lib/dvb/frontend.cpp

   1 #include <lib/dvb/dvb.h>
   2 #include <lib/base/eerror.h>
   3 #include <errno.h>
   4 #include <unistd.h>
   5 #include <fcntl.h>
   6 #include <sys/ioctl.h>
   7
   8 #ifndef I2C_SLAVE_FORCE
   9 #define I2C_SLAVE_FORCE 0x0706
  10 #endif
  11
  12 #if HAVE_DVB_API_VERSION < 3
  13 #include <ost/frontend.h>
  14 #include <ost/sec.h>
  15 #define QAM_AUTO                                (Modulation)6
  16 #define TRANSMISSION_MODE_AUTO  (TransmitMode)2
  17 #define BANDWIDTH_AUTO                  (BandWidth)3
  18 #define GUARD_INTERVAL_AUTO             (GuardInterval)4
  19 #define HIERARCHY_AUTO                  (Hierarchy)4
  20 #define parm.frequency parm.Frequency
  21 #define parm.u.qam.symbol_rate parm.u.qam.SymbolRate
  22 #define parm.u.qam.fec_inner parm.u.qam.FEC_inner
  23 #define parm.u.qam.modulation parm.u.qam.QAM
  24 #define parm.u.ofdm.bandwidth parm.u.ofdm.bandWidth
  25 #define parm.u.ofdm.code_rate_LP parm.u.ofdm.LP_CodeRate
  26 #define parm.u.ofdm.code_rate_HP parm.u.ofdm.HP_CodeRate
  27 #define parm.u.ofdm.constellation parm.u.ofdm.Constellation
  28 #define parm.u.ofdm.transmission_mode parm.u.ofdm.TransmissionMode
  29 #define parm.u.ofdm.guard_interval parm.u.ofdm.guardInterval
  30 #define parm.u.ofdm.hierarchy_information parm.u.ofdm.HierarchyInformation
  31 #define parm.inversion parm.Inversion
  32 #else
  33 #include <linux/dvb/frontend.h>
  34 #endif
  35
  36 #include <dvbsi++/satellite_delivery_system_descriptor.h>
  37 #include <dvbsi++/cable_delivery_system_descriptor.h>
  38 #include <dvbsi++/terrestrial_delivery_system_descriptor.h>
  39
  40 void eDVBFrontendParametersSatellite::set(const SatelliteDeliverySystemDescriptor &descriptor)
  41 {
  42         frequency    = descriptor.getFrequency() * 10;
  43         symbol_rate  = descriptor.getSymbolRate() * 100;
  44         polarisation = descriptor.getPolarization();
  45         fec = descriptor.getFecInner();
  46         if ( fec == 0xF )
  47                 fec = FEC::fNone;
  48         inversion = Inversion::Unknown;
  49         orbital_position  = ((descriptor.getOrbitalPosition() >> 12) & 0xF) * 1000;
  50         orbital_position += ((descriptor.getOrbitalPosition() >> 8) & 0xF) * 100;
  51         orbital_position += ((descriptor.getOrbitalPosition() >> 4) & 0xF) * 10;
  52         orbital_position += ((descriptor.getOrbitalPosition()) & 0xF);
  53         if (orbital_position && (!descriptor.getWestEastFlag()))
  54                 orbital_position = 3600 - orbital_position;
  55         eDebug("SAT freq %d, %s, pos %d, sr %d, fec %d",
  56                 frequency,
  57                 polarisation ? "hor" : "vert",
  58                 orbital_position,
  59                 symbol_rate, fec);
  60 }
  61
  62 void eDVBFrontendParametersCable::set(const CableDeliverySystemDescriptor &descriptor)
  63 {
  64         frequency = descriptor.getFrequency() / 10;
  65         symbol_rate = descriptor.getSymbolRate() * 100;
  66         fec_inner = descriptor.getFecInner();
  67         if ( fec_inner == 0xF )
  68                 fec_inner = FEC::fNone;
  69         modulation = descriptor.getModulation();
  70         if ( modulation > 0x5 )
  71                 modulation = Modulation::Auto;
  72         inversion = Inversion::Unknown;
  73         eDebug("Cable freq %d, mod %d, sr %d, fec %d",
  74                 frequency,
  75                 modulation, symbol_rate, fec_inner);
  76 }
  77
  78 void eDVBFrontendParametersTerrestrial::set(const TerrestrialDeliverySystemDescriptor &descriptor)
  79 {
  80         frequency = descriptor.getCentreFrequency() * 10;
  81         bandwidth = descriptor.getBandwidth();
  82         if ( bandwidth > 2 ) // 5Mhz forced to auto
  83                 bandwidth = Bandwidth::BwAuto;
  84         code_rate_HP = descriptor.getCodeRateHpStream();
  85         if (code_rate_HP > 4)
  86                 code_rate_HP = FEC::fAuto;
  87         code_rate_LP = descriptor.getCodeRateLpStream();
  88         if (code_rate_LP > 4)
  89                 code_rate_LP = FEC::fAuto;
  90         transmission_mode = descriptor.getTransmissionMode();
  91         if (transmission_mode > 2)
  92                 transmission_mode = TransmissionMode::TMAuto;
  93         guard_interval = descriptor.getGuardInterval();
  94         if (guard_interval > 3)
  95                 guard_interval = GuardInterval::GI_Auto;
  96         hierarchy = descriptor.getHierarchyInformation()&3;
  97         modulation = descriptor.getConstellation();
  98         if (modulation > 2)
  99                 modulation = Modulation::Auto;
 100         inversion = Inversion::Unknown;
 101         eDebug("Terr freq %d, bw %d, cr_hp %d, cr_lp %d, tm_mode %d, guard %d, hierarchy %d, const %d",
 102                 frequency, bandwidth, code_rate_HP, code_rate_LP, transmission_mode,
 103                 guard_interval, hierarchy, modulation);
 104 }
 105
 106 eDVBFrontendParameters::eDVBFrontendParameters(): m_type(-1)
 107 {
 108 }
 109
 110 DEFINE_REF(eDVBFrontendParameters);
 111
 112 RESULT eDVBFrontendParameters::getSystem(int &t) const
 113 {
 114         if (m_type == -1)
 115                 return -1;
 116         t = m_type;
 117         return 0;
 118 }
 119
 120 RESULT eDVBFrontendParameters::getDVBS(eDVBFrontendParametersSatellite &p) const
 121 {
 122         if (m_type != iDVBFrontend::feSatellite)
 123                 return -1;
 124         p = sat;
 125         return 0;
 126 }
 127
 128 RESULT eDVBFrontendParameters::getDVBC(eDVBFrontendParametersCable &p) const
 129 {
 130         if (m_type != iDVBFrontend::feCable)
 131                 return -1;
 132         p = cable;
 133         return 0;
 134 }
 135
 136 RESULT eDVBFrontendParameters::getDVBT(eDVBFrontendParametersTerrestrial &p) const
 137 {
 138         if (m_type != iDVBFrontend::feTerrestrial)
 139                 return -1;
 140         p = terrestrial;
 141         return 0;
 142 }
 143
 144 RESULT eDVBFrontendParameters::setDVBS(const eDVBFrontendParametersSatellite &p)
 145 {
 146         sat = p;
 147         m_type = iDVBFrontend::feSatellite;
 148         return 0;
 149 }
 150
 151 RESULT eDVBFrontendParameters::setDVBC(const eDVBFrontendParametersCable &p)
 152 {
 153         cable = p;
 154         m_type = iDVBFrontend::feCable;
 155         return 0;
 156 }
 157
 158 RESULT eDVBFrontendParameters::setDVBT(const eDVBFrontendParametersTerrestrial &p)
 159 {
 160         terrestrial = p;
 161         m_type = iDVBFrontend::feTerrestrial;
 162         return 0;
 163 }
 164
 165 RESULT eDVBFrontendParameters::calculateDifference(const iDVBFrontendParameters *parm, int &diff) const
 166 {
 167         if (!parm)
 168                 return -1;
 169         int type;
 170         if (parm->getSystem(type))
 171                 return -1;
 172         if (type != m_type)
 173         {
 174                 diff = 1<<30; // big difference
 175                 return 0;
 176         }
 177
 178         switch (type)
 179         {
 180         case iDVBFrontend::feSatellite:
 181         {
 182                 eDVBFrontendParametersSatellite osat;
 183                 if (parm->getDVBS(osat))
 184                         return -2;
 185
 186                 if (sat.orbital_position != osat.orbital_position)
 187                         diff = 1<<29;
 188                 else if (sat.polarisation != osat.polarisation)
 189                         diff = 1<<28;
 190                 else
 191                 {
 192                         diff = abs(sat.frequency - osat.frequency);
 193                         diff += abs(sat.symbol_rate - osat.symbol_rate);
 194                 }
 195                 return 0;
 196         }
 197         case iDVBFrontend::feCable:
 198                 eDVBFrontendParametersCable ocable;
 199                 if (parm->getDVBC(ocable))
 200                         return -2;
 201
 202                 if (cable.modulation != ocable.modulation && cable.modulation != eDVBFrontendParametersCable::Modulation::Auto && ocable.modulation != eDVBFrontendParametersCable::Modulation::Auto)
 203                         diff = 1 << 29;
 204                 else if (cable.inversion != ocable.inversion && cable.inversion != eDVBFrontendParametersCable::Inversion::Unknown && ocable.inversion != eDVBFrontendParametersCable::Inversion::Unknown)
 205                         diff = 1 << 28;
 206                 else
 207                 {
 208                         diff = abs(cable.frequency - ocable.frequency);
 209                         diff += abs(cable.symbol_rate - ocable.symbol_rate);
 210                 }
 211
 212                 return 0;
 213         case iDVBFrontend::feTerrestrial:
 214                 eDVBFrontendParametersTerrestrial oterrestrial;
 215                 if (parm->getDVBT(oterrestrial))
 216                         return -2;
 217
 218                 diff = abs(terrestrial.frequency - oterrestrial.frequency);
 219
 220                 return 0;
 221         default:
 222                 return -1;
 223         }
 224         return 0;
 225 }
 226
 227 RESULT eDVBFrontendParameters::getHash(unsigned long &hash) const
 228 {
 229         switch (m_type)
 230         {
 231         case iDVBFrontend::feSatellite:
 232         {
 233                 hash = (sat.orbital_position << 16);
 234                 hash |= ((sat.frequency/1000)&0xFFFF)|((sat.polarisation&1) << 15);
 235                 return 0;
 236         }
 237         case iDVBFrontend::feCable:
 238         case iDVBFrontend::feTerrestrial:
 239         default:
 240                 return -1;
 241         }
 242 }
 243
 244 DEFINE_REF(eDVBFrontend);
 245
 246 eDVBFrontend::eDVBFrontend(int adap, int fe, int &ok)
 247         :m_type(-1), m_fe(fe), m_fd(-1), m_timeout(0), m_tuneTimer(0)
 248 #if HAVE_DVB_API_VERSION < 3
 249         ,m_secfd(-1)
 250 #endif
 251 {
 252 #if HAVE_DVB_API_VERSION < 3
 253         sprintf(m_filename, "/dev/dvb/card%d/frontend%d", adap, fe);
 254         sprintf(m_sec_filename, "/dev/dvb/card%d/sec%d", adap, fe);
 255 #else
 256         sprintf(m_filename, "/dev/dvb/adapter%d/frontend%d", adap, fe);
 257 #endif
 258         m_timeout = new eTimer(eApp);
 259         CONNECT(m_timeout->timeout, eDVBFrontend::timeout);
 260
 261         m_tuneTimer = new eTimer(eApp);
 262         CONNECT(m_tuneTimer->timeout, eDVBFrontend::tuneLoop);
 263
 264         int entries = sizeof(m_data) / sizeof(int);
 265         for (int i=0; i<entries; ++i)
 266                 m_data[i] = -1;
 267
 268         m_idleInputpower[0]=m_idleInputpower[1]=0;
 269
 270         ok = !openFrontend();
 271         closeFrontend();
 272 }
 273
 274 int eDVBFrontend::openFrontend()
 275 {
 276         if (m_fd >= 0)
 277                 return -1;  // already opened
 278
 279         m_state=0;
 280         m_tuning=0;
 281
 282 #if HAVE_DVB_API_VERSION < 3
 283         m_secfd = ::open(m_sec_filename, O_RDWR);
 284         if (m_secfd < 0)
 285         {
 286                 eWarning("failed! (%s) %m", m_sec_filename);
 287                 return -1;
 288         }
 289         FrontendInfo fe_info;
 290 #else
 291         dvb_frontend_info fe_info;
 292 #endif
 293         eDebug("opening frontend %d", m_fe);
 294         m_fd = ::open(m_filename, O_RDWR|O_NONBLOCK);
 295         if (m_fd < 0)
 296         {
 297                 eWarning("failed! (%s) %m", m_filename);
 298 #if HAVE_DVB_API_VERSION < 3
 299                 ::close(m_secfd);
 300                 m_secfd=-1;
 301 #endif
 302                 return -1;
 303         }
 304
 305         if (m_type == -1)
 306         {
 307                 if (::ioctl(m_fd, FE_GET_INFO, &fe_info) < 0)
 308                 {
 309                         eWarning("ioctl FE_GET_INFO failed");
 310                         ::close(m_fd);
 311                         m_fd = -1;
 312 #if HAVE_DVB_API_VERSION < 3
 313                         ::close(m_secfd);
 314                         m_secfd=-1;
 315 #endif
 316                         return -1;
 317                 }
 318
 319                 switch (fe_info.type)
 320                 {
 321                 case FE_QPSK:
 322                         m_type = iDVBFrontend::feSatellite;
 323                         break;
 324                 case FE_QAM:
 325                         m_type = iDVBFrontend::feCable;
 326                         break;
 327                 case FE_OFDM:
 328                         m_type = iDVBFrontend::feTerrestrial;
 329                         break;
 330                 default:
 331                         eWarning("unknown frontend type.");
 332                         ::close(m_fd);
 333                         m_fd = -1;
 334 #if HAVE_DVB_API_VERSION < 3
 335                         ::close(m_secfd);
 336                         m_secfd=-1;
 337 #endif
 338                         return -1;
 339                 }
 340                 eDebug("detected %s frontend", "satellite\0cable\0    terrestrial"+fe_info.type*10);
 341         }
 342
 343         setTone(iDVBFrontend::toneOff);
 344         setVoltage(iDVBFrontend::voltageOff);
 345
 346         m_sn = new eSocketNotifier(eApp, m_fd, eSocketNotifier::Read);
 347         CONNECT(m_sn->activated, eDVBFrontend::feEvent);
 348         m_sn->start();
 349
 350         return 0;
 351 }
 352
 353 int eDVBFrontend::closeFrontend()
 354 {
 355         if (!m_fe && m_data[7] != -1)
 356         {
 357                 // try to close the first frontend.. but the second is linked to the first
 358                 eDVBRegisteredFrontend *linked_fe = (eDVBRegisteredFrontend*)m_data[7];
 359                 if (linked_fe->m_inuse)
 360                 {
 361                         eDebug("dont close frontend %d until the linked frontend %d is still in use",
 362                                 m_fe, linked_fe->m_frontend->getID());
 363                         return -1;
 364                 }
 365         }
 366         if (m_fd >= 0)
 367         {
 368                 eDebug("close frontend %d", m_fe);
 369                 setTone(iDVBFrontend::toneOff);
 370                 setVoltage(iDVBFrontend::voltageOff);
 371                 ::close(m_fd);
 372                 m_fd=-1;
 373                 m_data[0] = m_data[1] = m_data[2] = -1;
 374         }
 375 #if HAVE_DVB_API_VERSION < 3
 376         if (m_secfd >= 0)
 377         {
 378                 ::close(m_secfd);
 379                 m_secfd=-1;
 380         }
 381 #endif
 382         delete m_sn;
 383         m_sn=0;
 384
 385         return 0;
 386 }
 387
 388 eDVBFrontend::~eDVBFrontend()
 389 {
 390         closeFrontend();
 391         delete m_timeout;
 392         delete m_tuneTimer;
 393 }
 394
 395 void eDVBFrontend::feEvent(int w)
 396 {
 397         while (1)
 398         {
 399 #if HAVE_DVB_API_VERSION < 3
 400                 FrontendEvent event;
 401 #else
 402                 dvb_frontend_event event;
 403 #endif
 404                 int res;
 405                 int state;
 406                 res = ::ioctl(m_fd, FE_GET_EVENT, &event);
 407
 408                 if (res && (errno == EAGAIN))
 409                         break;
 410
 411                 if (res)
 412                 {
 413                         eWarning("FE_GET_EVENT failed! %m");
 414                         return;
 415                 }
 416
 417                 if (w < 0)
 418                         continue;
 419
 420 #if HAVE_DVB_API_VERSION < 3
 421                 if (event.type == FE_COMPLETION_EV)
 422 #else
 423                 eDebug("(%d)fe event: status %x, inversion %s", m_fe, event.status, (event.parameters.inversion == INVERSION_ON) ? "on" : "off");
 424                 if (event.status & FE_HAS_LOCK)
 425 #endif
 426                 {
 427                         state = stateLock;
 428                 } else
 429                 {
 430                         if (m_tuning)
 431                                 state = stateTuning;
 432                         else
 433                         {
 434                                 state = stateLostLock;
 435                                 m_data[0] = m_data[1] = m_data[2] = -1; // reset diseqc
 436                         }
 437                 }
 438                 if (m_state != state)
 439                 {
 440                         m_state = state;
 441                         m_stateChanged(this);
 442                 }
 443         }
 444 }
 445
 446 void eDVBFrontend::timeout()
 447 {
 448         m_tuning = 0;
 449         if (m_state == stateTuning)
 450         {
 451                 m_state = stateFailed;
 452                 m_stateChanged(this);
 453         }
 454 }
 455
 456 int eDVBFrontend::readFrontendData(int type)
 457 {
 458         switch(type)
 459         {
 460                 case bitErrorRate:
 461                 {
 462                         uint32_t ber=0;
 463                         if (ioctl(m_fd, FE_READ_BER, &ber) < 0 && errno != ERANGE)
 464                                 eDebug("FE_READ_BER failed (%m)");
 465                         return ber;
 466                 }
 467                 case signalPower:
 468                 {
 469                         uint16_t snr=0;
 470                         if (ioctl(m_fd, FE_READ_SNR, &snr) < 0 && errno != ERANGE)
 471                                 eDebug("FE_READ_SNR failed (%m)");
 472                         return snr;
 473                 }
 474                 case signalQuality:
 475                 {
 476                         uint16_t strength=0;
 477                         if (ioctl(m_fd, FE_READ_SIGNAL_STRENGTH, &strength) < 0 && errno != ERANGE)
 478                                 eDebug("FE_READ_SIGNAL_STRENGTH failed (%m)");
 479                         return strength;
 480                 }
 481         }
 482         return 0;
 483 }
 484
 485 #ifndef FP_IOCTL_GET_ID
 486 #define FP_IOCTL_GET_ID 0
 487 #endif
 488 int eDVBFrontend::readInputpower()
 489 {
 490         int power=m_fe;  // this is needed for read inputpower from the correct tuner !
 491
 492         // open front prozessor
 493         int fp=::open("/dev/dbox/fp0", O_RDWR);
 494         if (fp < 0)
 495         {
 496                 eDebug("couldn't open fp");
 497                 return -1;
 498         }
 499         static bool old_fp = (::ioctl(fp, FP_IOCTL_GET_ID) < 0);
 500         if ( ioctl( fp, old_fp ? 9 : 0x100, &power ) < 0 )
 501         {
 502                 eDebug("FP_IOCTL_GET_LNB_CURRENT failed (%m)");
 503                 return -1;
 504         }
 505         ::close(fp);
 506
 507         return power;
 508 }
 509
 510 bool eDVBFrontend::setSecSequencePos(int steps)
 511 {
 512         eDebug("set sequence pos %d", steps);
 513         if (!steps)
 514                 return false;
 515         while( steps > 0 )
 516         {
 517                 if (m_sec_sequence.current() != m_sec_sequence.end())
 518                         ++m_sec_sequence.current();
 519                 --steps;
 520         }
 521         while( steps < 0 )
 522         {
 523                 if (m_sec_sequence.current() != m_sec_sequence.begin() && m_sec_sequence.current() != m_sec_sequence.end())
 524                         --m_sec_sequence.current();
 525                 ++steps;
 526         }
 527         return true;
 528 }
 529
 530 void eDVBFrontend::tuneLoop()  // called by m_tuneTimer
 531 {
 532         int delay=0;
 533         if ( m_sec_sequence && m_sec_sequence.current() != m_sec_sequence.end() )
 534         {
 535                 switch (m_sec_sequence.current()->cmd)
 536                 {
 537                         case eSecCommand::SLEEP:
 538                                 delay = m_sec_sequence.current()++->msec;
 539                                 eDebug("[SEC] sleep %dms", delay);
 540                                 break;
 541                         case eSecCommand::GOTO:
 542                                 if ( !setSecSequencePos(m_sec_sequence.current()->steps) )
 543                                         ++m_sec_sequence.current();
 544                                 break;
 545                         case eSecCommand::SET_VOLTAGE:
 546                         {
 547                                 int voltage = m_sec_sequence.current()++->voltage;
 548                                 eDebug("[SEC] setVoltage %d", voltage);
 549                                 setVoltage(voltage);
 550                                 break;
 551                         }
 552                         case eSecCommand::IF_VOLTAGE_GOTO:
 553                         {
 554                                 eSecCommand::pair &compare = m_sec_sequence.current()->compare;
 555                                 if ( compare.voltage == m_curVoltage && setSecSequencePos(compare.steps) )
 556                                         break;
 557                                 ++m_sec_sequence.current();
 558                                 break;
 559                         }
 560                         case eSecCommand::IF_NOT_VOLTAGE_GOTO:
 561                         {
 562                                 eSecCommand::pair &compare = m_sec_sequence.current()->compare;
 563                                 if ( compare.voltage != m_curVoltage && setSecSequencePos(compare.steps) )
 564                                         break;
 565                                 ++m_sec_sequence.current();
 566                                 break;
 567                         }
 568                         case eSecCommand::SET_TONE:
 569                                 eDebug("[SEC] setTone %d", m_sec_sequence.current()->tone);
 570                                 setTone(m_sec_sequence.current()++->tone);
 571                                 break;
 572                         case eSecCommand::SEND_DISEQC:
 573                                 sendDiseqc(m_sec_sequence.current()->diseqc);
 574                                 eDebugNoNewLine("[SEC] sendDiseqc: ");
 575                                 for (int i=0; i < m_sec_sequence.current()->diseqc.len; ++i)
 576                                     eDebugNoNewLine("%02x", m_sec_sequence.current()->diseqc.data[i]);
 577                                 eDebug("");
 578                                 ++m_sec_sequence.current();
 579                                 break;
 580                         case eSecCommand::SEND_TONEBURST:
 581                                 eDebug("[SEC] sendToneburst: %d", m_sec_sequence.current()->toneburst);
 582                                 sendToneburst(m_sec_sequence.current()++->toneburst);
 583                                 break;
 584                         case eSecCommand::SET_FRONTEND:
 585                                 eDebug("[SEC] setFrontend");
 586                                 setFrontend();
 587                                 ++m_sec_sequence.current();
 588                                 break;
 589                         case eSecCommand::SET_TIMEOUT:
 590                                 m_timeoutCount = m_sec_sequence.current()++->val;
 591                                 eDebug("[SEC] set timeout %d", m_timeoutCount);
 592                                 break;
 593                         case eSecCommand::IF_TIMEOUT_GOTO:
 594                                 if (!m_timeoutCount)
 595                                 {
 596                                         eDebug("[SEC] rotor timout");
 597                                         m_sec->setRotorMoving(false);
 598                                         setSecSequencePos(m_sec_sequence.current()->steps);
 599                                 }
 600                                 else
 601                                         ++m_sec_sequence.current();
 602                                 break;
 603                         case eSecCommand::MEASURE_IDLE_INPUTPOWER:
 604                         {
 605                                 int idx = m_sec_sequence.current()++->val;
 606                                 if ( idx == 0 || idx == 1 )
 607                                 {
 608                                         m_idleInputpower[idx] = readInputpower();
 609                                         eDebug("[SEC] idleInputpower[%d] is %d", idx, m_idleInputpower[idx]);
 610                                 }
 611                                 else
 612                                         eDebug("[SEC] idleInputpower measure index(%d) out of bound !!!", idx);
 613                                 break;
 614                         }
 615                         case eSecCommand::IF_MEASURE_IDLE_WAS_NOT_OK_GOTO:
 616                         {
 617                                 eSecCommand::pair &compare = m_sec_sequence.current()->compare;
 618                                 int idx = compare.voltage;
 619                                 if ( idx == 0 || idx == 1 )
 620                                 {
 621                                         int idle = readInputpower();
 622                                         int diff = abs(idle-m_idleInputpower[idx]);
 623                                         if ( diff > 0)
 624                                         {
 625                                                 eDebug("measure idle(%d) was not okay.. (%d - %d = %d) retry", idx, m_idleInputpower[idx], idle, diff);
 626                                                 setSecSequencePos(compare.steps);
 627                                                 break;
 628                                         }
 629                                 }
 630                                 ++m_sec_sequence.current();
 631                                 break;
 632                         }
 633                         case eSecCommand::MEASURE_RUNNING_INPUTPOWER:
 634                                 m_runningInputpower = readInputpower();
 635                                 eDebug("[SEC] runningInputpower is %d", m_runningInputpower);
 636                                 ++m_sec_sequence.current();
 637                                 break;
 638                         case eSecCommand::IF_INPUTPOWER_DELTA_GOTO:
 639                         {
 640                                 int idleInputpower = m_idleInputpower[ (m_curVoltage&1) ? 0 : 1];
 641                                 eSecCommand::rotor &cmd = m_sec_sequence.current()->measure;
 642                                 const char *txt = cmd.direction ? "running" : "stopped";
 643                                 eDebug("[SEC] waiting for rotor %s %d, idle %d, delta %d",
 644                                         txt,
 645                                         m_runningInputpower,
 646                                         idleInputpower,
 647                                         cmd.deltaA);
 648                                 if ( (cmd.direction && abs(m_runningInputpower - idleInputpower) >= cmd.deltaA)
 649                                         || (!cmd.direction && abs(m_runningInputpower - idleInputpower) <= cmd.deltaA) )
 650                                 {
 651                                         ++cmd.okcount;
 652                                         eDebug("[SEC] rotor %s step %d ok", txt, cmd.okcount);
 653                                         if ( cmd.okcount > 6 )
 654                                         {
 655                                                 m_sec->setRotorMoving(cmd.direction);
 656                                                 eDebug("[SEC] rotor is %s", txt);
 657                                                 if (setSecSequencePos(cmd.steps))
 658                                                         break;
 659                                         }
 660                                 }
 661                                 else
 662                                 {
 663                                         eDebug("[SEC] rotor not %s... reset counter.. increase timeout", txt);
 664                                         --m_timeoutCount;
 665                                         if (!m_timeoutCount && m_retryCount > 0)
 666                                                 --m_retryCount;
 667                                         cmd.okcount=0;
 668                                 }
 669                                 ++m_sec_sequence.current();
 670                                 break;
 671                         }
 672                         case eSecCommand::IF_ROTORPOS_VALID_GOTO:
 673                                 if (m_data[5] != -1 && m_data[6] != -1)
 674                                         setSecSequencePos(m_sec_sequence.current()->steps);
 675                                 else
 676                                         ++m_sec_sequence.current();
 677                                 break;
 678                         case eSecCommand::INVALIDATE_CURRENT_ROTORPARMS:
 679                                 m_data[5] = m_data[6] = -1;
 680                                 eDebug("[SEC] invalidate current rotorparams");
 681                                 ++m_sec_sequence.current();
 682                                 break;
 683                         case eSecCommand::UPDATE_CURRENT_ROTORPARAMS:
 684                                 m_data[5] = m_data[3];
 685                                 m_data[6] = m_data[4];
 686                                 eDebug("[SEC] update current rotorparams %d %04x %d", m_timeoutCount, m_data[5], m_data[6]);
 687                                 ++m_sec_sequence.current();
 688                                 break;
 689                         case eSecCommand::SET_ROTOR_DISEQC_RETRYS:
 690                                 m_retryCount = m_sec_sequence.current()++->val;
 691                                 eDebug("[SEC] set rotor retries %d", m_retryCount);
 692                                 break;
 693                         case eSecCommand::IF_NO_MORE_ROTOR_DISEQC_RETRYS_GOTO:
 694                                 if (!m_retryCount)
 695                                 {
 696                                         eDebug("[SEC] no more rotor retrys");
 697                                         setSecSequencePos(m_sec_sequence.current()->steps);
 698                                 }
 699                                 else
 700                                         ++m_sec_sequence.current();
 701                                 break;
 702                         case eSecCommand::SET_POWER_LIMITING_MODE:
 703                         {
 704                                 int fd = m_fe ?
 705                                         ::open("/dev/i2c/1", O_RDWR) :
 706                                         ::open("/dev/i2c/0", O_RDWR);
 707
 708                                 unsigned char data[2];
 709                                 ::ioctl(fd, I2C_SLAVE_FORCE, 0x10 >> 1);
 710                                 if(::read(fd, data, 1) != 1)
 711                                         eDebug("[SEC] error read lnbp (%m)");
 712                                 if ( m_sec_sequence.current()->mode == eSecCommand::modeStatic )
 713                                 {
 714                                         data[0] |= 0x80;  // enable static current limiting
 715                                         eDebug("[SEC] set static current limiting");
 716                                 }
 717                                 else
 718                                 {
 719                                         data[0] &= ~0x80;  // enable dynamic current limiting
 720                                         eDebug("[SEC] set dynamic current limiting");
 721                                 }
 722                                 if(::write(fd, data, 1) != 1)
 723                                         eDebug("[SEC] error write lnbp (%m)");
 724                                 ::close(fd);
 725                                 ++m_sec_sequence.current();
 726                                 break;
 727                         }
 728                         default:
 729                                 ++m_sec_sequence.current();
 730                                 eDebug("[SEC] unhandled sec command");
 731                 }
 732                 m_tuneTimer->start(delay,true);
 733         }
 734 }
 735
 736 void eDVBFrontend::setFrontend()
 737 {
 738         eDebug("setting frontend %d", m_fe);
 739         if (ioctl(m_fd, FE_SET_FRONTEND, &parm) == -1)
 740         {
 741                 perror("FE_SET_FRONTEND failed");
 742                 return;
 743         }
 744         m_timeout->start(5000, 1); // 5 sec timeout. TODO: symbolrate dependent
 745 }
 746
 747 RESULT eDVBFrontend::getFrontendType(int &t)
 748 {
 749         if (m_type == -1)
 750                 return -ENODEV;
 751         t = m_type;
 752         return 0;
 753 }
 754
 755 RESULT eDVBFrontend::tune(const iDVBFrontendParameters &where)
 756 {
 757         eDebug("(%d)tune", m_fe);
 758
 759         if (m_type == -1)
 760                 return -ENODEV;
 761
 762         feEvent(-1);
 763
 764         m_sec_sequence.clear();
 765
 766         switch (m_type)
 767         {
 768         case feSatellite:
 769         {
 770                 int res;
 771                 eDVBFrontendParametersSatellite feparm;
 772                 if (where.getDVBS(feparm))
 773                 {
 774                         eDebug("no dvbs data!");
 775                         return -EINVAL;
 776                 }
 777                 if (!m_sec)
 778                 {
 779                         eWarning("no SEC module active!");
 780                         return -ENOENT;
 781                 }
 782
 783                 res = m_sec->prepare(*this, parm, feparm, 1 << m_fe);
 784                 if (res)
 785                         return res;
 786                 eDebug("tuning to %d mhz", parm.frequency/1000);
 787                 break;
 788         }
 789         case feCable:
 790         {
 791                 eDVBFrontendParametersCable feparm;
 792                 if (where.getDVBC(feparm))
 793                         return -EINVAL;
 794                 parm.frequency = feparm.frequency * 1000;
 795                 parm.u.qam.symbol_rate = feparm.symbol_rate;
 796                 switch (feparm.modulation)
 797                 {
 798                 case eDVBFrontendParametersCable::Modulation::QAM16:
 799                         parm.u.qam.modulation = QAM_16;
 800                         break;
 801                 case eDVBFrontendParametersCable::Modulation::QAM32:
 802                         parm.u.qam.modulation = QAM_32;
 803                         break;
 804                 case eDVBFrontendParametersCable::Modulation::QAM64:
 805                         parm.u.qam.modulation = QAM_64;
 806                         break;
 807                 case eDVBFrontendParametersCable::Modulation::QAM128:
 808                         parm.u.qam.modulation = QAM_128;
 809                         break;
 810                 case eDVBFrontendParametersCable::Modulation::QAM256:
 811                         parm.u.qam.modulation = QAM_256;
 812                         break;
 813                 default:
 814                 case eDVBFrontendParametersCable::Modulation::Auto:
 815                         parm.u.qam.modulation = QAM_AUTO;
 816                         break;
 817                 }
 818                 switch (feparm.inversion)
 819                 {
 820                 case eDVBFrontendParametersCable::Inversion::On:
 821                         parm.inversion = INVERSION_ON;
 822                         break;
 823                 case eDVBFrontendParametersCable::Inversion::Off:
 824                         parm.inversion = INVERSION_OFF;
 825                         break;
 826                 default:
 827                 case eDVBFrontendParametersCable::Inversion::Unknown:
 828                         parm.inversion = INVERSION_AUTO;
 829                         break;
 830                 }
 831                 switch (feparm.fec_inner)
 832                 {
 833                 case eDVBFrontendParametersCable::FEC::fNone:
 834                         parm.u.qam.fec_inner = FEC_NONE;
 835                         break;
 836                 case eDVBFrontendParametersCable::FEC::f1_2:
 837                         parm.u.qam.fec_inner = FEC_1_2;
 838                         break;
 839                 case eDVBFrontendParametersCable::FEC::f2_3:
 840                         parm.u.qam.fec_inner = FEC_2_3;
 841                         break;
 842                 case eDVBFrontendParametersCable::FEC::f3_4:
 843                         parm.u.qam.fec_inner = FEC_3_4;
 844                         break;
 845                 case eDVBFrontendParametersCable::FEC::f5_6:
 846                         parm.u.qam.fec_inner = FEC_5_6;
 847                         break;
 848                 case eDVBFrontendParametersCable::FEC::f7_8:
 849                         parm.u.qam.fec_inner = FEC_7_8;
 850                         break;
 851                 case eDVBFrontendParametersCable::FEC::f8_9:
 852                         parm.u.qam.fec_inner = FEC_8_9;
 853                         break;
 854                 default:
 855                 case eDVBFrontendParametersCable::FEC::fAuto:
 856                         parm.u.qam.fec_inner = FEC_AUTO;
 857                         break;
 858                 }
 859                 break;
 860         }
 861         case feTerrestrial:
 862         {
 863                 eDVBFrontendParametersTerrestrial feparm;
 864                 if (where.getDVBT(feparm))
 865                 {
 866                         eDebug("no -T data");
 867                         return -EINVAL;
 868                 }
 869                 parm.frequency = feparm.frequency;
 870
 871                 switch (feparm.bandwidth)
 872                 {
 873                 case eDVBFrontendParametersTerrestrial::Bandwidth::Bw8MHz:
 874                         parm.u.ofdm.bandwidth = BANDWIDTH_8_MHZ;
 875                         break;
 876                 case eDVBFrontendParametersTerrestrial::Bandwidth::Bw7MHz:
 877                         parm.u.ofdm.bandwidth = BANDWIDTH_7_MHZ;
 878                         break;
 879                 case eDVBFrontendParametersTerrestrial::Bandwidth::Bw6MHz:
 880                         parm.u.ofdm.bandwidth = BANDWIDTH_6_MHZ;
 881                         break;
 882                 default:
 883                 case eDVBFrontendParametersTerrestrial::Bandwidth::BwAuto:
 884                         parm.u.ofdm.bandwidth = BANDWIDTH_AUTO;
 885                         break;
 886                 }
 887                 switch (feparm.code_rate_LP)
 888                 {
 889                 case eDVBFrontendParametersCable::FEC::f1_2:
 890                         parm.u.ofdm.code_rate_LP = FEC_1_2;
 891                         break;
 892                 case eDVBFrontendParametersCable::FEC::f2_3:
 893                         parm.u.ofdm.code_rate_LP = FEC_2_3;
 894                         break;
 895                 case eDVBFrontendParametersCable::FEC::f3_4:
 896                         parm.u.ofdm.code_rate_LP = FEC_3_4;
 897                         break;
 898                 case eDVBFrontendParametersCable::FEC::f5_6:
 899                         parm.u.ofdm.code_rate_LP = FEC_5_6;
 900                         break;
 901                 case eDVBFrontendParametersCable::FEC::f7_8:
 902                         parm.u.ofdm.code_rate_LP = FEC_7_8;
 903                         break;
 904                 default:
 905                 case eDVBFrontendParametersCable::FEC::fAuto:
 906                 case eDVBFrontendParametersCable::FEC::fNone:
 907                         parm.u.ofdm.code_rate_LP = FEC_AUTO;
 908                         break;
 909                 }
 910                 switch (feparm.code_rate_HP)
 911                 {
 912                 case eDVBFrontendParametersCable::FEC::f1_2:
 913                         parm.u.ofdm.code_rate_HP = FEC_1_2;
 914                         break;
 915                 case eDVBFrontendParametersCable::FEC::f2_3:
 916                         parm.u.ofdm.code_rate_HP = FEC_2_3;
 917                         break;
 918                 case eDVBFrontendParametersCable::FEC::f3_4:
 919                         parm.u.ofdm.code_rate_HP = FEC_3_4;
 920                         break;
 921                 case eDVBFrontendParametersCable::FEC::f5_6:
 922                         parm.u.ofdm.code_rate_HP = FEC_5_6;
 923                         break;
 924                 case eDVBFrontendParametersCable::FEC::f7_8:
 925                         parm.u.ofdm.code_rate_HP = FEC_7_8;
 926                         break;
 927                 default:
 928                 case eDVBFrontendParametersCable::FEC::fAuto:
 929                 case eDVBFrontendParametersCable::FEC::fNone:
 930                         parm.u.ofdm.code_rate_HP = FEC_AUTO;
 931                         break;
 932                 }
 933                 switch (feparm.modulation)
 934                 {
 935                 case eDVBFrontendParametersTerrestrial::Modulation::QPSK:
 936                         parm.u.ofdm.constellation = QPSK;
 937                         break;
 938                 case eDVBFrontendParametersTerrestrial::Modulation::QAM16:
 939                         parm.u.ofdm.constellation = QAM_16;
 940                         break;
 941                 default:
 942                 case eDVBFrontendParametersTerrestrial::Modulation::Auto:
 943                         parm.u.ofdm.constellation = QAM_AUTO;
 944                         break;
 945                 }
 946                 switch (feparm.transmission_mode)
 947                 {
 948                 case eDVBFrontendParametersTerrestrial::TransmissionMode::TM2k:
 949                         parm.u.ofdm.transmission_mode = TRANSMISSION_MODE_2K;
 950                         break;
 951                 case eDVBFrontendParametersTerrestrial::TransmissionMode::TM8k:
 952                         parm.u.ofdm.transmission_mode = TRANSMISSION_MODE_8K;
 953                         break;
 954                 default:
 955                 case eDVBFrontendParametersTerrestrial::TransmissionMode::TMAuto:
 956                         parm.u.ofdm.transmission_mode = TRANSMISSION_MODE_AUTO;
 957                         break;
 958                 }
 959                 switch (feparm.guard_interval)
 960                 {
 961                         case eDVBFrontendParametersTerrestrial::GuardInterval::GI_1_32:
 962                                 parm.u.ofdm.guard_interval = GUARD_INTERVAL_1_32;
 963                                 break;
 964                         case eDVBFrontendParametersTerrestrial::GuardInterval::GI_1_16:
 965                                 parm.u.ofdm.guard_interval = GUARD_INTERVAL_1_16;
 966                                 break;
 967                         case eDVBFrontendParametersTerrestrial::GuardInterval::GI_1_8:
 968                                 parm.u.ofdm.guard_interval = GUARD_INTERVAL_1_8;
 969                                 break;
 970                         case eDVBFrontendParametersTerrestrial::GuardInterval::GI_1_4:
 971                                 parm.u.ofdm.guard_interval = GUARD_INTERVAL_1_4;
 972                                 break;
 973                         default:
 974                         case eDVBFrontendParametersTerrestrial::GuardInterval::GI_Auto:
 975                                 parm.u.ofdm.guard_interval = GUARD_INTERVAL_AUTO;
 976                                 break;
 977                 }
 978                 switch (feparm.hierarchy)
 979                 {
 980                         case eDVBFrontendParametersTerrestrial::Hierarchy::H1:
 981                                 parm.u.ofdm.hierarchy_information = HIERARCHY_1;
 982                                 break;
 983                         case eDVBFrontendParametersTerrestrial::Hierarchy::H2:
 984                                 parm.u.ofdm.hierarchy_information = HIERARCHY_2;
 985                                 break;
 986                         case eDVBFrontendParametersTerrestrial::Hierarchy::H4:
 987                                 parm.u.ofdm.hierarchy_information = HIERARCHY_4;
 988                                 break;
 989                         default:
 990                         case eDVBFrontendParametersTerrestrial::Hierarchy::HAuto:
 991                                 parm.u.ofdm.hierarchy_information = HIERARCHY_AUTO;
 992                                 break;
 993                 }
 994         }
 995         }
 996
 997         m_sec_sequence.push_back( eSecCommand(eSecCommand::SET_FRONTEND) );
 998         m_tuneTimer->start(0,true);
 999         m_timeout->stop();
1000         m_sec_sequence.current() = m_sec_sequence.begin();
1001
1002         if (m_state != stateTuning)
1003         {
1004                 m_tuning = 1;
1005                 m_state = stateTuning;
1006                 m_stateChanged(this);
1007         }
1008
1009         return 0;
1010 }
1011
1012 RESULT eDVBFrontend::connectStateChange(const Slot1<void,iDVBFrontend*> &stateChange, ePtr<eConnection> &connection)
1013 {
1014         connection = new eConnection(this, m_stateChanged.connect(stateChange));
1015         return 0;
1016 }
1017
1018 RESULT eDVBFrontend::setVoltage(int voltage)
1019 {
1020         if (m_type != feSatellite)
1021                 return -1;
1022 #if HAVE_DVB_API_VERSION < 3
1023         secVoltage vlt;
1024 #else
1025         bool increased=false;
1026         fe_sec_voltage_t vlt;
1027 #endif
1028         m_curVoltage=voltage;
1029         switch (voltage)
1030         {
1031         case voltageOff:
1032                 for (int i=0; i < 3; ++i)  // reset diseqc
1033                         m_data[i]=-1;
1034                 vlt = SEC_VOLTAGE_OFF;
1035                 break;
1036         case voltage13_5:
1037 #if HAVE_DVB_API_VERSION < 3
1038                 vlt = SEC_VOLTAGE_13_5;
1039                 break;
1040 #else
1041                 increased = true;
1042 #endif
1043         case voltage13:
1044                 vlt = SEC_VOLTAGE_13;
1045                 break;
1046         case voltage18_5:
1047 #if HAVE_DVB_API_VERSION < 3
1048                 vlt = SEC_VOLTAGE_18_5;
1049                 break;
1050 #else
1051                 increased = true;
1052 #endif
1053         case voltage18:
1054                 vlt = SEC_VOLTAGE_18;
1055                 break;
1056         default:
1057                 return -ENODEV;
1058         }
1059 #if HAVE_DVB_API_VERSION < 3
1060         return ::ioctl(m_secfd, SEC_SET_VOLTAGE, vlt);
1061 #else
1062         if (::ioctl(m_fd, FE_ENABLE_HIGH_LNB_VOLTAGE, increased) < 0)
1063                 perror("FE_ENABLE_HIGH_LNB_VOLTAGE");
1064         return ::ioctl(m_fd, FE_SET_VOLTAGE, vlt);
1065 #endif
1066 }
1067
1068 RESULT eDVBFrontend::getState(int &state)
1069 {
1070         state = m_state;
1071         return 0;
1072 }
1073
1074 RESULT eDVBFrontend::setTone(int t)
1075 {
1076         if (m_type != feSatellite)
1077                 return -1;
1078 #if HAVE_DVB_API_VERSION < 3
1079         secToneMode_t tone;
1080 #else
1081         fe_sec_tone_mode_t tone;
1082 #endif
1083
1084         switch (t)
1085         {
1086         case toneOn:
1087                 tone = SEC_TONE_ON;
1088                 break;
1089         case toneOff:
1090                 tone = SEC_TONE_OFF;
1091                 break;
1092         default:
1093                 return -ENODEV;
1094         }
1095 #if HAVE_DVB_API_VERSION < 3
1096         return ::ioctl(m_secfd, SEC_SET_TONE, tone);
1097 #else
1098         return ::ioctl(m_fd, FE_SET_TONE, tone);
1099 #endif
1100 }
1101
1102 #if HAVE_DVB_API_VERSION < 3 && !defined(SEC_DISEQC_SEND_MASTER_CMD)
1103         #define SEC_DISEQC_SEND_MASTER_CMD _IOW('o', 97, struct secCommand *)
1104 #endif
1105
1106 RESULT eDVBFrontend::sendDiseqc(const eDVBDiseqcCommand &diseqc)
1107 {
1108 #if HAVE_DVB_API_VERSION < 3
1109         struct secCommand cmd;
1110         cmd.type = SEC_CMDTYPE_DISEQC_RAW;
1111         cmd.u.diseqc.cmdtype = diseqc.data[0];
1112         cmd.u.diseqc.addr = diseqc.data[1];
1113         cmd.u.diseqc.cmd = diseqc.data[2];
1114         cmd.u.diseqc.numParams = diseqc.len-3;
1115         memcpy(cmd.u.diseqc.params, diseqc.data+3, diseqc.len-3);
1116         if (::ioctl(m_secfd, SEC_DISEQC_SEND_MASTER_CMD, &cmd))
1117 #else
1118         struct dvb_diseqc_master_cmd cmd;
1119         memcpy(cmd.msg, diseqc.data, diseqc.len);
1120         cmd.msg_len = diseqc.len;
1121         if (::ioctl(m_fd, FE_DISEQC_SEND_MASTER_CMD, &cmd))
1122 #endif
1123                 return -EINVAL;
1124         return 0;
1125 }
1126
1127 #if HAVE_DVB_API_VERSION < 3 && !defined(SEC_DISEQC_SEND_BURST)
1128         #define SEC_DISEQC_SEND_BURST _IO('o', 96)
1129 #endif
1130 RESULT eDVBFrontend::sendToneburst(int burst)
1131 {
1132 #if HAVE_DVB_API_VERSION < 3
1133         secMiniCmd cmd = SEC_MINI_NONE;
1134 #else
1135         fe_sec_mini_cmd_t cmd = SEC_MINI_A;
1136 #endif
1137         if ( burst == eDVBSatelliteDiseqcParameters::A )
1138                 cmd = SEC_MINI_A;
1139         else if ( burst == eDVBSatelliteDiseqcParameters::B )
1140                 cmd = SEC_MINI_B;
1141 #if HAVE_DVB_API_VERSION < 3
1142         if (::ioctl(m_secfd, SEC_DISEQC_SEND_BURST, cmd))
1143                 return -EINVAL;
1144 #else
1145         if (::ioctl(m_fd, FE_DISEQC_SEND_BURST, cmd))
1146                 return -EINVAL;
1147 #endif
1148         return 0;
1149 }
1150
1151 RESULT eDVBFrontend::setSEC(iDVBSatelliteEquipmentControl *sec)
1152 {
1153         m_sec = sec;
1154         return 0;
1155 }
1156
1157 RESULT eDVBFrontend::setSecSequence(const eSecCommandList &list)
1158 {
1159         m_sec_sequence = list;
1160         return 0;
1161 }
1162
1163 RESULT eDVBFrontend::getData(int num, int &data)
1164 {
1165         if ( num < (int)(sizeof(m_data)/sizeof(int)) )
1166         {
1167                 data = m_data[num];
1168                 return 0;
1169         }
1170         return -EINVAL;
1171 }
1172
1173 RESULT eDVBFrontend::setData(int num, int val)
1174 {
1175         if ( num < (int)(sizeof(m_data)/sizeof(int)) )
1176         {
1177                 m_data[num] = val;
1178                 return 0;
1179         }
1180         return -EINVAL;
1181 }
1182
1183 int eDVBFrontend::isCompatibleWith(ePtr<iDVBFrontendParameters> &feparm)
1184 {
1185         int type;
1186         if (feparm->getSystem(type) || type != m_type)
1187                 return 0;
1188
1189         if (m_type == eDVBFrontend::feSatellite)
1190         {
1191                 ASSERT(m_sec);
1192                 eDVBFrontendParametersSatellite sat_parm;
1193                 ASSERT(!feparm->getDVBS(sat_parm));
1194                 return m_sec->canTune(sat_parm, this, 1 << m_fe);
1195         }
1196         return 1;
1197 }