Mercurial > mplayer.hg
diff stream/dvb_tune.c @ 19271:64d82a45a05d
introduce new 'stream' directory for all stream layer related components and split them from libmpdemux
author | ben |
---|---|
date | Mon, 31 Jul 2006 17:39:17 +0000 |
parents | libmpdemux/dvb_tune.c@0783dd397f74 |
children | 3af036ae3c75 |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/stream/dvb_tune.c Mon Jul 31 17:39:17 2006 +0000 @@ -0,0 +1,791 @@ +/* dvbtune - tune.c + + Copyright (C) Dave Chapman 2001,2002 + + Modified for use with MPlayer, for details see the changelog at + http://svn.mplayerhq.hu/mplayer/trunk/ + $Id$ + + This program is free software; you can redistribute it and/or + modify it under the terms of the GNU General Public License + as published by the Free Software Foundation; either version 2 + of the License, or (at your option) any later version. + + This program is distributed in the hope that it will be useful, + but WITHOUT ANY WARRANTY; without even the implied warranty of + MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + GNU General Public License for more details. + + You should have received a copy of the GNU General Public License + along with this program; if not, write to the Free Software + Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. + Or, point your browser to http://www.gnu.org/copyleft/gpl.html + +*/ + +#include <stdio.h> +#include <stdlib.h> +#include <ctype.h> +#include <sys/ioctl.h> +#include <sys/poll.h> +#include <unistd.h> +#include <fcntl.h> +#include <error.h> +#include <time.h> +#include <errno.h> +#include "config.h" + +#ifdef HAVE_DVB_HEAD + #include <linux/dvb/dmx.h> + #include <linux/dvb/frontend.h> + char* dvb_frontenddev[4]={"/dev/dvb/adapter0/frontend0","/dev/dvb/adapter1/frontend0","/dev/dvb/adapter2/frontend0","/dev/dvb/adapter3/frontend0"}; + char* dvb_dvrdev[4]={"/dev/dvb/adapter0/dvr0","/dev/dvb/adapter1/dvr0","/dev/dvb/adapter2/dvr0","/dev/dvb/adapter3/dvr0"}; + char* dvb_demuxdev[4]={"/dev/dvb/adapter0/demux0","/dev/dvb/adapter1/demux0","/dev/dvb/adapter2/demux0","/dev/dvb/adapter3/demux0"}; + static char* dvb_secdev[4]={"","","",""}; //UNUSED, ONLY FOR UNIFORMITY +#else + #include <ost/dmx.h> + #include <ost/sec.h> + #include <ost/frontend.h> + char* dvb_frontenddev[4]={"/dev/ost/frontend0","/dev/ost/frontend1","/dev/ost/frontend2","/dev/ost/frontend3"}; + char* dvb_dvrdev[4]={"/dev/ost/dvr0","/dev/ost/dvr1","/dev/ost/dvr2","/dev/ost/dvr3"}; + static char* dvb_secdev[4]={"/dev/ost/sec0","/dev/ost/sec1","/dev/ost/sec2","/dev/ost/sec3"}; + char* dvb_demuxdev[4]={"/dev/ost/demux0","/dev/ost/demux1","/dev/ost/demux2","/dev/ost/demux3"}; +#endif + +#include "dvbin.h" +#include "mp_msg.h" + + + +int dvb_get_tuner_type(int fe_fd) +{ +#ifdef HAVE_DVB_HEAD + struct dvb_frontend_info fe_info; +#else + FrontendInfo fe_info; +#endif + + int res; + + res = ioctl(fe_fd, FE_GET_INFO, &fe_info); + if(res < 0) + { + mp_msg(MSGT_DEMUX, MSGL_ERR, "FE_GET_INFO error: %d, FD: %d\n\n", errno, fe_fd); + return 0; + } + + switch(fe_info.type) + { + case FE_OFDM: + mp_msg(MSGT_DEMUX, MSGL_V, "TUNER TYPE SEEMS TO BE DVB-T\n"); + return TUNER_TER; + + case FE_QPSK: + mp_msg(MSGT_DEMUX, MSGL_V, "TUNER TYPE SEEMS TO BE DVB-S\n"); + return TUNER_SAT; + + case FE_QAM: + mp_msg(MSGT_DEMUX, MSGL_V, "TUNER TYPE SEEMS TO BE DVB-C\n"); + return TUNER_CBL; + +#ifdef DVB_ATSC + case FE_ATSC: + mp_msg(MSGT_DEMUX, MSGL_V, "TUNER TYPE SEEMS TO BE DVB-ATSC\n"); + return TUNER_ATSC; +#endif + default: + mp_msg(MSGT_DEMUX, MSGL_ERR, "UNKNOWN TUNER TYPE\n"); + return 0; + } + +} + +int dvb_set_ts_filt(int fd, uint16_t pid, dmx_pes_type_t pestype); + +int dvb_open_devices(dvb_priv_t *priv, int n, int demux_cnt, int *pids) +{ + int i; + + priv->fe_fd = open(dvb_frontenddev[n], O_RDWR | O_NONBLOCK); + if(priv->fe_fd < 0) + { + mp_msg(MSGT_DEMUX, MSGL_ERR, "ERROR OPENING FRONTEND DEVICE %s: ERRNO %d\n", dvb_frontenddev[n], errno); + return 0; + } +#ifdef HAVE_DVB_HEAD + priv->sec_fd=0; +#else + priv->sec_fd = open(dvb_secdev[n], O_RDWR); + if(priv->sec_fd < 0) + { + mp_msg(MSGT_DEMUX, MSGL_ERR, "ERROR OPENING SEC DEVICE %s: ERRNO %d\n", dvb_secdev[n], errno); + close(priv->fe_fd); + return 0; + } +#endif + priv->demux_fds_cnt = 0; + mp_msg(MSGT_DEMUX, MSGL_V, "DVB_OPEN_DEVICES(%d)\n", demux_cnt); + for(i = 0; i < demux_cnt; i++) + { + priv->demux_fds[i] = open(dvb_demuxdev[n], O_RDWR | O_NONBLOCK); + if(priv->demux_fds[i] < 0) + { + mp_msg(MSGT_DEMUX, MSGL_ERR, "ERROR OPENING DEMUX 0: %d\n", errno); + return 0; + } + else + { + mp_msg(MSGT_DEMUX, MSGL_V, "OPEN(%d), file %s: FD=%d, CNT=%d\n", i, dvb_demuxdev[n], priv->demux_fds[i], priv->demux_fds_cnt); + priv->demux_fds_cnt++; + } + } + + + priv->dvr_fd = open(dvb_dvrdev[n], O_RDONLY| O_NONBLOCK); + if(priv->dvr_fd < 0) + { + mp_msg(MSGT_DEMUX, MSGL_ERR, "ERROR OPENING DVR DEVICE %s: %d\n", dvb_dvrdev[n], errno); + return 0; + } + + return 1; +} + + +int dvb_fix_demuxes(dvb_priv_t *priv, int cnt, int *pids) +{ + int i; + + mp_msg(MSGT_DEMUX, MSGL_V, "FIX %d -> %d\n", priv->demux_fds_cnt, cnt); + if(priv->demux_fds_cnt >= cnt) + { + for(i = priv->demux_fds_cnt-1; i >= cnt; i--) + { + mp_msg(MSGT_DEMUX, MSGL_V, "FIX, CLOSE fd(%d): %d\n", i, priv->demux_fds[i]); + close(priv->demux_fds[i]); + } + priv->demux_fds_cnt = cnt; + } + else if(priv->demux_fds_cnt < cnt) + { + for(i = priv->demux_fds_cnt; i < cnt; i++) + { + priv->demux_fds[i] = open(dvb_demuxdev[priv->card], O_RDWR | O_NONBLOCK); + mp_msg(MSGT_DEMUX, MSGL_V, "FIX, OPEN fd(%d): %d\n", i, priv->demux_fds[i]); + if(priv->demux_fds[i] < 0) + { + mp_msg(MSGT_DEMUX, MSGL_ERR, "ERROR OPENING DEMUX 0: %d\n", errno); + return 0; + } + else + priv->demux_fds_cnt++; + } + } + + return 1; +} + +int dvb_set_ts_filt(int fd, uint16_t pid, dmx_pes_type_t pestype) +{ + int i; + struct dmx_pes_filter_params pesFilterParams; + + pesFilterParams.pid = pid; + pesFilterParams.input = DMX_IN_FRONTEND; + pesFilterParams.output = DMX_OUT_TS_TAP; +#ifdef HAVE_DVB_HEAD + pesFilterParams.pes_type = pestype; +#else + pesFilterParams.pesType = pestype; +#endif + + pesFilterParams.flags = DMX_IMMEDIATE_START; + + errno = 0; + if ((i = ioctl(fd, DMX_SET_PES_FILTER, &pesFilterParams)) < 0) + { + mp_msg(MSGT_DEMUX, MSGL_ERR, "ERROR IN SETTING DMX_FILTER %i for fd %d: ERRNO: %d", pid, fd, errno); + return 0; + } + + mp_msg(MSGT_DEMUX, MSGL_V, "SET PES FILTER ON PID %d to fd %d, RESULT: %d, ERRNO: %d\n", pid, fd, i, errno); + return 1; +} + + +int dvb_demux_stop(int fd) +{ + int i; + i = ioctl(fd, DMX_STOP); + + mp_msg(MSGT_DEMUX, MSGL_DBG2, "STOPPING FD: %d, RESULT: %d\n", fd, i); + + return (i==0); +} + + +int dvb_demux_start(int fd) +{ + int i; + i = ioctl(fd, DMX_START); + + mp_msg(MSGT_DEMUX, MSGL_DBG2, "STARTING FD: %d, RESULT: %d\n", fd, i); + + return (i==0); +} + + +static int tune_it(int fd_frontend, int fd_sec, unsigned int freq, unsigned int srate, char pol, int tone, + fe_spectral_inversion_t specInv, unsigned int diseqc, fe_modulation_t modulation, fe_code_rate_t HP_CodeRate, + fe_transmit_mode_t TransmissionMode, fe_guard_interval_t guardInterval, fe_bandwidth_t bandwidth, + fe_code_rate_t LP_CodeRate, fe_hierarchy_t hier, int tmout); + + +int dvb_tune(dvb_priv_t *priv, int freq, char pol, int srate, int diseqc, int tone, + fe_spectral_inversion_t specInv, fe_modulation_t modulation, fe_guard_interval_t guardInterval, + fe_transmit_mode_t TransmissionMode, fe_bandwidth_t bandWidth, fe_code_rate_t HP_CodeRate, + fe_code_rate_t LP_CodeRate, fe_hierarchy_t hier, int timeout) +{ + int ris; + + mp_msg(MSGT_DEMUX, MSGL_INFO, "dvb_tune Freq: %lu\n", (long unsigned int) freq); + + ris = tune_it(priv->fe_fd, priv->sec_fd, freq, srate, pol, tone, specInv, diseqc, modulation, HP_CodeRate, TransmissionMode, guardInterval, bandWidth, LP_CodeRate, hier, timeout); + + if(ris != 0) + mp_msg(MSGT_DEMUX, MSGL_INFO, "dvb_tune, TUNING FAILED\n"); + + return (ris == 0); +} + + +#ifndef HAVE_DVB_HEAD +static int SecGetStatus (int fd, struct secStatus *state) +{ + if(ioctl(fd, SEC_GET_STATUS, state) < 0) + { + mp_msg(MSGT_DEMUX, MSGL_ERR, ("SEC GET STATUS: ")); + return -1; + } + + switch (state->busMode) + { + case SEC_BUS_IDLE: + mp_msg(MSGT_DEMUX, MSGL_V, "SEC BUS MODE: IDLE (%d)\n",state->busMode); + break; + case SEC_BUS_BUSY: + mp_msg(MSGT_DEMUX, MSGL_V, "SEC BUS MODE: BUSY (%d)\n",state->busMode); + break; + case SEC_BUS_OFF: + mp_msg(MSGT_DEMUX, MSGL_V, "SEC BUS MODE: OFF (%d)\n",state->busMode); + break; + case SEC_BUS_OVERLOAD: + mp_msg(MSGT_DEMUX, MSGL_V, "SEC BUS MODE: OVERLOAD (%d)\n",state->busMode); + break; + default: + mp_msg(MSGT_DEMUX, MSGL_V, "SEC BUS MODE: unknown (%d)\n",state->busMode); + break; + } + + switch (state->selVolt) + { + case SEC_VOLTAGE_OFF: + mp_msg(MSGT_DEMUX, MSGL_V, "SEC VOLTAGE: OFF (%d)\n",state->selVolt); + break; + case SEC_VOLTAGE_LT: + mp_msg(MSGT_DEMUX, MSGL_V, "SEC VOLTAGE: LT (%d)\n",state->selVolt); + break; + case SEC_VOLTAGE_13: + mp_msg(MSGT_DEMUX, MSGL_V, "SEC VOLTAGE: 13 (%d)\n",state->selVolt); + break; + case SEC_VOLTAGE_13_5: + mp_msg(MSGT_DEMUX, MSGL_V, "SEC VOLTAGE: 13.5 (%d)\n",state->selVolt); + break; + case SEC_VOLTAGE_18: + mp_msg(MSGT_DEMUX, MSGL_V, "SEC VOLTAGE: 18 (%d)\n",state->selVolt); + break; + case SEC_VOLTAGE_18_5: + mp_msg(MSGT_DEMUX, MSGL_V, "SEC VOLTAGE: 18.5 (%d)\n",state->selVolt); + break; + default: + mp_msg(MSGT_DEMUX, MSGL_V, "SEC VOLTAGE: unknown (%d)\n",state->selVolt); + break; + } + + mp_msg(MSGT_DEMUX, MSGL_V, "SEC CONT TONE: %s\n", (state->contTone == SEC_TONE_ON ? "ON" : "OFF")); + return 0; +} + +#endif + +static void print_status(fe_status_t festatus) +{ + mp_msg(MSGT_DEMUX, MSGL_V, "FE_STATUS:"); + if (festatus & FE_HAS_SIGNAL) mp_msg(MSGT_DEMUX, MSGL_V," FE_HAS_SIGNAL"); +#ifdef HAVE_DVB_HEAD + if (festatus & FE_TIMEDOUT) mp_msg(MSGT_DEMUX, MSGL_V, " FE_TIMEDOUT"); +#else + if (festatus & FE_HAS_POWER) mp_msg(MSGT_DEMUX, MSGL_V, " FE_HAS_POWER"); + if (festatus & FE_SPECTRUM_INV) mp_msg(MSGT_DEMUX, MSGL_V, " FE_SPECTRUM_INV"); + if (festatus & FE_TUNER_HAS_LOCK) mp_msg(MSGT_DEMUX, MSGL_V, " FE_TUNER_HAS_LOCK"); +#endif + if (festatus & FE_HAS_LOCK) mp_msg(MSGT_DEMUX, MSGL_V, " FE_HAS_LOCK"); + if (festatus & FE_HAS_CARRIER) mp_msg(MSGT_DEMUX, MSGL_V, " FE_HAS_CARRIER"); + if (festatus & FE_HAS_VITERBI) mp_msg(MSGT_DEMUX, MSGL_V, " FE_HAS_VITERBI"); + if (festatus & FE_HAS_SYNC) mp_msg(MSGT_DEMUX, MSGL_V, " FE_HAS_SYNC"); + mp_msg(MSGT_DEMUX, MSGL_V, "\n"); +} + + +#ifdef HAVE_DVB_HEAD +static int check_status(int fd_frontend,struct dvb_frontend_parameters* feparams, int tuner_type, uint32_t base, int tmout) +{ + int32_t strength; + fe_status_t festatus; + struct pollfd pfd[1]; + int ok=0, locks=0; + time_t tm1, tm2; + + if (ioctl(fd_frontend,FE_SET_FRONTEND,feparams) < 0) + { + mp_msg(MSGT_DEMUX, MSGL_ERR, "ERROR tuning channel\n"); + return -1; + } + + pfd[0].fd = fd_frontend; + pfd[0].events = POLLPRI; + + mp_msg(MSGT_DEMUX, MSGL_V, "Getting frontend status\n"); + tm1 = tm2 = time((time_t*) NULL); + while(!ok) + { + festatus = 0; + if(poll(pfd,1,tmout*1000) > 0) + { + if (pfd[0].revents & POLLPRI) + { + if(ioctl(fd_frontend, FE_READ_STATUS, &festatus) >= 0) + if(festatus & FE_HAS_LOCK) + locks++; + } + } + usleep(10000); + tm2 = time((time_t*) NULL); + if((festatus & FE_TIMEDOUT) || (locks >= 2) || (tm2 - tm1 >= tmout)) + ok = 1; + } + + if(festatus & FE_HAS_LOCK) + { + if(ioctl(fd_frontend,FE_GET_FRONTEND,feparams) >= 0) + { + switch(tuner_type) + { + case FE_OFDM: + mp_msg(MSGT_DEMUX, MSGL_V, "Event: Frequency: %d\n",feparams->frequency); + break; + case FE_QPSK: + mp_msg(MSGT_DEMUX, MSGL_V, "Event: Frequency: %d\n",(unsigned int)((feparams->frequency)+base)); + mp_msg(MSGT_DEMUX, MSGL_V, " SymbolRate: %d\n",feparams->u.qpsk.symbol_rate); + mp_msg(MSGT_DEMUX, MSGL_V, " FEC_inner: %d\n",feparams->u.qpsk.fec_inner); + mp_msg(MSGT_DEMUX, MSGL_V, "\n"); + break; + case FE_QAM: + mp_msg(MSGT_DEMUX, MSGL_V, "Event: Frequency: %d\n",feparams->frequency); + mp_msg(MSGT_DEMUX, MSGL_V, " SymbolRate: %d\n",feparams->u.qpsk.symbol_rate); + mp_msg(MSGT_DEMUX, MSGL_V, " FEC_inner: %d\n",feparams->u.qpsk.fec_inner); + break; +#ifdef DVB_ATSC + case FE_ATSC: + mp_msg(MSGT_DEMUX, MSGL_V, "Event: Frequency: %d\n",feparams->frequency); + mp_msg(MSGT_DEMUX, MSGL_V, " Modulation: %d\n",feparams->u.vsb.modulation); + break; +#endif + default: + break; + } + } + + strength=0; + if(ioctl(fd_frontend,FE_READ_BER,&strength) >= 0) + mp_msg(MSGT_DEMUX, MSGL_V, "Bit error rate: %d\n",strength); + + strength=0; + if(ioctl(fd_frontend,FE_READ_SIGNAL_STRENGTH,&strength) >= 0) + mp_msg(MSGT_DEMUX, MSGL_V, "Signal strength: %d\n",strength); + + strength=0; + if(ioctl(fd_frontend,FE_READ_SNR,&strength) >= 0) + mp_msg(MSGT_DEMUX, MSGL_V, "SNR: %d\n",strength); + + strength=0; + if(ioctl(fd_frontend,FE_READ_UNCORRECTED_BLOCKS,&strength) >= 0) + mp_msg(MSGT_DEMUX, MSGL_V, "UNC: %d\n",strength); + + print_status(festatus); + } + else + { + mp_msg(MSGT_DEMUX, MSGL_ERR, "Not able to lock to the signal on the given frequency, timeout: %d\n", tmout); + return -1; + } + return 0; +} + +#else + +static int check_status(int fd_frontend,FrontendParameters* feparams,int tuner_type,uint32_t base, int tmout) +{ + int i,res; + int32_t strength; + fe_status_t festatus; + FrontendEvent event; + + struct pollfd pfd[1]; + + while(1) + { + if(ioctl(fd_frontend, FE_GET_EVENT, &event) == -1) + break; + } + + i = 0; res = -1; + while ((i < 3) && (res < 0)) + { + if (ioctl(fd_frontend,FE_SET_FRONTEND,feparams) < 0) + { + mp_msg(MSGT_DEMUX, MSGL_ERR, "ERROR tuning channel\n"); + return -1; + } + + pfd[0].fd = fd_frontend; + pfd[0].events = POLLIN | POLLPRI; + + if(poll(pfd,1,tmout*1000) > 0) + { + if (pfd[0].revents & POLLPRI) + { + mp_msg(MSGT_DEMUX, MSGL_V, "Getting frontend event\n"); + if ( ioctl(fd_frontend, FE_GET_EVENT, &event) < 0) + { + mp_msg(MSGT_DEMUX, MSGL_ERR, "FE_GET_EVENT"); + return -1; + } + mp_msg(MSGT_DEMUX, MSGL_V, "Received "); + switch(event.type) + { + case FE_UNEXPECTED_EV: + mp_msg(MSGT_DEMUX, MSGL_V, "unexpected event\n"); + res = -1; + break; + + case FE_FAILURE_EV: + mp_msg(MSGT_DEMUX, MSGL_V, "failure event\n"); + res = -1; + break; + + case FE_COMPLETION_EV: + mp_msg(MSGT_DEMUX, MSGL_V, "completion event\n"); + res = 0; + break; + } + } + i++; + } + } + + if (res > 0) + switch (event.type) + { + case FE_UNEXPECTED_EV: mp_msg(MSGT_DEMUX, MSGL_V, "FE_UNEXPECTED_EV\n"); + break; + case FE_COMPLETION_EV: mp_msg(MSGT_DEMUX, MSGL_V, "FE_COMPLETION_EV\n"); + break; + case FE_FAILURE_EV: mp_msg(MSGT_DEMUX, MSGL_V, "FE_FAILURE_EV\n"); + break; + } + + if (event.type == FE_COMPLETION_EV) + { + switch(tuner_type) + { + case FE_OFDM: + mp_msg(MSGT_DEMUX, MSGL_V, "Event: Frequency: %d\n",event.u.completionEvent.Frequency); + break; + + case FE_QPSK: + mp_msg(MSGT_DEMUX, MSGL_V, "Event: Frequency: %d\n",(unsigned int)((event.u.completionEvent.Frequency)+base)); + mp_msg(MSGT_DEMUX, MSGL_V, " SymbolRate: %d\n",event.u.completionEvent.u.qpsk.SymbolRate); + mp_msg(MSGT_DEMUX, MSGL_V, " FEC_inner: %d\n",event.u.completionEvent.u.qpsk.FEC_inner); + mp_msg(MSGT_DEMUX, MSGL_V, "\n"); + break; + + case FE_QAM: + mp_msg(MSGT_DEMUX, MSGL_V, "Event: Frequency: %d\n",event.u.completionEvent.Frequency); + mp_msg(MSGT_DEMUX, MSGL_V, " SymbolRate: %d\n",event.u.completionEvent.u.qpsk.SymbolRate); + mp_msg(MSGT_DEMUX, MSGL_V, " FEC_inner: %d\n",event.u.completionEvent.u.qpsk.FEC_inner); + break; + + default: + break; + } + + strength=0; + if(ioctl(fd_frontend,FE_READ_BER,&strength) >= 0) + mp_msg(MSGT_DEMUX, MSGL_V, "Bit error rate: %d\n",strength); + + strength=0; + if(ioctl(fd_frontend,FE_READ_SIGNAL_STRENGTH,&strength) >= 0) + mp_msg(MSGT_DEMUX, MSGL_V, "Signal strength: %d\n",strength); + + strength=0; + if(ioctl(fd_frontend,FE_READ_SNR,&strength) >= 0) + mp_msg(MSGT_DEMUX, MSGL_V, "SNR: %d\n",strength); + + festatus=0; + mp_msg(MSGT_DEMUX, MSGL_V, "FE_STATUS:"); + + if(ioctl(fd_frontend,FE_READ_STATUS,&festatus) >= 0) + print_status(festatus); + else + mp_msg(MSGT_DEMUX, MSGL_ERR, " ERROR, UNABLE TO READ_STATUS"); + + mp_msg(MSGT_DEMUX, MSGL_V, "\n"); + } + else + { + mp_msg(MSGT_DEMUX, MSGL_V, "Not able to lock to the signal on the given frequency\n"); + return -1; + } + return 0; +} +#endif + +#ifdef HAVE_DVB_HEAD + +static struct diseqc_cmd { + struct dvb_diseqc_master_cmd cmd; + uint32_t wait; +}; + +static int diseqc_send_msg(int fd, fe_sec_voltage_t v, struct diseqc_cmd *cmd, + fe_sec_tone_mode_t t, fe_sec_mini_cmd_t b) +{ + if(ioctl(fd, FE_SET_TONE, SEC_TONE_OFF) == -1) + return -1; + if(ioctl(fd, FE_SET_VOLTAGE, v) == -1) + return -1; + usleep(15 * 1000); + if(ioctl(fd, FE_DISEQC_SEND_MASTER_CMD, &cmd->cmd) == -1) + return -1; + usleep(cmd->wait * 1000); + usleep(15 * 1000); + if(ioctl(fd, FE_DISEQC_SEND_BURST, b) == -1) + return -1; + usleep(15 * 1000); + if(ioctl(fd, FE_SET_TONE, t) == -1) + return -1; + + return 0; +} + +/* digital satellite equipment control, + * specification is available from http://www.eutelsat.com/ + */ +static int do_diseqc(int secfd, int sat_no, int polv, int hi_lo) +{ + struct diseqc_cmd cmd = { {{0xe0, 0x10, 0x38, 0xf0, 0x00, 0x00}, 4}, 0 }; + + /* param: high nibble: reset bits, low nibble set bits, + * bits are: option, position, polarizaion, band + */ + cmd.cmd.msg[3] = + 0xf0 | (((sat_no * 4) & 0x0f) | (hi_lo ? 1 : 0) | (polv ? 0 : 2)); + + return diseqc_send_msg(secfd, polv ? SEC_VOLTAGE_13 : SEC_VOLTAGE_18, + &cmd, hi_lo ? SEC_TONE_ON : SEC_TONE_OFF, + (sat_no / 4) % 2 ? SEC_MINI_B : SEC_MINI_A); +} + +#else + +static int do_diseqc(int secfd, int sat_no, int polv, int hi_lo) +{ + struct secCommand scmd; + struct secCmdSequence scmds; + + scmds.continuousTone = (hi_lo ? SEC_TONE_ON : SEC_TONE_OFF); + scmds.voltage = (polv ? SEC_VOLTAGE_13 : SEC_VOLTAGE_18); + scmds.miniCommand = SEC_MINI_NONE; + + scmd.type = SEC_CMDTYPE_DISEQC; + scmds.numCommands = 1; + scmds.commands = &scmd; + + scmd.u.diseqc.addr = 0x10; + scmd.u.diseqc.cmd = 0x38; + scmd.u.diseqc.numParams = 1; + scmd.u.diseqc.params[0] = 0xf0 | + (((sat_no) << 2) & 0x0F) | + (hi_lo ? 1 : 0) | + (polv ? 0 : 2); + + if (ioctl(secfd,SEC_SEND_SEQUENCE,&scmds) < 0) + { + mp_msg(MSGT_DEMUX, MSGL_ERR, "Error sending DisEqC"); + return -1; + } + + return 0; +} +#endif + +static int tune_it(int fd_frontend, int fd_sec, unsigned int freq, unsigned int srate, char pol, int tone, + fe_spectral_inversion_t specInv, unsigned int diseqc, fe_modulation_t modulation, fe_code_rate_t HP_CodeRate, + fe_transmit_mode_t TransmissionMode, fe_guard_interval_t guardInterval, fe_bandwidth_t bandwidth, + fe_code_rate_t LP_CodeRate, fe_hierarchy_t hier, int timeout) +{ + int res, hi_lo, dfd; +#ifdef HAVE_DVB_HEAD + struct dvb_frontend_parameters feparams; + struct dvb_frontend_info fe_info; +#else + FrontendParameters feparams; + FrontendInfo fe_info; + struct secStatus sec_state; +#endif + + + mp_msg(MSGT_DEMUX, MSGL_V, "TUNE_IT, fd_frontend %d, fd_sec %d\nfreq %lu, srate %lu, pol %c, tone %i, specInv, diseqc %u, fe_modulation_t modulation,fe_code_rate_t HP_CodeRate, fe_transmit_mode_t TransmissionMode,fe_guard_interval_t guardInterval, fe_bandwidth_t bandwidth\n", + fd_frontend, fd_sec, (long unsigned int)freq, (long unsigned int)srate, pol, tone, diseqc); + + + if ( (res = ioctl(fd_frontend,FE_GET_INFO, &fe_info) < 0)) + { + mp_msg(MSGT_DEMUX, MSGL_FATAL, "FE_GET_INFO FAILED\n"); + return -1; + } + + +#ifdef HAVE_DVB_HEAD + mp_msg(MSGT_DEMUX, MSGL_V, "Using DVB card \"%s\"\n", fe_info.name); +#endif + + switch(fe_info.type) + { + case FE_OFDM: +#ifdef HAVE_DVB_HEAD + if (freq < 1000000) freq*=1000UL; + feparams.frequency=freq; + feparams.inversion=specInv; + feparams.u.ofdm.bandwidth=bandwidth; + feparams.u.ofdm.code_rate_HP=HP_CodeRate; + feparams.u.ofdm.code_rate_LP=LP_CodeRate; + feparams.u.ofdm.constellation=modulation; + feparams.u.ofdm.transmission_mode=TransmissionMode; + feparams.u.ofdm.guard_interval=guardInterval; + feparams.u.ofdm.hierarchy_information=hier; +#else + if (freq < 1000000) freq*=1000UL; + feparams.Frequency=freq; + feparams.Inversion=specInv; + feparams.u.ofdm.bandWidth=bandwidth; + feparams.u.ofdm.HP_CodeRate=HP_CodeRate; + feparams.u.ofdm.LP_CodeRate=LP_CodeRate; + feparams.u.ofdm.Constellation=modulation; + feparams.u.ofdm.TransmissionMode=TransmissionMode; + feparams.u.ofdm.guardInterval=guardInterval; + feparams.u.ofdm.HierarchyInformation=hier; +#endif + mp_msg(MSGT_DEMUX, MSGL_V, "tuning DVB-T to %d Hz, bandwidth: %d\n",freq, bandwidth); + break; + case FE_QPSK: + if (freq > 2200000) + { + // this must be an absolute frequency + if (freq < SLOF) + { +#ifdef HAVE_DVB_HEAD + freq = feparams.frequency=(freq-LOF1); +#else + freq = feparams.Frequency=(freq-LOF1); +#endif + hi_lo = 0; + } + else + { +#ifdef HAVE_DVB_HEAD + freq = feparams.frequency=(freq-LOF2); +#else + freq = feparams.Frequency=(freq-LOF2); +#endif + hi_lo = 1; + } + } + else + { + // this is an L-Band frequency +#ifdef HAVE_DVB_HEAD + feparams.frequency=freq; +#else + feparams.Frequency=freq; +#endif + } + +#ifdef HAVE_DVB_HEAD + feparams.inversion=specInv; + feparams.u.qpsk.symbol_rate=srate; + feparams.u.qpsk.fec_inner=HP_CodeRate; + dfd = fd_frontend; +#else + feparams.Inversion=specInv; + feparams.u.qpsk.SymbolRate=srate; + feparams.u.qpsk.FEC_inner=HP_CodeRate; + dfd = fd_sec; +#endif + + mp_msg(MSGT_DEMUX, MSGL_V, "tuning DVB-S to Freq: %u, Pol: %c Srate: %d, 22kHz: %s, LNB: %d\n",freq,pol,srate,hi_lo ? "on" : "off", diseqc); + + if(do_diseqc(dfd, diseqc, (pol == 'V' ? 1 : 0), hi_lo) == 0) + mp_msg(MSGT_DEMUX, MSGL_V, "DISEQC SETTING SUCCEDED\n"); + else + { + mp_msg(MSGT_DEMUX, MSGL_ERR, "DISEQC SETTING FAILED\n"); + return -1; + } + break; + case FE_QAM: + mp_msg(MSGT_DEMUX, MSGL_V, "tuning DVB-C to %d, srate=%d\n",freq,srate); +#ifdef HAVE_DVB_HEAD + feparams.frequency=freq; + feparams.inversion=specInv; + feparams.u.qam.symbol_rate = srate; + feparams.u.qam.fec_inner = HP_CodeRate; + feparams.u.qam.modulation = modulation; +#else + feparams.Frequency=freq; + feparams.Inversion=specInv; + feparams.u.qam.SymbolRate = srate; + feparams.u.qam.FEC_inner = HP_CodeRate; + feparams.u.qam.QAM = modulation; +#endif + break; +#ifdef DVB_ATSC + case FE_ATSC: + mp_msg(MSGT_DEMUX, MSGL_V, "tuning ATSC to %d, modulation=%d\n",freq,modulation); + feparams.frequency=freq; + feparams.u.vsb.modulation = modulation; + break; +#endif + default: + mp_msg(MSGT_DEMUX, MSGL_V, "Unknown FE type. Aborting\n"); + return 0; + } + usleep(100000); + +#ifndef HAVE_DVB_HEAD + if (fd_sec) SecGetStatus(fd_sec, &sec_state); +#endif + + return(check_status(fd_frontend,&feparams,fe_info.type, (hi_lo ? LOF2 : LOF1), timeout)); +}