tuner-core.c 20.4 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22
/*
 *
 * 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>
23
#include <media/v4l2-common.h>
L
Linus Torvalds 已提交
24 25 26 27 28

#define UNSET (-1U)

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

L
Linus Torvalds 已提交
35 36 37
I2C_CLIENT_INSMOD;

/* insmod options used at init time => read/only */
M
Mauro Carvalho Chehab 已提交
38
static unsigned int addr = 0;
39
static unsigned int no_autodetect = 0;
40 41
static unsigned int show_i2c = 0;

L
Linus Torvalds 已提交
42
/* insmod options used at runtime => read/write */
43 44
static unsigned int tuner_debug_old = 0;
int tuner_debug = 0;
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 };

49 50 51 52
static char pal[] = "--";
static char secam[] = "--";
static char ntsc[] = "-";

53

54 55 56
module_param(addr, int, 0444);
module_param(no_autodetect, int, 0444);
module_param(show_i2c, int, 0444);
57
/* Note: tuner_debug is deprecated and will be removed in 2.6.17 */
58 59
module_param_named(tuner_debug,tuner_debug_old, int, 0444);
module_param_named(debug,tuner_debug, int, 0644);
60 61 62
module_param_string(pal, pal, sizeof(pal), 0644);
module_param_string(secam, secam, sizeof(secam), 0644);
module_param_string(ntsc, ntsc, sizeof(ntsc), 0644);
M
Mauro Carvalho Chehab 已提交
63
module_param_array(tv_range, int, NULL, 0644);
L
Linus Torvalds 已提交
64 65 66 67 68 69 70 71 72 73 74
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;

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

75
/* Set tuner frequency,  freq in Units of 62.5kHz = 1/16MHz */
L
Linus Torvalds 已提交
76 77 78 79 80
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 已提交
81
		tuner_warn ("tuner type not set\n");
L
Linus Torvalds 已提交
82 83
		return;
	}
84
	if (NULL == t->set_tv_freq) {
M
Mauro Carvalho Chehab 已提交
85
		tuner_warn ("Tuner has no way to set tv freq\n");
L
Linus Torvalds 已提交
86 87
		return;
	}
M
Mauro Carvalho Chehab 已提交
88 89 90 91
	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]);
92 93 94 95 96 97
		/* V4L2 spec: if the freq is not possible then the closest
		   possible value should be selected */
		if (freq < tv_range[0] * 16)
			freq = tv_range[0] * 16;
		else
			freq = tv_range[1] * 16;
L
Linus Torvalds 已提交
98
	}
99
	t->set_tv_freq(c, freq);
L
Linus Torvalds 已提交
100 101 102 103 104 105 106
}

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 已提交
107
		tuner_warn ("tuner type not set\n");
L
Linus Torvalds 已提交
108 109
		return;
	}
110
	if (NULL == t->set_radio_freq) {
M
Mauro Carvalho Chehab 已提交
111
		tuner_warn ("tuner has no way to set radio frequency\n");
L
Linus Torvalds 已提交
112 113
		return;
	}
114
	if (freq < radio_range[0] * 16000 || freq > radio_range[1] * 16000) {
M
Mauro Carvalho Chehab 已提交
115 116 117
		tuner_dbg ("radio freq (%d.%02d) out of range (%d-%d)\n",
			   freq / 16000, freq % 16000 * 100 / 16000,
			   radio_range[0], radio_range[1]);
118 119 120 121 122 123
		/* V4L2 spec: if the freq is not possible then the closest
		   possible value should be selected */
		if (freq < radio_range[0] * 16000)
			freq = radio_range[0] * 16000;
		else
			freq = radio_range[1] * 16000;
L
Linus Torvalds 已提交
124
	}
125

126
	t->set_radio_freq(c, freq);
L
Linus Torvalds 已提交
127 128 129 130 131 132 133 134 135
}

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 已提交
136 137
			  freq / 16000, freq % 16000 * 100 / 16000);
		set_radio_freq(c, freq);
138
		t->radio_freq = freq;
L
Linus Torvalds 已提交
139 140 141 142
		break;
	case V4L2_TUNER_ANALOG_TV:
	case V4L2_TUNER_DIGITAL_TV:
		tuner_dbg("tv freq set to %lu.%02lu\n",
M
Mauro Carvalho Chehab 已提交
143
			  freq / 16, freq % 16 * 100 / 16);
L
Linus Torvalds 已提交
144
		set_tv_freq(c, freq);
145
		t->tv_freq = freq;
L
Linus Torvalds 已提交
146 147 148 149
		break;
	}
}

M
Mauro Carvalho Chehab 已提交
150 151
static void set_type(struct i2c_client *c, unsigned int type,
		     unsigned int new_mode_mask)
L
Linus Torvalds 已提交
152 153
{
	struct tuner *t = i2c_get_clientdata(c);
154
	unsigned char buffer[4];
L
Linus Torvalds 已提交
155

M
Mauro Carvalho Chehab 已提交
156 157
	if (type == UNSET || type == TUNER_ABSENT) {
		tuner_dbg ("tuner 0x%02x: Tuner type absent\n",c->addr);
L
Linus Torvalds 已提交
158
		return;
M
Mauro Carvalho Chehab 已提交
159 160 161 162
	}

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

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

		t->type=type;
L
Linus Torvalds 已提交
171 172
		return;
	}
173

L
Linus Torvalds 已提交
174 175 176 177 178 179 180 181
	t->type = type;
	switch (t->type) {
	case TUNER_MT2032:
		microtune_init(c);
		break;
	case TUNER_PHILIPS_TDA8290:
		tda8290_init(c);
		break;
182
	case TUNER_TEA5767:
M
Mauro Carvalho Chehab 已提交
183 184 185 186 187 188
		if (tea5767_tuner_init(c) == EINVAL) {
			t->type = TUNER_ABSENT;
			t->mode_mask = T_UNINITIALIZED;
			return;
		}
		t->mode_mask = T_RADIO;
189 190 191 192 193 194
		break;
	case TUNER_PHILIPS_FMD1216ME_MK3:
		buffer[0] = 0x0b;
		buffer[1] = 0xdc;
		buffer[2] = 0x9c;
		buffer[3] = 0x60;
M
Mauro Carvalho Chehab 已提交
195
		i2c_master_send(c, buffer, 4);
196 197 198
		mdelay(1);
		buffer[2] = 0x86;
		buffer[3] = 0x54;
M
Mauro Carvalho Chehab 已提交
199
		i2c_master_send(c, buffer, 4);
200 201
		default_tuner_init(c);
		break;
202 203 204 205 206 207 208 209
	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;
210 211 212 213 214 215 216
	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);
217
		break;
L
Linus Torvalds 已提交
218 219 220 221
	default:
		default_tuner_init(c);
		break;
	}
M
Mauro Carvalho Chehab 已提交
222 223 224 225

	if (t->mode_mask == T_UNINITIALIZED)
		t->mode_mask = new_mode_mask;

226
	set_freq(c, (V4L2_TUNER_RADIO == t->mode) ? t->radio_freq : t->tv_freq);
M
Mauro Carvalho Chehab 已提交
227
	tuner_dbg("%s %s I2C addr 0x%02x with type %d used for 0x%02x\n",
228
		  c->adapter->name, c->driver->driver.name, c->addr << 1, type,
M
Mauro Carvalho Chehab 已提交
229
		  t->mode_mask);
L
Linus Torvalds 已提交
230 231
}

M
Mauro Carvalho Chehab 已提交
232 233 234 235 236 237 238 239 240 241 242 243
/*
 * 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);

244
	if ( t->type == UNSET && ((tun_setup->addr == ADDR_UNSET &&
245
		(t->mode_mask & tun_setup->mode_mask)) ||
246
		tun_setup->addr == c->addr)) {
M
Mauro Carvalho Chehab 已提交
247 248 249
			set_type(c, tun_setup->type, tun_setup->mode_mask);
	}
}
250

M
Mauro Carvalho Chehab 已提交
251
static inline int check_mode(struct tuner *t, char *cmd)
252
{
253 254 255 256 257 258 259 260 261 262 263 264 265 266
	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;
267
	}
268
	return 0;
269 270
}

M
Mauro Carvalho Chehab 已提交
271
/* get more precise norm info from insmod option */
L
Linus Torvalds 已提交
272 273 274 275 276 277 278 279
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 已提交
280
			tuner_dbg ("insmod fixup: PAL => PAL-BG\n");
L
Linus Torvalds 已提交
281 282 283 284
			t->std = V4L2_STD_PAL_BG;
			break;
		case 'i':
		case 'I':
M
Mauro Carvalho Chehab 已提交
285
			tuner_dbg ("insmod fixup: PAL => PAL-I\n");
L
Linus Torvalds 已提交
286 287 288 289 290 291
			t->std = V4L2_STD_PAL_I;
			break;
		case 'd':
		case 'D':
		case 'k':
		case 'K':
M
Mauro Carvalho Chehab 已提交
292
			tuner_dbg ("insmod fixup: PAL => PAL-DK\n");
L
Linus Torvalds 已提交
293 294
			t->std = V4L2_STD_PAL_DK;
			break;
M
Mauro Carvalho Chehab 已提交
295 296 297 298 299 300 301
		case 'M':
		case 'm':
			tuner_dbg ("insmod fixup: PAL => PAL-M\n");
			t->std = V4L2_STD_PAL_M;
			break;
		case 'N':
		case 'n':
302 303 304 305 306 307 308
			if (pal[1] == 'c' || pal[1] == 'C') {
				tuner_dbg("insmod fixup: PAL => PAL-Nc\n");
				t->std = V4L2_STD_PAL_Nc;
			} else {
				tuner_dbg ("insmod fixup: PAL => PAL-N\n");
				t->std = V4L2_STD_PAL_N;
			}
M
Mauro Carvalho Chehab 已提交
309
			break;
310 311 312 313 314 315
		case '-':
			/* default parameter, do nothing */
			break;
		default:
			tuner_warn ("pal= argument not recognised\n");
			break;
L
Linus Torvalds 已提交
316 317
		}
	}
M
Mauro Carvalho Chehab 已提交
318 319
	if ((t->std & V4L2_STD_SECAM) == V4L2_STD_SECAM) {
		switch (secam[0]) {
320 321 322 323 324 325 326 327 328
		case 'b':
		case 'B':
		case 'g':
		case 'G':
		case 'h':
		case 'H':
			tuner_dbg("insmod fixup: SECAM => SECAM-BGH\n");
			t->std = V4L2_STD_SECAM_B | V4L2_STD_SECAM_G | V4L2_STD_SECAM_H;
			break;
M
Mauro Carvalho Chehab 已提交
329 330 331 332 333 334 335 336 337
		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':
338 339 340 341 342 343 344
			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;
			}
M
Mauro Carvalho Chehab 已提交
345
			break;
346 347 348 349 350 351
		case '-':
			/* default parameter, do nothing */
			break;
		default:
			tuner_warn ("secam= argument not recognised\n");
			break;
M
Mauro Carvalho Chehab 已提交
352 353 354
		}
	}

355 356 357 358 359 360 361 362 363 364 365 366
	if ((t->std & V4L2_STD_NTSC) == V4L2_STD_NTSC) {
		switch (ntsc[0]) {
		case 'm':
		case 'M':
			tuner_dbg("insmod fixup: NTSC => NTSC-M\n");
			t->std = V4L2_STD_NTSC_M;
			break;
		case 'j':
		case 'J':
			tuner_dbg("insmod fixup: NTSC => NTSC_M_JP\n");
			t->std = V4L2_STD_NTSC_M_JP;
			break;
367 368 369 370 371
		case 'k':
		case 'K':
			tuner_dbg("insmod fixup: NTSC => NTSC_M_KR\n");
			t->std = V4L2_STD_NTSC_M_KR;
			break;
372 373 374 375 376 377 378 379
		case '-':
			/* default parameter, do nothing */
			break;
		default:
			tuner_info("ntsc= argument not recognised\n");
			break;
		}
	}
L
Linus Torvalds 已提交
380 381 382
	return 0;
}

383 384 385 386 387 388 389 390 391 392 393 394 395
static void tuner_status(struct i2c_client *client)
{
	struct tuner *t = i2c_get_clientdata(client);
	unsigned long freq, freq_fraction;
	const char *p;

	switch (t->mode) {
		case V4L2_TUNER_RADIO: 	    p = "radio"; break;
		case V4L2_TUNER_ANALOG_TV:  p = "analog TV"; break;
		case V4L2_TUNER_DIGITAL_TV: p = "digital TV"; break;
		default: p = "undefined"; break;
	}
	if (t->mode == V4L2_TUNER_RADIO) {
396 397
		freq = t->radio_freq / 16000;
		freq_fraction = (t->radio_freq % 16000) * 100 / 16000;
398
	} else {
399 400
		freq = t->tv_freq / 16;
		freq_fraction = (t->tv_freq % 16) * 100 / 16;
401 402 403
	}
	tuner_info("Tuner mode:      %s\n", p);
	tuner_info("Frequency:       %lu.%02lu MHz\n", freq, freq_fraction);
404
	tuner_info("Standard:        0x%08lx\n", (unsigned long)t->std);
405 406 407 408 409 410 411
	if (t->mode != V4L2_TUNER_RADIO)
	       return;
	if (t->has_signal) {
		tuner_info("Signal strength: %d\n", t->has_signal(client));
	}
	if (t->is_stereo) {
		tuner_info("Stereo:          %s\n", t->is_stereo(client) ? "yes" : "no");
412 413
	}
}
414

L
Linus Torvalds 已提交
415 416
/* ---------------------------------------------------------------------- */

M
Mauro Carvalho Chehab 已提交
417 418 419 420 421 422
/* 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 已提交
423 424 425 426
static int tuner_attach(struct i2c_adapter *adap, int addr, int kind)
{
	struct tuner *t;

M
Mauro Carvalho Chehab 已提交
427 428
	client_template.adapter = adap;
	client_template.addr = addr;
L
Linus Torvalds 已提交
429

P
 
Panagiotis Issaris 已提交
430
	t = kzalloc(sizeof(struct tuner), GFP_KERNEL);
M
Mauro Carvalho Chehab 已提交
431 432 433
	if (NULL == t)
		return -ENOMEM;
	memcpy(&t->i2c, &client_template, sizeof(struct i2c_client));
L
Linus Torvalds 已提交
434
	i2c_set_clientdata(&t->i2c, t);
M
Mauro Carvalho Chehab 已提交
435 436 437 438
	t->type = UNSET;
	t->radio_if2 = 10700 * 1000;	/* 10.7MHz - FM radio */
	t->audmode = V4L2_TUNER_MODE_STEREO;
	t->mode_mask = T_UNINITIALIZED;
439 440
	if (tuner_debug_old) {
		tuner_debug = tuner_debug_old;
441 442 443
		printk(KERN_ERR "tuner: tuner_debug is deprecated and will be removed in 2.6.17.\n");
		printk(KERN_ERR "tuner: use the debug option instead.\n");
	}
M
Mauro Carvalho Chehab 已提交
444

445 446 447 448 449 450
	if (show_i2c) {
		unsigned char buffer[16];
		int i,rc;

		memset(buffer, 0, sizeof(buffer));
		rc = i2c_master_recv(&t->i2c, buffer, sizeof(buffer));
451
		tuner_info("I2C RECV = ");
452 453 454 455
		for (i=0;i<rc;i++)
			printk("%02x ",buffer[i]);
		printk("\n");
	}
456
	/* autodetection code based on the i2c addr */
457
	if (!no_autodetect) {
458 459 460 461
		switch (addr) {
		case 0x42:
		case 0x43:
		case 0x4a:
462
		case 0x4b:
463 464
			/* If chip is not tda8290, don't register.
			   since it can be tda9887*/
465
			if (tda8290_probe(&t->i2c) != 0) {
466
				tuner_dbg("chip at addr %x is not a tda8290\n", addr);
467 468 469
				kfree(t);
				return 0;
			}
470 471 472 473 474 475
			break;
		case 0x60:
			if (tea5767_autodetection(&t->i2c) != EINVAL) {
				t->type = TUNER_TEA5767;
				t->mode_mask = T_RADIO;
				t->mode = T_STANDBY;
476
				t->radio_freq = 87.5 * 16000; /* Sets freq to FM range */
477
				default_mode_mask &= ~T_RADIO;
478

479 480 481
				goto register_client;
			}
			break;
M
Mauro Carvalho Chehab 已提交
482 483
		}
	}
L
Linus Torvalds 已提交
484

M
Mauro Carvalho Chehab 已提交
485 486 487 488
	/* 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;
489 490
		t->tv_freq = 400 * 16; /* Sets freq to VHF High */
		t->radio_freq = 87.5 * 16000; /* Sets freq to FM range */
M
Mauro Carvalho Chehab 已提交
491 492
		default_mode_mask = T_UNINITIALIZED;
	}
493

M
Mauro Carvalho Chehab 已提交
494
	/* Should be just before return */
495 496
register_client:
	tuner_info("chip found @ 0x%x (%s)\n", addr << 1, adap->name);
M
Mauro Carvalho Chehab 已提交
497 498
	i2c_attach_client (&t->i2c);
	set_type (&t->i2c,t->type, t->mode_mask);
L
Linus Torvalds 已提交
499 500 501 502 503 504
	return 0;
}

static int tuner_probe(struct i2c_adapter *adap)
{
	if (0 != addr) {
505 506
		normal_i2c[0] = addr;
		normal_i2c[1] = I2C_CLIENT_END;
L
Linus Torvalds 已提交
507 508
	}

M
Mauro Carvalho Chehab 已提交
509
	default_mode_mask = T_RADIO | T_ANALOG_TV | T_DIGITAL_TV;
510

L
Linus Torvalds 已提交
511 512 513 514 515 516 517 518
	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);
519 520
	int err;

M
Mauro Carvalho Chehab 已提交
521
	err = i2c_detach_client(&t->i2c);
522
	if (err) {
M
Mauro Carvalho Chehab 已提交
523 524
		tuner_warn
		    ("Client deregistration failed, client not detached.\n");
525 526
		return err;
	}
L
Linus Torvalds 已提交
527 528 529 530 531

	kfree(t);
	return 0;
}

M
Mauro Carvalho Chehab 已提交
532 533 534 535 536 537 538 539 540
/*
 * 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)
{
541 542 543 544 545 546 547 548 549 550 551 552
	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;
M
Mauro Carvalho Chehab 已提交
553 554 555
}

#define switch_v4l2()	if (!t->using_v4l2) \
556 557
			    tuner_dbg("switching to v4l2\n"); \
			t->using_v4l2 = 1;
M
Mauro Carvalho Chehab 已提交
558 559 560 561 562 563 564 565 566

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 已提交
567

M
Mauro Carvalho Chehab 已提交
568
static int tuner_command(struct i2c_client *client, unsigned int cmd, void *arg)
L
Linus Torvalds 已提交
569 570 571
{
	struct tuner *t = i2c_get_clientdata(client);

572
	if (tuner_debug>1)
573 574
		v4l_i2c_print_ioctl(&(t->i2c),cmd);

M
Mauro Carvalho Chehab 已提交
575
	switch (cmd) {
L
Linus Torvalds 已提交
576
	/* --- configuration --- */
577
	case TUNER_SET_TYPE_ADDR:
M
Mauro Carvalho Chehab 已提交
578 579 580 581 582 583
		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);
584
		break;
L
Linus Torvalds 已提交
585
	case AUDC_SET_RADIO:
586 587 588 589 590
		if (set_mode(client, t, V4L2_TUNER_RADIO, "AUDC_SET_RADIO")
				== EINVAL)
			return 0;
		if (t->radio_freq)
			set_freq(client, t->radio_freq);
L
Linus Torvalds 已提交
591
		break;
592
	case TUNER_SET_STANDBY:
593 594 595 596 597
		if (check_mode(t, "TUNER_SET_STANDBY") == EINVAL)
			return 0;
		if (t->standby)
			t->standby (client);
		break;
598 599 600 601 602 603 604 605
	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");
M
Mauro Carvalho Chehab 已提交
606
		break;
L
Linus Torvalds 已提交
607 608 609 610
	/* --- v4l ioctls --- */
	/* take care: bttv does userspace copying, we'll get a
	   kernel pointer here... */
	case VIDIOCSCHAN:
M
Mauro Carvalho Chehab 已提交
611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630
		{
			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);
631 632
			if (t->tv_freq)
				set_tv_freq(client, t->tv_freq);
M
Mauro Carvalho Chehab 已提交
633 634
			return 0;
		}
L
Linus Torvalds 已提交
635
	case VIDIOCSFREQ:
M
Mauro Carvalho Chehab 已提交
636 637
		{
			unsigned long *v = arg;
L
Linus Torvalds 已提交
638

M
Mauro Carvalho Chehab 已提交
639 640 641 642 643 644 645 646
			if (check_mode(t, "VIDIOCSFREQ") == EINVAL)
				return 0;
			if (check_v4l2(t) == EINVAL)
				return 0;

			set_freq(client, *v);
			return 0;
		}
L
Linus Torvalds 已提交
647
	case VIDIOCGTUNER:
M
Mauro Carvalho Chehab 已提交
648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667
		{
			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 */
668

M
Mauro Carvalho Chehab 已提交
669 670
				vt->rangelow = radio_range[0] * 16000;
				vt->rangehigh = radio_range[1] * 16000;
671

M
Mauro Carvalho Chehab 已提交
672 673 674 675
			} else {
				vt->rangelow = tv_range[0] * 16;
				vt->rangehigh = tv_range[1] * 16;
			}
676

M
Mauro Carvalho Chehab 已提交
677 678
			return 0;
		}
L
Linus Torvalds 已提交
679
	case VIDIOCGAUDIO:
M
Mauro Carvalho Chehab 已提交
680 681 682 683 684 685 686 687 688 689 690 691 692
		{
			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 已提交
693 694

	case VIDIOC_S_STD:
M
Mauro Carvalho Chehab 已提交
695 696
		{
			v4l2_std_id *id = arg;
L
Linus Torvalds 已提交
697

M
Mauro Carvalho Chehab 已提交
698 699 700
			if (set_mode (client, t, V4L2_TUNER_ANALOG_TV, "VIDIOC_S_STD")
					== EINVAL)
				return 0;
701

M
Mauro Carvalho Chehab 已提交
702 703 704 705
			switch_v4l2();

			t->std = *id;
			tuner_fixup_std(t);
706 707
			if (t->tv_freq)
				set_freq(client, t->tv_freq);
M
Mauro Carvalho Chehab 已提交
708 709
			break;
		}
L
Linus Torvalds 已提交
710
	case VIDIOC_S_FREQUENCY:
M
Mauro Carvalho Chehab 已提交
711 712 713 714
		{
			struct v4l2_frequency *f = arg;

			switch_v4l2();
715 716 717
			if ((V4L2_TUNER_RADIO == f->type && V4L2_TUNER_RADIO != t->mode)
				|| (V4L2_TUNER_DIGITAL_TV == f->type
					&& V4L2_TUNER_DIGITAL_TV != t->mode)) {
718
				if (set_mode (client, t, f->type, "VIDIOC_S_FREQUENCY")
M
Mauro Carvalho Chehab 已提交
719 720 721
					    == EINVAL)
					return 0;
			}
722
			set_freq(client,f->frequency);
723

M
Mauro Carvalho Chehab 已提交
724 725 726 727 728 729 730 731 732 733
			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;
734 735
			f->frequency = (V4L2_TUNER_RADIO == t->mode) ?
				t->radio_freq : t->tv_freq;
M
Mauro Carvalho Chehab 已提交
736 737
			break;
		}
L
Linus Torvalds 已提交
738
	case VIDIOC_G_TUNER:
M
Mauro Carvalho Chehab 已提交
739 740 741 742 743 744 745
		{
			struct v4l2_tuner *tuner = arg;

			if (check_mode(t, "VIDIOC_G_TUNER") == EINVAL)
				return 0;
			switch_v4l2();

746 747
			tuner->type = t->mode;
			if (t->mode != V4L2_TUNER_RADIO) {
M
Mauro Carvalho Chehab 已提交
748 749
				tuner->rangelow = tv_range[0] * 16;
				tuner->rangehigh = tv_range[1] * 16;
750 751 752 753 754 755 756 757 758 759 760 761
				break;
			}

			/* radio mode */
			if (t->has_signal)
				tuner->signal = t->has_signal(client);

			tuner->rxsubchans =
				V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
			if (t->is_stereo) {
				tuner->rxsubchans = t->is_stereo(client) ?
					V4L2_TUNER_SUB_STEREO : V4L2_TUNER_SUB_MONO;
762
			}
763 764 765 766 767 768

			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;
M
Mauro Carvalho Chehab 已提交
769 770 771 772 773 774 775 776 777 778 779
			break;
		}
	case VIDIOC_S_TUNER:
		{
			struct v4l2_tuner *tuner = arg;

			if (check_mode(t, "VIDIOC_S_TUNER") == EINVAL)
				return 0;

			switch_v4l2();

780 781 782 783 784
			/* do nothing unless we're a radio tuner */
			if (t->mode != V4L2_TUNER_RADIO)
				break;
			t->audmode = tuner->audmode;
			set_radio_freq(client, t->radio_freq);
M
Mauro Carvalho Chehab 已提交
785
			break;
786
		}
787 788 789
	case VIDIOC_LOG_STATUS:
		tuner_status(client);
		break;
L
Linus Torvalds 已提交
790 791 792 793 794
	}

	return 0;
}

795
static int tuner_suspend(struct device *dev, pm_message_t state)
L
Linus Torvalds 已提交
796
{
M
Mauro Carvalho Chehab 已提交
797 798
	struct i2c_client *c = container_of (dev, struct i2c_client, dev);
	struct tuner *t = i2c_get_clientdata (c);
L
Linus Torvalds 已提交
799

M
Mauro Carvalho Chehab 已提交
800
	tuner_dbg ("suspend\n");
L
Linus Torvalds 已提交
801 802 803 804
	/* FIXME: power down ??? */
	return 0;
}

805
static int tuner_resume(struct device *dev)
L
Linus Torvalds 已提交
806
{
M
Mauro Carvalho Chehab 已提交
807 808
	struct i2c_client *c = container_of (dev, struct i2c_client, dev);
	struct tuner *t = i2c_get_clientdata (c);
L
Linus Torvalds 已提交
809

M
Mauro Carvalho Chehab 已提交
810
	tuner_dbg ("resume\n");
811 812 813 814 815 816 817
	if (V4L2_TUNER_RADIO == t->mode) {
		if (t->radio_freq)
			set_freq(c, t->radio_freq);
	} else {
		if (t->tv_freq)
			set_freq(c, t->tv_freq);
	}
L
Linus Torvalds 已提交
818 819 820 821 822 823
	return 0;
}

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

static struct i2c_driver driver = {
M
Mauro Carvalho Chehab 已提交
824 825 826 827
	.id = I2C_DRIVERID_TUNER,
	.attach_adapter = tuner_probe,
	.detach_client = tuner_detach,
	.command = tuner_command,
L
Linus Torvalds 已提交
828
	.driver = {
829 830 831 832
		.name    = "tuner",
		.suspend = tuner_suspend,
		.resume  = tuner_resume,
	},
L
Linus Torvalds 已提交
833
};
M
Mauro Carvalho Chehab 已提交
834
static struct i2c_client client_template = {
835
	.name = "(tuner unset)",
M
Mauro Carvalho Chehab 已提交
836
	.driver = &driver,
L
Linus Torvalds 已提交
837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858
};

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