forked from Minki/linux
800d3c6f90
- Added SECAM L' video standard - SECAM L' is a Secam variant that requires special config. This patch adds support on V4L core. Requires aditional patches on tuners to support. Signed-off-by: Mauro Carvalho Chehab <mchehab@brturbo.com.br> Signed-off-by: Andrew Morton <akpm@osdl.org> Signed-off-by: Linus Torvalds <torvalds@osdl.org>
783 lines
18 KiB
C
783 lines
18 KiB
C
/*
|
|
*
|
|
* i2c tv tuner chip device driver
|
|
* core core, i.e. kernel interfaces, registering and so on
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/moduleparam.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/poll.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/types.h>
|
|
#include <linux/videodev.h>
|
|
#include <linux/init.h>
|
|
|
|
#include <media/tuner.h>
|
|
#include <media/audiochip.h>
|
|
|
|
#include "msp3400.h"
|
|
|
|
#define UNSET (-1U)
|
|
|
|
/* standard i2c insmod options */
|
|
static unsigned short normal_i2c[] = {
|
|
0x42, 0x43, 0x4a, 0x4b, /* tda8290 */
|
|
0x60, 0x61, 0x62, 0x63, 0x64, 0x65, 0x66, 0x67,
|
|
0x68, 0x69, 0x6a, 0x6b, 0x6c, 0x6d, 0x6e, 0x6f,
|
|
I2C_CLIENT_END
|
|
};
|
|
|
|
I2C_CLIENT_INSMOD;
|
|
|
|
/* insmod options used at init time => read/only */
|
|
static unsigned int addr = 0;
|
|
module_param(addr, int, 0444);
|
|
|
|
static unsigned int no_autodetect = 0;
|
|
module_param(no_autodetect, int, 0444);
|
|
|
|
static unsigned int show_i2c = 0;
|
|
module_param(show_i2c, int, 0444);
|
|
|
|
/* insmod options used at runtime => read/write */
|
|
unsigned int tuner_debug = 0;
|
|
module_param(tuner_debug, int, 0644);
|
|
|
|
static unsigned int tv_range[2] = { 44, 958 };
|
|
static unsigned int radio_range[2] = { 65, 108 };
|
|
|
|
module_param_array(tv_range, int, NULL, 0644);
|
|
module_param_array(radio_range, int, NULL, 0644);
|
|
|
|
MODULE_DESCRIPTION("device driver for various TV and TV+FM radio tuners");
|
|
MODULE_AUTHOR("Ralph Metzler, Gerd Knorr, Gunther Mayer");
|
|
MODULE_LICENSE("GPL");
|
|
|
|
static struct i2c_driver driver;
|
|
static struct i2c_client client_template;
|
|
|
|
/* ---------------------------------------------------------------------- */
|
|
|
|
/* Set tuner frequency, freq in Units of 62.5kHz = 1/16MHz */
|
|
static void set_tv_freq(struct i2c_client *c, unsigned int freq)
|
|
{
|
|
struct tuner *t = i2c_get_clientdata(c);
|
|
|
|
if (t->type == UNSET) {
|
|
tuner_warn ("tuner type not set\n");
|
|
return;
|
|
}
|
|
if (NULL == t->tv_freq) {
|
|
tuner_warn ("Tuner has no way to set tv freq\n");
|
|
return;
|
|
}
|
|
if (freq < tv_range[0] * 16 || freq > tv_range[1] * 16) {
|
|
tuner_dbg ("TV freq (%d.%02d) out of range (%d-%d)\n",
|
|
freq / 16, freq % 16 * 100 / 16, tv_range[0],
|
|
tv_range[1]);
|
|
}
|
|
t->tv_freq(c, freq);
|
|
}
|
|
|
|
static void set_radio_freq(struct i2c_client *c, unsigned int freq)
|
|
{
|
|
struct tuner *t = i2c_get_clientdata(c);
|
|
|
|
if (t->type == UNSET) {
|
|
tuner_warn ("tuner type not set\n");
|
|
return;
|
|
}
|
|
if (NULL == t->radio_freq) {
|
|
tuner_warn ("tuner has no way to set radio frequency\n");
|
|
return;
|
|
}
|
|
if (freq <= radio_range[0] * 16000 || freq >= radio_range[1] * 16000) {
|
|
tuner_dbg ("radio freq (%d.%02d) out of range (%d-%d)\n",
|
|
freq / 16000, freq % 16000 * 100 / 16000,
|
|
radio_range[0], radio_range[1]);
|
|
}
|
|
|
|
t->radio_freq(c, freq);
|
|
return;
|
|
}
|
|
|
|
static void set_freq(struct i2c_client *c, unsigned long freq)
|
|
{
|
|
struct tuner *t = i2c_get_clientdata(c);
|
|
|
|
switch (t->mode) {
|
|
case V4L2_TUNER_RADIO:
|
|
tuner_dbg("radio freq set to %lu.%02lu\n",
|
|
freq / 16000, freq % 16000 * 100 / 16000);
|
|
set_radio_freq(c, freq);
|
|
break;
|
|
case V4L2_TUNER_ANALOG_TV:
|
|
case V4L2_TUNER_DIGITAL_TV:
|
|
tuner_dbg("tv freq set to %lu.%02lu\n",
|
|
freq / 16, freq % 16 * 100 / 16);
|
|
set_tv_freq(c, freq);
|
|
break;
|
|
}
|
|
t->freq = freq;
|
|
}
|
|
|
|
static void set_type(struct i2c_client *c, unsigned int type,
|
|
unsigned int new_mode_mask)
|
|
{
|
|
struct tuner *t = i2c_get_clientdata(c);
|
|
unsigned char buffer[4];
|
|
|
|
if (type == UNSET || type == TUNER_ABSENT) {
|
|
tuner_dbg ("tuner 0x%02x: Tuner type absent\n",c->addr);
|
|
return;
|
|
}
|
|
|
|
if (type >= tuner_count) {
|
|
tuner_warn ("tuner 0x%02x: Tuner count greater than %d\n",c->addr,tuner_count);
|
|
return;
|
|
}
|
|
|
|
/* This code detects calls by card attach_inform */
|
|
if (NULL == t->i2c.dev.driver) {
|
|
tuner_dbg ("tuner 0x%02x: called during i2c_client register by adapter's attach_inform\n", c->addr);
|
|
|
|
t->type=type;
|
|
return;
|
|
}
|
|
|
|
t->type = type;
|
|
|
|
switch (t->type) {
|
|
case TUNER_MT2032:
|
|
microtune_init(c);
|
|
break;
|
|
case TUNER_PHILIPS_TDA8290:
|
|
tda8290_init(c);
|
|
break;
|
|
case TUNER_TEA5767:
|
|
if (tea5767_tuner_init(c) == EINVAL) {
|
|
t->type = TUNER_ABSENT;
|
|
t->mode_mask = T_UNINITIALIZED;
|
|
return;
|
|
}
|
|
t->mode_mask = T_RADIO;
|
|
break;
|
|
case TUNER_PHILIPS_FMD1216ME_MK3:
|
|
buffer[0] = 0x0b;
|
|
buffer[1] = 0xdc;
|
|
buffer[2] = 0x9c;
|
|
buffer[3] = 0x60;
|
|
i2c_master_send(c, buffer, 4);
|
|
mdelay(1);
|
|
buffer[2] = 0x86;
|
|
buffer[3] = 0x54;
|
|
i2c_master_send(c, buffer, 4);
|
|
default_tuner_init(c);
|
|
break;
|
|
case TUNER_LG_TDVS_H062F:
|
|
/* Set the Auxiliary Byte. */
|
|
buffer[2] &= ~0x20;
|
|
buffer[2] |= 0x18;
|
|
buffer[3] = 0x20;
|
|
i2c_master_send(c, buffer, 4);
|
|
default_tuner_init(c);
|
|
break;
|
|
case TUNER_PHILIPS_TD1316:
|
|
buffer[0] = 0x0b;
|
|
buffer[1] = 0xdc;
|
|
buffer[2] = 0x86;
|
|
buffer[3] = 0xa4;
|
|
i2c_master_send(c,buffer,4);
|
|
default_tuner_init(c);
|
|
default:
|
|
default_tuner_init(c);
|
|
break;
|
|
}
|
|
|
|
if (t->mode_mask == T_UNINITIALIZED)
|
|
t->mode_mask = new_mode_mask;
|
|
|
|
set_freq(c, t->freq);
|
|
tuner_dbg("%s %s I2C addr 0x%02x with type %d used for 0x%02x\n",
|
|
c->adapter->name, c->driver->name, c->addr << 1, type,
|
|
t->mode_mask);
|
|
}
|
|
|
|
/*
|
|
* This function apply tuner config to tuner specified
|
|
* by tun_setup structure. I addr is unset, then admin status
|
|
* and tun addr status is more precise then current status,
|
|
* it's applied. Otherwise status and type are applied only to
|
|
* tuner with exactly the same addr.
|
|
*/
|
|
|
|
static void set_addr(struct i2c_client *c, struct tuner_setup *tun_setup)
|
|
{
|
|
struct tuner *t = i2c_get_clientdata(c);
|
|
|
|
if ( t->type == UNSET && ((tun_setup->addr == ADDR_UNSET &&
|
|
(t->mode_mask & tun_setup->mode_mask)) ||
|
|
tun_setup->addr == c->addr)) {
|
|
set_type(c, tun_setup->type, tun_setup->mode_mask);
|
|
}
|
|
}
|
|
|
|
static inline int check_mode(struct tuner *t, char *cmd)
|
|
{
|
|
if ((1 << t->mode & t->mode_mask) == 0) {
|
|
return EINVAL;
|
|
}
|
|
|
|
switch (t->mode) {
|
|
case V4L2_TUNER_RADIO:
|
|
tuner_dbg("Cmd %s accepted for radio\n", cmd);
|
|
break;
|
|
case V4L2_TUNER_ANALOG_TV:
|
|
tuner_dbg("Cmd %s accepted for analog TV\n", cmd);
|
|
break;
|
|
case V4L2_TUNER_DIGITAL_TV:
|
|
tuner_dbg("Cmd %s accepted for digital TV\n", cmd);
|
|
break;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static char pal[] = "-";
|
|
module_param_string(pal, pal, sizeof(pal), 0644);
|
|
static char secam[] = "--";
|
|
module_param_string(secam, secam, sizeof(secam), 0644);
|
|
|
|
/* get more precise norm info from insmod option */
|
|
static int tuner_fixup_std(struct tuner *t)
|
|
{
|
|
if ((t->std & V4L2_STD_PAL) == V4L2_STD_PAL) {
|
|
switch (pal[0]) {
|
|
case 'b':
|
|
case 'B':
|
|
case 'g':
|
|
case 'G':
|
|
tuner_dbg ("insmod fixup: PAL => PAL-BG\n");
|
|
t->std = V4L2_STD_PAL_BG;
|
|
break;
|
|
case 'i':
|
|
case 'I':
|
|
tuner_dbg ("insmod fixup: PAL => PAL-I\n");
|
|
t->std = V4L2_STD_PAL_I;
|
|
break;
|
|
case 'd':
|
|
case 'D':
|
|
case 'k':
|
|
case 'K':
|
|
tuner_dbg ("insmod fixup: PAL => PAL-DK\n");
|
|
t->std = V4L2_STD_PAL_DK;
|
|
break;
|
|
case 'M':
|
|
case 'm':
|
|
tuner_dbg ("insmod fixup: PAL => PAL-M\n");
|
|
t->std = V4L2_STD_PAL_M;
|
|
break;
|
|
case 'N':
|
|
case 'n':
|
|
tuner_dbg ("insmod fixup: PAL => PAL-N\n");
|
|
t->std = V4L2_STD_PAL_N;
|
|
break;
|
|
case '-':
|
|
/* default parameter, do nothing */
|
|
break;
|
|
default:
|
|
tuner_warn ("pal= argument not recognised\n");
|
|
break;
|
|
}
|
|
}
|
|
if ((t->std & V4L2_STD_SECAM) == V4L2_STD_SECAM) {
|
|
switch (secam[0]) {
|
|
case 'd':
|
|
case 'D':
|
|
case 'k':
|
|
case 'K':
|
|
tuner_dbg ("insmod fixup: SECAM => SECAM-DK\n");
|
|
t->std = V4L2_STD_SECAM_DK;
|
|
break;
|
|
case 'l':
|
|
case 'L':
|
|
if ((secam[1]=='C')||(secam[1]=='c')) {
|
|
tuner_dbg ("insmod fixup: SECAM => SECAM-L'\n");
|
|
t->std = V4L2_STD_SECAM_LC;
|
|
} else {
|
|
tuner_dbg ("insmod fixup: SECAM => SECAM-L\n");
|
|
t->std = V4L2_STD_SECAM_L;
|
|
}
|
|
break;
|
|
case '-':
|
|
/* default parameter, do nothing */
|
|
break;
|
|
default:
|
|
tuner_warn ("secam= argument not recognised\n");
|
|
break;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* ---------------------------------------------------------------------- */
|
|
|
|
/* static var Used only in tuner_attach and tuner_probe */
|
|
static unsigned default_mode_mask;
|
|
|
|
/* 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 tuner *t;
|
|
|
|
client_template.adapter = adap;
|
|
client_template.addr = addr;
|
|
|
|
t = kmalloc(sizeof(struct tuner), GFP_KERNEL);
|
|
if (NULL == t)
|
|
return -ENOMEM;
|
|
memset(t, 0, sizeof(struct tuner));
|
|
memcpy(&t->i2c, &client_template, sizeof(struct i2c_client));
|
|
i2c_set_clientdata(&t->i2c, t);
|
|
t->type = UNSET;
|
|
t->radio_if2 = 10700 * 1000; /* 10.7MHz - FM radio */
|
|
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(&t->i2c, buffer, sizeof(buffer));
|
|
tuner_info("I2C RECV = ");
|
|
for (i=0;i<rc;i++)
|
|
printk("%02x ",buffer[i]);
|
|
printk("\n");
|
|
}
|
|
/* TEA5767 autodetection code - only for addr = 0xc0 */
|
|
if (!no_autodetect) {
|
|
switch (addr) {
|
|
case 0x42:
|
|
case 0x43:
|
|
case 0x4a:
|
|
case 0x4b:
|
|
/* If chip is not tda8290, don't register.
|
|
since it can be tda9887*/
|
|
if (tda8290_probe(&t->i2c) != 0) {
|
|
tuner_dbg("chip at addr %x is not a tda8290\n", addr);
|
|
kfree(t);
|
|
return 0;
|
|
}
|
|
break;
|
|
case 0x60:
|
|
if (tea5767_autodetection(&t->i2c) != EINVAL) {
|
|
t->type = TUNER_TEA5767;
|
|
t->mode_mask = T_RADIO;
|
|
t->mode = T_STANDBY;
|
|
t->freq = 87.5 * 16; /* Sets freq to FM range */
|
|
default_mode_mask &= ~T_RADIO;
|
|
|
|
goto register_client;
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
|
|
/* Initializes only the first adapter found */
|
|
if (default_mode_mask != T_UNINITIALIZED) {
|
|
tuner_dbg ("Setting mode_mask to 0x%02x\n", default_mode_mask);
|
|
t->mode_mask = default_mode_mask;
|
|
t->freq = 400 * 16; /* Sets freq to VHF High */
|
|
default_mode_mask = T_UNINITIALIZED;
|
|
}
|
|
|
|
/* Should be just before return */
|
|
register_client:
|
|
tuner_info("chip found @ 0x%x (%s)\n", addr << 1, adap->name);
|
|
i2c_attach_client (&t->i2c);
|
|
set_type (&t->i2c,t->type, t->mode_mask);
|
|
return 0;
|
|
}
|
|
|
|
static int tuner_probe(struct i2c_adapter *adap)
|
|
{
|
|
if (0 != addr) {
|
|
normal_i2c[0] = addr;
|
|
normal_i2c[1] = I2C_CLIENT_END;
|
|
}
|
|
|
|
default_mode_mask = T_RADIO | T_ANALOG_TV | T_DIGITAL_TV;
|
|
|
|
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);
|
|
int err;
|
|
|
|
err = i2c_detach_client(&t->i2c);
|
|
if (err) {
|
|
tuner_warn
|
|
("Client deregistration failed, client not detached.\n");
|
|
return err;
|
|
}
|
|
|
|
kfree(t);
|
|
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
|
|
* tuners to avoid locking). Otherwise, just put second tuner in
|
|
* standby mode.
|
|
*/
|
|
|
|
static inline int set_mode(struct i2c_client *client, struct tuner *t, int mode, char *cmd)
|
|
{
|
|
if (mode == t->mode)
|
|
return 0;
|
|
|
|
t->mode = mode;
|
|
|
|
if (check_mode(t, cmd) == EINVAL) {
|
|
t->mode = T_STANDBY;
|
|
if (t->standby)
|
|
t->standby (client);
|
|
return EINVAL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
#define switch_v4l2() if (!t->using_v4l2) \
|
|
tuner_dbg("switching to v4l2\n"); \
|
|
t->using_v4l2 = 1;
|
|
|
|
static inline int check_v4l2(struct tuner *t)
|
|
{
|
|
if (t->using_v4l2) {
|
|
tuner_dbg ("ignore v4l1 call\n");
|
|
return EINVAL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int tuner_command(struct i2c_client *client, unsigned int cmd, void *arg)
|
|
{
|
|
struct tuner *t = i2c_get_clientdata(client);
|
|
unsigned int *iarg = (int *)arg;
|
|
|
|
switch (cmd) {
|
|
/* --- configuration --- */
|
|
case TUNER_SET_TYPE_ADDR:
|
|
tuner_dbg ("Calling set_type_addr for type=%d, addr=0x%02x, mode=0x%02x\n",
|
|
((struct tuner_setup *)arg)->type,
|
|
((struct tuner_setup *)arg)->addr,
|
|
((struct tuner_setup *)arg)->mode_mask);
|
|
|
|
set_addr(client, (struct tuner_setup *)arg);
|
|
break;
|
|
case AUDC_SET_RADIO:
|
|
set_mode(client,t,V4L2_TUNER_RADIO, "AUDC_SET_RADIO");
|
|
break;
|
|
case TUNER_SET_STANDBY:
|
|
{
|
|
if (check_mode(t, "TUNER_SET_STANDBY") == EINVAL)
|
|
return 0;
|
|
if (t->standby)
|
|
t->standby (client);
|
|
break;
|
|
}
|
|
case AUDC_CONFIG_PINNACLE:
|
|
switch (*iarg) {
|
|
case 2:
|
|
tuner_dbg("pinnacle pal\n");
|
|
t->radio_if2 = 33300 * 1000;
|
|
break;
|
|
case 3:
|
|
tuner_dbg("pinnacle ntsc\n");
|
|
t->radio_if2 = 41300 * 1000;
|
|
break;
|
|
}
|
|
break;
|
|
case VIDIOCSAUDIO:
|
|
if (check_mode(t, "VIDIOCSAUDIO") == EINVAL)
|
|
return 0;
|
|
if (check_v4l2(t) == EINVAL)
|
|
return 0;
|
|
|
|
/* Should be implemented, since bttv calls it */
|
|
tuner_dbg("VIDIOCSAUDIO not implemented.\n");
|
|
|
|
break;
|
|
case MSP_SET_MATRIX:
|
|
case TDA9887_SET_CONFIG:
|
|
break;
|
|
/* --- v4l ioctls --- */
|
|
/* take care: bttv does userspace copying, we'll get a
|
|
kernel pointer here... */
|
|
case VIDIOCSCHAN:
|
|
{
|
|
static const v4l2_std_id map[] = {
|
|
[VIDEO_MODE_PAL] = V4L2_STD_PAL,
|
|
[VIDEO_MODE_NTSC] = V4L2_STD_NTSC_M,
|
|
[VIDEO_MODE_SECAM] = V4L2_STD_SECAM,
|
|
[4 /* bttv */ ] = V4L2_STD_PAL_M,
|
|
[5 /* bttv */ ] = V4L2_STD_PAL_N,
|
|
[6 /* bttv */ ] = V4L2_STD_NTSC_M_JP,
|
|
};
|
|
struct video_channel *vc = arg;
|
|
|
|
if (check_v4l2(t) == EINVAL)
|
|
return 0;
|
|
|
|
if (set_mode(client,t,V4L2_TUNER_ANALOG_TV, "VIDIOCSCHAN")==EINVAL)
|
|
return 0;
|
|
|
|
if (vc->norm < ARRAY_SIZE(map))
|
|
t->std = map[vc->norm];
|
|
tuner_fixup_std(t);
|
|
if (t->freq)
|
|
set_tv_freq(client, t->freq);
|
|
return 0;
|
|
}
|
|
case VIDIOCSFREQ:
|
|
{
|
|
unsigned long *v = arg;
|
|
|
|
if (check_mode(t, "VIDIOCSFREQ") == EINVAL)
|
|
return 0;
|
|
if (check_v4l2(t) == EINVAL)
|
|
return 0;
|
|
|
|
set_freq(client, *v);
|
|
return 0;
|
|
}
|
|
case VIDIOCGTUNER:
|
|
{
|
|
struct video_tuner *vt = arg;
|
|
|
|
if (check_mode(t, "VIDIOCGTUNER") == EINVAL)
|
|
return 0;
|
|
if (check_v4l2(t) == EINVAL)
|
|
return 0;
|
|
|
|
if (V4L2_TUNER_RADIO == t->mode) {
|
|
if (t->has_signal)
|
|
vt->signal = t->has_signal(client);
|
|
if (t->is_stereo) {
|
|
if (t->is_stereo(client))
|
|
vt->flags |=
|
|
VIDEO_TUNER_STEREO_ON;
|
|
else
|
|
vt->flags &=
|
|
~VIDEO_TUNER_STEREO_ON;
|
|
}
|
|
vt->flags |= VIDEO_TUNER_LOW; /* Allow freqs at 62.5 Hz */
|
|
|
|
vt->rangelow = radio_range[0] * 16000;
|
|
vt->rangehigh = radio_range[1] * 16000;
|
|
|
|
} else {
|
|
vt->rangelow = tv_range[0] * 16;
|
|
vt->rangehigh = tv_range[1] * 16;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
case VIDIOCGAUDIO:
|
|
{
|
|
struct video_audio *va = arg;
|
|
|
|
if (check_mode(t, "VIDIOCGAUDIO") == EINVAL)
|
|
return 0;
|
|
if (check_v4l2(t) == EINVAL)
|
|
return 0;
|
|
|
|
if (V4L2_TUNER_RADIO == t->mode && t->is_stereo)
|
|
va->mode = t->is_stereo(client)
|
|
? VIDEO_SOUND_STEREO : VIDEO_SOUND_MONO;
|
|
return 0;
|
|
}
|
|
|
|
case VIDIOC_S_STD:
|
|
{
|
|
v4l2_std_id *id = arg;
|
|
|
|
if (set_mode (client, t, V4L2_TUNER_ANALOG_TV, "VIDIOC_S_STD")
|
|
== EINVAL)
|
|
return 0;
|
|
|
|
switch_v4l2();
|
|
|
|
t->std = *id;
|
|
tuner_fixup_std(t);
|
|
if (t->freq)
|
|
set_freq(client, t->freq);
|
|
break;
|
|
}
|
|
case VIDIOC_S_FREQUENCY:
|
|
{
|
|
struct v4l2_frequency *f = arg;
|
|
|
|
t->freq = f->frequency;
|
|
switch_v4l2();
|
|
if (V4L2_TUNER_RADIO == f->type &&
|
|
V4L2_TUNER_RADIO != t->mode) {
|
|
if (set_mode (client, t, f->type, "VIDIOC_S_FREQUENCY")
|
|
== EINVAL)
|
|
return 0;
|
|
}
|
|
set_freq(client,t->freq);
|
|
|
|
break;
|
|
}
|
|
case VIDIOC_G_FREQUENCY:
|
|
{
|
|
struct v4l2_frequency *f = arg;
|
|
|
|
if (check_mode(t, "VIDIOC_G_FREQUENCY") == EINVAL)
|
|
return 0;
|
|
switch_v4l2();
|
|
f->type = t->mode;
|
|
f->frequency = t->freq;
|
|
break;
|
|
}
|
|
case VIDIOC_G_TUNER:
|
|
{
|
|
struct v4l2_tuner *tuner = arg;
|
|
|
|
if (check_mode(t, "VIDIOC_G_TUNER") == EINVAL)
|
|
return 0;
|
|
switch_v4l2();
|
|
|
|
if (V4L2_TUNER_RADIO == t->mode) {
|
|
|
|
if (t->has_signal)
|
|
tuner->signal = t->has_signal(client);
|
|
|
|
if (t->is_stereo) {
|
|
if (t->is_stereo(client)) {
|
|
tuner->rxsubchans =
|
|
V4L2_TUNER_SUB_STEREO |
|
|
V4L2_TUNER_SUB_MONO;
|
|
} else {
|
|
tuner->rxsubchans =
|
|
V4L2_TUNER_SUB_MONO;
|
|
}
|
|
}
|
|
|
|
tuner->capability |=
|
|
V4L2_TUNER_CAP_LOW | V4L2_TUNER_CAP_STEREO;
|
|
|
|
tuner->audmode = t->audmode;
|
|
|
|
tuner->rangelow = radio_range[0] * 16000;
|
|
tuner->rangehigh = radio_range[1] * 16000;
|
|
} else {
|
|
tuner->rangelow = tv_range[0] * 16;
|
|
tuner->rangehigh = tv_range[1] * 16;
|
|
}
|
|
break;
|
|
}
|
|
case VIDIOC_S_TUNER:
|
|
{
|
|
struct v4l2_tuner *tuner = arg;
|
|
|
|
if (check_mode(t, "VIDIOC_S_TUNER") == EINVAL)
|
|
return 0;
|
|
|
|
switch_v4l2();
|
|
|
|
if (V4L2_TUNER_RADIO == t->mode) {
|
|
t->audmode = tuner->audmode;
|
|
set_radio_freq(client, t->freq);
|
|
}
|
|
break;
|
|
}
|
|
default:
|
|
tuner_dbg("Unimplemented IOCTL 0x%08x(dir=%d,tp='%c',nr=%d,sz=%d)\n",
|
|
cmd, _IOC_DIR(cmd), _IOC_TYPE(cmd),
|
|
_IOC_NR(cmd), _IOC_SIZE(cmd));
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int tuner_suspend(struct device *dev, pm_message_t state)
|
|
{
|
|
struct i2c_client *c = container_of (dev, struct i2c_client, dev);
|
|
struct tuner *t = i2c_get_clientdata (c);
|
|
|
|
tuner_dbg ("suspend\n");
|
|
/* FIXME: power down ??? */
|
|
return 0;
|
|
}
|
|
|
|
static int tuner_resume(struct device *dev)
|
|
{
|
|
struct i2c_client *c = container_of (dev, struct i2c_client, dev);
|
|
struct tuner *t = i2c_get_clientdata (c);
|
|
|
|
tuner_dbg ("resume\n");
|
|
if (t->freq)
|
|
set_freq(c, t->freq);
|
|
return 0;
|
|
}
|
|
|
|
/* ----------------------------------------------------------------------- */
|
|
|
|
static struct i2c_driver driver = {
|
|
.owner = THIS_MODULE,
|
|
.name = "tuner",
|
|
.id = I2C_DRIVERID_TUNER,
|
|
.flags = I2C_DF_NOTIFY,
|
|
.attach_adapter = tuner_probe,
|
|
.detach_client = tuner_detach,
|
|
.command = tuner_command,
|
|
.driver = {
|
|
.suspend = tuner_suspend,
|
|
.resume = tuner_resume,
|
|
},
|
|
};
|
|
static struct i2c_client client_template = {
|
|
.name = "(tuner unset)",
|
|
.flags = I2C_CLIENT_ALLOW_USE,
|
|
.driver = &driver,
|
|
};
|
|
|
|
static int __init tuner_init_module(void)
|
|
{
|
|
return i2c_add_driver(&driver);
|
|
}
|
|
|
|
static void __exit tuner_cleanup_module(void)
|
|
{
|
|
i2c_del_driver(&driver);
|
|
}
|
|
|
|
module_init(tuner_init_module);
|
|
module_exit(tuner_cleanup_module);
|
|
|
|
/*
|
|
* Overrides for Emacs so that we follow Linus's tabbing style.
|
|
* ---------------------------------------------------------------------------
|
|
* Local variables:
|
|
* c-basic-offset: 8
|
|
* End:
|
|
*/
|