/* * cDemux implementation for SH4 receivers (tested on fulan spark and * fulan spark7162 hardware) * * derived from libtriple/dmx_td.cpp * * (C) 2010-2013 Stefan Seyfried * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program. If not, see . */ /* * Theory of operation (or "why is this dmx_source thing so strange and * what is the _open() good for?") * * the sh4 pti driver, driving the /dev/dvb/adapter0/dmxN devices, can * apparently only map one input to on demux device at a time, so e.g. * DMX_SOURCE_FRONT1 -> demux0 * DMX_SOURCE_FRONT2 -> demux0 * DMX_SOURCE_FRONT1 -> demux1 * does not work. The driver makes sure that a one-to-one mapping of * DMX_SOURCE_FRONTn to demuxM is maintained, and it does by e.g changing * the default of * FRONT0 -> demux0 * FRONT1 -> demux1 * FRONT2 -> demux2 * to * FRONT1 -> demux0 * FRONT0 -> demux1 * FRONT2 -> demux2 * if you do a DMX_SET_SOURCE(FRONT1) ioctl on demux0. * This means, it also changes demux1's source on the SET_SOURCE ioctl on * demux0, potentially disturbing any operation on demux1 (e.g. recording). * * In order to avoid this, I do not change the source->demuxdev mapping * but instead just always use the demux device that is attached to the * correct source. * * The tricky part is, that the source might actually be changed after * Open() has been called, so Open() gets a dummy placeholder that just * sets some variables while the real device open is put into _open(). * _open() gets called later, whenever the device is actually used or * configured and -- if the source has changed -- closes the old and * opens the correct new device node. */ #include #include #include #include #include #include #include #include #include #include "dmx_lib.h" #include "lt_debug.h" /* Ugh... see comment in destructor for details... */ #include "video_lib.h" extern cVideo *videoDecoder; extern cVideo *pipDecoder; #define lt_debug(args...) _lt_debug(TRIPLE_DEBUG_DEMUX, this, args) #define lt_info(args...) _lt_info(TRIPLE_DEBUG_DEMUX, this, args) #define lt_info_c(args...) _lt_info(TRIPLE_DEBUG_DEMUX, NULL, args) #define dmx_err(_errfmt, _errstr, _revents) do { \ uint16_t _pid = (uint16_t)-1; uint16_t _f = 0;\ if (dmx_type == DMX_PSI_CHANNEL) { \ _pid = s_flt.pid; _f = s_flt.filter.filter[0]; \ } else { \ _pid = p_flt.pid; \ }; \ lt_info("%s " _errfmt " fd:%d, ev:0x%x %s pid:0x%04hx flt:0x%02hx\n", \ __func__, _errstr, fd, _revents, DMX_T[dmx_type], _pid, _f); \ } while(0); cDemux *videoDemux = NULL; cDemux *audioDemux = NULL; //cDemux *pcrDemux = NULL; cDemux *pipDemux = NULL; static const char *DMX_T[] = { "DMX_INVALID", "DMX_VIDEO", "DMX_AUDIO", "DMX_PES", "DMX_PSI", "DMX_PIP", "DMX_TP", "DMX_PCR" }; /* this is the number of different cDemux() units, not the number of * /dev/dvb/.../demuxX devices! */ #define NUM_DEMUX 4 /* the current source of each cDemux unit */ static int dmx_source[NUM_DEMUX] = { 0, 0, 0, 0 }; /* map the device numbers. */ #define NUM_DEMUXDEV 3 static const char *devname[NUM_DEMUXDEV] = { "/dev/dvb/adapter0/demux0", "/dev/dvb/adapter0/demux1", "/dev/dvb/adapter0/demux2" }; /* did we already DMX_SET_SOURCE on that demux device? */ static bool init[NUM_DEMUXDEV] = { false, false, false }; /* uuuugly */ static int dmx_tp_count = 0; #define MAX_TS_COUNT 1 cDemux::cDemux(int n) { if (n < 0 || n >= NUM_DEMUX) { lt_info("%s ERROR: n invalid (%d)\n", __FUNCTION__, n); num = 0; } else num = n; fd = -1; measure = false; last_measure = 0; last_data = 0; last_source = -1; } cDemux::~cDemux() { lt_debug("%s #%d fd: %d\n", __FUNCTION__, num, fd); Close(); /* in zapit.cpp, videoDemux is deleted after videoDecoder * in the video watchdog, we access videoDecoder * the thread still runs after videoDecoder has been deleted * => set videoDecoder to NULL here to make the check in the * watchdog thread pick this up. * This is ugly, but it saves me from changing neutrino * * if the delete order in neutrino will ever be changed, this * will blow up badly :-( */ if (dmx_type == DMX_VIDEO_CHANNEL) videoDecoder = NULL; if (dmx_type == DMX_PIP_CHANNEL) pipDecoder = NULL; } bool cDemux::Open(DMX_CHANNEL_TYPE pes_type, void * /*hVideoBuffer*/, int uBufferSize) { if (fd > -1) lt_info("%s FD ALREADY OPENED? fd = %d\n", __FUNCTION__, fd); dmx_type = pes_type; buffersize = uBufferSize; /* return code is unchecked anyway... */ return true; } bool cDemux::_open(void) { int flags = O_RDWR|O_CLOEXEC; int devnum = dmx_source[num]; if (last_source == devnum) { lt_debug("%s #%d: source (%d) did not change\n", __func__, num, last_source); if (fd > -1) return true; } if (fd > -1) { /* we changed source -> close and reopen the fd */ lt_debug("%s #%d: FD ALREADY OPENED fd = %d lastsource %d devnum %d\n", __func__, num, fd, last_source, devnum); close(fd); } if (dmx_type != DMX_PSI_CHANNEL) flags |= O_NONBLOCK; fd = open(devname[devnum], flags); if (fd < 0) { lt_info("%s %s: %m\n", __FUNCTION__, devname[devnum]); return false; } lt_debug("%s #%d pes_type: %s(%d), uBufferSize: %d fd: %d\n", __func__, num, DMX_T[dmx_type], dmx_type, buffersize, fd); /* this would actually need locking, but the worst that weill happen is, that * we'll DMX_SET_SOURCE twice per device, so don't bother... */ if (!init[devnum]) { /* this should not change anything... */ int n = DMX_SOURCE_FRONT0 + devnum; lt_info("%s: setting %s to source %d\n", __func__, devname[devnum], n); if (ioctl(fd, DMX_SET_SOURCE, &n) < 0) lt_info("%s DMX_SET_SOURCE failed!\n", __func__); else init[devnum] = true; } if (buffersize == 0) buffersize = 0xffff; // may or may not be reasonable --martii if (buffersize > 0) { /* probably uBufferSize == 0 means "use default size". TODO: find a reasonable default */ if (ioctl(fd, DMX_SET_BUFFER_SIZE, buffersize) < 0) lt_info("%s DMX_SET_BUFFER_SIZE failed (%m)\n", __func__); } last_source = devnum; return true; } void cDemux::Close(void) { lt_debug("%s #%d, fd = %d\n", __FUNCTION__, num, fd); if (fd < 0) { lt_info("%s #%d: not open!\n", __FUNCTION__, num); return; } pesfds.clear(); ioctl(fd, DMX_STOP); close(fd); fd = -1; if (measure) return; if (dmx_type == DMX_TP_CHANNEL) { dmx_tp_count--; if (dmx_tp_count < 0) { lt_info("%s dmx_tp_count < 0!!\n", __func__); dmx_tp_count = 0; } } } bool cDemux::Start(bool) { if (fd < 0) { lt_info("%s #%d: not open!\n", __FUNCTION__, num); return false; } ioctl(fd, DMX_START); return true; } bool cDemux::Stop(void) { if (fd < 0) { lt_info("%s #%d: not open!\n", __FUNCTION__, num); return false; } ioctl(fd, DMX_STOP); return true; } int cDemux::Read(unsigned char *buff, int len, int timeout) { #if 0 if (len != 4095 && timeout != 10) fprintf(stderr, "cDemux::%s #%d fd: %d type: %s len: %d timeout: %d\n", __FUNCTION__, num, fd, DMX_T[dmx_type], len, timeout); #endif if (fd < 0) { lt_info("%s #%d: not open!\n", __func__, num); return -1; } int rc; int to = timeout; struct pollfd ufds; ufds.fd = fd; ufds.events = POLLIN|POLLPRI|POLLERR; ufds.revents = 0; /* hack: if the frontend loses and regains lock, the demuxer often will not * return from read(), so as a "emergency exit" for e.g. NIT scan, set a (long) * timeout here */ if (dmx_type == DMX_PSI_CHANNEL && timeout <= 0) to = 60 * 1000; if (to > 0) { retry: rc = ::poll(&ufds, 1, to); if (!rc) { if (timeout == 0) /* we took the emergency exit */ { dmx_err("timed out for timeout=0!, %s", "", 0); return -1; /* this timeout is an error */ } return 0; // timeout } else if (rc < 0) { dmx_err("poll: %s,", strerror(errno), 0) //lt_info("%s poll: %m\n", __FUNCTION__); /* happens, when running under gdb... */ if (errno == EINTR) goto retry; return -1; } #if 0 if (ufds.revents & POLLERR) /* POLLERR means buffer error, i.e. buffer overflow */ { dmx_err("received %s,", "POLLERR", ufds.revents); /* this seems to happen sometimes at recording start, without bad effects */ return 0; } #endif if (ufds.revents & POLLHUP) /* we get POLLHUP if e.g. a too big DMX_BUFFER_SIZE was set */ { dmx_err("received %s,", "POLLHUP", ufds.revents); return -1; } if (!(ufds.revents & POLLIN)) /* we requested POLLIN but did not get it? */ { dmx_err("received %s, please report!", "POLLIN", ufds.revents); return 0; } } rc = ::read(fd, buff, len); //fprintf(stderr, "fd %d ret: %d\n", fd, rc); if (rc < 0) dmx_err("read: %s", strerror(errno), 0); return rc; } bool cDemux::sectionFilter(unsigned short pid, const unsigned char * const filter, const unsigned char * const mask, int len, int timeout, const unsigned char * const negmask) { memset(&s_flt, 0, sizeof(s_flt)); _open(); if (len > DMX_FILTER_SIZE) { lt_info("%s #%d: len too long: %d, DMX_FILTER_SIZE %d\n", __func__, num, len, DMX_FILTER_SIZE); len = DMX_FILTER_SIZE; } s_flt.pid = pid; s_flt.timeout = timeout; memcpy(s_flt.filter.filter, filter, len); memcpy(s_flt.filter.mask, mask, len); if (negmask != NULL) memcpy(s_flt.filter.mode, negmask, len); s_flt.flags = DMX_IMMEDIATE_START|DMX_CHECK_CRC; int to = 0; switch (filter[0]) { case 0x00: /* program_association_section */ to = 2000; break; case 0x01: /* conditional_access_section */ to = 6000; break; case 0x02: /* program_map_section */ to = 1500; break; case 0x03: /* transport_stream_description_section */ to = 10000; break; /* 0x04 - 0x3F: reserved */ case 0x40: /* network_information_section - actual_network */ to = 10000; break; case 0x41: /* network_information_section - other_network */ to = 15000; break; case 0x42: /* service_description_section - actual_transport_stream */ to = 10000; break; /* 0x43 - 0x45: reserved for future use */ case 0x46: /* service_description_section - other_transport_stream */ to = 10000; break; /* 0x47 - 0x49: reserved for future use */ case 0x4A: /* bouquet_association_section */ to = 11000; break; /* 0x4B - 0x4D: reserved for future use */ case 0x4E: /* event_information_section - actual_transport_stream, present/following */ to = 2000; break; case 0x4F: /* event_information_section - other_transport_stream, present/following */ to = 10000; break; /* 0x50 - 0x5F: event_information_section - actual_transport_stream, schedule */ /* 0x60 - 0x6F: event_information_section - other_transport_stream, schedule */ case 0x70: /* time_date_section */ s_flt.flags &= ~DMX_CHECK_CRC; /* section has no CRC */ s_flt.flags |= DMX_ONESHOT; //s_flt.pid = 0x0014; to = 30000; break; case 0x71: /* running_status_section */ s_flt.flags &= ~DMX_CHECK_CRC; /* section has no CRC */ to = 0; break; case 0x72: /* stuffing_section */ s_flt.flags &= ~DMX_CHECK_CRC; /* section has no CRC */ to = 0; break; case 0x73: /* time_offset_section */ s_flt.flags |= DMX_ONESHOT; //s_flt.pid = 0x0014; to = 30000; break; /* 0x74 - 0x7D: reserved for future use */ case 0x7E: /* discontinuity_information_section */ s_flt.flags &= ~DMX_CHECK_CRC; /* section has no CRC */ to = 0; break; case 0x7F: /* selection_information_section */ to = 0; break; /* 0x80 - 0x8F: ca_message_section */ /* 0x90 - 0xFE: user defined */ /* 0xFF: reserved */ default: break; // return -1; } /* the negmask == NULL is a hack: the users of negmask are PMT-update * and sectionsd EIT-Version change. And they really want no timeout * if timeout == 0 instead of "default timeout" */ if (timeout == 0 && negmask == NULL) s_flt.timeout = to; lt_debug("%s #%d pid:0x%04hx fd:%d type:%s len:%d to:%d flags:%x flt[0]:%02x\n", __func__, num, pid, fd, DMX_T[dmx_type], len, s_flt.timeout,s_flt.flags, s_flt.filter.filter[0]); #if 0 fprintf(stderr,"filt: ");for(int i=0;i= 0x0002 && pid <= 0x000f) || pid >= 0x1fff) return false; lt_debug("%s #%d pid: 0x%04hx fd: %d type: %s\n", __FUNCTION__, num, pid, fd, DMX_T[dmx_type]); _open(); memset(&p_flt, 0, sizeof(p_flt)); p_flt.pid = pid; p_flt.output = DMX_OUT_DECODER; p_flt.input = DMX_IN_FRONTEND; p_flt.flags = DMX_IMMEDIATE_START; switch (dmx_type) { case DMX_PCR_ONLY_CHANNEL: p_flt.pes_type = DMX_PES_PCR; break; case DMX_AUDIO_CHANNEL: p_flt.pes_type = DMX_PES_AUDIO; break; case DMX_VIDEO_CHANNEL: p_flt.pes_type = DMX_PES_VIDEO; break; case DMX_PES_CHANNEL: p_flt.pes_type = DMX_PES_OTHER; p_flt.output = DMX_OUT_TAP; break; case DMX_TP_CHANNEL: p_flt.pes_type = DMX_PES_OTHER; p_flt.output = DMX_OUT_TSDEMUX_TAP; break; case DMX_PIP_CHANNEL: p_flt.pes_type = DMX_PES_VIDEO1; break; default: lt_info("%s #%d invalid dmx_type %d!\n", __func__, num, dmx_type); return false; } return (ioctl(fd, DMX_SET_PES_FILTER, &p_flt) >= 0); } void cDemux::SetSyncMode(AVSYNC_TYPE /*mode*/) { lt_debug("%s #%d\n", __FUNCTION__, num); } void *cDemux::getBuffer() { lt_debug("%s #%d\n", __FUNCTION__, num); return NULL; } void *cDemux::getChannel() { lt_debug("%s #%d\n", __FUNCTION__, num); return NULL; } bool cDemux::addPid(unsigned short Pid) { lt_debug("%s: pid 0x%04hx\n", __func__, Pid); pes_pids pfd; int ret; if (dmx_type != DMX_TP_CHANNEL) { lt_info("%s pes_type %s not implemented yet! pid=%hx\n", __FUNCTION__, DMX_T[dmx_type], Pid); return false; } _open(); if (fd == -1) lt_info("%s bucketfd not yet opened? pid=%hx\n", __FUNCTION__, Pid); pfd.fd = fd; /* dummy */ pfd.pid = Pid; pesfds.push_back(pfd); ret = (ioctl(fd, DMX_ADD_PID, &Pid)); if (ret < 0) lt_info("%s: DMX_ADD_PID (%m)\n", __func__); return (ret != -1); } void cDemux::removePid(unsigned short Pid) { if (dmx_type != DMX_TP_CHANNEL) { lt_info("%s pes_type %s not implemented yet! pid=%hx\n", __FUNCTION__, DMX_T[dmx_type], Pid); return; } for (std::vector::iterator i = pesfds.begin(); i != pesfds.end(); ++i) { if ((*i).pid == Pid) { lt_debug("removePid: removing demux fd %d pid 0x%04x\n", fd, Pid); if (ioctl(fd, DMX_REMOVE_PID, Pid) < 0) lt_info("%s: (DMX_REMOVE_PID, 0x%04hx): %m\n", __func__, Pid); pesfds.erase(i); return; /* TODO: what if the same PID is there multiple times */ } } lt_info("%s pid 0x%04x not found\n", __FUNCTION__, Pid); } void cDemux::getSTC(int64_t * STC) { /* apparently I can only get the PTS of the video decoder, * but that's good enough for dvbsub */ lt_debug("%s #%d\n", __func__, num); int64_t pts = 0; if (videoDecoder) pts = videoDecoder->GetPTS(); *STC = pts; } int cDemux::getUnit(void) { lt_debug("%s #%d\n", __FUNCTION__, num); /* just guessed that this is the right thing to do. right now this is only used by the CA code which is stubbed out anyway */ return num; } bool cDemux::SetSource(int unit, int source) { if (unit >= NUM_DEMUX || unit < 0) { lt_info_c("%s: unit (%d) out of range, NUM_DEMUX %d\n", __func__, unit, NUM_DEMUX); return false; } lt_info_c("%s(%d, %d) => %d to %d\n", __func__, unit, source, dmx_source[unit], source); if (source < 0 || source >= NUM_DEMUXDEV) lt_info_c("%s(%d, %d) ERROR: source %d out of range!\n", __func__, unit, source, source); else dmx_source[unit] = source; return true; } int cDemux::GetSource(int unit) { if (unit >= NUM_DEMUX || unit < 0) { lt_info_c("%s: unit (%d) out of range, NUM_DEMUX %d\n", __func__, unit, NUM_DEMUX); return -1; } lt_info_c("%s(%d) => %d\n", __func__, unit, dmx_source[unit]); return dmx_source[unit]; }