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

/*
 * Silicon Labs Si2168 DVB-T/T2/C demodulator 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 "si2168_priv.h"

static const struct dvb_frontend_ops si2168_ops;

/* execute firmware command */
static int si2168_cmd_execute(struct si2168 *s, struct si2168_cmd *cmd)
{
	int ret;
	unsigned long timeout;

	mutex_lock(&s->i2c_mutex);

	if (cmd->wlen) {
		/* write cmd and args for firmware */
		ret = i2c_master_send(s->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 50
		timeout = jiffies + msecs_to_jiffies(TIMEOUT);
		while (!time_after(jiffies, timeout)) {
			ret = i2c_master_recv(s->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(&s->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;
		}
	}

	ret = 0;

err_mutex_unlock:
	mutex_unlock(&s->i2c_mutex);
	if (ret)
		goto err;

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

static int si2168_read_status(struct dvb_frontend *fe, fe_status_t *status)
{
	struct si2168 *s = fe->demodulator_priv;
	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
	int ret;
	struct si2168_cmd cmd;

	*status = 0;

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

	switch (c->delivery_system) {
	case SYS_DVBT:
		memcpy(cmd.args, "\xa0\x01", 2);
		cmd.wlen = 2;
		cmd.rlen = 13;
		break;
	case SYS_DVBC_ANNEX_A:
		memcpy(cmd.args, "\x90\x01", 2);
		cmd.wlen = 2;
		cmd.rlen = 9;
		break;
	case SYS_DVBT2:
		memcpy(cmd.args, "\x50\x01", 2);
		cmd.wlen = 2;
		cmd.rlen = 14;
		break;
	default:
		ret = -EINVAL;
		goto err;
	}

	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	/*
	 * Possible values seen, in order from strong signal to weak:
	 * 16 0001 0110 full lock
	 * 1e 0001 1110 partial lock
	 * 1a 0001 1010 partial lock
	 * 18 0001 1000 no lock
	 *
	 * [b3:b1] lock bits
	 * [b4] statistics ready? Set in a few secs after lock is gained.
	 */

	switch ((cmd.args[2] >> 1) & 0x03) {
	case 0x01:
		*status = FE_HAS_SIGNAL | FE_HAS_CARRIER;
		break;
	case 0x03:
		*status = FE_HAS_SIGNAL | FE_HAS_CARRIER | FE_HAS_VITERBI |
				FE_HAS_SYNC | FE_HAS_LOCK;
		break;
	}

	s->fe_status = *status;

	if (*status & FE_HAS_LOCK) {
		c->cnr.len = 1;
		c->cnr.stat[0].scale = FE_SCALE_DECIBEL;
		c->cnr.stat[0].svalue = cmd.args[3] * 1000 / 4;
	} else {
		c->cnr.len = 1;
		c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
	}

	dev_dbg(&s->client->dev, "status=%02x args=%*ph\n",
			*status, cmd.rlen, cmd.args);

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

static int si2168_set_frontend(struct dvb_frontend *fe)
{
	struct si2168 *s = fe->demodulator_priv;
	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
	int ret;
	struct si2168_cmd cmd;
	u8 bandwidth, delivery_system;

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

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

	switch (c->delivery_system) {
	case SYS_DVBT:
		delivery_system = 0x20;
		break;
	case SYS_DVBC_ANNEX_A:
		delivery_system = 0x30;
		break;
	case SYS_DVBT2:
		delivery_system = 0x70;
		break;
	default:
		ret = -EINVAL;
		goto err;
	}

	if (c->bandwidth_hz <= 5000000)
		bandwidth = 0x05;
	else if (c->bandwidth_hz <= 6000000)
		bandwidth = 0x06;
	else if (c->bandwidth_hz <= 7000000)
		bandwidth = 0x07;
	else if (c->bandwidth_hz <= 8000000)
		bandwidth = 0x08;
	else if (c->bandwidth_hz <= 9000000)
		bandwidth = 0x09;
	else if (c->bandwidth_hz <= 10000000)
		bandwidth = 0x0a;
	else
		bandwidth = 0x0f;

	/* program tuner */
	if (fe->ops.tuner_ops.set_params) {
		ret = fe->ops.tuner_ops.set_params(fe);
		if (ret)
			goto err;
	}

	memcpy(cmd.args, "\x88\x02\x02\x02\x02", 5);
	cmd.wlen = 5;
	cmd.rlen = 5;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	/* that has no big effect */
	if (c->delivery_system == SYS_DVBT)
		memcpy(cmd.args, "\x89\x21\x06\x11\xff\x98", 6);
	else if (c->delivery_system == SYS_DVBC_ANNEX_A)
		memcpy(cmd.args, "\x89\x21\x06\x11\x89\xf0", 6);
	else if (c->delivery_system == SYS_DVBT2)
		memcpy(cmd.args, "\x89\x21\x06\x11\x89\x20", 6);
	cmd.wlen = 6;
	cmd.rlen = 3;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	if (c->delivery_system == SYS_DVBT2) {
		/* select PLP */
		cmd.args[0] = 0x52;
		cmd.args[1] = c->stream_id & 0xff;
		cmd.args[2] = c->stream_id == NO_STREAM_ID_FILTER ? 0 : 1;
		cmd.wlen = 3;
		cmd.rlen = 1;
		ret = si2168_cmd_execute(s, &cmd);
		if (ret)
			goto err;
	}

	memcpy(cmd.args, "\x51\x03", 2);
	cmd.wlen = 2;
	cmd.rlen = 12;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	memcpy(cmd.args, "\x12\x08\x04", 3);
	cmd.wlen = 3;
	cmd.rlen = 3;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	memcpy(cmd.args, "\x14\x00\x0c\x10\x12\x00", 6);
	cmd.wlen = 6;
	cmd.rlen = 4;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	memcpy(cmd.args, "\x14\x00\x06\x10\x24\x00", 6);
	cmd.wlen = 6;
	cmd.rlen = 4;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	memcpy(cmd.args, "\x14\x00\x07\x10\x00\x24", 6);
	cmd.wlen = 6;
	cmd.rlen = 4;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	memcpy(cmd.args, "\x14\x00\x0a\x10\x00\x00", 6);
	cmd.args[4] = delivery_system | bandwidth;
	cmd.wlen = 6;
	cmd.rlen = 4;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	/* set DVB-C symbol rate */
	if (c->delivery_system == SYS_DVBC_ANNEX_A) {
		memcpy(cmd.args, "\x14\x00\x02\x11", 4);
		cmd.args[4] = (c->symbol_rate / 1000) & 0xff;
		cmd.args[5] = ((c->symbol_rate / 1000) >> 8) & 0xff;
		cmd.wlen = 6;
		cmd.rlen = 4;
		ret = si2168_cmd_execute(s, &cmd);
		if (ret)
			goto err;
	}

	memcpy(cmd.args, "\x14\x00\x0f\x10\x10\x00", 6);
	cmd.wlen = 6;
	cmd.rlen = 4;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	memcpy(cmd.args, "\x14\x00\x09\x10\xe3\x18", 6);
	cmd.wlen = 6;
	cmd.rlen = 4;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	memcpy(cmd.args, "\x14\x00\x08\x10\xd7\x15", 6);
	cmd.wlen = 6;
	cmd.rlen = 4;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	memcpy(cmd.args, "\x14\x00\x01\x12\x00\x00", 6);
	cmd.wlen = 6;
	cmd.rlen = 4;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	memcpy(cmd.args, "\x14\x00\x01\x03\x0c\x00", 6);
	cmd.wlen = 6;
	cmd.rlen = 4;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	memcpy(cmd.args, "\x85", 1);
	cmd.wlen = 1;
	cmd.rlen = 1;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	s->delivery_system = c->delivery_system;

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

static int si2168_init(struct dvb_frontend *fe)
{
	struct si2168 *s = fe->demodulator_priv;
	int ret, len, remaining;
	const struct firmware *fw = NULL;
	u8 *fw_file;
	const unsigned int i2c_wr_max = 8;
	struct si2168_cmd cmd;
	unsigned int chip_id;

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

	/* initialize */
	memcpy(cmd.args, "\xc0\x12\x00\x0c\x00\x0d\x16\x00\x00\x00\x00\x00\x00", 13);
	cmd.wlen = 13;
	cmd.rlen = 0;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	if (s->fw_loaded) {
		/* resume */
		memcpy(cmd.args, "\xc0\x06\x08\x0f\x00\x20\x21\x01", 8);
		cmd.wlen = 8;
		cmd.rlen = 1;
		ret = si2168_cmd_execute(s, &cmd);
		if (ret)
			goto err;

		memcpy(cmd.args, "\x85", 1);
		cmd.wlen = 1;
		cmd.rlen = 1;
		ret = si2168_cmd_execute(s, &cmd);
		if (ret)
			goto err;

		goto warm;
	}

	/* power up */
	memcpy(cmd.args, "\xc0\x06\x01\x0f\x00\x20\x20\x01", 8);
	cmd.wlen = 8;
	cmd.rlen = 1;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

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

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

	#define SI2168_A20 ('A' << 24 | 68 << 16 | '2' << 8 | '0' << 0)
	#define SI2168_A30 ('A' << 24 | 68 << 16 | '3' << 8 | '0' << 0)
	#define SI2168_B40 ('B' << 24 | 68 << 16 | '4' << 8 | '0' << 0)

	switch (chip_id) {
	case SI2168_A20:
		fw_file = SI2168_A20_FIRMWARE;
		break;
	case SI2168_A30:
		fw_file = SI2168_A30_FIRMWARE;
		break;
	case SI2168_B40:
		fw_file = SI2168_B40_FIRMWARE;
		break;
	default:
		dev_err(&s->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;
	}

	/* cold state - try to download firmware */
	dev_info(&s->client->dev, "found a '%s' in cold state\n",
			si2168_ops.info.name);

	/* request the firmware, this will block and timeout */
	ret = request_firmware(&fw, fw_file, &s->client->dev);
	if (ret) {
		/* fallback mechanism to handle old name for Si2168 B40 fw */
		if (chip_id == SI2168_B40) {
			fw_file = SI2168_B40_FIRMWARE_FALLBACK;
			ret = request_firmware(&fw, fw_file, &s->client->dev);
		}

		if (ret == 0) {
			dev_notice(&s->client->dev,
					"please install firmware file '%s'\n",
					SI2168_B40_FIRMWARE);
		} else {
			dev_err(&s->client->dev,
					"firmware file '%s' not found\n",
					fw_file);
			goto err;
		}
	}

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

	for (remaining = fw->size; remaining > 0; remaining -= i2c_wr_max) {
		len = remaining;
		if (len > i2c_wr_max)
			len = i2c_wr_max;

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

	release_firmware(fw);
	fw = NULL;

	memcpy(cmd.args, "\x01\x01", 2);
	cmd.wlen = 2;
	cmd.rlen = 1;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	/* set ts mode */
	memcpy(cmd.args, "\x14\x00\x01\x10\x10\x00", 6);
	cmd.args[4] |= s->ts_mode;
	cmd.wlen = 6;
	cmd.rlen = 4;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

	s->fw_loaded = true;

warm:
	dev_info(&s->client->dev, "found a '%s' in warm state\n",
			si2168_ops.info.name);

	s->active = true;

	return 0;
err:
	if (fw)
		release_firmware(fw);

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

static int si2168_sleep(struct dvb_frontend *fe)
{
	struct si2168 *s = fe->demodulator_priv;
	int ret;
	struct si2168_cmd cmd;

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

	s->active = false;

	memcpy(cmd.args, "\x13", 1);
	cmd.wlen = 1;
	cmd.rlen = 0;
	ret = si2168_cmd_execute(s, &cmd);
	if (ret)
		goto err;

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

static int si2168_get_tune_settings(struct dvb_frontend *fe,
	struct dvb_frontend_tune_settings *s)
{
	s->min_delay_ms = 900;

	return 0;
}

/*
 * I2C gate logic
 * We must use unlocked i2c_transfer() here because I2C lock is already taken
 * by tuner driver.
 */
static int si2168_select(struct i2c_adapter *adap, void *mux_priv, u32 chan)
{
	struct si2168 *s = mux_priv;
	int ret;
	struct i2c_msg gate_open_msg = {
		.addr = s->client->addr,
		.flags = 0,
		.len = 3,
		.buf = "\xc0\x0d\x01",
	};

	mutex_lock(&s->i2c_mutex);

	/* open tuner I2C gate */
	ret = __i2c_transfer(s->client->adapter, &gate_open_msg, 1);
	if (ret != 1) {
		dev_warn(&s->client->dev, "i2c write failed=%d\n", ret);
		if (ret >= 0)
			ret = -EREMOTEIO;
	} else {
		ret = 0;
	}

	return ret;
}

static int si2168_deselect(struct i2c_adapter *adap, void *mux_priv, u32 chan)
{
	struct si2168 *s = mux_priv;
	int ret;
	struct i2c_msg gate_close_msg = {
		.addr = s->client->addr,
		.flags = 0,
		.len = 3,
		.buf = "\xc0\x0d\x00",
	};

	/* close tuner I2C gate */
	ret = __i2c_transfer(s->client->adapter, &gate_close_msg, 1);
	if (ret != 1) {
		dev_warn(&s->client->dev, "i2c write failed=%d\n", ret);
		if (ret >= 0)
			ret = -EREMOTEIO;
	} else {
		ret = 0;
	}

	mutex_unlock(&s->i2c_mutex);

	return ret;
}

static const struct dvb_frontend_ops si2168_ops = {
	.delsys = {SYS_DVBT, SYS_DVBT2, SYS_DVBC_ANNEX_A},
	.info = {
		.name = "Silicon Labs Si2168",
		.caps =	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_32 |
			FE_CAN_QAM_64 |
			FE_CAN_QAM_128 |
			FE_CAN_QAM_256 |
			FE_CAN_QAM_AUTO |
			FE_CAN_TRANSMISSION_MODE_AUTO |
			FE_CAN_GUARD_INTERVAL_AUTO |
			FE_CAN_HIERARCHY_AUTO |
			FE_CAN_MUTE_TS |
			FE_CAN_2G_MODULATION |
			FE_CAN_MULTISTREAM
	},

	.get_tune_settings = si2168_get_tune_settings,

	.init = si2168_init,
	.sleep = si2168_sleep,

	.set_frontend = si2168_set_frontend,

	.read_status = si2168_read_status,
};

static int si2168_probe(struct i2c_client *client,
		const struct i2c_device_id *id)
{
	struct si2168_config *config = client->dev.platform_data;
	struct si2168 *s;
	int ret;

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

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

	s->client = client;
	mutex_init(&s->i2c_mutex);

	/* create mux i2c adapter for tuner */
	s->adapter = i2c_add_mux_adapter(client->adapter, &client->dev, s,
			0, 0, 0, si2168_select, si2168_deselect);
	if (s->adapter == NULL) {
		ret = -ENODEV;
		goto err;
	}

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

	*config->i2c_adapter = s->adapter;
	*config->fe = &s->fe;
	s->ts_mode = config->ts_mode;
	s->fw_loaded = false;

	i2c_set_clientdata(client, s);

	dev_info(&s->client->dev,
			"Silicon Labs Si2168 successfully attached\n");
	return 0;
err:
	kfree(s);
	dev_dbg(&client->dev, "failed=%d\n", ret);
	return ret;
}

static int si2168_remove(struct i2c_client *client)
{
	struct si2168 *s = i2c_get_clientdata(client);

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

	i2c_del_mux_adapter(s->adapter);

	s->fe.ops.release = NULL;
	s->fe.demodulator_priv = NULL;

	kfree(s);

	return 0;
}

static const struct i2c_device_id si2168_id[] = {
	{"si2168", 0},
	{}
};
MODULE_DEVICE_TABLE(i2c, si2168_id);

static struct i2c_driver si2168_driver = {
	.driver = {
		.owner	= THIS_MODULE,
		.name	= "si2168",
	},
	.probe		= si2168_probe,
	.remove		= si2168_remove,
	.id_table	= si2168_id,
};

module_i2c_driver(si2168_driver);

MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
MODULE_DESCRIPTION("Silicon Labs Si2168 DVB-T/T2/C demodulator driver");
MODULE_LICENSE("GPL");
MODULE_FIRMWARE(SI2168_A20_FIRMWARE);
MODULE_FIRMWARE(SI2168_A30_FIRMWARE);
MODULE_FIRMWARE(SI2168_B40_FIRMWARE);
Commit	Line	Data
711615df AP	1	/*
	2	* Silicon Labs Si2168 DVB-T/T2/C demodulator driver
	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
845f3505 AP	17	#include "si2168_priv.h"
	18
	19	static const struct dvb_frontend_ops si2168_ops;
	20
	21	/* execute firmware command */
	22	static int si2168_cmd_execute(struct si2168 s, struct si2168_cmd cmd)
	23	{
	24	int ret;
	25	unsigned long timeout;
	26
	27	mutex_lock(&s->i2c_mutex);
	28
	29	if (cmd->wlen) {
	30	/* write cmd and args for firmware */
	31	ret = i2c_master_send(s->client, cmd->args, cmd->wlen);
	32	if (ret < 0) {
	33	goto err_mutex_unlock;
	34	} else if (ret != cmd->wlen) {
	35	ret = -EREMOTEIO;
	36	goto err_mutex_unlock;
	37	}
	38	}
	39
	40	if (cmd->rlen) {
	41	/* wait cmd execution terminate */
	42	#define TIMEOUT 50
	43	timeout = jiffies + msecs_to_jiffies(TIMEOUT);
	44	while (!time_after(jiffies, timeout)) {
	45	ret = i2c_master_recv(s->client, cmd->args, cmd->rlen);
	46	if (ret < 0) {
	47	goto err_mutex_unlock;
	48	} else if (ret != cmd->rlen) {
	49	ret = -EREMOTEIO;
	50	goto err_mutex_unlock;
	51	}
	52
	53	/* firmware ready? */
	54	if ((cmd->args[0] >> 7) & 0x01)
	55	break;
	56	}
	57
37b4e43d	58	dev_dbg(&s->client->dev, "cmd execution took %d ms\n",
845f3505 AP	59	jiffies_to_msecs(jiffies) -
	60	(jiffies_to_msecs(timeout) - TIMEOUT));
	61
eefae30a	62	if (!((cmd->args[0] >> 7) & 0x01)) {
845f3505 AP	63	ret = -ETIMEDOUT;
	64	goto err_mutex_unlock;
	65	}
	66	}
	67
	68	ret = 0;
	69
	70	err_mutex_unlock:
	71	mutex_unlock(&s->i2c_mutex);
	72	if (ret)
	73	goto err;
	74
	75	return 0;
	76	err:
37b4e43d	77	dev_dbg(&s->client->dev, "failed=%d\n", ret);
845f3505 AP	78	return ret;
	79	}
	80
	81	static int si2168_read_status(struct dvb_frontend fe, fe_status_t status)
	82	{
	83	struct si2168 *s = fe->demodulator_priv;
bffab93c	84	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
845f3505 AP	85	int ret;
	86	struct si2168_cmd cmd;
	87
	88	*status = 0;
	89
	90	if (!s->active) {
	91	ret = -EAGAIN;
	92	goto err;
	93	}
	94
bffab93c AP	95	switch (c->delivery_system) {
bffab93c AP	96	case SYS_DVBT:
888680ff	97	memcpy(cmd.args, "\xa0\x01", 2);
bffab93c AP	98	cmd.wlen = 2;
	99	cmd.rlen = 13;
	100	break;
c790885b	101	case SYS_DVBC_ANNEX_A:
888680ff	102	memcpy(cmd.args, "\x90\x01", 2);
c790885b AP	103	cmd.wlen = 2;
	104	cmd.rlen = 9;
	105	break;
bffab93c	106	case SYS_DVBT2:
888680ff	107	memcpy(cmd.args, "\x50\x01", 2);
bffab93c AP	108	cmd.wlen = 2;
	109	cmd.rlen = 14;
	110	break;
	111	default:
	112	ret = -EINVAL;
	113	goto err;
	114	}
	115
845f3505 AP	116	ret = si2168_cmd_execute(s, &cmd);
	117	if (ret)
	118	goto err;
	119
	120	/*
	121	* Possible values seen, in order from strong signal to weak:
	122	* 16 0001 0110 full lock
	123	* 1e 0001 1110 partial lock
	124	* 1a 0001 1010 partial lock
	125	* 18 0001 1000 no lock
	126	*
	127	* [b3:b1] lock bits
	128	* [b4] statistics ready? Set in a few secs after lock is gained.
	129	*/
	130
722a042d AP	131	switch ((cmd.args[2] >> 1) & 0x03) {
722a042d AP	132	case 0x01:
845f3505 AP	133	*status = FE_HAS_SIGNAL \| FE_HAS_CARRIER;
845f3505 AP	134	break;
722a042d	135	case 0x03:
845f3505 AP	136	*status = FE_HAS_SIGNAL \| FE_HAS_CARRIER \| FE_HAS_VITERBI \|
	137	FE_HAS_SYNC \| FE_HAS_LOCK;
	138	break;
	139	}
	140
	141	s->fe_status = *status;
	142
88ac8f86 AP	143	if (*status & FE_HAS_LOCK) {
	144	c->cnr.len = 1;
	145	c->cnr.stat[0].scale = FE_SCALE_DECIBEL;
	146	c->cnr.stat[0].svalue = cmd.args[3] * 1000 / 4;
	147	} else {
	148	c->cnr.len = 1;
	149	c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
	150	}
	151
37b4e43d OS	152	dev_dbg(&s->client->dev, "status=%02x args=%*ph\n",
37b4e43d OS	153	*status, cmd.rlen, cmd.args);
845f3505 AP	154
	155	return 0;
	156	err:
37b4e43d	157	dev_dbg(&s->client->dev, "failed=%d\n", ret);
845f3505 AP	158	return ret;
	159	}
	160
	161	static int si2168_set_frontend(struct dvb_frontend *fe)
	162	{
	163	struct si2168 *s = fe->demodulator_priv;
	164	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
	165	int ret;
	166	struct si2168_cmd cmd;
bffab93c	167	u8 bandwidth, delivery_system;
845f3505 AP	168
845f3505 AP	169	dev_dbg(&s->client->dev,
e395e573	170	"delivery_system=%u modulation=%u frequency=%u bandwidth_hz=%u symbol_rate=%u inversion=%u, stream_id=%d\n",
37b4e43d	171	c->delivery_system, c->modulation,
845f3505	172	c->frequency, c->bandwidth_hz, c->symbol_rate,
e395e573	173	c->inversion, c->stream_id);
845f3505 AP	174
	175	if (!s->active) {
	176	ret = -EAGAIN;
	177	goto err;
	178	}
	179
bffab93c AP	180	switch (c->delivery_system) {
	181	case SYS_DVBT:
	182	delivery_system = 0x20;
	183	break;
c790885b AP	184	case SYS_DVBC_ANNEX_A:
	185	delivery_system = 0x30;
	186	break;
bffab93c AP	187	case SYS_DVBT2:
	188	delivery_system = 0x70;
	189	break;
	190	default:
	191	ret = -EINVAL;
	192	goto err;
	193	}
	194
c790885b	195	if (c->bandwidth_hz <= 5000000)
bffab93c	196	bandwidth = 0x05;
c790885b	197	else if (c->bandwidth_hz <= 6000000)
bffab93c	198	bandwidth = 0x06;
c790885b	199	else if (c->bandwidth_hz <= 7000000)
bffab93c	200	bandwidth = 0x07;
c790885b	201	else if (c->bandwidth_hz <= 8000000)
bffab93c	202	bandwidth = 0x08;
c790885b AP	203	else if (c->bandwidth_hz <= 9000000)
	204	bandwidth = 0x09;
	205	else if (c->bandwidth_hz <= 10000000)
	206	bandwidth = 0x0a;
	207	else
	208	bandwidth = 0x0f;
845f3505 AP	209
	210	/* program tuner */
	211	if (fe->ops.tuner_ops.set_params) {
	212	ret = fe->ops.tuner_ops.set_params(fe);
	213	if (ret)
	214	goto err;
	215	}
	216
	217	memcpy(cmd.args, "\x88\x02\x02\x02\x02", 5);
	218	cmd.wlen = 5;
	219	cmd.rlen = 5;
	220	ret = si2168_cmd_execute(s, &cmd);
	221	if (ret)
	222	goto err;
	223
bffab93c AP	224	/* that has no big effect */
	225	if (c->delivery_system == SYS_DVBT)
	226	memcpy(cmd.args, "\x89\x21\x06\x11\xff\x98", 6);
c790885b AP	227	else if (c->delivery_system == SYS_DVBC_ANNEX_A)
c790885b AP	228	memcpy(cmd.args, "\x89\x21\x06\x11\x89\xf0", 6);
bffab93c AP	229	else if (c->delivery_system == SYS_DVBT2)
bffab93c AP	230	memcpy(cmd.args, "\x89\x21\x06\x11\x89\x20", 6);
845f3505 AP	231	cmd.wlen = 6;
	232	cmd.rlen = 3;
	233	ret = si2168_cmd_execute(s, &cmd);
	234	if (ret)
	235	goto err;
	236
e395e573 C	237	if (c->delivery_system == SYS_DVBT2) {
	238	/* select PLP */
	239	cmd.args[0] = 0x52;
	240	cmd.args[1] = c->stream_id & 0xff;
	241	cmd.args[2] = c->stream_id == NO_STREAM_ID_FILTER ? 0 : 1;
	242	cmd.wlen = 3;
	243	cmd.rlen = 1;
	244	ret = si2168_cmd_execute(s, &cmd);
	245	if (ret)
	246	goto err;
	247	}
	248
845f3505 AP	249	memcpy(cmd.args, "\x51\x03", 2);
	250	cmd.wlen = 2;
	251	cmd.rlen = 12;
	252	ret = si2168_cmd_execute(s, &cmd);
	253	if (ret)
	254	goto err;
	255
	256	memcpy(cmd.args, "\x12\x08\x04", 3);
	257	cmd.wlen = 3;
	258	cmd.rlen = 3;
	259	ret = si2168_cmd_execute(s, &cmd);
	260	if (ret)
	261	goto err;
	262
845f3505 AP	263	memcpy(cmd.args, "\x14\x00\x0c\x10\x12\x00", 6);
845f3505 AP	264	cmd.wlen = 6;
1d518c27	265	cmd.rlen = 4;
845f3505 AP	266	ret = si2168_cmd_execute(s, &cmd);
	267	if (ret)
	268	goto err;
	269
	270	memcpy(cmd.args, "\x14\x00\x06\x10\x24\x00", 6);
	271	cmd.wlen = 6;
1d518c27	272	cmd.rlen = 4;
845f3505 AP	273	ret = si2168_cmd_execute(s, &cmd);
	274	if (ret)
	275	goto err;
	276
845f3505 AP	277	memcpy(cmd.args, "\x14\x00\x07\x10\x00\x24", 6);
845f3505 AP	278	cmd.wlen = 6;
1d518c27	279	cmd.rlen = 4;
845f3505 AP	280	ret = si2168_cmd_execute(s, &cmd);
	281	if (ret)
	282	goto err;
	283
	284	memcpy(cmd.args, "\x14\x00\x0a\x10\x00\x00", 6);
bffab93c	285	cmd.args[4] = delivery_system \| bandwidth;
845f3505	286	cmd.wlen = 6;
1d518c27	287	cmd.rlen = 4;
845f3505 AP	288	ret = si2168_cmd_execute(s, &cmd);
	289	if (ret)
	290	goto err;
	291
32bf8818 LA	292	/* set DVB-C symbol rate */
	293	if (c->delivery_system == SYS_DVBC_ANNEX_A) {
	294	memcpy(cmd.args, "\x14\x00\x02\x11", 4);
	295	cmd.args[4] = (c->symbol_rate / 1000) & 0xff;
	296	cmd.args[5] = ((c->symbol_rate / 1000) >> 8) & 0xff;
	297	cmd.wlen = 6;
	298	cmd.rlen = 4;
	299	ret = si2168_cmd_execute(s, &cmd);
	300	if (ret)
	301	goto err;
	302	}
	303
845f3505 AP	304	memcpy(cmd.args, "\x14\x00\x0f\x10\x10\x00", 6);
845f3505 AP	305	cmd.wlen = 6;
1d518c27	306	cmd.rlen = 4;
845f3505 AP	307	ret = si2168_cmd_execute(s, &cmd);
	308	if (ret)
	309	goto err;
	310
845f3505 AP	311	memcpy(cmd.args, "\x14\x00\x09\x10\xe3\x18", 6);
845f3505 AP	312	cmd.wlen = 6;
1d518c27	313	cmd.rlen = 4;
845f3505 AP	314	ret = si2168_cmd_execute(s, &cmd);
	315	if (ret)
	316	goto err;
	317
	318	memcpy(cmd.args, "\x14\x00\x08\x10\xd7\x15", 6);
	319	cmd.wlen = 6;
1d518c27	320	cmd.rlen = 4;
845f3505	321	ret = si2168_cmd_execute(s, &cmd);
845f3505 AP	322	if (ret)
	323	goto err;
	324
	325	memcpy(cmd.args, "\x14\x00\x01\x12\x00\x00", 6);
	326	cmd.wlen = 6;
1d518c27	327	cmd.rlen = 4;
845f3505 AP	328	ret = si2168_cmd_execute(s, &cmd);
	329	if (ret)
	330	goto err;
	331
43911776 OS	332	memcpy(cmd.args, "\x14\x00\x01\x03\x0c\x00", 6);
	333	cmd.wlen = 6;
	334	cmd.rlen = 4;
	335	ret = si2168_cmd_execute(s, &cmd);
	336	if (ret)
	337	goto err;
	338
888680ff	339	memcpy(cmd.args, "\x85", 1);
845f3505 AP	340	cmd.wlen = 1;
	341	cmd.rlen = 1;
	342	ret = si2168_cmd_execute(s, &cmd);
	343	if (ret)
	344	goto err;
	345
	346	s->delivery_system = c->delivery_system;
	347
	348	return 0;
	349	err:
37b4e43d	350	dev_dbg(&s->client->dev, "failed=%d\n", ret);
845f3505 AP	351	return ret;
	352	}
	353
	354	static int si2168_init(struct dvb_frontend *fe)
	355	{
	356	struct si2168 *s = fe->demodulator_priv;
	357	int ret, len, remaining;
	358	const struct firmware *fw = NULL;
c9cb0820	359	u8 *fw_file;
845f3505 AP	360	const unsigned int i2c_wr_max = 8;
845f3505 AP	361	struct si2168_cmd cmd;
b6b6fd6f	362	unsigned int chip_id;
845f3505	363
37b4e43d	364	dev_dbg(&s->client->dev, "\n");
845f3505	365
8e417224	366	/* initialize */
888680ff	367	memcpy(cmd.args, "\xc0\x12\x00\x0c\x00\x0d\x16\x00\x00\x00\x00\x00\x00", 13);
845f3505 AP	368	cmd.wlen = 13;
	369	cmd.rlen = 0;
	370	ret = si2168_cmd_execute(s, &cmd);
	371	if (ret)
	372	goto err;
	373
8e417224 OS	374	if (s->fw_loaded) {
	375	/* resume */
	376	memcpy(cmd.args, "\xc0\x06\x08\x0f\x00\x20\x21\x01", 8);
	377	cmd.wlen = 8;
	378	cmd.rlen = 1;
	379	ret = si2168_cmd_execute(s, &cmd);
	380	if (ret)
	381	goto err;
	382
	383	memcpy(cmd.args, "\x85", 1);
	384	cmd.wlen = 1;
	385	cmd.rlen = 1;
	386	ret = si2168_cmd_execute(s, &cmd);
	387	if (ret)
	388	goto err;
	389
	390	goto warm;
	391	}
	392
	393	/* power up */
888680ff	394	memcpy(cmd.args, "\xc0\x06\x01\x0f\x00\x20\x20\x01", 8);
845f3505 AP	395	cmd.wlen = 8;
	396	cmd.rlen = 1;
	397	ret = si2168_cmd_execute(s, &cmd);
	398	if (ret)
	399	goto err;
	400
c9cb0820	401	/* query chip revision */
888680ff	402	memcpy(cmd.args, "\x02", 1);
845f3505 AP	403	cmd.wlen = 1;
	404	cmd.rlen = 13;
	405	ret = si2168_cmd_execute(s, &cmd);
	406	if (ret)
	407	goto err;
	408
b6b6fd6f AP	409	chip_id = cmd.args[1] << 24 \| cmd.args[2] << 16 \| cmd.args[3] << 8 \|
	410	cmd.args[4] << 0;
	411
635a90cf	412	#define SI2168_A20 ('A' << 24 \| 68 << 16 \| '2' << 8 \| '0' << 0)
b6b6fd6f AP	413	#define SI2168_A30 ('A' << 24 \| 68 << 16 \| '3' << 8 \| '0' << 0)
	414	#define SI2168_B40 ('B' << 24 \| 68 << 16 \| '4' << 8 \| '0' << 0)
	415
	416	switch (chip_id) {
635a90cf LA	417	case SI2168_A20:
	418	fw_file = SI2168_A20_FIRMWARE;
	419	break;
b6b6fd6f	420	case SI2168_A30:
c9cb0820	421	fw_file = SI2168_A30_FIRMWARE;
b6b6fd6f AP	422	break;
	423	case SI2168_B40:
	424	fw_file = SI2168_B40_FIRMWARE;
	425	break;
	426	default:
c9cb0820	427	dev_err(&s->client->dev,
37b4e43d OS	428	"unknown chip version Si21%d-%c%c%c\n",
37b4e43d OS	429	cmd.args[2], cmd.args[1],
b6b6fd6f	430	cmd.args[3], cmd.args[4]);
c9cb0820 OS	431	ret = -EINVAL;
	432	goto err;
	433	}
	434
845f3505	435	/* cold state - try to download firmware */
37b4e43d OS	436	dev_info(&s->client->dev, "found a '%s' in cold state\n",
37b4e43d OS	437	si2168_ops.info.name);
845f3505 AP	438
	439	/* request the firmware, this will block and timeout */
	440	ret = request_firmware(&fw, fw_file, &s->client->dev);
	441	if (ret) {
b6b6fd6f AP	442	/* fallback mechanism to handle old name for Si2168 B40 fw */
b6b6fd6f AP	443	if (chip_id == SI2168_B40) {
c9cb0820 OS	444	fw_file = SI2168_B40_FIRMWARE_FALLBACK;
	445	ret = request_firmware(&fw, fw_file, &s->client->dev);
	446	}
b6b6fd6f AP	447
	448	if (ret == 0) {
	449	dev_notice(&s->client->dev,
37b4e43d OS	450	"please install firmware file '%s'\n",
37b4e43d OS	451	SI2168_B40_FIRMWARE);
b6b6fd6f AP	452	} else {
b6b6fd6f AP	453	dev_err(&s->client->dev,
37b4e43d OS	454	"firmware file '%s' not found\n",
37b4e43d OS	455	fw_file);
c9cb0820 OS	456	goto err;
c9cb0820 OS	457	}
845f3505 AP	458	}
845f3505 AP	459
37b4e43d OS	460	dev_info(&s->client->dev, "downloading firmware from file '%s'\n",
37b4e43d OS	461	fw_file);
845f3505 AP	462
	463	for (remaining = fw->size; remaining > 0; remaining -= i2c_wr_max) {
	464	len = remaining;
	465	if (len > i2c_wr_max)
	466	len = i2c_wr_max;
	467
	468	memcpy(cmd.args, &fw->data[fw->size - remaining], len);
	469	cmd.wlen = len;
	470	cmd.rlen = 1;
	471	ret = si2168_cmd_execute(s, &cmd);
	472	if (ret) {
	473	dev_err(&s->client->dev,
37b4e43d OS	474	"firmware download failed=%d\n",
37b4e43d OS	475	ret);
845f3505 AP	476	goto err;
	477	}
	478	}
	479
	480	release_firmware(fw);
	481	fw = NULL;
	482
888680ff	483	memcpy(cmd.args, "\x01\x01", 2);
845f3505 AP	484	cmd.wlen = 2;
	485	cmd.rlen = 1;
	486	ret = si2168_cmd_execute(s, &cmd);
	487	if (ret)
	488	goto err;
	489
389ce398 OS	490	/* set ts mode */
	491	memcpy(cmd.args, "\x14\x00\x01\x10\x10\x00", 6);
	492	cmd.args[4] \|= s->ts_mode;
	493	cmd.wlen = 6;
	494	cmd.rlen = 4;
	495	ret = si2168_cmd_execute(s, &cmd);
	496	if (ret)
	497	goto err;
	498
8e417224 OS	499	s->fw_loaded = true;
	500
	501	warm:
	502	dev_info(&s->client->dev, "found a '%s' in warm state\n",
	503	si2168_ops.info.name);
	504
845f3505 AP	505	s->active = true;
	506
	507	return 0;
	508	err:
	509	if (fw)
	510	release_firmware(fw);
	511
37b4e43d	512	dev_dbg(&s->client->dev, "failed=%d\n", ret);
845f3505 AP	513	return ret;
	514	}
	515
	516	static int si2168_sleep(struct dvb_frontend *fe)
	517	{
	518	struct si2168 *s = fe->demodulator_priv;
4de0ed7c AP	519	int ret;
4de0ed7c AP	520	struct si2168_cmd cmd;
845f3505	521
37b4e43d	522	dev_dbg(&s->client->dev, "\n");
845f3505 AP	523
	524	s->active = false;
	525
4de0ed7c AP	526	memcpy(cmd.args, "\x13", 1);
	527	cmd.wlen = 1;
	528	cmd.rlen = 0;
	529	ret = si2168_cmd_execute(s, &cmd);
	530	if (ret)
	531	goto err;
	532
845f3505	533	return 0;
4de0ed7c	534	err:
37b4e43d	535	dev_dbg(&s->client->dev, "failed=%d\n", ret);
4de0ed7c	536	return ret;
845f3505 AP	537	}
	538
	539	static int si2168_get_tune_settings(struct dvb_frontend *fe,
	540	struct dvb_frontend_tune_settings *s)
	541	{
	542	s->min_delay_ms = 900;
	543
	544	return 0;
	545	}
	546
	547	/*
	548	* I2C gate logic
	549	* We must use unlocked i2c_transfer() here because I2C lock is already taken
	550	* by tuner driver.
	551	*/
	552	static int si2168_select(struct i2c_adapter adap, void mux_priv, u32 chan)
	553	{
	554	struct si2168 *s = mux_priv;
	555	int ret;
	556	struct i2c_msg gate_open_msg = {
	557	.addr = s->client->addr,
	558	.flags = 0,
	559	.len = 3,
	560	.buf = "\xc0\x0d\x01",
	561	};
	562
	563	mutex_lock(&s->i2c_mutex);
	564
	565	/* open tuner I2C gate */
	566	ret = __i2c_transfer(s->client->adapter, &gate_open_msg, 1);
	567	if (ret != 1) {
37b4e43d	568	dev_warn(&s->client->dev, "i2c write failed=%d\n", ret);
845f3505 AP	569	if (ret >= 0)
	570	ret = -EREMOTEIO;
	571	} else {
	572	ret = 0;
	573	}
	574
	575	return ret;
	576	}
	577
	578	static int si2168_deselect(struct i2c_adapter adap, void mux_priv, u32 chan)
	579	{
	580	struct si2168 *s = mux_priv;
	581	int ret;
	582	struct i2c_msg gate_close_msg = {
	583	.addr = s->client->addr,
	584	.flags = 0,
	585	.len = 3,
	586	.buf = "\xc0\x0d\x00",
	587	};
	588
	589	/* close tuner I2C gate */
	590	ret = __i2c_transfer(s->client->adapter, &gate_close_msg, 1);
	591	if (ret != 1) {
37b4e43d	592	dev_warn(&s->client->dev, "i2c write failed=%d\n", ret);
845f3505 AP	593	if (ret >= 0)
	594	ret = -EREMOTEIO;
	595	} else {
	596	ret = 0;
	597	}
	598
	599	mutex_unlock(&s->i2c_mutex);
	600
	601	return ret;
	602	}
	603
	604	static const struct dvb_frontend_ops si2168_ops = {
c790885b	605	.delsys = {SYS_DVBT, SYS_DVBT2, SYS_DVBC_ANNEX_A},
845f3505 AP	606	.info = {
	607	.name = "Silicon Labs Si2168",
	608	.caps = FE_CAN_FEC_1_2 \|
	609	FE_CAN_FEC_2_3 \|
	610	FE_CAN_FEC_3_4 \|
	611	FE_CAN_FEC_5_6 \|
	612	FE_CAN_FEC_7_8 \|
	613	FE_CAN_FEC_AUTO \|
	614	FE_CAN_QPSK \|
	615	FE_CAN_QAM_16 \|
	616	FE_CAN_QAM_32 \|
	617	FE_CAN_QAM_64 \|
	618	FE_CAN_QAM_128 \|
	619	FE_CAN_QAM_256 \|
	620	FE_CAN_QAM_AUTO \|
	621	FE_CAN_TRANSMISSION_MODE_AUTO \|
	622	FE_CAN_GUARD_INTERVAL_AUTO \|
	623	FE_CAN_HIERARCHY_AUTO \|
	624	FE_CAN_MUTE_TS \|
327eeb3a OS	625	FE_CAN_2G_MODULATION \|
327eeb3a OS	626	FE_CAN_MULTISTREAM
845f3505 AP	627	},
	628
	629	.get_tune_settings = si2168_get_tune_settings,
	630
	631	.init = si2168_init,
	632	.sleep = si2168_sleep,
	633
	634	.set_frontend = si2168_set_frontend,
	635
	636	.read_status = si2168_read_status,
	637	};
	638
	639	static int si2168_probe(struct i2c_client *client,
	640	const struct i2c_device_id *id)
	641	{
	642	struct si2168_config *config = client->dev.platform_data;
	643	struct si2168 *s;
	644	int ret;
845f3505	645
37b4e43d	646	dev_dbg(&client->dev, "\n");
845f3505 AP	647
	648	s = kzalloc(sizeof(struct si2168), GFP_KERNEL);
	649	if (!s) {
	650	ret = -ENOMEM;
37b4e43d	651	dev_err(&client->dev, "kzalloc() failed\n");
845f3505 AP	652	goto err;
	653	}
	654
	655	s->client = client;
	656	mutex_init(&s->i2c_mutex);
	657
845f3505 AP	658	/* create mux i2c adapter for tuner */
	659	s->adapter = i2c_add_mux_adapter(client->adapter, &client->dev, s,
	660	0, 0, 0, si2168_select, si2168_deselect);
4d6efc7a LA	661	if (s->adapter == NULL) {
4d6efc7a LA	662	ret = -ENODEV;
845f3505	663	goto err;
4d6efc7a	664	}
845f3505 AP	665
	666	/* create dvb_frontend */
	667	memcpy(&s->fe.ops, &si2168_ops, sizeof(struct dvb_frontend_ops));
	668	s->fe.demodulator_priv = s;
	669
	670	*config->i2c_adapter = s->adapter;
	671	*config->fe = &s->fe;
389ce398	672	s->ts_mode = config->ts_mode;
8e417224	673	s->fw_loaded = false;
845f3505 AP	674
	675	i2c_set_clientdata(client, s);
	676
	677	dev_info(&s->client->dev,
37b4e43d	678	"Silicon Labs Si2168 successfully attached\n");
845f3505 AP	679	return 0;
	680	err:
	681	kfree(s);
37b4e43d	682	dev_dbg(&client->dev, "failed=%d\n", ret);
845f3505 AP	683	return ret;
	684	}
	685
	686	static int si2168_remove(struct i2c_client *client)
	687	{
	688	struct si2168 *s = i2c_get_clientdata(client);
	689
37b4e43d	690	dev_dbg(&client->dev, "\n");
845f3505 AP	691
	692	i2c_del_mux_adapter(s->adapter);
	693
	694	s->fe.ops.release = NULL;
	695	s->fe.demodulator_priv = NULL;
	696
	697	kfree(s);
	698
	699	return 0;
	700	}
	701
	702	static const struct i2c_device_id si2168_id[] = {
	703	{"si2168", 0},
	704	{}
	705	};
	706	MODULE_DEVICE_TABLE(i2c, si2168_id);
	707
	708	static struct i2c_driver si2168_driver = {
	709	.driver = {
	710	.owner = THIS_MODULE,
	711	.name = "si2168",
	712	},
	713	.probe = si2168_probe,
	714	.remove = si2168_remove,
	715	.id_table = si2168_id,
	716	};
	717
	718	module_i2c_driver(si2168_driver);
	719
	720	MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
	721	MODULE_DESCRIPTION("Silicon Labs Si2168 DVB-T/T2/C demodulator driver");
	722	MODULE_LICENSE("GPL");
635a90cf	723	MODULE_FIRMWARE(SI2168_A20_FIRMWARE);
668aa63c	724	MODULE_FIRMWARE(SI2168_A30_FIRMWARE);
c9cb0820	725	MODULE_FIRMWARE(SI2168_B40_FIRMWARE);