// Custom includes
#include <iomanip>
-#include <senf/Utils/hexdump.hh>
+#include "../../Utils/hexdump.hh"
#define prefix_
///////////////////////////////cc.p////////////////////////////////////////
+prefix_ senf::safe_data_iterator senf::BaseTLVPacketParser::resizeValueField(
+ DynamicTLVLengthParser::value_type size)
+{
+ DynamicTLVLengthParser::value_type current_length ( length());
+ length( size);
+
+ safe_data_iterator si (data(), boost::next(i(), 1 + length_bytes() ));
+ if (current_length > size)
+ data().erase( si, boost::next(si, current_length-size));
+ else
+ data().insert( si, size-current_length, 0);
+ return si;
+}
+
+
prefix_ senf::DynamicTLVLengthParser::value_type senf::DynamicTLVLengthParser::value() const
{
switch (bytes() ) {
case 1:
- return fixed_length_field().value();
+ return length_field().value();
case 2:
- return parse<UInt8Parser>( 1 ).value();
+ return parse<UInt8Parser>( 1 ).value() + (underflow_flag() ? 0 : 128u);
case 3:
- return parse<UInt16Parser>( 1 ).value();
+ return parse<UInt16Parser>( 1 ).value() + (underflow_flag() ? 0 : 128u);
case 4:
- return parse<UInt24Parser>( 1 ).value();
+ return parse<UInt24Parser>( 1 ).value() + (underflow_flag() ? 0 : 128u);
case 5:
- return parse<UInt32Parser>( 1 ).value();
+ return parse<UInt32Parser>( 1 ).value() + (underflow_flag() ? 0 : 128u);
default:
- throw(UnsuportedTLVPacketException());
+ throw(TLVLengthException());
};
}
+
prefix_ void senf::DynamicTLVLengthParser::value(value_type const & v)
{
- if (v > 4294967295u)
- throw(UnsuportedTLVPacketException());
-
- SafePacketParserWrapper<DynamicTLVLengthParser> safeThis (*this);
- if (v < 128u) {
- if (bytes() != 1) {
- resize(1);
- safeThis->extended_length_flag() = false;
- }
- safeThis->fixed_length_field() = v;
+ switch (bytes() ) {
+ case 1:
+ if (v > 128) throw( TLVLengthException());
+ length_field() = v;
return;
- }
- if (v < 256u) {
- if (bytes() != 2) {
- resize(2);
- safeThis->extended_length_flag() = true;
- safeThis->fixed_length_field() = 1;
- }
- safeThis->parse<UInt8Parser>(1) = v;
+ case 2:
+ if (v > UInt8Parser::max_value + 128) throw( TLVLengthException());
+ parse<UInt8Parser>(1) = v - (v>128 ? 128 : 0);
+ break;
+ case 3:
+ if (v > UInt16Parser::max_value + 128) throw( TLVLengthException());
+ parse<UInt16Parser>(1) = v - (v>128 ? 128 : 0);
+ break;;
+ case 4:
+ if (v > UInt24Parser::max_value + 128) throw( TLVLengthException());
+ parse<UInt24Parser>(1) = v - (v>128 ? 128 : 0);
+ break;
+ case 5:
+ parse<UInt32Parser>(1) = v - (v>128 ? 128 : 0);
+ break;
+ default:
+ throw( TLVLengthException());
+ };
+ underflow_flag() = (v <= 128);
+}
+
+
+prefix_ senf::DynamicTLVLengthParser::value_type senf::DynamicTLVLengthParser::maxValue()
+ const
+{
+ switch (bytes() ) {
+ case 1:
+ return 128;
+ case 2:
+ return UInt8Parser::max_value + 128;
+ case 3:
+ return UInt16Parser::max_value + 128;
+ case 4:
+ return UInt24Parser::max_value + 128;
+ case 5:
+ return UInt32Parser::max_value;
+ default:
+ throw( TLVLengthException());
+ };
+}
+
+
+prefix_ senf::DynamicTLVLengthParser const & senf::DynamicTLVLengthParser::operator= (value_type other)
+{
+ value(other);
+ return *this;
+}
+
+
+prefix_ void senf::DynamicTLVLengthParser::init() const
+{
+ defaultInit();
+ extended_length_flag() = false;
+}
+
+
+prefix_ void senf::DynamicTLVLengthParser::finalize()
+{
+ value_type v = value();
+ size_type b = bytes();
+ if (v <= 128) {
+ if (b != 1) resize(1);
return;
}
- if (v < 65536u) {
- if (bytes() != 3) {
- resize(3);
- safeThis->extended_length_flag() = true;
- safeThis->fixed_length_field() = 2;
- }
- safeThis->parse<UInt16Parser>(1) = v;
+ if (v <= UInt8Parser::max_value + 128) {
+ if (b != 2) resize(2);
return;
}
- if (v < 16777216u) {
- if (bytes() != 4) {
- resize(4);
- safeThis->extended_length_flag() = true;
- safeThis->fixed_length_field() = 3;
- }
- safeThis->parse<UInt24Parser>(1) = v;
+ if (v <= UInt16Parser::max_value + 128) {
+ if (b != 3) resize(3);
return;
}
- if (v <= 4294967295u) {
- if (bytes() != 5) {
- resize(5);
- safeThis->extended_length_flag() = true;
- safeThis->fixed_length_field() = 4;
- }
- safeThis->parse<UInt32Parser>(1) = v;
+ if (v <= UInt24Parser::max_value + 128 ){
+ if (b != 4) resize(4);
return;
}
+ if (b != 5) resize(5);
}
-prefix_ senf::DynamicTLVLengthParser const & senf::DynamicTLVLengthParser::operator= (value_type other)
+
+prefix_ void senf::DynamicTLVLengthParser:: maxValue(DynamicTLVLengthParser::value_type v)
{
- value(other);
- return *this;
+ if (v <= 128)
+ return;
+ size_type b = bytes();
+ if (v <= UInt8Parser::max_value + 128) {
+ if (b < 2) resize(2);
+ return;
+ }
+ if (v <= UInt16Parser::max_value + 128) {
+ if (b < 3) resize(3);
+ return;
+ }
+ if (v <= UInt24Parser::max_value + 128) {
+ if (b < 4) resize(4);
+ return;
+ }
+ if (b < 5) resize(5);
}
-prefix_ senf::DynamicTLVLengthParser::size_type senf::DynamicTLVLengthParser::bytes() const
+
+prefix_ void senf::DynamicTLVLengthParser::resize(size_type size)
{
- if ( extended_length_flag() )
- return 1 + fixed_length_field();
+ value_type v = value();
+ size_type current_size (bytes());
+ SafePacketParserWrapper<DynamicTLVLengthParser> safeThis (*this);
+
+ if (current_size > size)
+ data().erase( i(), boost::next(i(), current_size-size));
else
- return 1;
-}
+ data().insert( i(), size-current_size, 0);
-prefix_ void senf::DynamicTLVLengthParser::init() const
+ if (size > 1) {
+ safeThis->extended_length_flag() = true;
+ safeThis->fixed_length_field() = size - 1;
+ } else {
+ safeThis->extended_length_flag() = false;
+ }
+ safeThis->value(v);
+}
+
+
+prefix_ senf::PacketInterpreterBase::range senf::GenericTLVPacketParser::value()
+ const
{
- defaultInit();
- extended_length_flag() = 0;
+ senf::PacketData::iterator begin (boost::next(data().begin(), 1 + length_bytes() ));
+ return PacketInterpreterBase::range(
+ begin, boost::next( begin, length()) );
}
-prefix_ void senf::DynamicTLVLengthParser::resize(size_type size)
+
+prefix_ void senf::GenericTLVPacketType::dump(packet p, std::ostream & os)
{
- size_type current_size (bytes());
- safe_data_iterator si (data(), i());
-
- if (current_size > size)
- data().erase( si, boost::next(si, current_size-size));
- else
- data().insert( si, size-current_size, 0);
+ boost::io::ios_all_saver ias(os);
+ os << "GenericTLVPacket:\n"
+ << std::dec
+ << " type : " << unsigned( p->type()) << "\n"
+ << " length : " << unsigned( p->length()) << "\n"
+ << " value\n : ";
+ senf::hexdump( p->value().begin(), p->value().end(), os);
+}
+
+
+prefix_ void senf::GenericTLVPacketType::finalize(packet p)
+{
+ p->finalizeLength();
}