add pes parser
[enigma2.git] / lib / dvb / frontend.cpp
1 #include <lib/dvb/dvb.h>
2 #include <lib/base/eerror.h>
3 #include <errno.h>
4 #include <unistd.h>
5 #include <fcntl.h>
6 #include <sys/ioctl.h>
7
8 #ifndef I2C_SLAVE_FORCE
9 #define I2C_SLAVE_FORCE 0x0706
10 #endif
11
12 #if HAVE_DVB_API_VERSION < 3
13 #include <ost/frontend.h>
14 #include <ost/sec.h>
15 #define QAM_AUTO                                (Modulation)6
16 #define TRANSMISSION_MODE_AUTO  (TransmitMode)2
17 #define BANDWIDTH_AUTO                  (BandWidth)3
18 #define GUARD_INTERVAL_AUTO             (GuardInterval)4
19 #define HIERARCHY_AUTO                  (Hierarchy)4
20 #define parm_frequency parm.Frequency
21 #define parm_inversion parm.Inversion
22 #define parm_u_qpsk_symbol_rate parm.u.qpsk.SymbolRate
23 #define parm_u_qpsk_fec_inner parm.u.qpsk.FEC_inner
24 #define parm_u_qam_symbol_rate parm.u.qam.SymbolRate
25 #define parm_u_qam_fec_inner parm.u.qam.FEC_inner
26 #define parm_u_qam_modulation parm.u.qam.QAM
27 #define parm_u_ofdm_bandwidth parm.u.ofdm.bandWidth
28 #define parm_u_ofdm_code_rate_LP parm.u.ofdm.LP_CodeRate
29 #define parm_u_ofdm_code_rate_HP parm.u.ofdm.HP_CodeRate
30 #define parm_u_ofdm_constellation parm.u.ofdm.Constellation
31 #define parm_u_ofdm_transmission_mode parm.u.ofdm.TransmissionMode
32 #define parm_u_ofdm_guard_interval parm.u.ofdm.guardInterval
33 #define parm_u_ofdm_hierarchy_information parm.u.ofdm.HierarchyInformation
34 #else
35 #include <linux/dvb/frontend.h>
36 #define parm_frequency parm.frequency
37 #define parm_inversion parm.inversion
38 #define parm_u_qpsk_symbol_rate parm.u.qpsk.symbol_rate
39 #define parm_u_qpsk_fec_inner parm.u.qpsk.fec_inner
40 #define parm_u_qam_symbol_rate parm.u.qam.symbol_rate
41 #define parm_u_qam_fec_inner parm.u.qam.fec_inner
42 #define parm_u_qam_modulation parm.u.qam.modulation
43 #define parm_u_ofdm_bandwidth parm.u.ofdm.bandwidth
44 #define parm_u_ofdm_code_rate_LP parm.u.ofdm.code_rate_LP
45 #define parm_u_ofdm_code_rate_HP parm.u.ofdm.code_rate_HP
46 #define parm_u_ofdm_constellation parm.u.ofdm.constellation
47 #define parm_u_ofdm_transmission_mode parm.u.ofdm.transmission_mode
48 #define parm_u_ofdm_guard_interval parm.u.ofdm.guard_interval
49 #define parm_u_ofdm_hierarchy_information parm.u.ofdm.hierarchy_information
50 #endif
51
52 #include <dvbsi++/satellite_delivery_system_descriptor.h>
53 #include <dvbsi++/cable_delivery_system_descriptor.h>
54 #include <dvbsi++/terrestrial_delivery_system_descriptor.h>
55
56 void eDVBDiseqcCommand::setCommandString(const char *str)
57 {
58         if (!str)
59                 return;
60         len=0;
61         int slen = strlen(str);
62         if (slen % 2)
63         {
64                 eDebug("invalid diseqc command string length (not 2 byte aligned)");
65                 return;
66         }
67         if (slen > MAX_DISEQC_LENGTH*2)
68         {
69                 eDebug("invalid diseqc command string length (string is to long)");
70                 return;
71         }
72         unsigned char val=0;
73         for (int i=0; i < slen; ++i)
74         {
75                 unsigned char c = str[i];
76                 switch(c)
77                 {
78                         case '0' ... '9': c-=48; break;
79                         case 'a' ... 'f': c-=87; break;
80                         case 'A' ... 'F': c-=55; break;
81                         default:
82                                 eDebug("invalid character in hex string..ignore complete diseqc command !");
83                                 return;
84                 }
85                 if ( i % 2 )
86                 {
87                         val |= c;
88                         data[i/2] = val;
89                 }
90                 else
91                         val = c << 4;
92         }
93         len = slen/2;
94 }
95
96 void eDVBFrontendParametersSatellite::set(const SatelliteDeliverySystemDescriptor &descriptor)
97 {
98         frequency    = descriptor.getFrequency() * 10;
99         symbol_rate  = descriptor.getSymbolRate() * 100;
100         polarisation = descriptor.getPolarization();
101         fec = descriptor.getFecInner();
102         if ( fec == 0xF )
103                 fec = FEC::fNone;
104         inversion = Inversion::Unknown;
105         orbital_position  = ((descriptor.getOrbitalPosition() >> 12) & 0xF) * 1000;
106         orbital_position += ((descriptor.getOrbitalPosition() >> 8) & 0xF) * 100;
107         orbital_position += ((descriptor.getOrbitalPosition() >> 4) & 0xF) * 10;
108         orbital_position += ((descriptor.getOrbitalPosition()) & 0xF);
109         if (orbital_position && (!descriptor.getWestEastFlag()))
110                 orbital_position = 3600 - orbital_position;
111         eDebug("SAT freq %d, %s, pos %d, sr %d, fec %d",
112                 frequency,
113                 polarisation ? "hor" : "vert",
114                 orbital_position,
115                 symbol_rate, fec);
116 }
117
118 void eDVBFrontendParametersCable::set(const CableDeliverySystemDescriptor &descriptor)
119 {
120         frequency = descriptor.getFrequency() / 10;
121         symbol_rate = descriptor.getSymbolRate() * 100;
122         fec_inner = descriptor.getFecInner();
123         if ( fec_inner == 0xF )
124                 fec_inner = FEC::fNone;
125         modulation = descriptor.getModulation();
126         if ( modulation > 0x5 )
127                 modulation = Modulation::Auto;
128         inversion = Inversion::Unknown;
129         eDebug("Cable freq %d, mod %d, sr %d, fec %d",
130                 frequency,
131                 modulation, symbol_rate, fec_inner);
132 }
133
134 void eDVBFrontendParametersTerrestrial::set(const TerrestrialDeliverySystemDescriptor &descriptor)
135 {
136         frequency = descriptor.getCentreFrequency() * 10;
137         bandwidth = descriptor.getBandwidth();
138         if ( bandwidth > 2 ) // 5Mhz forced to auto
139                 bandwidth = Bandwidth::BwAuto;
140         code_rate_HP = descriptor.getCodeRateHpStream();
141         if (code_rate_HP > 4)
142                 code_rate_HP = FEC::fAuto;
143         code_rate_LP = descriptor.getCodeRateLpStream();
144         if (code_rate_LP > 4)
145                 code_rate_LP = FEC::fAuto;
146         transmission_mode = descriptor.getTransmissionMode();
147         if (transmission_mode > 1) // TM4k forced to auto
148                 transmission_mode = TransmissionMode::TMAuto;
149         guard_interval = descriptor.getGuardInterval();
150         if (guard_interval > 3)
151                 guard_interval = GuardInterval::GI_Auto;
152         hierarchy = descriptor.getHierarchyInformation()&3;
153         modulation = descriptor.getConstellation();
154         if (modulation > 2)
155                 modulation = Modulation::Auto;
156         inversion = Inversion::Unknown;
157         eDebug("Terr freq %d, bw %d, cr_hp %d, cr_lp %d, tm_mode %d, guard %d, hierarchy %d, const %d",
158                 frequency, bandwidth, code_rate_HP, code_rate_LP, transmission_mode,
159                 guard_interval, hierarchy, modulation);
160 }
161
162 eDVBFrontendParameters::eDVBFrontendParameters(): m_type(-1)
163 {
164 }
165
166 DEFINE_REF(eDVBFrontendParameters);
167
168 RESULT eDVBFrontendParameters::getSystem(int &t) const
169 {
170         if (m_type == -1)
171                 return -1;
172         t = m_type;
173         return 0;
174 }
175
176 RESULT eDVBFrontendParameters::getDVBS(eDVBFrontendParametersSatellite &p) const
177 {
178         if (m_type != iDVBFrontend::feSatellite)
179                 return -1;
180         p = sat;
181         return 0;
182 }
183
184 RESULT eDVBFrontendParameters::getDVBC(eDVBFrontendParametersCable &p) const
185 {
186         if (m_type != iDVBFrontend::feCable)
187                 return -1;
188         p = cable;
189         return 0;
190 }
191
192 RESULT eDVBFrontendParameters::getDVBT(eDVBFrontendParametersTerrestrial &p) const
193 {
194         if (m_type != iDVBFrontend::feTerrestrial)
195                 return -1;
196         p = terrestrial;
197         return 0;
198 }
199
200 RESULT eDVBFrontendParameters::setDVBS(const eDVBFrontendParametersSatellite &p, bool no_rotor_command_on_tune)
201 {
202         sat = p;
203         sat.no_rotor_command_on_tune = no_rotor_command_on_tune;
204         m_type = iDVBFrontend::feSatellite;
205         return 0;
206 }
207
208 RESULT eDVBFrontendParameters::setDVBC(const eDVBFrontendParametersCable &p)
209 {
210         cable = p;
211         m_type = iDVBFrontend::feCable;
212         return 0;
213 }
214
215 RESULT eDVBFrontendParameters::setDVBT(const eDVBFrontendParametersTerrestrial &p)
216 {
217         terrestrial = p;
218         m_type = iDVBFrontend::feTerrestrial;
219         return 0;
220 }
221
222 RESULT eDVBFrontendParameters::calculateDifference(const iDVBFrontendParameters *parm, int &diff) const
223 {
224         if (!parm)
225                 return -1;
226         int type;
227         if (parm->getSystem(type))
228                 return -1;
229         if (type != m_type)
230         {
231                 diff = 1<<30; // big difference
232                 return 0;
233         }
234         
235         switch (type)
236         {
237         case iDVBFrontend::feSatellite:
238         {
239                 eDVBFrontendParametersSatellite osat;
240                 if (parm->getDVBS(osat))
241                         return -2;
242                 
243                 if (sat.orbital_position != osat.orbital_position)
244                         diff = 1<<29;
245                 else if (sat.polarisation != osat.polarisation)
246                         diff = 1<<28;
247                 else
248                 {
249                         diff = abs(sat.frequency - osat.frequency);
250                         diff += abs(sat.symbol_rate - osat.symbol_rate);
251                 }
252                 return 0;
253         }
254         case iDVBFrontend::feCable:
255                 eDVBFrontendParametersCable ocable;
256                 if (parm->getDVBC(ocable))
257                         return -2;
258                 
259                 if (cable.modulation != ocable.modulation && cable.modulation != eDVBFrontendParametersCable::Modulation::Auto && ocable.modulation != eDVBFrontendParametersCable::Modulation::Auto)
260                         diff = 1 << 29;
261                 else if (cable.inversion != ocable.inversion && cable.inversion != eDVBFrontendParametersCable::Inversion::Unknown && ocable.inversion != eDVBFrontendParametersCable::Inversion::Unknown)
262                         diff = 1 << 28;
263                 else
264                 {
265                         diff = abs(cable.frequency - ocable.frequency);
266                         diff += abs(cable.symbol_rate - ocable.symbol_rate);
267                 }
268                 
269                 return 0;
270         case iDVBFrontend::feTerrestrial:
271                 eDVBFrontendParametersTerrestrial oterrestrial;
272                 if (parm->getDVBT(oterrestrial))
273                         return -2;
274                 
275                 diff = abs(terrestrial.frequency - oterrestrial.frequency);
276
277                 return 0;
278         default:
279                 return -1;
280         }
281         return 0;
282 }
283
284 RESULT eDVBFrontendParameters::getHash(unsigned long &hash) const
285 {
286         switch (m_type)
287         {
288         case iDVBFrontend::feSatellite:
289         {
290                 hash = (sat.orbital_position << 16);
291                 hash |= ((sat.frequency/1000)&0xFFFF)|((sat.polarisation&1) << 15);
292                 return 0;
293         }
294         case iDVBFrontend::feCable:
295                 hash = 0xFFFF0000;
296                 return 0;
297         case iDVBFrontend::feTerrestrial:
298                 hash = 0xEEEE0000;
299                 return 0;
300         default:
301                 return -1;
302         }
303 }
304
305 DEFINE_REF(eDVBFrontend);
306
307 eDVBFrontend::eDVBFrontend(int adap, int fe, int &ok)
308         :m_type(-1), m_fe(fe), m_fd(-1), m_sn(0), m_timeout(0), m_tuneTimer(0)
309 #if HAVE_DVB_API_VERSION < 3
310         ,m_secfd(-1)
311 #endif
312 {
313 #if HAVE_DVB_API_VERSION < 3
314         sprintf(m_filename, "/dev/dvb/card%d/frontend%d", adap, fe);
315         sprintf(m_sec_filename, "/dev/dvb/card%d/sec%d", adap, fe);
316 #else
317         sprintf(m_filename, "/dev/dvb/adapter%d/frontend%d", adap, fe);
318 #endif
319         m_timeout = new eTimer(eApp);
320         CONNECT(m_timeout->timeout, eDVBFrontend::timeout);
321
322         m_tuneTimer = new eTimer(eApp);
323         CONNECT(m_tuneTimer->timeout, eDVBFrontend::tuneLoop);
324
325         int entries = sizeof(m_data) / sizeof(int);
326         for (int i=0; i<entries; ++i)
327                 m_data[i] = -1;
328
329         m_idleInputpower[0]=m_idleInputpower[1]=0;
330
331         ok = !openFrontend();
332         closeFrontend();
333 }
334
335 int eDVBFrontend::openFrontend()
336 {
337         if (m_sn)
338                 return -1;  // already opened
339
340         m_state=0;
341         m_tuning=0;
342
343 #if HAVE_DVB_API_VERSION < 3
344         if (m_secfd < 0)
345         {
346                 m_secfd = ::open(m_sec_filename, O_RDWR);
347                 if (m_secfd < 0)
348                 {
349                         eWarning("failed! (%s) %m", m_sec_filename);
350                         return -1;
351                 }
352         }
353         else
354                 eWarning("sec %d already opened", m_fe);
355         FrontendInfo fe_info;
356 #else
357         dvb_frontend_info fe_info;
358 #endif
359         eDebug("opening frontend %d", m_fe);
360         if (m_fd < 0)
361         {
362                 m_fd = ::open(m_filename, O_RDWR|O_NONBLOCK);
363                 if (m_fd < 0)
364                 {
365                         eWarning("failed! (%s) %m", m_filename);
366 #if HAVE_DVB_API_VERSION < 3
367                         ::close(m_secfd);
368                         m_secfd=-1;
369 #endif
370                         return -1;
371                 }
372         }
373         else
374                 eWarning("frontend %d already opened", m_fe);
375         if (m_type == -1)
376         {
377                 if (::ioctl(m_fd, FE_GET_INFO, &fe_info) < 0)
378                 {
379                         eWarning("ioctl FE_GET_INFO failed");
380                         ::close(m_fd);
381                         m_fd = -1;
382 #if HAVE_DVB_API_VERSION < 3
383                         ::close(m_secfd);
384                         m_secfd=-1;
385 #endif
386                         return -1;
387                 }
388
389                 switch (fe_info.type)
390                 {
391                 case FE_QPSK:
392                         m_type = iDVBFrontend::feSatellite;
393                         break;
394                 case FE_QAM:
395                         m_type = iDVBFrontend::feCable;
396                         break;
397                 case FE_OFDM:
398                         m_type = iDVBFrontend::feTerrestrial;
399                         break;
400                 default:
401                         eWarning("unknown frontend type.");
402                         ::close(m_fd);
403                         m_fd = -1;
404 #if HAVE_DVB_API_VERSION < 3
405                         ::close(m_secfd);
406                         m_secfd=-1;
407 #endif
408                         return -1;
409                 }
410                 eDebug("detected %s frontend", "satellite\0cable\0    terrestrial"+fe_info.type*10);
411         }
412
413         setTone(iDVBFrontend::toneOff);
414         setVoltage(iDVBFrontend::voltageOff);
415
416         m_sn = new eSocketNotifier(eApp, m_fd, eSocketNotifier::Read);
417         CONNECT(m_sn->activated, eDVBFrontend::feEvent);
418
419         return 0;
420 }
421
422 int eDVBFrontend::closeFrontend()
423 {
424         if (!m_fe && m_data[7] != -1)
425         {
426                 // try to close the first frontend.. but the second is linked to the first
427                 eDVBRegisteredFrontend *linked_fe = (eDVBRegisteredFrontend*)m_data[7];
428                 if (linked_fe->m_inuse)
429                 {
430                         eDebug("dont close frontend %d until the linked frontend %d is still in use",
431                                 m_fe, linked_fe->m_frontend->getID());
432                         return -1;
433                 }
434         }
435         if (m_fd >= 0)
436         {
437                 eDebug("close frontend %d", m_fe);
438                 m_tuneTimer->stop();
439                 setTone(iDVBFrontend::toneOff);
440                 setVoltage(iDVBFrontend::voltageOff);
441                 if (m_sec)
442                         m_sec->setRotorMoving(false);
443                 if (!::close(m_fd))
444                         m_fd=-1;
445                 else
446                         eWarning("couldnt close frontend %d", m_fe);
447                 m_data[0] = m_data[1] = m_data[2] = -1;
448         }
449 #if HAVE_DVB_API_VERSION < 3
450         if (m_secfd >= 0)
451         {
452                 if (!::close(m_secfd))
453                         m_secfd=-1;
454                 else
455                         eWarning("couldnt close sec %d", m_fe);
456         }
457 #endif
458         delete m_sn;
459         m_sn=0;
460
461         return 0;
462 }
463
464 eDVBFrontend::~eDVBFrontend()
465 {
466         closeFrontend();
467         delete m_timeout;
468         delete m_tuneTimer;
469 }
470
471 void eDVBFrontend::feEvent(int w)
472 {
473         while (1)
474         {
475 #if HAVE_DVB_API_VERSION < 3
476                 FrontendEvent event;
477 #else
478                 dvb_frontend_event event;
479 #endif
480                 int res;
481                 int state;
482                 res = ::ioctl(m_fd, FE_GET_EVENT, &event);
483                 
484                 if (res && (errno == EAGAIN))
485                         break;
486
487                 if (res)
488                 {
489                         eWarning("FE_GET_EVENT failed! %m");
490                         return;
491                 }
492                 
493                 if (w < 0)
494                         continue;
495
496 #if HAVE_DVB_API_VERSION < 3
497                 if (event.type == FE_COMPLETION_EV)
498 #else
499                 eDebug("(%d)fe event: status %x, inversion %s", m_fe, event.status, (event.parameters.inversion == INVERSION_ON) ? "on" : "off");
500                 if (event.status & FE_HAS_LOCK)
501 #endif
502                 {
503                         state = stateLock;
504                 } else
505                 {
506                         if (m_tuning)
507                                 state = stateTuning;
508                         else
509                         {
510                                 state = stateLostLock;
511                                 m_data[0] = m_data[1] = m_data[2] = -1; // reset diseqc
512                         }
513                 }
514                 if (m_state != state)
515                 {
516                         m_state = state;
517                         m_stateChanged(this);
518                 }
519         }
520 }
521
522 void eDVBFrontend::timeout()
523 {
524         m_tuning = 0;
525         if (m_state == stateTuning)
526         {
527                 m_state = stateFailed;
528                 m_stateChanged(this);
529         }
530 }
531
532 int eDVBFrontend::readFrontendData(int type)
533 {
534         switch(type)
535         {
536                 case bitErrorRate:
537                 {
538                         uint32_t ber=0;
539                         if (ioctl(m_fd, FE_READ_BER, &ber) < 0 && errno != ERANGE)
540                                 eDebug("FE_READ_BER failed (%m)");
541                         return ber;
542                 }
543                 case signalPower:
544                 {
545                         uint16_t snr=0;
546                         if (ioctl(m_fd, FE_READ_SNR, &snr) < 0 && errno != ERANGE)
547                                 eDebug("FE_READ_SNR failed (%m)");
548                         return snr;
549                 }
550                 case signalQuality:
551                 {
552                         uint16_t strength=0;
553                         if (ioctl(m_fd, FE_READ_SIGNAL_STRENGTH, &strength) < 0 && errno != ERANGE)
554                                 eDebug("FE_READ_SIGNAL_STRENGTH failed (%m)");
555                         return strength;
556                 }
557                 case Locked:
558                 {
559 #if HAVE_DVB_API_VERSION < 3
560                         FrontendStatus status=0;
561 #else
562                         fe_status_t status;
563 #endif
564                         if ( ioctl(m_fd, FE_READ_STATUS, &status) < 0 && errno != ERANGE )
565                                 eDebug("FE_READ_STATUS failed (%m)");
566                         return !!(status&FE_HAS_LOCK);
567                 }
568                 case Synced:
569                 {
570 #if HAVE_DVB_API_VERSION < 3
571                         FrontendStatus status=0;
572 #else
573                         fe_status_t status;
574 #endif
575                         if ( ioctl(m_fd, FE_READ_STATUS, &status) < 0 && errno != ERANGE )
576                                 eDebug("FE_READ_STATUS failed (%m)");
577                         return !!(status&FE_HAS_SYNC);
578                 }
579         }
580         return 0;
581 }
582
583 void PutToDict(PyObject *dict, const char*key, long value)
584 {
585         PyObject *item = PyInt_FromLong(value);
586         if (item)
587         {
588                 if (PyDict_SetItemString(dict, key, item))
589                         eDebug("put %s to dict failed", key);
590                 Py_DECREF(item);
591         }
592         else
593                 eDebug("could not create PyObject for %s", key);
594 }
595
596 void PutToDict(PyObject *dict, const char*key, const char *value)
597 {
598         PyObject *item = PyString_FromString(value);
599         if (item)
600         {
601                 if (PyDict_SetItemString(dict, key, item))
602                         eDebug("put %s to dict failed", key);
603                 Py_DECREF(item);
604         }
605         else
606                 eDebug("could not create PyObject for %s", key);
607 }
608
609 void fillDictWithSatelliteData(PyObject *dict, const FRONTENDPARAMETERS &parm, eDVBFrontend *fe)
610 {
611         int freq_offset=0;
612         int csw=0;
613         const char *fec=0;
614         fe->getData(0, csw);
615         fe->getData(9, freq_offset);
616         int frequency = parm_frequency + freq_offset;
617         PutToDict(dict, "frequency", frequency);
618         PutToDict(dict, "symbol_rate", parm_u_qpsk_symbol_rate);
619
620         switch(parm_u_qpsk_fec_inner)
621         {
622         case FEC_1_2:
623                 fec = "FEC_1_2";
624                 break;
625         case FEC_2_3:
626                 fec = "FEC_2_3";
627                 break;
628         case FEC_3_4:
629                 fec = "FEC_3_4";
630                 break;
631         case FEC_5_6:
632                 fec = "FEC_5_6";
633                 break;
634         case FEC_7_8:
635                 fec = "FEC_7_8";
636                 break;
637         default:
638         case FEC_AUTO:
639                 fec = "FEC_AUTO";
640                 break;
641         }
642         PutToDict(dict, "fec_inner", fec);
643 }
644
645 void fillDictWithCableData(PyObject *dict, const FRONTENDPARAMETERS &parm)
646 {
647         const char *tmp=0;
648         PutToDict(dict, "frequency", parm_frequency/1000);
649         PutToDict(dict, "symbol_rate", parm_u_qam_symbol_rate);
650         switch(parm_u_qam_fec_inner)
651         {
652         case FEC_NONE:
653                 tmp = "FEC_NONE";
654                 break;
655         case FEC_1_2:
656                 tmp = "FEC_1_2";
657                 break;
658         case FEC_2_3:
659                 tmp = "FEC_2_3";
660                 break;
661         case FEC_3_4:
662                 tmp = "FEC_3_4";
663                 break;
664         case FEC_5_6:
665                 tmp = "FEC_5_6";
666                 break;
667         case FEC_7_8:
668                 tmp = "FEC_7_8";
669                 break;
670 #if HAVE_DVB_API_VERSION >= 3
671         case FEC_8_9:
672                 tmp = "FEC_8_9";
673                 break;
674 #endif
675         default:
676         case FEC_AUTO:
677                 tmp = "FEC_AUTO";
678                 break;
679         }
680         PutToDict(dict, "fec_inner", tmp);
681         switch(parm_u_qam_modulation)
682         {
683         case QAM_16:
684                 tmp = "QAM_16";
685                 break;
686         case QAM_32:
687                 tmp = "QAM_32";
688                 break;
689         case QAM_64:
690                 tmp = "QAM_64";
691                 break;
692         case QAM_128:
693                 tmp = "QAM_128";
694                 break;
695         case QAM_256:
696                 tmp = "QAM_256";
697                 break;
698         default:
699         case QAM_AUTO:
700                 tmp = "QAM_AUTO";
701                 break;
702         }
703         PutToDict(dict, "modulation", tmp);
704 }
705
706 void fillDictWithTerrestrialData(PyObject *dict, const FRONTENDPARAMETERS &parm)
707 {
708         const char *tmp=0;
709         PutToDict(dict, "frequency", parm_frequency);
710         switch (parm_u_ofdm_bandwidth)
711         {
712         case BANDWIDTH_8_MHZ:
713                 tmp = "BANDWIDTH_8_MHZ";
714                 break;
715         case BANDWIDTH_7_MHZ:
716                 tmp = "BANDWIDTH_7_MHZ";
717                 break;
718         case BANDWIDTH_6_MHZ:
719                 tmp = "BANDWIDTH_6_MHZ";
720                 break;
721         default:
722         case BANDWIDTH_AUTO:
723                 tmp = "BANDWIDTH_AUTO";
724                 break;
725         }
726         PutToDict(dict, "bandwidth", tmp);
727         switch (parm_u_ofdm_code_rate_LP)
728         {
729         case FEC_1_2:
730                 tmp = "FEC_1_2";
731                 break;
732         case FEC_2_3:
733                 tmp = "FEC_2_3";
734                 break;
735         case FEC_3_4:
736                 tmp = "FEC_3_4";
737                 break;
738         case FEC_5_6:
739                 tmp = "FEC_5_6";
740                 break;
741         case FEC_7_8:
742                 tmp = "FEC_7_8";
743                 break;
744         default:
745         case FEC_AUTO:
746                 tmp = "FEC_AUTO";
747                 break;
748         }
749         PutToDict(dict, "code_rate_lp", tmp);
750         switch (parm_u_ofdm_code_rate_HP)
751         {
752         case FEC_1_2:
753                 tmp = "FEC_1_2";
754                 break;
755         case FEC_2_3:
756                 tmp = "FEC_2_3";
757                 break;
758         case FEC_3_4:
759                 tmp = "FEC_3_4";
760                 break;
761         case FEC_5_6:
762                 tmp = "FEC_5_6";
763                 break;
764         case FEC_7_8:
765                 tmp = "FEC_7_8";
766                 break;
767         default:
768         case FEC_AUTO:
769                 tmp = "FEC_AUTO";
770                 break;
771         }
772         PutToDict(dict, "code_rate_hp", tmp);
773         switch (parm_u_ofdm_constellation)
774         {
775         case QPSK:
776                 tmp = "QPSK";
777                 break;
778         case QAM_16:
779                 tmp = "QAM_16";
780                 break;
781         case QAM_64:
782                 tmp = "QAM_64";
783                 break;
784         default:
785         case QAM_AUTO:
786                 tmp = "QAM_AUTO";
787                 break;
788         }
789         PutToDict(dict, "constellation", tmp);
790         switch (parm_u_ofdm_transmission_mode)
791         {
792         case TRANSMISSION_MODE_2K:
793                 tmp = "TRANSMISSION_MODE_2K";
794                 break;
795         case TRANSMISSION_MODE_8K:
796                 tmp = "TRANSMISSION_MODE_8K";
797                 break;
798         default:
799         case TRANSMISSION_MODE_AUTO:
800                 tmp = "TRANSMISSION_MODE_AUTO";
801                 break;
802         }
803         PutToDict(dict, "transmission_mode", tmp);
804         switch (parm_u_ofdm_guard_interval)
805         {
806                 case GUARD_INTERVAL_1_32:
807                         tmp = "GUARD_INTERVAL_1_32";
808                         break;
809                 case GUARD_INTERVAL_1_16:
810                         tmp = "GUARD_INTERVAL_1_16";
811                         break;
812                 case GUARD_INTERVAL_1_8:
813                         tmp = "GUARD_INTERVAL_1_8";
814                         break;
815                 case GUARD_INTERVAL_1_4:
816                         tmp = "GUARD_INTERVAL_1_4";
817                         break;
818                 default:
819                 case GUARD_INTERVAL_AUTO:
820                         tmp = "GUARD_INTERVAL_AUTO";
821                         break;
822         }
823         PutToDict(dict, "guard_interval", tmp);
824         switch (parm_u_ofdm_hierarchy_information)
825         {
826                 case HIERARCHY_NONE:
827                         tmp = "HIERARCHY_NONE";
828                         break;
829                 case HIERARCHY_1:
830                         tmp = "HIERARCHY_1";
831                         break;
832                 case HIERARCHY_2:
833                         tmp = "HIERARCHY_2";
834                         break;
835                 case HIERARCHY_4:
836                         tmp = "HIERARCHY_4";
837                         break;
838                 default:
839                 case HIERARCHY_AUTO:
840                         tmp = "HIERARCHY_AUTO";
841                         break;
842         }
843         PutToDict(dict, "hierarchy_information", tmp);
844 }
845
846 PyObject *eDVBFrontend::readTransponderData(bool original)
847 {
848         PyObject *ret=PyDict_New();
849
850         if (ret)
851         {
852                 bool read=m_fd != -1;
853                 const char *tmp=0;
854
855                 PutToDict(ret, "tuner_number", m_fe);
856
857                 switch(m_type)
858                 {
859                         case feSatellite:
860                                 tmp = "DVB-S";
861                                 break;
862                         case feCable:
863                                 tmp = "DVB-C";
864                                 break;
865                         case feTerrestrial:
866                                 tmp = "DVB-T";
867                                 break;
868                         default:
869                                 tmp = "UNKNOWN";
870                                 read=false;
871                                 break;
872                 }
873                 PutToDict(ret, "tuner_type", tmp);
874
875                 if (read)
876                 {
877                         FRONTENDPARAMETERS front;
878
879                         tmp = "UNKNOWN";
880                         switch(m_state)
881                         {
882                                 case stateIdle:
883                                         tmp="IDLE";
884                                         break;
885                                 case stateTuning:
886                                         tmp="TUNING";
887                                         break;
888                                 case stateFailed:
889                                         tmp="FAILED";
890                                         break;
891                                 case stateLock:
892                                         tmp="LOCKED";
893                                         break;
894                                 case stateLostLock:
895                                         tmp="LOSTLOCK";
896                                         break;
897                                 default:
898                                         break;
899                         }
900                         PutToDict(ret, "tuner_state", tmp);
901
902                         PutToDict(ret, "tuner_locked", readFrontendData(Locked));
903                         PutToDict(ret, "tuner_synced", readFrontendData(Synced));
904                         PutToDict(ret, "tuner_bit_error_rate", readFrontendData(bitErrorRate));
905                         PutToDict(ret, "tuner_signal_power", readFrontendData(signalPower));
906                         PutToDict(ret, "tuner_signal_quality", readFrontendData(signalQuality));
907
908                         if (!original && ioctl(m_fd, FE_GET_FRONTEND, &front)<0)
909                                 eDebug("FE_GET_FRONTEND (%m)");
910                         else
911                         {
912                                 tmp = "INVERSION_AUTO";
913                                 switch(parm_inversion)
914                                 {
915                                         case INVERSION_ON:
916                                                 tmp = "INVERSION_ON";
917                                                 break;
918                                         case INVERSION_OFF:
919                                                 tmp = "INVERSION_OFF";
920                                                 break;
921                                         default:
922                                                 break;
923                                 }
924                                 if (tmp)
925                                         PutToDict(ret, "inversion", tmp);
926
927                                 switch(m_type)
928                                 {
929                                         case feSatellite:
930                                                 fillDictWithSatelliteData(ret, original?parm:front, this);
931                                                 break;
932                                         case feCable:
933                                                 fillDictWithCableData(ret, original?parm:front);
934                                                 break;
935                                         case feTerrestrial:
936                                                 fillDictWithTerrestrialData(ret, original?parm:front);
937                                                 break;
938                                 }
939                         }
940                 }
941         }
942         else
943         {
944                 Py_INCREF(Py_None);
945                 ret = Py_None;
946         }
947         return ret;
948 }
949
950 #ifndef FP_IOCTL_GET_ID
951 #define FP_IOCTL_GET_ID 0
952 #endif
953 int eDVBFrontend::readInputpower()
954 {
955         int power=m_fe;  // this is needed for read inputpower from the correct tuner !
956
957         // open front prozessor
958         int fp=::open("/dev/dbox/fp0", O_RDWR);
959         if (fp < 0)
960         {
961                 eDebug("couldn't open fp");
962                 return -1;
963         }
964         static bool old_fp = (::ioctl(fp, FP_IOCTL_GET_ID) < 0);
965         if ( ioctl( fp, old_fp ? 9 : 0x100, &power ) < 0 )
966         {
967                 eDebug("FP_IOCTL_GET_LNB_CURRENT failed (%m)");
968                 return -1;
969         }
970         ::close(fp);
971
972         return power;
973 }
974
975 bool eDVBFrontend::setSecSequencePos(int steps)
976 {
977         eDebug("set sequence pos %d", steps);
978         if (!steps)
979                 return false;
980         while( steps > 0 )
981         {
982                 if (m_sec_sequence.current() != m_sec_sequence.end())
983                         ++m_sec_sequence.current();
984                 --steps;
985         }
986         while( steps < 0 )
987         {
988                 if (m_sec_sequence.current() != m_sec_sequence.begin() && m_sec_sequence.current() != m_sec_sequence.end())
989                         --m_sec_sequence.current();
990                 ++steps;
991         }
992         return true;
993 }
994
995 void eDVBFrontend::tuneLoop()  // called by m_tuneTimer
996 {
997         int delay=0;
998         if ( m_sec_sequence && m_sec_sequence.current() != m_sec_sequence.end() )
999         {
1000 //              eDebug("tuneLoop %d\n", m_sec_sequence.current()->cmd);
1001                 switch (m_sec_sequence.current()->cmd)
1002                 {
1003                         case eSecCommand::SLEEP:
1004                                 delay = m_sec_sequence.current()++->msec;
1005                                 eDebug("[SEC] sleep %dms", delay);
1006                                 break;
1007                         case eSecCommand::GOTO:
1008                                 if ( !setSecSequencePos(m_sec_sequence.current()->steps) )
1009                                         ++m_sec_sequence.current();
1010                                 break;
1011                         case eSecCommand::SET_VOLTAGE:
1012                         {
1013                                 int voltage = m_sec_sequence.current()++->voltage;
1014                                 eDebug("[SEC] setVoltage %d", voltage);
1015                                 setVoltage(voltage);
1016                                 break;
1017                         }
1018                         case eSecCommand::IF_VOLTAGE_GOTO:
1019                         {
1020                                 eSecCommand::pair &compare = m_sec_sequence.current()->compare;
1021                                 if ( compare.voltage == m_curVoltage && setSecSequencePos(compare.steps) )
1022                                         break;
1023                                 ++m_sec_sequence.current();
1024                                 break;
1025                         }
1026                         case eSecCommand::IF_NOT_VOLTAGE_GOTO:
1027                         {
1028                                 eSecCommand::pair &compare = m_sec_sequence.current()->compare;
1029                                 if ( compare.voltage != m_curVoltage && setSecSequencePos(compare.steps) )
1030                                         break;
1031                                 ++m_sec_sequence.current();
1032                                 break;
1033                         }
1034                         case eSecCommand::SET_TONE:
1035                                 eDebug("[SEC] setTone %d", m_sec_sequence.current()->tone);
1036                                 setTone(m_sec_sequence.current()++->tone);
1037                                 break;
1038                         case eSecCommand::SEND_DISEQC:
1039                                 sendDiseqc(m_sec_sequence.current()->diseqc);
1040                                 eDebugNoNewLine("[SEC] sendDiseqc: ");
1041                                 for (int i=0; i < m_sec_sequence.current()->diseqc.len; ++i)
1042                                     eDebugNoNewLine("%02x", m_sec_sequence.current()->diseqc.data[i]);
1043                                 eDebug("");
1044                                 ++m_sec_sequence.current();
1045                                 break;
1046                         case eSecCommand::SEND_TONEBURST:
1047                                 eDebug("[SEC] sendToneburst: %d", m_sec_sequence.current()->toneburst);
1048                                 sendToneburst(m_sec_sequence.current()++->toneburst);
1049                                 break;
1050                         case eSecCommand::SET_FRONTEND:
1051                                 eDebug("[SEC] setFrontend");
1052                                 setFrontend();
1053                                 ++m_sec_sequence.current();
1054                                 break;
1055                         case eSecCommand::START_TUNE_TIMEOUT:
1056                                 m_timeout->start(5000, 1); // 5 sec timeout. TODO: symbolrate dependent
1057                                 ++m_sec_sequence.current();
1058                                 break;
1059                         case eSecCommand::SET_TIMEOUT:
1060                                 m_timeoutCount = m_sec_sequence.current()++->val;
1061                                 eDebug("[SEC] set timeout %d", m_timeoutCount);
1062                                 break;
1063                         case eSecCommand::IF_TIMEOUT_GOTO:
1064                                 if (!m_timeoutCount)
1065                                 {
1066                                         eDebug("[SEC] rotor timout");
1067                                         m_sec->setRotorMoving(false);
1068                                         setSecSequencePos(m_sec_sequence.current()->steps);
1069                                 }
1070                                 else
1071                                         ++m_sec_sequence.current();
1072                                 break;
1073                         case eSecCommand::MEASURE_IDLE_INPUTPOWER:
1074                         {
1075                                 int idx = m_sec_sequence.current()++->val;
1076                                 if ( idx == 0 || idx == 1 )
1077                                 {
1078                                         m_idleInputpower[idx] = readInputpower();
1079                                         eDebug("[SEC] idleInputpower[%d] is %d", idx, m_idleInputpower[idx]);
1080                                 }
1081                                 else
1082                                         eDebug("[SEC] idleInputpower measure index(%d) out of bound !!!", idx);
1083                                 break;
1084                         }
1085                         case eSecCommand::IF_MEASURE_IDLE_WAS_NOT_OK_GOTO:
1086                         {
1087                                 eSecCommand::pair &compare = m_sec_sequence.current()->compare;
1088                                 int idx = compare.voltage;
1089                                 if ( idx == 0 || idx == 1 )
1090                                 {
1091                                         int idle = readInputpower();
1092                                         int diff = abs(idle-m_idleInputpower[idx]);
1093                                         if ( diff > 0)
1094                                         {
1095                                                 eDebug("measure idle(%d) was not okay.. (%d - %d = %d) retry", idx, m_idleInputpower[idx], idle, diff);
1096                                                 setSecSequencePos(compare.steps);
1097                                                 break;
1098                                         }
1099                                 }
1100                                 ++m_sec_sequence.current();
1101                                 break;
1102                         }
1103                         case eSecCommand::IF_TUNER_LOCKED_GOTO:
1104                         {
1105                                 eSecCommand::rotor &cmd = m_sec_sequence.current()->measure;
1106                                 if (readFrontendData(Locked))
1107                                 {
1108                                         eDebug("[SEC] locked step %d ok", cmd.okcount);
1109                                         ++cmd.okcount;
1110                                         if (cmd.okcount > 12)
1111                                         {
1112                                                 eDebug("ok > 12 .. goto %d\n",m_sec_sequence.current()->steps);
1113                                                 setSecSequencePos(cmd.steps);
1114                                                 break;
1115                                         }
1116                                 }
1117                                 else
1118                                 {
1119                                         eDebug("[SEC] rotor locked step %d failed", cmd.okcount);
1120                                         --m_timeoutCount;
1121                                         if (!m_timeoutCount && m_retryCount > 0)
1122                                                 --m_retryCount;
1123                                         cmd.okcount=0;
1124                                 }
1125                                 ++m_sec_sequence.current();
1126                                 break;
1127                         }
1128                         case eSecCommand::MEASURE_RUNNING_INPUTPOWER:
1129                                 m_runningInputpower = readInputpower();
1130                                 eDebug("[SEC] runningInputpower is %d", m_runningInputpower);
1131                                 ++m_sec_sequence.current();
1132                                 break;
1133                         case eSecCommand::IF_INPUTPOWER_DELTA_GOTO:
1134                         {
1135                                 int idleInputpower = m_idleInputpower[ (m_curVoltage&1) ? 0 : 1];
1136                                 eSecCommand::rotor &cmd = m_sec_sequence.current()->measure;
1137                                 const char *txt = cmd.direction ? "running" : "stopped";
1138                                 eDebug("[SEC] waiting for rotor %s %d, idle %d, delta %d",
1139                                         txt,
1140                                         m_runningInputpower,
1141                                         idleInputpower,
1142                                         cmd.deltaA);
1143                                 if ( (cmd.direction && abs(m_runningInputpower - idleInputpower) >= cmd.deltaA)
1144                                         || (!cmd.direction && abs(m_runningInputpower - idleInputpower) <= cmd.deltaA) )
1145                                 {
1146                                         ++cmd.okcount;
1147                                         eDebug("[SEC] rotor %s step %d ok", txt, cmd.okcount);
1148                                         if ( cmd.okcount > 6 )
1149                                         {
1150                                                 m_sec->setRotorMoving(cmd.direction);
1151                                                 eDebug("[SEC] rotor is %s", txt);
1152                                                 if (setSecSequencePos(cmd.steps))
1153                                                         break;
1154                                         }
1155                                 }
1156                                 else
1157                                 {
1158                                         eDebug("[SEC] rotor not %s... reset counter.. increase timeout", txt);
1159                                         --m_timeoutCount;
1160                                         if (!m_timeoutCount && m_retryCount > 0)
1161                                                 --m_retryCount;
1162                                         cmd.okcount=0;
1163                                 }
1164                                 ++m_sec_sequence.current();
1165                                 break;
1166                         }
1167                         case eSecCommand::IF_ROTORPOS_VALID_GOTO:
1168                                 if (m_data[5] != -1 && m_data[6] != -1)
1169                                         setSecSequencePos(m_sec_sequence.current()->steps);
1170                                 else
1171                                         ++m_sec_sequence.current();
1172                                 break;
1173                         case eSecCommand::INVALIDATE_CURRENT_ROTORPARMS:
1174                                 m_data[5] = m_data[6] = -1;
1175                                 eDebug("[SEC] invalidate current rotorparams");
1176                                 ++m_sec_sequence.current();
1177                                 break;
1178                         case eSecCommand::UPDATE_CURRENT_ROTORPARAMS:
1179                                 m_data[5] = m_data[3];
1180                                 m_data[6] = m_data[4];
1181                                 eDebug("[SEC] update current rotorparams %d %04x %d", m_timeoutCount, m_data[5], m_data[6]);
1182                                 ++m_sec_sequence.current();
1183                                 break;
1184                         case eSecCommand::SET_ROTOR_DISEQC_RETRYS:
1185                                 m_retryCount = m_sec_sequence.current()++->val;
1186                                 eDebug("[SEC] set rotor retries %d", m_retryCount);
1187                                 break;
1188                         case eSecCommand::IF_NO_MORE_ROTOR_DISEQC_RETRYS_GOTO:
1189                                 if (!m_retryCount)
1190                                 {
1191                                         eDebug("[SEC] no more rotor retrys");
1192                                         setSecSequencePos(m_sec_sequence.current()->steps);
1193                                 }
1194                                 else
1195                                         ++m_sec_sequence.current();
1196                                 break;
1197                         case eSecCommand::SET_POWER_LIMITING_MODE:
1198                         {
1199                                 int fd = m_fe ?
1200                                         ::open("/dev/i2c/1", O_RDWR) :
1201                                         ::open("/dev/i2c/0", O_RDWR);
1202
1203                                 unsigned char data[2];
1204                                 ::ioctl(fd, I2C_SLAVE_FORCE, 0x10 >> 1);
1205                                 if(::read(fd, data, 1) != 1)
1206                                         eDebug("[SEC] error read lnbp (%m)");
1207                                 if ( m_sec_sequence.current()->mode == eSecCommand::modeStatic )
1208                                 {
1209                                         data[0] |= 0x80;  // enable static current limiting
1210                                         eDebug("[SEC] set static current limiting");
1211                                 }
1212                                 else
1213                                 {
1214                                         data[0] &= ~0x80;  // enable dynamic current limiting
1215                                         eDebug("[SEC] set dynamic current limiting");
1216                                 }
1217                                 if(::write(fd, data, 1) != 1)
1218                                         eDebug("[SEC] error write lnbp (%m)");
1219                                 ::close(fd);
1220                                 ++m_sec_sequence.current();
1221                                 break;
1222                         }
1223                         default:
1224                                 ++m_sec_sequence.current();
1225                                 eDebug("[SEC] unhandled sec command");
1226                 }
1227                 m_tuneTimer->start(delay,true);
1228         }
1229 }
1230
1231 void eDVBFrontend::setFrontend()
1232 {
1233         eDebug("setting frontend %d", m_fe);
1234         m_sn->start();
1235         feEvent(-1);
1236         if (ioctl(m_fd, FE_SET_FRONTEND, &parm) == -1)
1237         {
1238                 perror("FE_SET_FRONTEND failed");
1239                 return;
1240         }
1241 }
1242
1243 RESULT eDVBFrontend::getFrontendType(int &t)
1244 {
1245         if (m_type == -1)
1246                 return -ENODEV;
1247         t = m_type;
1248         return 0;
1249 }
1250
1251 RESULT eDVBFrontend::prepare_sat(const eDVBFrontendParametersSatellite &feparm)
1252 {
1253         int res;
1254         if (!m_sec)
1255         {
1256                 eWarning("no SEC module active!");
1257                 return -ENOENT;
1258         }
1259         res = m_sec->prepare(*this, parm, feparm, 1 << m_fe);
1260         if (!res)
1261         {
1262                 parm_u_qpsk_symbol_rate = feparm.symbol_rate;
1263                 switch (feparm.inversion)
1264                 {
1265                         case eDVBFrontendParametersSatellite::Inversion::On:
1266                                 parm_inversion = INVERSION_ON;
1267                                 break;
1268                         case eDVBFrontendParametersSatellite::Inversion::Off:
1269                                 parm_inversion = INVERSION_OFF;
1270                                 break;
1271                         default:
1272                         case eDVBFrontendParametersSatellite::Inversion::Unknown:
1273                                 parm_inversion = INVERSION_AUTO;
1274                                 break;
1275                 }
1276                 switch (feparm.fec)
1277                 {
1278                         default:
1279                         case eDVBFrontendParametersSatellite::FEC::fNone:
1280                                 eDebug("no fec set.. assume auto");
1281                         case eDVBFrontendParametersSatellite::FEC::fAuto:
1282                                 parm_u_qpsk_fec_inner = FEC_AUTO;
1283                                 break;
1284                         case eDVBFrontendParametersSatellite::FEC::f1_2:
1285                                 parm_u_qpsk_fec_inner = FEC_1_2;
1286                                 break;
1287                         case eDVBFrontendParametersSatellite::FEC::f2_3:
1288                                 parm_u_qpsk_fec_inner = FEC_2_3;
1289                                 break;
1290                         case eDVBFrontendParametersSatellite::FEC::f3_4:
1291                                 parm_u_qpsk_fec_inner = FEC_3_4;
1292                                 break;
1293                         case eDVBFrontendParametersSatellite::FEC::f5_6:
1294                                 parm_u_qpsk_fec_inner = FEC_5_6;
1295                                 break;
1296                         case eDVBFrontendParametersSatellite::FEC::f7_8:
1297                                 parm_u_qpsk_fec_inner = FEC_7_8;
1298                                 break;
1299                 }
1300                 // FIXME !!! get frequency range from tuner
1301                 if ( parm_frequency < 900000 || parm_frequency > 2200000 )
1302                 {
1303                         eDebug("%d mhz out of tuner range.. dont tune", parm_frequency/1000);
1304                         return -EINVAL;
1305                 }
1306                 eDebug("tuning to %d mhz", parm_frequency/1000);
1307         }
1308         return res;
1309 }
1310
1311 RESULT eDVBFrontend::prepare_cable(const eDVBFrontendParametersCable &feparm)
1312 {
1313         parm_frequency = feparm.frequency * 1000;
1314         parm_u_qam_symbol_rate = feparm.symbol_rate;
1315         switch (feparm.modulation)
1316         {
1317         case eDVBFrontendParametersCable::Modulation::QAM16:
1318                 parm_u_qam_modulation = QAM_16;
1319                 break;
1320         case eDVBFrontendParametersCable::Modulation::QAM32:
1321                 parm_u_qam_modulation = QAM_32;
1322                 break;
1323         case eDVBFrontendParametersCable::Modulation::QAM64:
1324                 parm_u_qam_modulation = QAM_64;
1325                 break;
1326         case eDVBFrontendParametersCable::Modulation::QAM128:
1327                 parm_u_qam_modulation = QAM_128;
1328                 break;
1329         case eDVBFrontendParametersCable::Modulation::QAM256:
1330                 parm_u_qam_modulation = QAM_256;
1331                 break;
1332         default:
1333         case eDVBFrontendParametersCable::Modulation::Auto:
1334                 parm_u_qam_modulation = QAM_AUTO;
1335                 break;
1336         }
1337         switch (feparm.inversion)
1338         {
1339         case eDVBFrontendParametersCable::Inversion::On:
1340                 parm_inversion = INVERSION_ON;
1341                 break;
1342         case eDVBFrontendParametersCable::Inversion::Off:
1343                 parm_inversion = INVERSION_OFF;
1344                 break;
1345         default:
1346         case eDVBFrontendParametersCable::Inversion::Unknown:
1347                 parm_inversion = INVERSION_AUTO;
1348                 break;
1349         }
1350         switch (feparm.fec_inner)
1351         {
1352         case eDVBFrontendParametersCable::FEC::fNone:
1353                 parm_u_qam_fec_inner = FEC_NONE;
1354                 break;
1355         case eDVBFrontendParametersCable::FEC::f1_2:
1356                 parm_u_qam_fec_inner = FEC_1_2;
1357                 break;
1358         case eDVBFrontendParametersCable::FEC::f2_3:
1359                 parm_u_qam_fec_inner = FEC_2_3;
1360                 break;
1361         case eDVBFrontendParametersCable::FEC::f3_4:
1362                 parm_u_qam_fec_inner = FEC_3_4;
1363                 break;
1364         case eDVBFrontendParametersCable::FEC::f5_6:
1365                 parm_u_qam_fec_inner = FEC_5_6;
1366                 break;
1367         case eDVBFrontendParametersCable::FEC::f7_8:
1368                 parm_u_qam_fec_inner = FEC_7_8;
1369                 break;
1370 #if HAVE_DVB_API_VERSION >= 3
1371         case eDVBFrontendParametersCable::FEC::f8_9:
1372                 parm_u_qam_fec_inner = FEC_8_9;
1373                 break;
1374 #endif
1375         default:
1376         case eDVBFrontendParametersCable::FEC::fAuto:
1377                 parm_u_qam_fec_inner = FEC_AUTO;
1378                 break;
1379         }
1380         return 0;
1381 }
1382
1383 RESULT eDVBFrontend::prepare_terrestrial(const eDVBFrontendParametersTerrestrial &feparm)
1384 {
1385         parm_frequency = feparm.frequency;
1386
1387         switch (feparm.bandwidth)
1388         {
1389         case eDVBFrontendParametersTerrestrial::Bandwidth::Bw8MHz:
1390                 parm_u_ofdm_bandwidth = BANDWIDTH_8_MHZ;
1391                 break;
1392         case eDVBFrontendParametersTerrestrial::Bandwidth::Bw7MHz:
1393                 parm_u_ofdm_bandwidth = BANDWIDTH_7_MHZ;
1394                 break;
1395         case eDVBFrontendParametersTerrestrial::Bandwidth::Bw6MHz:
1396                 parm_u_ofdm_bandwidth = BANDWIDTH_6_MHZ;
1397                 break;
1398         default:
1399         case eDVBFrontendParametersTerrestrial::Bandwidth::BwAuto:
1400                 parm_u_ofdm_bandwidth = BANDWIDTH_AUTO;
1401                 break;
1402         }
1403         switch (feparm.code_rate_LP)
1404         {
1405         case eDVBFrontendParametersTerrestrial::FEC::f1_2:
1406                 parm_u_ofdm_code_rate_LP = FEC_1_2;
1407                 break;
1408         case eDVBFrontendParametersTerrestrial::FEC::f2_3:
1409                 parm_u_ofdm_code_rate_LP = FEC_2_3;
1410                 break;
1411         case eDVBFrontendParametersTerrestrial::FEC::f3_4:
1412                 parm_u_ofdm_code_rate_LP = FEC_3_4;
1413                 break;
1414         case eDVBFrontendParametersTerrestrial::FEC::f5_6:
1415                 parm_u_ofdm_code_rate_LP = FEC_5_6;
1416                 break;
1417         case eDVBFrontendParametersTerrestrial::FEC::f7_8:
1418                 parm_u_ofdm_code_rate_LP = FEC_7_8;
1419                 break;
1420         default:
1421         case eDVBFrontendParametersTerrestrial::FEC::fAuto:
1422                 parm_u_ofdm_code_rate_LP = FEC_AUTO;
1423                 break;
1424         }
1425         switch (feparm.code_rate_HP)
1426         {
1427         case eDVBFrontendParametersTerrestrial::FEC::f1_2:
1428                 parm_u_ofdm_code_rate_HP = FEC_1_2;
1429                 break;
1430         case eDVBFrontendParametersTerrestrial::FEC::f2_3:
1431                 parm_u_ofdm_code_rate_HP = FEC_2_3;
1432                 break;
1433         case eDVBFrontendParametersTerrestrial::FEC::f3_4:
1434                 parm_u_ofdm_code_rate_HP = FEC_3_4;
1435                 break;
1436         case eDVBFrontendParametersTerrestrial::FEC::f5_6:
1437                 parm_u_ofdm_code_rate_HP = FEC_5_6;
1438                 break;
1439         case eDVBFrontendParametersTerrestrial::FEC::f7_8:
1440                 parm_u_ofdm_code_rate_HP = FEC_7_8;
1441                 break;
1442         default:
1443         case eDVBFrontendParametersTerrestrial::FEC::fAuto:
1444                 parm_u_ofdm_code_rate_HP = FEC_AUTO;
1445                 break;
1446         }
1447         switch (feparm.modulation)
1448         {
1449         case eDVBFrontendParametersTerrestrial::Modulation::QPSK:
1450                 parm_u_ofdm_constellation = QPSK;
1451                 break;
1452         case eDVBFrontendParametersTerrestrial::Modulation::QAM16:
1453                 parm_u_ofdm_constellation = QAM_16;
1454                 break;
1455         case eDVBFrontendParametersTerrestrial::Modulation::QAM64:
1456                 parm_u_ofdm_constellation = QAM_64;
1457                 break;
1458         default:
1459         case eDVBFrontendParametersTerrestrial::Modulation::Auto:
1460                 parm_u_ofdm_constellation = QAM_AUTO;
1461                 break;
1462         }
1463         switch (feparm.transmission_mode)
1464         {
1465         case eDVBFrontendParametersTerrestrial::TransmissionMode::TM2k:
1466                 parm_u_ofdm_transmission_mode = TRANSMISSION_MODE_2K;
1467                 break;
1468         case eDVBFrontendParametersTerrestrial::TransmissionMode::TM8k:
1469                 parm_u_ofdm_transmission_mode = TRANSMISSION_MODE_8K;
1470                 break;
1471         default:
1472         case eDVBFrontendParametersTerrestrial::TransmissionMode::TMAuto:
1473                 parm_u_ofdm_transmission_mode = TRANSMISSION_MODE_AUTO;
1474                 break;
1475         }
1476         switch (feparm.guard_interval)
1477         {
1478                 case eDVBFrontendParametersTerrestrial::GuardInterval::GI_1_32:
1479                         parm_u_ofdm_guard_interval = GUARD_INTERVAL_1_32;
1480                         break;
1481                 case eDVBFrontendParametersTerrestrial::GuardInterval::GI_1_16:
1482                         parm_u_ofdm_guard_interval = GUARD_INTERVAL_1_16;
1483                         break;
1484                 case eDVBFrontendParametersTerrestrial::GuardInterval::GI_1_8:
1485                         parm_u_ofdm_guard_interval = GUARD_INTERVAL_1_8;
1486                         break;
1487                 case eDVBFrontendParametersTerrestrial::GuardInterval::GI_1_4:
1488                         parm_u_ofdm_guard_interval = GUARD_INTERVAL_1_4;
1489                         break;
1490                 default:
1491                 case eDVBFrontendParametersTerrestrial::GuardInterval::GI_Auto:
1492                         parm_u_ofdm_guard_interval = GUARD_INTERVAL_AUTO;
1493                         break;
1494         }
1495         switch (feparm.hierarchy)
1496         {
1497                 case eDVBFrontendParametersTerrestrial::Hierarchy::HNone:
1498                         parm_u_ofdm_hierarchy_information = HIERARCHY_NONE;
1499                         break;
1500                 case eDVBFrontendParametersTerrestrial::Hierarchy::H1:
1501                         parm_u_ofdm_hierarchy_information = HIERARCHY_1;
1502                         break;
1503                 case eDVBFrontendParametersTerrestrial::Hierarchy::H2:
1504                         parm_u_ofdm_hierarchy_information = HIERARCHY_2;
1505                         break;
1506                 case eDVBFrontendParametersTerrestrial::Hierarchy::H4:
1507                         parm_u_ofdm_hierarchy_information = HIERARCHY_4;
1508                         break;
1509                 default:
1510                 case eDVBFrontendParametersTerrestrial::Hierarchy::HAuto:
1511                         parm_u_ofdm_hierarchy_information = HIERARCHY_AUTO;
1512                         break;
1513         }
1514         switch (feparm.inversion)
1515         {
1516         case eDVBFrontendParametersTerrestrial::Inversion::On:
1517                 parm_inversion = INVERSION_ON;
1518                 break;
1519         case eDVBFrontendParametersTerrestrial::Inversion::Off:
1520                 parm_inversion = INVERSION_OFF;
1521                 break;
1522         default:
1523         case eDVBFrontendParametersTerrestrial::Inversion::Unknown:
1524                 parm_inversion = INVERSION_AUTO;
1525                 break;
1526         }
1527         return 0;
1528 }
1529
1530 RESULT eDVBFrontend::tune(const iDVBFrontendParameters &where)
1531 {
1532         eDebug("(%d)tune", m_fe);
1533
1534         m_timeout->stop();
1535
1536         int res=0;
1537
1538         if (m_type == -1)
1539                 return -ENODEV;
1540
1541         m_sn->stop();
1542         m_sec_sequence.clear();
1543
1544         switch (m_type)
1545         {
1546         case feSatellite:
1547         {
1548                 eDVBFrontendParametersSatellite feparm;
1549                 if (where.getDVBS(feparm))
1550                 {
1551                         eDebug("no dvbs data!");
1552                         return -EINVAL;
1553                 }
1554                 res=prepare_sat(feparm);
1555                 m_sec->setRotorMoving(false);
1556                 break;
1557         }
1558         case feCable:
1559         {
1560                 eDVBFrontendParametersCable feparm;
1561                 if (where.getDVBC(feparm))
1562                         return -EINVAL;
1563                 res=prepare_cable(feparm);
1564                 if (!res)
1565                 {
1566                         m_sec_sequence.push_back( eSecCommand(eSecCommand::START_TUNE_TIMEOUT) );
1567                         m_sec_sequence.push_back( eSecCommand(eSecCommand::SET_FRONTEND) );
1568                 }
1569                 break;
1570         }
1571         case feTerrestrial:
1572         {
1573                 eDVBFrontendParametersTerrestrial feparm;
1574                 if (where.getDVBT(feparm))
1575                 {
1576                         eDebug("no -T data");
1577                         return -EINVAL;
1578                 }
1579                 res=prepare_terrestrial(feparm);
1580                 if (!res)
1581                 {
1582                         m_sec_sequence.push_back( eSecCommand(eSecCommand::START_TUNE_TIMEOUT) );
1583                         m_sec_sequence.push_back( eSecCommand(eSecCommand::SET_FRONTEND) );
1584                 }
1585                 break;
1586         }
1587         }
1588
1589         if (!res)  // prepare ok
1590         {
1591                 m_tuneTimer->start(0,true);
1592                 m_sec_sequence.current() = m_sec_sequence.begin();
1593
1594                 if (m_state != stateTuning)
1595                 {
1596                         m_tuning = 1;
1597                         m_state = stateTuning;
1598                         m_stateChanged(this);
1599                 }
1600         }
1601
1602         return res;
1603 }
1604
1605 RESULT eDVBFrontend::connectStateChange(const Slot1<void,iDVBFrontend*> &stateChange, ePtr<eConnection> &connection)
1606 {
1607         connection = new eConnection(this, m_stateChanged.connect(stateChange));
1608         return 0;
1609 }
1610
1611 RESULT eDVBFrontend::setVoltage(int voltage)
1612 {
1613         if (m_type != feSatellite)
1614                 return -1;
1615 #if HAVE_DVB_API_VERSION < 3
1616         secVoltage vlt;
1617 #else
1618         bool increased=false;
1619         fe_sec_voltage_t vlt;
1620 #endif
1621         m_curVoltage=voltage;
1622         switch (voltage)
1623         {
1624         case voltageOff:
1625                 for (int i=0; i < 3; ++i)  // reset diseqc
1626                         m_data[i]=-1;
1627                 vlt = SEC_VOLTAGE_OFF;
1628                 break;
1629         case voltage13_5:
1630 #if HAVE_DVB_API_VERSION < 3
1631                 vlt = SEC_VOLTAGE_13_5;
1632                 break;
1633 #else
1634                 increased = true;
1635 #endif
1636         case voltage13:
1637                 vlt = SEC_VOLTAGE_13;
1638                 break;
1639         case voltage18_5:
1640 #if HAVE_DVB_API_VERSION < 3
1641                 vlt = SEC_VOLTAGE_18_5;
1642                 break;
1643 #else
1644                 increased = true;
1645 #endif
1646         case voltage18:
1647                 vlt = SEC_VOLTAGE_18;
1648                 break;
1649         default:
1650                 return -ENODEV;
1651         }
1652 #if HAVE_DVB_API_VERSION < 3
1653         return ::ioctl(m_secfd, SEC_SET_VOLTAGE, vlt);
1654 #else
1655         if (::ioctl(m_fd, FE_ENABLE_HIGH_LNB_VOLTAGE, increased) < 0)
1656                 perror("FE_ENABLE_HIGH_LNB_VOLTAGE");
1657         return ::ioctl(m_fd, FE_SET_VOLTAGE, vlt);
1658 #endif
1659 }
1660
1661 RESULT eDVBFrontend::getState(int &state)
1662 {
1663         state = m_state;
1664         return 0;
1665 }
1666
1667 RESULT eDVBFrontend::setTone(int t)
1668 {
1669         if (m_type != feSatellite)
1670                 return -1;
1671 #if HAVE_DVB_API_VERSION < 3
1672         secToneMode_t tone;
1673 #else
1674         fe_sec_tone_mode_t tone;
1675 #endif
1676
1677         switch (t)
1678         {
1679         case toneOn:
1680                 tone = SEC_TONE_ON;
1681                 break;
1682         case toneOff:
1683                 tone = SEC_TONE_OFF;
1684                 break;
1685         default:
1686                 return -ENODEV;
1687         }
1688 #if HAVE_DVB_API_VERSION < 3    
1689         return ::ioctl(m_secfd, SEC_SET_TONE, tone);
1690 #else   
1691         return ::ioctl(m_fd, FE_SET_TONE, tone);
1692 #endif
1693 }
1694
1695 #if HAVE_DVB_API_VERSION < 3 && !defined(SEC_DISEQC_SEND_MASTER_CMD)
1696         #define SEC_DISEQC_SEND_MASTER_CMD _IOW('o', 97, struct secCommand *)
1697 #endif
1698
1699 RESULT eDVBFrontend::sendDiseqc(const eDVBDiseqcCommand &diseqc)
1700 {
1701 #if HAVE_DVB_API_VERSION < 3
1702         struct secCommand cmd;
1703         cmd.type = SEC_CMDTYPE_DISEQC_RAW;
1704         cmd.u.diseqc.cmdtype = diseqc.data[0];
1705         cmd.u.diseqc.addr = diseqc.data[1];
1706         cmd.u.diseqc.cmd = diseqc.data[2];
1707         cmd.u.diseqc.numParams = diseqc.len-3;
1708         memcpy(cmd.u.diseqc.params, diseqc.data+3, diseqc.len-3);
1709         if (::ioctl(m_secfd, SEC_DISEQC_SEND_MASTER_CMD, &cmd))
1710 #else
1711         struct dvb_diseqc_master_cmd cmd;
1712         memcpy(cmd.msg, diseqc.data, diseqc.len);
1713         cmd.msg_len = diseqc.len;
1714         if (::ioctl(m_fd, FE_DISEQC_SEND_MASTER_CMD, &cmd))
1715 #endif
1716                 return -EINVAL;
1717         return 0;
1718 }
1719
1720 #if HAVE_DVB_API_VERSION < 3 && !defined(SEC_DISEQC_SEND_BURST)
1721         #define SEC_DISEQC_SEND_BURST _IO('o', 96)
1722 #endif
1723 RESULT eDVBFrontend::sendToneburst(int burst)
1724 {
1725 #if HAVE_DVB_API_VERSION < 3
1726         secMiniCmd cmd = SEC_MINI_NONE;
1727 #else
1728         fe_sec_mini_cmd_t cmd = SEC_MINI_A;
1729 #endif
1730         if ( burst == eDVBSatelliteDiseqcParameters::A )
1731                 cmd = SEC_MINI_A;
1732         else if ( burst == eDVBSatelliteDiseqcParameters::B )
1733                 cmd = SEC_MINI_B;
1734 #if HAVE_DVB_API_VERSION < 3
1735         if (::ioctl(m_secfd, SEC_DISEQC_SEND_BURST, cmd))
1736                 return -EINVAL;
1737 #else
1738         if (::ioctl(m_fd, FE_DISEQC_SEND_BURST, cmd))
1739                 return -EINVAL;
1740 #endif
1741         return 0;
1742 }
1743
1744 RESULT eDVBFrontend::setSEC(iDVBSatelliteEquipmentControl *sec)
1745 {
1746         m_sec = sec;
1747         return 0;
1748 }
1749
1750 RESULT eDVBFrontend::setSecSequence(const eSecCommandList &list)
1751 {
1752         m_sec_sequence = list;
1753         return 0;
1754 }
1755
1756 RESULT eDVBFrontend::getData(int num, int &data)
1757 {
1758         if ( num < (int)(sizeof(m_data)/sizeof(int)) )
1759         {
1760                 data = m_data[num];
1761                 return 0;
1762         }
1763         return -EINVAL;
1764 }
1765
1766 RESULT eDVBFrontend::setData(int num, int val)
1767 {
1768         if ( num < (int)(sizeof(m_data)/sizeof(int)) )
1769         {
1770                 m_data[num] = val;
1771                 return 0;
1772         }
1773         return -EINVAL;
1774 }
1775
1776 int eDVBFrontend::isCompatibleWith(ePtr<iDVBFrontendParameters> &feparm)
1777 {
1778         int type;
1779         if (feparm->getSystem(type) || type != m_type)
1780                 return 0;
1781
1782         if (m_type == eDVBFrontend::feSatellite)
1783         {
1784                 ASSERT(m_sec);
1785                 eDVBFrontendParametersSatellite sat_parm;
1786                 ASSERT(!feparm->getDVBS(sat_parm));
1787                 return m_sec->canTune(sat_parm, this, 1 << m_fe);
1788         }
1789         return 1;
1790 }