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