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