diseqc 1.1 should be working now
[enigma2.git] / lib / dvb / frontend.cpp
1 #include <config.h>
2 #include <lib/dvb/dvb.h>
3 #include <lib/base/eerror.h>
4 #include <errno.h>
5 #include <unistd.h>
6 #include <fcntl.h>
7 #include <sys/ioctl.h>
8
9 #if HAVE_DVB_API_VERSION < 3
10 #include <ost/frontend.h>
11 #include <ost/sec.h>
12 #define QAM_AUTO                                (Modulation)6
13 #define TRANSMISSION_MODE_AUTO  (TransmitMode)2
14 #define BANDWIDTH_AUTO                  (BandWidth)3
15 #define GUARD_INTERVAL_AUTO             (GuardInterval)4
16 #define HIERARCHY_AUTO                  (Hierarchy)4
17 #define constellation Constellation
18 #define guard_interval guardInterval
19 #define hierarchy_information HierarchyInformation
20 #define code_rate_HP HP_CodeRate
21 #define code_rate_LP LP_CodeRate
22 #else
23 #include <linux/dvb/frontend.h>
24 #endif
25
26 #include <lib/dvb_si/satellite_delivery_system_descriptor.h>
27 #include <lib/dvb_si/cable_delivery_system_descriptor.h>
28 #include <lib/dvb_si/terrestrial_delivery_system_descriptor.h>
29
30 void eDVBFrontendParametersSatellite::set(const SatelliteDeliverySystemDescriptor &descriptor)
31 {
32         frequency    = descriptor.getFrequency() * 10;
33         symbol_rate  = descriptor.getSymbolRate() * 100;
34         switch (descriptor.getPolarization())
35         {
36         case 0:
37                 polarisation = Polarisation::Horizontal;
38                 break;
39         case 1:
40                 polarisation = Polarisation::Vertical;
41                 break;
42         case 2:
43                 polarisation = Polarisation::CircularLeft;
44                 break;
45         case 3:
46                 polarisation = Polarisation::CircularRight;
47                 break;
48         }
49         switch (descriptor.getFecInner())
50         {
51         case 1:
52                 fec = FEC::f1_2;
53                 break;
54         case 2:
55                 fec = FEC::f2_3;
56                 break;
57         case 3:
58                 fec = FEC::f3_4;
59                 break;
60         case 4:
61                 fec = FEC::f5_6;
62                 break;
63         case 5:
64                 fec = FEC::f7_8;
65                 break;
66         case 0xF:
67                 fec = FEC::fNone;
68                 break;
69         default:
70                 fec = FEC::fAuto;
71                 break;
72         }
73         inversion = Inversion::Unknown;
74         orbital_position  = ((descriptor.getOrbitalPosition() >> 12) & 0xF) * 1000;
75         orbital_position += ((descriptor.getOrbitalPosition() >> 8) & 0xF) * 100;
76         orbital_position += ((descriptor.getOrbitalPosition() >> 4) & 0xF) * 10;
77         orbital_position += ((descriptor.getOrbitalPosition()) & 0xF);
78         if (orbital_position && (!descriptor.getWestEastFlag()))
79                 orbital_position = 3600 - orbital_position;
80 }
81
82 void eDVBFrontendParametersCable::set(const CableDeliverySystemDescriptor &descriptor)
83 {
84         eFatal("nyi");
85 }
86
87 void eDVBFrontendParametersTerrestrial::set(const TerrestrialDeliverySystemDescriptor  &)
88 {
89         eFatal("nyi");
90 }
91
92 eDVBFrontendParameters::eDVBFrontendParameters(): m_type(-1)
93 {
94 }
95
96 DEFINE_REF(eDVBFrontendParameters);
97
98 RESULT eDVBFrontendParameters::getSystem(int &t) const
99 {
100         if (m_type == -1)
101                 return -1;
102         t = m_type;
103         return 0;
104 }
105
106 RESULT eDVBFrontendParameters::getDVBS(eDVBFrontendParametersSatellite &p) const
107 {
108         if (m_type != iDVBFrontend::feSatellite)
109                 return -1;
110         p = sat;
111         return 0;
112 }
113
114 RESULT eDVBFrontendParameters::getDVBC(eDVBFrontendParametersCable &p) const
115 {
116         if (m_type != iDVBFrontend::feCable)
117                 return -1;
118         p = cable;
119         return 0;
120 }
121
122 RESULT eDVBFrontendParameters::getDVBT(eDVBFrontendParametersTerrestrial &p) const
123 {
124         if (m_type != iDVBFrontend::feTerrestrial)
125                 return -1;
126         p = terrestrial;
127         return 0;
128 }
129
130 RESULT eDVBFrontendParameters::setDVBS(eDVBFrontendParametersSatellite &p)
131 {
132         sat = p;
133         m_type = iDVBFrontend::feSatellite;
134         return 0;
135 }
136
137 RESULT eDVBFrontendParameters::setDVBC(eDVBFrontendParametersCable &p)
138 {
139         cable = p;
140         m_type = iDVBFrontend::feCable;
141         return 0;
142 }
143
144 RESULT eDVBFrontendParameters::setDVBT(eDVBFrontendParametersTerrestrial &p)
145 {
146         terrestrial = p;
147         m_type = iDVBFrontend::feTerrestrial;
148         return 0;
149 }
150
151 RESULT eDVBFrontendParameters::calculateDifference(const iDVBFrontendParameters *parm, int &diff) const
152 {
153         if (!parm)
154                 return -1;
155         int type;
156         if (parm->getSystem(type))
157                 return -1;
158         if (type != m_type)
159         {
160                 diff = 1<<30; // big difference
161                 return 0;
162         }
163         
164         switch (type)
165         {
166         case iDVBFrontend::feSatellite:
167         {
168                 eDVBFrontendParametersSatellite osat;
169                 if (parm->getDVBS(osat))
170                         return -2;
171                 
172                 if (sat.orbital_position != osat.orbital_position)
173                         diff = 1<<29;
174                 else if (sat.polarisation != osat.polarisation)
175                         diff = 1<<28;
176                 else 
177                         diff = abs(sat.frequency - osat.frequency);
178                 return 0;
179         }
180         case iDVBFrontend::feCable:
181         case iDVBFrontend::feTerrestrial:
182         default:
183                 return -1;
184         }
185         return 0;
186 }
187
188 RESULT eDVBFrontendParameters::getHash(unsigned long &hash) const 
189 {
190         switch (m_type)
191         {
192         case iDVBFrontend::feSatellite:
193         {
194                 hash  = sat.frequency & 0xFFFF;
195                 hash |= sat.orbital_position << 16;
196                 return 0;
197         }
198         case iDVBFrontend::feCable:
199         case iDVBFrontend::feTerrestrial:
200         default:
201                 return -1;
202         }
203 }
204
205 DEFINE_REF(eDVBFrontend);
206
207 eDVBFrontend::eDVBFrontend(int adap, int fe, int &ok): m_type(-1)
208 {
209 #if HAVE_DVB_API_VERSION < 3
210         char sec_filename[128];
211 #endif
212         char filename[128];
213
214         int result;
215
216         m_sn = 0;
217         m_timeout = 0;
218
219 #if HAVE_DVB_API_VERSION < 3
220         sprintf(sec_filename, "/dev/dvb/card%d/sec%d", adap, fe);
221         m_secfd = ::open(sec_filename, O_RDWR);
222         if (m_secfd < 0)
223         {
224                 eWarning("failed! (%s) %m", sec_filename);
225                 ok = 0;
226                 return;
227         }
228         else
229                 eDebug("m_secfd is %d", m_secfd);
230
231         FrontendInfo fe_info;
232         sprintf(filename, "/dev/dvb/card%d/frontend%d", adap, fe);
233 #else
234         dvb_frontend_info fe_info;      
235         sprintf(filename, "/dev/dvb/adapter%d/frontend%d", adap, fe);
236 #endif
237         eDebug("opening frontend.");
238         m_fd = ::open(filename, O_RDWR|O_NONBLOCK);
239         if (m_fd < 0)
240         {
241                 eWarning("failed! (%s) %m", filename);
242                 ok = 0;
243                 return;
244         }
245
246         result = ::ioctl(m_fd, FE_GET_INFO, &fe_info);
247         
248         if (result < 0) {
249                 eWarning("ioctl FE_GET_INFO failed");
250                 ::close(m_fd);
251                 m_fd = -1;
252                 ok = 0;
253                 return;
254         }
255
256         switch (fe_info.type) 
257         {
258         case FE_QPSK:
259                 m_type = feSatellite;
260                 break;
261         case FE_QAM:
262                 m_type = feCable;
263                 break;
264         case FE_OFDM:
265                 m_type = feTerrestrial;
266                 break;
267         default:
268                 eWarning("unknown frontend type.");
269                 ::close(m_fd);
270                 m_fd = -1;
271                 ok = 0;
272                 return;
273         }
274         eDebug("detected %s frontend", "satellite\0cable\0    terrestrial"+fe_info.type*9);
275         ok = 1;
276
277         m_sn = new eSocketNotifier(eApp, m_fd, eSocketNotifier::Read);
278         CONNECT(m_sn->activated, eDVBFrontend::feEvent);
279         m_sn->start();
280
281         m_timeout = new eTimer(eApp);
282         CONNECT(m_timeout->timeout, eDVBFrontend::timeout);
283
284         m_tuneTimer = new eTimer(eApp);
285         CONNECT(m_tuneTimer->timeout, eDVBFrontend::tuneLoop);
286
287         memset(m_data, 0xFFFF, sizeof(m_data));
288
289         return;
290 }
291
292 eDVBFrontend::~eDVBFrontend()
293 {
294         if (m_fd >= 0)
295                 ::close(m_fd);
296         if (m_sn)
297                 delete m_sn;
298         if (m_timeout)
299                 delete m_timeout;
300 }
301
302 void eDVBFrontend::feEvent(int w)
303 {
304         while (1)
305         {
306 #if HAVE_DVB_API_VERSION < 3
307                 FrontendEvent event;
308 #else
309                 dvb_frontend_event event;
310 #endif
311                 int res;
312                 int state;
313                 res = ::ioctl(m_fd, FE_GET_EVENT, &event);
314                 
315                 if (res && (errno == EAGAIN))
316                         break;
317
318                 if (res)
319                 {
320                         eWarning("FE_GET_EVENT failed! %m");
321                         return;
322                 }
323                 
324                 if (w < 0)
325                         continue;
326
327 #if HAVE_DVB_API_VERSION < 3
328                 if (event.type == FE_COMPLETION_EV)
329 #else
330                 eDebug("fe event: status %x, inversion %s", event.status, (event.parameters.inversion == INVERSION_ON) ? "on" : "off");
331                 if (event.status & FE_HAS_LOCK)
332 #endif
333                 {
334                         state = stateLock;
335                 } else
336                 {
337                         if (m_tuning)
338                                 state = stateTuning;
339                         else
340                                 state = stateFailed;
341                 }
342                 if (m_state != state)
343                 {
344                         m_state = state;
345                         m_stateChanged(this);
346                 }
347         }
348 }
349
350 void eDVBFrontend::timeout()
351 {
352         int state;
353         if (m_state == stateTuning)
354         {
355                 state = stateFailed;
356                 eDebug("DVBFrontend: timeout");
357                 if (m_state != state)
358                 {
359                         m_state = state;
360                         m_stateChanged(this);
361                 }
362         } else
363                 m_tuning = 0;
364 }
365
366 void eDVBFrontend::tuneLoop()  // called by m_tuneTimer
367 {
368         int delay=0;
369         if ( m_sec_sequence && m_sec_sequence.current() != m_sec_sequence.end() )
370         {
371                 switch (m_sec_sequence.current()->cmd)
372                 {
373                         case eSecCommand::SLEEP:
374                                 delay = m_sec_sequence.current()->msec;
375                                 break;
376                         case eSecCommand::SET_VOLTAGE:
377                                 setVoltage(m_sec_sequence.current()->voltage);
378                                 break;
379                         case eSecCommand::SET_TONE:
380                                 setTone(m_sec_sequence.current()->tone);
381                                 break;
382                         case eSecCommand::SEND_DISEQC:
383                                 sendDiseqc(m_sec_sequence.current()->diseqc);
384                                 break;
385                         case eSecCommand::SEND_TONEBURST:
386                                 sendToneburst(m_sec_sequence.current()->toneburst);
387                                 break;
388                         case eSecCommand::SET_FRONTEND:
389                                 setFrontend();
390                                 break;
391                         case eSecCommand::IF_LOCK_GOTO:
392                         case eSecCommand::IF_NOT_LOCK_GOTO:
393                         default:
394                                 eDebug("unhandled sec command");
395                 }
396                 m_sec_sequence.current()++;
397                 m_tuneTimer->start(delay,true);
398         }
399 }
400
401 void eDVBFrontend::setFrontend()
402 {
403         eDebug("setting frontend..\n");
404         if (ioctl(m_fd, FE_SET_FRONTEND, &parm) == -1)
405         {
406                 perror("FE_SET_FRONTEND failed");
407                 return;
408         }
409
410         if (m_state != stateTuning)
411         {
412                 m_tuning = 1;
413                 m_state = stateTuning;
414                 m_stateChanged(this);
415         }
416         m_timeout->start(5000, 1); // 5 sec timeout. TODO: symbolrate dependent
417 }
418
419 RESULT eDVBFrontend::getFrontendType(int &t)
420 {
421         if (m_type == -1)
422                 return -ENODEV;
423         t = m_type;
424         return 0;
425 }
426
427 RESULT eDVBFrontend::tune(const iDVBFrontendParameters &where)
428 {
429         if (m_type == -1)
430                 return -ENODEV;
431
432         feEvent(-1);
433
434         m_sec_sequence.clear();
435
436         eDebug("eDVBFrontend::tune. type: %d", m_type);
437
438         switch (m_type)
439         {
440         case feSatellite:
441         {
442                 int res;
443                 eDVBFrontendParametersSatellite feparm;
444                 if (where.getDVBS(feparm))
445                 {
446                         eDebug("no dvbs data!");
447                         return -EINVAL;
448                 }
449                 if (!m_sec)
450                 {
451                         eWarning("no SEC module active!");
452                         return -ENOENT;
453                 }
454                 
455                 res = m_sec->prepare(*this, parm, feparm);
456                 if (res)
457                         return res;
458 #if HAVE_DVB_API_VERSION < 3
459                 eDebug("tuning to %d mhz", parm.Frequency/1000);
460 #else
461                 eDebug("tuning to %d mhz", parm.frequency/1000);
462 #endif
463                 break;
464         }
465         case feCable:
466         {
467                 eDVBFrontendParametersCable feparm;
468                 if (where.getDVBC(feparm))
469                         return -EINVAL;
470                 eFatal("cable tuning nyi");
471         }
472         case feTerrestrial:
473         {
474                 eDVBFrontendParametersTerrestrial feparm;
475                 if (where.getDVBT(feparm))
476                 {
477                         eDebug("no -T data");
478                         return -EINVAL;
479                 }
480 #if HAVE_DVB_API_VERSION < 3
481                 parm.Frequency = feparm.frequency;
482 #else
483                 parm.frequency = feparm.frequency;
484 #endif
485
486                 switch (feparm.bandwidth)
487                 {
488                 case eDVBFrontendParametersTerrestrial::Bandwidth::Bw8MHz:
489 #if HAVE_DVB_API_VERSION < 3
490                         parm.u.ofdm.bandWidth =
491 #else
492                         parm.u.ofdm.bandwidth =
493 #endif
494                                 BANDWIDTH_8_MHZ;
495                         break;
496                 case eDVBFrontendParametersTerrestrial::Bandwidth::Bw7MHz:
497 #if HAVE_DVB_API_VERSION < 3
498                         parm.u.ofdm.bandWidth =
499 #else
500                         parm.u.ofdm.bandwidth =
501 #endif
502                                 BANDWIDTH_7_MHZ;
503                         break;
504                 case eDVBFrontendParametersTerrestrial::Bandwidth::Bw6MHz:
505 #if HAVE_DVB_API_VERSION < 3
506                         parm.u.ofdm.bandWidth =
507 #else
508                         parm.u.ofdm.bandwidth =
509 #endif
510                                 BANDWIDTH_6_MHZ;
511                         break;
512                 case eDVBFrontendParametersTerrestrial::Bandwidth::BwAuto:
513 #if HAVE_DVB_API_VERSION < 3
514                         parm.u.ofdm.bandWidth =
515 #else
516                         parm.u.ofdm.bandwidth =
517 #endif
518                                 BANDWIDTH_AUTO;
519                         break;
520                 default:
521                         eWarning("invalid OFDM bandwith");
522                         return -EINVAL;
523                 }
524                 
525                 parm.u.ofdm.code_rate_HP = FEC_AUTO;
526                 parm.u.ofdm.code_rate_LP = FEC_AUTO;
527                 
528                 switch (feparm.modulation)
529                 {
530                 case eDVBFrontendParametersTerrestrial::Modulation::QPSK:
531                         parm.u.ofdm.constellation = QPSK;
532                         break;
533                 case eDVBFrontendParametersTerrestrial::Modulation::QAM16:
534                         parm.u.ofdm.constellation = QAM_16;
535                         break;
536                 case eDVBFrontendParametersTerrestrial::Modulation::Auto:
537                         parm.u.ofdm.constellation = QAM_AUTO;
538                         break;
539                 }
540                 
541                 switch (feparm.transmission_mode)
542                 {
543                 case eDVBFrontendParametersTerrestrial::TransmissionMode::TM2k:
544 #if HAVE_DVB_API_VERSION < 3
545                         parm.u.ofdm.TransmissionMode =
546 #else
547                         parm.u.ofdm.transmission_mode =
548 #endif
549                                 TRANSMISSION_MODE_2K;
550                         break;
551                 case eDVBFrontendParametersTerrestrial::TransmissionMode::TM8k:
552 #if HAVE_DVB_API_VERSION < 3
553                         parm.u.ofdm.TransmissionMode =
554 #else
555                         parm.u.ofdm.transmission_mode =
556 #endif
557                                 TRANSMISSION_MODE_8K;
558                         break;
559                 case eDVBFrontendParametersTerrestrial::TransmissionMode::TMAuto:
560 #if HAVE_DVB_API_VERSION < 3
561                         parm.u.ofdm.TransmissionMode =
562 #else
563                         parm.u.ofdm.transmission_mode =
564 #endif
565                                 TRANSMISSION_MODE_AUTO;
566                         break;
567                 }
568                 
569                 parm.u.ofdm.guard_interval = GUARD_INTERVAL_AUTO;
570                 parm.u.ofdm.hierarchy_information = HIERARCHY_AUTO;
571 #if HAVE_DVB_API_VERSION < 3
572                 parm.Inversion =
573 #else
574                 parm.inversion =
575 #endif
576                         INVERSION_AUTO;
577                 break;
578         }
579         }
580
581         m_sec_sequence.push_back( eSecCommand(eSecCommand::SET_FRONTEND, 0) );
582         m_tuneTimer->start(0,true);
583         m_sec_sequence.current() = m_sec_sequence.begin();
584
585         return 0;
586 }
587
588 RESULT eDVBFrontend::connectStateChange(const Slot1<void,iDVBFrontend*> &stateChange, ePtr<eConnection> &connection)
589 {
590         connection = new eConnection(this, m_stateChanged.connect(stateChange));
591         return 0;
592 }
593
594 RESULT eDVBFrontend::setVoltage(int voltage)
595 {
596 #if HAVE_DVB_API_VERSION < 3
597         secVoltage vlt;
598 #else
599         fe_sec_voltage_t vlt;
600 #endif
601
602         switch (voltage)
603         {
604         case voltageOff:
605                 vlt = SEC_VOLTAGE_OFF;
606                 break;
607         case voltage13:
608                 vlt = SEC_VOLTAGE_13;
609                 break;
610         case voltage18:
611                 vlt = SEC_VOLTAGE_18;
612                 break;
613         default:
614                 return -ENODEV;
615         }
616 #if HAVE_DVB_API_VERSION < 3
617         return ::ioctl(m_secfd, SEC_SET_VOLTAGE, vlt);
618 #else
619         return ::ioctl(m_fd, FE_SET_VOLTAGE, vlt);
620 #endif
621 }
622
623 RESULT eDVBFrontend::getState(int &state)
624 {
625         state = m_state;
626         return 0;
627 }
628
629 RESULT eDVBFrontend::setTone(int t)
630 {
631 #if HAVE_DVB_API_VERSION < 3
632         secToneMode_t tone;
633 #else
634         fe_sec_tone_mode_t tone;
635 #endif
636
637         switch (t)
638         {
639         case toneOn:
640                 tone = SEC_TONE_ON;
641                 break;
642         case toneOff:
643                 tone = SEC_TONE_OFF;
644                 break;
645         default:
646                 return -ENODEV;
647         }
648 #if HAVE_DVB_API_VERSION < 3    
649         return ::ioctl(m_secfd, SEC_SET_TONE, tone);
650 #else   
651         return ::ioctl(m_fd, FE_SET_TONE, tone);
652 #endif
653 }
654
655 #if HAVE_DVB_API_VERSION < 3 && !defined(SEC_DISEQC_SEND_MASTER_CMD)
656         #define SEC_DISEQC_SEND_MASTER_CMD _IOW('o', 97, struct secCommand *)
657 #endif
658
659 RESULT eDVBFrontend::sendDiseqc(const eDVBDiseqcCommand &diseqc)
660 {
661         eDebug("send %02x %02x %02x %02x",
662                 diseqc.data[0], diseqc.data[1], diseqc.data[2], diseqc.data[3]);
663 #if HAVE_DVB_API_VERSION < 3
664         struct secCommand cmd;
665         cmd.type = SEC_CMDTYPE_DISEQC_RAW;
666         cmd.u.diseqc.cmdtype = diseqc.data[0];
667         cmd.u.diseqc.addr = diseqc.data[1];
668         cmd.u.diseqc.cmd = diseqc.data[2];
669         cmd.u.diseqc.numParams = diseqc.len-3;
670         memcpy(cmd.u.diseqc.params, diseqc.data+3, diseqc.len-3);
671         if (::ioctl(m_secfd, SEC_DISEQC_SEND_MASTER_CMD, &cmd))
672 #else
673         struct dvb_diseqc_master_cmd cmd;
674         memcpy(cmd.msg, diseqc.data, diseqc.len);
675         cmd.msg_len = diseqc.len;
676         if (::ioctl(m_fd, FE_DISEQC_SEND_MASTER_CMD, &cmd))
677 #endif
678                 return -EINVAL;
679         return 0;
680 }
681
682 #if HAVE_DVB_API_VERSION < 3 && !defined(SEC_DISEQC_SEND_BURST)
683         #define SEC_DISEQC_SEND_BURST _IO('o', 96)
684 #endif
685 RESULT eDVBFrontend::sendToneburst(int burst)
686 {
687 #if HAVE_DVB_API_VERSION < 3
688         secMiniCmd cmd = SEC_MINI_NONE;
689         if ( burst == eDVBSatelliteDiseqcParameters::A )
690                 cmd = SEC_MINI_A;
691         else if ( burst == eDVBSatelliteDiseqcParameters::B )
692                 cmd = SEC_MINI_B;
693         if (::ioctl(m_secfd, SEC_DISEQC_SEND_BURST, cmd))
694                 return -EINVAL;
695 #endif
696         return 0;
697 }
698
699 RESULT eDVBFrontend::setSEC(iDVBSatelliteEquipmentControl *sec)
700 {
701         m_sec = sec;
702         return 0;
703 }
704
705 RESULT eDVBFrontend::setSecSequence(const eSecCommandList &list)
706 {
707         m_sec_sequence = list;
708         return 0;
709 }
710
711 RESULT eDVBFrontend::getData(int num, int &data)
712 {
713         if ( num < 4 )
714         {
715                 data = m_data[num];
716                 return 0;
717         }
718         return -EINVAL;
719 }
720
721 RESULT eDVBFrontend::setData(int num, int val)
722 {
723         if ( num < 4 )
724         {
725                 m_data[num] = val;
726                 return 0;
727         }
728         return -EINVAL;
729 }
730