Packets/MPEGDVBBundle/TLVPacket.cc

   1 // $Id$
   2 //
   3 // Copyright (C) 2007
   4 // Fraunhofer Institute for Open Communication Systems (FOKUS)
   5 // Competence Center NETwork research (NET), St. Augustin, GERMANY
   6 //     Thorsten Horstmann <tho@berlios.de>
   7 //
   8 // This program is free software; you can redistribute it and/or modify
   9 // it under the terms of the GNU General Public License as published by
  10 // the Free Software Foundation; either version 2 of the License, or
  11 // (at your option) any later version.
  12 //
  13 // This program is distributed in the hope that it will be useful,
  14 // but WITHOUT ANY WARRANTY; without even the implied warranty of
  15 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16 // GNU General Public License for more details.
  17 //
  18 // You should have received a copy of the GNU General Public License
  19 // along with this program; if not, write to the
  20 // Free Software Foundation, Inc.,
  21 // 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
  22
  23 /** \file
  24     \brief TLVPacket non-inline non-template implementation */
  25
  26 #include "TLVPacket.hh"
  27 //#include "TLVPacket.ih"
  28
  29 // Custom includes
  30 #include <iomanip>
  31 #include <senf/Utils/hexdump.hh>
  32
  33 #define prefix_
  34 ///////////////////////////////cc.p////////////////////////////////////////
  35
  36 prefix_ senf::DynamicTLVLengthParser::value_type senf::DynamicTLVLengthParser::value() const
  37 {
  38     switch (bytes() ) {
  39     case 1:
  40         return fixed_length_field().value();
  41     case 2:
  42         return parse<UInt8Parser>( 1 ).value();
  43     case 3:
  44         return parse<UInt16Parser>( 1 ).value();
  45     case 4:
  46         return parse<UInt24Parser>( 1 ).value();
  47     case 5:
  48         return parse<UInt32Parser>( 1 ).value();
  49     default:
  50         throw(UnsuportedTLVPacketException());
  51     };
  52 }
  53
  54 prefix_ void senf::DynamicTLVLengthParser::value(value_type const & v)
  55 {
  56     if (v > 4294967295u)
  57         throw(UnsuportedTLVPacketException());
  58
  59     SafePacketParserWrapper<DynamicTLVLengthParser> safeThis (*this);
  60     if (v < 128u) {
  61         if (bytes() != 1) {
  62             resize(1);
  63             safeThis->extended_length_flag() = false;
  64         }
  65         safeThis->fixed_length_field() = v;
  66         return;
  67     }
  68     if (v < 256u) {
  69         if (bytes() != 2) {
  70             resize(2);
  71             safeThis->extended_length_flag() = true;
  72             safeThis->fixed_length_field() = 1;
  73         }
  74         safeThis->parse<UInt8Parser>(1) = v;
  75         return;
  76     }
  77     if (v < 65536u) {
  78         if (bytes() != 3) {
  79             resize(3);
  80             safeThis->extended_length_flag() = true;
  81             safeThis->fixed_length_field() = 2;
  82         }
  83         safeThis->parse<UInt16Parser>(1) = v;
  84         return;
  85     }
  86     if (v < 16777216u) {
  87         if (bytes() != 4) {
  88             resize(4);
  89             safeThis->extended_length_flag() = true;
  90             safeThis->fixed_length_field() = 3;
  91         }
  92         safeThis->parse<UInt24Parser>(1) = v;
  93         return;
  94     }
  95     if (v <= 4294967295u) {
  96         if (bytes() != 5) {
  97             resize(5);
  98             safeThis->extended_length_flag() = true;
  99             safeThis->fixed_length_field() = 4;
 100         }
 101         safeThis->parse<UInt32Parser>(1) = v;
 102         return;
 103     }
 104 }
 105
 106 prefix_ senf::DynamicTLVLengthParser const & senf::DynamicTLVLengthParser::operator= (value_type other)
 107 {
 108     value(other);
 109     return *this;
 110 }
 111
 112 prefix_ senf::DynamicTLVLengthParser::size_type senf::DynamicTLVLengthParser::bytes() const
 113 {
 114     if ( extended_length_flag() )
 115         return 1 + fixed_length_field();
 116     else
 117         return 1;
 118 }
 119
 120 prefix_ void senf::DynamicTLVLengthParser::init() const
 121 {
 122     defaultInit();
 123     extended_length_flag() = 0;
 124 }
 125
 126 prefix_ void senf::DynamicTLVLengthParser::resize(size_type size)
 127 {
 128     size_type current_size (bytes());
 129     safe_data_iterator si (data(), i());
 130
 131     if (current_size > size)
 132         data().erase( si, boost::next(si, current_size-size));
 133     else
 134         data().insert( si, size-current_size, 0);
 135 }
 136
 137
 138 ///////////////////////////////cc.e////////////////////////////////////////
 139 #undef prefix_
 140
 141 \f
 142 // Local Variables:
 143 // mode: c++
 144 // fill-column: 100
 145 // c-file-style: "senf"
 146 // indent-tabs-mode: nil
 147 // ispell-local-dictionary: "american"
 148 // compile-command: "scons -u test"
 149 // comment-column: 40
 150 // End: