work on rotor support, add usals stuff (rotor stuff not completed yet),
[vuplus_dvbapp] / lib / dvb / frontend.cpp
index 8948f19..1136d9d 100644 (file)
@@ -1,3 +1,4 @@
+#include <config.h>
 #include <lib/dvb/dvb.h>
 #include <lib/base/eerror.h>
 #include <errno.h>
@@ -5,7 +6,22 @@
 #include <fcntl.h>
 #include <sys/ioctl.h>
 
+#if HAVE_DVB_API_VERSION < 3
+#include <ost/frontend.h>
+#include <ost/sec.h>
+#define QAM_AUTO                               (Modulation)6
+#define TRANSMISSION_MODE_AUTO (TransmitMode)2
+#define BANDWIDTH_AUTO                 (BandWidth)3
+#define GUARD_INTERVAL_AUTO            (GuardInterval)4
+#define HIERARCHY_AUTO                 (Hierarchy)4
+#define constellation Constellation
+#define guard_interval guardInterval
+#define hierarchy_information HierarchyInformation
+#define code_rate_HP HP_CodeRate
+#define code_rate_LP LP_CodeRate
+#else
 #include <linux/dvb/frontend.h>
+#endif
 
 #include <lib/dvb_si/satellite_delivery_system_descriptor.h>
 #include <lib/dvb_si/cable_delivery_system_descriptor.h>
@@ -73,7 +89,7 @@ void eDVBFrontendParametersTerrestrial::set(const TerrestrialDeliverySystemDescr
        eFatal("nyi");
 }
 
-eDVBFrontendParameters::eDVBFrontendParameters(): ref(0), m_type(-1)
+eDVBFrontendParameters::eDVBFrontendParameters(): m_type(-1)
 {
 }
 
@@ -188,16 +204,36 @@ RESULT eDVBFrontendParameters::getHash(unsigned long &hash) const
 
 DEFINE_REF(eDVBFrontend);
 
-eDVBFrontend::eDVBFrontend(int adap, int fe, int &ok): ref(0), m_type(-1)
+eDVBFrontend::eDVBFrontend(int adap, int fe, int &ok): m_type(-1)
 {
+#if HAVE_DVB_API_VERSION < 3
+       char sec_filename[128];
+#endif
        char filename[128];
+
        int result;
-       dvb_frontend_info fe_info;
-       
+
        m_sn = 0;
        m_timeout = 0;
-       
+
+#if HAVE_DVB_API_VERSION < 3
+       sprintf(sec_filename, "/dev/dvb/card%d/sec%d", adap, fe);
+       m_secfd = ::open(sec_filename, O_RDWR);
+       if (m_secfd < 0)
+       {
+               eWarning("failed! (%s) %m", sec_filename);
+               ok = 0;
+               return;
+       }
+       else
+               eDebug("m_secfd is %d", m_secfd);
+
+       FrontendInfo fe_info;
+       sprintf(filename, "/dev/dvb/card%d/frontend%d", adap, fe);
+#else
+       dvb_frontend_info fe_info;      
        sprintf(filename, "/dev/dvb/adapter%d/frontend%d", adap, fe);
+#endif
        eDebug("opening frontend.");
        m_fd = ::open(filename, O_RDWR|O_NONBLOCK);
        if (m_fd < 0)
@@ -206,7 +242,7 @@ eDVBFrontend::eDVBFrontend(int adap, int fe, int &ok): ref(0), m_type(-1)
                ok = 0;
                return;
        }
-       
+
        result = ::ioctl(m_fd, FE_GET_INFO, &fe_info);
        
        if (result < 0) {
@@ -235,16 +271,21 @@ eDVBFrontend::eDVBFrontend(int adap, int fe, int &ok): ref(0), m_type(-1)
                ok = 0;
                return;
        }
-       eDebug("detected %s frontend", "satellite\0cable\0    terrestrial"+feSatellite*9);
+       eDebug("detected %s frontend", "satellite\0cable\0    terrestrial"+fe_info.type*9);
        ok = 1;
 
        m_sn = new eSocketNotifier(eApp, m_fd, eSocketNotifier::Read);
        CONNECT(m_sn->activated, eDVBFrontend::feEvent);
        m_sn->start();
-       
+
        m_timeout = new eTimer(eApp);
        CONNECT(m_timeout->timeout, eDVBFrontend::timeout);
-       
+
+       m_tuneTimer = new eTimer(eApp);
+       CONNECT(m_tuneTimer->timeout, eDVBFrontend::tuneLoop);
+
+       memset(m_data, 0xFFFF, sizeof(m_data));
+
        return;
 }
 
@@ -262,7 +303,11 @@ void eDVBFrontend::feEvent(int w)
 {
        while (1)
        {
+#if HAVE_DVB_API_VERSION < 3
+               FrontendEvent event;
+#else
                dvb_frontend_event event;
+#endif
                int res;
                int state;
                res = ::ioctl(m_fd, FE_GET_EVENT, &event);
@@ -278,9 +323,13 @@ void eDVBFrontend::feEvent(int w)
                
                if (w < 0)
                        continue;
-               
+
+#if HAVE_DVB_API_VERSION < 3
+               if (event.type == FE_COMPLETION_EV)
+#else
                eDebug("fe event: status %x, inversion %s", event.status, (event.parameters.inversion == INVERSION_ON) ? "on" : "off");
                if (event.status & FE_HAS_LOCK)
+#endif
                {
                        state = stateLock;
                } else
@@ -314,6 +363,59 @@ void eDVBFrontend::timeout()
                m_tuning = 0;
 }
 
+void eDVBFrontend::tuneLoop()  // called by m_tuneTimer
+{
+       int delay=0;
+       if ( m_sec_sequence && m_sec_sequence.current() != m_sec_sequence.end() )
+       {
+               switch (m_sec_sequence.current()->cmd)
+               {
+                       case eSecCommand::SLEEP:
+                               delay = m_sec_sequence.current()->msec;
+                               break;
+                       case eSecCommand::SET_VOLTAGE:
+                               setVoltage(m_sec_sequence.current()->voltage);
+                               break;
+                       case eSecCommand::SET_TONE:
+                               setTone(m_sec_sequence.current()->tone);
+                               break;
+                       case eSecCommand::SEND_DISEQC:
+                               sendDiseqc(m_sec_sequence.current()->diseqc);
+                               break;
+                       case eSecCommand::SEND_TONEBURST:
+                               sendToneburst(m_sec_sequence.current()->toneburst);
+                               break;
+                       case eSecCommand::SET_FRONTEND:
+                               setFrontend();
+                               break;
+                       case eSecCommand::IF_LOCK_GOTO:
+                       case eSecCommand::IF_NOT_LOCK_GOTO:
+                       default:
+                               eDebug("unhandled sec command");
+               }
+               m_sec_sequence.current()++;
+               m_tuneTimer->start(delay,true);
+       }
+}
+
+void eDVBFrontend::setFrontend()
+{
+       eDebug("setting frontend..\n");
+       if (ioctl(m_fd, FE_SET_FRONTEND, &parm) == -1)
+       {
+               perror("FE_SET_FRONTEND failed");
+               return;
+       }
+
+       if (m_state != stateTuning)
+       {
+               m_tuning = 1;
+               m_state = stateTuning;
+               m_stateChanged(this);
+       }
+       m_timeout->start(5000, 1); // 5 sec timeout. TODO: symbolrate dependent
+}
+
 RESULT eDVBFrontend::getFrontendType(int &t)
 {
        if (m_type == -1)
@@ -327,10 +429,12 @@ RESULT eDVBFrontend::tune(const iDVBFrontendParameters &where)
        if (m_type == -1)
                return -ENODEV;
 
-       dvb_frontend_parameters parm;
-       
        feEvent(-1);
-       
+
+       m_sec_sequence.clear();
+
+       eDebug("eDVBFrontend::tune. type: %d", m_type);
+
        switch (m_type)
        {
        case feSatellite:
@@ -351,8 +455,11 @@ RESULT eDVBFrontend::tune(const iDVBFrontendParameters &where)
                res = m_sec->prepare(*this, parm, feparm);
                if (res)
                        return res;
-               
+#if HAVE_DVB_API_VERSION < 3
+               eDebug("tuning to %d mhz", parm.Frequency/1000);
+#else
                eDebug("tuning to %d mhz", parm.frequency/1000);
+#endif
                break;
        }
        case feCable:
@@ -366,25 +473,114 @@ RESULT eDVBFrontend::tune(const iDVBFrontendParameters &where)
        {
                eDVBFrontendParametersTerrestrial feparm;
                if (where.getDVBT(feparm))
+               {
+                       eDebug("no -T data");
                        return -EINVAL;
-               eFatal("terrestrial tuning nyi");
-       }
-       }
-       
-       if (ioctl(m_fd, FE_SET_FRONTEND, &parm) == -1)
-       {
-               perror("FE_SET_FRONTEND failed");
-               return errno;
+               }
+#if HAVE_DVB_API_VERSION < 3
+               parm.Frequency = feparm.frequency;
+#else
+               parm.frequency = feparm.frequency;
+#endif
+
+               switch (feparm.bandwidth)
+               {
+               case eDVBFrontendParametersTerrestrial::Bandwidth::Bw8MHz:
+#if HAVE_DVB_API_VERSION < 3
+                       parm.u.ofdm.bandWidth =
+#else
+                       parm.u.ofdm.bandwidth =
+#endif
+                               BANDWIDTH_8_MHZ;
+                       break;
+               case eDVBFrontendParametersTerrestrial::Bandwidth::Bw7MHz:
+#if HAVE_DVB_API_VERSION < 3
+                       parm.u.ofdm.bandWidth =
+#else
+                       parm.u.ofdm.bandwidth =
+#endif
+                               BANDWIDTH_7_MHZ;
+                       break;
+               case eDVBFrontendParametersTerrestrial::Bandwidth::Bw6MHz:
+#if HAVE_DVB_API_VERSION < 3
+                       parm.u.ofdm.bandWidth =
+#else
+                       parm.u.ofdm.bandwidth =
+#endif
+                               BANDWIDTH_6_MHZ;
+                       break;
+               case eDVBFrontendParametersTerrestrial::Bandwidth::BwAuto:
+#if HAVE_DVB_API_VERSION < 3
+                       parm.u.ofdm.bandWidth =
+#else
+                       parm.u.ofdm.bandwidth =
+#endif
+                               BANDWIDTH_AUTO;
+                       break;
+               default:
+                       eWarning("invalid OFDM bandwith");
+                       return -EINVAL;
+               }
+               
+               parm.u.ofdm.code_rate_HP = FEC_AUTO;
+               parm.u.ofdm.code_rate_LP = FEC_AUTO;
+               
+               switch (feparm.modulation)
+               {
+               case eDVBFrontendParametersTerrestrial::Modulation::QPSK:
+                       parm.u.ofdm.constellation = QPSK;
+                       break;
+               case eDVBFrontendParametersTerrestrial::Modulation::QAM16:
+                       parm.u.ofdm.constellation = QAM_16;
+                       break;
+               case eDVBFrontendParametersTerrestrial::Modulation::Auto:
+                       parm.u.ofdm.constellation = QAM_AUTO;
+                       break;
+               }
+               
+               switch (feparm.transmission_mode)
+               {
+               case eDVBFrontendParametersTerrestrial::TransmissionMode::TM2k:
+#if HAVE_DVB_API_VERSION < 3
+                       parm.u.ofdm.TransmissionMode =
+#else
+                       parm.u.ofdm.transmission_mode =
+#endif
+                               TRANSMISSION_MODE_2K;
+                       break;
+               case eDVBFrontendParametersTerrestrial::TransmissionMode::TM8k:
+#if HAVE_DVB_API_VERSION < 3
+                       parm.u.ofdm.TransmissionMode =
+#else
+                       parm.u.ofdm.transmission_mode =
+#endif
+                               TRANSMISSION_MODE_8K;
+                       break;
+               case eDVBFrontendParametersTerrestrial::TransmissionMode::TMAuto:
+#if HAVE_DVB_API_VERSION < 3
+                       parm.u.ofdm.TransmissionMode =
+#else
+                       parm.u.ofdm.transmission_mode =
+#endif
+                               TRANSMISSION_MODE_AUTO;
+                       break;
+               }
+               
+               parm.u.ofdm.guard_interval = GUARD_INTERVAL_AUTO;
+               parm.u.ofdm.hierarchy_information = HIERARCHY_AUTO;
+#if HAVE_DVB_API_VERSION < 3
+               parm.Inversion =
+#else
+               parm.inversion =
+#endif
+                       INVERSION_AUTO;
+               break;
        }
-       
-       if (m_state != stateTuning)
-       {
-               m_tuning = 1;
-               m_state = stateTuning;
-               m_stateChanged(this);
        }
-       
-       m_timeout->start(5000, 1); // 5 sec timeout. TODO: symbolrate dependent
+
+       m_sec_sequence.push_back( eSecCommand(eSecCommand::SET_FRONTEND, 0) );
+       m_tuneTimer->start(0,true);
+       m_sec_sequence.current() = m_sec_sequence.begin();
 
        return 0;
 }
@@ -397,8 +593,12 @@ RESULT eDVBFrontend::connectStateChange(const Slot1<void,iDVBFrontend*> &stateCh
 
 RESULT eDVBFrontend::setVoltage(int voltage)
 {
+#if HAVE_DVB_API_VERSION < 3
+       secVoltage vlt;
+#else
        fe_sec_voltage_t vlt;
-       
+#endif
+
        switch (voltage)
        {
        case voltageOff:
@@ -413,8 +613,11 @@ RESULT eDVBFrontend::setVoltage(int voltage)
        default:
                return -ENODEV;
        }
-       
+#if HAVE_DVB_API_VERSION < 3
+       return ::ioctl(m_secfd, SEC_SET_VOLTAGE, vlt);
+#else
        return ::ioctl(m_fd, FE_SET_VOLTAGE, vlt);
+#endif
 }
 
 RESULT eDVBFrontend::getState(int &state)
@@ -425,8 +628,12 @@ RESULT eDVBFrontend::getState(int &state)
 
 RESULT eDVBFrontend::setTone(int t)
 {
+#if HAVE_DVB_API_VERSION < 3
+       secToneMode_t tone;
+#else
        fe_sec_tone_mode_t tone;
-       
+#endif
+
        switch (t)
        {
        case toneOn:
@@ -438,23 +645,54 @@ RESULT eDVBFrontend::setTone(int t)
        default:
                return -ENODEV;
        }
-       
-       return ::ioctl(m_fd, FE_SET_TONE, tone);        
+#if HAVE_DVB_API_VERSION < 3   
+       return ::ioctl(m_secfd, SEC_SET_TONE, tone);
+#else  
+       return ::ioctl(m_fd, FE_SET_TONE, tone);
+#endif
 }
 
+#if HAVE_DVB_API_VERSION < 3 && !defined(SEC_DISEQC_SEND_MASTER_CMD)
+       #define SEC_DISEQC_SEND_MASTER_CMD _IOW('o', 97, struct secCommand *)
+#endif
+
 RESULT eDVBFrontend::sendDiseqc(const eDVBDiseqcCommand &diseqc)
 {
+       eDebug("send %02x %02x %02x %02x",
+               diseqc.data[0], diseqc.data[1], diseqc.data[2], diseqc.data[3]);
+#if HAVE_DVB_API_VERSION < 3
+       struct secCommand cmd;
+       cmd.type = SEC_CMDTYPE_DISEQC_RAW;
+       cmd.u.diseqc.cmdtype = diseqc.data[0];
+       cmd.u.diseqc.addr = diseqc.data[1];
+       cmd.u.diseqc.cmd = diseqc.data[2];
+       cmd.u.diseqc.numParams = diseqc.len-3;
+       memcpy(cmd.u.diseqc.params, diseqc.data+3, diseqc.len-3);
+       if (::ioctl(m_secfd, SEC_DISEQC_SEND_MASTER_CMD, &cmd))
+#else
        struct dvb_diseqc_master_cmd cmd;
-       if (::ioctl(m_fd, FE_SET_TONE, SEC_TONE_OFF))
-               return -EINVAL;
-       usleep(15 * 1000);
        memcpy(cmd.msg, diseqc.data, diseqc.len);
        cmd.msg_len = diseqc.len;
-       
        if (::ioctl(m_fd, FE_DISEQC_SEND_MASTER_CMD, &cmd))
+#endif
                return -EINVAL;
-       usleep(15 * 1000);
-       eDebug("diseqc ok");
+       return 0;
+}
+
+#if HAVE_DVB_API_VERSION < 3 && !defined(SEC_DISEQC_SEND_BURST)
+       #define SEC_DISEQC_SEND_BURST _IO('o', 96)
+#endif
+RESULT eDVBFrontend::sendToneburst(int burst)
+{
+#if HAVE_DVB_API_VERSION < 3
+       secMiniCmd cmd = SEC_MINI_NONE;
+       if ( burst == eDVBSatelliteDiseqcParameters::A )
+               cmd = SEC_MINI_A;
+       else if ( burst == eDVBSatelliteDiseqcParameters::B )
+               cmd = SEC_MINI_B;
+       if (::ioctl(m_secfd, SEC_DISEQC_SEND_BURST, cmd))
+               return -EINVAL;
+#endif
        return 0;
 }
 
@@ -463,3 +701,30 @@ RESULT eDVBFrontend::setSEC(iDVBSatelliteEquipmentControl *sec)
        m_sec = sec;
        return 0;
 }
+
+RESULT eDVBFrontend::setSecSequence(const eSecCommandList &list)
+{
+       m_sec_sequence = list;
+       return 0;
+}
+
+RESULT eDVBFrontend::getData(int num, int &data)
+{
+       if ( num < 5 )
+       {
+               data = m_data[num];
+               return 0;
+       }
+       return -EINVAL;
+}
+
+RESULT eDVBFrontend::setData(int num, int val)
+{
+       if ( num < 5 )
+       {
+               m_data[num] = val;
+               return 0;
+       }
+       return -EINVAL;
+}
+