tuner-core.c 16.1 KB
Newer Older
L
Linus Torvalds 已提交
1
/*
M
Mauro Carvalho Chehab 已提交
2
 * $Id: tuner-core.c,v 1.55 2005/07/08 13:20:33 mchehab Exp $
L
Linus Torvalds 已提交
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29
 *
 * 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>

#define UNSET (-1U)

/* standard i2c insmod options */
static unsigned short normal_i2c[] = {
M
Mauro Carvalho Chehab 已提交
30
	0x4b,			/* tda8290 */
31 32
	0x60, 0x61, 0x62, 0x63, 0x64, 0x65, 0x66, 0x67,
	0x68, 0x69, 0x6a, 0x6b, 0x6c, 0x6d, 0x6e, 0x6f,
L
Linus Torvalds 已提交
33 34
	I2C_CLIENT_END
};
M
Mauro Carvalho Chehab 已提交
35

L
Linus Torvalds 已提交
36 37 38
I2C_CLIENT_INSMOD;

/* insmod options used at init time => read/only */
M
Mauro Carvalho Chehab 已提交
39
static unsigned int addr = 0;
L
Linus Torvalds 已提交
40 41 42
module_param(addr, int, 0444);

/* insmod options used at runtime => read/write */
M
Mauro Carvalho Chehab 已提交
43 44
unsigned int tuner_debug = 0;
module_param(tuner_debug, int, 0644);
L
Linus Torvalds 已提交
45

M
Mauro Carvalho Chehab 已提交
46
static unsigned int tv_range[2] = { 44, 958 };
L
Linus Torvalds 已提交
47 48
static unsigned int radio_range[2] = { 65, 108 };

M
Mauro Carvalho Chehab 已提交
49
module_param_array(tv_range, int, NULL, 0644);
L
Linus Torvalds 已提交
50 51 52 53 54 55 56 57 58 59 60
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;

/* ---------------------------------------------------------------------- */

61
/* Set tuner frequency,  freq in Units of 62.5kHz = 1/16MHz */
L
Linus Torvalds 已提交
62 63 64 65 66
static void set_tv_freq(struct i2c_client *c, unsigned int freq)
{
	struct tuner *t = i2c_get_clientdata(c);

	if (t->type == UNSET) {
M
Mauro Carvalho Chehab 已提交
67
		tuner_warn ("tuner type not set\n");
L
Linus Torvalds 已提交
68 69 70
		return;
	}
	if (NULL == t->tv_freq) {
M
Mauro Carvalho Chehab 已提交
71
		tuner_warn ("Tuner has no way to set tv freq\n");
L
Linus Torvalds 已提交
72 73
		return;
	}
M
Mauro Carvalho Chehab 已提交
74 75 76 77
	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]);
L
Linus Torvalds 已提交
78
	}
M
Mauro Carvalho Chehab 已提交
79
	t->tv_freq(c, freq);
L
Linus Torvalds 已提交
80 81 82 83 84 85 86
}

static void set_radio_freq(struct i2c_client *c, unsigned int freq)
{
	struct tuner *t = i2c_get_clientdata(c);

	if (t->type == UNSET) {
M
Mauro Carvalho Chehab 已提交
87
		tuner_warn ("tuner type not set\n");
L
Linus Torvalds 已提交
88 89 90
		return;
	}
	if (NULL == t->radio_freq) {
M
Mauro Carvalho Chehab 已提交
91
		tuner_warn ("tuner has no way to set radio frequency\n");
L
Linus Torvalds 已提交
92 93
		return;
	}
M
Mauro Carvalho Chehab 已提交
94 95 96 97
	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]);
L
Linus Torvalds 已提交
98
	}
99

M
Mauro Carvalho Chehab 已提交
100
	t->radio_freq(c, freq);
101
	return;
L
Linus Torvalds 已提交
102 103 104 105 106 107 108 109 110
}

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",
M
Mauro Carvalho Chehab 已提交
111 112
			  freq / 16000, freq % 16000 * 100 / 16000);
		set_radio_freq(c, freq);
L
Linus Torvalds 已提交
113 114 115 116
		break;
	case V4L2_TUNER_ANALOG_TV:
	case V4L2_TUNER_DIGITAL_TV:
		tuner_dbg("tv freq set to %lu.%02lu\n",
M
Mauro Carvalho Chehab 已提交
117
			  freq / 16, freq % 16 * 100 / 16);
L
Linus Torvalds 已提交
118 119 120 121 122 123
		set_tv_freq(c, freq);
		break;
	}
	t->freq = freq;
}

M
Mauro Carvalho Chehab 已提交
124 125
static void set_type(struct i2c_client *c, unsigned int type,
		     unsigned int new_mode_mask)
L
Linus Torvalds 已提交
126 127
{
	struct tuner *t = i2c_get_clientdata(c);
128
	unsigned char buffer[4];
L
Linus Torvalds 已提交
129

M
Mauro Carvalho Chehab 已提交
130 131
	if (type == UNSET || type == TUNER_ABSENT) {
		tuner_dbg ("tuner 0x%02x: Tuner type absent\n",c->addr);
L
Linus Torvalds 已提交
132
		return;
M
Mauro Carvalho Chehab 已提交
133 134 135 136
	}

	if (type >= tuner_count) {
		tuner_warn ("tuner 0x%02x: Tuner count greater than %d\n",c->addr,tuner_count);
L
Linus Torvalds 已提交
137
		return;
M
Mauro Carvalho Chehab 已提交
138
	}
L
Linus Torvalds 已提交
139

M
Mauro Carvalho Chehab 已提交
140
	/* This code detects calls by card attach_inform */
L
Linus Torvalds 已提交
141
	if (NULL == t->i2c.dev.driver) {
M
Mauro Carvalho Chehab 已提交
142 143 144
		tuner_dbg ("tuner 0x%02x: called during i2c_client register by adapter's attach_inform\n", c->addr);

		t->type=type;
L
Linus Torvalds 已提交
145 146
		return;
	}
147

L
Linus Torvalds 已提交
148
	t->type = type;
M
Mauro Carvalho Chehab 已提交
149

L
Linus Torvalds 已提交
150 151 152 153 154 155 156
	switch (t->type) {
	case TUNER_MT2032:
		microtune_init(c);
		break;
	case TUNER_PHILIPS_TDA8290:
		tda8290_init(c);
		break;
157
	case TUNER_TEA5767:
M
Mauro Carvalho Chehab 已提交
158 159 160 161 162 163
		if (tea5767_tuner_init(c) == EINVAL) {
			t->type = TUNER_ABSENT;
			t->mode_mask = T_UNINITIALIZED;
			return;
		}
		t->mode_mask = T_RADIO;
164 165 166 167 168 169
		break;
	case TUNER_PHILIPS_FMD1216ME_MK3:
		buffer[0] = 0x0b;
		buffer[1] = 0xdc;
		buffer[2] = 0x9c;
		buffer[3] = 0x60;
M
Mauro Carvalho Chehab 已提交
170
		i2c_master_send(c, buffer, 4);
171 172 173
		mdelay(1);
		buffer[2] = 0x86;
		buffer[3] = 0x54;
M
Mauro Carvalho Chehab 已提交
174
		i2c_master_send(c, buffer, 4);
175 176
		default_tuner_init(c);
		break;
L
Linus Torvalds 已提交
177 178 179 180
	default:
		default_tuner_init(c);
		break;
	}
M
Mauro Carvalho Chehab 已提交
181 182 183 184 185 186 187 188

	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);
L
Linus Torvalds 已提交
189 190
}

M
Mauro Carvalho Chehab 已提交
191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209
/*
 * 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);
	}
}
210

M
Mauro Carvalho Chehab 已提交
211
static inline int check_mode(struct tuner *t, char *cmd)
212
{
M
Mauro Carvalho Chehab 已提交
213 214
	if (1 << t->mode & t->mode_mask) {
		switch (t->mode) {
215
		case V4L2_TUNER_RADIO:
M
Mauro Carvalho Chehab 已提交
216
			tuner_dbg("Cmd %s accepted for radio\n", cmd);
217
			break;
M
Mauro Carvalho Chehab 已提交
218 219 220 221 222
		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);
223 224
			break;
		}
M
Mauro Carvalho Chehab 已提交
225
		return 0;
226
	}
M
Mauro Carvalho Chehab 已提交
227
	return EINVAL;
228 229
}

L
Linus Torvalds 已提交
230
static char pal[] = "-";
231
module_param_string(pal, pal, sizeof(pal), 0644);
M
Mauro Carvalho Chehab 已提交
232 233
static char secam[] = "-";
module_param_string(secam, secam, sizeof(secam), 0644);
L
Linus Torvalds 已提交
234

M
Mauro Carvalho Chehab 已提交
235
/* get more precise norm info from insmod option */
L
Linus Torvalds 已提交
236 237 238 239 240 241 242 243
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':
M
Mauro Carvalho Chehab 已提交
244
			tuner_dbg ("insmod fixup: PAL => PAL-BG\n");
L
Linus Torvalds 已提交
245 246 247 248
			t->std = V4L2_STD_PAL_BG;
			break;
		case 'i':
		case 'I':
M
Mauro Carvalho Chehab 已提交
249
			tuner_dbg ("insmod fixup: PAL => PAL-I\n");
L
Linus Torvalds 已提交
250 251 252 253 254 255
			t->std = V4L2_STD_PAL_I;
			break;
		case 'd':
		case 'D':
		case 'k':
		case 'K':
M
Mauro Carvalho Chehab 已提交
256
			tuner_dbg ("insmod fixup: PAL => PAL-DK\n");
L
Linus Torvalds 已提交
257 258
			t->std = V4L2_STD_PAL_DK;
			break;
M
Mauro Carvalho Chehab 已提交
259 260 261 262 263 264 265 266 267 268
		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;
L
Linus Torvalds 已提交
269 270
		}
	}
M
Mauro Carvalho Chehab 已提交
271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287
	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;
		}
	}

L
Linus Torvalds 已提交
288 289 290 291 292
	return 0;
}

/* ---------------------------------------------------------------------- */

M
Mauro Carvalho Chehab 已提交
293 294 295 296 297 298
/* 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.
 */
L
Linus Torvalds 已提交
299 300 301 302
static int tuner_attach(struct i2c_adapter *adap, int addr, int kind)
{
	struct tuner *t;

M
Mauro Carvalho Chehab 已提交
303 304
	client_template.adapter = adap;
	client_template.addr = addr;
L
Linus Torvalds 已提交
305

M
Mauro Carvalho Chehab 已提交
306 307 308 309 310
	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));
L
Linus Torvalds 已提交
311
	i2c_set_clientdata(&t->i2c, t);
M
Mauro Carvalho Chehab 已提交
312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333
	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);

	/* TEA5767 autodetection code - only for addr = 0xc0 */
	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;
		}
	}
L
Linus Torvalds 已提交
334

M
Mauro Carvalho Chehab 已提交
335 336 337 338 339 340 341
	/* 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;
	}
342

M
Mauro Carvalho Chehab 已提交
343 344 345
	/* Should be just before return */
	i2c_attach_client (&t->i2c);
	set_type (&t->i2c,t->type, t->mode_mask);
L
Linus Torvalds 已提交
346 347 348 349 350 351
	return 0;
}

static int tuner_probe(struct i2c_adapter *adap)
{
	if (0 != addr) {
352 353
		normal_i2c[0] = addr;
		normal_i2c[1] = I2C_CLIENT_END;
L
Linus Torvalds 已提交
354 355
	}

M
Mauro Carvalho Chehab 已提交
356
	default_mode_mask = T_RADIO | T_ANALOG_TV | T_DIGITAL_TV;
357

L
Linus Torvalds 已提交
358 359 360 361 362 363 364 365
	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);
366 367
	int err;

M
Mauro Carvalho Chehab 已提交
368
	err = i2c_detach_client(&t->i2c);
369
	if (err) {
M
Mauro Carvalho Chehab 已提交
370 371
		tuner_warn
		    ("Client deregistration failed, client not detached.\n");
372 373
		return err;
	}
L
Linus Torvalds 已提交
374 375 376 377 378

	kfree(t);
	return 0;
}

M
Mauro Carvalho Chehab 已提交
379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415
/*
 * 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;
}
L
Linus Torvalds 已提交
416

M
Mauro Carvalho Chehab 已提交
417
static int tuner_command(struct i2c_client *client, unsigned int cmd, void *arg)
L
Linus Torvalds 已提交
418 419
{
	struct tuner *t = i2c_get_clientdata(client);
M
Mauro Carvalho Chehab 已提交
420
	unsigned int *iarg = (int *)arg;
L
Linus Torvalds 已提交
421

M
Mauro Carvalho Chehab 已提交
422
	switch (cmd) {
L
Linus Torvalds 已提交
423
	/* --- configuration --- */
424
	case TUNER_SET_TYPE_ADDR:
M
Mauro Carvalho Chehab 已提交
425 426 427 428 429 430
		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);
431
		break;
L
Linus Torvalds 已提交
432
	case AUDC_SET_RADIO:
M
Mauro Carvalho Chehab 已提交
433
		set_mode(client,t,V4L2_TUNER_RADIO, "AUDC_SET_RADIO");
L
Linus Torvalds 已提交
434 435
		break;
	case AUDC_CONFIG_PINNACLE:
M
Mauro Carvalho Chehab 已提交
436 437
		if (check_mode(t, "AUDC_CONFIG_PINNACLE") == EINVAL)
			return 0;
L
Linus Torvalds 已提交
438 439 440 441 442 443 444 445 446 447
		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;
		}
448
		break;
M
Mauro Carvalho Chehab 已提交
449 450
	case TDA9887_SET_CONFIG:
		break;
L
Linus Torvalds 已提交
451 452 453 454
	/* --- v4l ioctls --- */
	/* take care: bttv does userspace copying, we'll get a
	   kernel pointer here... */
	case VIDIOCSCHAN:
M
Mauro Carvalho Chehab 已提交
455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478
		{
			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;
		}
L
Linus Torvalds 已提交
479
	case VIDIOCSFREQ:
M
Mauro Carvalho Chehab 已提交
480 481
		{
			unsigned long *v = arg;
L
Linus Torvalds 已提交
482

M
Mauro Carvalho Chehab 已提交
483 484 485 486 487 488 489 490
			if (check_mode(t, "VIDIOCSFREQ") == EINVAL)
				return 0;
			if (check_v4l2(t) == EINVAL)
				return 0;

			set_freq(client, *v);
			return 0;
		}
L
Linus Torvalds 已提交
491
	case VIDIOCGTUNER:
M
Mauro Carvalho Chehab 已提交
492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511
		{
			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 */
512

M
Mauro Carvalho Chehab 已提交
513 514
				vt->rangelow = radio_range[0] * 16000;
				vt->rangehigh = radio_range[1] * 16000;
515

M
Mauro Carvalho Chehab 已提交
516 517 518 519
			} else {
				vt->rangelow = tv_range[0] * 16;
				vt->rangehigh = tv_range[1] * 16;
			}
520

M
Mauro Carvalho Chehab 已提交
521 522
			return 0;
		}
L
Linus Torvalds 已提交
523
	case VIDIOCGAUDIO:
M
Mauro Carvalho Chehab 已提交
524 525 526 527 528 529 530 531 532 533 534 535 536
		{
			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;
		}
L
Linus Torvalds 已提交
537 538

	case VIDIOC_S_STD:
M
Mauro Carvalho Chehab 已提交
539 540
		{
			v4l2_std_id *id = arg;
L
Linus Torvalds 已提交
541

M
Mauro Carvalho Chehab 已提交
542 543 544
			if (set_mode (client, t, V4L2_TUNER_ANALOG_TV, "VIDIOC_S_STD")
					== EINVAL)
				return 0;
545

M
Mauro Carvalho Chehab 已提交
546 547 548 549 550 551 552 553
			switch_v4l2();

			t->std = *id;
			tuner_fixup_std(t);
			if (t->freq)
				set_freq(client, t->freq);
			break;
		}
L
Linus Torvalds 已提交
554
	case VIDIOC_S_FREQUENCY:
M
Mauro Carvalho Chehab 已提交
555 556 557 558 559 560 561 562 563 564 565 566
		{
			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);
567

M
Mauro Carvalho Chehab 已提交
568 569 570 571 572 573 574 575 576 577 578 579 580
			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;
		}
L
Linus Torvalds 已提交
581
	case VIDIOC_G_TUNER:
M
Mauro Carvalho Chehab 已提交
582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602
		{
			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;
					}
603
				}
M
Mauro Carvalho Chehab 已提交
604 605 606 607 608 609 610 611 612 613 614

				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;
615
			}
M
Mauro Carvalho Chehab 已提交
616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631
			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;
632
		}
L
Linus Torvalds 已提交
633
	default:
M
Mauro Carvalho Chehab 已提交
634
		tuner_dbg("Unimplemented IOCTL 0x%08x called to tuner.\n", cmd);
L
Linus Torvalds 已提交
635 636 637 638 639 640
		break;
	}

	return 0;
}

M
Mauro Carvalho Chehab 已提交
641
static int tuner_suspend(struct device *dev, u32 state, u32 level)
L
Linus Torvalds 已提交
642
{
M
Mauro Carvalho Chehab 已提交
643 644
	struct i2c_client *c = container_of (dev, struct i2c_client, dev);
	struct tuner *t = i2c_get_clientdata (c);
L
Linus Torvalds 已提交
645

M
Mauro Carvalho Chehab 已提交
646
	tuner_dbg ("suspend\n");
L
Linus Torvalds 已提交
647 648 649 650
	/* FIXME: power down ??? */
	return 0;
}

M
Mauro Carvalho Chehab 已提交
651
static int tuner_resume(struct device *dev, u32 level)
L
Linus Torvalds 已提交
652
{
M
Mauro Carvalho Chehab 已提交
653 654
	struct i2c_client *c = container_of (dev, struct i2c_client, dev);
	struct tuner *t = i2c_get_clientdata (c);
L
Linus Torvalds 已提交
655

M
Mauro Carvalho Chehab 已提交
656
	tuner_dbg ("resume\n");
L
Linus Torvalds 已提交
657
	if (t->freq)
M
Mauro Carvalho Chehab 已提交
658
		set_freq(c, t->freq);
L
Linus Torvalds 已提交
659 660 661 662 663 664
	return 0;
}

/* ----------------------------------------------------------------------- */

static struct i2c_driver driver = {
M
Mauro Carvalho Chehab 已提交
665 666 667 668 669 670 671
	.owner = THIS_MODULE,
	.name = "tuner",
	.id = I2C_DRIVERID_TUNER,
	.flags = I2C_DF_NOTIFY,
	.attach_adapter = tuner_probe,
	.detach_client = tuner_detach,
	.command = tuner_command,
L
Linus Torvalds 已提交
672
	.driver = {
M
Mauro Carvalho Chehab 已提交
673 674 675
		   .suspend = tuner_suspend,
		   .resume = tuner_resume,
		   },
L
Linus Torvalds 已提交
676
};
M
Mauro Carvalho Chehab 已提交
677
static struct i2c_client client_template = {
L
Linus Torvalds 已提交
678
	I2C_DEVNAME("(tuner unset)"),
M
Mauro Carvalho Chehab 已提交
679 680
	.flags = I2C_CLIENT_ALLOW_USE,
	.driver = &driver,
L
Linus Torvalds 已提交
681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702
};

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:
 */