X-Git-Url: http://g0dil.de/git?a=blobdiff_plain;f=Packets%2FMPEGDVBBundle%2FTLVPacket.cc;h=44c63383f125c0a02b9b52641b102ead1741c01b;hb=ae06fe86f16fdabb7ffb219d255444d2eb4f4f79;hp=d93d5c2ff189c3ef042eee9be43ff1556915d2f8;hpb=8fec9fd54d7814bb93d235f6dd14641f3b16daea;p=senf.git

diff --git a/Packets/MPEGDVBBundle/TLVPacket.cc b/Packets/MPEGDVBBundle/TLVPacket.cc
index d93d5c2..44c6338 100644
--- a/Packets/MPEGDVBBundle/TLVPacket.cc
+++ b/Packets/MPEGDVBBundle/TLVPacket.cc
@@ -1,4 +1,4 @@
-// $Id: SNDUPacket.cc 423 2007-08-31 22:05:37Z g0dil $
+// $Id$
 //
 // Copyright (C) 2007
 // Fraunhofer Institut fuer offene Kommunikationssysteme (FOKUS)
@@ -21,31 +21,118 @@
 // 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 <iomanip>
-#include "../../Utils/hexdump.hh"
-#include "../../Packets/DefaultBundle/EthernetPacket.hh"
-
+#include <senf/Utils/hexdump.hh>
 
 #define prefix_
 ///////////////////////////////cc.p////////////////////////////////////////
 
+prefix_ senf::Parse_TLVPacketLength::value_type senf::Parse_TLVPacketLength::value() const 
+{
+    switch (bytes() ) {
+    case 1:
+        return fixed_length_field().value();
+    case 2:
+        return parse<Parse_UInt8>( 1 ).value();
+    case 3:
+        return parse<Parse_UInt16>( 1 ).value();
+    case 4:
+        return parse<Parse_UInt24>( 1 ).value();
+    case 5:
+        return parse<Parse_UInt32>( 1 ).value();
+    default:
+        throw(UnsuportedTLVPacketException());
+    };
+}
+
+prefix_ void senf::Parse_TLVPacketLength::value(value_type const & v) 
+{
+    if (v > 4294967295u)
+        throw(UnsuportedTLVPacketException());
+    
+    SafePacketParser<Parse_TLVPacketLength> 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<Parse_UInt8>(1) = v;
+        return;
+    }
+    if (v < 65536u) {
+        if (bytes() != 3) {
+	    resize(3);
+	    safeThis->extended_length_flag() = true;
+	    safeThis->fixed_length_field() = 2;
+	}
+        safeThis->parse<Parse_UInt16>(1) = v;
+        return;
+    }
+    if (v < 16777216u) {
+        if (bytes() != 4) {
+	    resize(4);
+	    safeThis->extended_length_flag() = true;
+	    safeThis->fixed_length_field() = 3;
+	}
+        safeThis->parse<Parse_UInt24>(1) = v;
+        return;
+    }
+    if (v <= 4294967295u) {
+        if (bytes() != 5) {
+	    resize(5);
+	    safeThis->extended_length_flag() = true;
+	    safeThis->fixed_length_field() = 4;
+	}
+        safeThis->parse<Parse_UInt32>(1) = v;
+        return;
+    }
+}
+
+prefix_ senf::Parse_TLVPacketLength const & senf::Parse_TLVPacketLength::operator= (value_type other) 
+{
+    value(other);
+    return *this; 
+}
 
-prefix_ senf::PacketParserBase::size_type senf::Parse_TLVPacket::bytes()
-    const
+prefix_ senf::Parse_TLVPacketLength::size_type senf::Parse_TLVPacketLength::bytes() const 
+{
+    if ( extended_length_flag() )
+        return 1 + fixed_length_field();
+    else
+        return 1;
+}
+    
+prefix_ void senf::Parse_TLVPacketLength::init() const 
 {
-    return 4 + senf::bytes( length() );
+    defaultInit();
+    extended_length_flag() = 0;
 }
 
-//prefix_ void senf::TLVPacketType::init(packet p)
-//{
-//    p->init();
-//}
+prefix_ void senf::Parse_TLVPacketLength::resize(size_type size) 
+{
+    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);
+}
 
 prefix_ void senf::TLVPacketType::dump(packet p, std::ostream & os)
 {
@@ -57,14 +144,30 @@ prefix_ void senf::TLVPacketType::dump(packet p, std::ostream & os)
 
 prefix_ senf::PacketParserBase::size_type senf::TLVPacketType::initSize()
 {
-    return 4 + 1;
+    return 5;  // 4 bytes type + 1 byte length
+}
+
+prefix_ void senf::TLVPacketType::init(packet p)
+{
+    p->init();
 }
 
-prefix_ senf::PacketParserBase::size_type senf::TLVPacketType::initHeadSize()
+prefix_ void senf::TLVPacketType::finalize(packet p)
 {
-    return 4 + 1;
+    p->length() = p.next().data().size();
 }
 
+prefix_ senf::PacketInterpreterBase::optional_range 
+senf::TLVPacketType::nextPacketRange(packet p) 
+{
+    if (p.data().size() < 5)
+        return no_range();
+    return range(
+            boost::next(p.data().begin(), 4 + senf::bytes(p->length()) ),
+            p.data().end() );
+}
+
+
 ///////////////////////////////cc.e////////////////////////////////////////
 #undef prefix_