4 // Fraunhofer Institut fuer offene Kommunikationssysteme (FOKUS)
5 // Kompetenzzentrum fuer Satelitenkommunikation (SatCom)
6 // Stefan Bund <stefan.bund@fokus.fraunhofer.de>
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.
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.
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.
24 #define IH_ParseInt_ 1
27 #include "PacketTypes.hh"
29 ///////////////////////////////ih.p////////////////////////////////////////
35 ///////////////////////////////////////////////////////////////////////////
38 /** \brief Internal: Integer operation mixin for integer parsers
42 This class contains all the integer operations supported by the integer parsers. It is
43 inherited by each integer parser.
45 template <class Derived, class Value>
49 typedef Value value_type;
51 operator Value () const { return derived().value(); }
54 Value operator op () const { return op derived().value(); }
55 # define mutator(op) \
56 template <class Other> Derived const & operator op ## = (Other other) \
57 { derived().value( derived().value() op other ); return derived(); }
77 Derived const & operator ++ ()
78 { derived().value( derived().value()+1 ); return derived(); }
79 Derived const & operator -- ()
80 { derived().value( derived().value()-1 ); return derived(); }
82 Value operator ++ (int)
83 { Value v (derived().value()); derived().value( v+1 ); return v; }
84 Value operator -- (int)
85 { Value v (derived().value()); derived().value( v-1 ); return v; }
88 Derived & derived() { return *static_cast<Derived *>(this); }
89 Derived const & derived() const { return *static_cast<Derived const *>(this); };
92 ///////////////////////////////////////////////////////////////////////////
93 // Network byte order integer extraction
95 /** \brief Internal: Extract 16bit network byte order value
99 inline boost::uint16_t parse_uint16(iterator i)
101 return i[1] | i[0]<<8;
104 /** \brief Internal: Write 16bit network byte order value
108 inline void write_uint16(iterator i, boost::uint16_t v)
110 i[0] = ( v >> 8 ) & 0xff;
114 /** \brief Internal: Extract 24bit network byte order value
118 inline boost::uint32_t parse_uint24(iterator i)
120 return i[2] | i[1]<<8 | i[0]<<16;
123 /** \brief Internal: Write 24bit network byte order value
127 inline void write_uint24(iterator i, boost::uint32_t v)
129 i[0] = ( v >> 16 ) & 0xff;
130 i[1] = ( v >> 8 ) & 0xff;
134 /** \brief Internal: Extract 32bit network byte order value
138 inline boost::uint32_t parse_uint32(iterator i)
140 return i[3] | i[2]<<8 | i[1]<<16 | i[0]<<24;
143 /** \brief Internal: Write 32bit network byte order value
147 inline void write_uint32(iterator i, boost::uint32_t v)
149 i[0] = ( v >> 24 ) & 0xff;
150 i[1] = ( v >> 16 ) & 0xff;
151 i[2] = ( v >> 8 ) & 0xff;
155 ///////////////////////////////////////////////////////////////////////////
156 // bitfield extraction
158 // Doxygen doesn't like this stuff ...
162 template <unsigned offset, unsigned endb, unsigned start, unsigned end>
163 struct parse_bitfield_i
165 static boost::uint32_t parse(iterator i) {
166 return ( ( ( parse_uint32(i+offset+1)>>(40-end) ) // Beware of sign extension !!
167 & boost::low_bits_mask_t<32-(40-end)>::sig_bits )
168 | (i[offset]<<(32-(40-end))) )
169 & boost::low_bits_mask_t<end-start>::sig_bits;
172 static void write(iterator i, boost::uint32_t v) {
173 write_uint32(i+offset+1,
174 (parse_uint32(i+offset+1) & ~(boost::low_bits_mask_t<end-8>::sig_bits<<(40-end)))
175 | ((v & boost::low_bits_mask_t<end-8>::sig_bits) << (40-end)));
176 i[offset] = (i[offset] & ~(boost::low_bits_mask_t<8-start>::sig_bits))
177 | ((v>>(end-8)) & boost::low_bits_mask_t<8-start>::sig_bits);
181 template <unsigned offset, unsigned start, unsigned end>
182 struct parse_bitfield_i<offset, 3, start, end>
184 static boost::uint32_t parse(iterator i) {
185 return ( parse_uint32(i+offset)>>(32-end) )
186 & boost::low_bits_mask_t<end-start>::sig_bits;
189 static void write(iterator i, boost::uint32_t v) {
190 write_uint32(i+offset,
191 (parse_uint32(i+offset) & ~(boost::low_bits_mask_t<end-start>::sig_bits<<(32-end)))
192 | ((v & boost::low_bits_mask_t<end-start>::sig_bits) << (32-end)));
196 template <unsigned offset, unsigned start, unsigned end>
197 struct parse_bitfield_i<offset, 2, start, end>
199 static boost::uint32_t parse(iterator i) {
200 return ( parse_uint24(i+offset)>>(24-end) )
201 & boost::low_bits_mask_t<end-start>::sig_bits;
204 static void write(iterator i, boost::uint32_t v) {
205 write_uint24(i+offset,
206 (parse_uint24(i+offset) & ~(boost::low_bits_mask_t<end-start>::sig_bits<<(24-end)))
207 | ((v & boost::low_bits_mask_t<end-start>::sig_bits) << (24-end)));
211 template <unsigned offset, unsigned start, unsigned end>
212 struct parse_bitfield_i<offset, 1, start, end>
214 static boost::uint32_t parse(iterator i) {
215 return ( parse_uint16(i+offset)>>(16-end) )
216 & boost::low_bits_mask_t<end-start>::sig_bits;
219 static void write(iterator i, boost::uint32_t v) {
220 write_uint16(i+offset,
221 (parse_uint16(i+offset) & ~(boost::low_bits_mask_t<end-start>::sig_bits<<(16-end)))
222 | ((v & boost::low_bits_mask_t<end-start>::sig_bits) << (16-end)));
226 template <unsigned offset, unsigned start, unsigned end>
227 struct parse_bitfield_i<offset, 0, start, end>
229 static boost::uint32_t parse(iterator i) {
230 return ( i[offset]>>(8-end) )
231 & boost::low_bits_mask_t<end-start>::sig_bits;
234 static void write(iterator i, boost::uint32_t v) {
235 i[offset] = (i[offset] & ~(boost::low_bits_mask_t<end-start>::sig_bits<<(8-end)))
236 | ((v & boost::low_bits_mask_t<end-start>::sig_bits) << (8-end));
242 /** \brief Internal: Bitfield read/write helper
246 Using template specializations, this class provides optimized bitfield parsers and
247 writers. For each number of bytes the bitfield covers (from 1 to 5 bytes), a template
248 specialization is provided in \c parse_bitfield_i.
250 This helper always processes unsigned values. For signed values sign extension still needs
253 template <unsigned start, unsigned end>
254 struct parse_bitfield
255 : public parse_bitfield_i<start/8,(end-1)/8-start/8,start%8,end-8*(start/8)>
260 ///////////////////////////////ih.e////////////////////////////////////////
267 // c-file-style: "senf"
268 // indent-tabs-mode: nil
269 // ispell-local-dictionary: "american"
270 // compile-command: "scons -u test"
271 // comment-column: 40