implement readFrontendData method to get a python dictionary containing data
[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         fe->getData(0, csw);
540         fe->getData(9, freq_offset);
541         int frequency = parm.frequency + freq_offset;
542         PutToDict(dict, "frequency", frequency);
543         PutToDict(dict, "inversion", parm.inversion);
544         PutToDict(dict, "symbol_rate", parm.u.qpsk.symbol_rate);
545         const char *fec=0;
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 /*
574 #define parm.frequency parm.Frequency
575 #define parm.inversion parm.Inversion
576 #define parm.u.qam.symbol_rate parm.u.qam.SymbolRate
577 #define parm.u.qam.fec_inner parm.u.qam.FEC_inner
578 #define parm.u.qam.modulation parm.u.qam.QAM
579 */
580 }
581
582 void fillDictWithTerrestrialData(PyObject *dict, const FRONTENDPARAMETERS &parm)
583 {
584 /*
585 #define parm.frequency parm.Frequency
586 #define parm.inversion parm.Inversion
587 #define parm.u.ofdm.bandwidth parm.u.ofdm.bandWidth
588 #define parm.u.ofdm.code_rate_LP parm.u.ofdm.LP_CodeRate
589 #define parm.u.ofdm.code_rate_HP parm.u.ofdm.HP_CodeRate
590 #define parm.u.ofdm.constellation parm.u.ofdm.Constellation
591 #define parm.u.ofdm.transmission_mode parm.u.ofdm.TransmissionMode
592 #define parm.u.ofdm.guard_interval parm.u.ofdm.guardInterval
593 #define parm.u.ofdm.hierarchy_information parm.u.ofdm.HierarchyInformation
594 */
595 }
596
597 PyObject *eDVBFrontend::readTransponderData(bool original)
598 {
599         PyObject *ret=PyDict_New();
600
601         if (ret)
602         {
603                 bool read=m_fd != -1;
604                 const char *tmp = "unknown";
605
606                 PutToDict(ret, "tuner number", m_fe);
607
608                 switch(m_type)
609                 {
610                         case feSatellite:
611                                 tmp = "DVB-S";
612                                 break;
613                         case feCable:
614                                 tmp="DVB-C";
615                                 break;
616                         case feTerrestrial:
617                                 tmp="DVB-T";
618                                 break;
619                         default:
620                                 read=false;
621                                 break;
622                 }
623                 PutToDict(ret, "tuner type", tmp);
624
625                 if (read)
626                 {
627                         FRONTENDPARAMETERS front;
628
629                         tmp = "unknown";
630                         switch(m_state)
631                         {
632                                 case stateIdle:
633                                         tmp="idle";
634                                         break;
635                                 case stateTuning:
636                                         tmp="tuning";
637                                         break;
638                                 case stateFailed:
639                                         tmp="failed";
640                                         break;
641                                 case stateLock:
642                                         tmp="lock";
643                                         break;
644                                 case stateLostLock:
645                                         tmp="lostlock";
646                                         break;
647                                 default:
648                                         break;
649                         }
650                         PutToDict(ret, "tuner state", tmp);
651
652                         PutToDict(ret, "tuner locked", readFrontendData(Locked));
653                         PutToDict(ret, "tuner synced", readFrontendData(Synced));
654                         PutToDict(ret, "tuner bit_error_rate", readFrontendData(bitErrorRate));
655                         PutToDict(ret, "tuner signal_power", readFrontendData(signalPower));
656                         PutToDict(ret, "tuner signal_quality", readFrontendData(signalQuality));
657
658                         if (!original && ioctl(m_fd, FE_GET_FRONTEND, &front)<0)
659                                 eDebug("FE_GET_FRONTEND (%m)");
660                         else
661                         {
662                                 switch(m_type)
663                                 {
664                                         case feSatellite:
665                                                 fillDictWithSatelliteData(ret, original?parm:front, this);
666                                                 break;
667                                         case feCable:
668                                                 fillDictWithCableData(ret, original?parm:front);
669                                                 break;
670                                         case feTerrestrial:
671                                                 fillDictWithTerrestrialData(ret, original?parm:front);
672                                                 break;
673                                 }
674                         }
675                 }
676         }
677         else
678         {
679                 Py_INCREF(Py_None);
680                 ret = Py_None;
681         }
682         return ret;
683 }
684
685 #ifndef FP_IOCTL_GET_ID
686 #define FP_IOCTL_GET_ID 0
687 #endif
688 int eDVBFrontend::readInputpower()
689 {
690         int power=m_fe;  // this is needed for read inputpower from the correct tuner !
691
692         // open front prozessor
693         int fp=::open("/dev/dbox/fp0", O_RDWR);
694         if (fp < 0)
695         {
696                 eDebug("couldn't open fp");
697                 return -1;
698         }
699         static bool old_fp = (::ioctl(fp, FP_IOCTL_GET_ID) < 0);
700         if ( ioctl( fp, old_fp ? 9 : 0x100, &power ) < 0 )
701         {
702                 eDebug("FP_IOCTL_GET_LNB_CURRENT failed (%m)");
703                 return -1;
704         }
705         ::close(fp);
706
707         return power;
708 }
709
710 bool eDVBFrontend::setSecSequencePos(int steps)
711 {
712         eDebug("set sequence pos %d", steps);
713         if (!steps)
714                 return false;
715         while( steps > 0 )
716         {
717                 if (m_sec_sequence.current() != m_sec_sequence.end())
718                         ++m_sec_sequence.current();
719                 --steps;
720         }
721         while( steps < 0 )
722         {
723                 if (m_sec_sequence.current() != m_sec_sequence.begin() && m_sec_sequence.current() != m_sec_sequence.end())
724                         --m_sec_sequence.current();
725                 ++steps;
726         }
727         return true;
728 }
729
730 void eDVBFrontend::tuneLoop()  // called by m_tuneTimer
731 {
732         int delay=0;
733         if ( m_sec_sequence && m_sec_sequence.current() != m_sec_sequence.end() )
734         {
735 //              eDebug("tuneLoop %d\n", m_sec_sequence.current()->cmd);
736                 switch (m_sec_sequence.current()->cmd)
737                 {
738                         case eSecCommand::SLEEP:
739                                 delay = m_sec_sequence.current()++->msec;
740                                 eDebug("[SEC] sleep %dms", delay);
741                                 break;
742                         case eSecCommand::GOTO:
743                                 if ( !setSecSequencePos(m_sec_sequence.current()->steps) )
744                                         ++m_sec_sequence.current();
745                                 break;
746                         case eSecCommand::SET_VOLTAGE:
747                         {
748                                 int voltage = m_sec_sequence.current()++->voltage;
749                                 eDebug("[SEC] setVoltage %d", voltage);
750                                 setVoltage(voltage);
751                                 break;
752                         }
753                         case eSecCommand::IF_VOLTAGE_GOTO:
754                         {
755                                 eSecCommand::pair &compare = m_sec_sequence.current()->compare;
756                                 if ( compare.voltage == m_curVoltage && setSecSequencePos(compare.steps) )
757                                         break;
758                                 ++m_sec_sequence.current();
759                                 break;
760                         }
761                         case eSecCommand::IF_NOT_VOLTAGE_GOTO:
762                         {
763                                 eSecCommand::pair &compare = m_sec_sequence.current()->compare;
764                                 if ( compare.voltage != m_curVoltage && setSecSequencePos(compare.steps) )
765                                         break;
766                                 ++m_sec_sequence.current();
767                                 break;
768                         }
769                         case eSecCommand::SET_TONE:
770                                 eDebug("[SEC] setTone %d", m_sec_sequence.current()->tone);
771                                 setTone(m_sec_sequence.current()++->tone);
772                                 break;
773                         case eSecCommand::SEND_DISEQC:
774                                 sendDiseqc(m_sec_sequence.current()->diseqc);
775                                 eDebugNoNewLine("[SEC] sendDiseqc: ");
776                                 for (int i=0; i < m_sec_sequence.current()->diseqc.len; ++i)
777                                     eDebugNoNewLine("%02x", m_sec_sequence.current()->diseqc.data[i]);
778                                 eDebug("");
779                                 ++m_sec_sequence.current();
780                                 break;
781                         case eSecCommand::SEND_TONEBURST:
782                                 eDebug("[SEC] sendToneburst: %d", m_sec_sequence.current()->toneburst);
783                                 sendToneburst(m_sec_sequence.current()++->toneburst);
784                                 break;
785                         case eSecCommand::SET_FRONTEND:
786                                 eDebug("[SEC] setFrontend");
787                                 setFrontend();
788                                 ++m_sec_sequence.current();
789                                 break;
790                         case eSecCommand::START_TUNE_TIMEOUT:
791                                 m_timeout->start(5000, 1); // 5 sec timeout. TODO: symbolrate dependent
792                                 ++m_sec_sequence.current();
793                                 break;
794                         case eSecCommand::SET_TIMEOUT:
795                                 m_timeoutCount = m_sec_sequence.current()++->val;
796                                 eDebug("[SEC] set timeout %d", m_timeoutCount);
797                                 break;
798                         case eSecCommand::IF_TIMEOUT_GOTO:
799                                 if (!m_timeoutCount)
800                                 {
801                                         eDebug("[SEC] rotor timout");
802                                         m_sec->setRotorMoving(false);
803                                         setSecSequencePos(m_sec_sequence.current()->steps);
804                                 }
805                                 else
806                                         ++m_sec_sequence.current();
807                                 break;
808                         case eSecCommand::MEASURE_IDLE_INPUTPOWER:
809                         {
810                                 int idx = m_sec_sequence.current()++->val;
811                                 if ( idx == 0 || idx == 1 )
812                                 {
813                                         m_idleInputpower[idx] = readInputpower();
814                                         eDebug("[SEC] idleInputpower[%d] is %d", idx, m_idleInputpower[idx]);
815                                 }
816                                 else
817                                         eDebug("[SEC] idleInputpower measure index(%d) out of bound !!!", idx);
818                                 break;
819                         }
820                         case eSecCommand::IF_MEASURE_IDLE_WAS_NOT_OK_GOTO:
821                         {
822                                 eSecCommand::pair &compare = m_sec_sequence.current()->compare;
823                                 int idx = compare.voltage;
824                                 if ( idx == 0 || idx == 1 )
825                                 {
826                                         int idle = readInputpower();
827                                         int diff = abs(idle-m_idleInputpower[idx]);
828                                         if ( diff > 0)
829                                         {
830                                                 eDebug("measure idle(%d) was not okay.. (%d - %d = %d) retry", idx, m_idleInputpower[idx], idle, diff);
831                                                 setSecSequencePos(compare.steps);
832                                                 break;
833                                         }
834                                 }
835                                 ++m_sec_sequence.current();
836                                 break;
837                         }
838                         case eSecCommand::IF_TUNER_LOCKED_GOTO:
839                         {
840                                 eSecCommand::rotor &cmd = m_sec_sequence.current()->measure;
841                                 if (readFrontendData(Locked))
842                                 {
843                                         eDebug("[SEC] locked step %d ok", cmd.okcount);
844                                         ++cmd.okcount;
845                                         if (cmd.okcount > 12)
846                                         {
847                                                 eDebug("ok > 12 .. goto %d\n",m_sec_sequence.current()->steps);
848                                                 setSecSequencePos(cmd.steps);
849                                                 break;
850                                         }
851                                 }
852                                 else
853                                 {
854                                         eDebug("[SEC] rotor locked step %d failed", cmd.okcount);
855                                         --m_timeoutCount;
856                                         if (!m_timeoutCount && m_retryCount > 0)
857                                                 --m_retryCount;
858                                         cmd.okcount=0;
859                                 }
860                                 ++m_sec_sequence.current();
861                                 break;
862                         }
863                         case eSecCommand::MEASURE_RUNNING_INPUTPOWER:
864                                 m_runningInputpower = readInputpower();
865                                 eDebug("[SEC] runningInputpower is %d", m_runningInputpower);
866                                 ++m_sec_sequence.current();
867                                 break;
868                         case eSecCommand::IF_INPUTPOWER_DELTA_GOTO:
869                         {
870                                 int idleInputpower = m_idleInputpower[ (m_curVoltage&1) ? 0 : 1];
871                                 eSecCommand::rotor &cmd = m_sec_sequence.current()->measure;
872                                 const char *txt = cmd.direction ? "running" : "stopped";
873                                 eDebug("[SEC] waiting for rotor %s %d, idle %d, delta %d",
874                                         txt,
875                                         m_runningInputpower,
876                                         idleInputpower,
877                                         cmd.deltaA);
878                                 if ( (cmd.direction && abs(m_runningInputpower - idleInputpower) >= cmd.deltaA)
879                                         || (!cmd.direction && abs(m_runningInputpower - idleInputpower) <= cmd.deltaA) )
880                                 {
881                                         ++cmd.okcount;
882                                         eDebug("[SEC] rotor %s step %d ok", txt, cmd.okcount);
883                                         if ( cmd.okcount > 6 )
884                                         {
885                                                 m_sec->setRotorMoving(cmd.direction);
886                                                 eDebug("[SEC] rotor is %s", txt);
887                                                 if (setSecSequencePos(cmd.steps))
888                                                         break;
889                                         }
890                                 }
891                                 else
892                                 {
893                                         eDebug("[SEC] rotor not %s... reset counter.. increase timeout", txt);
894                                         --m_timeoutCount;
895                                         if (!m_timeoutCount && m_retryCount > 0)
896                                                 --m_retryCount;
897                                         cmd.okcount=0;
898                                 }
899                                 ++m_sec_sequence.current();
900                                 break;
901                         }
902                         case eSecCommand::IF_ROTORPOS_VALID_GOTO:
903                                 if (m_data[5] != -1 && m_data[6] != -1)
904                                         setSecSequencePos(m_sec_sequence.current()->steps);
905                                 else
906                                         ++m_sec_sequence.current();
907                                 break;
908                         case eSecCommand::INVALIDATE_CURRENT_ROTORPARMS:
909                                 m_data[5] = m_data[6] = -1;
910                                 eDebug("[SEC] invalidate current rotorparams");
911                                 ++m_sec_sequence.current();
912                                 break;
913                         case eSecCommand::UPDATE_CURRENT_ROTORPARAMS:
914                                 m_data[5] = m_data[3];
915                                 m_data[6] = m_data[4];
916                                 eDebug("[SEC] update current rotorparams %d %04x %d", m_timeoutCount, m_data[5], m_data[6]);
917                                 ++m_sec_sequence.current();
918                                 break;
919                         case eSecCommand::SET_ROTOR_DISEQC_RETRYS:
920                                 m_retryCount = m_sec_sequence.current()++->val;
921                                 eDebug("[SEC] set rotor retries %d", m_retryCount);
922                                 break;
923                         case eSecCommand::IF_NO_MORE_ROTOR_DISEQC_RETRYS_GOTO:
924                                 if (!m_retryCount)
925                                 {
926                                         eDebug("[SEC] no more rotor retrys");
927                                         setSecSequencePos(m_sec_sequence.current()->steps);
928                                 }
929                                 else
930                                         ++m_sec_sequence.current();
931                                 break;
932                         case eSecCommand::SET_POWER_LIMITING_MODE:
933                         {
934                                 int fd = m_fe ?
935                                         ::open("/dev/i2c/1", O_RDWR) :
936                                         ::open("/dev/i2c/0", O_RDWR);
937
938                                 unsigned char data[2];
939                                 ::ioctl(fd, I2C_SLAVE_FORCE, 0x10 >> 1);
940                                 if(::read(fd, data, 1) != 1)
941                                         eDebug("[SEC] error read lnbp (%m)");
942                                 if ( m_sec_sequence.current()->mode == eSecCommand::modeStatic )
943                                 {
944                                         data[0] |= 0x80;  // enable static current limiting
945                                         eDebug("[SEC] set static current limiting");
946                                 }
947                                 else
948                                 {
949                                         data[0] &= ~0x80;  // enable dynamic current limiting
950                                         eDebug("[SEC] set dynamic current limiting");
951                                 }
952                                 if(::write(fd, data, 1) != 1)
953                                         eDebug("[SEC] error write lnbp (%m)");
954                                 ::close(fd);
955                                 ++m_sec_sequence.current();
956                                 break;
957                         }
958                         default:
959                                 ++m_sec_sequence.current();
960                                 eDebug("[SEC] unhandled sec command");
961                 }
962                 m_tuneTimer->start(delay,true);
963         }
964 }
965
966 void eDVBFrontend::setFrontend()
967 {
968         eDebug("setting frontend %d", m_fe);
969         if (ioctl(m_fd, FE_SET_FRONTEND, &parm) == -1)
970         {
971                 perror("FE_SET_FRONTEND failed");
972                 return;
973         }
974 }
975
976 RESULT eDVBFrontend::getFrontendType(int &t)
977 {
978         if (m_type == -1)
979                 return -ENODEV;
980         t = m_type;
981         return 0;
982 }
983
984 RESULT eDVBFrontend::prepare_sat(const eDVBFrontendParametersSatellite &feparm)
985 {
986         int res;
987         if (!m_sec)
988         {
989                 eWarning("no SEC module active!");
990                 return -ENOENT;
991         }
992         res = m_sec->prepare(*this, parm, feparm, 1 << m_fe);
993         if (!res)
994         {
995                 parm.u.qpsk.symbol_rate = feparm.symbol_rate;
996                 switch (feparm.inversion)
997                 {
998                         case eDVBFrontendParametersSatellite::Inversion::On:
999                                 parm.inversion = INVERSION_ON;
1000                                 break;
1001                         case eDVBFrontendParametersSatellite::Inversion::Off:
1002                                 parm.inversion = INVERSION_OFF;
1003                                 break;
1004                         default:
1005                         case eDVBFrontendParametersSatellite::Inversion::Unknown:
1006                                 parm.inversion = INVERSION_AUTO;
1007                                 break;
1008                 }
1009                 switch (feparm.fec)
1010                 {
1011                         default:
1012                         case eDVBFrontendParametersSatellite::FEC::fNone:
1013                                 eDebug("no fec set.. assume auto");
1014                         case eDVBFrontendParametersSatellite::FEC::fAuto:
1015                                 parm.u.qpsk.fec_inner = FEC_AUTO;
1016                                 break;
1017                         case eDVBFrontendParametersSatellite::FEC::f1_2:
1018                                 parm.u.qpsk.fec_inner = FEC_1_2;
1019                                 break;
1020                         case eDVBFrontendParametersSatellite::FEC::f2_3:
1021                                 parm.u.qpsk.fec_inner = FEC_2_3;
1022                                 break;
1023                         case eDVBFrontendParametersSatellite::FEC::f3_4:
1024                                 parm.u.qpsk.fec_inner = FEC_3_4;
1025                                 break;
1026                         case eDVBFrontendParametersSatellite::FEC::f5_6:
1027                                 parm.u.qpsk.fec_inner = FEC_5_6;
1028                                 break;
1029                         case eDVBFrontendParametersSatellite::FEC::f7_8:
1030                                 parm.u.qpsk.fec_inner = FEC_7_8;
1031                                 break;
1032                 }
1033                 eDebug("tuning to %d mhz", parm.frequency/1000);
1034         }
1035         return res;
1036 }
1037
1038 RESULT eDVBFrontend::prepare_cable(const eDVBFrontendParametersCable &feparm)
1039 {
1040         parm.frequency = feparm.frequency * 1000;
1041         parm.u.qam.symbol_rate = feparm.symbol_rate;
1042         switch (feparm.modulation)
1043         {
1044         case eDVBFrontendParametersCable::Modulation::QAM16:
1045                 parm.u.qam.modulation = QAM_16;
1046                 break;
1047         case eDVBFrontendParametersCable::Modulation::QAM32:
1048                 parm.u.qam.modulation = QAM_32;
1049                 break;
1050         case eDVBFrontendParametersCable::Modulation::QAM64:
1051                 parm.u.qam.modulation = QAM_64;
1052                 break;
1053         case eDVBFrontendParametersCable::Modulation::QAM128:
1054                 parm.u.qam.modulation = QAM_128;
1055                 break;
1056         case eDVBFrontendParametersCable::Modulation::QAM256:
1057                 parm.u.qam.modulation = QAM_256;
1058                 break;
1059         default:
1060         case eDVBFrontendParametersCable::Modulation::Auto:
1061                 parm.u.qam.modulation = QAM_AUTO;
1062                 break;
1063         }
1064         switch (feparm.inversion)
1065         {
1066         case eDVBFrontendParametersCable::Inversion::On:
1067                 parm.inversion = INVERSION_ON;
1068                 break;
1069         case eDVBFrontendParametersCable::Inversion::Off:
1070                 parm.inversion = INVERSION_OFF;
1071                 break;
1072         default:
1073         case eDVBFrontendParametersCable::Inversion::Unknown:
1074                 parm.inversion = INVERSION_AUTO;
1075                 break;
1076         }
1077         switch (feparm.fec_inner)
1078         {
1079         case eDVBFrontendParametersCable::FEC::fNone:
1080                 parm.u.qam.fec_inner = FEC_NONE;
1081                 break;
1082         case eDVBFrontendParametersCable::FEC::f1_2:
1083                 parm.u.qam.fec_inner = FEC_1_2;
1084                 break;
1085         case eDVBFrontendParametersCable::FEC::f2_3:
1086                 parm.u.qam.fec_inner = FEC_2_3;
1087                 break;
1088         case eDVBFrontendParametersCable::FEC::f3_4:
1089                 parm.u.qam.fec_inner = FEC_3_4;
1090                 break;
1091         case eDVBFrontendParametersCable::FEC::f5_6:
1092                 parm.u.qam.fec_inner = FEC_5_6;
1093                 break;
1094         case eDVBFrontendParametersCable::FEC::f7_8:
1095                 parm.u.qam.fec_inner = FEC_7_8;
1096                 break;
1097         case eDVBFrontendParametersCable::FEC::f8_9:
1098                 parm.u.qam.fec_inner = FEC_8_9;
1099                 break;
1100         default:
1101         case eDVBFrontendParametersCable::FEC::fAuto:
1102                 parm.u.qam.fec_inner = FEC_AUTO;
1103                 break;
1104         }
1105         return 0;
1106 }
1107
1108 RESULT eDVBFrontend::prepare_terrestrial(const eDVBFrontendParametersTerrestrial &feparm)
1109 {
1110         parm.frequency = feparm.frequency;
1111
1112         switch (feparm.bandwidth)
1113         {
1114         case eDVBFrontendParametersTerrestrial::Bandwidth::Bw8MHz:
1115                 parm.u.ofdm.bandwidth = BANDWIDTH_8_MHZ;
1116                 break;
1117         case eDVBFrontendParametersTerrestrial::Bandwidth::Bw7MHz:
1118                 parm.u.ofdm.bandwidth = BANDWIDTH_7_MHZ;
1119                 break;
1120         case eDVBFrontendParametersTerrestrial::Bandwidth::Bw6MHz:
1121                 parm.u.ofdm.bandwidth = BANDWIDTH_6_MHZ;
1122                 break;
1123         default:
1124         case eDVBFrontendParametersTerrestrial::Bandwidth::BwAuto:
1125                 parm.u.ofdm.bandwidth = BANDWIDTH_AUTO;
1126                 break;
1127         }
1128         switch (feparm.code_rate_LP)
1129         {
1130         case eDVBFrontendParametersCable::FEC::f1_2:
1131                 parm.u.ofdm.code_rate_LP = FEC_1_2;
1132                 break;
1133         case eDVBFrontendParametersCable::FEC::f2_3:
1134                 parm.u.ofdm.code_rate_LP = FEC_2_3;
1135                 break;
1136         case eDVBFrontendParametersCable::FEC::f3_4:
1137                 parm.u.ofdm.code_rate_LP = FEC_3_4;
1138                 break;
1139         case eDVBFrontendParametersCable::FEC::f5_6:
1140                 parm.u.ofdm.code_rate_LP = FEC_5_6;
1141                 break;
1142         case eDVBFrontendParametersCable::FEC::f7_8:
1143                 parm.u.ofdm.code_rate_LP = FEC_7_8;
1144                 break;
1145         default:
1146         case eDVBFrontendParametersCable::FEC::fAuto:
1147         case eDVBFrontendParametersCable::FEC::fNone:
1148                 parm.u.ofdm.code_rate_LP = FEC_AUTO;
1149                 break;
1150         }
1151         switch (feparm.code_rate_HP)
1152         {
1153         case eDVBFrontendParametersCable::FEC::f1_2:
1154                 parm.u.ofdm.code_rate_HP = FEC_1_2;
1155                 break;
1156         case eDVBFrontendParametersCable::FEC::f2_3:
1157                 parm.u.ofdm.code_rate_HP = FEC_2_3;
1158                 break;
1159         case eDVBFrontendParametersCable::FEC::f3_4:
1160                 parm.u.ofdm.code_rate_HP = FEC_3_4;
1161                 break;
1162         case eDVBFrontendParametersCable::FEC::f5_6:
1163                 parm.u.ofdm.code_rate_HP = FEC_5_6;
1164                 break;
1165         case eDVBFrontendParametersCable::FEC::f7_8:
1166                 parm.u.ofdm.code_rate_HP = FEC_7_8;
1167                 break;
1168         default:
1169         case eDVBFrontendParametersCable::FEC::fAuto:
1170         case eDVBFrontendParametersCable::FEC::fNone:
1171                 parm.u.ofdm.code_rate_HP = FEC_AUTO;
1172                 break;
1173         }
1174         switch (feparm.modulation)
1175         {
1176         case eDVBFrontendParametersTerrestrial::Modulation::QPSK:
1177                 parm.u.ofdm.constellation = QPSK;
1178                 break;
1179         case eDVBFrontendParametersTerrestrial::Modulation::QAM16:
1180                 parm.u.ofdm.constellation = QAM_16;
1181                 break;
1182         default:
1183         case eDVBFrontendParametersTerrestrial::Modulation::Auto:
1184                 parm.u.ofdm.constellation = QAM_AUTO;
1185                 break;
1186         }
1187         switch (feparm.transmission_mode)
1188         {
1189         case eDVBFrontendParametersTerrestrial::TransmissionMode::TM2k:
1190                 parm.u.ofdm.transmission_mode = TRANSMISSION_MODE_2K;
1191                 break;
1192         case eDVBFrontendParametersTerrestrial::TransmissionMode::TM8k:
1193                 parm.u.ofdm.transmission_mode = TRANSMISSION_MODE_8K;
1194                 break;
1195         default:
1196         case eDVBFrontendParametersTerrestrial::TransmissionMode::TMAuto:
1197                 parm.u.ofdm.transmission_mode = TRANSMISSION_MODE_AUTO;
1198                 break;
1199         }
1200         switch (feparm.guard_interval)
1201         {
1202                 case eDVBFrontendParametersTerrestrial::GuardInterval::GI_1_32:
1203                         parm.u.ofdm.guard_interval = GUARD_INTERVAL_1_32;
1204                         break;
1205                 case eDVBFrontendParametersTerrestrial::GuardInterval::GI_1_16:
1206                         parm.u.ofdm.guard_interval = GUARD_INTERVAL_1_16;
1207                         break;
1208                 case eDVBFrontendParametersTerrestrial::GuardInterval::GI_1_8:
1209                         parm.u.ofdm.guard_interval = GUARD_INTERVAL_1_8;
1210                         break;
1211                 case eDVBFrontendParametersTerrestrial::GuardInterval::GI_1_4:
1212                         parm.u.ofdm.guard_interval = GUARD_INTERVAL_1_4;
1213                         break;
1214                 default:
1215                 case eDVBFrontendParametersTerrestrial::GuardInterval::GI_Auto:
1216                         parm.u.ofdm.guard_interval = GUARD_INTERVAL_AUTO;
1217                         break;
1218         }
1219         switch (feparm.hierarchy)
1220         {
1221                 case eDVBFrontendParametersTerrestrial::Hierarchy::H1:
1222                         parm.u.ofdm.hierarchy_information = HIERARCHY_1;
1223                         break;
1224                 case eDVBFrontendParametersTerrestrial::Hierarchy::H2:
1225                         parm.u.ofdm.hierarchy_information = HIERARCHY_2;
1226                         break;
1227                 case eDVBFrontendParametersTerrestrial::Hierarchy::H4:
1228                         parm.u.ofdm.hierarchy_information = HIERARCHY_4;
1229                         break;
1230                 default:
1231                 case eDVBFrontendParametersTerrestrial::Hierarchy::HAuto:
1232                         parm.u.ofdm.hierarchy_information = HIERARCHY_AUTO;
1233                         break;
1234         }
1235         return 0;
1236 }
1237
1238 RESULT eDVBFrontend::tune(const iDVBFrontendParameters &where)
1239 {
1240         eDebug("(%d)tune", m_fe);
1241
1242         int res=0;
1243
1244         if (m_type == -1)
1245                 return -ENODEV;
1246
1247         feEvent(-1);
1248
1249         m_sec_sequence.clear();
1250
1251         switch (m_type)
1252         {
1253         case feSatellite:
1254         {
1255                 eDVBFrontendParametersSatellite feparm;
1256                 if (where.getDVBS(feparm))
1257                 {
1258                         eDebug("no dvbs data!");
1259                         return -EINVAL;
1260                 }
1261                 res=prepare_sat(feparm);
1262                 break;
1263         }
1264         case feCable:
1265         {
1266                 eDVBFrontendParametersCable feparm;
1267                 if (where.getDVBC(feparm))
1268                         return -EINVAL;
1269                 res=prepare_cable(feparm);
1270                 if (!res)
1271                         m_sec_sequence.push_back( eSecCommand(eSecCommand::SET_FRONTEND) );
1272                 break;
1273         }
1274         case feTerrestrial:
1275         {
1276                 eDVBFrontendParametersTerrestrial feparm;
1277                 if (where.getDVBT(feparm))
1278                 {
1279                         eDebug("no -T data");
1280                         return -EINVAL;
1281                 }
1282                 res=prepare_terrestrial(feparm);
1283                 if (!res)
1284                         m_sec_sequence.push_back( eSecCommand(eSecCommand::SET_FRONTEND) );
1285                 break;
1286         }
1287         }
1288
1289         if (!res)  // prepare ok
1290         {
1291                 m_tuneTimer->start(0,true);
1292                 m_timeout->stop();
1293                 m_sec_sequence.current() = m_sec_sequence.begin();
1294
1295                 if (m_state != stateTuning)
1296                 {
1297                         m_tuning = 1;
1298                         m_state = stateTuning;
1299                         m_stateChanged(this);
1300                 }
1301         }
1302
1303         return res;
1304 }
1305
1306 RESULT eDVBFrontend::connectStateChange(const Slot1<void,iDVBFrontend*> &stateChange, ePtr<eConnection> &connection)
1307 {
1308         connection = new eConnection(this, m_stateChanged.connect(stateChange));
1309         return 0;
1310 }
1311
1312 RESULT eDVBFrontend::setVoltage(int voltage)
1313 {
1314         if (m_type != feSatellite)
1315                 return -1;
1316 #if HAVE_DVB_API_VERSION < 3
1317         secVoltage vlt;
1318 #else
1319         bool increased=false;
1320         fe_sec_voltage_t vlt;
1321 #endif
1322         m_curVoltage=voltage;
1323         switch (voltage)
1324         {
1325         case voltageOff:
1326                 for (int i=0; i < 3; ++i)  // reset diseqc
1327                         m_data[i]=-1;
1328                 vlt = SEC_VOLTAGE_OFF;
1329                 break;
1330         case voltage13_5:
1331 #if HAVE_DVB_API_VERSION < 3
1332                 vlt = SEC_VOLTAGE_13_5;
1333                 break;
1334 #else
1335                 increased = true;
1336 #endif
1337         case voltage13:
1338                 vlt = SEC_VOLTAGE_13;
1339                 break;
1340         case voltage18_5:
1341 #if HAVE_DVB_API_VERSION < 3
1342                 vlt = SEC_VOLTAGE_18_5;
1343                 break;
1344 #else
1345                 increased = true;
1346 #endif
1347         case voltage18:
1348                 vlt = SEC_VOLTAGE_18;
1349                 break;
1350         default:
1351                 return -ENODEV;
1352         }
1353 #if HAVE_DVB_API_VERSION < 3
1354         return ::ioctl(m_secfd, SEC_SET_VOLTAGE, vlt);
1355 #else
1356         if (::ioctl(m_fd, FE_ENABLE_HIGH_LNB_VOLTAGE, increased) < 0)
1357                 perror("FE_ENABLE_HIGH_LNB_VOLTAGE");
1358         return ::ioctl(m_fd, FE_SET_VOLTAGE, vlt);
1359 #endif
1360 }
1361
1362 RESULT eDVBFrontend::getState(int &state)
1363 {
1364         state = m_state;
1365         return 0;
1366 }
1367
1368 RESULT eDVBFrontend::setTone(int t)
1369 {
1370         if (m_type != feSatellite)
1371                 return -1;
1372 #if HAVE_DVB_API_VERSION < 3
1373         secToneMode_t tone;
1374 #else
1375         fe_sec_tone_mode_t tone;
1376 #endif
1377
1378         switch (t)
1379         {
1380         case toneOn:
1381                 tone = SEC_TONE_ON;
1382                 break;
1383         case toneOff:
1384                 tone = SEC_TONE_OFF;
1385                 break;
1386         default:
1387                 return -ENODEV;
1388         }
1389 #if HAVE_DVB_API_VERSION < 3    
1390         return ::ioctl(m_secfd, SEC_SET_TONE, tone);
1391 #else   
1392         return ::ioctl(m_fd, FE_SET_TONE, tone);
1393 #endif
1394 }
1395
1396 #if HAVE_DVB_API_VERSION < 3 && !defined(SEC_DISEQC_SEND_MASTER_CMD)
1397         #define SEC_DISEQC_SEND_MASTER_CMD _IOW('o', 97, struct secCommand *)
1398 #endif
1399
1400 RESULT eDVBFrontend::sendDiseqc(const eDVBDiseqcCommand &diseqc)
1401 {
1402 #if HAVE_DVB_API_VERSION < 3
1403         struct secCommand cmd;
1404         cmd.type = SEC_CMDTYPE_DISEQC_RAW;
1405         cmd.u.diseqc.cmdtype = diseqc.data[0];
1406         cmd.u.diseqc.addr = diseqc.data[1];
1407         cmd.u.diseqc.cmd = diseqc.data[2];
1408         cmd.u.diseqc.numParams = diseqc.len-3;
1409         memcpy(cmd.u.diseqc.params, diseqc.data+3, diseqc.len-3);
1410         if (::ioctl(m_secfd, SEC_DISEQC_SEND_MASTER_CMD, &cmd))
1411 #else
1412         struct dvb_diseqc_master_cmd cmd;
1413         memcpy(cmd.msg, diseqc.data, diseqc.len);
1414         cmd.msg_len = diseqc.len;
1415         if (::ioctl(m_fd, FE_DISEQC_SEND_MASTER_CMD, &cmd))
1416 #endif
1417                 return -EINVAL;
1418         return 0;
1419 }
1420
1421 #if HAVE_DVB_API_VERSION < 3 && !defined(SEC_DISEQC_SEND_BURST)
1422         #define SEC_DISEQC_SEND_BURST _IO('o', 96)
1423 #endif
1424 RESULT eDVBFrontend::sendToneburst(int burst)
1425 {
1426 #if HAVE_DVB_API_VERSION < 3
1427         secMiniCmd cmd = SEC_MINI_NONE;
1428 #else
1429         fe_sec_mini_cmd_t cmd = SEC_MINI_A;
1430 #endif
1431         if ( burst == eDVBSatelliteDiseqcParameters::A )
1432                 cmd = SEC_MINI_A;
1433         else if ( burst == eDVBSatelliteDiseqcParameters::B )
1434                 cmd = SEC_MINI_B;
1435 #if HAVE_DVB_API_VERSION < 3
1436         if (::ioctl(m_secfd, SEC_DISEQC_SEND_BURST, cmd))
1437                 return -EINVAL;
1438 #else
1439         if (::ioctl(m_fd, FE_DISEQC_SEND_BURST, cmd))
1440                 return -EINVAL;
1441 #endif
1442         return 0;
1443 }
1444
1445 RESULT eDVBFrontend::setSEC(iDVBSatelliteEquipmentControl *sec)
1446 {
1447         m_sec = sec;
1448         return 0;
1449 }
1450
1451 RESULT eDVBFrontend::setSecSequence(const eSecCommandList &list)
1452 {
1453         m_sec_sequence = list;
1454         return 0;
1455 }
1456
1457 RESULT eDVBFrontend::getData(int num, int &data)
1458 {
1459         if ( num < (int)(sizeof(m_data)/sizeof(int)) )
1460         {
1461                 data = m_data[num];
1462                 return 0;
1463         }
1464         return -EINVAL;
1465 }
1466
1467 RESULT eDVBFrontend::setData(int num, int val)
1468 {
1469         if ( num < (int)(sizeof(m_data)/sizeof(int)) )
1470         {
1471                 m_data[num] = val;
1472                 return 0;
1473         }
1474         return -EINVAL;
1475 }
1476
1477 int eDVBFrontend::isCompatibleWith(ePtr<iDVBFrontendParameters> &feparm)
1478 {
1479         int type;
1480         if (feparm->getSystem(type) || type != m_type)
1481                 return 0;
1482
1483         if (m_type == eDVBFrontend::feSatellite)
1484         {
1485                 ASSERT(m_sec);
1486                 eDVBFrontendParametersSatellite sat_parm;
1487                 ASSERT(!feparm->getDVBS(sat_parm));
1488                 return m_sec->canTune(sat_parm, this, 1 << m_fe);
1489         }
1490         return 1;
1491 }