255 lines
5.3 KiB
C
255 lines
5.3 KiB
C
![]() |
/*
|
||
|
Driver for ST STB6000 DVBS Silicon tuner
|
||
|
|
||
|
Copyright (C) 2008 Igor M. Liplianin (liplianin@me.by)
|
||
|
|
||
|
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., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||
|
|
||
|
*/
|
||
|
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/dvb/frontend.h>
|
||
|
#include <asm/types.h>
|
||
|
|
||
|
#include "stb6000.h"
|
||
|
|
||
|
static int debug;
|
||
|
#define dprintk(args...) \
|
||
|
do { \
|
||
|
if (debug) \
|
||
|
printk(KERN_DEBUG "stb6000: " args); \
|
||
|
} while (0)
|
||
|
|
||
|
struct stb6000_priv {
|
||
|
/* i2c details */
|
||
|
int i2c_address;
|
||
|
struct i2c_adapter *i2c;
|
||
|
u32 frequency;
|
||
|
};
|
||
|
|
||
|
static int stb6000_release(struct dvb_frontend *fe)
|
||
|
{
|
||
|
kfree(fe->tuner_priv);
|
||
|
fe->tuner_priv = NULL;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int stb6000_sleep(struct dvb_frontend *fe)
|
||
|
{
|
||
|
struct stb6000_priv *priv = fe->tuner_priv;
|
||
|
int ret;
|
||
|
u8 buf[] = { 10, 0 };
|
||
|
struct i2c_msg msg = {
|
||
|
.addr = priv->i2c_address,
|
||
|
.flags = 0,
|
||
|
.buf = buf,
|
||
|
.len = 2
|
||
|
};
|
||
|
|
||
|
dprintk("%s:\n", __func__);
|
||
|
|
||
|
if (fe->ops.i2c_gate_ctrl)
|
||
|
fe->ops.i2c_gate_ctrl(fe, 1);
|
||
|
|
||
|
ret = i2c_transfer(priv->i2c, &msg, 1);
|
||
|
if (ret != 1)
|
||
|
dprintk("%s: i2c error\n", __func__);
|
||
|
|
||
|
if (fe->ops.i2c_gate_ctrl)
|
||
|
fe->ops.i2c_gate_ctrl(fe, 0);
|
||
|
|
||
|
return (ret == 1) ? 0 : ret;
|
||
|
}
|
||
|
|
||
|
static int stb6000_set_params(struct dvb_frontend *fe,
|
||
|
struct dvb_frontend_parameters *params)
|
||
|
{
|
||
|
struct stb6000_priv *priv = fe->tuner_priv;
|
||
|
unsigned int n, m;
|
||
|
int ret;
|
||
|
u32 freq_mhz;
|
||
|
int bandwidth;
|
||
|
u8 buf[12];
|
||
|
struct i2c_msg msg = {
|
||
|
.addr = priv->i2c_address,
|
||
|
.flags = 0,
|
||
|
.buf = buf,
|
||
|
.len = 12
|
||
|
};
|
||
|
|
||
|
dprintk("%s:\n", __func__);
|
||
|
|
||
|
freq_mhz = params->frequency / 1000;
|
||
|
bandwidth = params->u.qpsk.symbol_rate / 1000000;
|
||
|
|
||
|
if (bandwidth > 31)
|
||
|
bandwidth = 31;
|
||
|
|
||
|
if ((freq_mhz > 949) && (freq_mhz < 2151)) {
|
||
|
buf[0] = 0x01;
|
||
|
buf[1] = 0xac;
|
||
|
if (freq_mhz < 1950)
|
||
|
buf[1] = 0xaa;
|
||
|
if (freq_mhz < 1800)
|
||
|
buf[1] = 0xa8;
|
||
|
if (freq_mhz < 1650)
|
||
|
buf[1] = 0xa6;
|
||
|
if (freq_mhz < 1530)
|
||
|
buf[1] = 0xa5;
|
||
|
if (freq_mhz < 1470)
|
||
|
buf[1] = 0xa4;
|
||
|
if (freq_mhz < 1370)
|
||
|
buf[1] = 0xa2;
|
||
|
if (freq_mhz < 1300)
|
||
|
buf[1] = 0xa1;
|
||
|
if (freq_mhz < 1200)
|
||
|
buf[1] = 0xa0;
|
||
|
if (freq_mhz < 1075)
|
||
|
buf[1] = 0xbc;
|
||
|
if (freq_mhz < 1000)
|
||
|
buf[1] = 0xba;
|
||
|
if (freq_mhz < 1075) {
|
||
|
n = freq_mhz / 8; /* vco=lo*4 */
|
||
|
m = 2;
|
||
|
} else {
|
||
|
n = freq_mhz / 16; /* vco=lo*2 */
|
||
|
m = 1;
|
||
|
}
|
||
|
buf[2] = n >> 1;
|
||
|
buf[3] = (unsigned char)(((n & 1) << 7) |
|
||
|
(m * freq_mhz - n * 16) | 0x60);
|
||
|
buf[4] = 0x04;
|
||
|
buf[5] = 0x0e;
|
||
|
|
||
|
buf[6] = (unsigned char)(bandwidth);
|
||
|
|
||
|
buf[7] = 0xd8;
|
||
|
buf[8] = 0xd0;
|
||
|
buf[9] = 0x50;
|
||
|
buf[10] = 0xeb;
|
||
|
buf[11] = 0x4f;
|
||
|
|
||
|
if (fe->ops.i2c_gate_ctrl)
|
||
|
fe->ops.i2c_gate_ctrl(fe, 1);
|
||
|
|
||
|
ret = i2c_transfer(priv->i2c, &msg, 1);
|
||
|
if (ret != 1)
|
||
|
dprintk("%s: i2c error\n", __func__);
|
||
|
|
||
|
udelay(10);
|
||
|
if (fe->ops.i2c_gate_ctrl)
|
||
|
fe->ops.i2c_gate_ctrl(fe, 0);
|
||
|
|
||
|
buf[0] = 0x07;
|
||
|
buf[1] = 0xdf;
|
||
|
buf[2] = 0xd0;
|
||
|
buf[3] = 0x50;
|
||
|
buf[4] = 0xfb;
|
||
|
msg.len = 5;
|
||
|
|
||
|
if (fe->ops.i2c_gate_ctrl)
|
||
|
fe->ops.i2c_gate_ctrl(fe, 1);
|
||
|
|
||
|
ret = i2c_transfer(priv->i2c, &msg, 1);
|
||
|
if (ret != 1)
|
||
|
dprintk("%s: i2c error\n", __func__);
|
||
|
|
||
|
udelay(10);
|
||
|
if (fe->ops.i2c_gate_ctrl)
|
||
|
fe->ops.i2c_gate_ctrl(fe, 0);
|
||
|
|
||
|
priv->frequency = freq_mhz * 1000;
|
||
|
|
||
|
return (ret == 1) ? 0 : ret;
|
||
|
}
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
static int stb6000_get_frequency(struct dvb_frontend *fe, u32 *frequency)
|
||
|
{
|
||
|
struct stb6000_priv *priv = fe->tuner_priv;
|
||
|
*frequency = priv->frequency;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static struct dvb_tuner_ops stb6000_tuner_ops = {
|
||
|
.info = {
|
||
|
.name = "ST STB6000",
|
||
|
.frequency_min = 950000,
|
||
|
.frequency_max = 2150000
|
||
|
},
|
||
|
.release = stb6000_release,
|
||
|
.sleep = stb6000_sleep,
|
||
|
.set_params = stb6000_set_params,
|
||
|
.get_frequency = stb6000_get_frequency,
|
||
|
};
|
||
|
|
||
|
struct dvb_frontend *stb6000_attach(struct dvb_frontend *fe, int addr,
|
||
|
struct i2c_adapter *i2c)
|
||
|
{
|
||
|
struct stb6000_priv *priv = NULL;
|
||
|
u8 b1[] = { 0, 0 };
|
||
|
struct i2c_msg msg[2] = {
|
||
|
{
|
||
|
.addr = addr,
|
||
|
.flags = 0,
|
||
|
.buf = NULL,
|
||
|
.len = 0
|
||
|
}, {
|
||
|
.addr = addr,
|
||
|
.flags = I2C_M_RD,
|
||
|
.buf = b1,
|
||
|
.len = 2
|
||
|
}
|
||
|
};
|
||
|
int ret;
|
||
|
|
||
|
dprintk("%s:\n", __func__);
|
||
|
|
||
|
if (fe->ops.i2c_gate_ctrl)
|
||
|
fe->ops.i2c_gate_ctrl(fe, 1);
|
||
|
|
||
|
/* is some i2c device here ? */
|
||
|
ret = i2c_transfer(i2c, msg, 2);
|
||
|
if (fe->ops.i2c_gate_ctrl)
|
||
|
fe->ops.i2c_gate_ctrl(fe, 0);
|
||
|
|
||
|
if (ret != 2)
|
||
|
return NULL;
|
||
|
|
||
|
priv = kzalloc(sizeof(struct stb6000_priv), GFP_KERNEL);
|
||
|
if (priv == NULL)
|
||
|
return NULL;
|
||
|
|
||
|
priv->i2c_address = addr;
|
||
|
priv->i2c = i2c;
|
||
|
|
||
|
memcpy(&fe->ops.tuner_ops, &stb6000_tuner_ops,
|
||
|
sizeof(struct dvb_tuner_ops));
|
||
|
|
||
|
fe->tuner_priv = priv;
|
||
|
|
||
|
return fe;
|
||
|
}
|
||
|
EXPORT_SYMBOL(stb6000_attach);
|
||
|
|
||
|
module_param(debug, int, 0644);
|
||
|
MODULE_PARM_DESC(debug, "Turn on/off frontend debugging (default:off).");
|
||
|
|
||
|
MODULE_DESCRIPTION("DVB STB6000 driver");
|
||
|
MODULE_AUTHOR("Igor M. Liplianin <liplianin@me.by>");
|
||
|
MODULE_LICENSE("GPL");
|