kernel-fxtec-pro1x/drivers/media/video/tuner-3036.c
Arthur Othieno d4437d3fad V4L/DVB (3344b): don't ignore return from i2c_add_driver() for tuner-3036
The call to i2c_add_driver() may actually fail, but tuner-3036 ignores
this and always returns 0, regardless.

Fix it up so it returns what i2c_add_driver() does, instead.

Signed-off-by: Arthur Othieno <a.othieno@bluewin.ch>
Signed-off-by: Andrew Morton <akpm@osdl.org>
Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>
2006-01-11 19:41:04 -02:00

213 lines
4.8 KiB
C

/*
* Driver for Philips SAB3036 "CITAC" tuner control chip.
*
* Author: Phil Blundell <philb@gnu.org>
*
* The SAB3036 is just about different enough from the chips that
* tuner.c copes with to make it not worth the effort to crowbar
* the support into that file. So instead we have a separate driver.
*
* 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.
*/
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/sched.h>
#include <linux/string.h>
#include <linux/timer.h>
#include <linux/delay.h>
#include <linux/errno.h>
#include <linux/slab.h>
#include <linux/init.h>
#include <linux/i2c.h>
#include <linux/videodev.h>
#include <media/tuner.h>
static int debug; /* insmod parameter */
static int this_adap;
static struct i2c_client client_template;
/* Addresses to scan */
static unsigned short normal_i2c[] = { 0x60, 0x61, I2C_CLIENT_END };
static unsigned short ignore = I2C_CLIENT_END;
static struct i2c_client_address_data addr_data = {
.normal_i2c = normal_i2c,
.probe = &ignore,
.ignore = &ignore,
};
/* ---------------------------------------------------------------------- */
static unsigned char
tuner_getstatus (struct i2c_client *c)
{
unsigned char byte;
if (i2c_master_recv(c, &byte, 1) != 1)
printk(KERN_ERR "tuner-3036: I/O error.\n");
return byte;
}
#define TUNER_FL 0x80
static int
tuner_islocked (struct i2c_client *c)
{
return (tuner_getstatus(c) & TUNER_FL);
}
/* ---------------------------------------------------------------------- */
static void
set_tv_freq(struct i2c_client *c, int freq)
{
u16 div = ((freq * 20) / 16);
unsigned long give_up = jiffies + HZ;
unsigned char buffer[2];
if (debug)
printk(KERN_DEBUG "tuner: setting frequency %dMHz, divisor %x\n", freq / 16, div);
/* Select high tuning current */
buffer[0] = 0x29;
buffer[1] = 0x3e;
if (i2c_master_send(c, buffer, 2) != 2)
printk("tuner: i2c i/o error 1\n");
buffer[0] = 0x80 | ((div>>8) & 0x7f);
buffer[1] = div & 0xff;
if (i2c_master_send(c, buffer, 2) != 2)
printk("tuner: i2c i/o error 2\n");
while (!tuner_islocked(c) && time_before(jiffies, give_up))
schedule();
if (!tuner_islocked(c))
printk(KERN_WARNING "tuner: failed to achieve PLL lock\n");
/* Select low tuning current and engage AFC */
buffer[0] = 0x29;
buffer[1] = 0xb2;
if (i2c_master_send(c, buffer, 2) != 2)
printk("tuner: i2c i/o error 3\n");
if (debug)
printk(KERN_DEBUG "tuner: status %02x\n", tuner_getstatus(c));
}
/* ---------------------------------------------------------------------- */
static int
tuner_attach(struct i2c_adapter *adap, int addr, int kind)
{
static unsigned char buffer[] = { 0x29, 0x32, 0x2a, 0, 0x2b, 0 };
struct i2c_client *client;
if (this_adap > 0)
return -1;
this_adap++;
client_template.adapter = adap;
client_template.addr = addr;
client = kmalloc(sizeof(struct i2c_client), GFP_KERNEL);
if (client == NULL)
return -ENOMEM;
memcpy(client, &client_template, sizeof(struct i2c_client));
printk("tuner: SAB3036 found, status %02x\n", tuner_getstatus(client));
i2c_attach_client(client);
if (i2c_master_send(client, buffer, 2) != 2)
printk("tuner: i2c i/o error 1\n");
if (i2c_master_send(client, buffer+2, 2) != 2)
printk("tuner: i2c i/o error 2\n");
if (i2c_master_send(client, buffer+4, 2) != 2)
printk("tuner: i2c i/o error 3\n");
return 0;
}
static int
tuner_detach(struct i2c_client *c)
{
return 0;
}
static int
tuner_command(struct i2c_client *client, unsigned int cmd, void *arg)
{
int *iarg = (int*)arg;
switch (cmd)
{
case VIDIOCSFREQ:
set_tv_freq(client, *iarg);
break;
default:
return -EINVAL;
}
return 0;
}
static int
tuner_probe(struct i2c_adapter *adap)
{
this_adap = 0;
if (adap->id == I2C_HW_B_LP)
return i2c_probe(adap, &addr_data, tuner_attach);
return 0;
}
/* ----------------------------------------------------------------------- */
static struct i2c_driver
i2c_driver_tuner =
{
.driver = {
.name = "sab3036",
},
.id = I2C_DRIVERID_SAB3036,
.attach_adapter = tuner_probe,
.detach_client = tuner_detach,
.command = tuner_command
};
static struct i2c_client client_template =
{
.driver = &i2c_driver_tuner,
.name = "SAB3036",
};
static int __init
tuner3036_init(void)
{
return i2c_add_driver(&i2c_driver_tuner);
}
static void __exit
tuner3036_exit(void)
{
i2c_del_driver(&i2c_driver_tuner);
}
MODULE_DESCRIPTION("SAB3036 tuner driver");
MODULE_AUTHOR("Philip Blundell <philb@gnu.org>");
MODULE_LICENSE("GPL");
module_param(debug, int, 0);
MODULE_PARM_DESC(debug,"Enable debugging output");
module_init(tuner3036_init);
module_exit(tuner3036_exit);