X-Git-Url: http://g0dil.de/git?a=blobdiff_plain;f=Packets%2FMPEGDVBBundle%2FTLVPacket.cc;h=de06d6181dc5066ffc4b2184415200fde1456154;hb=914aedddb62c3ca4fcabc881ad12b398a1c120f3;hp=d93d5c2ff189c3ef042eee9be43ff1556915d2f8;hpb=8fec9fd54d7814bb93d235f6dd14641f3b16daea;p=senf.git diff --git a/Packets/MPEGDVBBundle/TLVPacket.cc b/Packets/MPEGDVBBundle/TLVPacket.cc index d93d5c2..de06d61 100644 --- a/Packets/MPEGDVBBundle/TLVPacket.cc +++ b/Packets/MPEGDVBBundle/TLVPacket.cc @@ -1,9 +1,9 @@ -// $Id: SNDUPacket.cc 423 2007-08-31 22:05:37Z g0dil $ +// $Id$ // // Copyright (C) 2007 -// Fraunhofer Institut fuer offene Kommunikationssysteme (FOKUS) -// Kompetenzzentrum fuer Satelitenkommunikation (SatCom) -// Thorsten Horstmann +// Fraunhofer Institute for Open Communication Systems (FOKUS) +// Competence Center NETwork research (NET), St. Augustin, GERMANY +// Thorsten Horstmann // // This program is free software; you can redistribute it and/or modify // it under the terms of the GNU General Public License as published by @@ -21,50 +21,120 @@ // 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. /** \file - \brief DSMCCSection non-inline non-template implementation */ + \brief TLVPacket non-inline non-template implementation */ #include "TLVPacket.hh" //#include "TLVPacket.ih" // Custom includes #include -#include "../../Utils/hexdump.hh" -#include "../../Packets/DefaultBundle/EthernetPacket.hh" - +#include #define prefix_ ///////////////////////////////cc.p//////////////////////////////////////// - -prefix_ senf::PacketParserBase::size_type senf::Parse_TLVPacket::bytes() - const +prefix_ senf::DynamicTLVLengthParser::value_type senf::DynamicTLVLengthParser::value() const { - return 4 + senf::bytes( length() ); + switch (bytes() ) { + case 1: + return fixed_length_field().value(); + case 2: + return parse( 1 ).value(); + case 3: + return parse( 1 ).value(); + case 4: + return parse( 1 ).value(); + case 5: + return parse( 1 ).value(); + default: + throw(UnsuportedTLVPacketException()); + }; } -//prefix_ void senf::TLVPacketType::init(packet p) -//{ -// p->init(); -//} +prefix_ void senf::DynamicTLVLengthParser::value(value_type const & v) +{ + if (v > 4294967295u) + throw(UnsuportedTLVPacketException()); + + SafePacketParserWrapper safeThis (*this); + if (v < 128u) { + if (bytes() != 1) { + resize(1); + safeThis->extended_length_flag() = false; + } + safeThis->fixed_length_field() = v; + return; + } + if (v < 256u) { + if (bytes() != 2) { + resize(2); + safeThis->extended_length_flag() = true; + safeThis->fixed_length_field() = 1; + } + safeThis->parse(1) = v; + return; + } + if (v < 65536u) { + if (bytes() != 3) { + resize(3); + safeThis->extended_length_flag() = true; + safeThis->fixed_length_field() = 2; + } + safeThis->parse(1) = v; + return; + } + if (v < 16777216u) { + if (bytes() != 4) { + resize(4); + safeThis->extended_length_flag() = true; + safeThis->fixed_length_field() = 3; + } + safeThis->parse(1) = v; + return; + } + if (v <= 4294967295u) { + if (bytes() != 5) { + resize(5); + safeThis->extended_length_flag() = true; + safeThis->fixed_length_field() = 4; + } + safeThis->parse(1) = v; + return; + } +} -prefix_ void senf::TLVPacketType::dump(packet p, std::ostream & os) +prefix_ senf::DynamicTLVLengthParser const & senf::DynamicTLVLengthParser::operator= (value_type other) { - os << "TLVPacket:\n" - << std::dec - << " type: " << unsigned(p->type()) << "\n" - << " length: " << unsigned(p->length()) << "\n"; + value(other); + return *this; } -prefix_ senf::PacketParserBase::size_type senf::TLVPacketType::initSize() +prefix_ senf::DynamicTLVLengthParser::size_type senf::DynamicTLVLengthParser::bytes() const { - return 4 + 1; + if ( extended_length_flag() ) + return 1 + fixed_length_field(); + else + return 1; +} + +prefix_ void senf::DynamicTLVLengthParser::init() const +{ + defaultInit(); + extended_length_flag() = 0; } -prefix_ senf::PacketParserBase::size_type senf::TLVPacketType::initHeadSize() +prefix_ void senf::DynamicTLVLengthParser::resize(size_type size) { - return 4 + 1; + 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); } + ///////////////////////////////cc.e//////////////////////////////////////// #undef prefix_