voltage was not set, when not diseqc send was needed .. fix this
[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                                 eDebug("setVoltage %d", m_sec_sequence.current()->voltage);
379                                 break;
380                         case eSecCommand::SET_TONE:
381                                 setTone(m_sec_sequence.current()->tone);
382                                 eDebug("setTone %d", m_sec_sequence.current()->tone);
383                                 break;
384                         case eSecCommand::SEND_DISEQC:
385                                 sendDiseqc(m_sec_sequence.current()->diseqc);
386                                 eDebugNoNewLine("sendDiseqc: ");
387                                 for (int i=0; i < m_sec_sequence.current()->diseqc.len; ++i)
388                                     eDebugNoNewLine("%02x", m_sec_sequence.current()->diseqc.data[i]);
389                                 eDebug("");
390                                 break;
391                         case eSecCommand::SEND_TONEBURST:
392                                 sendToneburst(m_sec_sequence.current()->toneburst);
393                                 eDebug("sendToneburst: %d", m_sec_sequence.current()->toneburst);
394                                 break;
395                         case eSecCommand::SET_FRONTEND:
396                                 eDebug("setFrontend");
397                                 setFrontend();
398                                 break;
399                         case eSecCommand::IF_LOCK_GOTO:
400                         case eSecCommand::IF_NOT_LOCK_GOTO:
401                         default:
402                                 eDebug("unhandled sec command");
403                 }
404                 m_sec_sequence.current()++;
405                 m_tuneTimer->start(delay,true);
406         }
407 }
408
409 void eDVBFrontend::setFrontend()
410 {
411         eDebug("setting frontend..\n");
412         if (ioctl(m_fd, FE_SET_FRONTEND, &parm) == -1)
413         {
414                 perror("FE_SET_FRONTEND failed");
415                 return;
416         }
417
418         if (m_state != stateTuning)
419         {
420                 m_tuning = 1;
421                 m_state = stateTuning;
422                 m_stateChanged(this);
423         }
424         m_timeout->start(5000, 1); // 5 sec timeout. TODO: symbolrate dependent
425 }
426
427 RESULT eDVBFrontend::getFrontendType(int &t)
428 {
429         if (m_type == -1)
430                 return -ENODEV;
431         t = m_type;
432         return 0;
433 }
434
435 RESULT eDVBFrontend::tune(const iDVBFrontendParameters &where)
436 {
437         if (m_type == -1)
438                 return -ENODEV;
439
440         feEvent(-1);
441
442         m_sec_sequence.clear();
443
444         eDebug("eDVBFrontend::tune. type: %d", m_type);
445
446         switch (m_type)
447         {
448         case feSatellite:
449         {
450                 int res;
451                 eDVBFrontendParametersSatellite feparm;
452                 if (where.getDVBS(feparm))
453                 {
454                         eDebug("no dvbs data!");
455                         return -EINVAL;
456                 }
457                 if (!m_sec)
458                 {
459                         eWarning("no SEC module active!");
460                         return -ENOENT;
461                 }
462                 
463                 res = m_sec->prepare(*this, parm, feparm);
464                 if (res)
465                         return res;
466 #if HAVE_DVB_API_VERSION < 3
467                 eDebug("tuning to %d mhz", parm.Frequency/1000);
468 #else
469                 eDebug("tuning to %d mhz", parm.frequency/1000);
470 #endif
471                 break;
472         }
473         case feCable:
474         {
475                 eDVBFrontendParametersCable feparm;
476                 if (where.getDVBC(feparm))
477                         return -EINVAL;
478                 eFatal("cable tuning nyi");
479         }
480         case feTerrestrial:
481         {
482                 eDVBFrontendParametersTerrestrial feparm;
483                 if (where.getDVBT(feparm))
484                 {
485                         eDebug("no -T data");
486                         return -EINVAL;
487                 }
488 #if HAVE_DVB_API_VERSION < 3
489                 parm.Frequency = feparm.frequency;
490 #else
491                 parm.frequency = feparm.frequency;
492 #endif
493
494                 switch (feparm.bandwidth)
495                 {
496                 case eDVBFrontendParametersTerrestrial::Bandwidth::Bw8MHz:
497 #if HAVE_DVB_API_VERSION < 3
498                         parm.u.ofdm.bandWidth =
499 #else
500                         parm.u.ofdm.bandwidth =
501 #endif
502                                 BANDWIDTH_8_MHZ;
503                         break;
504                 case eDVBFrontendParametersTerrestrial::Bandwidth::Bw7MHz:
505 #if HAVE_DVB_API_VERSION < 3
506                         parm.u.ofdm.bandWidth =
507 #else
508                         parm.u.ofdm.bandwidth =
509 #endif
510                                 BANDWIDTH_7_MHZ;
511                         break;
512                 case eDVBFrontendParametersTerrestrial::Bandwidth::Bw6MHz:
513 #if HAVE_DVB_API_VERSION < 3
514                         parm.u.ofdm.bandWidth =
515 #else
516                         parm.u.ofdm.bandwidth =
517 #endif
518                                 BANDWIDTH_6_MHZ;
519                         break;
520                 case eDVBFrontendParametersTerrestrial::Bandwidth::BwAuto:
521 #if HAVE_DVB_API_VERSION < 3
522                         parm.u.ofdm.bandWidth =
523 #else
524                         parm.u.ofdm.bandwidth =
525 #endif
526                                 BANDWIDTH_AUTO;
527                         break;
528                 default:
529                         eWarning("invalid OFDM bandwith");
530                         return -EINVAL;
531                 }
532                 
533                 parm.u.ofdm.code_rate_HP = FEC_AUTO;
534                 parm.u.ofdm.code_rate_LP = FEC_AUTO;
535                 
536                 switch (feparm.modulation)
537                 {
538                 case eDVBFrontendParametersTerrestrial::Modulation::QPSK:
539                         parm.u.ofdm.constellation = QPSK;
540                         break;
541                 case eDVBFrontendParametersTerrestrial::Modulation::QAM16:
542                         parm.u.ofdm.constellation = QAM_16;
543                         break;
544                 case eDVBFrontendParametersTerrestrial::Modulation::Auto:
545                         parm.u.ofdm.constellation = QAM_AUTO;
546                         break;
547                 }
548                 
549                 switch (feparm.transmission_mode)
550                 {
551                 case eDVBFrontendParametersTerrestrial::TransmissionMode::TM2k:
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_2K;
558                         break;
559                 case eDVBFrontendParametersTerrestrial::TransmissionMode::TM8k:
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_8K;
566                         break;
567                 case eDVBFrontendParametersTerrestrial::TransmissionMode::TMAuto:
568 #if HAVE_DVB_API_VERSION < 3
569                         parm.u.ofdm.TransmissionMode =
570 #else
571                         parm.u.ofdm.transmission_mode =
572 #endif
573                                 TRANSMISSION_MODE_AUTO;
574                         break;
575                 }
576                 
577                 parm.u.ofdm.guard_interval = GUARD_INTERVAL_AUTO;
578                 parm.u.ofdm.hierarchy_information = HIERARCHY_AUTO;
579 #if HAVE_DVB_API_VERSION < 3
580                 parm.Inversion =
581 #else
582                 parm.inversion =
583 #endif
584                         INVERSION_AUTO;
585                 break;
586         }
587         }
588
589         m_sec_sequence.push_back( eSecCommand(eSecCommand::SET_FRONTEND) );
590         m_tuneTimer->start(0,true);
591         m_sec_sequence.current() = m_sec_sequence.begin();
592
593         return 0;
594 }
595
596 RESULT eDVBFrontend::connectStateChange(const Slot1<void,iDVBFrontend*> &stateChange, ePtr<eConnection> &connection)
597 {
598         connection = new eConnection(this, m_stateChanged.connect(stateChange));
599         return 0;
600 }
601
602 RESULT eDVBFrontend::setVoltage(int voltage)
603 {
604 #if HAVE_DVB_API_VERSION < 3
605         secVoltage vlt;
606 #else
607         fe_sec_voltage_t vlt;
608 #endif
609
610         switch (voltage)
611         {
612         case voltageOff:
613                 vlt = SEC_VOLTAGE_OFF;
614                 break;
615         case voltage13:
616                 vlt = SEC_VOLTAGE_13;
617                 break;
618         case voltage18:
619                 vlt = SEC_VOLTAGE_18;
620                 break;
621         default:
622                 return -ENODEV;
623         }
624 #if HAVE_DVB_API_VERSION < 3
625         return ::ioctl(m_secfd, SEC_SET_VOLTAGE, vlt);
626 #else
627         return ::ioctl(m_fd, FE_SET_VOLTAGE, vlt);
628 #endif
629 }
630
631 RESULT eDVBFrontend::getState(int &state)
632 {
633         state = m_state;
634         return 0;
635 }
636
637 RESULT eDVBFrontend::setTone(int t)
638 {
639 #if HAVE_DVB_API_VERSION < 3
640         secToneMode_t tone;
641 #else
642         fe_sec_tone_mode_t tone;
643 #endif
644
645         switch (t)
646         {
647         case toneOn:
648                 tone = SEC_TONE_ON;
649                 break;
650         case toneOff:
651                 tone = SEC_TONE_OFF;
652                 break;
653         default:
654                 return -ENODEV;
655         }
656 #if HAVE_DVB_API_VERSION < 3    
657         return ::ioctl(m_secfd, SEC_SET_TONE, tone);
658 #else   
659         return ::ioctl(m_fd, FE_SET_TONE, tone);
660 #endif
661 }
662
663 #if HAVE_DVB_API_VERSION < 3 && !defined(SEC_DISEQC_SEND_MASTER_CMD)
664         #define SEC_DISEQC_SEND_MASTER_CMD _IOW('o', 97, struct secCommand *)
665 #endif
666
667 RESULT eDVBFrontend::sendDiseqc(const eDVBDiseqcCommand &diseqc)
668 {
669 #if HAVE_DVB_API_VERSION < 3
670         struct secCommand cmd;
671         cmd.type = SEC_CMDTYPE_DISEQC_RAW;
672         cmd.u.diseqc.cmdtype = diseqc.data[0];
673         cmd.u.diseqc.addr = diseqc.data[1];
674         cmd.u.diseqc.cmd = diseqc.data[2];
675         cmd.u.diseqc.numParams = diseqc.len-3;
676         memcpy(cmd.u.diseqc.params, diseqc.data+3, diseqc.len-3);
677         if (::ioctl(m_secfd, SEC_DISEQC_SEND_MASTER_CMD, &cmd))
678 #else
679         struct dvb_diseqc_master_cmd cmd;
680         memcpy(cmd.msg, diseqc.data, diseqc.len);
681         cmd.msg_len = diseqc.len;
682         if (::ioctl(m_fd, FE_DISEQC_SEND_MASTER_CMD, &cmd))
683 #endif
684                 return -EINVAL;
685         return 0;
686 }
687
688 #if HAVE_DVB_API_VERSION < 3 && !defined(SEC_DISEQC_SEND_BURST)
689         #define SEC_DISEQC_SEND_BURST _IO('o', 96)
690 #endif
691 RESULT eDVBFrontend::sendToneburst(int burst)
692 {
693 #if HAVE_DVB_API_VERSION < 3
694         secMiniCmd cmd = SEC_MINI_NONE;
695         if ( burst == eDVBSatelliteDiseqcParameters::A )
696                 cmd = SEC_MINI_A;
697         else if ( burst == eDVBSatelliteDiseqcParameters::B )
698                 cmd = SEC_MINI_B;
699         if (::ioctl(m_secfd, SEC_DISEQC_SEND_BURST, cmd))
700                 return -EINVAL;
701 #endif
702         return 0;
703 }
704
705 RESULT eDVBFrontend::setSEC(iDVBSatelliteEquipmentControl *sec)
706 {
707         m_sec = sec;
708         return 0;
709 }
710
711 RESULT eDVBFrontend::setSecSequence(const eSecCommandList &list)
712 {
713         m_sec_sequence = list;
714         return 0;
715 }
716
717 RESULT eDVBFrontend::getData(int num, int &data)
718 {
719         if ( num < 5 )
720         {
721                 data = m_data[num];
722                 return 0;
723         }
724         return -EINVAL;
725 }
726
727 RESULT eDVBFrontend::setData(int num, int val)
728 {
729         if ( num < 5 )
730         {
731                 m_data[num] = val;
732                 return 0;
733         }
734         return -EINVAL;
735 }
736