code.vuplus.com Git - vuplus_dvbapp/blob - lib/dvb/frontend.cpp

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