lib/dvb/demux.cpp

   1 #include <config.h>
   2 #include <stdio.h>
   3 #include <fcntl.h>
   4 #include <sys/ioctl.h>
   5 #include <errno.h>
   6 #include <unistd.h>
   7 #include <signal.h>
   8
   9
  10 #if HAVE_DVB_API_VERSION < 3
  11 #include <ost/dmx.h>
  12 #ifndef DMX_SET_NEGFILTER_MASK
  13         #define DMX_SET_NEGFILTER_MASK   _IOW('o',48,uint8_t *)
  14 #endif
  15 #else
  16 #include <linux/dvb/dmx.h>
  17 #endif
  18
  19 #include "crc32.h"
  20
  21 #include <lib/base/eerror.h>
  22 #include <lib/base/filepush.h>
  23 #include <lib/dvb/idvb.h>
  24 #include <lib/dvb/demux.h>
  25 #include <lib/dvb/esection.h>
  26 #include <lib/dvb/decoder.h>
  27
  28 eDVBDemux::eDVBDemux(int adapter, int demux): adapter(adapter), demux(demux)
  29 {
  30         m_dvr_busy = 0;
  31 }
  32
  33 eDVBDemux::~eDVBDemux()
  34 {
  35 }
  36
  37 DEFINE_REF(eDVBDemux)
  38
  39 RESULT eDVBDemux::createSectionReader(eMainloop *context, ePtr<iDVBSectionReader> &reader)
  40 {
  41         RESULT res;
  42         reader = new eDVBSectionReader(this, context, res);
  43         if (res)
  44                 reader = 0;
  45         return res;
  46 }
  47
  48 RESULT eDVBDemux::createTSRecorder(ePtr<iDVBTSRecorder> &recorder)
  49 {
  50         if (m_dvr_busy)
  51                 return -EBUSY;
  52         recorder = new eDVBTSRecorder(this);
  53         return 0;
  54 }
  55
  56 RESULT eDVBDemux::getMPEGDecoder(ePtr<iTSMPEGDecoder> &decoder)
  57 {
  58         decoder = new eTSMPEGDecoder(this, 0);
  59         return 0;
  60 }
  61
  62 RESULT eDVBDemux::getSTC(pts_t &pts)
  63 {
  64         char filename[128];
  65 #if HAVE_DVB_API_VERSION < 3
  66         sprintf(filename, "/dev/dvb/card%d/demux%d", adapter, demux);
  67 #else
  68         sprintf(filename, "/dev/dvb/adapter%d/demux%d", adapter, demux);
  69 #endif
  70         int fd = ::open(filename, O_RDWR);
  71
  72         if (fd < 0)
  73                 return -ENODEV;
  74
  75         struct dmx_stc stc;
  76         stc.num = 0;
  77         stc.base = 1;
  78
  79         if (ioctl(fd, DMX_GET_STC, &stc) < 0)
  80         {
  81                 ::close(fd);
  82                 return -1;
  83         }
  84
  85         pts = stc.stc;
  86         eDebug("got demux stc: %08llx", pts);
  87
  88         ::close(fd);
  89
  90         return 0;
  91 }
  92
  93
  94 void eDVBSectionReader::data(int)
  95 {
  96         __u8 data[4096]; // max. section size
  97         int r;
  98         r = ::read(fd, data, 4096);
  99         if(r < 0)
 100         {
 101                 eWarning("ERROR reading section - %m\n");
 102                 return;
 103         }
 104         if (checkcrc)
 105         {
 106                         // this check should never happen unless the driver is crappy!
 107                 unsigned int c;
 108                 if ((c = crc32((unsigned)-1, data, r)))
 109                 {
 110                         eDebug("crc32 failed! is %x\n", c);
 111                         return;
 112                 }
 113         }
 114         if (active)
 115                 read(data);
 116         else
 117                 eDebug("data.. but not active");
 118 }
 119
 120 eDVBSectionReader::eDVBSectionReader(eDVBDemux *demux, eMainloop *context, RESULT &res): demux(demux)
 121 {
 122         char filename[128];
 123 #if HAVE_DVB_API_VERSION < 3
 124         sprintf(filename, "/dev/dvb/card%d/demux%d", demux->adapter, demux->demux);
 125 #else
 126         sprintf(filename, "/dev/dvb/adapter%d/demux%d", demux->adapter, demux->demux);
 127 #endif
 128         fd = ::open(filename, O_RDWR);
 129
 130         eDebug("eDVBSectionReader has fd %d", fd);
 131
 132         if (fd >= 0)
 133         {
 134                 notifier=new eSocketNotifier(context, fd, eSocketNotifier::Read);
 135                 CONNECT(notifier->activated, eDVBSectionReader::data);
 136                 res = 0;
 137         } else
 138         {
 139                 perror(filename);
 140                 res = errno;
 141         }
 142 }
 143
 144 DEFINE_REF(eDVBSectionReader)
 145
 146 eDVBSectionReader::~eDVBSectionReader()
 147 {
 148         if (notifier)
 149                 delete notifier;
 150         if (fd >= 0)
 151                 ::close(fd);
 152 }
 153
 154 RESULT eDVBSectionReader::start(const eDVBSectionFilterMask &mask)
 155 {
 156         RESULT res;
 157         if (fd < 0)
 158                 return -ENODEV;
 159
 160 #if HAVE_DVB_API_VERSION < 3
 161         dmxSctFilterParams sct;
 162 #else
 163         dmx_sct_filter_params sct;
 164 #endif
 165         sct.pid     = mask.pid;
 166         sct.timeout = 0;
 167 #if HAVE_DVB_API_VERSION < 3
 168         sct.flags   = 0;
 169 #else
 170         sct.flags   = DMX_IMMEDIATE_START;
 171 #endif
 172         if (mask.flags & eDVBSectionFilterMask::rfCRC)
 173         {
 174                 sct.flags |= DMX_CHECK_CRC;
 175                 checkcrc = 1;
 176         } else
 177                 checkcrc = 0;
 178
 179         memcpy(sct.filter.filter, mask.data, DMX_FILTER_SIZE);
 180         memcpy(sct.filter.mask, mask.mask, DMX_FILTER_SIZE);
 181 #if HAVE_DVB_API_VERSION >= 3
 182         memcpy(sct.filter.mode, mask.mode, DMX_FILTER_SIZE);
 183 #endif
 184
 185         res = ::ioctl(fd, DMX_SET_FILTER, &sct);
 186         if (!res)
 187         {
 188 #if HAVE_DVB_API_VERSION < 3
 189                 res = ::ioctl(fd, DMX_SET_NEGFILTER_MASK, mask.mode);
 190                 if (!res)
 191                 {
 192                         res = ::ioctl(fd, DMX_START, 0);
 193                         if (!res)
 194                                 active = 1;
 195                 }
 196 #else
 197                 active = 1;
 198 #endif
 199         }
 200         return res;
 201 }
 202
 203 RESULT eDVBSectionReader::stop()
 204 {
 205         if (!active)
 206                 return -1;
 207
 208         active=0;
 209         ::ioctl(fd, DMX_STOP);
 210
 211         return 0;
 212 }
 213
 214 RESULT eDVBSectionReader::connectRead(const Slot1<void,const __u8*> &r, ePtr<eConnection> &conn)
 215 {
 216         conn = new eConnection(this, read.connect(r));
 217         return 0;
 218 }
 219
 220 DEFINE_REF(eDVBTSRecorder);
 221
 222 eDVBTSRecorder::eDVBTSRecorder(eDVBDemux *demux): m_demux(demux)
 223 {
 224         m_running = 0;
 225         m_format = 0;
 226         m_target_fd = -1;
 227         m_thread = new eFilePushThread();
 228         m_demux->m_dvr_busy = 1;
 229 }
 230
 231 eDVBTSRecorder::~eDVBTSRecorder()
 232 {
 233         stop();
 234         delete m_thread;
 235         m_demux->m_dvr_busy = 0;
 236 }
 237
 238 RESULT eDVBTSRecorder::start()
 239 {
 240         if (m_running)
 241                 return -1;
 242
 243         if (m_target_fd == -1)
 244                 return -2;
 245
 246         char filename[128];
 247 #if HAVE_DVB_API_VERSION < 3
 248         snprintf(filename, 128, "/dev/dvb/card%d/dvr%d", m_demux->adapter, m_demux->demux);
 249 #else
 250         snprintf(filename, 128, "/dev/dvb/adapter%d/dvr%d", m_demux->adapter, m_demux->demux);
 251 #endif
 252         m_source_fd = ::open(filename, O_RDONLY);
 253
 254         if (m_source_fd < 0)
 255         {
 256                 eDebug("FAILED to open dvr (%s) in ts recoder (%m)", filename);
 257                 return -3;
 258         }
 259
 260         m_thread->start(m_source_fd, m_target_fd);
 261         m_running = 1;
 262
 263         for (std::map<int,int>::iterator i(m_pids.begin()); i != m_pids.end(); ++i)
 264                 startPID(i->first);
 265
 266         return 0;
 267 }
 268
 269 RESULT eDVBTSRecorder::addPID(int pid)
 270 {
 271         if (m_pids.find(pid) != m_pids.end())
 272                 return -1;
 273
 274         m_pids.insert(std::pair<int,int>(pid, -1));
 275         if (m_running)
 276                 startPID(pid);
 277         return 0;
 278 }
 279
 280 RESULT eDVBTSRecorder::removePID(int pid)
 281 {
 282         if (m_pids.find(pid) == m_pids.end())
 283                 return -1;
 284
 285         if (m_running)
 286                 stopPID(pid);
 287
 288         m_pids.erase(pid);
 289         return 0;
 290 }
 291
 292 RESULT eDVBTSRecorder::setFormat(int format)
 293 {
 294         if (m_running)
 295                 return -1;
 296         m_format = format;
 297         return 0;
 298 }
 299
 300 RESULT eDVBTSRecorder::setTargetFD(int fd)
 301 {
 302         m_target_fd = fd;
 303         return 0;
 304 }
 305
 306 RESULT eDVBTSRecorder::setBoundary(off_t max)
 307 {
 308         return -1; // not yet implemented
 309 }
 310
 311 RESULT eDVBTSRecorder::stop()
 312 {
 313         for (std::map<int,int>::iterator i(m_pids.begin()); i != m_pids.end(); ++i)
 314                 stopPID(i->first);
 315
 316         if (!m_running)
 317                 return -1;
 318         m_thread->stop();
 319
 320         close(m_source_fd);
 321
 322         return 0;
 323 }
 324
 325 RESULT eDVBTSRecorder::connectEvent(const Slot1<void,int> &event, ePtr<eConnection> &conn)
 326 {
 327         conn = new eConnection(this, m_event.connect(event));
 328         return 0;
 329 }
 330
 331 RESULT eDVBTSRecorder::startPID(int pid)
 332 {
 333         char filename[128];
 334 #if HAVE_DVB_API_VERSION < 3
 335         snprintf(filename, 128, "/dev/dvb/card%d/demux%d", m_demux->adapter, m_demux->demux);
 336 #else
 337         snprintf(filename, 128, "/dev/dvb/adapter%d/demux%d", m_demux->adapter, m_demux->demux);
 338 #endif
 339         int fd = ::open(filename, O_RDWR);
 340         if (fd < 0)
 341         {
 342                 eDebug("FAILED to open demux (%s) in ts recoder (%m)", filename);
 343                 return -1;
 344         }
 345
 346 #if HAVE_DVB_API_VERSION < 3
 347         dmxPesFilterParams flt;
 348
 349         flt.pesType = DMX_PES_OTHER;
 350 #else
 351         dmx_pes_filter_params flt;
 352
 353         flt.pes_type = DMX_PES_OTHER;
 354 #endif
 355
 356         flt.pid     = pid;
 357         flt.input   = DMX_IN_FRONTEND;
 358         flt.output  = DMX_OUT_TS_TAP;
 359
 360         flt.flags   = DMX_IMMEDIATE_START;
 361
 362         int res = ::ioctl(fd, DMX_SET_PES_FILTER, &flt);
 363         if (res < 0)
 364         {
 365                 eDebug("set pes filter failed!");
 366                 ::close(fd);
 367                 return -1;
 368         }
 369         m_pids[pid] = fd;
 370
 371         return 0;
 372 }
 373
 374 void eDVBTSRecorder::stopPID(int pid)
 375 {
 376         ::close(m_pids[pid]);
 377         m_pids[pid] = -1;
 378 }