Examples/DVBAdapter/MPEdec.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/DatagramSection.hh"
  35 #include "Utils/membind.hh"
  36 #include "Socket/DVBDemuxHandles.hh"
  37 #include "Packets/ParseInt.hh"
  38 #include "Packets/Packet.hh"
  39 #include "Packets/PacketData.hh"
  40
  41 #define PID 500
  42
  43 #define prefix_
  44 ///////////////////////////////cc.p////////////////////////////////////////
  45
  46 namespace {
  47
  48     static const unsigned BLOCK_SIZE = 16;
  49
  50     template <class Iterator>
  51     void hexdump(Iterator i, Iterator const & i_end, std::ostream& stream)
  52     {
  53         unsigned offset (0);
  54         std::string ascii;
  55         for (; i != i_end; ++i, ++offset) {
  56             switch (offset % BLOCK_SIZE) {
  57             case 0:
  58                 if (!ascii.empty()) {
  59                     stream << "  " << ascii << "\n";
  60                     ascii = "";
  61                 }
  62                 stream << "  "
  63                           << std::hex << std::setw(4) << std::setfill('0')
  64                           << offset << ' ';
  65                 break;
  66             case BLOCK_SIZE/2:
  67                 stream << " ";
  68                 ascii += ' ';
  69                 break;
  70             }
  71             stream << ' ' << std::hex << std::setw(2) << std::setfill('0')
  72                       << unsigned(*i);
  73             ascii += (*i >= ' ' && *i < 126) ? *i : '.';
  74         }
  75         if (!ascii.empty()) {
  76             for (; (offset % BLOCK_SIZE) != 0; ++offset) {
  77                 if ((offset % BLOCK_SIZE) == BLOCK_SIZE/2)
  78                     stream << " ";
  79                 stream << "   ";
  80             }
  81             stream << "  " << ascii << "\n";
  82         }
  83         stream << std::dec;
  84     }
  85 }
  86
  87
  88 class MySniffer
  89 {
  90     senf::DVBDemuxSectionHandle handle;
  91
  92 public:
  93     MySniffer()
  94     {
  95         struct dmx_sct_filter_params sec_filter;
  96         memset(&sec_filter, 0, sizeof (struct dmx_sct_filter_params));
  97         sec_filter.pid = PID;
  98         sec_filter.filter.filter[0] = 62;
  99         sec_filter.filter.mask[0] = 0xff;
 100         sec_filter.flags = DMX_IMMEDIATE_START;
 101         sec_filter.flags |= DMX_CHECK_CRC;
 102
 103         handle.protocol().setSectionFilter( &sec_filter );
 104
 105         senf::Scheduler::instance().add(
 106             handle, senf::membind(&MySniffer::dumpSection, this));
 107     }
 108
 109 private:
 110     void dumpSection(senf::FileHandle /* ignored */, senf::Scheduler::EventId event)
 111     {
 112         std::string data (handle.read());
 113         senf::DatagramSection section (senf::DatagramSection::create(data));
 114         section.dump(std::cout);
 115         senf::PacketData & datagramData (section.last().data());
 116         hexdump(datagramData.begin(), datagramData.end(), std::cout);
 117     }
 118 };
 119
 120 int main(int argc, char const * argv[])
 121 {
 122     try {
 123         MySniffer sniffer;
 124         senf::Scheduler::instance().process();
 125     }
 126     catch (std::exception const & ex) {
 127         std::cerr << senf::prettyName(typeid(ex)) << ": " << ex.what() << "\n";
 128     }
 129     return 0;
 130 }
 131
 132
 133 ///////////////////////////////cc.e////////////////////////////////////////
 134 #undef prefix_
 135
 136 \f
 137 // Local Variables:
 138 // mode: c++
 139 // fill-column: 100
 140 // c-file-style: "senf"
 141 // indent-tabs-mode: nil
 142 // ispell-local-dictionary: "american"
 143 // compile-command: "scons -u test"
 144 // comment-column: 40
 145 // End: