[linux.git] / drivers / media / dvb-frontends / hd29l2.c

/*
 * HDIC HD29L2 DMB-TH demodulator driver
 *
 * Copyright (C) 2011 Metropolia University of Applied Sciences, Electria R&D
 *
 * Author: Antti Palosaari <[email protected]>
 *
 *    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 "hd29l2_priv.h"

#define HD29L2_MAX_LEN (3)

/* write multiple registers */
static int hd29l2_wr_regs(struct hd29l2_priv *priv, u8 reg, u8 *val, int len)
{
	int ret;
	u8 buf[2 + HD29L2_MAX_LEN];
	struct i2c_msg msg[1] = {
		{
			.addr = priv->cfg.i2c_addr,
			.flags = 0,
			.len = 2 + len,
			.buf = buf,
		}
	};

	if (len > HD29L2_MAX_LEN)
		return -EINVAL;
	buf[0] = 0x00;
	buf[1] = reg;
	memcpy(&buf[2], val, len);

	ret = i2c_transfer(priv->i2c, msg, 1);
	if (ret == 1) {
		ret = 0;
	} else {
		dev_warn(&priv->i2c->dev,
				"%s: i2c wr failed=%d reg=%02x len=%d\n",
				KBUILD_MODNAME, ret, reg, len);
		ret = -EREMOTEIO;
	}

	return ret;
}

/* read multiple registers */
static int hd29l2_rd_regs(struct hd29l2_priv *priv, u8 reg, u8 *val, int len)
{
	int ret;
	u8 buf[2] = { 0x00, reg };
	struct i2c_msg msg[2] = {
		{
			.addr = priv->cfg.i2c_addr,
			.flags = 0,
			.len = 2,
			.buf = buf,
		}, {
			.addr = priv->cfg.i2c_addr,
			.flags = I2C_M_RD,
			.len = len,
			.buf = val,
		}
	};

	ret = i2c_transfer(priv->i2c, msg, 2);
	if (ret == 2) {
		ret = 0;
	} else {
		dev_warn(&priv->i2c->dev,
				"%s: i2c rd failed=%d reg=%02x len=%d\n",
				KBUILD_MODNAME, ret, reg, len);
		ret = -EREMOTEIO;
	}

	return ret;
}

/* write single register */
static int hd29l2_wr_reg(struct hd29l2_priv *priv, u8 reg, u8 val)
{
	return hd29l2_wr_regs(priv, reg, &val, 1);
}

/* read single register */
static int hd29l2_rd_reg(struct hd29l2_priv *priv, u8 reg, u8 *val)
{
	return hd29l2_rd_regs(priv, reg, val, 1);
}

/* write single register with mask */
static int hd29l2_wr_reg_mask(struct hd29l2_priv *priv, u8 reg, u8 val, u8 mask)
{
	int ret;
	u8 tmp;

	/* no need for read if whole reg is written */
	if (mask != 0xff) {
		ret = hd29l2_rd_regs(priv, reg, &tmp, 1);
		if (ret)
			return ret;

		val &= mask;
		tmp &= ~mask;
		val |= tmp;
	}

	return hd29l2_wr_regs(priv, reg, &val, 1);
}

/* read single register with mask */
static int hd29l2_rd_reg_mask(struct hd29l2_priv *priv, u8 reg, u8 *val, u8 mask)
{
	int ret, i;
	u8 tmp;

	ret = hd29l2_rd_regs(priv, reg, &tmp, 1);
	if (ret)
		return ret;

	tmp &= mask;

	/* find position of the first bit */
	for (i = 0; i < 8; i++) {
		if ((mask >> i) & 0x01)
			break;
	}
	*val = tmp >> i;

	return 0;
}

static int hd29l2_soft_reset(struct hd29l2_priv *priv)
{
	int ret;
	u8 tmp;

	ret = hd29l2_rd_reg(priv, 0x26, &tmp);
	if (ret)
		goto err;

	ret = hd29l2_wr_reg(priv, 0x26, 0x0d);
	if (ret)
		goto err;

	usleep_range(10000, 20000);

	ret = hd29l2_wr_reg(priv, 0x26, tmp);
	if (ret)
		goto err;

	return 0;
err:
	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
	return ret;
}

static int hd29l2_i2c_gate_ctrl(struct dvb_frontend *fe, int enable)
{
	int ret, i;
	struct hd29l2_priv *priv = fe->demodulator_priv;
	u8 tmp;

	dev_dbg(&priv->i2c->dev, "%s: enable=%d\n", __func__, enable);

	/* set tuner address for demod */
	if (!priv->tuner_i2c_addr_programmed && enable) {
		/* no need to set tuner address every time, once is enough */
		ret = hd29l2_wr_reg(priv, 0x9d, priv->cfg.tuner_i2c_addr << 1);
		if (ret)
			goto err;

		priv->tuner_i2c_addr_programmed = true;
	}

	/* open / close gate */
	ret = hd29l2_wr_reg(priv, 0x9f, enable);
	if (ret)
		goto err;

	/* wait demod ready */
	for (i = 10; i; i--) {
		ret = hd29l2_rd_reg(priv, 0x9e, &tmp);
		if (ret)
			goto err;

		if (tmp == enable)
			break;

		usleep_range(5000, 10000);
	}

	dev_dbg(&priv->i2c->dev, "%s: loop=%d\n", __func__, i);

	return ret;
err:
	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
	return ret;
}

static int hd29l2_read_status(struct dvb_frontend *fe, enum fe_status *status)
{
	int ret;
	struct hd29l2_priv *priv = fe->demodulator_priv;
	u8 buf[2];

	*status = 0;

	ret = hd29l2_rd_reg(priv, 0x05, &buf[0]);
	if (ret)
		goto err;

	if (buf[0] & 0x01) {
		/* full lock */
		*status |= FE_HAS_SIGNAL | FE_HAS_CARRIER | FE_HAS_VITERBI |
			FE_HAS_SYNC | FE_HAS_LOCK;
	} else {
		ret = hd29l2_rd_reg(priv, 0x0d, &buf[1]);
		if (ret)
			goto err;

		if ((buf[1] & 0xfe) == 0x78)
			/* partial lock */
			*status |= FE_HAS_SIGNAL | FE_HAS_CARRIER |
				FE_HAS_VITERBI | FE_HAS_SYNC;
	}

	priv->fe_status = *status;

	return 0;
err:
	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
	return ret;
}

static int hd29l2_read_snr(struct dvb_frontend *fe, u16 *snr)
{
	int ret;
	struct hd29l2_priv *priv = fe->demodulator_priv;
	u8 buf[2];
	u16 tmp;

	if (!(priv->fe_status & FE_HAS_LOCK)) {
		*snr = 0;
		ret = 0;
		goto err;
	}

	ret = hd29l2_rd_regs(priv, 0x0b, buf, 2);
	if (ret)
		goto err;

	tmp = (buf[0] << 8) | buf[1];

	/* report SNR in dB * 10 */
	#define LOG10_20736_24 72422627 /* log10(20736) << 24 */
	if (tmp)
		*snr = (LOG10_20736_24 - intlog10(tmp)) / ((1 << 24) / 100);
	else
		*snr = 0;

	return 0;
err:
	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
	return ret;
}

static int hd29l2_read_signal_strength(struct dvb_frontend *fe, u16 *strength)
{
	int ret;
	struct hd29l2_priv *priv = fe->demodulator_priv;
	u8 buf[2];
	u16 tmp;

	*strength = 0;

	ret = hd29l2_rd_regs(priv, 0xd5, buf, 2);
	if (ret)
		goto err;

	tmp = buf[0] << 8 | buf[1];
	tmp = ~tmp & 0x0fff;

	/* scale value to 0x0000-0xffff from 0x0000-0x0fff */
	*strength = tmp * 0xffff / 0x0fff;

	return 0;
err:
	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
	return ret;
}

static int hd29l2_read_ber(struct dvb_frontend *fe, u32 *ber)
{
	int ret;
	struct hd29l2_priv *priv = fe->demodulator_priv;
	u8 buf[2];

	if (!(priv->fe_status & FE_HAS_SYNC)) {
		*ber = 0;
		ret = 0;
		goto err;
	}

	ret = hd29l2_rd_regs(priv, 0xd9, buf, 2);
	if (ret) {
		*ber = 0;
		goto err;
	}

	/* LDPC BER */
	*ber = ((buf[0] & 0x0f) << 8) | buf[1];

	return 0;
err:
	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
	return ret;
}

static int hd29l2_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
{
	/* no way to read? */
	*ucblocks = 0;
	return 0;
}

static enum dvbfe_search hd29l2_search(struct dvb_frontend *fe)
{
	int ret, i;
	struct hd29l2_priv *priv = fe->demodulator_priv;
	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
	u8 tmp, buf[3];
	u8 modulation, carrier, guard_interval, interleave, code_rate;
	u64 num64;
	u32 if_freq, if_ctl;
	bool auto_mode;

	dev_dbg(&priv->i2c->dev, "%s: delivery_system=%d frequency=%d " \
			"bandwidth_hz=%d modulation=%d inversion=%d " \
			"fec_inner=%d guard_interval=%d\n", __func__,
			c->delivery_system, c->frequency, c->bandwidth_hz,
			c->modulation, c->inversion, c->fec_inner,
			c->guard_interval);

	/* as for now we detect always params automatically */
	auto_mode = true;

	/* program tuner */
	if (fe->ops.tuner_ops.set_params)
		fe->ops.tuner_ops.set_params(fe);

	/* get and program IF */
	if (fe->ops.tuner_ops.get_if_frequency)
		fe->ops.tuner_ops.get_if_frequency(fe, &if_freq);
	else
		if_freq = 0;

	if (if_freq) {
		/* normal IF */

		/* calc IF control value */
		num64 = if_freq;
		num64 *= 0x800000;
		num64 = div_u64(num64, HD29L2_XTAL);
		num64 -= 0x800000;
		if_ctl = num64;

		tmp = 0xfc; /* tuner type normal */
	} else {
		/* zero IF */
		if_ctl = 0;
		tmp = 0xfe; /* tuner type Zero-IF */
	}

	buf[0] = ((if_ctl >>  0) & 0xff);
	buf[1] = ((if_ctl >>  8) & 0xff);
	buf[2] = ((if_ctl >> 16) & 0xff);

	/* program IF control */
	ret = hd29l2_wr_regs(priv, 0x14, buf, 3);
	if (ret)
		goto err;

	/* program tuner type */
	ret = hd29l2_wr_reg(priv, 0xab, tmp);
	if (ret)
		goto err;

	dev_dbg(&priv->i2c->dev, "%s: if_freq=%d if_ctl=%x\n",
			__func__, if_freq, if_ctl);

	if (auto_mode) {
		/*
		 * use auto mode
		 */

		/* disable quick mode */
		ret = hd29l2_wr_reg_mask(priv, 0xac, 0 << 7, 0x80);
		if (ret)
			goto err;

		ret = hd29l2_wr_reg_mask(priv, 0x82, 1 << 1, 0x02);
		if (ret)
			goto err;

		/* enable auto mode */
		ret = hd29l2_wr_reg_mask(priv, 0x7d, 1 << 6, 0x40);
		if (ret)
			goto err;

		ret = hd29l2_wr_reg_mask(priv, 0x81, 1 << 3, 0x08);
		if (ret)
			goto err;

		/* soft reset */
		ret = hd29l2_soft_reset(priv);
		if (ret)
			goto err;

		/* detect modulation */
		for (i = 30; i; i--) {
			msleep(100);

			ret = hd29l2_rd_reg(priv, 0x0d, &tmp);
			if (ret)
				goto err;

			if ((((tmp & 0xf0) >= 0x10) &&
				((tmp & 0x0f) == 0x08)) || (tmp >= 0x2c))
				break;
		}

		dev_dbg(&priv->i2c->dev, "%s: loop=%d\n", __func__, i);

		if (i == 0)
			/* detection failed */
			return DVBFE_ALGO_SEARCH_FAILED;

		/* read modulation */
		ret = hd29l2_rd_reg_mask(priv, 0x7d, &modulation, 0x07);
		if (ret)
			goto err;
	} else {
		/*
		 * use manual mode
		 */

		modulation = HD29L2_QAM64;
		carrier = HD29L2_CARRIER_MULTI;
		guard_interval = HD29L2_PN945;
		interleave = HD29L2_INTERLEAVER_420;
		code_rate = HD29L2_CODE_RATE_08;

		tmp = (code_rate << 3) | modulation;
		ret = hd29l2_wr_reg_mask(priv, 0x7d, tmp, 0x5f);
		if (ret)
			goto err;

		tmp = (carrier << 2) | guard_interval;
		ret = hd29l2_wr_reg_mask(priv, 0x81, tmp, 0x0f);
		if (ret)
			goto err;

		tmp = interleave;
		ret = hd29l2_wr_reg_mask(priv, 0x82, tmp, 0x03);
		if (ret)
			goto err;
	}

	/* ensure modulation validy */
	/* 0=QAM4_NR, 1=QAM4, 2=QAM16, 3=QAM32, 4=QAM64 */
	if (modulation > (ARRAY_SIZE(reg_mod_vals_tab[0].val) - 1)) {
		dev_dbg(&priv->i2c->dev, "%s: modulation=%d not valid\n",
				__func__, modulation);
		goto err;
	}

	/* program registers according to modulation */
	for (i = 0; i < ARRAY_SIZE(reg_mod_vals_tab); i++) {
		ret = hd29l2_wr_reg(priv, reg_mod_vals_tab[i].reg,
			reg_mod_vals_tab[i].val[modulation]);
		if (ret)
			goto err;
	}

	/* read guard interval */
	ret = hd29l2_rd_reg_mask(priv, 0x81, &guard_interval, 0x03);
	if (ret)
		goto err;

	/* read carrier mode */
	ret = hd29l2_rd_reg_mask(priv, 0x81, &carrier, 0x04);
	if (ret)
		goto err;

	dev_dbg(&priv->i2c->dev,
			"%s: modulation=%d guard_interval=%d carrier=%d\n",
			__func__, modulation, guard_interval, carrier);

	if ((carrier == HD29L2_CARRIER_MULTI) && (modulation == HD29L2_QAM64) &&
		(guard_interval == HD29L2_PN945)) {
		dev_dbg(&priv->i2c->dev, "%s: C=3780 && QAM64 && PN945\n",
				__func__);

		ret = hd29l2_wr_reg(priv, 0x42, 0x33);
		if (ret)
			goto err;

		ret = hd29l2_wr_reg(priv, 0xdd, 0x01);
		if (ret)
			goto err;
	}

	usleep_range(10000, 20000);

	/* soft reset */
	ret = hd29l2_soft_reset(priv);
	if (ret)
		goto err;

	/* wait demod lock */
	for (i = 30; i; i--) {
		msleep(100);

		/* read lock bit */
		ret = hd29l2_rd_reg_mask(priv, 0x05, &tmp, 0x01);
		if (ret)
			goto err;

		if (tmp)
			break;
	}

	dev_dbg(&priv->i2c->dev, "%s: loop=%d\n", __func__, i);

	if (i == 0)
		return DVBFE_ALGO_SEARCH_AGAIN;

	return DVBFE_ALGO_SEARCH_SUCCESS;
err:
	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
	return DVBFE_ALGO_SEARCH_ERROR;
}

static int hd29l2_get_frontend_algo(struct dvb_frontend *fe)
{
	return DVBFE_ALGO_CUSTOM;
}

static int hd29l2_get_frontend(struct dvb_frontend *fe,
			       struct dtv_frontend_properties *c)
{
	int ret;
	struct hd29l2_priv *priv = fe->demodulator_priv;
	u8 buf[3];
	u32 if_ctl;
	char *str_constellation, *str_code_rate, *str_constellation_code_rate,
		*str_guard_interval, *str_carrier, *str_guard_interval_carrier,
		*str_interleave, *str_interleave_;

	ret = hd29l2_rd_reg(priv, 0x7d, &buf[0]);
	if (ret)
		goto err;

	ret = hd29l2_rd_regs(priv, 0x81, &buf[1], 2);
	if (ret)
		goto err;

	/* constellation, 0x7d[2:0] */
	switch ((buf[0] >> 0) & 0x07) {
	case 0: /* QAM4NR */
		str_constellation = "QAM4NR";
		c->modulation = QAM_AUTO; /* FIXME */
		break;
	case 1: /* QAM4 */
		str_constellation = "QAM4";
		c->modulation = QPSK; /* FIXME */
		break;
	case 2:
		str_constellation = "QAM16";
		c->modulation = QAM_16;
		break;
	case 3:
		str_constellation = "QAM32";
		c->modulation = QAM_32;
		break;
	case 4:
		str_constellation = "QAM64";
		c->modulation = QAM_64;
		break;
	default:
		str_constellation = "?";
	}

	/* LDPC code rate, 0x7d[4:3] */
	switch ((buf[0] >> 3) & 0x03) {
	case 0: /* 0.4 */
		str_code_rate = "0.4";
		c->fec_inner = FEC_AUTO; /* FIXME */
		break;
	case 1: /* 0.6 */
		str_code_rate = "0.6";
		c->fec_inner = FEC_3_5;
		break;
	case 2: /* 0.8 */
		str_code_rate = "0.8";
		c->fec_inner = FEC_4_5;
		break;
	default:
		str_code_rate = "?";
	}

	/* constellation & code rate set, 0x7d[6] */
	switch ((buf[0] >> 6) & 0x01) {
	case 0:
		str_constellation_code_rate = "manual";
		break;
	case 1:
		str_constellation_code_rate = "auto";
		break;
	default:
		str_constellation_code_rate = "?";
	}

	/* frame header, 0x81[1:0] */
	switch ((buf[1] >> 0) & 0x03) {
	case 0: /* PN945 */
		str_guard_interval = "PN945";
		c->guard_interval = GUARD_INTERVAL_AUTO; /* FIXME */
		break;
	case 1: /* PN595 */
		str_guard_interval = "PN595";
		c->guard_interval = GUARD_INTERVAL_AUTO; /* FIXME */
		break;
	case 2: /* PN420 */
		str_guard_interval = "PN420";
		c->guard_interval = GUARD_INTERVAL_AUTO; /* FIXME */
		break;
	default:
		str_guard_interval = "?";
	}

	/* carrier, 0x81[2] */
	switch ((buf[1] >> 2) & 0x01) {
	case 0:
		str_carrier = "C=1";
		break;
	case 1:
		str_carrier = "C=3780";
		break;
	default:
		str_carrier = "?";
	}

	/* frame header & carrier set, 0x81[3] */
	switch ((buf[1] >> 3) & 0x01) {
	case 0:
		str_guard_interval_carrier = "manual";
		break;
	case 1:
		str_guard_interval_carrier = "auto";
		break;
	default:
		str_guard_interval_carrier = "?";
	}

	/* interleave, 0x82[0] */
	switch ((buf[2] >> 0) & 0x01) {
	case 0:
		str_interleave = "M=720";
		break;
	case 1:
		str_interleave = "M=240";
		break;
	default:
		str_interleave = "?";
	}

	/* interleave set, 0x82[1] */
	switch ((buf[2] >> 1) & 0x01) {
	case 0:
		str_interleave_ = "manual";
		break;
	case 1:
		str_interleave_ = "auto";
		break;
	default:
		str_interleave_ = "?";
	}

	/*
	 * We can read out current detected NCO and use that value next
	 * time instead of calculating new value from targed IF.
	 * I think it will not effect receiver sensitivity but gaining lock
	 * after tune could be easier...
	 */
	ret = hd29l2_rd_regs(priv, 0xb1, &buf[0], 3);
	if (ret)
		goto err;

	if_ctl = (buf[0] << 16) | ((buf[1] - 7) << 8) | buf[2];

	dev_dbg(&priv->i2c->dev, "%s: %s %s %s | %s %s %s | %s %s | NCO=%06x\n",
			__func__, str_constellation, str_code_rate,
			str_constellation_code_rate, str_guard_interval,
			str_carrier, str_guard_interval_carrier, str_interleave,
			str_interleave_, if_ctl);
	return 0;
err:
	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
	return ret;
}

static int hd29l2_init(struct dvb_frontend *fe)
{
	int ret, i;
	struct hd29l2_priv *priv = fe->demodulator_priv;
	u8 tmp;
	static const struct reg_val tab[] = {
		{ 0x3a, 0x06 },
		{ 0x3b, 0x03 },
		{ 0x3c, 0x04 },
		{ 0xaf, 0x06 },
		{ 0xb0, 0x1b },
		{ 0x80, 0x64 },
		{ 0x10, 0x38 },
	};

	dev_dbg(&priv->i2c->dev, "%s:\n", __func__);

	/* reset demod */
	/* it is recommended to HW reset chip using RST_N pin */
	if (fe->callback) {
		ret = fe->callback(fe, DVB_FRONTEND_COMPONENT_DEMOD, 0, 0);
		if (ret)
			goto err;

		/* reprogramming needed because HW reset clears registers */
		priv->tuner_i2c_addr_programmed = false;
	}

	/* init */
	for (i = 0; i < ARRAY_SIZE(tab); i++) {
		ret = hd29l2_wr_reg(priv, tab[i].reg, tab[i].val);
		if (ret)
			goto err;
	}

	/* TS params */
	ret = hd29l2_rd_reg(priv, 0x36, &tmp);
	if (ret)
		goto err;

	tmp &= 0x1b;
	tmp |= priv->cfg.ts_mode;
	ret = hd29l2_wr_reg(priv, 0x36, tmp);
	if (ret)
		goto err;

	ret = hd29l2_rd_reg(priv, 0x31, &tmp);
	tmp &= 0xef;

	if (!(priv->cfg.ts_mode >> 7))
		/* set b4 for serial TS */
		tmp |= 0x10;

	ret = hd29l2_wr_reg(priv, 0x31, tmp);
	if (ret)
		goto err;

	return ret;
err:
	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
	return ret;
}

static void hd29l2_release(struct dvb_frontend *fe)
{
	struct hd29l2_priv *priv = fe->demodulator_priv;
	kfree(priv);
}

static struct dvb_frontend_ops hd29l2_ops;

struct dvb_frontend *hd29l2_attach(const struct hd29l2_config *config,
	struct i2c_adapter *i2c)
{
	int ret;
	struct hd29l2_priv *priv = NULL;
	u8 tmp;

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

	/* setup the state */
	priv->i2c = i2c;
	memcpy(&priv->cfg, config, sizeof(struct hd29l2_config));


	/* check if the demod is there */
	ret = hd29l2_rd_reg(priv, 0x00, &tmp);
	if (ret)
		goto err;

	/* create dvb_frontend */
	memcpy(&priv->fe.ops, &hd29l2_ops, sizeof(struct dvb_frontend_ops));
	priv->fe.demodulator_priv = priv;

	return &priv->fe;
err:
	kfree(priv);
	return NULL;
}
EXPORT_SYMBOL(hd29l2_attach);

static struct dvb_frontend_ops hd29l2_ops = {
	.delsys = { SYS_DVBT },
	.info = {
		.name = "HDIC HD29L2 DMB-TH",
		.frequency_min = 474000000,
		.frequency_max = 858000000,
		.frequency_stepsize = 10000,
		.caps = FE_CAN_FEC_AUTO |
			FE_CAN_QPSK |
			FE_CAN_QAM_16 |
			FE_CAN_QAM_32 |
			FE_CAN_QAM_64 |
			FE_CAN_QAM_AUTO |
			FE_CAN_TRANSMISSION_MODE_AUTO |
			FE_CAN_BANDWIDTH_AUTO |
			FE_CAN_GUARD_INTERVAL_AUTO |
			FE_CAN_HIERARCHY_AUTO |
			FE_CAN_RECOVER
	},

	.release = hd29l2_release,

	.init = hd29l2_init,

	.get_frontend_algo = hd29l2_get_frontend_algo,
	.search = hd29l2_search,
	.get_frontend = hd29l2_get_frontend,

	.read_status = hd29l2_read_status,
	.read_snr = hd29l2_read_snr,
	.read_signal_strength = hd29l2_read_signal_strength,
	.read_ber = hd29l2_read_ber,
	.read_ucblocks = hd29l2_read_ucblocks,

	.i2c_gate_ctrl = hd29l2_i2c_gate_ctrl,
};

MODULE_AUTHOR("Antti Palosaari <[email protected]>");
MODULE_DESCRIPTION("HDIC HD29L2 DMB-TH demodulator driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
ee9b8c8c AP	1	/*
	2	* HDIC HD29L2 DMB-TH demodulator driver
	3	*
	4	* Copyright (C) 2011 Metropolia University of Applied Sciences, Electria R&D
	5	*
	6	* Author: Antti Palosaari <[email protected]>
	7	*
	8	* This program is free software; you can redistribute it and/or modify
	9	* it under the terms of the GNU General Public License as published by
	10	* the Free Software Foundation; either version 2 of the License, or
	11	* (at your option) any later version.
	12	*
	13	* This program is distributed in the hope that it will be useful,
	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	16	* GNU General Public License for more details.
	17	*
	18	* You should have received a copy of the GNU General Public License
	19	* along with this program; if not, write to the Free Software
	20	* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
	21	*/
	22
	23	#include "hd29l2_priv.h"
	24
50fd5e8c HV	25	#define HD29L2_MAX_LEN (3)
50fd5e8c HV	26
ee9b8c8c AP	27	/* write multiple registers */
	28	static int hd29l2_wr_regs(struct hd29l2_priv priv, u8 reg, u8 val, int len)
	29	{
	30	int ret;
50fd5e8c	31	u8 buf[2 + HD29L2_MAX_LEN];
ee9b8c8c AP	32	struct i2c_msg msg[1] = {
	33	{
	34	.addr = priv->cfg.i2c_addr,
	35	.flags = 0,
50fd5e8c	36	.len = 2 + len,
ee9b8c8c AP	37	.buf = buf,
	38	}
	39	};
	40
50fd5e8c HV	41	if (len > HD29L2_MAX_LEN)
50fd5e8c HV	42	return -EINVAL;
ee9b8c8c AP	43	buf[0] = 0x00;
	44	buf[1] = reg;
	45	memcpy(&buf[2], val, len);
	46
	47	ret = i2c_transfer(priv->i2c, msg, 1);
	48	if (ret == 1) {
	49	ret = 0;
	50	} else {
a44850df AP	51	dev_warn(&priv->i2c->dev,
	52	"%s: i2c wr failed=%d reg=%02x len=%d\n",
	53	KBUILD_MODNAME, ret, reg, len);
ee9b8c8c AP	54	ret = -EREMOTEIO;
	55	}
	56
	57	return ret;
	58	}
	59
	60	/* read multiple registers */
	61	static int hd29l2_rd_regs(struct hd29l2_priv priv, u8 reg, u8 val, int len)
	62	{
	63	int ret;
	64	u8 buf[2] = { 0x00, reg };
	65	struct i2c_msg msg[2] = {
	66	{
	67	.addr = priv->cfg.i2c_addr,
	68	.flags = 0,
	69	.len = 2,
	70	.buf = buf,
	71	}, {
	72	.addr = priv->cfg.i2c_addr,
	73	.flags = I2C_M_RD,
	74	.len = len,
	75	.buf = val,
	76	}
	77	};
	78
	79	ret = i2c_transfer(priv->i2c, msg, 2);
	80	if (ret == 2) {
	81	ret = 0;
	82	} else {
a44850df AP	83	dev_warn(&priv->i2c->dev,
	84	"%s: i2c rd failed=%d reg=%02x len=%d\n",
	85	KBUILD_MODNAME, ret, reg, len);
ee9b8c8c AP	86	ret = -EREMOTEIO;
	87	}
	88
	89	return ret;
	90	}
	91
	92	/* write single register */
	93	static int hd29l2_wr_reg(struct hd29l2_priv *priv, u8 reg, u8 val)
	94	{
	95	return hd29l2_wr_regs(priv, reg, &val, 1);
	96	}
	97
	98	/* read single register */
	99	static int hd29l2_rd_reg(struct hd29l2_priv priv, u8 reg, u8 val)
	100	{
	101	return hd29l2_rd_regs(priv, reg, val, 1);
	102	}
	103
	104	/* write single register with mask */
	105	static int hd29l2_wr_reg_mask(struct hd29l2_priv *priv, u8 reg, u8 val, u8 mask)
	106	{
	107	int ret;
	108	u8 tmp;
	109
	110	/* no need for read if whole reg is written */
	111	if (mask != 0xff) {
	112	ret = hd29l2_rd_regs(priv, reg, &tmp, 1);
	113	if (ret)
	114	return ret;
	115
	116	val &= mask;
	117	tmp &= ~mask;
	118	val \|= tmp;
	119	}
	120
	121	return hd29l2_wr_regs(priv, reg, &val, 1);
	122	}
	123
	124	/* read single register with mask */
50fd5e8c	125	static int hd29l2_rd_reg_mask(struct hd29l2_priv priv, u8 reg, u8 val, u8 mask)
ee9b8c8c AP	126	{
	127	int ret, i;
	128	u8 tmp;
	129
	130	ret = hd29l2_rd_regs(priv, reg, &tmp, 1);
	131	if (ret)
	132	return ret;
	133
	134	tmp &= mask;
	135
	136	/* find position of the first bit */
	137	for (i = 0; i < 8; i++) {
	138	if ((mask >> i) & 0x01)
	139	break;
	140	}
	141	*val = tmp >> i;
	142
	143	return 0;
	144	}
	145
	146	static int hd29l2_soft_reset(struct hd29l2_priv *priv)
	147	{
	148	int ret;
	149	u8 tmp;
	150
	151	ret = hd29l2_rd_reg(priv, 0x26, &tmp);
	152	if (ret)
	153	goto err;
	154
	155	ret = hd29l2_wr_reg(priv, 0x26, 0x0d);
	156	if (ret)
	157	goto err;
	158
	159	usleep_range(10000, 20000);
	160
	161	ret = hd29l2_wr_reg(priv, 0x26, tmp);
	162	if (ret)
	163	goto err;
	164
	165	return 0;
	166	err:
a44850df	167	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
ee9b8c8c AP	168	return ret;
	169	}
	170
	171	static int hd29l2_i2c_gate_ctrl(struct dvb_frontend *fe, int enable)
	172	{
	173	int ret, i;
	174	struct hd29l2_priv *priv = fe->demodulator_priv;
	175	u8 tmp;
	176
a44850df	177	dev_dbg(&priv->i2c->dev, "%s: enable=%d\n", __func__, enable);
ee9b8c8c AP	178
	179	/* set tuner address for demod */
	180	if (!priv->tuner_i2c_addr_programmed && enable) {
	181	/* no need to set tuner address every time, once is enough */
	182	ret = hd29l2_wr_reg(priv, 0x9d, priv->cfg.tuner_i2c_addr << 1);
	183	if (ret)
	184	goto err;
	185
	186	priv->tuner_i2c_addr_programmed = true;
	187	}
	188
	189	/* open / close gate */
	190	ret = hd29l2_wr_reg(priv, 0x9f, enable);
	191	if (ret)
	192	goto err;
	193
	194	/* wait demod ready */
	195	for (i = 10; i; i--) {
	196	ret = hd29l2_rd_reg(priv, 0x9e, &tmp);
	197	if (ret)
	198	goto err;
	199
	200	if (tmp == enable)
	201	break;
	202
	203	usleep_range(5000, 10000);
	204	}
	205
a44850df	206	dev_dbg(&priv->i2c->dev, "%s: loop=%d\n", __func__, i);
ee9b8c8c AP	207
	208	return ret;
	209	err:
a44850df	210	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
ee9b8c8c AP	211	return ret;
	212	}
	213
0df289a2	214	static int hd29l2_read_status(struct dvb_frontend fe, enum fe_status status)
ee9b8c8c AP	215	{
	216	int ret;
	217	struct hd29l2_priv *priv = fe->demodulator_priv;
	218	u8 buf[2];
	219
	220	*status = 0;
	221
	222	ret = hd29l2_rd_reg(priv, 0x05, &buf[0]);
	223	if (ret)
	224	goto err;
	225
	226	if (buf[0] & 0x01) {
	227	/* full lock */
	228	*status \|= FE_HAS_SIGNAL \| FE_HAS_CARRIER \| FE_HAS_VITERBI \|
	229	FE_HAS_SYNC \| FE_HAS_LOCK;
	230	} else {
	231	ret = hd29l2_rd_reg(priv, 0x0d, &buf[1]);
	232	if (ret)
	233	goto err;
	234
	235	if ((buf[1] & 0xfe) == 0x78)
	236	/* partial lock */
	237	*status \|= FE_HAS_SIGNAL \| FE_HAS_CARRIER \|
	238	FE_HAS_VITERBI \| FE_HAS_SYNC;
	239	}
	240
	241	priv->fe_status = *status;
	242
	243	return 0;
	244	err:
a44850df	245	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
ee9b8c8c AP	246	return ret;
	247	}
	248
	249	static int hd29l2_read_snr(struct dvb_frontend fe, u16 snr)
	250	{
	251	int ret;
	252	struct hd29l2_priv *priv = fe->demodulator_priv;
	253	u8 buf[2];
	254	u16 tmp;
	255
	256	if (!(priv->fe_status & FE_HAS_LOCK)) {
	257	*snr = 0;
	258	ret = 0;
	259	goto err;
	260	}
	261
	262	ret = hd29l2_rd_regs(priv, 0x0b, buf, 2);
	263	if (ret)
	264	goto err;
	265
	266	tmp = (buf[0] << 8) \| buf[1];
	267
	268	/* report SNR in dB * 10 */
	269	#define LOG10_20736_24 72422627 /* log10(20736) << 24 */
	270	if (tmp)
	271	*snr = (LOG10_20736_24 - intlog10(tmp)) / ((1 << 24) / 100);
	272	else
	273	*snr = 0;
	274
	275	return 0;
	276	err:
a44850df	277	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
ee9b8c8c AP	278	return ret;
	279	}
	280
	281	static int hd29l2_read_signal_strength(struct dvb_frontend fe, u16 strength)
	282	{
	283	int ret;
	284	struct hd29l2_priv *priv = fe->demodulator_priv;
	285	u8 buf[2];
	286	u16 tmp;
	287
	288	*strength = 0;
	289
	290	ret = hd29l2_rd_regs(priv, 0xd5, buf, 2);
	291	if (ret)
	292	goto err;
	293
	294	tmp = buf[0] << 8 \| buf[1];
	295	tmp = ~tmp & 0x0fff;
	296
	297	/* scale value to 0x0000-0xffff from 0x0000-0x0fff */
	298	strength = tmp 0xffff / 0x0fff;
	299
	300	return 0;
	301	err:
a44850df	302	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
ee9b8c8c AP	303	return ret;
	304	}
	305
	306	static int hd29l2_read_ber(struct dvb_frontend fe, u32 ber)
	307	{
	308	int ret;
	309	struct hd29l2_priv *priv = fe->demodulator_priv;
	310	u8 buf[2];
	311
	312	if (!(priv->fe_status & FE_HAS_SYNC)) {
	313	*ber = 0;
	314	ret = 0;
	315	goto err;
	316	}
	317
	318	ret = hd29l2_rd_regs(priv, 0xd9, buf, 2);
	319	if (ret) {
	320	*ber = 0;
	321	goto err;
	322	}
	323
	324	/* LDPC BER */
	325	*ber = ((buf[0] & 0x0f) << 8) \| buf[1];
	326
	327	return 0;
	328	err:
a44850df	329	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
ee9b8c8c AP	330	return ret;
	331	}
	332
	333	static int hd29l2_read_ucblocks(struct dvb_frontend fe, u32 ucblocks)
	334	{
	335	/* no way to read? */
	336	*ucblocks = 0;
	337	return 0;
	338	}
	339
6964c308	340	static enum dvbfe_search hd29l2_search(struct dvb_frontend *fe)
ee9b8c8c AP	341	{
	342	int ret, i;
	343	struct hd29l2_priv *priv = fe->demodulator_priv;
	344	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
	345	u8 tmp, buf[3];
	346	u8 modulation, carrier, guard_interval, interleave, code_rate;
	347	u64 num64;
	348	u32 if_freq, if_ctl;
	349	bool auto_mode;
	350
a44850df AP	351	dev_dbg(&priv->i2c->dev, "%s: delivery_system=%d frequency=%d " \
	352	"bandwidth_hz=%d modulation=%d inversion=%d " \
	353	"fec_inner=%d guard_interval=%d\n", __func__,
	354	c->delivery_system, c->frequency, c->bandwidth_hz,
	355	c->modulation, c->inversion, c->fec_inner,
	356	c->guard_interval);
ee9b8c8c AP	357
	358	/* as for now we detect always params automatically */
	359	auto_mode = true;
	360
	361	/* program tuner */
	362	if (fe->ops.tuner_ops.set_params)
6964c308	363	fe->ops.tuner_ops.set_params(fe);
ee9b8c8c AP	364
	365	/* get and program IF */
	366	if (fe->ops.tuner_ops.get_if_frequency)
	367	fe->ops.tuner_ops.get_if_frequency(fe, &if_freq);
	368	else
	369	if_freq = 0;
	370
	371	if (if_freq) {
	372	/* normal IF */
	373
	374	/* calc IF control value */
	375	num64 = if_freq;
	376	num64 *= 0x800000;
	377	num64 = div_u64(num64, HD29L2_XTAL);
	378	num64 -= 0x800000;
	379	if_ctl = num64;
	380
	381	tmp = 0xfc; /* tuner type normal */
	382	} else {
	383	/* zero IF */
	384	if_ctl = 0;
	385	tmp = 0xfe; /* tuner type Zero-IF */
	386	}
	387
	388	buf[0] = ((if_ctl >> 0) & 0xff);
	389	buf[1] = ((if_ctl >> 8) & 0xff);
	390	buf[2] = ((if_ctl >> 16) & 0xff);
	391
	392	/* program IF control */
	393	ret = hd29l2_wr_regs(priv, 0x14, buf, 3);
	394	if (ret)
	395	goto err;
	396
	397	/* program tuner type */
	398	ret = hd29l2_wr_reg(priv, 0xab, tmp);
	399	if (ret)
	400	goto err;
	401
a44850df AP	402	dev_dbg(&priv->i2c->dev, "%s: if_freq=%d if_ctl=%x\n",
a44850df AP	403	__func__, if_freq, if_ctl);
ee9b8c8c AP	404
	405	if (auto_mode) {
	406	/*
	407	* use auto mode
	408	*/
	409
	410	/* disable quick mode */
	411	ret = hd29l2_wr_reg_mask(priv, 0xac, 0 << 7, 0x80);
	412	if (ret)
	413	goto err;
	414
	415	ret = hd29l2_wr_reg_mask(priv, 0x82, 1 << 1, 0x02);
	416	if (ret)
	417	goto err;
	418
	419	/* enable auto mode */
	420	ret = hd29l2_wr_reg_mask(priv, 0x7d, 1 << 6, 0x40);
	421	if (ret)
	422	goto err;
	423
	424	ret = hd29l2_wr_reg_mask(priv, 0x81, 1 << 3, 0x08);
	425	if (ret)
	426	goto err;
	427
	428	/* soft reset */
	429	ret = hd29l2_soft_reset(priv);
	430	if (ret)
	431	goto err;
	432
	433	/* detect modulation */
	434	for (i = 30; i; i--) {
	435	msleep(100);
	436
	437	ret = hd29l2_rd_reg(priv, 0x0d, &tmp);
	438	if (ret)
	439	goto err;
	440
	441	if ((((tmp & 0xf0) >= 0x10) &&
	442	((tmp & 0x0f) == 0x08)) \|\| (tmp >= 0x2c))
	443	break;
	444	}
	445
a44850df	446	dev_dbg(&priv->i2c->dev, "%s: loop=%d\n", __func__, i);
ee9b8c8c AP	447
	448	if (i == 0)
	449	/* detection failed */
	450	return DVBFE_ALGO_SEARCH_FAILED;
	451
	452	/* read modulation */
	453	ret = hd29l2_rd_reg_mask(priv, 0x7d, &modulation, 0x07);
	454	if (ret)
	455	goto err;
	456	} else {
	457	/*
	458	* use manual mode
	459	*/
	460
	461	modulation = HD29L2_QAM64;
	462	carrier = HD29L2_CARRIER_MULTI;
	463	guard_interval = HD29L2_PN945;
	464	interleave = HD29L2_INTERLEAVER_420;
	465	code_rate = HD29L2_CODE_RATE_08;
	466
	467	tmp = (code_rate << 3) \| modulation;
	468	ret = hd29l2_wr_reg_mask(priv, 0x7d, tmp, 0x5f);
	469	if (ret)
	470	goto err;
	471
	472	tmp = (carrier << 2) \| guard_interval;
	473	ret = hd29l2_wr_reg_mask(priv, 0x81, tmp, 0x0f);
	474	if (ret)
	475	goto err;
	476
	477	tmp = interleave;
	478	ret = hd29l2_wr_reg_mask(priv, 0x82, tmp, 0x03);
	479	if (ret)
	480	goto err;
	481	}
	482
	483	/* ensure modulation validy */
	484	/* 0=QAM4_NR, 1=QAM4, 2=QAM16, 3=QAM32, 4=QAM64 */
dab734ec	485	if (modulation > (ARRAY_SIZE(reg_mod_vals_tab[0].val) - 1)) {
a44850df AP	486	dev_dbg(&priv->i2c->dev, "%s: modulation=%d not valid\n",
a44850df AP	487	__func__, modulation);
ee9b8c8c AP	488	goto err;
	489	}
	490
	491	/* program registers according to modulation */
	492	for (i = 0; i < ARRAY_SIZE(reg_mod_vals_tab); i++) {
	493	ret = hd29l2_wr_reg(priv, reg_mod_vals_tab[i].reg,
	494	reg_mod_vals_tab[i].val[modulation]);
	495	if (ret)
	496	goto err;
	497	}
	498
	499	/* read guard interval */
	500	ret = hd29l2_rd_reg_mask(priv, 0x81, &guard_interval, 0x03);
	501	if (ret)
	502	goto err;
	503
	504	/* read carrier mode */
	505	ret = hd29l2_rd_reg_mask(priv, 0x81, &carrier, 0x04);
	506	if (ret)
	507	goto err;
	508
a44850df AP	509	dev_dbg(&priv->i2c->dev,
	510	"%s: modulation=%d guard_interval=%d carrier=%d\n",
	511	__func__, modulation, guard_interval, carrier);
ee9b8c8c AP	512
	513	if ((carrier == HD29L2_CARRIER_MULTI) && (modulation == HD29L2_QAM64) &&
	514	(guard_interval == HD29L2_PN945)) {
a44850df AP	515	dev_dbg(&priv->i2c->dev, "%s: C=3780 && QAM64 && PN945\n",
a44850df AP	516	__func__);
ee9b8c8c AP	517
	518	ret = hd29l2_wr_reg(priv, 0x42, 0x33);
	519	if (ret)
	520	goto err;
	521
	522	ret = hd29l2_wr_reg(priv, 0xdd, 0x01);
	523	if (ret)
	524	goto err;
	525	}
	526
	527	usleep_range(10000, 20000);
	528
	529	/* soft reset */
	530	ret = hd29l2_soft_reset(priv);
	531	if (ret)
	532	goto err;
	533
	534	/* wait demod lock */
	535	for (i = 30; i; i--) {
	536	msleep(100);
	537
	538	/* read lock bit */
	539	ret = hd29l2_rd_reg_mask(priv, 0x05, &tmp, 0x01);
	540	if (ret)
	541	goto err;
	542
	543	if (tmp)
	544	break;
	545	}
	546
a44850df	547	dev_dbg(&priv->i2c->dev, "%s: loop=%d\n", __func__, i);
ee9b8c8c AP	548
	549	if (i == 0)
	550	return DVBFE_ALGO_SEARCH_AGAIN;
	551
	552	return DVBFE_ALGO_SEARCH_SUCCESS;
	553	err:
a44850df	554	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
ee9b8c8c AP	555	return DVBFE_ALGO_SEARCH_ERROR;
	556	}
	557
	558	static int hd29l2_get_frontend_algo(struct dvb_frontend *fe)
	559	{
	560	return DVBFE_ALGO_CUSTOM;
	561	}
	562
7e3e68bc MCC	563	static int hd29l2_get_frontend(struct dvb_frontend *fe,
7e3e68bc MCC	564	struct dtv_frontend_properties *c)
ee9b8c8c AP	565	{
	566	int ret;
	567	struct hd29l2_priv *priv = fe->demodulator_priv;
ee9b8c8c AP	568	u8 buf[3];
	569	u32 if_ctl;
	570	char str_constellation, str_code_rate, *str_constellation_code_rate,
	571	str_guard_interval, str_carrier, *str_guard_interval_carrier,
	572	str_interleave, str_interleave_;
	573
	574	ret = hd29l2_rd_reg(priv, 0x7d, &buf[0]);
	575	if (ret)
	576	goto err;
	577
	578	ret = hd29l2_rd_regs(priv, 0x81, &buf[1], 2);
	579	if (ret)
	580	goto err;
	581
	582	/* constellation, 0x7d[2:0] */
	583	switch ((buf[0] >> 0) & 0x07) {
	584	case 0: /* QAM4NR */
	585	str_constellation = "QAM4NR";
	586	c->modulation = QAM_AUTO; /* FIXME */
	587	break;
	588	case 1: /* QAM4 */
	589	str_constellation = "QAM4";
	590	c->modulation = QPSK; /* FIXME */
	591	break;
	592	case 2:
	593	str_constellation = "QAM16";
	594	c->modulation = QAM_16;
	595	break;
	596	case 3:
	597	str_constellation = "QAM32";
	598	c->modulation = QAM_32;
	599	break;
	600	case 4:
	601	str_constellation = "QAM64";
	602	c->modulation = QAM_64;
	603	break;
	604	default:
	605	str_constellation = "?";
	606	}
	607
	608	/* LDPC code rate, 0x7d[4:3] */
	609	switch ((buf[0] >> 3) & 0x03) {
	610	case 0: /* 0.4 */
	611	str_code_rate = "0.4";
	612	c->fec_inner = FEC_AUTO; /* FIXME */
	613	break;
	614	case 1: /* 0.6 */
	615	str_code_rate = "0.6";
	616	c->fec_inner = FEC_3_5;
	617	break;
	618	case 2: /* 0.8 */
	619	str_code_rate = "0.8";
	620	c->fec_inner = FEC_4_5;
	621	break;
	622	default:
	623	str_code_rate = "?";
	624	}
	625
	626	/* constellation & code rate set, 0x7d[6] */
	627	switch ((buf[0] >> 6) & 0x01) {
	628	case 0:
	629	str_constellation_code_rate = "manual";
	630	break;
	631	case 1:
632	str_constellation_code_rate = "auto";
633	break;
634	default:
635	str_constellation_code_rate = "?";
636	}
637
638	/* frame header, 0x81[1:0] */
639	switch ((buf[1] >> 0) & 0x03) {
640	case 0: /* PN945 */
641	str_guard_interval = "PN945";
642	c->guard_interval = GUARD_INTERVAL_AUTO; /* FIXME */
643	break;
644	case 1: /* PN595 */
645	str_guard_interval = "PN595";
646	c->guard_interval = GUARD_INTERVAL_AUTO; /* FIXME */
647	break;
648	case 2: /* PN420 */
649	str_guard_interval = "PN420";
650	c->guard_interval = GUARD_INTERVAL_AUTO; /* FIXME */
651	break;
652	default:
653	str_guard_interval = "?";
654	}
655
656	/* carrier, 0x81[2] */
657	switch ((buf[1] >> 2) & 0x01) {
658	case 0:
659	str_carrier = "C=1";
660	break;
661	case 1:
662	str_carrier = "C=3780";
663	break;
664	default:
665	str_carrier = "?";
666	}
667
668	/* frame header & carrier set, 0x81[3] */
669	switch ((buf[1] >> 3) & 0x01) {
670	case 0:
671	str_guard_interval_carrier = "manual";
672	break;
673	case 1:
674	str_guard_interval_carrier = "auto";
675	break;
676	default:
677	str_guard_interval_carrier = "?";
678	}
679
680	/* interleave, 0x82[0] */
681	switch ((buf[2] >> 0) & 0x01) {
682	case 0:
683	str_interleave = "M=720";
684	break;
685	case 1:
686	str_interleave = "M=240";
687	break;
688	default:
689	str_interleave = "?";
690	}
691
692	/* interleave set, 0x82[1] */
693	switch ((buf[2] >> 1) & 0x01) {
694	case 0:
695	str_interleave_ = "manual";
696	break;
697	case 1:
698	str_interleave_ = "auto";
699	break;
700	default:
701	str_interleave_ = "?";
702	}
703
704	/*
705	* We can read out current detected NCO and use that value next
706	* time instead of calculating new value from targed IF.
707	* I think it will not effect receiver sensitivity but gaining lock
708	* after tune could be easier...
709	*/
710	ret = hd29l2_rd_regs(priv, 0xb1, &buf[0], 3);
711	if (ret)
712	goto err;
713
714	if_ctl = (buf[0] << 16) \| ((buf[1] - 7) << 8) \| buf[2];
715
a44850df AP	716	dev_dbg(&priv->i2c->dev, "%s: %s %s %s \| %s %s %s \| %s %s \| NCO=%06x\n",
	717	__func__, str_constellation, str_code_rate,
	718	str_constellation_code_rate, str_guard_interval,
	719	str_carrier, str_guard_interval_carrier, str_interleave,
	720	str_interleave_, if_ctl);
ee9b8c8c AP	721	return 0;
ee9b8c8c AP	722	err:
a44850df	723	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
ee9b8c8c AP	724	return ret;
	725	}
	726
	727	static int hd29l2_init(struct dvb_frontend *fe)
	728	{
	729	int ret, i;
	730	struct hd29l2_priv *priv = fe->demodulator_priv;
	731	u8 tmp;
	732	static const struct reg_val tab[] = {
	733	{ 0x3a, 0x06 },
	734	{ 0x3b, 0x03 },
	735	{ 0x3c, 0x04 },
	736	{ 0xaf, 0x06 },
	737	{ 0xb0, 0x1b },
	738	{ 0x80, 0x64 },
	739	{ 0x10, 0x38 },
	740	};
	741
a44850df	742	dev_dbg(&priv->i2c->dev, "%s:\n", __func__);
ee9b8c8c AP	743
	744	/* reset demod */
	745	/* it is recommended to HW reset chip using RST_N pin */
	746	if (fe->callback) {
dab734ec	747	ret = fe->callback(fe, DVB_FRONTEND_COMPONENT_DEMOD, 0, 0);
ee9b8c8c AP	748	if (ret)
	749	goto err;
	750
	751	/* reprogramming needed because HW reset clears registers */
	752	priv->tuner_i2c_addr_programmed = false;
	753	}
	754
	755	/* init */
	756	for (i = 0; i < ARRAY_SIZE(tab); i++) {
	757	ret = hd29l2_wr_reg(priv, tab[i].reg, tab[i].val);
	758	if (ret)
	759	goto err;
	760	}
	761
	762	/* TS params */
	763	ret = hd29l2_rd_reg(priv, 0x36, &tmp);
	764	if (ret)
	765	goto err;
	766
	767	tmp &= 0x1b;
	768	tmp \|= priv->cfg.ts_mode;
	769	ret = hd29l2_wr_reg(priv, 0x36, tmp);
	770	if (ret)
	771	goto err;
	772
	773	ret = hd29l2_rd_reg(priv, 0x31, &tmp);
	774	tmp &= 0xef;
	775
	776	if (!(priv->cfg.ts_mode >> 7))
	777	/* set b4 for serial TS */
	778	tmp \|= 0x10;
	779
	780	ret = hd29l2_wr_reg(priv, 0x31, tmp);
	781	if (ret)
	782	goto err;
	783
	784	return ret;
	785	err:
a44850df	786	dev_dbg(&priv->i2c->dev, "%s: failed=%d\n", __func__, ret);
ee9b8c8c AP	787	return ret;
	788	}
	789
	790	static void hd29l2_release(struct dvb_frontend *fe)
	791	{
	792	struct hd29l2_priv *priv = fe->demodulator_priv;
	793	kfree(priv);
	794	}
	795
	796	static struct dvb_frontend_ops hd29l2_ops;
	797
	798	struct dvb_frontend hd29l2_attach(const struct hd29l2_config config,
	799	struct i2c_adapter *i2c)
	800	{
	801	int ret;
	802	struct hd29l2_priv *priv = NULL;
	803	u8 tmp;
	804
	805	/* allocate memory for the internal state */
	806	priv = kzalloc(sizeof(struct hd29l2_priv), GFP_KERNEL);
	807	if (priv == NULL)
	808	goto err;
	809
	810	/* setup the state */
	811	priv->i2c = i2c;
	812	memcpy(&priv->cfg, config, sizeof(struct hd29l2_config));
	813
	814
	815	/* check if the demod is there */
	816	ret = hd29l2_rd_reg(priv, 0x00, &tmp);
	817	if (ret)
	818	goto err;
	819
	820	/* create dvb_frontend */
	821	memcpy(&priv->fe.ops, &hd29l2_ops, sizeof(struct dvb_frontend_ops));
	822	priv->fe.demodulator_priv = priv;
	823
	824	return &priv->fe;
	825	err:
	826	kfree(priv);
	827	return NULL;
	828	}
	829	EXPORT_SYMBOL(hd29l2_attach);
	830
	831	static struct dvb_frontend_ops hd29l2_ops = {
6964c308	832	.delsys = { SYS_DVBT },
ee9b8c8c AP	833	.info = {
ee9b8c8c AP	834	.name = "HDIC HD29L2 DMB-TH",
ee9b8c8c AP	835	.frequency_min = 474000000,
	836	.frequency_max = 858000000,
	837	.frequency_stepsize = 10000,
	838	.caps = FE_CAN_FEC_AUTO \|
	839	FE_CAN_QPSK \|
	840	FE_CAN_QAM_16 \|
	841	FE_CAN_QAM_32 \|
	842	FE_CAN_QAM_64 \|
	843	FE_CAN_QAM_AUTO \|
	844	FE_CAN_TRANSMISSION_MODE_AUTO \|
	845	FE_CAN_BANDWIDTH_AUTO \|
	846	FE_CAN_GUARD_INTERVAL_AUTO \|
	847	FE_CAN_HIERARCHY_AUTO \|
	848	FE_CAN_RECOVER
	849	},
	850
	851	.release = hd29l2_release,
	852
	853	.init = hd29l2_init,
	854
	855	.get_frontend_algo = hd29l2_get_frontend_algo,
	856	.search = hd29l2_search,
	857	.get_frontend = hd29l2_get_frontend,
	858
	859	.read_status = hd29l2_read_status,
	860	.read_snr = hd29l2_read_snr,
	861	.read_signal_strength = hd29l2_read_signal_strength,
	862	.read_ber = hd29l2_read_ber,
	863	.read_ucblocks = hd29l2_read_ucblocks,
	864
	865	.i2c_gate_ctrl = hd29l2_i2c_gate_ctrl,
	866	};
	867
	868	MODULE_AUTHOR("Antti Palosaari <[email protected]>");
	869	MODULE_DESCRIPTION("HDIC HD29L2 DMB-TH demodulator driver");
	870	MODULE_LICENSE("GPL");