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