tuner-core.c 20.6 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

static inline int check_v4l2(struct tuner *t)
{
561 562 563 564
	/* bttv still uses both v4l1 and v4l2 calls to the tuner (v4l2 for
	   TV, v4l1 for radio), until that is fixed this code is disabled.
	   Otherwise the radio (v4l1) wouldn't tune after using the TV (v4l2)
	   first. */
M
Mauro Carvalho Chehab 已提交
565 566
	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:
 */