ddc11db26c
The original logic had an integer to unsigned integer conversion, plus a float-point math. While gcc should be able to do the match at compile time, other compilers might not do the same. Also, those produce the following warnings with static code analyzers: drivers/media/dvb-frontends/tda10086.c:300 tda10086_set_symbol_rate() warn: unsigned 'symbol_rate' is never less than zero. drivers/media/dvb-frontends/tda10086.c:303 tda10086_set_symbol_rate() warn: unsigned 'symbol_rate' is never less than zero. drivers/media/dvb-frontends/tda10086.c:306 tda10086_set_symbol_rate() warn: unsigned 'symbol_rate' is never less than zero. drivers/media/dvb-frontends/tda10086.c:309 tda10086_set_symbol_rate() warn: unsigned 'symbol_rate' is never less than zero. drivers/media/dvb-frontends/tda10086.c:312 tda10086_set_symbol_rate() warn: unsigned 'symbol_rate' is never less than zero. drivers/media/dvb-frontends/tda10086.c:315 tda10086_set_symbol_rate() warn: unsigned 'symbol_rate' is never less than zero. drivers/media/dvb-frontends/tda10086.c:318 tda10086_set_symbol_rate() warn: unsigned 'symbol_rate' is never less than zero. drivers/media/dvb-frontends/tda10086.c:321 tda10086_set_symbol_rate() warn: unsigned 'symbol_rate' is never less than zero. drivers/media/dvb-frontends/tda10086.c:324 tda10086_set_symbol_rate() warn: unsigned 'symbol_rate' is never less than zero. drivers/media/dvb-frontends/tda10086.c:327 tda10086_set_symbol_rate() warn: unsigned 'symbol_rate' is never less than zero. Change the logic to declare the reference constant as unsigned and to not use float point math. Signed-off-by: Mauro Carvalho Chehab <mchehab+huawei@kernel.org>
768 lines
18 KiB
C
768 lines
18 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
Driver for Philips tda10086 DVBS Demodulator
|
|
|
|
(c) 2006 Andrew de Quincey
|
|
|
|
|
|
*/
|
|
|
|
#include <linux/init.h>
|
|
#include <linux/module.h>
|
|
#include <linux/device.h>
|
|
#include <linux/jiffies.h>
|
|
#include <linux/string.h>
|
|
#include <linux/slab.h>
|
|
|
|
#include <media/dvb_frontend.h>
|
|
#include "tda10086.h"
|
|
|
|
#define SACLK 96000000U
|
|
|
|
struct tda10086_state {
|
|
struct i2c_adapter* i2c;
|
|
const struct tda10086_config* config;
|
|
struct dvb_frontend frontend;
|
|
|
|
/* private demod data */
|
|
u32 frequency;
|
|
u32 symbol_rate;
|
|
bool has_lock;
|
|
};
|
|
|
|
static int debug;
|
|
#define dprintk(args...) \
|
|
do { \
|
|
if (debug) printk(KERN_DEBUG "tda10086: " args); \
|
|
} while (0)
|
|
|
|
static int tda10086_write_byte(struct tda10086_state *state, int reg, int data)
|
|
{
|
|
int ret;
|
|
u8 b0[] = { reg, data };
|
|
struct i2c_msg msg = { .flags = 0, .buf = b0, .len = 2 };
|
|
|
|
msg.addr = state->config->demod_address;
|
|
ret = i2c_transfer(state->i2c, &msg, 1);
|
|
|
|
if (ret != 1)
|
|
dprintk("%s: error reg=0x%x, data=0x%x, ret=%i\n",
|
|
__func__, reg, data, ret);
|
|
|
|
return (ret != 1) ? ret : 0;
|
|
}
|
|
|
|
static int tda10086_read_byte(struct tda10086_state *state, int reg)
|
|
{
|
|
int ret;
|
|
u8 b0[] = { reg };
|
|
u8 b1[] = { 0 };
|
|
struct i2c_msg msg[] = {{ .flags = 0, .buf = b0, .len = 1 },
|
|
{ .flags = I2C_M_RD, .buf = b1, .len = 1 }};
|
|
|
|
msg[0].addr = state->config->demod_address;
|
|
msg[1].addr = state->config->demod_address;
|
|
ret = i2c_transfer(state->i2c, msg, 2);
|
|
|
|
if (ret != 2) {
|
|
dprintk("%s: error reg=0x%x, ret=%i\n", __func__, reg,
|
|
ret);
|
|
return ret;
|
|
}
|
|
|
|
return b1[0];
|
|
}
|
|
|
|
static int tda10086_write_mask(struct tda10086_state *state, int reg, int mask, int data)
|
|
{
|
|
int val;
|
|
|
|
/* read a byte and check */
|
|
val = tda10086_read_byte(state, reg);
|
|
if (val < 0)
|
|
return val;
|
|
|
|
/* mask if off */
|
|
val = val & ~mask;
|
|
val |= data & 0xff;
|
|
|
|
/* write it out again */
|
|
return tda10086_write_byte(state, reg, val);
|
|
}
|
|
|
|
static int tda10086_init(struct dvb_frontend* fe)
|
|
{
|
|
struct tda10086_state* state = fe->demodulator_priv;
|
|
u8 t22k_off = 0x80;
|
|
|
|
dprintk ("%s\n", __func__);
|
|
|
|
if (state->config->diseqc_tone)
|
|
t22k_off = 0;
|
|
/* reset */
|
|
tda10086_write_byte(state, 0x00, 0x00);
|
|
msleep(10);
|
|
|
|
/* misc setup */
|
|
tda10086_write_byte(state, 0x01, 0x94);
|
|
tda10086_write_byte(state, 0x02, 0x35); /* NOTE: TT drivers appear to disable CSWP */
|
|
tda10086_write_byte(state, 0x03, 0xe4);
|
|
tda10086_write_byte(state, 0x04, 0x43);
|
|
tda10086_write_byte(state, 0x0c, 0x0c);
|
|
tda10086_write_byte(state, 0x1b, 0xb0); /* noise threshold */
|
|
tda10086_write_byte(state, 0x20, 0x89); /* misc */
|
|
tda10086_write_byte(state, 0x30, 0x04); /* acquisition period length */
|
|
tda10086_write_byte(state, 0x32, 0x00); /* irq off */
|
|
tda10086_write_byte(state, 0x31, 0x56); /* setup AFC */
|
|
|
|
/* setup PLL (this assumes SACLK = 96MHz) */
|
|
tda10086_write_byte(state, 0x55, 0x2c); /* misc PLL setup */
|
|
if (state->config->xtal_freq == TDA10086_XTAL_16M) {
|
|
tda10086_write_byte(state, 0x3a, 0x0b); /* M=12 */
|
|
tda10086_write_byte(state, 0x3b, 0x01); /* P=2 */
|
|
} else {
|
|
tda10086_write_byte(state, 0x3a, 0x17); /* M=24 */
|
|
tda10086_write_byte(state, 0x3b, 0x00); /* P=1 */
|
|
}
|
|
tda10086_write_mask(state, 0x55, 0x20, 0x00); /* powerup PLL */
|
|
|
|
/* setup TS interface */
|
|
tda10086_write_byte(state, 0x11, 0x81);
|
|
tda10086_write_byte(state, 0x12, 0x81);
|
|
tda10086_write_byte(state, 0x19, 0x40); /* parallel mode A + MSBFIRST */
|
|
tda10086_write_byte(state, 0x56, 0x80); /* powerdown WPLL - unused in the mode we use */
|
|
tda10086_write_byte(state, 0x57, 0x08); /* bypass WPLL - unused in the mode we use */
|
|
tda10086_write_byte(state, 0x10, 0x2a);
|
|
|
|
/* setup ADC */
|
|
tda10086_write_byte(state, 0x58, 0x61); /* ADC setup */
|
|
tda10086_write_mask(state, 0x58, 0x01, 0x00); /* powerup ADC */
|
|
|
|
/* setup AGC */
|
|
tda10086_write_byte(state, 0x05, 0x0B);
|
|
tda10086_write_byte(state, 0x37, 0x63);
|
|
tda10086_write_byte(state, 0x3f, 0x0a); /* NOTE: flydvb varies it */
|
|
tda10086_write_byte(state, 0x40, 0x64);
|
|
tda10086_write_byte(state, 0x41, 0x4f);
|
|
tda10086_write_byte(state, 0x42, 0x43);
|
|
|
|
/* setup viterbi */
|
|
tda10086_write_byte(state, 0x1a, 0x11); /* VBER 10^6, DVB, QPSK */
|
|
|
|
/* setup carrier recovery */
|
|
tda10086_write_byte(state, 0x3d, 0x80);
|
|
|
|
/* setup SEC */
|
|
tda10086_write_byte(state, 0x36, t22k_off); /* all SEC off, 22k tone */
|
|
tda10086_write_byte(state, 0x34, (((1<<19) * (22000/1000)) / (SACLK/1000)));
|
|
tda10086_write_byte(state, 0x35, (((1<<19) * (22000/1000)) / (SACLK/1000)) >> 8);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void tda10086_diseqc_wait(struct tda10086_state *state)
|
|
{
|
|
unsigned long timeout = jiffies + msecs_to_jiffies(200);
|
|
while (!(tda10086_read_byte(state, 0x50) & 0x01)) {
|
|
if(time_after(jiffies, timeout)) {
|
|
printk("%s: diseqc queue not ready, command may be lost.\n", __func__);
|
|
break;
|
|
}
|
|
msleep(10);
|
|
}
|
|
}
|
|
|
|
static int tda10086_set_tone(struct dvb_frontend *fe,
|
|
enum fe_sec_tone_mode tone)
|
|
{
|
|
struct tda10086_state* state = fe->demodulator_priv;
|
|
u8 t22k_off = 0x80;
|
|
|
|
dprintk ("%s\n", __func__);
|
|
|
|
if (state->config->diseqc_tone)
|
|
t22k_off = 0;
|
|
|
|
switch (tone) {
|
|
case SEC_TONE_OFF:
|
|
tda10086_write_byte(state, 0x36, t22k_off);
|
|
break;
|
|
|
|
case SEC_TONE_ON:
|
|
tda10086_write_byte(state, 0x36, 0x01 + t22k_off);
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tda10086_send_master_cmd (struct dvb_frontend* fe,
|
|
struct dvb_diseqc_master_cmd* cmd)
|
|
{
|
|
struct tda10086_state* state = fe->demodulator_priv;
|
|
int i;
|
|
u8 oldval;
|
|
u8 t22k_off = 0x80;
|
|
|
|
dprintk ("%s\n", __func__);
|
|
|
|
if (state->config->diseqc_tone)
|
|
t22k_off = 0;
|
|
|
|
if (cmd->msg_len > 6)
|
|
return -EINVAL;
|
|
oldval = tda10086_read_byte(state, 0x36);
|
|
|
|
for(i=0; i< cmd->msg_len; i++) {
|
|
tda10086_write_byte(state, 0x48+i, cmd->msg[i]);
|
|
}
|
|
tda10086_write_byte(state, 0x36, (0x08 + t22k_off)
|
|
| ((cmd->msg_len - 1) << 4));
|
|
|
|
tda10086_diseqc_wait(state);
|
|
|
|
tda10086_write_byte(state, 0x36, oldval);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tda10086_send_burst(struct dvb_frontend *fe,
|
|
enum fe_sec_mini_cmd minicmd)
|
|
{
|
|
struct tda10086_state* state = fe->demodulator_priv;
|
|
u8 oldval = tda10086_read_byte(state, 0x36);
|
|
u8 t22k_off = 0x80;
|
|
|
|
dprintk ("%s\n", __func__);
|
|
|
|
if (state->config->diseqc_tone)
|
|
t22k_off = 0;
|
|
|
|
switch(minicmd) {
|
|
case SEC_MINI_A:
|
|
tda10086_write_byte(state, 0x36, 0x04 + t22k_off);
|
|
break;
|
|
|
|
case SEC_MINI_B:
|
|
tda10086_write_byte(state, 0x36, 0x06 + t22k_off);
|
|
break;
|
|
}
|
|
|
|
tda10086_diseqc_wait(state);
|
|
|
|
tda10086_write_byte(state, 0x36, oldval);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tda10086_set_inversion(struct tda10086_state *state,
|
|
struct dtv_frontend_properties *fe_params)
|
|
{
|
|
u8 invval = 0x80;
|
|
|
|
dprintk ("%s %i %i\n", __func__, fe_params->inversion, state->config->invert);
|
|
|
|
switch(fe_params->inversion) {
|
|
case INVERSION_OFF:
|
|
if (state->config->invert)
|
|
invval = 0x40;
|
|
break;
|
|
case INVERSION_ON:
|
|
if (!state->config->invert)
|
|
invval = 0x40;
|
|
break;
|
|
case INVERSION_AUTO:
|
|
invval = 0x00;
|
|
break;
|
|
}
|
|
tda10086_write_mask(state, 0x0c, 0xc0, invval);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tda10086_set_symbol_rate(struct tda10086_state *state,
|
|
struct dtv_frontend_properties *fe_params)
|
|
{
|
|
u8 dfn = 0;
|
|
u8 afs = 0;
|
|
u8 byp = 0;
|
|
u8 reg37 = 0x43;
|
|
u8 reg42 = 0x43;
|
|
u64 big;
|
|
u32 tmp;
|
|
u32 bdr;
|
|
u32 bdri;
|
|
u32 symbol_rate = fe_params->symbol_rate;
|
|
|
|
dprintk ("%s %i\n", __func__, symbol_rate);
|
|
|
|
/* setup the decimation and anti-aliasing filters.. */
|
|
if (symbol_rate < SACLK / 10000 * 137) {
|
|
dfn=4;
|
|
afs=1;
|
|
} else if (symbol_rate < SACLK / 10000 * 208) {
|
|
dfn=4;
|
|
afs=0;
|
|
} else if (symbol_rate < SACLK / 10000 * 270) {
|
|
dfn=3;
|
|
afs=1;
|
|
} else if (symbol_rate < SACLK / 10000 * 416) {
|
|
dfn=3;
|
|
afs=0;
|
|
} else if (symbol_rate < SACLK / 10000 * 550) {
|
|
dfn=2;
|
|
afs=1;
|
|
} else if (symbol_rate < SACLK / 10000 * 833) {
|
|
dfn=2;
|
|
afs=0;
|
|
} else if (symbol_rate < SACLK / 10000 * 1100) {
|
|
dfn=1;
|
|
afs=1;
|
|
} else if (symbol_rate < SACLK / 10000 * 1666) {
|
|
dfn=1;
|
|
afs=0;
|
|
} else if (symbol_rate < SACLK / 10000 * 2200) {
|
|
dfn=0;
|
|
afs=1;
|
|
} else if (symbol_rate < SACLK / 10000 * 3333) {
|
|
dfn=0;
|
|
afs=0;
|
|
} else {
|
|
reg37 = 0x63;
|
|
reg42 = 0x4f;
|
|
byp=1;
|
|
}
|
|
|
|
/* calculate BDR */
|
|
big = (1ULL<<21) * ((u64) symbol_rate/1000ULL) * (1ULL<<dfn);
|
|
big += ((SACLK/1000ULL)-1ULL);
|
|
do_div(big, (SACLK/1000ULL));
|
|
bdr = big & 0xfffff;
|
|
|
|
/* calculate BDRI */
|
|
tmp = (1<<dfn)*(symbol_rate/1000);
|
|
bdri = ((32 * (SACLK/1000)) + (tmp-1)) / tmp;
|
|
|
|
tda10086_write_byte(state, 0x21, (afs << 7) | dfn);
|
|
tda10086_write_mask(state, 0x20, 0x08, byp << 3);
|
|
tda10086_write_byte(state, 0x06, bdr);
|
|
tda10086_write_byte(state, 0x07, bdr >> 8);
|
|
tda10086_write_byte(state, 0x08, bdr >> 16);
|
|
tda10086_write_byte(state, 0x09, bdri);
|
|
tda10086_write_byte(state, 0x37, reg37);
|
|
tda10086_write_byte(state, 0x42, reg42);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tda10086_set_fec(struct tda10086_state *state,
|
|
struct dtv_frontend_properties *fe_params)
|
|
{
|
|
u8 fecval;
|
|
|
|
dprintk("%s %i\n", __func__, fe_params->fec_inner);
|
|
|
|
switch (fe_params->fec_inner) {
|
|
case FEC_1_2:
|
|
fecval = 0x00;
|
|
break;
|
|
case FEC_2_3:
|
|
fecval = 0x01;
|
|
break;
|
|
case FEC_3_4:
|
|
fecval = 0x02;
|
|
break;
|
|
case FEC_4_5:
|
|
fecval = 0x03;
|
|
break;
|
|
case FEC_5_6:
|
|
fecval = 0x04;
|
|
break;
|
|
case FEC_6_7:
|
|
fecval = 0x05;
|
|
break;
|
|
case FEC_7_8:
|
|
fecval = 0x06;
|
|
break;
|
|
case FEC_8_9:
|
|
fecval = 0x07;
|
|
break;
|
|
case FEC_AUTO:
|
|
fecval = 0x08;
|
|
break;
|
|
default:
|
|
return -1;
|
|
}
|
|
tda10086_write_byte(state, 0x0d, fecval);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tda10086_set_frontend(struct dvb_frontend *fe)
|
|
{
|
|
struct dtv_frontend_properties *fe_params = &fe->dtv_property_cache;
|
|
struct tda10086_state *state = fe->demodulator_priv;
|
|
int ret;
|
|
u32 freq = 0;
|
|
int freqoff;
|
|
|
|
dprintk ("%s\n", __func__);
|
|
|
|
/* modify parameters for tuning */
|
|
tda10086_write_byte(state, 0x02, 0x35);
|
|
state->has_lock = false;
|
|
|
|
/* set params */
|
|
if (fe->ops.tuner_ops.set_params) {
|
|
fe->ops.tuner_ops.set_params(fe);
|
|
if (fe->ops.i2c_gate_ctrl)
|
|
fe->ops.i2c_gate_ctrl(fe, 0);
|
|
|
|
if (fe->ops.tuner_ops.get_frequency)
|
|
fe->ops.tuner_ops.get_frequency(fe, &freq);
|
|
if (fe->ops.i2c_gate_ctrl)
|
|
fe->ops.i2c_gate_ctrl(fe, 0);
|
|
}
|
|
|
|
/* calculate the frequency offset (in *Hz* not kHz) */
|
|
freqoff = fe_params->frequency - freq;
|
|
freqoff = ((1<<16) * freqoff) / (SACLK/1000);
|
|
tda10086_write_byte(state, 0x3d, 0x80 | ((freqoff >> 8) & 0x7f));
|
|
tda10086_write_byte(state, 0x3e, freqoff);
|
|
|
|
if ((ret = tda10086_set_inversion(state, fe_params)) < 0)
|
|
return ret;
|
|
if ((ret = tda10086_set_symbol_rate(state, fe_params)) < 0)
|
|
return ret;
|
|
if ((ret = tda10086_set_fec(state, fe_params)) < 0)
|
|
return ret;
|
|
|
|
/* soft reset + disable TS output until lock */
|
|
tda10086_write_mask(state, 0x10, 0x40, 0x40);
|
|
tda10086_write_mask(state, 0x00, 0x01, 0x00);
|
|
|
|
state->symbol_rate = fe_params->symbol_rate;
|
|
state->frequency = fe_params->frequency;
|
|
return 0;
|
|
}
|
|
|
|
static int tda10086_get_frontend(struct dvb_frontend *fe,
|
|
struct dtv_frontend_properties *fe_params)
|
|
{
|
|
struct tda10086_state* state = fe->demodulator_priv;
|
|
u8 val;
|
|
int tmp;
|
|
u64 tmp64;
|
|
|
|
dprintk ("%s\n", __func__);
|
|
|
|
/* check for invalid symbol rate */
|
|
if (fe_params->symbol_rate < 500000)
|
|
return -EINVAL;
|
|
|
|
/* calculate the updated frequency (note: we convert from Hz->kHz) */
|
|
tmp64 = ((u64)tda10086_read_byte(state, 0x52)
|
|
| (tda10086_read_byte(state, 0x51) << 8));
|
|
if (tmp64 & 0x8000)
|
|
tmp64 |= 0xffffffffffff0000ULL;
|
|
tmp64 = (tmp64 * (SACLK/1000ULL));
|
|
do_div(tmp64, (1ULL<<15) * (1ULL<<1));
|
|
fe_params->frequency = (int) state->frequency + (int) tmp64;
|
|
|
|
/* the inversion */
|
|
val = tda10086_read_byte(state, 0x0c);
|
|
if (val & 0x80) {
|
|
switch(val & 0x40) {
|
|
case 0x00:
|
|
fe_params->inversion = INVERSION_OFF;
|
|
if (state->config->invert)
|
|
fe_params->inversion = INVERSION_ON;
|
|
break;
|
|
default:
|
|
fe_params->inversion = INVERSION_ON;
|
|
if (state->config->invert)
|
|
fe_params->inversion = INVERSION_OFF;
|
|
break;
|
|
}
|
|
} else {
|
|
tda10086_read_byte(state, 0x0f);
|
|
switch(val & 0x02) {
|
|
case 0x00:
|
|
fe_params->inversion = INVERSION_OFF;
|
|
if (state->config->invert)
|
|
fe_params->inversion = INVERSION_ON;
|
|
break;
|
|
default:
|
|
fe_params->inversion = INVERSION_ON;
|
|
if (state->config->invert)
|
|
fe_params->inversion = INVERSION_OFF;
|
|
break;
|
|
}
|
|
}
|
|
|
|
/* calculate the updated symbol rate */
|
|
tmp = tda10086_read_byte(state, 0x1d);
|
|
if (tmp & 0x80)
|
|
tmp |= 0xffffff00;
|
|
tmp = (tmp * 480 * (1<<1)) / 128;
|
|
tmp = ((state->symbol_rate/1000) * tmp) / (1000000/1000);
|
|
fe_params->symbol_rate = state->symbol_rate + tmp;
|
|
|
|
/* the FEC */
|
|
val = (tda10086_read_byte(state, 0x0d) & 0x70) >> 4;
|
|
switch(val) {
|
|
case 0x00:
|
|
fe_params->fec_inner = FEC_1_2;
|
|
break;
|
|
case 0x01:
|
|
fe_params->fec_inner = FEC_2_3;
|
|
break;
|
|
case 0x02:
|
|
fe_params->fec_inner = FEC_3_4;
|
|
break;
|
|
case 0x03:
|
|
fe_params->fec_inner = FEC_4_5;
|
|
break;
|
|
case 0x04:
|
|
fe_params->fec_inner = FEC_5_6;
|
|
break;
|
|
case 0x05:
|
|
fe_params->fec_inner = FEC_6_7;
|
|
break;
|
|
case 0x06:
|
|
fe_params->fec_inner = FEC_7_8;
|
|
break;
|
|
case 0x07:
|
|
fe_params->fec_inner = FEC_8_9;
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tda10086_read_status(struct dvb_frontend *fe,
|
|
enum fe_status *fe_status)
|
|
{
|
|
struct tda10086_state* state = fe->demodulator_priv;
|
|
u8 val;
|
|
|
|
dprintk ("%s\n", __func__);
|
|
|
|
val = tda10086_read_byte(state, 0x0e);
|
|
*fe_status = 0;
|
|
if (val & 0x01)
|
|
*fe_status |= FE_HAS_SIGNAL;
|
|
if (val & 0x02)
|
|
*fe_status |= FE_HAS_CARRIER;
|
|
if (val & 0x04)
|
|
*fe_status |= FE_HAS_VITERBI;
|
|
if (val & 0x08)
|
|
*fe_status |= FE_HAS_SYNC;
|
|
if (val & 0x10) {
|
|
*fe_status |= FE_HAS_LOCK;
|
|
if (!state->has_lock) {
|
|
state->has_lock = true;
|
|
/* modify parameters for stable reception */
|
|
tda10086_write_byte(state, 0x02, 0x00);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tda10086_read_signal_strength(struct dvb_frontend* fe, u16 * signal)
|
|
{
|
|
struct tda10086_state* state = fe->demodulator_priv;
|
|
u8 _str;
|
|
|
|
dprintk ("%s\n", __func__);
|
|
|
|
_str = 0xff - tda10086_read_byte(state, 0x43);
|
|
*signal = (_str << 8) | _str;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tda10086_read_snr(struct dvb_frontend* fe, u16 * snr)
|
|
{
|
|
struct tda10086_state* state = fe->demodulator_priv;
|
|
u8 _snr;
|
|
|
|
dprintk ("%s\n", __func__);
|
|
|
|
_snr = 0xff - tda10086_read_byte(state, 0x1c);
|
|
*snr = (_snr << 8) | _snr;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tda10086_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks)
|
|
{
|
|
struct tda10086_state* state = fe->demodulator_priv;
|
|
|
|
dprintk ("%s\n", __func__);
|
|
|
|
/* read it */
|
|
*ucblocks = tda10086_read_byte(state, 0x18) & 0x7f;
|
|
|
|
/* reset counter */
|
|
tda10086_write_byte(state, 0x18, 0x00);
|
|
tda10086_write_byte(state, 0x18, 0x80);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tda10086_read_ber(struct dvb_frontend* fe, u32* ber)
|
|
{
|
|
struct tda10086_state* state = fe->demodulator_priv;
|
|
|
|
dprintk ("%s\n", __func__);
|
|
|
|
/* read it */
|
|
*ber = 0;
|
|
*ber |= tda10086_read_byte(state, 0x15);
|
|
*ber |= tda10086_read_byte(state, 0x16) << 8;
|
|
*ber |= (tda10086_read_byte(state, 0x17) & 0xf) << 16;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tda10086_sleep(struct dvb_frontend* fe)
|
|
{
|
|
struct tda10086_state* state = fe->demodulator_priv;
|
|
|
|
dprintk ("%s\n", __func__);
|
|
|
|
tda10086_write_mask(state, 0x00, 0x08, 0x08);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tda10086_i2c_gate_ctrl(struct dvb_frontend* fe, int enable)
|
|
{
|
|
struct tda10086_state* state = fe->demodulator_priv;
|
|
|
|
dprintk ("%s\n", __func__);
|
|
|
|
if (enable) {
|
|
tda10086_write_mask(state, 0x00, 0x10, 0x10);
|
|
} else {
|
|
tda10086_write_mask(state, 0x00, 0x10, 0x00);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tda10086_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend_tune_settings* fesettings)
|
|
{
|
|
struct dtv_frontend_properties *p = &fe->dtv_property_cache;
|
|
|
|
if (p->symbol_rate > 20000000) {
|
|
fesettings->min_delay_ms = 50;
|
|
fesettings->step_size = 2000;
|
|
fesettings->max_drift = 8000;
|
|
} else if (p->symbol_rate > 12000000) {
|
|
fesettings->min_delay_ms = 100;
|
|
fesettings->step_size = 1500;
|
|
fesettings->max_drift = 9000;
|
|
} else if (p->symbol_rate > 8000000) {
|
|
fesettings->min_delay_ms = 100;
|
|
fesettings->step_size = 1000;
|
|
fesettings->max_drift = 8000;
|
|
} else if (p->symbol_rate > 4000000) {
|
|
fesettings->min_delay_ms = 100;
|
|
fesettings->step_size = 500;
|
|
fesettings->max_drift = 7000;
|
|
} else if (p->symbol_rate > 2000000) {
|
|
fesettings->min_delay_ms = 200;
|
|
fesettings->step_size = p->symbol_rate / 8000;
|
|
fesettings->max_drift = 14 * fesettings->step_size;
|
|
} else {
|
|
fesettings->min_delay_ms = 200;
|
|
fesettings->step_size = p->symbol_rate / 8000;
|
|
fesettings->max_drift = 18 * fesettings->step_size;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void tda10086_release(struct dvb_frontend* fe)
|
|
{
|
|
struct tda10086_state *state = fe->demodulator_priv;
|
|
tda10086_sleep(fe);
|
|
kfree(state);
|
|
}
|
|
|
|
static const struct dvb_frontend_ops tda10086_ops = {
|
|
.delsys = { SYS_DVBS },
|
|
.info = {
|
|
.name = "Philips TDA10086 DVB-S",
|
|
.frequency_min_hz = 950 * MHz,
|
|
.frequency_max_hz = 2150 * MHz,
|
|
.frequency_stepsize_hz = 125 * kHz,
|
|
.symbol_rate_min = 1000000,
|
|
.symbol_rate_max = 45000000,
|
|
.caps = FE_CAN_INVERSION_AUTO |
|
|
FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
|
|
FE_CAN_FEC_5_6 | FE_CAN_FEC_6_7 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO |
|
|
FE_CAN_QPSK
|
|
},
|
|
|
|
.release = tda10086_release,
|
|
|
|
.init = tda10086_init,
|
|
.sleep = tda10086_sleep,
|
|
.i2c_gate_ctrl = tda10086_i2c_gate_ctrl,
|
|
|
|
.set_frontend = tda10086_set_frontend,
|
|
.get_frontend = tda10086_get_frontend,
|
|
.get_tune_settings = tda10086_get_tune_settings,
|
|
|
|
.read_status = tda10086_read_status,
|
|
.read_ber = tda10086_read_ber,
|
|
.read_signal_strength = tda10086_read_signal_strength,
|
|
.read_snr = tda10086_read_snr,
|
|
.read_ucblocks = tda10086_read_ucblocks,
|
|
|
|
.diseqc_send_master_cmd = tda10086_send_master_cmd,
|
|
.diseqc_send_burst = tda10086_send_burst,
|
|
.set_tone = tda10086_set_tone,
|
|
};
|
|
|
|
struct dvb_frontend* tda10086_attach(const struct tda10086_config* config,
|
|
struct i2c_adapter* i2c)
|
|
{
|
|
struct tda10086_state *state;
|
|
|
|
dprintk ("%s\n", __func__);
|
|
|
|
/* allocate memory for the internal state */
|
|
state = kzalloc(sizeof(struct tda10086_state), GFP_KERNEL);
|
|
if (!state)
|
|
return NULL;
|
|
|
|
/* setup the state */
|
|
state->config = config;
|
|
state->i2c = i2c;
|
|
|
|
/* check if the demod is there */
|
|
if (tda10086_read_byte(state, 0x1e) != 0xe1) {
|
|
kfree(state);
|
|
return NULL;
|
|
}
|
|
|
|
/* create dvb_frontend */
|
|
memcpy(&state->frontend.ops, &tda10086_ops, sizeof(struct dvb_frontend_ops));
|
|
state->frontend.demodulator_priv = state;
|
|
return &state->frontend;
|
|
}
|
|
|
|
module_param(debug, int, 0644);
|
|
MODULE_PARM_DESC(debug, "Turn on/off frontend debugging (default:off).");
|
|
|
|
MODULE_DESCRIPTION("Philips TDA10086 DVB-S Demodulator");
|
|
MODULE_AUTHOR("Andrew de Quincey");
|
|
MODULE_LICENSE("GPL");
|
|
|
|
EXPORT_SYMBOL(tda10086_attach);
|