MPESection: added new crc calculation
[senf.git] / Packets / MPEGDVBBundle / MPESection.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 // and
9 //
10 // Copyright(C) 2002 Pascal Massimino <skal@planet-d.net>
11 // (xvidcore-1.1.0-beta2/examples/xvid_bench.c)
12 //
13 // This program is free software; you can redistribute it and/or modify
14 // it under the terms of the GNU General Public License as published by
15 // the Free Software Foundation; either version 2 of the License, or
16 // (at your option) any later version.
17 //
18 // This program is distributed in the hope that it will be useful,
19 // but WITHOUT ANY WARRANTY; without even the implied warranty of
20 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
21 // GNU General Public License for more details.
22 //
23 // You should have received a copy of the GNU General Public License
24 // along with this program; if not, write to the
25 // Free Software Foundation, Inc.,
26 // 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
27
28 /** \file
29     \brief MPESection non-inline non-template implementation */
30
31 #include "MPESection.hh"
32 //#include "MPESection.ih"
33
34 // Custom includes
35 #include <iomanip>
36 #include <boost/io/ios_state.hpp>
37 #include "../../Packets/DefaultBundle/LlcSnapPacket.hh"
38 #include "../../Packets/DefaultBundle/IPv4Packet.hh"
39 #include "../../Packets/DefaultBundle/IPv6Packet.hh"
40
41 #define prefix_
42 ///////////////////////////////cc.p////////////////////////////////////////
43
44 unsigned long senf::MPESectionParser::crc32tab_[256] = {
45         0x00000000L, 0x04C11DB7L, 0x09823B6EL, 0x0D4326D9L, 0x130476DCL,
46         0x17C56B6BL, 0x1A864DB2L, 0x1E475005L, 0x2608EDB8L, 0x22C9F00FL,
47         0x2F8AD6D6L, 0x2B4BCB61L, 0x350C9B64L, 0x31CD86D3L, 0x3C8EA00AL,
48         0x384FBDBDL, 0x4C11DB70L, 0x48D0C6C7L, 0x4593E01EL, 0x4152FDA9L,
49         0x5F15ADACL, 0x5BD4B01BL, 0x569796C2L, 0x52568B75L, 0x6A1936C8L,
50         0x6ED82B7FL, 0x639B0DA6L, 0x675A1011L, 0x791D4014L, 0x7DDC5DA3L,
51         0x709F7B7AL, 0x745E66CDL, 0x9823B6E0L, 0x9CE2AB57L, 0x91A18D8EL,
52         0x95609039L, 0x8B27C03CL, 0x8FE6DD8BL, 0x82A5FB52L, 0x8664E6E5L,
53         0xBE2B5B58L, 0xBAEA46EFL, 0xB7A96036L, 0xB3687D81L, 0xAD2F2D84L,
54         0xA9EE3033L, 0xA4AD16EAL, 0xA06C0B5DL, 0xD4326D90L, 0xD0F37027L,
55         0xDDB056FEL, 0xD9714B49L, 0xC7361B4CL, 0xC3F706FBL, 0xCEB42022L,
56         0xCA753D95L, 0xF23A8028L, 0xF6FB9D9FL, 0xFBB8BB46L, 0xFF79A6F1L,
57         0xE13EF6F4L, 0xE5FFEB43L, 0xE8BCCD9AL, 0xEC7DD02DL, 0x34867077L,
58         0x30476DC0L, 0x3D044B19L, 0x39C556AEL, 0x278206ABL, 0x23431B1CL,
59         0x2E003DC5L, 0x2AC12072L, 0x128E9DCFL, 0x164F8078L, 0x1B0CA6A1L,
60         0x1FCDBB16L, 0x018AEB13L, 0x054BF6A4L, 0x0808D07DL, 0x0CC9CDCAL,
61         0x7897AB07L, 0x7C56B6B0L, 0x71159069L, 0x75D48DDEL, 0x6B93DDDBL,
62         0x6F52C06CL, 0x6211E6B5L, 0x66D0FB02L, 0x5E9F46BFL, 0x5A5E5B08L,
63         0x571D7DD1L, 0x53DC6066L, 0x4D9B3063L, 0x495A2DD4L, 0x44190B0DL,
64         0x40D816BAL, 0xACA5C697L, 0xA864DB20L, 0xA527FDF9L, 0xA1E6E04EL,
65         0xBFA1B04BL, 0xBB60ADFCL, 0xB6238B25L, 0xB2E29692L, 0x8AAD2B2FL,
66         0x8E6C3698L, 0x832F1041L, 0x87EE0DF6L, 0x99A95DF3L, 0x9D684044L,
67         0x902B669DL, 0x94EA7B2AL, 0xE0B41DE7L, 0xE4750050L, 0xE9362689L,
68         0xEDF73B3EL, 0xF3B06B3BL, 0xF771768CL, 0xFA325055L, 0xFEF34DE2L,
69         0xC6BCF05FL, 0xC27DEDE8L, 0xCF3ECB31L, 0xCBFFD686L, 0xD5B88683L,
70         0xD1799B34L, 0xDC3ABDEDL, 0xD8FBA05AL, 0x690CE0EEL, 0x6DCDFD59L,
71         0x608EDB80L, 0x644FC637L, 0x7A089632L, 0x7EC98B85L, 0x738AAD5CL,
72         0x774BB0EBL, 0x4F040D56L, 0x4BC510E1L, 0x46863638L, 0x42472B8FL,
73         0x5C007B8AL, 0x58C1663DL, 0x558240E4L, 0x51435D53L, 0x251D3B9EL,
74         0x21DC2629L, 0x2C9F00F0L, 0x285E1D47L, 0x36194D42L, 0x32D850F5L,
75         0x3F9B762CL, 0x3B5A6B9BL, 0x0315D626L, 0x07D4CB91L, 0x0A97ED48L,
76         0x0E56F0FFL, 0x1011A0FAL, 0x14D0BD4DL, 0x19939B94L, 0x1D528623L,
77         0xF12F560EL, 0xF5EE4BB9L, 0xF8AD6D60L, 0xFC6C70D7L, 0xE22B20D2L,
78         0xE6EA3D65L, 0xEBA91BBCL, 0xEF68060BL, 0xD727BBB6L, 0xD3E6A601L,
79         0xDEA580D8L, 0xDA649D6FL, 0xC423CD6AL, 0xC0E2D0DDL, 0xCDA1F604L,
80         0xC960EBB3L, 0xBD3E8D7EL, 0xB9FF90C9L, 0xB4BCB610L, 0xB07DABA7L,
81         0xAE3AFBA2L, 0xAAFBE615L, 0xA7B8C0CCL, 0xA379DD7BL, 0x9B3660C6L,
82         0x9FF77D71L, 0x92B45BA8L, 0x9675461FL, 0x8832161AL, 0x8CF30BADL,
83         0x81B02D74L, 0x857130C3L, 0x5D8A9099L, 0x594B8D2EL, 0x5408ABF7L,
84         0x50C9B640L, 0x4E8EE645L, 0x4A4FFBF2L, 0x470CDD2BL, 0x43CDC09CL,
85         0x7B827D21L, 0x7F436096L, 0x7200464FL, 0x76C15BF8L, 0x68860BFDL,
86         0x6C47164AL, 0x61043093L, 0x65C52D24L, 0x119B4BE9L, 0x155A565EL,
87         0x18197087L, 0x1CD86D30L, 0x029F3D35L, 0x065E2082L, 0x0B1D065BL,
88         0x0FDC1BECL, 0x3793A651L, 0x3352BBE6L, 0x3E119D3FL, 0x3AD08088L,
89         0x2497D08DL, 0x2056CD3AL, 0x2D15EBE3L, 0x29D4F654L, 0xC5A92679L,
90         0xC1683BCEL, 0xCC2B1D17L, 0xC8EA00A0L, 0xD6AD50A5L, 0xD26C4D12L,
91         0xDF2F6BCBL, 0xDBEE767CL, 0xE3A1CBC1L, 0xE760D676L, 0xEA23F0AFL,
92         0xEEE2ED18L, 0xF0A5BD1DL, 0xF464A0AAL, 0xF9278673L, 0xFDE69BC4L,
93         0x89B8FD09L, 0x8D79E0BEL, 0x803AC667L, 0x84FBDBD0L, 0x9ABC8BD5L,
94         0x9E7D9662L, 0x933EB0BBL, 0x97FFAD0CL, 0xAFB010B1L, 0xAB710D06L,
95         0xA6322BDFL, 0xA2F33668L, 0xBCB4666DL, 0xB8757BDAL, 0xB5365D03L,
96         0xB1F740B4L
97 };
98
99 #define DO1(c, crc) ((crc) = senf::MPESectionParser::crc32tab_[((unsigned int)((crc)>>24) ^ (*c++)) & 0xff] ^ ((crc) << 8))
100 #define DO2(c, crc)  DO1(c, crc); DO1(c, crc);
101 #define DO4(c, crc)  DO2(c, crc); DO2(c, crc);
102 #define DO8(c, crc)  DO4(c, crc); DO4(c, crc);
103 prefix_ boost::uint32_t senf::MPESectionParser::calcCrc()
104     const
105 {
106 //    return std::for_each(
107 //            data().begin(),
108 //            boost::prior(data().end(), 4),
109 //            crc32_t() ).checksum();
110     register boost::uint32_t crc = 0xFFFFFFFF;
111     size_type len = data().size()-4;
112     byte *mem = &data()[0];
113
114     while( len >= 8) {
115         DO8(mem, crc);
116         len -= 8;
117     }
118     while( len ) {
119         DO1(mem, crc);
120         len--;
121     }
122
123     return crc;
124
125 }
126
127
128 prefix_ void senf::MPESectionType::dump(packet p, std::ostream & os)
129 {
130     boost::io::ios_all_saver ias(os);
131     os << "MPE Section:\n"
132        << std::hex
133        << "  table_id: 0x" << unsigned(p->table_id()) << "\n"
134        << "  section_syntax_indicator: " << p->section_syntax_indicator() << "\n"
135        << "  private_indicator: " << p->private_indicator() << "\n"
136        << std::dec
137        << "  section_length: " << p->section_length() << "\n"
138        << std::hex
139        << "  MAC_address_6: 0x" << unsigned(p->mac_addr_6()) << "\n"
140        << "  MAC_address_5: 0x" << unsigned(p->mac_addr_5()) << "\n"
141        << "  payload_scrambling_control: 0x" << p->payload_scrmbl_ctrl() << "\n"
142        << "  address_scrambling_control: 0x" << p-> addr_scrmbl_ctrl()  << "\n"
143        << "  LLC_SNAP_flag: 0x" << p->llc_snap_flag() << "\n"
144        << "  current_next_indicator: 0x" << p->curr_next_indicator() << "\n"
145        << "  section_number: 0x" << unsigned(p->section_num()) << "\n"
146        << "  last_section_number: 0x" << unsigned(p->last_section_num()) << "\n"
147        << "  real_time_parameters: \n"
148        << "    delta_t: 0x" << unsigned(p->real_time_parameters().delta_t()) << "\n"
149        << "    table_boundary: 0x" << unsigned(p->real_time_parameters().table_boundary()) << "\n"
150        << "    frame_boundary: 0x" << unsigned(p->real_time_parameters().frame_boundary()) << "\n"
151        << "    address: 0x" << unsigned(p->real_time_parameters().address()) << "\n"
152        << std::dec
153        << "  CRC: " << unsigned(p->crc()) << "\n";
154 }
155
156 prefix_ senf::PacketParserBase::size_type senf::MPESectionType::initSize()
157 {
158     return parser::fixed_bytes + 32/8;
159 }
160
161 prefix_ senf::PacketParserBase::size_type senf::MPESectionType::initHeadSize()
162 {
163     return parser::fixed_bytes;
164 }
165
166 prefix_ senf::PacketInterpreterBase::factory_t senf::MPESectionType::nextPacketType(packet p)
167 {
168     if (p.data().size() > initSize()+1) {
169         if (p->llc_snap_flag())
170             return LlcSnapPacket::factory();
171         if (p->ip_datagram_version().value() == 4)
172             return IPv4Packet::factory();
173         if (p->ip_datagram_version().value() == 6)
174             return IPv6Packet::factory();
175     }
176     return no_factory();
177 }
178
179 prefix_ void senf::MPESectionType::finalize(packet p)
180 {
181     p->llc_snap_flag() = p.next(nothrow) && p.next().is<LlcSnapPacket>() ? 1 : 0;
182     p->section_length() = p.data().size() - 3;
183     p->crc() = p->calcCrc();
184 }
185
186 ///////////////////////////////cc.e////////////////////////////////////////
187 #undef prefix_
188
189
190 // Local Variables:
191 // mode: c++
192 // fill-column: 100
193 // c-file-style: "senf"
194 // indent-tabs-mode: nil
195 // ispell-local-dictionary: "american"
196 // compile-command: "scons -u test"
197 // comment-column: 40
198 // End: