[deliverable/linux.git] / drivers / media / tuners / si2157.c

/*
 * Silicon Labs Si2146/2147/2148/2157/2158 silicon tuner driver
 *
 * Copyright (C) 2014 Antti Palosaari <crope@iki.fi>
 *
 *    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.
 */

#include "si2157_priv.h"

static const struct dvb_tuner_ops si2157_ops;

/* execute firmware command */
static int si2157_cmd_execute(struct i2c_client *client, struct si2157_cmd *cmd)
{
	struct si2157_dev *dev = i2c_get_clientdata(client);
	int ret;
	unsigned long timeout;

	mutex_lock(&dev->i2c_mutex);

	if (cmd->wlen) {
		/* write cmd and args for firmware */
		ret = i2c_master_send(client, cmd->args, cmd->wlen);
		if (ret < 0) {
			goto err_mutex_unlock;
		} else if (ret != cmd->wlen) {
			ret = -EREMOTEIO;
			goto err_mutex_unlock;
		}
	}

	if (cmd->rlen) {
		/* wait cmd execution terminate */
		#define TIMEOUT 80
		timeout = jiffies + msecs_to_jiffies(TIMEOUT);
		while (!time_after(jiffies, timeout)) {
			ret = i2c_master_recv(client, cmd->args, cmd->rlen);
			if (ret < 0) {
				goto err_mutex_unlock;
			} else if (ret != cmd->rlen) {
				ret = -EREMOTEIO;
				goto err_mutex_unlock;
			}

			/* firmware ready? */
			if ((cmd->args[0] >> 7) & 0x01)
				break;
		}

		dev_dbg(&client->dev, "cmd execution took %d ms\n",
				jiffies_to_msecs(jiffies) -
				(jiffies_to_msecs(timeout) - TIMEOUT));

		if (!((cmd->args[0] >> 7) & 0x01)) {
			ret = -ETIMEDOUT;
			goto err_mutex_unlock;
		}
	}

	mutex_unlock(&dev->i2c_mutex);
	return 0;

err_mutex_unlock:
	mutex_unlock(&dev->i2c_mutex);
	dev_dbg(&client->dev, "failed=%d\n", ret);
	return ret;
}

static int si2157_init(struct dvb_frontend *fe)
{
	struct i2c_client *client = fe->tuner_priv;
	struct si2157_dev *dev = i2c_get_clientdata(client);
	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
	int ret, len, remaining;
	struct si2157_cmd cmd;
	const struct firmware *fw;
	const char *fw_name;
	unsigned int chip_id;

	dev_dbg(&client->dev, "\n");

	if (dev->fw_loaded)
		goto warm;

	/* power up */
	if (dev->chiptype == SI2157_CHIPTYPE_SI2146) {
		memcpy(cmd.args, "\xc0\x05\x01\x00\x00\x0b\x00\x00\x01", 9);
		cmd.wlen = 9;
	} else {
		memcpy(cmd.args, "\xc0\x00\x0c\x00\x00\x01\x01\x01\x01\x01\x01\x02\x00\x00\x01", 15);
		cmd.wlen = 15;
	}
	cmd.rlen = 1;
	ret = si2157_cmd_execute(client, &cmd);
	if (ret)
		goto err;

	/* query chip revision */
	memcpy(cmd.args, "\x02", 1);
	cmd.wlen = 1;
	cmd.rlen = 13;
	ret = si2157_cmd_execute(client, &cmd);
	if (ret)
		goto err;

	chip_id = cmd.args[1] << 24 | cmd.args[2] << 16 | cmd.args[3] << 8 |
			cmd.args[4] << 0;

	#define SI2158_A20 ('A' << 24 | 58 << 16 | '2' << 8 | '0' << 0)
	#define SI2148_A20 ('A' << 24 | 48 << 16 | '2' << 8 | '0' << 0)
	#define SI2157_A30 ('A' << 24 | 57 << 16 | '3' << 8 | '0' << 0)
	#define SI2147_A30 ('A' << 24 | 47 << 16 | '3' << 8 | '0' << 0)
	#define SI2146_A10 ('A' << 24 | 46 << 16 | '1' << 8 | '0' << 0)

	switch (chip_id) {
	case SI2158_A20:
	case SI2148_A20:
		fw_name = SI2158_A20_FIRMWARE;
		break;
	case SI2157_A30:
	case SI2147_A30:
	case SI2146_A10:
		fw_name = NULL;
		break;
	default:
		dev_err(&client->dev, "unknown chip version Si21%d-%c%c%c\n",
				cmd.args[2], cmd.args[1],
				cmd.args[3], cmd.args[4]);
		ret = -EINVAL;
		goto err;
	}

	dev_info(&client->dev, "found a 'Silicon Labs Si21%d-%c%c%c'\n",
			cmd.args[2], cmd.args[1], cmd.args[3], cmd.args[4]);

	if (fw_name == NULL)
		goto skip_fw_download;

	/* request the firmware, this will block and timeout */
	ret = request_firmware(&fw, fw_name, &client->dev);
	if (ret) {
		dev_err(&client->dev, "firmware file '%s' not found\n",
				fw_name);
		goto err;
	}

	/* firmware should be n chunks of 17 bytes */
	if (fw->size % 17 != 0) {
		dev_err(&client->dev, "firmware file '%s' is invalid\n",
				fw_name);
		ret = -EINVAL;
		goto err_release_firmware;
	}

	dev_info(&client->dev, "downloading firmware from file '%s'\n",
			fw_name);

	for (remaining = fw->size; remaining > 0; remaining -= 17) {
		len = fw->data[fw->size - remaining];
		memcpy(cmd.args, &fw->data[(fw->size - remaining) + 1], len);
		cmd.wlen = len;
		cmd.rlen = 1;
		ret = si2157_cmd_execute(client, &cmd);
		if (ret) {
			dev_err(&client->dev, "firmware download failed %d\n",
					ret);
			goto err_release_firmware;
		}
	}

	release_firmware(fw);

skip_fw_download:
	/* reboot the tuner with new firmware? */
	memcpy(cmd.args, "\x01\x01", 2);
	cmd.wlen = 2;
	cmd.rlen = 1;
	ret = si2157_cmd_execute(client, &cmd);
	if (ret)
		goto err;

	/* query firmware version */
	memcpy(cmd.args, "\x11", 1);
	cmd.wlen = 1;
	cmd.rlen = 10;
	ret = si2157_cmd_execute(client, &cmd);
	if (ret)
		goto err;

	dev_info(&client->dev, "firmware version: %c.%c.%d\n",
			cmd.args[6], cmd.args[7], cmd.args[8]);

	dev->fw_loaded = true;

warm:
	/* init statistics in order signal app which are supported */
	c->strength.len = 1;
	c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
	/* start statistics polling */
	schedule_delayed_work(&dev->stat_work, msecs_to_jiffies(1000));

	dev->active = true;
	return 0;
err_release_firmware:
	release_firmware(fw);
err:
	dev_dbg(&client->dev, "failed=%d\n", ret);
	return ret;
}

static int si2157_sleep(struct dvb_frontend *fe)
{
	struct i2c_client *client = fe->tuner_priv;
	struct si2157_dev *dev = i2c_get_clientdata(client);
	int ret;
	struct si2157_cmd cmd;

	dev_dbg(&client->dev, "\n");

	dev->active = false;

	/* stop statistics polling */
	cancel_delayed_work_sync(&dev->stat_work);

	/* standby */
	memcpy(cmd.args, "\x16\x00", 2);
	cmd.wlen = 2;
	cmd.rlen = 1;
	ret = si2157_cmd_execute(client, &cmd);
	if (ret)
		goto err;

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

static int si2157_set_params(struct dvb_frontend *fe)
{
	struct i2c_client *client = fe->tuner_priv;
	struct si2157_dev *dev = i2c_get_clientdata(client);
	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
	int ret;
	struct si2157_cmd cmd;
	u8 bandwidth, delivery_system;
	u32 if_frequency = 5000000;

	dev_dbg(&client->dev,
			"delivery_system=%d frequency=%u bandwidth_hz=%u\n",
			c->delivery_system, c->frequency, c->bandwidth_hz);

	if (!dev->active) {
		ret = -EAGAIN;
		goto err;
	}

	if (c->bandwidth_hz <= 6000000)
		bandwidth = 0x06;
	else if (c->bandwidth_hz <= 7000000)
		bandwidth = 0x07;
	else if (c->bandwidth_hz <= 8000000)
		bandwidth = 0x08;
	else
		bandwidth = 0x0f;

	switch (c->delivery_system) {
	case SYS_ATSC:
			delivery_system = 0x00;
			if_frequency = 3250000;
			break;
	case SYS_DVBC_ANNEX_B:
			delivery_system = 0x10;
			if_frequency = 4000000;
			break;
	case SYS_DVBT:
	case SYS_DVBT2: /* it seems DVB-T and DVB-T2 both are 0x20 here */
			delivery_system = 0x20;
			break;
	case SYS_DVBC_ANNEX_A:
			delivery_system = 0x30;
			break;
	default:
			ret = -EINVAL;
			goto err;
	}

	memcpy(cmd.args, "\x14\x00\x03\x07\x00\x00", 6);
	cmd.args[4] = delivery_system | bandwidth;
	if (dev->inversion)
		cmd.args[5] = 0x01;
	cmd.wlen = 6;
	cmd.rlen = 4;
	ret = si2157_cmd_execute(client, &cmd);
	if (ret)
		goto err;

	if (dev->chiptype == SI2157_CHIPTYPE_SI2146)
		memcpy(cmd.args, "\x14\x00\x02\x07\x00\x01", 6);
	else
		memcpy(cmd.args, "\x14\x00\x02\x07\x00\x00", 6);
	cmd.args[4] = dev->if_port;
	cmd.wlen = 6;
	cmd.rlen = 4;
	ret = si2157_cmd_execute(client, &cmd);
	if (ret)
		goto err;

	/* set if frequency if needed */
	if (if_frequency != dev->if_frequency) {
		memcpy(cmd.args, "\x14\x00\x06\x07", 4);
		cmd.args[4] = (if_frequency / 1000) & 0xff;
		cmd.args[5] = ((if_frequency / 1000) >> 8) & 0xff;
		cmd.wlen = 6;
		cmd.rlen = 4;
		ret = si2157_cmd_execute(client, &cmd);
		if (ret)
			goto err;

		dev->if_frequency = if_frequency;
	}

	/* set frequency */
	memcpy(cmd.args, "\x41\x00\x00\x00\x00\x00\x00\x00", 8);
	cmd.args[4] = (c->frequency >>  0) & 0xff;
	cmd.args[5] = (c->frequency >>  8) & 0xff;
	cmd.args[6] = (c->frequency >> 16) & 0xff;
	cmd.args[7] = (c->frequency >> 24) & 0xff;
	cmd.wlen = 8;
	cmd.rlen = 1;
	ret = si2157_cmd_execute(client, &cmd);
	if (ret)
		goto err;

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

static int si2157_get_if_frequency(struct dvb_frontend *fe, u32 *frequency)
{
	struct i2c_client *client = fe->tuner_priv;
	struct si2157_dev *dev = i2c_get_clientdata(client);

	*frequency = dev->if_frequency;
	return 0;
}

static const struct dvb_tuner_ops si2157_ops = {
	.info = {
		.name           = "Silicon Labs Si2146/2147/2148/2157/2158",
		.frequency_min  = 55000000,
		.frequency_max  = 862000000,
	},

	.init = si2157_init,
	.sleep = si2157_sleep,
	.set_params = si2157_set_params,
	.get_if_frequency = si2157_get_if_frequency,
};

static void si2157_stat_work(struct work_struct *work)
{
	struct si2157_dev *dev = container_of(work, struct si2157_dev, stat_work.work);
	struct dvb_frontend *fe = dev->fe;
	struct i2c_client *client = fe->tuner_priv;
	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
	struct si2157_cmd cmd;
	int ret;

	dev_dbg(&client->dev, "\n");

	memcpy(cmd.args, "\x42\x00", 2);
	cmd.wlen = 2;
	cmd.rlen = 12;
	ret = si2157_cmd_execute(client, &cmd);
	if (ret)
		goto err;

	c->strength.stat[0].scale = FE_SCALE_DECIBEL;
	c->strength.stat[0].svalue = (s8) cmd.args[3] * 1000;

	schedule_delayed_work(&dev->stat_work, msecs_to_jiffies(2000));
	return;
err:
	c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
	dev_dbg(&client->dev, "failed=%d\n", ret);
}

static int si2157_probe(struct i2c_client *client,
		const struct i2c_device_id *id)
{
	struct si2157_config *cfg = client->dev.platform_data;
	struct dvb_frontend *fe = cfg->fe;
	struct si2157_dev *dev;
	struct si2157_cmd cmd;
	int ret;

	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
	if (!dev) {
		ret = -ENOMEM;
		dev_err(&client->dev, "kzalloc() failed\n");
		goto err;
	}

	i2c_set_clientdata(client, dev);
	dev->fe = cfg->fe;
	dev->inversion = cfg->inversion;
	dev->if_port = cfg->if_port;
	dev->fw_loaded = false;
	dev->chiptype = (u8)id->driver_data;
	dev->if_frequency = 5000000; /* default value of property 0x0706 */
	mutex_init(&dev->i2c_mutex);
	INIT_DELAYED_WORK(&dev->stat_work, si2157_stat_work);

	/* check if the tuner is there */
	cmd.wlen = 0;
	cmd.rlen = 1;
	ret = si2157_cmd_execute(client, &cmd);
	if (ret)
		goto err_kfree;

	memcpy(&fe->ops.tuner_ops, &si2157_ops, sizeof(struct dvb_tuner_ops));
	fe->tuner_priv = client;

	dev_info(&client->dev, "Silicon Labs %s successfully attached\n",
			dev->chiptype == SI2157_CHIPTYPE_SI2146 ?
			"Si2146" : "Si2147/2148/2157/2158");

	return 0;

err_kfree:
	kfree(dev);
err:
	dev_dbg(&client->dev, "failed=%d\n", ret);
	return ret;
}

static int si2157_remove(struct i2c_client *client)
{
	struct si2157_dev *dev = i2c_get_clientdata(client);
	struct dvb_frontend *fe = dev->fe;

	dev_dbg(&client->dev, "\n");

	memset(&fe->ops.tuner_ops, 0, sizeof(struct dvb_tuner_ops));
	fe->tuner_priv = NULL;
	kfree(dev);

	return 0;
}

static const struct i2c_device_id si2157_id_table[] = {
	{"si2157", SI2157_CHIPTYPE_SI2157},
	{"si2146", SI2157_CHIPTYPE_SI2146},
	{}
};
MODULE_DEVICE_TABLE(i2c, si2157_id_table);

static struct i2c_driver si2157_driver = {
	.driver = {
		.owner	= THIS_MODULE,
		.name	= "si2157",
	},
	.probe		= si2157_probe,
	.remove		= si2157_remove,
	.id_table	= si2157_id_table,
};

module_i2c_driver(si2157_driver);

MODULE_DESCRIPTION("Silicon Labs Si2146/2147/2148/2157/2158 silicon tuner driver");
MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
MODULE_LICENSE("GPL");
MODULE_FIRMWARE(SI2158_A20_FIRMWARE);
Commit	Line	Data
ba92ae0f	1	/*
17ad09f1	2	* Silicon Labs Si2146/2147/2148/2157/2158 silicon tuner driver
ba92ae0f AP	3	*
	4	* Copyright (C) 2014 Antti Palosaari <crope@iki.fi>
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License as published by
	8	* the Free Software Foundation; either version 2 of the License, or
	9	* (at your option) any later version.
	10	*
	11	* This program is distributed in the hope that it will be useful,
	12	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	14	* GNU General Public License for more details.
	15	*/
	16
930a8730 AP	17	#include "si2157_priv.h"
930a8730 AP	18
1b92373f OS	19	static const struct dvb_tuner_ops si2157_ops;
1b92373f OS	20
930a8730	21	/* execute firmware command */
8fe51725	22	static int si2157_cmd_execute(struct i2c_client client, struct si2157_cmd cmd)
930a8730	23	{
8fe51725	24	struct si2157_dev *dev = i2c_get_clientdata(client);
930a8730	25	int ret;
930a8730 AP	26	unsigned long timeout;
930a8730 AP	27
70f13ff0	28	mutex_lock(&dev->i2c_mutex);
930a8730	29
e6b4380f	30	if (cmd->wlen) {
930a8730	31	/* write cmd and args for firmware */
8fe51725	32	ret = i2c_master_send(client, cmd->args, cmd->wlen);
930a8730 AP	33	if (ret < 0) {
930a8730 AP	34	goto err_mutex_unlock;
e6b4380f	35	} else if (ret != cmd->wlen) {
930a8730 AP	36	ret = -EREMOTEIO;
	37	goto err_mutex_unlock;
	38	}
	39	}
	40
e6b4380f AP	41	if (cmd->rlen) {
	42	/* wait cmd execution terminate */
	43	#define TIMEOUT 80
	44	timeout = jiffies + msecs_to_jiffies(TIMEOUT);
	45	while (!time_after(jiffies, timeout)) {
8fe51725	46	ret = i2c_master_recv(client, cmd->args, cmd->rlen);
e6b4380f AP	47	if (ret < 0) {
	48	goto err_mutex_unlock;
	49	} else if (ret != cmd->rlen) {
	50	ret = -EREMOTEIO;
	51	goto err_mutex_unlock;
	52	}
	53
	54	/* firmware ready? */
	55	if ((cmd->args[0] >> 7) & 0x01)
	56	break;
930a8730 AP	57	}
930a8730 AP	58
8fe51725	59	dev_dbg(&client->dev, "cmd execution took %d ms\n",
e6b4380f AP	60	jiffies_to_msecs(jiffies) -
e6b4380f AP	61	(jiffies_to_msecs(timeout) - TIMEOUT));
930a8730	62
e6b4380f AP	63	if (!((cmd->args[0] >> 7) & 0x01)) {
	64	ret = -ETIMEDOUT;
	65	goto err_mutex_unlock;
	66	}
930a8730 AP	67	}
930a8730 AP	68
7cbf5d76 AP	69	mutex_unlock(&dev->i2c_mutex);
7cbf5d76 AP	70	return 0;
e6b4380f	71
930a8730	72	err_mutex_unlock:
70f13ff0	73	mutex_unlock(&dev->i2c_mutex);
8fe51725	74	dev_dbg(&client->dev, "failed=%d\n", ret);
930a8730 AP	75	return ret;
	76	}
	77
	78	static int si2157_init(struct dvb_frontend *fe)
	79	{
8fe51725 AP	80	struct i2c_client *client = fe->tuner_priv;
8fe51725 AP	81	struct si2157_dev *dev = i2c_get_clientdata(client);
2f1ea29f	82	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
7d6bc608	83	int ret, len, remaining;
b154121c	84	struct si2157_cmd cmd;
78dab40a	85	const struct firmware *fw;
08272db6	86	const char *fw_name;
7d6bc608	87	unsigned int chip_id;
930a8730	88
8fe51725	89	dev_dbg(&client->dev, "\n");
930a8730	90
70f13ff0	91	if (dev->fw_loaded)
4cbf6ed9 OS	92	goto warm;
	93
	94	/* power up */
70f13ff0	95	if (dev->chiptype == SI2157_CHIPTYPE_SI2146) {
073f3849 OS	96	memcpy(cmd.args, "\xc0\x05\x01\x00\x00\x0b\x00\x00\x01", 9);
	97	cmd.wlen = 9;
	98	} else {
	99	memcpy(cmd.args, "\xc0\x00\x0c\x00\x00\x01\x01\x01\x01\x01\x01\x02\x00\x00\x01", 15);
	100	cmd.wlen = 15;
	101	}
b154121c	102	cmd.rlen = 1;
8fe51725	103	ret = si2157_cmd_execute(client, &cmd);
b154121c OS	104	if (ret)
	105	goto err;
	106
	107	/* query chip revision */
	108	memcpy(cmd.args, "\x02", 1);
	109	cmd.wlen = 1;
	110	cmd.rlen = 13;
8fe51725	111	ret = si2157_cmd_execute(client, &cmd);
b154121c OS	112	if (ret)
	113	goto err;
	114
7d6bc608 AP	115	chip_id = cmd.args[1] << 24 \| cmd.args[2] << 16 \| cmd.args[3] << 8 \|
	116	cmd.args[4] << 0;
	117
	118	#define SI2158_A20 ('A' << 24 \| 58 << 16 \| '2' << 8 \| '0' << 0)
17ad09f1	119	#define SI2148_A20 ('A' << 24 \| 48 << 16 \| '2' << 8 \| '0' << 0)
7d6bc608	120	#define SI2157_A30 ('A' << 24 \| 57 << 16 \| '3' << 8 \| '0' << 0)
d87a5058	121	#define SI2147_A30 ('A' << 24 \| 47 << 16 \| '3' << 8 \| '0' << 0)
073f3849	122	#define SI2146_A10 ('A' << 24 \| 46 << 16 \| '1' << 8 \| '0' << 0)
7d6bc608 AP	123
	124	switch (chip_id) {
	125	case SI2158_A20:
17ad09f1	126	case SI2148_A20:
08272db6	127	fw_name = SI2158_A20_FIRMWARE;
7d6bc608 AP	128	break;
7d6bc608 AP	129	case SI2157_A30:
d87a5058	130	case SI2147_A30:
073f3849	131	case SI2146_A10:
08272db6	132	fw_name = NULL;
6c372533	133	break;
7d6bc608	134	default:
8fe51725	135	dev_err(&client->dev, "unknown chip version Si21%d-%c%c%c\n",
67d0113a	136	cmd.args[2], cmd.args[1],
7d6bc608 AP	137	cmd.args[3], cmd.args[4]);
	138	ret = -EINVAL;
	139	goto err;
	140	}
1b92373f	141
6c372533 AP	142	dev_info(&client->dev, "found a 'Silicon Labs Si21%d-%c%c%c'\n",
	143	cmd.args[2], cmd.args[1], cmd.args[3], cmd.args[4]);
	144
08272db6	145	if (fw_name == NULL)
6c372533	146	goto skip_fw_download;
1b92373f	147
7d6bc608	148	/* request the firmware, this will block and timeout */
08272db6	149	ret = request_firmware(&fw, fw_name, &client->dev);
7d6bc608	150	if (ret) {
8fe51725	151	dev_err(&client->dev, "firmware file '%s' not found\n",
08272db6	152	fw_name);
7d6bc608 AP	153	goto err;
7d6bc608 AP	154	}
1b92373f	155
7d6bc608 AP	156	/* firmware should be n chunks of 17 bytes */
7d6bc608 AP	157	if (fw->size % 17 != 0) {
8fe51725	158	dev_err(&client->dev, "firmware file '%s' is invalid\n",
08272db6	159	fw_name);
7d6bc608	160	ret = -EINVAL;
78dab40a	161	goto err_release_firmware;
7d6bc608	162	}
1b92373f	163
8fe51725	164	dev_info(&client->dev, "downloading firmware from file '%s'\n",
08272db6	165	fw_name);
1b92373f	166
7d6bc608 AP	167	for (remaining = fw->size; remaining > 0; remaining -= 17) {
	168	len = fw->data[fw->size - remaining];
	169	memcpy(cmd.args, &fw->data[(fw->size - remaining) + 1], len);
	170	cmd.wlen = len;
	171	cmd.rlen = 1;
8fe51725	172	ret = si2157_cmd_execute(client, &cmd);
7d6bc608	173	if (ret) {
8fe51725	174	dev_err(&client->dev, "firmware download failed %d\n",
67d0113a	175	ret);
78dab40a	176	goto err_release_firmware;
1b92373f	177	}
1b92373f OS	178	}
1b92373f OS	179
7d6bc608	180	release_firmware(fw);
7d6bc608 AP	181
7d6bc608 AP	182	skip_fw_download:
b154121c OS	183	/* reboot the tuner with new firmware? */
	184	memcpy(cmd.args, "\x01\x01", 2);
	185	cmd.wlen = 2;
	186	cmd.rlen = 1;
8fe51725	187	ret = si2157_cmd_execute(client, &cmd);
b154121c OS	188	if (ret)
	189	goto err;
	190
c7011845 AP	191	/* query firmware version */
	192	memcpy(cmd.args, "\x11", 1);
	193	cmd.wlen = 1;
	194	cmd.rlen = 10;
	195	ret = si2157_cmd_execute(client, &cmd);
	196	if (ret)
	197	goto err;
	198
	199	dev_info(&client->dev, "firmware version: %c.%c.%d\n",
	200	cmd.args[6], cmd.args[7], cmd.args[8]);
	201
70f13ff0	202	dev->fw_loaded = true;
930a8730	203
4cbf6ed9	204	warm:
2f1ea29f AP	205	/* init statistics in order signal app which are supported */
	206	c->strength.len = 1;
	207	c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
	208	/* start statistics polling */
	209	schedule_delayed_work(&dev->stat_work, msecs_to_jiffies(1000));
	210
70f13ff0	211	dev->active = true;
930a8730	212	return 0;
78dab40a	213	err_release_firmware:
dc89cfcf	214	release_firmware(fw);
e358c8a6	215	err:
8fe51725	216	dev_dbg(&client->dev, "failed=%d\n", ret);
b154121c	217	return ret;
930a8730 AP	218	}
	219
	220	static int si2157_sleep(struct dvb_frontend *fe)
	221	{
8fe51725 AP	222	struct i2c_client *client = fe->tuner_priv;
8fe51725 AP	223	struct si2157_dev *dev = i2c_get_clientdata(client);
a83d7d17 AP	224	int ret;
a83d7d17 AP	225	struct si2157_cmd cmd;
930a8730	226
8fe51725	227	dev_dbg(&client->dev, "\n");
930a8730	228
70f13ff0	229	dev->active = false;
930a8730	230
2f1ea29f AP	231	/* stop statistics polling */
	232	cancel_delayed_work_sync(&dev->stat_work);
	233
0e38233d OS	234	/* standby */
	235	memcpy(cmd.args, "\x16\x00", 2);
	236	cmd.wlen = 2;
	237	cmd.rlen = 1;
8fe51725	238	ret = si2157_cmd_execute(client, &cmd);
a83d7d17 AP	239	if (ret)
	240	goto err;
	241
930a8730	242	return 0;
a83d7d17	243	err:
8fe51725	244	dev_dbg(&client->dev, "failed=%d\n", ret);
a83d7d17	245	return ret;
930a8730 AP	246	}
	247
	248	static int si2157_set_params(struct dvb_frontend *fe)
	249	{
8fe51725 AP	250	struct i2c_client *client = fe->tuner_priv;
8fe51725 AP	251	struct si2157_dev *dev = i2c_get_clientdata(client);
930a8730 AP	252	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
	253	int ret;
	254	struct si2157_cmd cmd;
a1dad50d	255	u8 bandwidth, delivery_system;
c28aebe1	256	u32 if_frequency = 5000000;
930a8730	257
8fe51725	258	dev_dbg(&client->dev,
67d0113a	259	"delivery_system=%d frequency=%u bandwidth_hz=%u\n",
8fe51725	260	c->delivery_system, c->frequency, c->bandwidth_hz);
930a8730	261
70f13ff0	262	if (!dev->active) {
930a8730 AP	263	ret = -EAGAIN;
	264	goto err;
	265	}
	266
a1dad50d OS	267	if (c->bandwidth_hz <= 6000000)
	268	bandwidth = 0x06;
	269	else if (c->bandwidth_hz <= 7000000)
	270	bandwidth = 0x07;
	271	else if (c->bandwidth_hz <= 8000000)
	272	bandwidth = 0x08;
	273	else
	274	bandwidth = 0x0f;
	275
	276	switch (c->delivery_system) {
5cd62db7 OS	277	case SYS_ATSC:
5cd62db7 OS	278	delivery_system = 0x00;
c28aebe1	279	if_frequency = 3250000;
5cd62db7	280	break;
0d1165fc OS	281	case SYS_DVBC_ANNEX_B:
0d1165fc OS	282	delivery_system = 0x10;
c28aebe1	283	if_frequency = 4000000;
0d1165fc	284	break;
a1dad50d OS	285	case SYS_DVBT:
	286	case SYS_DVBT2: /* it seems DVB-T and DVB-T2 both are 0x20 here */
	287	delivery_system = 0x20;
	288	break;
	289	case SYS_DVBC_ANNEX_A:
	290	delivery_system = 0x30;
	291	break;
	292	default:
	293	ret = -EINVAL;
	294	goto err;
	295	}
	296
	297	memcpy(cmd.args, "\x14\x00\x03\x07\x00\x00", 6);
	298	cmd.args[4] = delivery_system \| bandwidth;
70f13ff0	299	if (dev->inversion)
05024efe	300	cmd.args[5] = 0x01;
a1dad50d	301	cmd.wlen = 6;
d87a5058	302	cmd.rlen = 4;
8fe51725	303	ret = si2157_cmd_execute(client, &cmd);
d87a5058 OS	304	if (ret)
	305	goto err;
	306
70f13ff0	307	if (dev->chiptype == SI2157_CHIPTYPE_SI2146)
073f3849 OS	308	memcpy(cmd.args, "\x14\x00\x02\x07\x00\x01", 6);
073f3849 OS	309	else
ee3c3e46 OS	310	memcpy(cmd.args, "\x14\x00\x02\x07\x00\x00", 6);
ee3c3e46 OS	311	cmd.args[4] = dev->if_port;
d87a5058 OS	312	cmd.wlen = 6;
d87a5058 OS	313	cmd.rlen = 4;
8fe51725	314	ret = si2157_cmd_execute(client, &cmd);
a1dad50d OS	315	if (ret)
	316	goto err;
	317
c28aebe1 OS	318	/* set if frequency if needed */
	319	if (if_frequency != dev->if_frequency) {
	320	memcpy(cmd.args, "\x14\x00\x06\x07", 4);
	321	cmd.args[4] = (if_frequency / 1000) & 0xff;
	322	cmd.args[5] = ((if_frequency / 1000) >> 8) & 0xff;
	323	cmd.wlen = 6;
	324	cmd.rlen = 4;
	325	ret = si2157_cmd_execute(client, &cmd);
	326	if (ret)
	327	goto err;
	328
	329	dev->if_frequency = if_frequency;
	330	}
	331
930a8730	332	/* set frequency */
b154121c	333	memcpy(cmd.args, "\x41\x00\x00\x00\x00\x00\x00\x00", 8);
930a8730 AP	334	cmd.args[4] = (c->frequency >> 0) & 0xff;
	335	cmd.args[5] = (c->frequency >> 8) & 0xff;
	336	cmd.args[6] = (c->frequency >> 16) & 0xff;
	337	cmd.args[7] = (c->frequency >> 24) & 0xff;
e6b4380f AP	338	cmd.wlen = 8;
e6b4380f AP	339	cmd.rlen = 1;
8fe51725	340	ret = si2157_cmd_execute(client, &cmd);
930a8730 AP	341	if (ret)
	342	goto err;
	343
	344	return 0;
	345	err:
8fe51725	346	dev_dbg(&client->dev, "failed=%d\n", ret);
930a8730 AP	347	return ret;
	348	}
	349
1140540d MS	350	static int si2157_get_if_frequency(struct dvb_frontend fe, u32 frequency)
1140540d MS	351	{
c28aebe1 OS	352	struct i2c_client *client = fe->tuner_priv;
	353	struct si2157_dev *dev = i2c_get_clientdata(client);
	354
	355	*frequency = dev->if_frequency;
1140540d MS	356	return 0;
	357	}
	358
6cc8a35d	359	static const struct dvb_tuner_ops si2157_ops = {
930a8730	360	.info = {
17ad09f1	361	.name = "Silicon Labs Si2146/2147/2148/2157/2158",
18acc6ac	362	.frequency_min = 55000000,
930a8730 AP	363	.frequency_max = 862000000,
	364	},
	365
	366	.init = si2157_init,
	367	.sleep = si2157_sleep,
	368	.set_params = si2157_set_params,
1140540d	369	.get_if_frequency = si2157_get_if_frequency,
930a8730 AP	370	};
930a8730 AP	371
2f1ea29f AP	372	static void si2157_stat_work(struct work_struct *work)
	373	{
	374	struct si2157_dev *dev = container_of(work, struct si2157_dev, stat_work.work);
	375	struct dvb_frontend *fe = dev->fe;
	376	struct i2c_client *client = fe->tuner_priv;
	377	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
	378	struct si2157_cmd cmd;
	379	int ret;
	380
	381	dev_dbg(&client->dev, "\n");
	382
	383	memcpy(cmd.args, "\x42\x00", 2);
	384	cmd.wlen = 2;
	385	cmd.rlen = 12;
	386	ret = si2157_cmd_execute(client, &cmd);
	387	if (ret)
	388	goto err;
	389
	390	c->strength.stat[0].scale = FE_SCALE_DECIBEL;
	391	c->strength.stat[0].svalue = (s8) cmd.args[3] * 1000;
	392
	393	schedule_delayed_work(&dev->stat_work, msecs_to_jiffies(2000));
	394	return;
	395	err:
	396	c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
	397	dev_dbg(&client->dev, "failed=%d\n", ret);
	398	}
	399
930a8730 AP	400	static int si2157_probe(struct i2c_client *client,
	401	const struct i2c_device_id *id)
	402	{
	403	struct si2157_config *cfg = client->dev.platform_data;
	404	struct dvb_frontend *fe = cfg->fe;
70f13ff0	405	struct si2157_dev *dev;
930a8730 AP	406	struct si2157_cmd cmd;
	407	int ret;
	408
70f13ff0 AP	409	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
70f13ff0 AP	410	if (!dev) {
930a8730	411	ret = -ENOMEM;
67d0113a	412	dev_err(&client->dev, "kzalloc() failed\n");
930a8730 AP	413	goto err;
	414	}
	415
8fe51725	416	i2c_set_clientdata(client, dev);
70f13ff0 AP	417	dev->fe = cfg->fe;
70f13ff0 AP	418	dev->inversion = cfg->inversion;
ee3c3e46	419	dev->if_port = cfg->if_port;
70f13ff0 AP	420	dev->fw_loaded = false;
70f13ff0 AP	421	dev->chiptype = (u8)id->driver_data;
c28aebe1	422	dev->if_frequency = 5000000; /* default value of property 0x0706 */
70f13ff0	423	mutex_init(&dev->i2c_mutex);
2f1ea29f	424	INIT_DELAYED_WORK(&dev->stat_work, si2157_stat_work);
930a8730 AP	425
930a8730 AP	426	/* check if the tuner is there */
e6b4380f AP	427	cmd.wlen = 0;
e6b4380f AP	428	cmd.rlen = 1;
8fe51725	429	ret = si2157_cmd_execute(client, &cmd);
930a8730	430	if (ret)
e7f3f9f3	431	goto err_kfree;
930a8730	432
70f13ff0	433	memcpy(&fe->ops.tuner_ops, &si2157_ops, sizeof(struct dvb_tuner_ops));
8fe51725	434	fe->tuner_priv = client;
930a8730	435
8fe51725	436	dev_info(&client->dev, "Silicon Labs %s successfully attached\n",
70f13ff0	437	dev->chiptype == SI2157_CHIPTYPE_SI2146 ?
17ad09f1	438	"Si2146" : "Si2147/2148/2157/2158");
073f3849	439
930a8730	440	return 0;
e7f3f9f3 AP	441
	442	err_kfree:
	443	kfree(dev);
930a8730	444	err:
67d0113a	445	dev_dbg(&client->dev, "failed=%d\n", ret);
930a8730 AP	446	return ret;
	447	}
	448
	449	static int si2157_remove(struct i2c_client *client)
	450	{
70f13ff0 AP	451	struct si2157_dev *dev = i2c_get_clientdata(client);
70f13ff0 AP	452	struct dvb_frontend *fe = dev->fe;
930a8730	453
67d0113a	454	dev_dbg(&client->dev, "\n");
930a8730 AP	455
	456	memset(&fe->ops.tuner_ops, 0, sizeof(struct dvb_tuner_ops));
	457	fe->tuner_priv = NULL;
70f13ff0	458	kfree(dev);
930a8730 AP	459
	460	return 0;
	461	}
	462
c1292233 AP	463	static const struct i2c_device_id si2157_id_table[] = {
	464	{"si2157", SI2157_CHIPTYPE_SI2157},
	465	{"si2146", SI2157_CHIPTYPE_SI2146},
930a8730 AP	466	{}
930a8730 AP	467	};
c1292233	468	MODULE_DEVICE_TABLE(i2c, si2157_id_table);
930a8730 AP	469
	470	static struct i2c_driver si2157_driver = {
	471	.driver = {
	472	.owner = THIS_MODULE,
	473	.name = "si2157",
	474	},
	475	.probe = si2157_probe,
	476	.remove = si2157_remove,
c1292233	477	.id_table = si2157_id_table,
930a8730 AP	478	};
	479
	480	module_i2c_driver(si2157_driver);
	481
17ad09f1	482	MODULE_DESCRIPTION("Silicon Labs Si2146/2147/2148/2157/2158 silicon tuner driver");
930a8730 AP	483	MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
930a8730 AP	484	MODULE_LICENSE("GPL");
bac53a2c	485	MODULE_FIRMWARE(SI2158_A20_FIRMWARE);