1 #include <lib/base/eerror.h>
2 #include <lib/dvb/teletext.h>
3 #include <lib/dvb/idemux.h>
4 #include <lib/gdi/gpixmap.h>
7 This is a very simple en300 706 telext decoder.
9 It can only decode a single page at a time, thus it's only used
14 DEFINE_REF(eDVBTeletextParser);
16 /* we asumme error free transmission! */
17 static inline unsigned char decode_odd_parity(unsigned char *b)
20 unsigned char res = 0;
27 static inline unsigned char decode_hamming_84(unsigned char *b)
29 unsigned char res = 0;
37 static inline unsigned long decode_hamming_2418(unsigned char *b)
39 unsigned long h24 = b[0] | (b[1] << 8) | (b[2] << 16);
42 ((h24 & 0x000004) >> 2) |
43 ((h24 & 0x000070) >> 3) |
44 ((h24 & 0x007f00) >> 4) |
45 ((h24 & 0x7f0000) >> 5);
48 eDVBTeletextParser::eDVBTeletextParser(iDVBDemux *demux)
50 setStreamID(0xBD); /* as per en 300 472 */
54 if (demux->createPESReader(eApp, m_pes_reader))
55 eDebug("failed to create PES reader!");
57 m_pes_reader->connectRead(slot(*this, &eDVBTeletextParser::processData), m_read_connection);
60 eDVBTeletextParser::~eDVBTeletextParser()
64 void eDVBTeletextParser::processPESPacket(__u8 *pkt, int len)
66 unsigned char *p = pkt;
68 p += 4; len -= 4; /* start code, already be verified by pes parser */
69 p += 2; len -= 2; /* length, better use the argument */
71 p += 3; len -= 3; /* pes header */
73 p += 0x24; len -= 0x24; /* skip header */
75 // eDebug("data identifier: %02x", *p);
81 unsigned char data_unit_id = *p++;
82 unsigned char data_unit_length = *p++;
85 if (len < data_unit_length)
87 eDebug("data_unit_length > len");
91 if (data_unit_length != 44)
93 eDebug("illegal data unit length %d", data_unit_length);
97 unsigned char line_offset = *p++; len--;
98 unsigned char framing_code = *p++; len--;
100 int magazine_and_packet_address = decode_hamming_84(p++); len--;
101 magazine_and_packet_address |= decode_hamming_84(p++)<<4; len--;
103 unsigned char *data = p; p += 40; len -= 40;
105 if (framing_code != 0xe4) /* no teletxt data */
108 m_M = magazine_and_packet_address & 7;
109 m_Y = magazine_and_packet_address >> 3;
111 // eDebug("line %d, framing code: %02x, M=%02x, Y=%02x", line_offset, framing_code, m_M, m_Y);
113 if (m_Y == 0) /* page header */
117 m_S1 = decode_hamming_84(data + 2); /* S1 */
118 int S2C4 = decode_hamming_84(data + 3);
121 m_C |= (S2C4 & 8) ? (1<<4) : 0;
123 m_S3 = decode_hamming_84(data + 4);
125 int S4C5C6 = decode_hamming_84(data + 5);
128 m_C |= (S4C5C6 & 0xC) << 3;
130 m_C |= decode_hamming_84(data + 6) << 7;
131 m_C |= decode_hamming_84(data + 7) << 11;
133 int serial_mode = m_C & (1<<11);
135 /* page on the same magazine? end current page. */
136 if ((serial_mode || (m_M == m_page_M)) && (m_page_open))
142 m_X = decode_hamming_84(data+1) * 0x10 + decode_hamming_84(data);
145 m_found_subtitle_pages.insert((m_M << 8) | m_X);
147 /* correct page on correct magazine? open page. */
148 if ((m_M == m_page_M) && (m_X == m_page_X))
152 handleLine(data + 8, 32);
156 /* data for the selected page? */
157 if ((m_M == m_page_M) && m_page_open)
158 handleLine(data, 40);
163 int eDVBTeletextParser::start(int pid)
168 return m_pes_reader->start(pid);
173 void eDVBTeletextParser::handlePageStart()
175 // if (m_C & (1<<4)) /* erase flag set */
177 /* we are always erasing the page,
178 even when the erase flag is not set. */
179 m_subtitle_page.clear();
182 void eDVBTeletextParser::handleLine(unsigned char *data, int len)
184 if (!m_Y) /* first line is page header, we don't need that. */
187 int last_was_white = 1, color = 7; /* start with whitespace. start with color=white. (that's unrelated.) */
191 // eDebug("handle subtitle line: %d len", len);
192 for (int i=0; i<len; ++i)
194 unsigned char b = decode_odd_parity(data + i);
196 if (b < 0x10) /* spacing attribute */
198 if (b < 8) /* colors */
200 if (b != color) /* new color is split into a new string */
202 addSubtitleString(color, text);
207 /* ignore other attributes */
210 eDebugNoNewLine("%c", b);
211 /* no more than one whitespace, only printable chars */
212 if (((!last_was_white) || (b != ' ')) && (b >= 0x20))
215 last_was_white = b == ' ';
220 addSubtitleString(color, text);
223 void eDVBTeletextParser::handlePageEnd()
225 eDebug("handle page end");
226 addSubtitleString(-1, ""); /* end last line */
227 sendSubtitlePage(); /* send assembled subtitle page to display */
230 void eDVBTeletextParser::setPage(int page)
232 m_page_M = (page >> 8) & 7; /* magazine to look for */
233 m_page_X = page & 0xFF; /* page number */
236 void eDVBTeletextParser::connectNewPage(const Slot1<void, const eDVBTeletextSubtitlePage&> &slot, ePtr<eConnection> &connection)
238 connection = new eConnection(this, m_new_subtitle_page.connect(slot));
241 void eDVBTeletextParser::addSubtitleString(int color, const std::string &string)
243 // eDebug("add subtitle string: %s, col %d", string.c_str(), color);
244 gRGB rgbcol((color & 1) ? 255 : 128, (color & 2) ? 255 : 128, (color & 4) ? 255 : 128);
245 if ((color != m_subtitle_color) && !m_subtitle_text.empty())
247 m_subtitle_page.m_elements.push_back(eDVBTeletextSubtitlePageElement(rgbcol, m_subtitle_text));
248 m_subtitle_text = "";
249 } else if (!m_subtitle_text.empty() && m_subtitle_text[m_subtitle_text.size()-1] != ' ')
250 m_subtitle_text += " ";
252 m_subtitle_color = color;
253 m_subtitle_text += string;
256 void eDVBTeletextParser::sendSubtitlePage()
258 eDebug("subtitle page:");
259 for (unsigned int i = 0; i < m_subtitle_page.m_elements.size(); ++i)
260 eDebug("%s", m_subtitle_page.m_elements[i].m_text.c_str());
261 m_new_subtitle_page(m_subtitle_page);