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