[linux-2.6-block.git] / drivers / media / dvb / dvb-usb / dtt200u-fe.c

/* Frontend part of the Linux driver for the WideView/ Yakumo/ Hama/
 * Typhoon/ Yuan DVB-T USB2.0 receiver.
 *
 * Copyright (C) 2005 Patrick Boettcher <patrick.boettcher@desy.de>
 *
 *	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 "dtt200u.h"

struct dtt200u_fe_state {
	struct dvb_usb_device *d;

	fe_status_t stat;

	struct dvb_frontend_parameters fep;
	struct dvb_frontend frontend;
	struct dvb_frontend_ops ops;
};

static int dtt200u_fe_read_status(struct dvb_frontend* fe, fe_status_t *stat)
{
	struct dtt200u_fe_state *state = fe->demodulator_priv;
	u8 st = GET_TUNE_STATUS, b[3];

	dvb_usb_generic_rw(state->d,&st,1,b,3,0);

	switch (b[0]) {
		case 0x01:
			*stat = FE_HAS_SIGNAL | FE_HAS_CARRIER |
				FE_HAS_VITERBI | FE_HAS_SYNC | FE_HAS_LOCK;
			break;
		case 0x00: /* pending */
			*stat = FE_TIMEDOUT; /* during set_frontend */
			break;
		default:
		case 0x02: /* failed */
			*stat = 0;
			break;
	}
	return 0;
}

static int dtt200u_fe_read_ber(struct dvb_frontend* fe, u32 *ber)
{
	struct dtt200u_fe_state *state = fe->demodulator_priv;
	u8 bw = GET_VIT_ERR_CNT,b[3];
	dvb_usb_generic_rw(state->d,&bw,1,b,3,0);
	*ber = (b[0] << 16) | (b[1] << 8) | b[2];
	return 0;
}

static int dtt200u_fe_read_unc_blocks(struct dvb_frontend* fe, u32 *unc)
{
	struct dtt200u_fe_state *state = fe->demodulator_priv;
	u8 bw = GET_RS_UNCOR_BLK_CNT,b[2];

	dvb_usb_generic_rw(state->d,&bw,1,b,2,0);
	*unc = (b[0] << 8) | b[1];
	return 0;
}

static int dtt200u_fe_read_signal_strength(struct dvb_frontend* fe, u16 *strength)
{
	struct dtt200u_fe_state *state = fe->demodulator_priv;
	u8 bw = GET_AGC, b;
	dvb_usb_generic_rw(state->d,&bw,1,&b,1,0);
	*strength = (b << 8) | b;
	return 0;
}

static int dtt200u_fe_read_snr(struct dvb_frontend* fe, u16 *snr)
{
	struct dtt200u_fe_state *state = fe->demodulator_priv;
	u8 bw = GET_SNR,br;
	dvb_usb_generic_rw(state->d,&bw,1,&br,1,0);
	*snr = ~((br << 8) | br);
	return 0;
}

static int dtt200u_fe_init(struct dvb_frontend* fe)
{
	struct dtt200u_fe_state *state = fe->demodulator_priv;
	u8 b = SET_INIT;
	return dvb_usb_generic_write(state->d,&b,1);
}

static int dtt200u_fe_sleep(struct dvb_frontend* fe)
{
	return dtt200u_fe_init(fe);
}

static int dtt200u_fe_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend_tune_settings *tune)
{
	tune->min_delay_ms = 1500;
	tune->step_size = 0;
	tune->max_drift = 0;
	return 0;
}

static int dtt200u_fe_set_frontend(struct dvb_frontend* fe,
				  struct dvb_frontend_parameters *fep)
{
	struct dtt200u_fe_state *state = fe->demodulator_priv;
	int i;
	fe_status_t st;
	u16 freq = fep->frequency / 250000;
	u8 bwbuf[2] = { SET_BANDWIDTH, 0 },freqbuf[3] = { SET_RF_FREQ, 0, 0 };

	switch (fep->u.ofdm.bandwidth) {
		case BANDWIDTH_8_MHZ: bwbuf[1] = 8; break;
		case BANDWIDTH_7_MHZ: bwbuf[1] = 7; break;
		case BANDWIDTH_6_MHZ: bwbuf[1] = 6; break;
		case BANDWIDTH_AUTO: return -EOPNOTSUPP;
		default:
			return -EINVAL;
	}

	dvb_usb_generic_write(state->d,bwbuf,2);

	freqbuf[1] = freq & 0xff;
	freqbuf[2] = (freq >> 8) & 0xff;
	dvb_usb_generic_write(state->d,freqbuf,3);

	for (i = 0; i < 30; i++) {
		msleep(20);
		dtt200u_fe_read_status(fe, &st);
		if (st & FE_TIMEDOUT)
			continue;
	}

	return 0;
}

static int dtt200u_fe_get_frontend(struct dvb_frontend* fe,
				  struct dvb_frontend_parameters *fep)
{
	struct dtt200u_fe_state *state = fe->demodulator_priv;
	memcpy(fep,&state->fep,sizeof(struct dvb_frontend_parameters));
	return 0;
}

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

static struct dvb_frontend_ops dtt200u_fe_ops;

struct dvb_frontend* dtt200u_fe_attach(struct dvb_usb_device *d)
{
	struct dtt200u_fe_state* state = NULL;

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

	deb_info("attaching frontend dtt200u\n");

	state->d = d;
	memcpy(&state->ops,&dtt200u_fe_ops,sizeof(struct dvb_frontend_ops));

	state->frontend.ops = &state->ops;
	state->frontend.demodulator_priv = state;

	goto success;
error:
	return NULL;
success:
	return &state->frontend;
}

static struct dvb_frontend_ops dtt200u_fe_ops = {
	.info = {
		.name			= "WideView USB DVB-T",
		.type			= FE_OFDM,
		.frequency_min		= 44250000,
		.frequency_max		= 867250000,
		.frequency_stepsize	= 250000,
		.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_7_8 | FE_CAN_FEC_AUTO |
				FE_CAN_QPSK | FE_CAN_QAM_16 | FE_CAN_QAM_64 | FE_CAN_QAM_AUTO |
				FE_CAN_TRANSMISSION_MODE_AUTO |
				FE_CAN_GUARD_INTERVAL_AUTO |
				FE_CAN_RECOVER |
				FE_CAN_HIERARCHY_AUTO,
	},

	.release = dtt200u_fe_release,

	.init = dtt200u_fe_init,
	.sleep = dtt200u_fe_sleep,

	.set_frontend = dtt200u_fe_set_frontend,
	.get_frontend = dtt200u_fe_get_frontend,
	.get_tune_settings = dtt200u_fe_get_tune_settings,

	.read_status = dtt200u_fe_read_status,
	.read_ber = dtt200u_fe_read_ber,
	.read_signal_strength = dtt200u_fe_read_signal_strength,
	.read_snr = dtt200u_fe_read_snr,
	.read_ucblocks = dtt200u_fe_read_unc_blocks,
};
Commit	Line	Data
fb41f5a7 PB	1	/* Frontend part of the Linux driver for the WideView/ Yakumo/ Hama/
fb41f5a7 PB	2	* Typhoon/ Yuan DVB-T USB2.0 receiver.
776338e1 JS	3	*
	4	* Copyright (C) 2005 Patrick Boettcher <patrick.boettcher@desy.de>
	5	*
	6	* This program is free software; you can redistribute it and/or modify it
	7	* under the terms of the GNU General Public License as published by the Free
	8	* Software Foundation, version 2.
	9	*
	10	* see Documentation/dvb/README.dvb-usb for more information
	11	*/
	12	#include "dtt200u.h"
	13
	14	struct dtt200u_fe_state {
	15	struct dvb_usb_device *d;
	16
d590f9c2 PB	17	fe_status_t stat;
d590f9c2 PB	18
776338e1 JS	19	struct dvb_frontend_parameters fep;
776338e1 JS	20	struct dvb_frontend frontend;
43bc3f41	21	struct dvb_frontend_ops ops;
776338e1 JS	22	};
776338e1 JS	23
776338e1 JS	24	static int dtt200u_fe_read_status(struct dvb_frontend* fe, fe_status_t *stat)
	25	{
	26	struct dtt200u_fe_state *state = fe->demodulator_priv;
d590f9c2 PB	27	u8 st = GET_TUNE_STATUS, b[3];
	28
	29	dvb_usb_generic_rw(state->d,&st,1,b,3,0);
776338e1	30
d590f9c2	31	switch (b[0]) {
776338e1	32	case 0x01:
d590f9c2 PB	33	*stat = FE_HAS_SIGNAL \| FE_HAS_CARRIER \|
d590f9c2 PB	34	FE_HAS_VITERBI \| FE_HAS_SYNC \| FE_HAS_LOCK;
776338e1	35	break;
d590f9c2 PB	36	case 0x00: /* pending */
d590f9c2 PB	37	stat = FE_TIMEDOUT; / during set_frontend */
776338e1 JS	38	break;
776338e1 JS	39	default:
d590f9c2 PB	40	case 0x02: /* failed */
d590f9c2 PB	41	*stat = 0;
776338e1 JS	42	break;
776338e1 JS	43	}
776338e1 JS	44	return 0;
776338e1 JS	45	}
d590f9c2	46
776338e1 JS	47	static int dtt200u_fe_read_ber(struct dvb_frontend* fe, u32 *ber)
	48	{
	49	struct dtt200u_fe_state *state = fe->demodulator_priv;
d590f9c2 PB	50	u8 bw = GET_VIT_ERR_CNT,b[3];
	51	dvb_usb_generic_rw(state->d,&bw,1,b,3,0);
	52	*ber = (b[0] << 16) \| (b[1] << 8) \| b[2];
776338e1 JS	53	return 0;
	54	}
	55
	56	static int dtt200u_fe_read_unc_blocks(struct dvb_frontend* fe, u32 *unc)
	57	{
	58	struct dtt200u_fe_state *state = fe->demodulator_priv;
d590f9c2 PB	59	u8 bw = GET_RS_UNCOR_BLK_CNT,b[2];
	60
	61	dvb_usb_generic_rw(state->d,&bw,1,b,2,0);
	62	*unc = (b[0] << 8) \| b[1];
776338e1 JS	63	return 0;
	64	}
	65
	66	static int dtt200u_fe_read_signal_strength(struct dvb_frontend* fe, u16 *strength)
	67	{
	68	struct dtt200u_fe_state *state = fe->demodulator_priv;
d590f9c2	69	u8 bw = GET_AGC, b;
776338e1 JS	70	dvb_usb_generic_rw(state->d,&bw,1,&b,1,0);
	71	*strength = (b << 8) \| b;
	72	return 0;
	73	}
	74
	75	static int dtt200u_fe_read_snr(struct dvb_frontend* fe, u16 *snr)
	76	{
	77	struct dtt200u_fe_state *state = fe->demodulator_priv;
	78	u8 bw = GET_SNR,br;
	79	dvb_usb_generic_rw(state->d,&bw,1,&br,1,0);
	80	*snr = ~((br << 8) \| br);
	81	return 0;
	82	}
	83
	84	static int dtt200u_fe_init(struct dvb_frontend* fe)
	85	{
	86	struct dtt200u_fe_state *state = fe->demodulator_priv;
d590f9c2	87	u8 b = SET_INIT;
776338e1 JS	88	return dvb_usb_generic_write(state->d,&b,1);
	89	}
	90
	91	static int dtt200u_fe_sleep(struct dvb_frontend* fe)
	92	{
	93	return dtt200u_fe_init(fe);
	94	}
	95
	96	static int dtt200u_fe_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend_tune_settings *tune)
	97	{
	98	tune->min_delay_ms = 1500;
d590f9c2 PB	99	tune->step_size = 0;
d590f9c2 PB	100	tune->max_drift = 0;
776338e1 JS	101	return 0;
	102	}
	103
	104	static int dtt200u_fe_set_frontend(struct dvb_frontend* fe,
	105	struct dvb_frontend_parameters *fep)
	106	{
	107	struct dtt200u_fe_state *state = fe->demodulator_priv;
d590f9c2 PB	108	int i;
d590f9c2 PB	109	fe_status_t st;
776338e1	110	u16 freq = fep->frequency / 250000;
d590f9c2	111	u8 bwbuf[2] = { SET_BANDWIDTH, 0 },freqbuf[3] = { SET_RF_FREQ, 0, 0 };
776338e1 JS	112
776338e1 JS	113	switch (fep->u.ofdm.bandwidth) {
d590f9c2 PB	114	case BANDWIDTH_8_MHZ: bwbuf[1] = 8; break;
	115	case BANDWIDTH_7_MHZ: bwbuf[1] = 7; break;
	116	case BANDWIDTH_6_MHZ: bwbuf[1] = 6; break;
776338e1 JS	117	case BANDWIDTH_AUTO: return -EOPNOTSUPP;
	118	default:
	119	return -EINVAL;
	120	}
776338e1	121
776338e1 JS	122	dvb_usb_generic_write(state->d,bwbuf,2);
	123
	124	freqbuf[1] = freq & 0xff;
	125	freqbuf[2] = (freq >> 8) & 0xff;
	126	dvb_usb_generic_write(state->d,freqbuf,3);
	127
d590f9c2 PB	128	for (i = 0; i < 30; i++) {
	129	msleep(20);
	130	dtt200u_fe_read_status(fe, &st);
	131	if (st & FE_TIMEDOUT)
	132	continue;
	133	}
776338e1 JS	134
	135	return 0;
	136	}
	137
	138	static int dtt200u_fe_get_frontend(struct dvb_frontend* fe,
	139	struct dvb_frontend_parameters *fep)
	140	{
	141	struct dtt200u_fe_state *state = fe->demodulator_priv;
	142	memcpy(fep,&state->fep,sizeof(struct dvb_frontend_parameters));
	143	return 0;
	144	}
	145
	146	static void dtt200u_fe_release(struct dvb_frontend* fe)
	147	{
	148	struct dtt200u_fe_state state = (struct dtt200u_fe_state) fe->demodulator_priv;
	149	kfree(state);
	150	}
	151
	152	static struct dvb_frontend_ops dtt200u_fe_ops;
	153
	154	struct dvb_frontend* dtt200u_fe_attach(struct dvb_usb_device *d)
	155	{
	156	struct dtt200u_fe_state* state = NULL;
	157
	158	/* allocate memory for the internal state */
7408187d	159	state = kzalloc(sizeof(struct dtt200u_fe_state), GFP_KERNEL);
776338e1 JS	160	if (state == NULL)
776338e1 JS	161	goto error;
776338e1 JS	162
	163	deb_info("attaching frontend dtt200u\n");
	164
	165	state->d = d;
43bc3f41	166	memcpy(&state->ops,&dtt200u_fe_ops,sizeof(struct dvb_frontend_ops));
776338e1	167
43bc3f41	168	state->frontend.ops = &state->ops;
776338e1 JS	169	state->frontend.demodulator_priv = state;
	170
	171	goto success;
	172	error:
	173	return NULL;
	174	success:
	175	return &state->frontend;
	176	}
	177
	178	static struct dvb_frontend_ops dtt200u_fe_ops = {
	179	.info = {
d590f9c2	180	.name = "WideView USB DVB-T",
776338e1 JS	181	.type = FE_OFDM,
	182	.frequency_min = 44250000,
	183	.frequency_max = 867250000,
	184	.frequency_stepsize = 250000,
	185	.caps = FE_CAN_INVERSION_AUTO \|
	186	FE_CAN_FEC_1_2 \| FE_CAN_FEC_2_3 \| FE_CAN_FEC_3_4 \|
	187	FE_CAN_FEC_5_6 \| FE_CAN_FEC_7_8 \| FE_CAN_FEC_AUTO \|
	188	FE_CAN_QPSK \| FE_CAN_QAM_16 \| FE_CAN_QAM_64 \| FE_CAN_QAM_AUTO \|
	189	FE_CAN_TRANSMISSION_MODE_AUTO \|
	190	FE_CAN_GUARD_INTERVAL_AUTO \|
	191	FE_CAN_RECOVER \|
	192	FE_CAN_HIERARCHY_AUTO,
	193	},
	194
	195	.release = dtt200u_fe_release,
	196
	197	.init = dtt200u_fe_init,
	198	.sleep = dtt200u_fe_sleep,
	199
	200	.set_frontend = dtt200u_fe_set_frontend,
	201	.get_frontend = dtt200u_fe_get_frontend,
	202	.get_tune_settings = dtt200u_fe_get_tune_settings,
	203
	204	.read_status = dtt200u_fe_read_status,
	205	.read_ber = dtt200u_fe_read_ber,
	206	.read_signal_strength = dtt200u_fe_read_signal_strength,
	207	.read_snr = dtt200u_fe_read_snr,
	208	.read_ucblocks = dtt200u_fe_read_unc_blocks,
	209	};