-// $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 <thorsten.horstmann@fokus.fraunhofer.de>
+// Fraunhofer Institute for Open Communication Systems (FOKUS)
+// Competence Center NETwork research (NET), St. Augustin, GERMANY
+// Thorsten Horstmann <tho@berlios.de>
//
// 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
// 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::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<UInt8Parser>( 1 ).value();
+ case 3:
+ return parse<UInt16Parser>( 1 ).value();
+ case 4:
+ return parse<UInt24Parser>( 1 ).value();
+ case 5:
+ return parse<UInt32Parser>( 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<DynamicTLVLengthParser> 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<UInt8Parser>(1) = v;
+ return;
+ }
+ if (v < 65536u) {
+ if (bytes() != 3) {
+ resize(3);
+ safeThis->extended_length_flag() = true;
+ safeThis->fixed_length_field() = 2;
+ }
+ safeThis->parse<UInt16Parser>(1) = v;
+ return;
+ }
+ if (v < 16777216u) {
+ if (bytes() != 4) {
+ resize(4);
+ safeThis->extended_length_flag() = true;
+ safeThis->fixed_length_field() = 3;
+ }
+ safeThis->parse<UInt24Parser>(1) = v;
+ return;
+ }
+ if (v <= 4294967295u) {
+ if (bytes() != 5) {
+ resize(5);
+ safeThis->extended_length_flag() = true;
+ safeThis->fixed_length_field() = 4;
+ }
+ safeThis->parse<UInt32Parser>(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_