[net-next-2.6.git] / drivers / media / dvb / dvb-usb / friio-fe.c

/* DVB USB compliant Linux driver for the Friio USB2.0 ISDB-T receiver.
 *
 * Copyright (C) 2009 Akihiro Tsukada <tskd2@yahoo.co.jp>
 *
 * This module is based off the the gl861 and vp702x modules.
 *
 * 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, version 2.
 *
 * see Documentation/dvb/README.dvb-usb for more information
 */
#include <linux/init.h>
#include <linux/string.h>
#include <linux/slab.h>

#include "friio.h"

struct jdvbt90502_state {
	struct i2c_adapter *i2c;
	struct dvb_frontend frontend;
	struct jdvbt90502_config config;
};

/* NOTE: TC90502 has 16bit register-address? */
/* register 0x0100 is used for reading PLL status, so reg is u16 here */
static int jdvbt90502_reg_read(struct jdvbt90502_state *state,
			       const u16 reg, u8 *buf, const size_t count)
{
	int ret;
	u8 wbuf[3];
	struct i2c_msg msg[2];

	wbuf[0] = reg & 0xFF;
	wbuf[1] = 0;
	wbuf[2] = reg >> 8;

	msg[0].addr = state->config.demod_address;
	msg[0].flags = 0;
	msg[0].buf = wbuf;
	msg[0].len = sizeof(wbuf);

	msg[1].addr = msg[0].addr;
	msg[1].flags = I2C_M_RD;
	msg[1].buf = buf;
	msg[1].len = count;

	ret = i2c_transfer(state->i2c, msg, 2);
	if (ret != 2) {
		deb_fe(" reg read failed.\n");
		return -EREMOTEIO;
	}
	return 0;
}

/* currently 16bit register-address is not used, so reg is u8 here */
static int jdvbt90502_single_reg_write(struct jdvbt90502_state *state,
				       const u8 reg, const u8 val)
{
	struct i2c_msg msg;
	u8 wbuf[2];

	wbuf[0] = reg;
	wbuf[1] = val;

	msg.addr = state->config.demod_address;
	msg.flags = 0;
	msg.buf = wbuf;
	msg.len = sizeof(wbuf);

	if (i2c_transfer(state->i2c, &msg, 1) != 1) {
		deb_fe(" reg write failed.");
		return -EREMOTEIO;
	}
	return 0;
}

static int _jdvbt90502_write(struct dvb_frontend *fe, const u8 buf[], int len)
{
	struct jdvbt90502_state *state = fe->demodulator_priv;
	int err, i;
	for (i = 0; i < len - 1; i++) {
		err = jdvbt90502_single_reg_write(state,
						  buf[0] + i, buf[i + 1]);
		if (err)
			return err;
	}

	return 0;
}

/* read pll status byte via the demodulator's I2C register */
/* note: Win box reads it by 8B block at the I2C addr 0x30 from reg:0x80 */
static int jdvbt90502_pll_read(struct jdvbt90502_state *state, u8 *result)
{
	int ret;

	/* +1 for reading */
	u8 pll_addr_byte = (state->config.pll_address << 1) + 1;

	*result = 0;

	ret = jdvbt90502_single_reg_write(state, JDVBT90502_2ND_I2C_REG,
					  pll_addr_byte);
	if (ret)
		goto error;

	ret = jdvbt90502_reg_read(state, 0x0100, result, 1);
	if (ret)
		goto error;

	deb_fe("PLL read val:%02x\n", *result);
	return 0;

error:
	deb_fe("%s:ret == %d\n", __func__, ret);
	return -EREMOTEIO;
}


/* set pll frequency via the demodulator's I2C register */
static int jdvbt90502_pll_set_freq(struct jdvbt90502_state *state, u32 freq)
{
	int ret;
	int retry;
	u8 res1;
	u8 res2[9];

	u8 pll_freq_cmd[PLL_CMD_LEN];
	u8 pll_agc_cmd[PLL_CMD_LEN];
	struct i2c_msg msg[2];
	u32 f;

	deb_fe("%s: freq=%d, step=%d\n", __func__, freq,
	       state->frontend.ops.info.frequency_stepsize);
	/* freq -> oscilator frequency conversion. */
	/* freq: 473,000,000 + n*6,000,000 [+ 142857 (center freq. shift)] */
	f = freq / state->frontend.ops.info.frequency_stepsize;
	/* add 399[1/7 MHZ] = 57MHz for the IF  */
	f += 399;
	/* add center frequency shift if necessary */
	if (f % 7 == 0)
		f++;
	pll_freq_cmd[DEMOD_REDIRECT_REG] = JDVBT90502_2ND_I2C_REG; /* 0xFE */
	pll_freq_cmd[ADDRESS_BYTE] = state->config.pll_address << 1;
	pll_freq_cmd[DIVIDER_BYTE1] = (f >> 8) & 0x7F;
	pll_freq_cmd[DIVIDER_BYTE2] = f & 0xFF;
	pll_freq_cmd[CONTROL_BYTE] = 0xB2; /* ref.divider:28, 4MHz/28=1/7MHz */
	pll_freq_cmd[BANDSWITCH_BYTE] = 0x08;	/* UHF band */

	msg[0].addr = state->config.demod_address;
	msg[0].flags = 0;
	msg[0].buf = pll_freq_cmd;
	msg[0].len = sizeof(pll_freq_cmd);

	ret = i2c_transfer(state->i2c, &msg[0], 1);
	if (ret != 1)
		goto error;

	udelay(50);

	pll_agc_cmd[DEMOD_REDIRECT_REG] = pll_freq_cmd[DEMOD_REDIRECT_REG];
	pll_agc_cmd[ADDRESS_BYTE] = pll_freq_cmd[ADDRESS_BYTE];
	pll_agc_cmd[DIVIDER_BYTE1] = pll_freq_cmd[DIVIDER_BYTE1];
	pll_agc_cmd[DIVIDER_BYTE2] = pll_freq_cmd[DIVIDER_BYTE2];
	pll_agc_cmd[CONTROL_BYTE] = 0x9A; /*  AGC_CTRL instead of BANDSWITCH */
	pll_agc_cmd[AGC_CTRL_BYTE] = 0x50;
	/* AGC Time Constant 2s, AGC take-over point:103dBuV(lowest) */

	msg[1].addr = msg[0].addr;
	msg[1].flags = 0;
	msg[1].buf = pll_agc_cmd;
	msg[1].len = sizeof(pll_agc_cmd);

	ret = i2c_transfer(state->i2c, &msg[1], 1);
	if (ret != 1)
		goto error;

	/* I don't know what these cmds are for,  */
	/* but the USB log on a windows box contains them */
	ret = jdvbt90502_single_reg_write(state, 0x01, 0x40);
	ret |= jdvbt90502_single_reg_write(state, 0x01, 0x00);
	if (ret)
		goto error;
	udelay(100);

	/* wait for the demod to be ready? */
#define RETRY_COUNT 5
	for (retry = 0; retry < RETRY_COUNT; retry++) {
		ret = jdvbt90502_reg_read(state, 0x0096, &res1, 1);
		if (ret)
			goto error;
		/* if (res1 != 0x00) goto error; */
		ret = jdvbt90502_reg_read(state, 0x00B0, res2, sizeof(res2));
		if (ret)
			goto error;
		if (res2[0] >= 0xA7)
			break;
		msleep(100);
	}
	if (retry >= RETRY_COUNT) {
		deb_fe("%s: FE does not get ready after freq setting.\n",
		       __func__);
		return -EREMOTEIO;
	}

	return 0;
error:
	deb_fe("%s:ret == %d\n", __func__, ret);
	return -EREMOTEIO;
}

static int jdvbt90502_read_status(struct dvb_frontend *fe, fe_status_t *state)
{
	u8 result;
	int ret;

	*state = FE_HAS_SIGNAL;

	ret = jdvbt90502_pll_read(fe->demodulator_priv, &result);
	if (ret) {
		deb_fe("%s:ret == %d\n", __func__, ret);
		return -EREMOTEIO;
	}

	*state = FE_HAS_SIGNAL
		| FE_HAS_CARRIER
		| FE_HAS_VITERBI
		| FE_HAS_SYNC;

	if (result & PLL_STATUS_LOCKED)
		*state |= FE_HAS_LOCK;

	return 0;
}

static int jdvbt90502_read_signal_strength(struct dvb_frontend *fe,
					   u16 *strength)
{
	int ret;
	u8 rbuf[37];

	*strength = 0;

	/* status register (incl. signal strength) : 0x89  */
	/* TODO: read just the necessary registers [0x8B..0x8D]? */
	ret = jdvbt90502_reg_read(fe->demodulator_priv, 0x0089,
				  rbuf, sizeof(rbuf));

	if (ret) {
		deb_fe("%s:ret == %d\n", __func__, ret);
		return -EREMOTEIO;
	}

	/* signal_strength: rbuf[2-4] (24bit BE), use lower 16bit for now. */
	*strength = (rbuf[3] << 8) + rbuf[4];
	if (rbuf[2])
		*strength = 0xffff;

	return 0;
}


/* filter out un-supported properties to notify users */
static int jdvbt90502_set_property(struct dvb_frontend *fe,
				   struct dtv_property *tvp)
{
	int r = 0;

	switch (tvp->cmd) {
	case DTV_DELIVERY_SYSTEM:
		if (tvp->u.data != SYS_ISDBT)
			r = -EINVAL;
		break;
	case DTV_CLEAR:
	case DTV_TUNE:
	case DTV_FREQUENCY:
		break;
	default:
		r = -EINVAL;
	}
	return r;
}

static int jdvbt90502_get_frontend(struct dvb_frontend *fe,
				   struct dvb_frontend_parameters *p)
{
	p->inversion = INVERSION_AUTO;
	p->u.ofdm.bandwidth = BANDWIDTH_6_MHZ;
	p->u.ofdm.code_rate_HP = FEC_AUTO;
	p->u.ofdm.code_rate_LP = FEC_AUTO;
	p->u.ofdm.constellation = QAM_64;
	p->u.ofdm.transmission_mode = TRANSMISSION_MODE_AUTO;
	p->u.ofdm.guard_interval = GUARD_INTERVAL_AUTO;
	p->u.ofdm.hierarchy_information = HIERARCHY_AUTO;
	return 0;
}

static int jdvbt90502_set_frontend(struct dvb_frontend *fe,
				   struct dvb_frontend_parameters *p)
{
	/**
	 * NOTE: ignore all the parameters except frequency.
	 *       others should be fixed to the proper value for ISDB-T,
	 *       but don't check here.
	 */

	struct jdvbt90502_state *state = fe->demodulator_priv;
	int ret;

	deb_fe("%s: Freq:%d\n", __func__, p->frequency);

	/* for recovery from DTV_CLEAN */
	fe->dtv_property_cache.delivery_system = SYS_ISDBT;

	ret = jdvbt90502_pll_set_freq(state, p->frequency);
	if (ret) {
		deb_fe("%s:ret == %d\n", __func__, ret);
		return -EREMOTEIO;
	}

	return 0;
}


/**
 * (reg, val) commad list to initialize this module.
 *  captured on a Windows box.
 */
static u8 init_code[][2] = {
	{0x01, 0x40},
	{0x04, 0x38},
	{0x05, 0x40},
	{0x07, 0x40},
	{0x0F, 0x4F},
	{0x11, 0x21},
	{0x12, 0x0B},
	{0x13, 0x2F},
	{0x14, 0x31},
	{0x16, 0x02},
	{0x21, 0xC4},
	{0x22, 0x20},
	{0x2C, 0x79},
	{0x2D, 0x34},
	{0x2F, 0x00},
	{0x30, 0x28},
	{0x31, 0x31},
	{0x32, 0xDF},
	{0x38, 0x01},
	{0x39, 0x78},
	{0x3B, 0x33},
	{0x3C, 0x33},
	{0x48, 0x90},
	{0x51, 0x68},
	{0x5E, 0x38},
	{0x71, 0x00},
	{0x72, 0x08},
	{0x77, 0x00},
	{0xC0, 0x21},
	{0xC1, 0x10},
	{0xE4, 0x1A},
	{0xEA, 0x1F},
	{0x77, 0x00},
	{0x71, 0x00},
	{0x71, 0x00},
	{0x76, 0x0C},
};

static const int init_code_len = sizeof(init_code) / sizeof(u8[2]);

static int jdvbt90502_init(struct dvb_frontend *fe)
{
	int i = -1;
	int ret;
	struct i2c_msg msg;

	struct jdvbt90502_state *state = fe->demodulator_priv;

	deb_fe("%s called.\n", __func__);

	msg.addr = state->config.demod_address;
	msg.flags = 0;
	msg.len = 2;
	for (i = 0; i < init_code_len; i++) {
		msg.buf = init_code[i];
		ret = i2c_transfer(state->i2c, &msg, 1);
		if (ret != 1)
			goto error;
	}
	fe->dtv_property_cache.delivery_system = SYS_ISDBT;
	msleep(100);

	return 0;

error:
	deb_fe("%s: init_code[%d] failed. ret==%d\n", __func__, i, ret);
	return -EREMOTEIO;
}


static void jdvbt90502_release(struct dvb_frontend *fe)
{
	struct jdvbt90502_state *state = fe->demodulator_priv;
	kfree(state);
}


static struct dvb_frontend_ops jdvbt90502_ops;

struct dvb_frontend *jdvbt90502_attach(struct dvb_usb_device *d)
{
	struct jdvbt90502_state *state = NULL;

	deb_info("%s called.\n", __func__);

	/* allocate memory for the internal state */
	state = kzalloc(sizeof(struct jdvbt90502_state), GFP_KERNEL);
	if (state == NULL)
		goto error;

	/* setup the state */
	state->i2c = &d->i2c_adap;
	memcpy(&state->config, &friio_fe_config, sizeof(friio_fe_config));

	/* create dvb_frontend */
	memcpy(&state->frontend.ops, &jdvbt90502_ops,
	       sizeof(jdvbt90502_ops));
	state->frontend.demodulator_priv = state;

	if (jdvbt90502_init(&state->frontend) < 0)
		goto error;

	return &state->frontend;

error:
	kfree(state);
	return NULL;
}

static struct dvb_frontend_ops jdvbt90502_ops = {

	.info = {
		.name			= "Comtech JDVBT90502 ISDB-T",
		.type			= FE_OFDM,
		.frequency_min		= 473000000, /* UHF 13ch, center */
		.frequency_max		= 767142857, /* UHF 62ch, center */
		.frequency_stepsize	= JDVBT90502_PLL_CLK /
							JDVBT90502_PLL_DIVIDER,
		.frequency_tolerance	= 0,

		/* NOTE: this driver ignores all parameters but frequency. */
		.caps = FE_CAN_INVERSION_AUTO |
			FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
			FE_CAN_FEC_4_5 | FE_CAN_FEC_5_6 | FE_CAN_FEC_6_7 |
			FE_CAN_FEC_7_8 | FE_CAN_FEC_8_9 | FE_CAN_FEC_AUTO |
			FE_CAN_QAM_16 | FE_CAN_QAM_64 | FE_CAN_QAM_AUTO |
			FE_CAN_TRANSMISSION_MODE_AUTO |
			FE_CAN_GUARD_INTERVAL_AUTO |
			FE_CAN_HIERARCHY_AUTO,
	},

	.release = jdvbt90502_release,

	.init = jdvbt90502_init,
	.write = _jdvbt90502_write,

	.set_property = jdvbt90502_set_property,

	.set_frontend = jdvbt90502_set_frontend,
	.get_frontend = jdvbt90502_get_frontend,

	.read_status = jdvbt90502_read_status,
	.read_signal_strength = jdvbt90502_read_signal_strength,
};
Commit	Line	Data
5eca4823 AT	1	/* DVB USB compliant Linux driver for the Friio USB2.0 ISDB-T receiver.
	2	*
	3	* Copyright (C) 2009 Akihiro Tsukada <tskd2@yahoo.co.jp>
	4	*
	5	* This module is based off the the gl861 and vp702x modules.
	6	*
	7	* This program is free software; you can redistribute it and/or modify it
	8	* under the terms of the GNU General Public License as published by the Free
	9	* Software Foundation, version 2.
	10	*
	11	* see Documentation/dvb/README.dvb-usb for more information
	12	*/
	13	#include <linux/init.h>
	14	#include <linux/string.h>
	15	#include <linux/slab.h>
	16
	17	#include "friio.h"
	18
	19	struct jdvbt90502_state {
	20	struct i2c_adapter *i2c;
	21	struct dvb_frontend frontend;
	22	struct jdvbt90502_config config;
	23	};
	24
	25	/* NOTE: TC90502 has 16bit register-address? */
	26	/* register 0x0100 is used for reading PLL status, so reg is u16 here */
	27	static int jdvbt90502_reg_read(struct jdvbt90502_state *state,
	28	const u16 reg, u8 *buf, const size_t count)
	29	{
	30	int ret;
	31	u8 wbuf[3];
	32	struct i2c_msg msg[2];
	33
	34	wbuf[0] = reg & 0xFF;
	35	wbuf[1] = 0;
	36	wbuf[2] = reg >> 8;
	37
	38	msg[0].addr = state->config.demod_address;
	39	msg[0].flags = 0;
	40	msg[0].buf = wbuf;
	41	msg[0].len = sizeof(wbuf);
	42
	43	msg[1].addr = msg[0].addr;
	44	msg[1].flags = I2C_M_RD;
	45	msg[1].buf = buf;
	46	msg[1].len = count;
	47
	48	ret = i2c_transfer(state->i2c, msg, 2);
	49	if (ret != 2) {
	50	deb_fe(" reg read failed.\n");
	51	return -EREMOTEIO;
	52	}
	53	return 0;
	54	}
	55
	56	/* currently 16bit register-address is not used, so reg is u8 here */
	57	static int jdvbt90502_single_reg_write(struct jdvbt90502_state *state,
	58	const u8 reg, const u8 val)
	59	{
	60	struct i2c_msg msg;
	61	u8 wbuf[2];
	62
	63	wbuf[0] = reg;
	64	wbuf[1] = val;
65
66	msg.addr = state->config.demod_address;
67	msg.flags = 0;
68	msg.buf = wbuf;
69	msg.len = sizeof(wbuf);
70
71	if (i2c_transfer(state->i2c, &msg, 1) != 1) {
72	deb_fe(" reg write failed.");
73	return -EREMOTEIO;
74	}
75	return 0;
76	}
77
2e4e98e7	78	static int _jdvbt90502_write(struct dvb_frontend *fe, const u8 buf[], int len)
5eca4823 AT	79	{
	80	struct jdvbt90502_state *state = fe->demodulator_priv;
	81	int err, i;
	82	for (i = 0; i < len - 1; i++) {
	83	err = jdvbt90502_single_reg_write(state,
	84	buf[0] + i, buf[i + 1]);
	85	if (err)
	86	return err;
	87	}
	88
	89	return 0;
	90	}
	91
	92	/* read pll status byte via the demodulator's I2C register */
	93	/* note: Win box reads it by 8B block at the I2C addr 0x30 from reg:0x80 */
	94	static int jdvbt90502_pll_read(struct jdvbt90502_state state, u8 result)
	95	{
	96	int ret;
	97
	98	/* +1 for reading */
	99	u8 pll_addr_byte = (state->config.pll_address << 1) + 1;
	100
	101	*result = 0;
	102
	103	ret = jdvbt90502_single_reg_write(state, JDVBT90502_2ND_I2C_REG,
	104	pll_addr_byte);
	105	if (ret)
	106	goto error;
	107
	108	ret = jdvbt90502_reg_read(state, 0x0100, result, 1);
	109	if (ret)
	110	goto error;
	111
	112	deb_fe("PLL read val:%02x\n", *result);
	113	return 0;
	114
	115	error:
	116	deb_fe("%s:ret == %d\n", __func__, ret);
	117	return -EREMOTEIO;
	118	}
	119
	120
	121	/* set pll frequency via the demodulator's I2C register */
	122	static int jdvbt90502_pll_set_freq(struct jdvbt90502_state *state, u32 freq)
	123	{
	124	int ret;
	125	int retry;
	126	u8 res1;
	127	u8 res2[9];
	128
	129	u8 pll_freq_cmd[PLL_CMD_LEN];
	130	u8 pll_agc_cmd[PLL_CMD_LEN];
	131	struct i2c_msg msg[2];
	132	u32 f;
	133
	134	deb_fe("%s: freq=%d, step=%d\n", __func__, freq,
	135	state->frontend.ops.info.frequency_stepsize);
	136	/* freq -> oscilator frequency conversion. */
0e2f0d34	137	/* freq: 473,000,000 + n6,000,000 [+ 142857 (center freq. shift)] /
5eca4823	138	f = freq / state->frontend.ops.info.frequency_stepsize;
0e2f0d34 AT	139	/* add 399[1/7 MHZ] = 57MHz for the IF */
	140	f += 399;
	141	/* add center frequency shift if necessary */
	142	if (f % 7 == 0)
	143	f++;
5eca4823 AT	144	pll_freq_cmd[DEMOD_REDIRECT_REG] = JDVBT90502_2ND_I2C_REG; /* 0xFE */
	145	pll_freq_cmd[ADDRESS_BYTE] = state->config.pll_address << 1;
	146	pll_freq_cmd[DIVIDER_BYTE1] = (f >> 8) & 0x7F;
	147	pll_freq_cmd[DIVIDER_BYTE2] = f & 0xFF;
	148	pll_freq_cmd[CONTROL_BYTE] = 0xB2; /* ref.divider:28, 4MHz/28=1/7MHz */
	149	pll_freq_cmd[BANDSWITCH_BYTE] = 0x08; /* UHF band */
	150
	151	msg[0].addr = state->config.demod_address;
	152	msg[0].flags = 0;
	153	msg[0].buf = pll_freq_cmd;
	154	msg[0].len = sizeof(pll_freq_cmd);
	155
	156	ret = i2c_transfer(state->i2c, &msg[0], 1);
	157	if (ret != 1)
	158	goto error;
	159
	160	udelay(50);
	161
	162	pll_agc_cmd[DEMOD_REDIRECT_REG] = pll_freq_cmd[DEMOD_REDIRECT_REG];
	163	pll_agc_cmd[ADDRESS_BYTE] = pll_freq_cmd[ADDRESS_BYTE];
	164	pll_agc_cmd[DIVIDER_BYTE1] = pll_freq_cmd[DIVIDER_BYTE1];
	165	pll_agc_cmd[DIVIDER_BYTE2] = pll_freq_cmd[DIVIDER_BYTE2];
	166	pll_agc_cmd[CONTROL_BYTE] = 0x9A; /* AGC_CTRL instead of BANDSWITCH */
	167	pll_agc_cmd[AGC_CTRL_BYTE] = 0x50;
	168	/* AGC Time Constant 2s, AGC take-over point:103dBuV(lowest) */
	169
	170	msg[1].addr = msg[0].addr;
	171	msg[1].flags = 0;
	172	msg[1].buf = pll_agc_cmd;
	173	msg[1].len = sizeof(pll_agc_cmd);
	174
	175	ret = i2c_transfer(state->i2c, &msg[1], 1);
	176	if (ret != 1)
	177	goto error;
	178
	179	/* I don't know what these cmds are for, */
	180	/* but the USB log on a windows box contains them */
	181	ret = jdvbt90502_single_reg_write(state, 0x01, 0x40);
	182	ret \|= jdvbt90502_single_reg_write(state, 0x01, 0x00);
	183	if (ret)
	184	goto error;
	185	udelay(100);
	186
	187	/* wait for the demod to be ready? */
	188	#define RETRY_COUNT 5
	189	for (retry = 0; retry < RETRY_COUNT; retry++) {
	190	ret = jdvbt90502_reg_read(state, 0x0096, &res1, 1);
	191	if (ret)
	192	goto error;
	193	/* if (res1 != 0x00) goto error; */
	194	ret = jdvbt90502_reg_read(state, 0x00B0, res2, sizeof(res2));
	195	if (ret)
	196	goto error;
	197	if (res2[0] >= 0xA7)
	198	break;
	199	msleep(100);
	200	}
	201	if (retry >= RETRY_COUNT) {
	202	deb_fe("%s: FE does not get ready after freq setting.\n",
	203	__func__);
	204	return -EREMOTEIO;
	205	}
	206
	207	return 0;
208	error:
209	deb_fe("%s:ret == %d\n", __func__, ret);
210	return -EREMOTEIO;
211	}
212
213	static int jdvbt90502_read_status(struct dvb_frontend fe, fe_status_t state)
214	{
215	u8 result;
216	int ret;
217
218	*state = FE_HAS_SIGNAL;
219
220	ret = jdvbt90502_pll_read(fe->demodulator_priv, &result);
221	if (ret) {
222	deb_fe("%s:ret == %d\n", __func__, ret);
223	return -EREMOTEIO;
224	}
225
226	*state = FE_HAS_SIGNAL
227	\| FE_HAS_CARRIER
228	\| FE_HAS_VITERBI
229	\| FE_HAS_SYNC;
230
231	if (result & PLL_STATUS_LOCKED)
232	*state \|= FE_HAS_LOCK;
233
234	return 0;
235	}
236
5eca4823 AT	237	static int jdvbt90502_read_signal_strength(struct dvb_frontend *fe,
	238	u16 *strength)
	239	{
	240	int ret;
	241	u8 rbuf[37];
	242
	243	*strength = 0;
	244
	245	/* status register (incl. signal strength) : 0x89 */
	246	/* TODO: read just the necessary registers [0x8B..0x8D]? */
	247	ret = jdvbt90502_reg_read(fe->demodulator_priv, 0x0089,
	248	rbuf, sizeof(rbuf));
	249
	250	if (ret) {
	251	deb_fe("%s:ret == %d\n", __func__, ret);
	252	return -EREMOTEIO;
	253	}
	254
	255	/* signal_strength: rbuf[2-4] (24bit BE), use lower 16bit for now. */
	256	*strength = (rbuf[3] << 8) + rbuf[4];
	257	if (rbuf[2])
	258	*strength = 0xffff;
	259
	260	return 0;
	261	}
	262
5eca4823	263
ad12f07b AT	264	/* filter out un-supported properties to notify users */
	265	static int jdvbt90502_set_property(struct dvb_frontend *fe,
	266	struct dtv_property *tvp)
	267	{
	268	int r = 0;
	269
	270	switch (tvp->cmd) {
	271	case DTV_DELIVERY_SYSTEM:
	272	if (tvp->u.data != SYS_ISDBT)
	273	r = -EINVAL;
	274	break;
	275	case DTV_CLEAR:
	276	case DTV_TUNE:
	277	case DTV_FREQUENCY:
	278	break;
	279	default:
	280	r = -EINVAL;
	281	}
	282	return r;
	283	}
	284
5eca4823 AT	285	static int jdvbt90502_get_frontend(struct dvb_frontend *fe,
	286	struct dvb_frontend_parameters *p)
	287	{
	288	p->inversion = INVERSION_AUTO;
	289	p->u.ofdm.bandwidth = BANDWIDTH_6_MHZ;
	290	p->u.ofdm.code_rate_HP = FEC_AUTO;
	291	p->u.ofdm.code_rate_LP = FEC_AUTO;
	292	p->u.ofdm.constellation = QAM_64;
	293	p->u.ofdm.transmission_mode = TRANSMISSION_MODE_AUTO;
	294	p->u.ofdm.guard_interval = GUARD_INTERVAL_AUTO;
	295	p->u.ofdm.hierarchy_information = HIERARCHY_AUTO;
	296	return 0;
	297	}
	298
	299	static int jdvbt90502_set_frontend(struct dvb_frontend *fe,
	300	struct dvb_frontend_parameters *p)
	301	{
	302	/**
88393161	303	* NOTE: ignore all the parameters except frequency.
5eca4823 AT	304	* others should be fixed to the proper value for ISDB-T,
	305	* but don't check here.
	306	*/
	307
	308	struct jdvbt90502_state *state = fe->demodulator_priv;
	309	int ret;
	310
	311	deb_fe("%s: Freq:%d\n", __func__, p->frequency);
	312
ad12f07b AT	313	/* for recovery from DTV_CLEAN */
	314	fe->dtv_property_cache.delivery_system = SYS_ISDBT;
	315
5eca4823 AT	316	ret = jdvbt90502_pll_set_freq(state, p->frequency);
	317	if (ret) {
	318	deb_fe("%s:ret == %d\n", __func__, ret);
	319	return -EREMOTEIO;
	320	}
	321
	322	return 0;
	323	}
	324
5eca4823 AT	325
	326	/**
	327	* (reg, val) commad list to initialize this module.
	328	* captured on a Windows box.
	329	*/
	330	static u8 init_code[][2] = {
	331	{0x01, 0x40},
	332	{0x04, 0x38},
	333	{0x05, 0x40},
	334	{0x07, 0x40},
	335	{0x0F, 0x4F},
	336	{0x11, 0x21},
	337	{0x12, 0x0B},
	338	{0x13, 0x2F},
	339	{0x14, 0x31},
	340	{0x16, 0x02},
	341	{0x21, 0xC4},
	342	{0x22, 0x20},
	343	{0x2C, 0x79},
	344	{0x2D, 0x34},
	345	{0x2F, 0x00},
	346	{0x30, 0x28},
	347	{0x31, 0x31},
	348	{0x32, 0xDF},
	349	{0x38, 0x01},
	350	{0x39, 0x78},
	351	{0x3B, 0x33},
	352	{0x3C, 0x33},
	353	{0x48, 0x90},
	354	{0x51, 0x68},
	355	{0x5E, 0x38},
	356	{0x71, 0x00},
	357	{0x72, 0x08},
	358	{0x77, 0x00},
	359	{0xC0, 0x21},
	360	{0xC1, 0x10},
	361	{0xE4, 0x1A},
	362	{0xEA, 0x1F},
	363	{0x77, 0x00},
	364	{0x71, 0x00},
	365	{0x71, 0x00},
	366	{0x76, 0x0C},
	367	};
	368
7b2d3983	369	static const int init_code_len = sizeof(init_code) / sizeof(u8[2]);
5eca4823 AT	370
	371	static int jdvbt90502_init(struct dvb_frontend *fe)
	372	{
	373	int i = -1;
	374	int ret;
	375	struct i2c_msg msg;
	376
	377	struct jdvbt90502_state *state = fe->demodulator_priv;
	378
	379	deb_fe("%s called.\n", __func__);
	380
	381	msg.addr = state->config.demod_address;
	382	msg.flags = 0;
	383	msg.len = 2;
	384	for (i = 0; i < init_code_len; i++) {
	385	msg.buf = init_code[i];
	386	ret = i2c_transfer(state->i2c, &msg, 1);
	387	if (ret != 1)
	388	goto error;
	389	}
ad12f07b	390	fe->dtv_property_cache.delivery_system = SYS_ISDBT;
5eca4823 AT	391	msleep(100);
	392
	393	return 0;
	394
	395	error:
	396	deb_fe("%s: init_code[%d] failed. ret==%d\n", __func__, i, ret);
	397	return -EREMOTEIO;
	398	}
	399
	400
	401	static void jdvbt90502_release(struct dvb_frontend *fe)
	402	{
	403	struct jdvbt90502_state *state = fe->demodulator_priv;
	404	kfree(state);
	405	}
	406
	407
	408	static struct dvb_frontend_ops jdvbt90502_ops;
	409
	410	struct dvb_frontend jdvbt90502_attach(struct dvb_usb_device d)
	411	{
	412	struct jdvbt90502_state *state = NULL;
	413
	414	deb_info("%s called.\n", __func__);
	415
	416	/* allocate memory for the internal state */
	417	state = kzalloc(sizeof(struct jdvbt90502_state), GFP_KERNEL);
	418	if (state == NULL)
	419	goto error;
	420
	421	/* setup the state */
	422	state->i2c = &d->i2c_adap;
	423	memcpy(&state->config, &friio_fe_config, sizeof(friio_fe_config));
	424
	425	/* create dvb_frontend */
	426	memcpy(&state->frontend.ops, &jdvbt90502_ops,
	427	sizeof(jdvbt90502_ops));
	428	state->frontend.demodulator_priv = state;
	429
	430	if (jdvbt90502_init(&state->frontend) < 0)
	431	goto error;
	432
	433	return &state->frontend;
	434
	435	error:
	436	kfree(state);
	437	return NULL;
	438	}
	439
	440	static struct dvb_frontend_ops jdvbt90502_ops = {
	441
	442	.info = {
	443	.name = "Comtech JDVBT90502 ISDB-T",
	444	.type = FE_OFDM,
	445	.frequency_min = 473000000, /* UHF 13ch, center */
	446	.frequency_max = 767142857, /* UHF 62ch, center */
	447	.frequency_stepsize = JDVBT90502_PLL_CLK /
	448	JDVBT90502_PLL_DIVIDER,
	449	.frequency_tolerance = 0,
	450
	451	/* NOTE: this driver ignores all parameters but frequency. */
	452	.caps = FE_CAN_INVERSION_AUTO \|
	453	FE_CAN_FEC_1_2 \| FE_CAN_FEC_2_3 \| FE_CAN_FEC_3_4 \|
	454	FE_CAN_FEC_4_5 \| FE_CAN_FEC_5_6 \| FE_CAN_FEC_6_7 \|
455	FE_CAN_FEC_7_8 \| FE_CAN_FEC_8_9 \| FE_CAN_FEC_AUTO \|
456	FE_CAN_QAM_16 \| FE_CAN_QAM_64 \| FE_CAN_QAM_AUTO \|
457	FE_CAN_TRANSMISSION_MODE_AUTO \|
458	FE_CAN_GUARD_INTERVAL_AUTO \|
459	FE_CAN_HIERARCHY_AUTO,
460	},
461
462	.release = jdvbt90502_release,
463
464	.init = jdvbt90502_init,
5eca4823 AT	465	.write = _jdvbt90502_write,
5eca4823 AT	466
ad12f07b AT	467	.set_property = jdvbt90502_set_property,
ad12f07b AT	468
5eca4823 AT	469	.set_frontend = jdvbt90502_set_frontend,
5eca4823 AT	470	.get_frontend = jdvbt90502_get_frontend,
5eca4823 AT	471
5eca4823 AT	472	.read_status = jdvbt90502_read_status,
5eca4823	473	.read_signal_strength = jdvbt90502_read_signal_strength,
5eca4823	474	};