added first structure for ULE SNDU Packet
[senf.git] / Examples / DVBAdapter / ULEdec.cc
1 // $Id$
2 //
3 // Copyright (C) 2006
4 // Fraunhofer Institut fuer offene Kommunikationssysteme (FOKUS)
5 // Kompetenzzentrum fuer Satelitenkommunikation (SatCom)
6 //     Stefan Bund <stefan.bund@fokus.fraunhofer.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 // Definition of non-inline non-template functions
24
25 #include <string>
26 #include <iostream>
27 #include <iomanip>
28 #include <sys/ioctl.h>
29 #include <linux/sockios.h>
30 #include <linux/dvb/dmx.h> 
31
32 #include "Scheduler/Scheduler.hh"
33 #include "Packets/DefaultBundle/EthernetPacket.hh"
34 #include "Packets/MPEGDVBBundle/TransportPacket.hh"
35 #include "Packets/MPEGDVBBundle/SNDUPacket.hh"
36 #include "Utils/membind.hh"
37 #include "Socket/Protocols/DVB/DVBDemuxHandles.hh"
38 #include "Packets/ParseInt.hh"
39 #include "Packets/Packet.hh"
40 #include "Packets/PacketData.hh"
41 #include "Packets/ParseInt.hh"
42
43 #define PID 271
44 #define TS_SYNC 0x47
45
46 #define prefix_
47 ///////////////////////////////cc.p////////////////////////////////////////
48
49 namespace {
50
51     static const unsigned BLOCK_SIZE = 16;
52
53     template <class Iterator>
54     void hexdump(Iterator i, Iterator const & i_end, std::ostream& stream)
55     {
56         unsigned offset (0);
57         std::string ascii;
58         for (; i != i_end; ++i, ++offset) {
59             switch (offset % BLOCK_SIZE) {
60             case 0:
61                 if (!ascii.empty()) {
62                     stream << "  " << ascii << "\n";
63                     ascii = "";
64                 }
65                 stream << "  "
66                           << std::hex << std::setw(4) << std::setfill('0')
67                           << offset << ' ';
68                 break;
69             case BLOCK_SIZE/2:
70                 stream << " ";
71                 ascii += ' ';
72                 break;
73             }
74             stream << ' ' << std::hex << std::setw(2) << std::setfill('0')
75                       << unsigned(*i);
76             ascii += (*i >= ' ' && *i < 126) ? *i : '.';
77         }
78         if (!ascii.empty()) {
79             for (; (offset % BLOCK_SIZE) != 0; ++offset) {
80                 if ((offset % BLOCK_SIZE) == BLOCK_SIZE/2)
81                     stream << " ";
82                 stream << "   ";
83             }
84             stream << "  " << ascii << "\n";
85         }
86         stream << std::dec;
87     }
88 }
89
90
91 class ULEdec
92 {
93     senf::DVBDemuxPESHandle demuxHandle;
94     senf::DVBDvrHandle dvrHandle;
95     
96     unsigned char receiver_state;
97     unsigned char priv_tscc;
98 public:
99     ULEdec()
100     {
101         struct dmx_pes_filter_params pes_filter;
102         memset(&pes_filter, 0, sizeof (struct dmx_pes_filter_params));
103         pes_filter.pid = PID;
104         pes_filter.input  = DMX_IN_FRONTEND;
105         pes_filter.output = DMX_OUT_TS_TAP;
106         pes_filter.pes_type = DMX_PES_OTHER;
107         pes_filter.flags = DMX_IMMEDIATE_START;
108         demuxHandle.protocol().setPESFilter( &pes_filter );
109         
110         senf::Scheduler::instance().add(
111             dvrHandle, senf::membind(&ULEdec::handlePacket, this));
112         
113         receiver_state = 1; // Idle
114     }
115
116 private:
117     void handlePacket(senf::FileHandle, senf::Scheduler::EventId event)
118     {
119         char ts_data[188];
120         dvrHandle.read(&ts_data[0], &ts_data[188]);
121         senf::TransportPacket tsPacket (
122                 senf::TransportPacket::create( boost::begin(ts_data) ));
123 //        packet.dump(std::cout);
124 //        senf::PacketData & packetData (packet.last().data());
125 //        hexdump(packetData.begin(), packetData.end(), std::cout);
126         
127         // Check TS error conditions: sync_byte, transport_error_indicator, scrambling_control.
128         if ( (tsPacket->sync_byte() != TS_SYNC) || 
129              (tsPacket->transport_error_indicator() == true) || 
130              (tsPacket->transport_scrmbl_ctrl() != 0)) 
131         {
132             std::cerr << "invalid ts packet\n";
133             // drop partly decoded SNDU, reset state, resync on PUSI.
134             return;
135         }
136
137         unsigned char payload_pointer;
138         switch (receiver_state) {
139         case 1:  // Idle State
140             // resync on PUSI
141             if (tsPacket->pusi() == 0) 
142                 return; // skip packet
143             // Synchronize continuity counter
144             priv_tscc = tsPacket->continuity_counter();
145             // a PUSI value of 1 indicates the presence of a Payload Pointer.
146             payload_pointer = ts_data[4];
147             if (payload_pointer>181) {
148                 std::cerr << "invalid payload_pointer\n";
149                 return;
150             }
151             
152             // 
153             break;
154         case 2:  // Reassembly State
155             break;
156         }
157     }
158 };
159
160 int main(int argc, char const * argv[])
161 {
162     try {
163         ULEdec decoder;
164         senf::Scheduler::instance().process();
165     }
166     catch (std::exception const & ex) {
167         std::cerr << senf::prettyName(typeid(ex)) << ": " << ex.what() << "\n";
168     }
169     return 0;
170 }
171
172
173 ///////////////////////////////cc.e////////////////////////////////////////
174 #undef prefix_
175
176 \f
177 // Local Variables:
178 // mode: c++
179 // fill-column: 100
180 // c-file-style: "senf"
181 // indent-tabs-mode: nil
182 // ispell-local-dictionary: "american"
183 // compile-command: "scons -u test"
184 // comment-column: 40
185 // End: