1 #include <lib/base/eerror.h>
2 #include <lib/dvb/radiotext.h>
3 #include <lib/dvb/idemux.h>
4 #include <lib/gdi/gpixmap.h>
6 DEFINE_REF(eDVBRdsDecoder);
8 eDVBRdsDecoder::eDVBRdsDecoder(iDVBDemux *demux)
9 :msgPtr(0), bsflag(0), qdar_pos(0), t_ptr(0), qdarmvi_show(0), state(0)
12 setStreamID(0xC0, 0xC0);
14 memset(rass_picture_mask, 0, sizeof(rass_picture_mask));
16 if (demux->createPESReader(eApp, m_pes_reader))
17 eDebug("failed to create PES reader!");
19 m_pes_reader->connectRead(slot(*this, &eDVBRdsDecoder::processData), m_read_connection);
20 CONNECT(m_abortTimer.timeout, eDVBRdsDecoder::abortNonAvail);
23 eDVBRdsDecoder::~eDVBRdsDecoder()
25 // delete cached rass slides
26 for (int page=0; page < 10; ++page)
28 unsigned char mask = rass_picture_mask[(page*4)/8];
36 std::string filename = getRassPicture(page, subpage);
37 if (filename.length())
38 remove(filename.c_str());
44 remove("/tmp/RassLast.mvi");
47 #define SWAP(x) ((x<<8)|(x>>8))
48 #define LO(x) (x&0xFF)
50 static inline unsigned short crc_ccitt_byte( unsigned short crc, unsigned char c )
53 crc = crc ^ (LO(crc) >> 4);
54 crc = crc ^ (SWAP(LO(crc)) << 4) ^ (LO(crc) << 5);
58 static int bitrate[3][3][16] = {
61 {-1,8000,16000,24000,32000,40000,48000,56000,64000,80000,96000,112000,128000,144000,160000,0},
63 {-1,8000,16000,24000,32000,40000,48000,56000,64000,80000,96000,112000,128000,144000,160000,0},
65 {-1,32000,48000,56000,64000,80000,96000,112000,128000,144000,160000,176000,192000,224000,256000,0}
69 {-1,32000,40000,48000,56000,64000,80000,96000,112000,128000,160000,192000,224000,256000,320000,0},
71 {-1,32000,48000,56000,64000,80000,96000,112000,128000,160000,192000,224000,256000,320000,384000,0},
73 {-1,32000,64000,96000,128000,160000,192000,224000,256000,288000,320000,352000,384000,416000,448000,0}
77 {-1,6000,8000,10000,12000,16000,20000,24000,28000,320000,40000,48000,56000,64000,80000,0},
79 {-1,6000,8000,10000,12000,16000,20000,24000,28000,320000,40000,48000,56000,64000,80000,0},
81 {-1,8000,12000,16000,20000,24000,32000,40000,48000,560000,64000,80000,96000,112000,128000,0}
85 static int frequency[3][4] = {
86 // MPEG2 - 22.05, 24, 16khz
87 { 22050,24000,16000,0 },
88 // MPEG1 - 44.1, 48, 32khz
89 { 44100,48000,32000,0 },
90 // MPEG2.5 - 11.025, 12, 8khz
91 { 11025,12000,8000,0 }
94 void eDVBRdsDecoder::connectEvent(const Slot1<void, int> &slot, ePtr<eConnection> &connection)
96 connection = new eConnection(this, m_event.connect(slot));
99 void eDVBRdsDecoder::addToPictureMask(int id)
101 int page = id / 1000;
102 int tmp = page > 0 ? id / page : id;
110 int index = (page*4+subpage)/8;
111 int val = (page%2) ? 16 * (1 << subpage) : (1 << subpage);
112 if (rass_picture_mask[index] & val) // already have this picture
114 rass_picture_mask[index] |= val;
115 /* emit */ m_event(RassInteractivePicMaskChanged);
118 void eDVBRdsDecoder::removeFromPictureMask(int id)
120 int page = id / 1000;
121 int tmp = page > 0 ? id / page : id;
129 int index = (page*4)/8;
130 int val = (page%2) ? 16 * (1 << subpage) : (1 << subpage);
131 if (rass_picture_mask[index] & val) // have this picture
133 rass_picture_mask[index] &= ~val;
134 /* emit */ m_event(RassInteractivePicMaskChanged);
138 void eDVBRdsDecoder::processPESPacket(__u8 *data, int len)
140 int pos=9+data[8];// skip pes header
145 if ((0xFF & data[pos]) != 0xFF || (0xF0 & data[pos + 1]) != 0xF0)
148 int padding_bit = (data[pos + 2]>>1) & 1;
149 int mode = (data[pos + 3]>>6) & 3;
150 int channel = mode == 3 ? 1 : 2;
151 int id = (data[pos + 1] >> 3) & 1;
152 int emphasis_bit = data[pos + 3] & 3;
153 int protection_bit = data[pos + 1] & 1;
155 int sample_freq = -1;
158 if (emphasis_bit == 2 && id == 1 )
161 if ((layer = (data[pos + 1]>>1) & 3) < 1)
164 if ((rate = bitrate[id][layer - 1][(data[pos + 2]>>4) & 0xf]) < 1)
167 if ((sample_freq = frequency[id][(data[pos + 2]>>2) & 3]) == 0)
170 if (id == 1 && layer == 2)
172 if (rate / channel < 32000)
174 if (rate / channel > 192000)
178 int frame_size = layer < 3 ?
179 (144 * rate / sample_freq) + padding_bit :
180 ((12 * rate / sample_freq) * 4) + (4 * padding_bit);
185 // eDebug("protection_bit ? %d", protection_bit);
186 // int offs = protection_bit ? pos - 1 : pos - 3;
187 // if (data[offs] != 0xFD)
189 // eDebug("%02x %02x %02x %02x %02x", data[offs-2], data[offs-1], data[offs], data[offs+1], data[offs+2]);
194 if (data[offs] == 0xFD)
197 int ancillary_len = 1 + data[offs - 1];
198 offs -= ancillary_len;
199 gotAncillaryData(data+offs, ancillary_len);
204 void eDVBRdsDecoder::process_qdar(unsigned char *buf)
206 if (buf[0] == 0x40 && buf[1] == 0xDA)
208 unsigned int item,cnt,ctrl,item_type;
209 unsigned long item_length,id,item_no,ptr,tmp;
210 unsigned short crc_qdar,crc_read;
213 item=buf[2]<<8; // Number of Items
216 while ( cnt++ < item ) //read in items
218 id=buf[ptr++]<<8; //QDarID
221 item_no=buf[ptr++]<<8; // Item Number
224 ctrl=buf[ptr++]; //controlbyte
225 item_type=buf[ptr++]; //item type
227 item_length=buf[ptr++]<<24; // Item length
228 item_length|=buf[ptr++]<<16;
229 item_length|=buf[ptr++]<<8;
230 item_length|=buf[ptr++];
232 ptr=ptr+4; // rfu Bytes ... not used
235 while (tmp < ptr+item_length)
236 crc_qdar = crc_ccitt_byte(crc_qdar, buf[tmp++]);
238 crc_read=buf[ptr+item_length]<<8;
239 crc_read|=buf[ptr+item_length+1];
240 //eDebug("[RDS/Rass] CRC read: %04X calculated: %04X",crc_read,crc_qdar^0xFFFF);
242 if (crc_read == (crc_qdar^0xFFFF)) // process item
246 case 0x01: //Stillframe
247 if (ctrl&0x01) // display slide
249 sprintf(fname,"/tmp/RassLast.mvi");
250 FILE *fh=fopen(fname,"wb");
251 fwrite(buf+ptr,1,item_length-2,fh);
253 /*emit*/ m_event(RecvRassSlidePic);
256 if (ctrl&0x02) // save slide for interactive mode
258 if (id == 0 || id >= 1000)
260 sprintf(fname,"/tmp/Rass%04d.mvi",(int)id);
261 FILE *fh=fopen(fname,"wb");
262 fwrite(buf+ptr,1,item_length-2,fh);
264 addToPictureMask(id);
267 eDebug("ignore recv interactive picture id %lu", id);
269 if (ctrl&0x04) // display slide if nothing had been displayed yet
271 if (qdarmvi_show != 1)
273 sprintf(fname,"/tmp/RassLast.mvi");
274 FILE *fh=fopen(fname,"wb");
275 fwrite(buf+ptr,1,item_length-2,fh);
277 /*emit*/ m_event(RecvRassSlidePic);
281 if (ctrl&0x08) // delete slide
283 eDebug("delete slide id %lu, item_no %lu", id, item_no);
284 if (id == 0 || id >= 1000)
286 eDebug("delete %lu", id);
287 removeFromPictureMask(id);
288 sprintf(fname,"/tmp/Rass%04d.mvi",(int)id); // was item_no ? ! ?
292 eDebug("ignore del interactive picture id %lu", id);
295 default: //nothing more yet defined
301 eDebug("[RDS/Rass] CRC error, skip Rass-Qdar-Item");
309 eDebug("[RDS/Rass] No Rass-QDAR archive (%02X %02X) so skipping !\n",buf[0],buf[1]);
313 inline void eDVBRdsDecoder::gotAncillaryData(__u8 *buf, int len)
318 unsigned char c = buf[--len];
320 if (bsflag == 1) // byte stuffing
325 case 0x00: c=0xFD; break;
326 case 0x01: c=0xFE; break;
327 case 0x02: c=0xFF; break;
331 if (c == 0xFD && bsflag ==0)
340 if (( state >= 1 && state < 11 ) || ( state >=26 && state < 36 ))
341 crc = crc_ccitt_byte(crc, c);
346 if ( c==0xFE ) // Startkennung
349 case 1: // 10bit Site Address + 6bit Encoder Address
351 case 3: // Sequence Counter
361 case 0x0A: // Radiotext
364 case 0x46: // Radiotext Plus tags
370 default: // reset to state 0
376 case 6: // Data Set Number ... ignore
377 case 7: // Program Service Number ... ignore
380 case 8: // Message Element Length
382 if ( !text_len || text_len > 65 || text_len > leninfo-4)
391 case 9: // Radio Text Status bit:
392 // 0 = AB-flagcontrol
393 // 1-4 = Transmission-Number
394 // 5-6 = Buffer-Config
395 ++state; // ignore ...
398 // TODO build a complete radiotext charcode to UTF8 conversion table for all character > 0x80
401 case 0 ... 0x7f: break;
402 case 0x8d: c='ß'; break;
403 case 0x91: c='ä'; break;
404 case 0xd1: c='Ä'; break;
405 case 0x97: c='ö'; break;
406 case 0xd7: c='Ö'; break;
407 case 0x99: c='ü'; break;
408 case 0xd9: c='Ü'; break;
409 default: c=' '; break; // convert all unknown to space
424 while(message[msgPtr] == ' ' && msgPtr > 0)
425 message[msgPtr--] = 0;
426 if ( crc16 == (crc^0xFFFF) )
428 eDebug("radiotext: (%s)", message);
429 /*emit*/ m_event(RadioTextChanged);
430 memcpy(lastmessage,message,66);
433 eDebug("invalid radiotext crc (%s)", message);
446 case 27: // SID not used atm
449 case 28: // SID not used atm
452 case 29: // PNR packet number
456 case 30: // PNR packet number
460 case 31: // PNR packet number
464 case 32: // NOP number of packets
468 case 33: // NOP number of packets
472 case 34: // NOP number of packets
477 datamessage[t_ptr++]=c;
489 //eDebug("[RDS/Rass] CRC read: %04X CRC calculated: %04X",crc16,crc^0xFFFF);
491 if ( crc16 == (crc^0xFFFF) )
497 memcpy(qdar+qdar_pos,datamessage,text_len2+1);
498 qdar_pos=qdar_pos+text_len2+1;
499 if (partcnt == parts)
501 process_qdar(qdar); // decode qdar archive
516 eDebug("[RDS/Rass] CRC error, skip Rass-Qdar-Packet");
517 eDebug("[RDS/Rass] CRC read: %04X CRC calculated: %04X",crc16,crc^0xFFFF);
523 // process RT plus tags ...
524 case 38: // Message Element Length
528 case 39: // Application ID
529 case 40: // always 0x4BD7 so we ignore it ;)
530 case 41: // Applicationgroup Typecode/PTY ... ignore
549 case 46: // bit 10#4 = Item Togglebit
550 // bit 10#3 = Item Runningbit
551 // Tag1: bit 10#2..11#5 = Contenttype, 11#4..12#7 = Startmarker, 12#6..12#1 = Length
553 if (lastmessage[0] == 0) // no rds message till now ? quit ...
555 int rtp_typ[2],rtp_start[2],rtp_len[2];
556 rtp_typ[0] = (0x38 & rtp_buf[0]<<3) | rtp_buf[1]>>5;
557 rtp_start[0] = (0x3e & rtp_buf[1]<<1) | rtp_buf[2]>>7;
558 rtp_len[0] = 0x3f & rtp_buf[2]>>1;
559 // Tag2: bit 12#0..13#3 = Contenttype, 13#2..14#5 = Startmarker, 14#4..14#0 = Length(5bit)
560 rtp_typ[1] = (0x20 & rtp_buf[2]<<5) | rtp_buf[3]>>3;
561 rtp_start[1] = (0x38 & rtp_buf[3]<<3) | rtp_buf[4]>>5;
562 rtp_len[1] = 0x1f & rtp_buf[4];
564 unsigned char rtplus_osd_tmp[64];
566 memcpy(rtp_item[rtp_typ[0]],lastmessage+rtp_start[0],rtp_len[0]+1);
567 rtp_item[rtp_typ[0]][rtp_len[0]+1]=0;
569 if (rtp_typ[0] != rtp_typ[1])
571 memcpy(rtp_item[rtp_typ[1]],lastmessage+rtp_start[1],rtp_len[1]+1);
572 rtp_item[rtp_typ[1]][rtp_len[1]+1]=0;
575 // main RTPlus item_types used by the radio stations:
584 // todo: make a window to display all saved items ...
586 //create RTPlus OSD for title/artist
589 if ( rtp_item[4][0] != 0 )//artist
590 sprintf((char*)rtplus_osd_tmp," (%s)",rtp_item[4]);
592 if ( rtp_item[1][0] != 0 )//title
593 sprintf((char*)rtplus_osd,"%s%s",rtp_item[1],rtplus_osd_tmp);
595 if ( rtplus_osd[0] != 0 )
597 /*emit*/ m_event(RtpTextChanged);
598 eDebug("RTPlus: %s",rtplus_osd);
608 std::string eDVBRdsDecoder::getRassPicture(int page, int subpage)
628 sprintf(fname,"/tmp/Rass%04d.mvi",val);
632 int eDVBRdsDecoder::start(int pid)
635 if (m_pes_reader && !(ret = m_pes_reader->start(pid)))
636 m_abortTimer.startLongTimer(20);
640 void eDVBRdsDecoder::abortNonAvail()
642 eDebug("no ancillary data in audio stream... abort radiotext pes parser");
644 m_pes_reader->stop();
647 ePyObject eDVBRdsDecoder::getRassPictureMask()
649 ePyObject ret = PyTuple_New(5);
650 PyTuple_SET_ITEM(ret, 0, PyInt_FromLong(rass_picture_mask[0]));
651 PyTuple_SET_ITEM(ret, 1, PyInt_FromLong(rass_picture_mask[1]));
652 PyTuple_SET_ITEM(ret, 2, PyInt_FromLong(rass_picture_mask[2]));
653 PyTuple_SET_ITEM(ret, 3, PyInt_FromLong(rass_picture_mask[3]));
654 PyTuple_SET_ITEM(ret, 4, PyInt_FromLong(rass_picture_mask[4]));