linux/drivers/media/tuners/si2157.c

245 lines
4.8 KiB
C
Raw Normal View History

#include "si2157_priv.h"
/* execute firmware command */
static int si2157_cmd_execute(struct si2157 *s, struct si2157_cmd *cmd)
{
int ret;
u8 buf[1];
unsigned long timeout;
mutex_lock(&s->i2c_mutex);
if (cmd->len) {
/* write cmd and args for firmware */
ret = i2c_master_send(s->client, cmd->args, cmd->len);
if (ret < 0) {
goto err_mutex_unlock;
} else if (ret != cmd->len) {
ret = -EREMOTEIO;
goto err_mutex_unlock;
}
}
/* wait cmd execution terminate */
#define TIMEOUT 80
timeout = jiffies + msecs_to_jiffies(TIMEOUT);
while (!time_after(jiffies, timeout)) {
ret = i2c_master_recv(s->client, buf, 1);
if (ret < 0) {
goto err_mutex_unlock;
} else if (ret != 1) {
ret = -EREMOTEIO;
goto err_mutex_unlock;
}
/* firmware ready? */
if ((buf[0] >> 7) & 0x01)
break;
}
dev_dbg(&s->client->dev, "%s: cmd execution took %d ms\n", __func__,
jiffies_to_msecs(jiffies) -
(jiffies_to_msecs(timeout) - TIMEOUT));
if (!(buf[0] >> 7) & 0x01) {
ret = -ETIMEDOUT;
goto err_mutex_unlock;
} else {
ret = 0;
}
err_mutex_unlock:
mutex_unlock(&s->i2c_mutex);
if (ret)
goto err;
return 0;
err:
dev_dbg(&s->client->dev, "%s: failed=%d\n", __func__, ret);
return ret;
}
static int si2157_init(struct dvb_frontend *fe)
{
struct si2157 *s = fe->tuner_priv;
dev_dbg(&s->client->dev, "%s:\n", __func__);
s->active = true;
return 0;
}
static int si2157_sleep(struct dvb_frontend *fe)
{
struct si2157 *s = fe->tuner_priv;
dev_dbg(&s->client->dev, "%s:\n", __func__);
s->active = false;
return 0;
}
static int si2157_set_params(struct dvb_frontend *fe)
{
struct si2157 *s = fe->tuner_priv;
struct dtv_frontend_properties *c = &fe->dtv_property_cache;
int ret;
struct si2157_cmd cmd;
dev_dbg(&s->client->dev,
"%s: delivery_system=%d frequency=%u bandwidth_hz=%u\n",
__func__, c->delivery_system, c->frequency,
c->bandwidth_hz);
if (!s->active) {
ret = -EAGAIN;
goto err;
}
/* configure? */
cmd.args[0] = 0xc0;
cmd.args[1] = 0x00;
cmd.args[2] = 0x0c;
cmd.args[3] = 0x00;
cmd.args[4] = 0x00;
cmd.args[5] = 0x01;
cmd.args[6] = 0x01;
cmd.args[7] = 0x01;
cmd.args[8] = 0x01;
cmd.args[9] = 0x01;
cmd.args[10] = 0x01;
cmd.args[11] = 0x02;
cmd.args[12] = 0x00;
cmd.args[13] = 0x00;
cmd.args[14] = 0x01;
cmd.len = 15;
ret = si2157_cmd_execute(s, &cmd);
if (ret)
goto err;
cmd.args[0] = 0x02;
cmd.len = 1;
ret = si2157_cmd_execute(s, &cmd);
if (ret)
goto err;
cmd.args[0] = 0x01;
cmd.args[1] = 0x01;
cmd.len = 2;
ret = si2157_cmd_execute(s, &cmd);
if (ret)
goto err;
/* set frequency */
cmd.args[0] = 0x41;
cmd.args[1] = 0x00;
cmd.args[2] = 0x00;
cmd.args[3] = 0x00;
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.len = 8;
ret = si2157_cmd_execute(s, &cmd);
if (ret)
goto err;
return 0;
err:
dev_dbg(&s->client->dev, "%s: failed=%d\n", __func__, ret);
return ret;
}
static const struct dvb_tuner_ops si2157_tuner_ops = {
.info = {
.name = "Silicon Labs Si2157",
.frequency_min = 174000000,
.frequency_max = 862000000,
},
.init = si2157_init,
.sleep = si2157_sleep,
.set_params = si2157_set_params,
};
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 *s;
struct si2157_cmd cmd;
int ret;
s = kzalloc(sizeof(struct si2157), GFP_KERNEL);
if (!s) {
ret = -ENOMEM;
dev_err(&client->dev, "%s: kzalloc() failed\n", KBUILD_MODNAME);
goto err;
}
s->client = client;
s->fe = cfg->fe;
mutex_init(&s->i2c_mutex);
/* check if the tuner is there */
cmd.len = 0;
ret = si2157_cmd_execute(s, &cmd);
if (ret)
goto err;
fe->tuner_priv = s;
memcpy(&fe->ops.tuner_ops, &si2157_tuner_ops,
sizeof(struct dvb_tuner_ops));
i2c_set_clientdata(client, s);
dev_info(&s->client->dev,
"%s: Silicon Labs Si2157 successfully attached\n",
KBUILD_MODNAME);
return 0;
err:
dev_dbg(&client->dev, "%s: failed=%d\n", __func__, ret);
kfree(s);
return ret;
}
static int si2157_remove(struct i2c_client *client)
{
struct si2157 *s = i2c_get_clientdata(client);
struct dvb_frontend *fe = s->fe;
dev_dbg(&client->dev, "%s:\n", __func__);
memset(&fe->ops.tuner_ops, 0, sizeof(struct dvb_tuner_ops));
fe->tuner_priv = NULL;
kfree(s);
return 0;
}
static const struct i2c_device_id si2157_id[] = {
{"si2157", 0},
{}
};
MODULE_DEVICE_TABLE(i2c, si2157_id);
static struct i2c_driver si2157_driver = {
.driver = {
.owner = THIS_MODULE,
.name = "si2157",
},
.probe = si2157_probe,
.remove = si2157_remove,
.id_table = si2157_id,
};
module_i2c_driver(si2157_driver);
MODULE_DESCRIPTION("Silicon Labs Si2157 silicon tuner driver");
MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
MODULE_LICENSE("GPL");