300add41c42e638d35dca22308ced1b77ec8b3b2
[enigma2.git] / lib / dvb / pmt.cpp
1 #include <lib/base/eerror.h>
2 #include <lib/dvb/pmt.h>
3 #include <lib/dvb/specs.h>
4 #include <lib/dvb/dvb.h>
5 #include <lib/dvb/metaparser.h>
6 #include <lib/dvb_ci/dvbci.h>
7 #include <dvbsi++/ca_program_map_section.h>
8 #include <dvbsi++/descriptor_tag.h>
9 #include <dvbsi++/iso639_language_descriptor.h>
10 #include <dvbsi++/component_descriptor.h>
11
12 eDVBServicePMTHandler::eDVBServicePMTHandler(int record)
13         :m_ca_servicePtr(0)
14 {
15         m_record = record;
16         eDVBResourceManager::getInstance(m_resourceManager);
17         CONNECT(m_PMT.tableReady, eDVBServicePMTHandler::PMTready);
18         CONNECT(m_PAT.tableReady, eDVBServicePMTHandler::PATready);
19         eDebug("new PMT handler record: %d", m_record);
20 }
21
22 eDVBServicePMTHandler::~eDVBServicePMTHandler()
23 {
24         eDebug("delete PMT handler record: %d", m_record);
25         if (m_ca_servicePtr)
26         {
27                 eDebug("unregister caservice");
28                 uint8_t demux_num;
29                 m_demux->getCADemuxID(demux_num);
30                 ePtr<eTable<ProgramMapSection> > ptr;
31                 m_PMT.getCurrent(ptr);
32                 eDVBCAService::unregister_service(m_reference, demux_num, ptr);
33                 eDVBCIInterfaces::getInstance()->removePMTHandler(this);
34         }
35 }
36
37 void eDVBServicePMTHandler::channelStateChanged(iDVBChannel *channel)
38 {
39         int state;
40         channel->getState(state);
41         
42         if ((m_last_channel_state != iDVBChannel::state_ok)
43                 && (state == iDVBChannel::state_ok) && (!m_demux))
44         {
45                 if (m_channel)
46                         if (m_channel->getDemux(m_demux, m_record ? 0 : iDVBChannel::capDecode))
47                                 eDebug("Allocating a demux for now tuned-in channel failed.");
48                 
49                 serviceEvent(eventTuned);
50                 
51                 if (m_demux)
52                 {
53                         eDebug("ok ... now we start!!");
54
55                         m_PAT.begin(eApp, eDVBPATSpec(), m_demux);
56
57                         if ( m_service && !m_service->cacheEmpty() )
58                                 serviceEvent(eventNewProgramInfo);
59                 }
60         } else if ((m_last_channel_state != iDVBChannel::state_failed) && 
61                         (state == iDVBChannel::state_failed))
62         {
63                 eDebug("tune failed.");
64                 serviceEvent(eventTuneFailed);
65         }
66 }
67
68 void eDVBServicePMTHandler::PMTready(int error)
69 {
70         if (error)
71                 serviceEvent(eventNoPMT);
72         else
73         {
74                 serviceEvent(eventNewProgramInfo);
75                 if (!m_pvr_channel)
76                 {
77                         if(!m_ca_servicePtr)   // don't send campmt to camd.socket for playbacked services
78                         {
79                                 uint8_t demux_num;
80                                 m_demux->getCADemuxID(demux_num);
81                                 eDVBCAService::register_service(m_reference, demux_num, m_ca_servicePtr);
82                                 eDVBCIInterfaces::getInstance()->addPMTHandler(this);
83                         }
84                         eDVBCIInterfaces::getInstance()->gotPMT(this);
85                 }
86                 if (m_ca_servicePtr)
87                 {
88                         ePtr<eTable<ProgramMapSection> > ptr;
89                         if (!m_PMT.getCurrent(ptr))
90                                 m_ca_servicePtr->buildCAPMT(ptr);
91                         else
92                                 eDebug("eDVBServicePMTHandler cannot call buildCAPMT");
93                 }
94         }
95 }
96
97 void eDVBServicePMTHandler::PATready(int)
98 {
99         eDebug("got PAT");
100         ePtr<eTable<ProgramAssociationSection> > ptr;
101         if (!m_PAT.getCurrent(ptr))
102         {
103                 int pmtpid = -1;
104                 std::vector<ProgramAssociationSection*>::const_iterator i;
105                 for (i = ptr->getSections().begin(); i != ptr->getSections().end(); ++i)
106                 {
107                         const ProgramAssociationSection &pat = **i;
108                         ProgramAssociationConstIterator program;
109                         for (program = pat.getPrograms()->begin(); program != pat.getPrograms()->end(); ++program)
110                                 if (eServiceID((*program)->getProgramNumber()) == m_reference.getServiceID())
111                                         pmtpid = (*program)->getProgramMapPid();
112                 }
113                 if (pmtpid == -1)
114                         serviceEvent(eventNoPATEntry);
115                 else
116                         m_PMT.begin(eApp, eDVBPMTSpec(pmtpid, m_reference.getServiceID().get()), m_demux);
117         } else
118                 serviceEvent(eventNoPAT);
119 }
120
121 int eDVBServicePMTHandler::getProgramInfo(struct program &program)
122 {
123         ePtr<eTable<ProgramMapSection> > ptr;
124
125         program.videoStreams.clear();
126         program.audioStreams.clear();
127         program.pcrPid = -1;
128
129         if (!m_PMT.getCurrent(ptr))
130         {
131                 eDVBTableSpec table_spec;
132                 ptr->getSpec(table_spec);
133                 program.pmtPid = table_spec.pid < 0x1fff ? table_spec.pid : -1;
134                 std::vector<ProgramMapSection*>::const_iterator i;
135                 for (i = ptr->getSections().begin(); i != ptr->getSections().end(); ++i)
136                 {
137                         const ProgramMapSection &pmt = **i;
138                         program.pcrPid = pmt.getPcrPid();
139                         
140                         ElementaryStreamInfoConstIterator es;
141                         for (es = pmt.getEsInfo()->begin(); es != pmt.getEsInfo()->end(); ++es)
142                         {
143                                 int isaudio = 0, isvideo = 0;
144                                 videoStream video;
145                                 audioStream audio;
146                                 
147                                 video.pid = (*es)->getPid();
148                                 audio.pid = (*es)->getPid();
149                                 
150                                 switch ((*es)->getType())
151                                 {
152                                 case 0x01: // MPEG 1 video
153                                 case 0x02: // MPEG 2 video
154                                         isvideo = 1;
155                                         break;
156                                 case 0x03: // MPEG 1 audio
157                                 case 0x04: // MPEG 2 audio:
158                                         isaudio = 1;
159                                         audio.type = audioStream::atMPEG;
160                                         break;
161                                 case 0x06: // PES Private
162                                                 /* PES private can contain AC-3, DTS or lots of other stuff.
163                                                    check descriptors to get the exact type. */
164                                         for (DescriptorConstIterator desc = (*es)->getDescriptors()->begin();
165                                                         desc != (*es)->getDescriptors()->end(); ++desc)
166                                         {
167                                                 switch ((*desc)->getTag())
168                                                 {
169                                                 case AC3_DESCRIPTOR:
170                                                         isaudio = 1;
171                                                         audio.type = audioStream::atAC3;
172                                                         break;
173                                                 }
174                                         }
175                                         break;
176                                 }
177                                 if (isaudio)
178                                 {
179                                         for (DescriptorConstIterator desc = (*es)->getDescriptors()->begin();
180                                                         desc != (*es)->getDescriptors()->end(); ++desc)
181                                         {
182                                                 switch ((*desc)->getTag())
183                                                 {
184                                                 case ISO_639_LANGUAGE_DESCRIPTOR:
185                                                 {
186                                                         const Iso639LanguageList *languages = ((Iso639LanguageDescriptor*)*desc)->getIso639Languages();
187                                                         
188                                                                 /* use last language code */
189                                                         for (Iso639LanguageConstIterator i(languages->begin()); i != languages->end(); ++i)
190                                                                 audio.language_code = (*i)->getIso639LanguageCode();
191
192                                                         break;
193                                                 }
194                                                 case COMPONENT_DESCRIPTOR:
195                                                         audio.component_tag = ((ComponentDescriptor*)*desc)->getComponentTag();
196                                                         break;
197                                                 }
198                                         }
199
200                                         program.audioStreams.push_back(audio);
201                                 }
202                                 if (isvideo)
203                                         program.videoStreams.push_back(video);
204                         }
205                 }
206                 return 0;
207         }
208         else if ( m_service && !m_service->cacheEmpty() )
209         {
210                 int vpid = m_service->getCachePID(eDVBService::cVPID),
211                         apid_ac3 = m_service->getCachePID(eDVBService::cAPID),
212                         apid_mpeg = m_service->getCachePID(eDVBService::cAC3PID),
213                         pcrpid = m_service->getCachePID(eDVBService::cPCRPID),
214                         cnt=0;
215                 if ( vpid != -1 )
216                 {
217                         videoStream s;
218                         s.pid = vpid;
219                         program.videoStreams.push_back(s);
220                         ++cnt;
221                 }
222                 if ( apid_ac3 != -1 )
223                 {
224                         audioStream s;
225                         s.type = audioStream::atAC3;
226                         s.pid = apid_ac3;
227                         program.audioStreams.push_back(s);
228                         ++cnt;
229                 }
230                 if ( apid_mpeg != -1 )
231                 {
232                         audioStream s;
233                         s.type = audioStream::atMPEG;
234                         s.pid = apid_mpeg;
235                         program.audioStreams.push_back(s);
236                         ++cnt;
237                 }
238                 if ( pcrpid != -1 )
239                 {
240                         ++cnt;
241                         program.pcrPid = pcrpid;
242                 }
243                 if ( cnt )
244                         return 0;
245         }
246         return -1;
247 }
248
249 int eDVBServicePMTHandler::getChannel(eUsePtr<iDVBChannel> &channel)
250 {
251         channel = m_channel;
252         if (channel)
253                 return 0;
254         else
255                 return -1;
256 }
257
258 int eDVBServicePMTHandler::getDemux(ePtr<iDVBDemux> &demux)
259 {
260         demux = m_demux;
261         if (demux)
262                 return 0;
263         else
264                 return -1;
265 }
266
267 int eDVBServicePMTHandler::getPVRChannel(ePtr<iDVBPVRChannel> &pvr_channel)
268 {
269         pvr_channel = m_pvr_channel;
270         if (pvr_channel)
271                 return 0;
272         else
273                 return -1;
274 }
275
276 int eDVBServicePMTHandler::tune(eServiceReferenceDVB &ref)
277 {
278         RESULT res;
279         m_reference = ref;
280         
281                 /* is this a normal (non PVR) channel? */
282         if (ref.path.empty())
283         {
284                 eDVBChannelID chid;
285                 ref.getChannelID(chid);
286                 res = m_resourceManager->allocateChannel(chid, m_channel);
287                 eDebug("allocate Channel: res %d", res);
288         } else
289         {
290                 eDVBMetaParser parser;
291                 
292                 if (parser.parseFile(ref.path))
293                         eWarning("no .meta file found, trying original service ref.");
294                 else
295                         m_reference = parser.m_ref;
296                 
297                 eDebug("alloc PVR");
298                         /* allocate PVR */
299                 res = m_resourceManager->allocatePVRChannel(m_pvr_channel);
300                 if (res)
301                         eDebug("allocatePVRChannel failed!\n");
302                 m_channel = m_pvr_channel;
303         }
304         
305         if (m_channel)
306         {
307                 m_channel->connectStateChange(
308                         slot(*this, &eDVBServicePMTHandler::channelStateChanged), 
309                         m_channelStateChanged_connection);
310                 m_last_channel_state = -1;
311                 channelStateChanged(m_channel);
312         } else
313         {
314                 serviceEvent(eventTuneFailed);
315                 return res;
316         }
317
318         if (m_pvr_channel)
319                 m_pvr_channel->playFile(ref.path.c_str());
320
321         ePtr<iDVBChannelList> db;
322         if (!m_resourceManager->getChannelList(db))
323                 db->getService((eServiceReferenceDVB&)m_reference, m_service);
324
325         return res;
326 }
327
328 std::map<eServiceReferenceDVB, eDVBCAService*> eDVBCAService::exist;
329
330 eDVBCAService::eDVBCAService()
331         :m_prev_build_hash(0), m_sendstate(0), m_retryTimer(eApp)
332 {
333         memset(m_used_demux, 0xFF, sizeof(m_used_demux));
334         CONNECT(m_retryTimer.timeout, eDVBCAService::sendCAPMT);
335         Connect();
336 }
337
338 eDVBCAService::~eDVBCAService()
339 {
340         eDebug("[eDVBCAService] free service %s", m_service.toString().c_str());
341         ::close(m_sock);
342 }
343
344 RESULT eDVBCAService::register_service( const eServiceReferenceDVB &ref, int demux_num, eDVBCAService *&caservice )
345 {
346         CAServiceMap::iterator it = exist.find(ref);
347         if ( it != exist.end() )
348                 caservice = it->second;
349         else
350         {
351                 caservice = (exist[ref]=new eDVBCAService());
352                 caservice->m_service = ref;
353                 eDebug("[eDVBCAHandler] new service %s", ref.toString().c_str() );
354         }
355 // search free demux entry
356         int iter=0, max_demux_slots = sizeof(caservice->m_used_demux);
357
358         while ( iter < max_demux_slots && caservice->m_used_demux[iter] != 0xFF )
359                 ++iter;
360
361         if ( iter < max_demux_slots )
362         {
363                 caservice->m_used_demux[iter] = demux_num & 0xFF;
364                 eDebug("[eDVBCAHandler] add demux %d to slot %d service %s", demux_num, iter, ref.toString().c_str());
365         }
366         else
367         {
368                 eDebug("[eDVBCAHandler] no more demux slots free for service %s!!", ref.toString().c_str());
369                 return -1;
370         }
371         return 0;
372 }
373
374 RESULT eDVBCAService::unregister_service( const eServiceReferenceDVB &ref, int demux_num, eTable<ProgramMapSection> *ptr )
375 {
376         CAServiceMap::iterator it = exist.find(ref);
377         if ( it == exist.end() )
378         {
379                 eDebug("[eDVBCAHandler] try to unregister non registered %s", ref.toString().c_str());
380                 return -1;
381         }
382         else
383         {
384                 eDVBCAService *caservice = it->second;
385                 bool freed = false;
386                 int iter = 0,
387                         used_demux_slots = 0,
388                         max_demux_slots = sizeof(caservice->m_used_demux)/sizeof(int);
389                 while ( iter < max_demux_slots )
390                 {
391                         if ( caservice->m_used_demux[iter] != 0xFF )
392                         {
393                                 if ( !freed && caservice->m_used_demux[iter] == demux_num )
394                                 {
395                                         eDebug("[eDVBCAService] free slot %d demux %d for service %s", iter, caservice->m_used_demux[iter], caservice->m_service.toString().c_str() );
396                                         caservice->m_used_demux[iter] = 0xFF;
397                                         freed=true;
398                                 }
399                                 else
400                                         ++used_demux_slots;
401                         }
402                         ++iter;
403                 }
404                 if (!freed)
405                 {
406                         eDebug("[eDVBCAService] couldn't free demux slot for demux %d", demux_num);
407                         return -1;
408                 }
409                 if (!used_demux_slots)  // no more used.. so we remove it
410                 {
411                         delete it->second;
412                         exist.erase(it);
413                 }
414                 else
415                 {
416                         if (ptr)
417                                 it->second->buildCAPMT(ptr);
418                         else
419                                 eDebug("[eDVBCAHandler] can not send updated demux info");
420                 }
421         }
422         return 0;
423 }
424
425 void eDVBCAService::Connect()
426 {
427         memset(&m_servaddr, 0, sizeof(struct sockaddr_un));
428         m_servaddr.sun_family = AF_UNIX;
429         strcpy(m_servaddr.sun_path, "/tmp/camd.socket");
430         m_clilen = sizeof(m_servaddr.sun_family) + strlen(m_servaddr.sun_path);
431         m_sock = socket(PF_UNIX, SOCK_STREAM, 0);
432         connect(m_sock, (struct sockaddr *) &m_servaddr, m_clilen);
433         fcntl(m_sock, F_SETFL, O_NONBLOCK);
434         int val=1;
435         setsockopt(m_sock, SOL_SOCKET, SO_REUSEADDR, &val, 4);
436 }
437
438 void eDVBCAService::buildCAPMT(eTable<ProgramMapSection> *ptr)
439 {
440         if (!ptr)
441                 return;
442
443         eDVBTableSpec table_spec;
444         ptr->getSpec(table_spec);
445
446         int pmtpid = table_spec.pid,
447                 pmt_version = table_spec.version;
448
449         uint8_t demux_mask = 0;
450         uint8_t first_demux_num = 0xFF;
451
452 #if 1
453         int iter=0, max_demux_slots = sizeof(m_used_demux);
454         while ( iter < max_demux_slots )
455         {
456                 if ( m_used_demux[iter] != 0xFF )
457                 {
458                         if ( first_demux_num == 0xFF )
459                                 first_demux_num = m_used_demux[iter];
460                         demux_mask |= (1 << m_used_demux[iter]);
461                 }
462                 ++iter;
463         }
464 #else
465         demux_mask = 3;
466         first_demux_num = 0;
467 #endif
468
469         if ( first_demux_num == 0xFF )
470         {
471                 eDebug("[eDVBCAService] no demux found for service %s", m_service.toString().c_str() );
472                 return;
473         }
474
475         eDebug("demux %d mask %02x prevhash %08x", first_demux_num, demux_mask, m_prev_build_hash);
476
477         unsigned int build_hash = (pmtpid << 16);
478         build_hash |= (demux_mask << 8);
479         build_hash |= (pmt_version&0xFF);
480
481         if ( build_hash == m_prev_build_hash )
482         {
483                 eDebug("[eDVBCAService] don't build/send the same CA PMT twice");
484                 return;
485         }
486
487         std::vector<ProgramMapSection*>::const_iterator i=ptr->getSections().begin();
488         if ( i != ptr->getSections().end() )
489         {
490                 CaProgramMapSection capmt(*i++, m_prev_build_hash ? 0x05 /*update*/ : 0x03 /*only*/, 0x01 );
491
492                 while( i != ptr->getSections().end() )
493                 {
494 //                      eDebug("append");
495                         capmt.append(*i++);
496                 }
497
498                 // add our private descriptors to capmt
499                 uint8_t tmp[10];
500
501                 tmp[0]=0x84;  // pmt pid
502                 tmp[1]=0x02;
503                 tmp[2]=pmtpid>>8;
504                 tmp[3]=pmtpid&0xFF;
505                 capmt.injectDescriptor(tmp, false);
506
507                 tmp[0] = 0x82; // demux
508                 tmp[1] = 0x02;
509                 tmp[2] = demux_mask;    // descramble bitmask
510                 tmp[3] = first_demux_num; // read section data from demux number
511                 capmt.injectDescriptor(tmp, false);
512
513                 tmp[0] = 0x81; // dvbnamespace
514                 tmp[1] = 0x08;
515                 tmp[2] = m_service.getDVBNamespace().get()>>24;
516                 tmp[3]=(m_service.getDVBNamespace().get()>>16)&0xFF;
517                 tmp[4]=(m_service.getDVBNamespace().get()>>8)&0xFF;
518                 tmp[5]=m_service.getDVBNamespace().get()&0xFF;
519                 tmp[6]=m_service.getTransportStreamID().get()>>8;
520                 tmp[7]=m_service.getTransportStreamID().get()&0xFF;
521                 tmp[8]=m_service.getOriginalNetworkID().get()>>8;
522                 tmp[9]=m_service.getOriginalNetworkID().get()&0xFF;
523                 capmt.injectDescriptor(tmp, false);
524
525                 capmt.writeToBuffer(m_capmt);
526         }
527
528         m_prev_build_hash = build_hash;
529
530         if ( m_sendstate != 0xFFFFFFFF )
531                 m_sendstate=0;
532         sendCAPMT();
533 }
534
535 void eDVBCAService::sendCAPMT()
536 {
537         if ( m_sendstate && m_sendstate != 0xFFFFFFFF ) // broken pipe retry
538         {
539                 ::close(m_sock);
540                 Connect();
541         }
542
543         int wp=0;
544         if ( m_capmt[3] & 0x80 )
545         {
546                 int i=0;
547                 int lenbytes = m_capmt[3] & ~0x80;
548                 while(i < lenbytes)
549                         wp = (wp << 8) | m_capmt[4 + i++];
550                 wp+=4;
551                 wp+=lenbytes;
552         }
553         else
554         {
555                 wp = m_capmt[3];
556                 wp+=4;
557         }
558
559         if ( write(m_sock, m_capmt, wp) == wp )
560         {
561                 m_sendstate=0xFFFFFFFF;
562                 eDebug("[eDVBCAHandler] send %d bytes",wp);
563 #if 1
564                 for(int i=0;i<wp;i++)
565                         eDebugNoNewLine("%02x ", m_capmt[i]);
566                 eDebug("");
567 #endif
568         }
569         else
570         {
571                 switch(m_sendstate)
572                 {
573                         case 0xFFFFFFFF:
574                                 ++m_sendstate;
575                                 m_retryTimer.start(0,true);
576 //                              eDebug("[eDVBCAHandler] send failed .. immediate retry");
577                                 break;
578                         default:
579                                 m_retryTimer.start(5000,true);
580 //                              eDebug("[eDVBCAHandler] send failed .. retry in 5 sec");
581                                 break;
582                 }
583                 ++m_sendstate;
584         }
585 }