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