mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-22 20:23:57 +08:00
V4L/DVB (6555): tuner: reorder functions to prepare for i2c conversion
Signed-off-by: Hans Verkuil <hverkuil@xs4all.nl> Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>
This commit is contained in:
Hans Verkuil
Mauro Carvalho Chehab
parent
159ffe77cd
commit
92de1f16d1
@ -585,221 +585,6 @@ static void tuner_status(struct dvb_frontend *fe)
|
||||
|
||||
/* ---------------------------------------------------------------------- */
|
||||
|
||||
LIST_HEAD(tuner_list);
|
||||
|
||||
/* Search for existing radio and/or TV tuners on the given I2C adapter.
|
||||
Note that when this function is called from tuner_attach you can be
|
||||
certain no other devices will be added/deleted at the same time, I2C
|
||||
core protects against that. */
|
||||
static void tuner_lookup(struct i2c_adapter *adap,
|
||||
struct tuner **radio, struct tuner **tv)
|
||||
{
|
||||
struct tuner *pos;
|
||||
|
||||
*radio = NULL;
|
||||
*tv = NULL;
|
||||
|
||||
list_for_each_entry(pos, &tuner_list, list) {
|
||||
int mode_mask;
|
||||
|
||||
if (pos->i2c->adapter != adap ||
|
||||
pos->i2c->driver->id != I2C_DRIVERID_TUNER)
|
||||
continue;
|
||||
|
||||
mode_mask = pos->mode_mask & ~T_STANDBY;
|
||||
if (*radio == NULL && mode_mask == T_RADIO)
|
||||
*radio = pos;
|
||||
/* Note: currently TDA9887 is the only demod-only
|
||||
device. If other devices appear then we need to
|
||||
make this test more general. */
|
||||
else if (*tv == NULL && pos->type != TUNER_TDA9887 &&
|
||||
(pos->mode_mask & (T_ANALOG_TV | T_DIGITAL_TV)))
|
||||
*tv = pos;
|
||||
}
|
||||
}
|
||||
|
||||
/* During client attach, set_type is called by adapter's attach_inform callback.
|
||||
set_type must then be completed by tuner_attach.
|
||||
*/
|
||||
static int tuner_attach(struct i2c_adapter *adap, int addr, int kind)
|
||||
{
|
||||
struct i2c_client *client;
|
||||
struct tuner *t;
|
||||
struct tuner *radio;
|
||||
struct tuner *tv;
|
||||
|
||||
client = kmalloc(sizeof(struct i2c_client), GFP_KERNEL);
|
||||
if (NULL == client)
|
||||
return -ENOMEM;
|
||||
|
||||
t = kzalloc(sizeof(struct tuner), GFP_KERNEL);
|
||||
if (NULL == t) {
|
||||
kfree(client);
|
||||
return -ENOMEM;
|
||||
}
|
||||
t->i2c = client;
|
||||
client_template.adapter = adap;
|
||||
client_template.addr = addr;
|
||||
memcpy(client, &client_template, sizeof(struct i2c_client));
|
||||
i2c_set_clientdata(client, t);
|
||||
t->type = UNSET;
|
||||
t->audmode = V4L2_TUNER_MODE_STEREO;
|
||||
t->mode_mask = T_UNINITIALIZED;
|
||||
|
||||
if (show_i2c) {
|
||||
unsigned char buffer[16];
|
||||
int i,rc;
|
||||
|
||||
memset(buffer, 0, sizeof(buffer));
|
||||
rc = i2c_master_recv(client, buffer, sizeof(buffer));
|
||||
tuner_info("I2C RECV = ");
|
||||
for (i=0;i<rc;i++)
|
||||
printk("%02x ",buffer[i]);
|
||||
printk("\n");
|
||||
}
|
||||
/* HACK: This test were added to avoid tuner to probe tda9840 and tea6415c on the MXB card */
|
||||
if (adap->id == I2C_HW_SAA7146 && addr < 0x4a)
|
||||
return -ENODEV;
|
||||
|
||||
/* autodetection code based on the i2c addr */
|
||||
if (!no_autodetect) {
|
||||
switch (addr) {
|
||||
case 0x10:
|
||||
if (tea5761_autodetection(t->i2c->adapter, t->i2c->addr) != EINVAL) {
|
||||
t->type = TUNER_TEA5761;
|
||||
t->mode_mask = T_RADIO;
|
||||
t->mode = T_STANDBY;
|
||||
t->radio_freq = 87.5 * 16000; /* Sets freq to FM range */
|
||||
tuner_lookup(t->i2c->adapter, &radio, &tv);
|
||||
if (tv)
|
||||
tv->mode_mask &= ~T_RADIO;
|
||||
|
||||
goto register_client;
|
||||
}
|
||||
break;
|
||||
case 0x42:
|
||||
case 0x43:
|
||||
case 0x4a:
|
||||
case 0x4b:
|
||||
/* If chip is not tda8290, don't register.
|
||||
since it can be tda9887*/
|
||||
if (tda829x_probe(t) == 0) {
|
||||
tuner_dbg("tda829x detected\n");
|
||||
} else {
|
||||
/* Default is being tda9887 */
|
||||
t->type = TUNER_TDA9887;
|
||||
t->mode_mask = T_RADIO | T_ANALOG_TV | T_DIGITAL_TV;
|
||||
t->mode = T_STANDBY;
|
||||
goto register_client;
|
||||
}
|
||||
break;
|
||||
case 0x60:
|
||||
if (tea5767_autodetection(t->i2c->adapter, t->i2c->addr) != EINVAL) {
|
||||
t->type = TUNER_TEA5767;
|
||||
t->mode_mask = T_RADIO;
|
||||
t->mode = T_STANDBY;
|
||||
t->radio_freq = 87.5 * 16000; /* Sets freq to FM range */
|
||||
tuner_lookup(t->i2c->adapter, &radio, &tv);
|
||||
if (tv)
|
||||
tv->mode_mask &= ~T_RADIO;
|
||||
|
||||
goto register_client;
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/* Initializes only the first TV tuner on this adapter. Why only the
|
||||
first? Because there are some devices (notably the ones with TI
|
||||
tuners) that have more than one i2c address for the *same* device.
|
||||
Experience shows that, except for just one case, the first
|
||||
address is the right one. The exception is a Russian tuner
|
||||
(ACORP_Y878F). So, the desired behavior is just to enable the
|
||||
first found TV tuner. */
|
||||
tuner_lookup(t->i2c->adapter, &radio, &tv);
|
||||
if (tv == NULL) {
|
||||
t->mode_mask = T_ANALOG_TV | T_DIGITAL_TV;
|
||||
if (radio == NULL)
|
||||
t->mode_mask |= T_RADIO;
|
||||
tuner_dbg("Setting mode_mask to 0x%02x\n", t->mode_mask);
|
||||
t->tv_freq = 400 * 16; /* Sets freq to VHF High */
|
||||
t->radio_freq = 87.5 * 16000; /* Sets freq to FM range */
|
||||
}
|
||||
|
||||
/* Should be just before return */
|
||||
register_client:
|
||||
tuner_info("chip found @ 0x%x (%s)\n", addr << 1, adap->name);
|
||||
|
||||
/* Sets a default mode */
|
||||
if (t->mode_mask & T_ANALOG_TV) {
|
||||
t->mode = T_ANALOG_TV;
|
||||
} else if (t->mode_mask & T_RADIO) {
|
||||
t->mode = T_RADIO;
|
||||
} else {
|
||||
t->mode = T_DIGITAL_TV;
|
||||
}
|
||||
|
||||
i2c_attach_client (client);
|
||||
set_type (client,t->type, t->mode_mask, t->config, t->tuner_callback);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int tuner_probe(struct i2c_adapter *adap)
|
||||
{
|
||||
if (0 != addr) {
|
||||
normal_i2c[0] = addr;
|
||||
normal_i2c[1] = I2C_CLIENT_END;
|
||||
}
|
||||
|
||||
/* HACK: Ignore 0x6b and 0x6f on cx88 boards.
|
||||
* FusionHDTV5 RT Gold has an ir receiver at 0x6b
|
||||
* and an RTC at 0x6f which can get corrupted if probed.
|
||||
*/
|
||||
if ((adap->id == I2C_HW_B_CX2388x) ||
|
||||
(adap->id == I2C_HW_B_CX23885)) {
|
||||
unsigned int i = 0;
|
||||
|
||||
while (i < I2C_CLIENT_MAX_OPTS && ignore[i] != I2C_CLIENT_END)
|
||||
i += 2;
|
||||
if (i + 4 < I2C_CLIENT_MAX_OPTS) {
|
||||
ignore[i+0] = adap->nr;
|
||||
ignore[i+1] = 0x6b;
|
||||
ignore[i+2] = adap->nr;
|
||||
ignore[i+3] = 0x6f;
|
||||
ignore[i+4] = I2C_CLIENT_END;
|
||||
} else
|
||||
printk(KERN_WARNING "tuner: "
|
||||
"too many options specified "
|
||||
"in i2c probe ignore list!\n");
|
||||
}
|
||||
|
||||
if (adap->class & I2C_CLASS_TV_ANALOG)
|
||||
return i2c_probe(adap, &addr_data, tuner_attach);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int tuner_detach(struct i2c_client *client)
|
||||
{
|
||||
struct tuner *t = i2c_get_clientdata(client);
|
||||
struct analog_tuner_ops *ops = t->fe.ops.analog_demod_ops;
|
||||
int err;
|
||||
|
||||
err = i2c_detach_client(t->i2c);
|
||||
if (err) {
|
||||
tuner_warn
|
||||
("Client deregistration failed, client not detached.\n");
|
||||
return err;
|
||||
}
|
||||
|
||||
if (ops && ops->release)
|
||||
ops->release(&t->fe);
|
||||
|
||||
list_del(&t->list);
|
||||
kfree(t);
|
||||
kfree(client);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Switch tuner to other mode. If tuner support both tv and radio,
|
||||
* set another frequency to some value (This is needed for some pal
|
||||
@ -1156,6 +941,229 @@ static int tuner_resume(struct i2c_client *c)
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* ---------------------------------------------------------------------- */
|
||||
|
||||
LIST_HEAD(tuner_list);
|
||||
|
||||
/* Search for existing radio and/or TV tuners on the given I2C adapter.
|
||||
Note that when this function is called from tuner_attach you can be
|
||||
certain no other devices will be added/deleted at the same time, I2C
|
||||
core protects against that. */
|
||||
static void tuner_lookup(struct i2c_adapter *adap,
|
||||
struct tuner **radio, struct tuner **tv)
|
||||
{
|
||||
struct tuner *pos;
|
||||
|
||||
*radio = NULL;
|
||||
*tv = NULL;
|
||||
|
||||
list_for_each_entry(pos, &tuner_list, list) {
|
||||
int mode_mask;
|
||||
|
||||
if (pos->i2c->adapter != adap ||
|
||||
pos->i2c->driver->id != I2C_DRIVERID_TUNER)
|
||||
continue;
|
||||
|
||||
mode_mask = pos->mode_mask & ~T_STANDBY;
|
||||
if (*radio == NULL && mode_mask == T_RADIO)
|
||||
*radio = pos;
|
||||
/* Note: currently TDA9887 is the only demod-only
|
||||
device. If other devices appear then we need to
|
||||
make this test more general. */
|
||||
else if (*tv == NULL && pos->type != TUNER_TDA9887 &&
|
||||
(pos->mode_mask & (T_ANALOG_TV | T_DIGITAL_TV)))
|
||||
*tv = pos;
|
||||
}
|
||||
}
|
||||
|
||||
/* During client attach, set_type is called by adapter's attach_inform callback.
|
||||
set_type must then be completed by tuner_attach.
|
||||
*/
|
||||
static int tuner_attach(struct i2c_adapter *adap, int addr, int kind)
|
||||
{
|
||||
struct i2c_client *client;
|
||||
struct tuner *t;
|
||||
struct tuner *radio;
|
||||
struct tuner *tv;
|
||||
|
||||
client = kmalloc(sizeof(struct i2c_client), GFP_KERNEL);
|
||||
if (NULL == client)
|
||||
return -ENOMEM;
|
||||
|
||||
t = kzalloc(sizeof(struct tuner), GFP_KERNEL);
|
||||
if (NULL == t) {
|
||||
kfree(client);
|
||||
return -ENOMEM;
|
||||
}
|
||||
t->i2c = client;
|
||||
client_template.adapter = adap;
|
||||
client_template.addr = addr;
|
||||
memcpy(client, &client_template, sizeof(struct i2c_client));
|
||||
i2c_set_clientdata(client, t);
|
||||
t->type = UNSET;
|
||||
t->audmode = V4L2_TUNER_MODE_STEREO;
|
||||
t->mode_mask = T_UNINITIALIZED;
|
||||
|
||||
if (show_i2c) {
|
||||
unsigned char buffer[16];
|
||||
int i, rc;
|
||||
|
||||
memset(buffer, 0, sizeof(buffer));
|
||||
rc = i2c_master_recv(client, buffer, sizeof(buffer));
|
||||
tuner_info("I2C RECV = ");
|
||||
for (i = 0; i < rc; i++)
|
||||
printk(KERN_CONT "%02x ", buffer[i]);
|
||||
printk("\n");
|
||||
}
|
||||
/* HACK: This test were added to avoid tuner to probe tda9840 and
|
||||
tea6415c on the MXB card */
|
||||
if (adap->id == I2C_HW_SAA7146 && addr < 0x4a)
|
||||
return -ENODEV;
|
||||
|
||||
/* autodetection code based on the i2c addr */
|
||||
if (!no_autodetect) {
|
||||
switch (addr) {
|
||||
case 0x10:
|
||||
if (tea5761_autodetection(t->i2c->adapter, t->i2c->addr)
|
||||
!= EINVAL) {
|
||||
t->type = TUNER_TEA5761;
|
||||
t->mode_mask = T_RADIO;
|
||||
t->mode = T_STANDBY;
|
||||
/* Sets freq to FM range */
|
||||
t->radio_freq = 87.5 * 16000;
|
||||
tuner_lookup(t->i2c->adapter, &radio, &tv);
|
||||
if (tv)
|
||||
tv->mode_mask &= ~T_RADIO;
|
||||
|
||||
goto register_client;
|
||||
}
|
||||
break;
|
||||
case 0x42:
|
||||
case 0x43:
|
||||
case 0x4a:
|
||||
case 0x4b:
|
||||
/* If chip is not tda8290, don't register.
|
||||
since it can be tda9887*/
|
||||
if (tda829x_probe(t) == 0) {
|
||||
tuner_dbg("tda829x detected\n");
|
||||
} else {
|
||||
/* Default is being tda9887 */
|
||||
t->type = TUNER_TDA9887;
|
||||
t->mode_mask = T_RADIO | T_ANALOG_TV |
|
||||
T_DIGITAL_TV;
|
||||
t->mode = T_STANDBY;
|
||||
goto register_client;
|
||||
}
|
||||
break;
|
||||
case 0x60:
|
||||
if (tea5767_autodetection(t->i2c->adapter, t->i2c->addr)
|
||||
!= EINVAL) {
|
||||
t->type = TUNER_TEA5767;
|
||||
t->mode_mask = T_RADIO;
|
||||
t->mode = T_STANDBY;
|
||||
/* Sets freq to FM range */
|
||||
t->radio_freq = 87.5 * 16000;
|
||||
tuner_lookup(t->i2c->adapter, &radio, &tv);
|
||||
if (tv)
|
||||
tv->mode_mask &= ~T_RADIO;
|
||||
|
||||
goto register_client;
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/* Initializes only the first TV tuner on this adapter. Why only the
|
||||
first? Because there are some devices (notably the ones with TI
|
||||
tuners) that have more than one i2c address for the *same* device.
|
||||
Experience shows that, except for just one case, the first
|
||||
address is the right one. The exception is a Russian tuner
|
||||
(ACORP_Y878F). So, the desired behavior is just to enable the
|
||||
first found TV tuner. */
|
||||
tuner_lookup(t->i2c->adapter, &radio, &tv);
|
||||
if (tv == NULL) {
|
||||
t->mode_mask = T_ANALOG_TV | T_DIGITAL_TV;
|
||||
if (radio == NULL)
|
||||
t->mode_mask |= T_RADIO;
|
||||
tuner_dbg("Setting mode_mask to 0x%02x\n", t->mode_mask);
|
||||
t->tv_freq = 400 * 16; /* Sets freq to VHF High */
|
||||
t->radio_freq = 87.5 * 16000; /* Sets freq to FM range */
|
||||
}
|
||||
|
||||
/* Should be just before return */
|
||||
register_client:
|
||||
tuner_info("chip found @ 0x%x (%s)\n", addr << 1, adap->name);
|
||||
|
||||
/* Sets a default mode */
|
||||
if (t->mode_mask & T_ANALOG_TV) {
|
||||
t->mode = T_ANALOG_TV;
|
||||
} else if (t->mode_mask & T_RADIO) {
|
||||
t->mode = T_RADIO;
|
||||
} else {
|
||||
t->mode = T_DIGITAL_TV;
|
||||
}
|
||||
|
||||
i2c_attach_client(client);
|
||||
set_type(client, t->type, t->mode_mask, t->config, t->tuner_callback);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int tuner_probe(struct i2c_adapter *adap)
|
||||
{
|
||||
if (0 != addr) {
|
||||
normal_i2c[0] = addr;
|
||||
normal_i2c[1] = I2C_CLIENT_END;
|
||||
}
|
||||
|
||||
/* HACK: Ignore 0x6b and 0x6f on cx88 boards.
|
||||
* FusionHDTV5 RT Gold has an ir receiver at 0x6b
|
||||
* and an RTC at 0x6f which can get corrupted if probed.
|
||||
*/
|
||||
if ((adap->id == I2C_HW_B_CX2388x) ||
|
||||
(adap->id == I2C_HW_B_CX23885)) {
|
||||
unsigned int i = 0;
|
||||
|
||||
while (i < I2C_CLIENT_MAX_OPTS && ignore[i] != I2C_CLIENT_END)
|
||||
i += 2;
|
||||
if (i + 4 < I2C_CLIENT_MAX_OPTS) {
|
||||
ignore[i+0] = adap->nr;
|
||||
ignore[i+1] = 0x6b;
|
||||
ignore[i+2] = adap->nr;
|
||||
ignore[i+3] = 0x6f;
|
||||
ignore[i+4] = I2C_CLIENT_END;
|
||||
} else
|
||||
printk(KERN_WARNING "tuner: "
|
||||
"too many options specified "
|
||||
"in i2c probe ignore list!\n");
|
||||
}
|
||||
|
||||
if (adap->class & I2C_CLASS_TV_ANALOG)
|
||||
return i2c_probe(adap, &addr_data, tuner_attach);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int tuner_detach(struct i2c_client *client)
|
||||
{
|
||||
struct tuner *t = i2c_get_clientdata(client);
|
||||
struct analog_tuner_ops *ops = t->fe.ops.analog_demod_ops;
|
||||
int err;
|
||||
|
||||
err = i2c_detach_client(t->i2c);
|
||||
if (err) {
|
||||
tuner_warn
|
||||
("Client deregistration failed, client not detached.\n");
|
||||
return err;
|
||||
}
|
||||
|
||||
if (ops && ops->release)
|
||||
ops->release(&t->fe);
|
||||
|
||||
list_del(&t->list);
|
||||
kfree(t);
|
||||
kfree(client);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* ----------------------------------------------------------------------- */
|
||||
|
||||
static struct i2c_driver driver = {
|
||||
|
||||
Loading…
Reference in New Issue
Block a user