drivers/media/video/tuner-core.c - linux - Git at Google

 /*
  * $Id: tuner-core.c,v 1.63 2005/07/28 18:19:55 mchehab Exp $
  *
  * 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[] = {
 	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;
 	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 (tun_setup->addr == ADDR_UNSET) {
 		if (t->mode_mask & tun_setup->mode_mask)
 			set_type(c, tun_setup->type, tun_setup->mode_mask);
 	} else if (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) {
 		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;
 	}
 	return EINVAL;
 }

 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;
 		}
 	}
 	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':
 			tuner_dbg ("insmod fixup: SECAM => SECAM-L\n");
 			t->std = V4L2_STD_SECAM_L;
 			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;


 	tuner_info("chip found @ 0x%x (%s)\n", addr << 1, adap->name);

 	if (show_i2c) {
 		unsigned char buffer[16];
 		int i,rc;

 		memset(buffer, 0, sizeof(buffer));
 		rc = i2c_master_recv(&t->i2c, buffer, sizeof(buffer));
 		printk("tuner-%04x I2C RECV = ",addr);
 		for (i=0;i<rc;i++)
 			printk("%02x ",buffer[i]);
 		printk("\n");
 	}
 	/* TEA5767 autodetection code - only for addr = 0xc0 */
 	if (!no_autodetect) {
 		if (addr == 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;

 				i2c_attach_client (&t->i2c);
 				set_type(&t->i2c,t->type, t->mode_mask);
 				return 0;
 			}
 		}
 	}

 	/* 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 */
 	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) {

 		t->mode = mode;
 		if (check_mode(t, cmd) == EINVAL) {
 			t->mode = T_STANDBY;
 			if (V4L2_TUNER_RADIO == mode) {
 				set_tv_freq(client, 400 * 16);
 			} else {
 				set_radio_freq(client, 87.5 * 16000);
 			}
 			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 AUDC_CONFIG_PINNACLE:
 		if (check_mode(t, "AUDC_CONFIG_PINNACLE") == EINVAL)
 			return 0;
 		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=0x%02x,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, u32 level)
 {
 	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, u32 level)
 {
 	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 = {
 	I2C_DEVNAME("(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:
  */
	/*
	* $Id: tuner-core.c,v 1.63 2005/07/28 18:19:55 mchehab Exp $
	*
	* 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[] = {
	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;
	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 (tun_setup->addr == ADDR_UNSET) {
	if (t->mode_mask & tun_setup->mode_mask)
	set_type(c, tun_setup->type, tun_setup->mode_mask);
	} else if (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) {
	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;
	}
	return EINVAL;
	}

	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;
	}
	}
	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':
	tuner_dbg ("insmod fixup: SECAM => SECAM-L\n");
	t->std = V4L2_STD_SECAM_L;
	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;


	tuner_info("chip found @ 0x%x (%s)\n", addr << 1, adap->name);

	if (show_i2c) {
	unsigned char buffer[16];
	int i,rc;

	memset(buffer, 0, sizeof(buffer));
	rc = i2c_master_recv(&t->i2c, buffer, sizeof(buffer));
	printk("tuner-%04x I2C RECV = ",addr);
	for (i=0;i<rc;i++)
	printk("%02x ",buffer[i]);
	printk("\n");
	}
	/* TEA5767 autodetection code - only for addr = 0xc0 */
	if (!no_autodetect) {
	if (addr == 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;

	i2c_attach_client (&t->i2c);
	set_type(&t->i2c,t->type, t->mode_mask);
	return 0;
	}
	}
	}

	/* 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 */
	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) {

	t->mode = mode;
	if (check_mode(t, cmd) == EINVAL) {
	t->mode = T_STANDBY;
	if (V4L2_TUNER_RADIO == mode) {
	set_tv_freq(client, 400 * 16);
	} else {
	set_radio_freq(client, 87.5 * 16000);
	}
	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 AUDC_CONFIG_PINNACLE:
	if (check_mode(t, "AUDC_CONFIG_PINNACLE") == EINVAL)
	return 0;
	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=0x%02x,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, u32 level)
	{
	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, u32 level)
	{
	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 = {
	I2C_DEVNAME("(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:
	*/