2 #include <lib/dvb/dvb.h>
3 #include <lib/base/eerror.h>
9 #ifndef I2C_SLAVE_FORCE
10 #define I2C_SLAVE_FORCE 0x0706
13 #if HAVE_DVB_API_VERSION < 3
14 #include <ost/frontend.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 constellation Constellation
22 #define guard_interval guardInterval
23 #define hierarchy_information HierarchyInformation
24 #define code_rate_HP HP_CodeRate
25 #define code_rate_LP LP_CodeRate
27 #include <linux/dvb/frontend.h>
30 #include <dvbsi++/satellite_delivery_system_descriptor.h>
31 #include <dvbsi++/cable_delivery_system_descriptor.h>
32 #include <dvbsi++/terrestrial_delivery_system_descriptor.h>
34 void eDVBFrontendParametersSatellite::set(const SatelliteDeliverySystemDescriptor &descriptor)
36 frequency = descriptor.getFrequency() * 10;
37 symbol_rate = descriptor.getSymbolRate() * 100;
38 switch (descriptor.getPolarization())
41 polarisation = Polarisation::Horizontal;
44 polarisation = Polarisation::Vertical;
47 polarisation = Polarisation::CircularLeft;
50 polarisation = Polarisation::CircularRight;
53 switch (descriptor.getFecInner())
77 inversion = Inversion::Unknown;
78 orbital_position = ((descriptor.getOrbitalPosition() >> 12) & 0xF) * 1000;
79 orbital_position += ((descriptor.getOrbitalPosition() >> 8) & 0xF) * 100;
80 orbital_position += ((descriptor.getOrbitalPosition() >> 4) & 0xF) * 10;
81 orbital_position += ((descriptor.getOrbitalPosition()) & 0xF);
82 if (orbital_position && (!descriptor.getWestEastFlag()))
83 orbital_position = 3600 - orbital_position;
86 void eDVBFrontendParametersCable::set(const CableDeliverySystemDescriptor &descriptor)
91 void eDVBFrontendParametersTerrestrial::set(const TerrestrialDeliverySystemDescriptor &)
96 eDVBFrontendParameters::eDVBFrontendParameters(): m_type(-1)
100 DEFINE_REF(eDVBFrontendParameters);
102 RESULT eDVBFrontendParameters::getSystem(int &t) const
110 RESULT eDVBFrontendParameters::getDVBS(eDVBFrontendParametersSatellite &p) const
112 if (m_type != iDVBFrontend::feSatellite)
118 RESULT eDVBFrontendParameters::getDVBC(eDVBFrontendParametersCable &p) const
120 if (m_type != iDVBFrontend::feCable)
126 RESULT eDVBFrontendParameters::getDVBT(eDVBFrontendParametersTerrestrial &p) const
128 if (m_type != iDVBFrontend::feTerrestrial)
134 RESULT eDVBFrontendParameters::setDVBS(const eDVBFrontendParametersSatellite &p)
137 m_type = iDVBFrontend::feSatellite;
141 RESULT eDVBFrontendParameters::setDVBC(const eDVBFrontendParametersCable &p)
144 m_type = iDVBFrontend::feCable;
148 RESULT eDVBFrontendParameters::setDVBT(const eDVBFrontendParametersTerrestrial &p)
151 m_type = iDVBFrontend::feTerrestrial;
155 RESULT eDVBFrontendParameters::calculateDifference(const iDVBFrontendParameters *parm, int &diff) const
160 if (parm->getSystem(type))
164 diff = 1<<30; // big difference
170 case iDVBFrontend::feSatellite:
172 eDVBFrontendParametersSatellite osat;
173 if (parm->getDVBS(osat))
176 if (sat.orbital_position != osat.orbital_position)
178 else if (sat.polarisation != osat.polarisation)
181 diff = abs(sat.frequency - osat.frequency);
184 case iDVBFrontend::feCable:
185 case iDVBFrontend::feTerrestrial:
192 RESULT eDVBFrontendParameters::getHash(unsigned long &hash) const
196 case iDVBFrontend::feSatellite:
198 hash = sat.frequency & 0xFFFF;
199 hash |= sat.orbital_position << 16;
202 case iDVBFrontend::feCable:
203 case iDVBFrontend::feTerrestrial:
209 DEFINE_REF(eDVBFrontend);
211 eDVBFrontend::eDVBFrontend(int adap, int fe, int &ok): m_type(-1), m_fe(fe), m_curVoltage(-1)
213 #if HAVE_DVB_API_VERSION < 3
214 char sec_filename[128];
223 #if HAVE_DVB_API_VERSION < 3
224 sprintf(sec_filename, "/dev/dvb/card%d/sec%d", adap, fe);
225 m_secfd = ::open(sec_filename, O_RDWR);
228 eWarning("failed! (%s) %m", sec_filename);
233 eDebug("m_secfd is %d", m_secfd);
235 FrontendInfo fe_info;
236 sprintf(filename, "/dev/dvb/card%d/frontend%d", adap, fe);
238 dvb_frontend_info fe_info;
239 sprintf(filename, "/dev/dvb/adapter%d/frontend%d", adap, fe);
241 eDebug("opening frontend.");
242 m_fd = ::open(filename, O_RDWR|O_NONBLOCK);
245 eWarning("failed! (%s) %m", filename);
250 result = ::ioctl(m_fd, FE_GET_INFO, &fe_info);
253 eWarning("ioctl FE_GET_INFO failed");
260 switch (fe_info.type)
263 m_type = feSatellite;
269 m_type = feTerrestrial;
272 eWarning("unknown frontend type.");
278 eDebug("detected %s frontend", "satellite\0cable\0 terrestrial"+fe_info.type*9);
281 m_sn = new eSocketNotifier(eApp, m_fd, eSocketNotifier::Read);
282 CONNECT(m_sn->activated, eDVBFrontend::feEvent);
285 m_timeout = new eTimer(eApp);
286 CONNECT(m_timeout->timeout, eDVBFrontend::timeout);
288 m_tuneTimer = new eTimer(eApp);
289 CONNECT(m_tuneTimer->timeout, eDVBFrontend::tuneLoop);
291 memset(m_data, 0xFFFF, sizeof(m_data));
296 eDVBFrontend::~eDVBFrontend()
306 void eDVBFrontend::feEvent(int w)
310 #if HAVE_DVB_API_VERSION < 3
313 dvb_frontend_event event;
317 res = ::ioctl(m_fd, FE_GET_EVENT, &event);
319 if (res && (errno == EAGAIN))
324 eWarning("FE_GET_EVENT failed! %m");
331 #if HAVE_DVB_API_VERSION < 3
332 if (event.type == FE_COMPLETION_EV)
334 eDebug("fe event: status %x, inversion %s", event.status, (event.parameters.inversion == INVERSION_ON) ? "on" : "off");
335 if (event.status & FE_HAS_LOCK)
345 state = stateLostLock;
347 if (m_state != stateLostLock)
348 eDebug("FIXME: we lost lock, so we might have to retune.");
351 if (m_state != state)
354 m_stateChanged(this);
359 void eDVBFrontend::timeout()
362 if (m_state == stateTuning)
365 eDebug("DVBFrontend: timeout");
366 if (m_state != state)
369 m_stateChanged(this);
376 #ifndef FP_IOCTL_GET_ID
377 #define FP_IOCTL_GET_ID 0
379 int eDVBFrontend::readInputpower()
382 // if ( eSystemInfo::getInstance()->canMeasureLNBCurrent() )
384 // switch ( eSystemInfo::getInstance()->getHwType() )
386 // case eSystemInfo::DM7000:
387 // case eSystemInfo::DM7020:
389 // open front prozessor
390 int fp=::open("/dev/dbox/fp0", O_RDWR);
393 eDebug("couldn't open fp");
396 static bool old_fp = (::ioctl(fp, FP_IOCTL_GET_ID) < 0);
397 if ( ioctl( fp, old_fp ? 9 : 0x100, &power ) < 0 )
399 eDebug("FP_IOCTL_GET_LNB_CURRENT failed (%m)");
406 // eDebug("Inputpower read for platform %d not yet implemented", eSystemInfo::getInstance()->getHwType());
412 bool eDVBFrontend::setSecSequencePos(int steps)
414 eDebug("set sequence pos %d", steps);
419 if (m_sec_sequence.current() != m_sec_sequence.end())
420 ++m_sec_sequence.current();
425 if (m_sec_sequence.current() != m_sec_sequence.begin() && m_sec_sequence.current() != m_sec_sequence.end())
426 --m_sec_sequence.current();
432 void eDVBFrontend::tuneLoop() // called by m_tuneTimer
435 if ( m_sec_sequence && m_sec_sequence.current() != m_sec_sequence.end() )
437 switch (m_sec_sequence.current()->cmd)
439 case eSecCommand::SLEEP:
440 delay = m_sec_sequence.current()++->msec;
441 eDebug("[SEC] sleep %dms", delay);
443 case eSecCommand::GOTO:
444 if ( !setSecSequencePos(m_sec_sequence.current()->steps) )
445 ++m_sec_sequence.current();
447 case eSecCommand::SET_VOLTAGE:
448 int voltage = m_sec_sequence.current()++->voltage;
449 eDebug("[SEC] setVoltage %d", voltage);
452 case eSecCommand::SET_TONE:
453 eDebug("[SEC] setTone %d", m_sec_sequence.current()->tone);
454 setTone(m_sec_sequence.current()++->tone);
456 case eSecCommand::SEND_DISEQC:
457 sendDiseqc(m_sec_sequence.current()->diseqc);
458 eDebugNoNewLine("[SEC] sendDiseqc: ");
459 for (int i=0; i < m_sec_sequence.current()->diseqc.len; ++i)
460 eDebugNoNewLine("%02x", m_sec_sequence.current()->diseqc.data[i]);
462 ++m_sec_sequence.current();
464 case eSecCommand::SEND_TONEBURST:
465 eDebug("[SEC] sendToneburst: %d", m_sec_sequence.current()->toneburst);
466 sendToneburst(m_sec_sequence.current()++->toneburst);
468 case eSecCommand::SET_FRONTEND:
469 eDebug("[SEC] setFrontend");
471 ++m_sec_sequence.current();
473 case eSecCommand::MEASURE_IDLE_INPUTPOWER:
475 int idx = m_sec_sequence.current()++->val;
476 if ( idx == 0 || idx == 1 )
478 m_idleInputpower[idx] = readInputpower();
479 eDebug("[SEC] idleInputpower[%d] is %d", idx, m_idleInputpower[idx]);
482 eDebug("[SEC] idleInputpower measure index(%d) out of bound !!!", idx);
485 case eSecCommand::MEASURE_RUNNING_INPUTPOWER:
486 m_runningInputpower = readInputpower();
487 eDebug("[SEC] runningInputpower is %d", m_runningInputpower);
488 ++m_sec_sequence.current();
490 case eSecCommand::SET_TIMEOUT:
491 m_timeoutCount = m_sec_sequence.current()++->val;
492 eDebug("[SEC] set timeout %d", m_timeoutCount);
494 case eSecCommand::UPDATE_CURRENT_ROTORPARAMS:
495 m_data[5] = m_data[3];
496 m_data[6] = m_data[4];
497 eDebug("[SEC] update current rotorparams %d %04x %d", m_timeoutCount, m_data[5], m_data[6]);
498 ++m_sec_sequence.current();
500 case eSecCommand::IF_TIMEOUT_GOTO:
503 eDebug("[SEC] rotor timout");
504 setSecSequencePos(m_sec_sequence.current()->steps);
507 ++m_sec_sequence.current();
509 case eSecCommand::SET_POWER_LIMITING_MODE:
511 int fd=::open("/dev/i2c/0", O_RDWR);
512 unsigned char data[2];
513 ::ioctl(fd, I2C_SLAVE_FORCE, 0x10 >> 1);
514 if(::read(fd, data, 1) != 1)
515 eDebug("[SEC] error read lnbp (%m)");
516 if ( m_sec_sequence.current()->mode == eSecCommand::modeStatic )
518 data[0] |= 0x90; // enable static current limiting
519 eDebug("[SEC] set static current limiting");
523 data[0] &= ~0x90; // enable dynamic current limiting
524 eDebug("[SEC] set dynamic current limiting");
526 if(::write(fd, data, 1) != 1)
527 eDebug("[SEC] error write lnbp (%m)");
529 ++m_sec_sequence.current();
532 case eSecCommand::IF_IDLE_INPUTPOWER_AVAIL_GOTO:
533 if (m_idleInputpower[0] && m_idleInputpower[1] && setSecSequencePos(m_sec_sequence.current()->steps))
535 ++m_sec_sequence.current();
537 case eSecCommand::IF_INPUTPOWER_DELTA_GOTO:
539 int idleInputpower = m_idleInputpower[m_curVoltage == iDVBFrontend::voltage13 ? 0 : 1];
540 eSecCommand::rotor &cmd = m_sec_sequence.current()->measure;
541 const char *txt = cmd.direction ? "running" : "stopped";
542 eDebug("[SEC] waiting for rotor %s %d, idle %d, delta %d",
547 if ( (cmd.direction && abs(m_runningInputpower - idleInputpower) >= cmd.deltaA)
548 || (!cmd.direction && abs(m_runningInputpower - idleInputpower) <= cmd.deltaA) )
551 eDebug("[SEC] rotor %s step %d ok", txt, cmd.okcount);
552 if ( cmd.okcount > 6 )
554 eDebug("[SEC] rotor is %s", txt);
555 if (setSecSequencePos(cmd.steps))
561 eDebug("[SEC] rotor not %s... reset counter.. increase timeout", txt);
565 ++m_sec_sequence.current();
568 case eSecCommand::IF_VOLTAGE_GOTO:
570 eSecCommand::pair &compare = m_sec_sequence.current()->compare;
571 if ( compare.voltage == m_curVoltage && setSecSequencePos(compare.steps) )
573 ++m_sec_sequence.current();
577 ++m_sec_sequence.current();
578 eDebug("[SEC] unhandled sec command");
580 m_tuneTimer->start(delay,true);
584 void eDVBFrontend::setFrontend()
586 eDebug("setting frontend..\n");
587 if (ioctl(m_fd, FE_SET_FRONTEND, &parm) == -1)
589 perror("FE_SET_FRONTEND failed");
593 if (m_state != stateTuning)
596 m_state = stateTuning;
597 m_stateChanged(this);
599 m_timeout->start(5000, 1); // 5 sec timeout. TODO: symbolrate dependent
602 RESULT eDVBFrontend::getFrontendType(int &t)
610 RESULT eDVBFrontend::tune(const iDVBFrontendParameters &where)
617 m_sec_sequence.clear();
624 eDVBFrontendParametersSatellite feparm;
625 if (where.getDVBS(feparm))
627 eDebug("no dvbs data!");
632 eWarning("no SEC module active!");
636 res = m_sec->prepare(*this, parm, feparm, m_fe ? 1 << m_fe : 1);
639 #if HAVE_DVB_API_VERSION < 3
640 eDebug("tuning to %d mhz", parm.Frequency/1000);
642 eDebug("tuning to %d mhz", parm.frequency/1000);
648 eDVBFrontendParametersCable feparm;
649 if (where.getDVBC(feparm))
651 eFatal("cable tuning nyi");
655 eDVBFrontendParametersTerrestrial feparm;
656 if (where.getDVBT(feparm))
658 eDebug("no -T data");
661 #if HAVE_DVB_API_VERSION < 3
662 parm.Frequency = feparm.frequency;
664 parm.frequency = feparm.frequency;
667 switch (feparm.bandwidth)
669 case eDVBFrontendParametersTerrestrial::Bandwidth::Bw8MHz:
670 #if HAVE_DVB_API_VERSION < 3
671 parm.u.ofdm.bandWidth =
673 parm.u.ofdm.bandwidth =
677 case eDVBFrontendParametersTerrestrial::Bandwidth::Bw7MHz:
678 #if HAVE_DVB_API_VERSION < 3
679 parm.u.ofdm.bandWidth =
681 parm.u.ofdm.bandwidth =
685 case eDVBFrontendParametersTerrestrial::Bandwidth::Bw6MHz:
686 #if HAVE_DVB_API_VERSION < 3
687 parm.u.ofdm.bandWidth =
689 parm.u.ofdm.bandwidth =
693 case eDVBFrontendParametersTerrestrial::Bandwidth::BwAuto:
694 #if HAVE_DVB_API_VERSION < 3
695 parm.u.ofdm.bandWidth =
697 parm.u.ofdm.bandwidth =
702 eWarning("invalid OFDM bandwith");
706 parm.u.ofdm.code_rate_HP = FEC_AUTO;
707 parm.u.ofdm.code_rate_LP = FEC_AUTO;
709 switch (feparm.modulation)
711 case eDVBFrontendParametersTerrestrial::Modulation::QPSK:
712 parm.u.ofdm.constellation = QPSK;
714 case eDVBFrontendParametersTerrestrial::Modulation::QAM16:
715 parm.u.ofdm.constellation = QAM_16;
717 case eDVBFrontendParametersTerrestrial::Modulation::Auto:
718 parm.u.ofdm.constellation = QAM_AUTO;
722 switch (feparm.transmission_mode)
724 case eDVBFrontendParametersTerrestrial::TransmissionMode::TM2k:
725 #if HAVE_DVB_API_VERSION < 3
726 parm.u.ofdm.TransmissionMode =
728 parm.u.ofdm.transmission_mode =
730 TRANSMISSION_MODE_2K;
732 case eDVBFrontendParametersTerrestrial::TransmissionMode::TM8k:
733 #if HAVE_DVB_API_VERSION < 3
734 parm.u.ofdm.TransmissionMode =
736 parm.u.ofdm.transmission_mode =
738 TRANSMISSION_MODE_8K;
740 case eDVBFrontendParametersTerrestrial::TransmissionMode::TMAuto:
741 #if HAVE_DVB_API_VERSION < 3
742 parm.u.ofdm.TransmissionMode =
744 parm.u.ofdm.transmission_mode =
746 TRANSMISSION_MODE_AUTO;
750 parm.u.ofdm.guard_interval = GUARD_INTERVAL_AUTO;
751 parm.u.ofdm.hierarchy_information = HIERARCHY_AUTO;
752 #if HAVE_DVB_API_VERSION < 3
762 m_sec_sequence.push_back( eSecCommand(eSecCommand::SET_FRONTEND) );
763 m_tuneTimer->start(0,true);
764 m_sec_sequence.current() = m_sec_sequence.begin();
769 RESULT eDVBFrontend::connectStateChange(const Slot1<void,iDVBFrontend*> &stateChange, ePtr<eConnection> &connection)
771 connection = new eConnection(this, m_stateChanged.connect(stateChange));
775 RESULT eDVBFrontend::setVoltage(int voltage)
777 #if HAVE_DVB_API_VERSION < 3
780 fe_sec_voltage_t vlt;
783 m_curVoltage=voltage;
787 vlt = SEC_VOLTAGE_OFF;
790 vlt = SEC_VOLTAGE_13;
793 vlt = SEC_VOLTAGE_18;
798 #if HAVE_DVB_API_VERSION < 3
799 return ::ioctl(m_secfd, SEC_SET_VOLTAGE, vlt);
801 return ::ioctl(m_fd, FE_SET_VOLTAGE, vlt);
805 RESULT eDVBFrontend::getState(int &state)
811 RESULT eDVBFrontend::setTone(int t)
813 #if HAVE_DVB_API_VERSION < 3
816 fe_sec_tone_mode_t tone;
830 #if HAVE_DVB_API_VERSION < 3
831 return ::ioctl(m_secfd, SEC_SET_TONE, tone);
833 return ::ioctl(m_fd, FE_SET_TONE, tone);
837 #if HAVE_DVB_API_VERSION < 3 && !defined(SEC_DISEQC_SEND_MASTER_CMD)
838 #define SEC_DISEQC_SEND_MASTER_CMD _IOW('o', 97, struct secCommand *)
841 RESULT eDVBFrontend::sendDiseqc(const eDVBDiseqcCommand &diseqc)
843 #if HAVE_DVB_API_VERSION < 3
844 struct secCommand cmd;
845 cmd.type = SEC_CMDTYPE_DISEQC_RAW;
846 cmd.u.diseqc.cmdtype = diseqc.data[0];
847 cmd.u.diseqc.addr = diseqc.data[1];
848 cmd.u.diseqc.cmd = diseqc.data[2];
849 cmd.u.diseqc.numParams = diseqc.len-3;
850 memcpy(cmd.u.diseqc.params, diseqc.data+3, diseqc.len-3);
851 if (::ioctl(m_secfd, SEC_DISEQC_SEND_MASTER_CMD, &cmd))
853 struct dvb_diseqc_master_cmd cmd;
854 memcpy(cmd.msg, diseqc.data, diseqc.len);
855 cmd.msg_len = diseqc.len;
856 if (::ioctl(m_fd, FE_DISEQC_SEND_MASTER_CMD, &cmd))
862 #if HAVE_DVB_API_VERSION < 3 && !defined(SEC_DISEQC_SEND_BURST)
863 #define SEC_DISEQC_SEND_BURST _IO('o', 96)
865 RESULT eDVBFrontend::sendToneburst(int burst)
867 #if HAVE_DVB_API_VERSION < 3
868 secMiniCmd cmd = SEC_MINI_NONE;
869 if ( burst == eDVBSatelliteDiseqcParameters::A )
871 else if ( burst == eDVBSatelliteDiseqcParameters::B )
873 if (::ioctl(m_secfd, SEC_DISEQC_SEND_BURST, cmd))
879 RESULT eDVBFrontend::setSEC(iDVBSatelliteEquipmentControl *sec)
885 RESULT eDVBFrontend::setSecSequence(const eSecCommandList &list)
887 m_sec_sequence = list;
891 RESULT eDVBFrontend::getData(int num, int &data)
901 RESULT eDVBFrontend::setData(int num, int val)
911 int eDVBFrontend::isCompatibleWith(ePtr<iDVBFrontendParameters> &feparm)
913 if (m_type != eDVBFrontend::feSatellite)
918 eDVBFrontendParametersSatellite sat_parm;
920 ASSERT(!feparm->getDVBS(sat_parm));
922 return m_sec->canTune(sat_parm, this, m_fe ? 1 << m_fe : 1);