2 #include <lib/dvb/dvb.h>
3 #include <lib/base/eerror.h>
9 #if HAVE_DVB_API_VERSION < 3
10 #include <ost/frontend.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
23 #include <linux/dvb/frontend.h>
26 #include <dvbsi++/satellite_delivery_system_descriptor.h>
27 #include <dvbsi++/cable_delivery_system_descriptor.h>
28 #include <dvbsi++/terrestrial_delivery_system_descriptor.h>
30 void eDVBFrontendParametersSatellite::set(const SatelliteDeliverySystemDescriptor &descriptor)
32 frequency = descriptor.getFrequency() * 10;
33 symbol_rate = descriptor.getSymbolRate() * 100;
34 switch (descriptor.getPolarization())
37 polarisation = Polarisation::Horizontal;
40 polarisation = Polarisation::Vertical;
43 polarisation = Polarisation::CircularLeft;
46 polarisation = Polarisation::CircularRight;
49 switch (descriptor.getFecInner())
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;
82 void eDVBFrontendParametersCable::set(const CableDeliverySystemDescriptor &descriptor)
87 void eDVBFrontendParametersTerrestrial::set(const TerrestrialDeliverySystemDescriptor &)
92 eDVBFrontendParameters::eDVBFrontendParameters(): m_type(-1)
96 DEFINE_REF(eDVBFrontendParameters);
98 RESULT eDVBFrontendParameters::getSystem(int &t) const
106 RESULT eDVBFrontendParameters::getDVBS(eDVBFrontendParametersSatellite &p) const
108 if (m_type != iDVBFrontend::feSatellite)
114 RESULT eDVBFrontendParameters::getDVBC(eDVBFrontendParametersCable &p) const
116 if (m_type != iDVBFrontend::feCable)
122 RESULT eDVBFrontendParameters::getDVBT(eDVBFrontendParametersTerrestrial &p) const
124 if (m_type != iDVBFrontend::feTerrestrial)
130 RESULT eDVBFrontendParameters::setDVBS(eDVBFrontendParametersSatellite &p)
133 m_type = iDVBFrontend::feSatellite;
137 RESULT eDVBFrontendParameters::setDVBC(eDVBFrontendParametersCable &p)
140 m_type = iDVBFrontend::feCable;
144 RESULT eDVBFrontendParameters::setDVBT(eDVBFrontendParametersTerrestrial &p)
147 m_type = iDVBFrontend::feTerrestrial;
151 RESULT eDVBFrontendParameters::calculateDifference(const iDVBFrontendParameters *parm, int &diff) const
156 if (parm->getSystem(type))
160 diff = 1<<30; // big difference
166 case iDVBFrontend::feSatellite:
168 eDVBFrontendParametersSatellite osat;
169 if (parm->getDVBS(osat))
172 if (sat.orbital_position != osat.orbital_position)
174 else if (sat.polarisation != osat.polarisation)
177 diff = abs(sat.frequency - osat.frequency);
180 case iDVBFrontend::feCable:
181 case iDVBFrontend::feTerrestrial:
188 RESULT eDVBFrontendParameters::getHash(unsigned long &hash) const
192 case iDVBFrontend::feSatellite:
194 hash = sat.frequency & 0xFFFF;
195 hash |= sat.orbital_position << 16;
198 case iDVBFrontend::feCable:
199 case iDVBFrontend::feTerrestrial:
205 DEFINE_REF(eDVBFrontend);
207 eDVBFrontend::eDVBFrontend(int adap, int fe, int &ok): m_type(-1), m_curVoltage(-1)
209 #if HAVE_DVB_API_VERSION < 3
210 char sec_filename[128];
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);
224 eWarning("failed! (%s) %m", sec_filename);
229 eDebug("m_secfd is %d", m_secfd);
231 FrontendInfo fe_info;
232 sprintf(filename, "/dev/dvb/card%d/frontend%d", adap, fe);
234 dvb_frontend_info fe_info;
235 sprintf(filename, "/dev/dvb/adapter%d/frontend%d", adap, fe);
237 eDebug("opening frontend.");
238 m_fd = ::open(filename, O_RDWR|O_NONBLOCK);
241 eWarning("failed! (%s) %m", filename);
246 result = ::ioctl(m_fd, FE_GET_INFO, &fe_info);
249 eWarning("ioctl FE_GET_INFO failed");
256 switch (fe_info.type)
259 m_type = feSatellite;
265 m_type = feTerrestrial;
268 eWarning("unknown frontend type.");
274 eDebug("detected %s frontend", "satellite\0cable\0 terrestrial"+fe_info.type*9);
277 m_sn = new eSocketNotifier(eApp, m_fd, eSocketNotifier::Read);
278 CONNECT(m_sn->activated, eDVBFrontend::feEvent);
281 m_timeout = new eTimer(eApp);
282 CONNECT(m_timeout->timeout, eDVBFrontend::timeout);
284 m_tuneTimer = new eTimer(eApp);
285 CONNECT(m_tuneTimer->timeout, eDVBFrontend::tuneLoop);
287 memset(m_data, 0xFFFF, sizeof(m_data));
292 eDVBFrontend::~eDVBFrontend()
302 void eDVBFrontend::feEvent(int w)
306 #if HAVE_DVB_API_VERSION < 3
309 dvb_frontend_event event;
313 res = ::ioctl(m_fd, FE_GET_EVENT, &event);
315 if (res && (errno == EAGAIN))
320 eWarning("FE_GET_EVENT failed! %m");
327 #if HAVE_DVB_API_VERSION < 3
328 if (event.type == FE_COMPLETION_EV)
330 eDebug("fe event: status %x, inversion %s", event.status, (event.parameters.inversion == INVERSION_ON) ? "on" : "off");
331 if (event.status & FE_HAS_LOCK)
342 if (m_state != state)
345 m_stateChanged(this);
350 void eDVBFrontend::timeout()
353 if (m_state == stateTuning)
356 eDebug("DVBFrontend: timeout");
357 if (m_state != state)
360 m_stateChanged(this);
366 #ifndef FP_IOCTL_GET_ID
367 #define FP_IOCTL_GET_ID 0
369 int eDVBFrontend::readInputpower()
372 // if ( eSystemInfo::getInstance()->canMeasureLNBCurrent() )
374 // switch ( eSystemInfo::getInstance()->getHwType() )
376 // case eSystemInfo::DM7000:
377 // case eSystemInfo::DM7020:
379 // open front prozessor
380 int fp=::open("/dev/dbox/fp0", O_RDWR);
383 eDebug("couldn't open fp");
386 static bool old_fp = (::ioctl(fp, FP_IOCTL_GET_ID) < 0);
387 if ( ioctl( fp, old_fp ? 9 : 0x100, &power ) < 0 )
389 eDebug("FP_IOCTL_GET_LNB_CURRENT failed (%m)");
396 // eDebug("Inputpower read for platform %d not yet implemented", eSystemInfo::getInstance()->getHwType());
402 bool eDVBFrontend::setSecSequencePos(int steps)
404 eDebug("set sequence pos %d", steps);
409 if (m_sec_sequence.current() != m_sec_sequence.end())
410 ++m_sec_sequence.current();
415 if (m_sec_sequence.current() != m_sec_sequence.begin() && m_sec_sequence.current() != m_sec_sequence.end())
416 --m_sec_sequence.current();
422 void eDVBFrontend::tuneLoop() // called by m_tuneTimer
425 if ( m_sec_sequence && m_sec_sequence.current() != m_sec_sequence.end() )
427 switch (m_sec_sequence.current()->cmd)
429 case eSecCommand::SLEEP:
430 delay = m_sec_sequence.current()++->msec;
431 eDebug("[SEC] sleep %dms", delay);
433 case eSecCommand::GOTO:
434 if ( !setSecSequencePos(m_sec_sequence.current()->steps) )
435 ++m_sec_sequence.current();
437 case eSecCommand::SET_VOLTAGE:
438 int voltage = m_sec_sequence.current()++->voltage;
439 eDebug("[SEC] setVoltage %d", voltage);
442 case eSecCommand::SET_TONE:
443 eDebug("[SEC] setTone %d", m_sec_sequence.current()->tone);
444 setTone(m_sec_sequence.current()++->tone);
446 case eSecCommand::SEND_DISEQC:
447 sendDiseqc(m_sec_sequence.current()->diseqc);
448 eDebugNoNewLine("[SEC] sendDiseqc: ");
449 for (int i=0; i < m_sec_sequence.current()->diseqc.len; ++i)
450 eDebugNoNewLine("%02x", m_sec_sequence.current()->diseqc.data[i]);
452 ++m_sec_sequence.current();
454 case eSecCommand::SEND_TONEBURST:
455 eDebug("[SEC] sendToneburst: %d", m_sec_sequence.current()->toneburst);
456 sendToneburst(m_sec_sequence.current()++->toneburst);
458 case eSecCommand::SET_FRONTEND:
459 eDebug("[SEC] setFrontend");
461 ++m_sec_sequence.current();
463 case eSecCommand::MEASURE_IDLE_INPUTPOWER:
465 int idx = m_sec_sequence.current()++->val;
466 if ( idx == 0 || idx == 1 )
468 m_idleInputpower[idx] = readInputpower();
469 eDebug("[SEC] idleInputpower[%d] is %d", idx, m_idleInputpower[idx]);
472 eDebug("[SEC] idleInputpower measure index(%d) out of bound !!!", idx);
475 case eSecCommand::MEASURE_RUNNING_INPUTPOWER:
476 m_runningInputpower = readInputpower();
477 eDebug("[SEC] runningInputpower is %d", m_runningInputpower);
478 ++m_sec_sequence.current();
480 case eSecCommand::SET_TIMEOUT:
481 m_timeoutCount = m_sec_sequence.current()++->val;
482 eDebug("[SEC] set timeout %d", m_timeoutCount);
484 case eSecCommand::UPDATE_CURRENT_ROTORPARAMS:
485 m_data[5] = m_data[3];
486 m_data[6] = m_data[4];
487 eDebug("[SEC] update current rotorparams %d %04x %d", m_timeoutCount, m_data[5], m_data[6]);
488 ++m_sec_sequence.current();
490 case eSecCommand::IF_TIMEOUT_GOTO:
493 eDebug("[SEC] rotor timout");
494 setSecSequencePos(m_sec_sequence.current()->steps);
497 ++m_sec_sequence.current();
499 case eSecCommand::SET_POWER_LIMITING_MODE:
501 int fd=::open("/dev/i2c/0", O_RDWR);
502 unsigned char data[2];
503 ::ioctl(fd, I2C_SLAVE_FORCE, 0x10 >> 1);
504 if(::read(fd, data, 1) != 1)
505 eDebug("[SEC] error read lnbp (%m)");
506 if ( m_sec_sequence.current()->mode == eSecCommand::modeStatic )
508 data[0] |= 0x90; // enable static current limiting
509 eDebug("[SEC] set static current limiting");
513 data[0] &= ~0x90; // enable dynamic current limiting
514 eDebug("[SEC] set dynamic current limiting");
516 if(::write(fd, data, 1) != 1)
517 eDebug("[SEC] error write lnbp (%m)");
519 ++m_sec_sequence.current();
522 case eSecCommand::IF_IDLE_INPUTPOWER_AVAIL_GOTO:
523 if (m_idleInputpower[0] && m_idleInputpower[1] && setSecSequencePos(m_sec_sequence.current()->steps))
525 ++m_sec_sequence.current();
527 case eSecCommand::IF_INPUTPOWER_DELTA_GOTO:
529 int idleInputpower = m_idleInputpower[m_curVoltage == iDVBFrontend::voltage13 ? 0 : 1];
530 eSecCommand::rotor &cmd = m_sec_sequence.current()->measure;
531 const char *txt = cmd.direction ? "running" : "stopped";
532 eDebug("[SEC] waiting for rotor %s %d, idle %d, delta %d",
537 if ( (cmd.direction && abs(m_runningInputpower - idleInputpower) >= cmd.deltaA)
538 || (!cmd.direction && abs(m_runningInputpower - idleInputpower) <= cmd.deltaA) )
541 eDebug("[SEC] rotor %s step %d ok", txt, cmd.okcount);
542 if ( cmd.okcount > 6 )
544 eDebug("[SEC] rotor is %s", txt);
545 if (setSecSequencePos(cmd.steps))
551 eDebug("[SEC] rotor not %s... reset counter.. increase timeout", txt);
555 ++m_sec_sequence.current();
558 case eSecCommand::IF_VOLTAGE_GOTO:
560 eSecCommand::pair &compare = m_sec_sequence.current()->compare;
561 if ( compare.voltage == m_curVoltage && setSecSequencePos(compare.steps) )
563 ++m_sec_sequence.current();
567 ++m_sec_sequence.current();
568 eDebug("[SEC] unhandled sec command");
570 m_tuneTimer->start(delay,true);
574 void eDVBFrontend::setFrontend()
576 eDebug("setting frontend..\n");
577 if (ioctl(m_fd, FE_SET_FRONTEND, &parm) == -1)
579 perror("FE_SET_FRONTEND failed");
583 if (m_state != stateTuning)
586 m_state = stateTuning;
587 m_stateChanged(this);
589 m_timeout->start(5000, 1); // 5 sec timeout. TODO: symbolrate dependent
592 RESULT eDVBFrontend::getFrontendType(int &t)
600 RESULT eDVBFrontend::tune(const iDVBFrontendParameters &where)
607 m_sec_sequence.clear();
609 eDebug("eDVBFrontend::tune. type: %d", m_type);
616 eDVBFrontendParametersSatellite feparm;
617 if (where.getDVBS(feparm))
619 eDebug("no dvbs data!");
624 eWarning("no SEC module active!");
628 res = m_sec->prepare(*this, parm, feparm);
631 #if HAVE_DVB_API_VERSION < 3
632 eDebug("tuning to %d mhz", parm.Frequency/1000);
634 eDebug("tuning to %d mhz", parm.frequency/1000);
640 eDVBFrontendParametersCable feparm;
641 if (where.getDVBC(feparm))
643 eFatal("cable tuning nyi");
647 eDVBFrontendParametersTerrestrial feparm;
648 if (where.getDVBT(feparm))
650 eDebug("no -T data");
653 #if HAVE_DVB_API_VERSION < 3
654 parm.Frequency = feparm.frequency;
656 parm.frequency = feparm.frequency;
659 switch (feparm.bandwidth)
661 case eDVBFrontendParametersTerrestrial::Bandwidth::Bw8MHz:
662 #if HAVE_DVB_API_VERSION < 3
663 parm.u.ofdm.bandWidth =
665 parm.u.ofdm.bandwidth =
669 case eDVBFrontendParametersTerrestrial::Bandwidth::Bw7MHz:
670 #if HAVE_DVB_API_VERSION < 3
671 parm.u.ofdm.bandWidth =
673 parm.u.ofdm.bandwidth =
677 case eDVBFrontendParametersTerrestrial::Bandwidth::Bw6MHz:
678 #if HAVE_DVB_API_VERSION < 3
679 parm.u.ofdm.bandWidth =
681 parm.u.ofdm.bandwidth =
685 case eDVBFrontendParametersTerrestrial::Bandwidth::BwAuto:
686 #if HAVE_DVB_API_VERSION < 3
687 parm.u.ofdm.bandWidth =
689 parm.u.ofdm.bandwidth =
694 eWarning("invalid OFDM bandwith");
698 parm.u.ofdm.code_rate_HP = FEC_AUTO;
699 parm.u.ofdm.code_rate_LP = FEC_AUTO;
701 switch (feparm.modulation)
703 case eDVBFrontendParametersTerrestrial::Modulation::QPSK:
704 parm.u.ofdm.constellation = QPSK;
706 case eDVBFrontendParametersTerrestrial::Modulation::QAM16:
707 parm.u.ofdm.constellation = QAM_16;
709 case eDVBFrontendParametersTerrestrial::Modulation::Auto:
710 parm.u.ofdm.constellation = QAM_AUTO;
714 switch (feparm.transmission_mode)
716 case eDVBFrontendParametersTerrestrial::TransmissionMode::TM2k:
717 #if HAVE_DVB_API_VERSION < 3
718 parm.u.ofdm.TransmissionMode =
720 parm.u.ofdm.transmission_mode =
722 TRANSMISSION_MODE_2K;
724 case eDVBFrontendParametersTerrestrial::TransmissionMode::TM8k:
725 #if HAVE_DVB_API_VERSION < 3
726 parm.u.ofdm.TransmissionMode =
728 parm.u.ofdm.transmission_mode =
730 TRANSMISSION_MODE_8K;
732 case eDVBFrontendParametersTerrestrial::TransmissionMode::TMAuto:
733 #if HAVE_DVB_API_VERSION < 3
734 parm.u.ofdm.TransmissionMode =
736 parm.u.ofdm.transmission_mode =
738 TRANSMISSION_MODE_AUTO;
742 parm.u.ofdm.guard_interval = GUARD_INTERVAL_AUTO;
743 parm.u.ofdm.hierarchy_information = HIERARCHY_AUTO;
744 #if HAVE_DVB_API_VERSION < 3
754 m_sec_sequence.push_back( eSecCommand(eSecCommand::SET_FRONTEND) );
755 m_tuneTimer->start(0,true);
756 m_sec_sequence.current() = m_sec_sequence.begin();
761 RESULT eDVBFrontend::connectStateChange(const Slot1<void,iDVBFrontend*> &stateChange, ePtr<eConnection> &connection)
763 connection = new eConnection(this, m_stateChanged.connect(stateChange));
767 RESULT eDVBFrontend::setVoltage(int voltage)
769 #if HAVE_DVB_API_VERSION < 3
772 fe_sec_voltage_t vlt;
775 m_curVoltage=voltage;
779 vlt = SEC_VOLTAGE_OFF;
782 vlt = SEC_VOLTAGE_13;
785 vlt = SEC_VOLTAGE_18;
790 #if HAVE_DVB_API_VERSION < 3
791 return ::ioctl(m_secfd, SEC_SET_VOLTAGE, vlt);
793 return ::ioctl(m_fd, FE_SET_VOLTAGE, vlt);
797 RESULT eDVBFrontend::getState(int &state)
803 RESULT eDVBFrontend::setTone(int t)
805 #if HAVE_DVB_API_VERSION < 3
808 fe_sec_tone_mode_t tone;
822 #if HAVE_DVB_API_VERSION < 3
823 return ::ioctl(m_secfd, SEC_SET_TONE, tone);
825 return ::ioctl(m_fd, FE_SET_TONE, tone);
829 #if HAVE_DVB_API_VERSION < 3 && !defined(SEC_DISEQC_SEND_MASTER_CMD)
830 #define SEC_DISEQC_SEND_MASTER_CMD _IOW('o', 97, struct secCommand *)
833 RESULT eDVBFrontend::sendDiseqc(const eDVBDiseqcCommand &diseqc)
835 #if HAVE_DVB_API_VERSION < 3
836 struct secCommand cmd;
837 cmd.type = SEC_CMDTYPE_DISEQC_RAW;
838 cmd.u.diseqc.cmdtype = diseqc.data[0];
839 cmd.u.diseqc.addr = diseqc.data[1];
840 cmd.u.diseqc.cmd = diseqc.data[2];
841 cmd.u.diseqc.numParams = diseqc.len-3;
842 memcpy(cmd.u.diseqc.params, diseqc.data+3, diseqc.len-3);
843 if (::ioctl(m_secfd, SEC_DISEQC_SEND_MASTER_CMD, &cmd))
845 struct dvb_diseqc_master_cmd cmd;
846 memcpy(cmd.msg, diseqc.data, diseqc.len);
847 cmd.msg_len = diseqc.len;
848 if (::ioctl(m_fd, FE_DISEQC_SEND_MASTER_CMD, &cmd))
854 #if HAVE_DVB_API_VERSION < 3 && !defined(SEC_DISEQC_SEND_BURST)
855 #define SEC_DISEQC_SEND_BURST _IO('o', 96)
857 RESULT eDVBFrontend::sendToneburst(int burst)
859 #if HAVE_DVB_API_VERSION < 3
860 secMiniCmd cmd = SEC_MINI_NONE;
861 if ( burst == eDVBSatelliteDiseqcParameters::A )
863 else if ( burst == eDVBSatelliteDiseqcParameters::B )
865 if (::ioctl(m_secfd, SEC_DISEQC_SEND_BURST, cmd))
871 RESULT eDVBFrontend::setSEC(iDVBSatelliteEquipmentControl *sec)
877 RESULT eDVBFrontend::setSecSequence(const eSecCommandList &list)
879 m_sec_sequence = list;
883 RESULT eDVBFrontend::getData(int num, int &data)
893 RESULT eDVBFrontend::setData(int num, int val)