tuner-core.c 20.8 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
int tuner_debug = 0;
L
Linus Torvalds 已提交
44

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

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

52

53 54 55
module_param(addr, int, 0444);
module_param(no_autodetect, int, 0444);
module_param(show_i2c, int, 0444);
56
module_param_named(debug,tuner_debug, int, 0644);
57 58 59
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 已提交
60
module_param_array(tv_range, int, NULL, 0644);
L
Linus Torvalds 已提交
61 62 63 64 65 66 67 68 69 70 71
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;

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

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

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

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

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

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

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

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

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

		t->type=type;
L
Linus Torvalds 已提交
168 169
		return;
	}
170

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

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

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

M
Mauro Carvalho Chehab 已提交
224 225 226 227 228 229 230 231 232 233 234 235
/*
 * 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);

236 237
	tuner_dbg("set addr for type %i\n", t->type);

238
	if ( t->type == UNSET && ((tun_setup->addr == ADDR_UNSET &&
239
		(t->mode_mask & tun_setup->mode_mask)) ||
240
		tun_setup->addr == c->addr)) {
M
Mauro Carvalho Chehab 已提交
241 242 243
			set_type(c, tun_setup->type, tun_setup->mode_mask);
	}
}
244

M
Mauro Carvalho Chehab 已提交
245
static inline int check_mode(struct tuner *t, char *cmd)
246
{
247 248 249 250 251 252 253 254 255 256 257 258 259 260
	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;
261
	}
262
	return 0;
263 264
}

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

353 354 355 356 357 358 359 360 361 362 363 364
	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;
365 366 367 368 369
		case 'k':
		case 'K':
			tuner_dbg("insmod fixup: NTSC => NTSC_M_KR\n");
			t->std = V4L2_STD_NTSC_M_KR;
			break;
370 371 372 373 374 375 376 377
		case '-':
			/* default parameter, do nothing */
			break;
		default:
			tuner_info("ntsc= argument not recognised\n");
			break;
		}
	}
L
Linus Torvalds 已提交
378 379 380
	return 0;
}

381 382 383 384 385 386 387 388 389 390 391 392 393
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) {
394 395
		freq = t->radio_freq / 16000;
		freq_fraction = (t->radio_freq % 16000) * 100 / 16000;
396
	} else {
397 398
		freq = t->tv_freq / 16;
		freq_fraction = (t->tv_freq % 16) * 100 / 16;
399 400 401
	}
	tuner_info("Tuner mode:      %s\n", p);
	tuner_info("Frequency:       %lu.%02lu MHz\n", freq, freq_fraction);
402
	tuner_info("Standard:        0x%08lx\n", (unsigned long)t->std);
403 404 405 406 407 408 409
	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");
410 411
	}
}
412

L
Linus Torvalds 已提交
413 414
/* ---------------------------------------------------------------------- */

415
/* static vars: used only in tuner_attach and tuner_probe */
M
Mauro Carvalho Chehab 已提交
416 417 418 419 420
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 已提交
421 422 423 424
static int tuner_attach(struct i2c_adapter *adap, int addr, int kind)
{
	struct tuner *t;

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

P
 
Panagiotis Issaris 已提交
428
	t = kzalloc(sizeof(struct tuner), GFP_KERNEL);
M
Mauro Carvalho Chehab 已提交
429 430 431
	if (NULL == t)
		return -ENOMEM;
	memcpy(&t->i2c, &client_template, sizeof(struct i2c_client));
L
Linus Torvalds 已提交
432
	i2c_set_clientdata(&t->i2c, t);
M
Mauro Carvalho Chehab 已提交
433 434 435 436
	t->type = UNSET;
	t->radio_if2 = 10700 * 1000;	/* 10.7MHz - FM radio */
	t->audmode = V4L2_TUNER_MODE_STEREO;
	t->mode_mask = T_UNINITIALIZED;
437
	t->tuner_status = tuner_status;
M
Mauro Carvalho Chehab 已提交
438

439 440 441 442 443 444
	if (show_i2c) {
		unsigned char buffer[16];
		int i,rc;

		memset(buffer, 0, sizeof(buffer));
		rc = i2c_master_recv(&t->i2c, buffer, sizeof(buffer));
445
		tuner_info("I2C RECV = ");
446 447 448 449
		for (i=0;i<rc;i++)
			printk("%02x ",buffer[i]);
		printk("\n");
	}
450 451 452 453
	/* HACK: This test were added to avoid tuner to probe tda9840 and tea6415c on the MXB card */
	if (adap->id == I2C_HW_SAA7146 && addr < 0x4a)
		return -ENODEV;

454
	/* autodetection code based on the i2c addr */
455
	if (!no_autodetect) {
456 457 458 459
		switch (addr) {
		case 0x42:
		case 0x43:
		case 0x4a:
460
		case 0x4b:
461 462
			/* If chip is not tda8290, don't register.
			   since it can be tda9887*/
463 464 465 466 467 468 469 470
			if (tda8290_probe(&t->i2c) == 0) {
				tuner_dbg("chip at addr %x is a tda8290\n", addr);
			} else {
				/* Default is being tda9887 */
				t->type = TUNER_TDA9887;
				t->mode_mask = T_RADIO | T_ANALOG_TV | T_DIGITAL_TV;
				t->mode = T_STANDBY;
				goto register_client;
471
			}
472 473 474 475 476 477
			break;
		case 0x60:
			if (tea5767_autodetection(&t->i2c) != EINVAL) {
				t->type = TUNER_TEA5767;
				t->mode_mask = T_RADIO;
				t->mode = T_STANDBY;
478
				t->radio_freq = 87.5 * 16000; /* Sets freq to FM range */
479
				default_mode_mask &= ~T_RADIO;
480

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

M
Mauro Carvalho Chehab 已提交
487 488 489 490
	/* 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;
491 492
		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 已提交
493 494
		default_mode_mask = T_UNINITIALIZED;
	}
495

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

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

M
Mauro Carvalho Chehab 已提交
511
	default_mode_mask = T_RADIO | T_ANALOG_TV | T_DIGITAL_TV;
512

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

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

	kfree(t);
	return 0;
}

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

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

static inline int check_v4l2(struct tuner *t)
{
563 564 565 566
	/* 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 已提交
567 568
	return 0;
}
L
Linus Torvalds 已提交
569

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

574
	if (tuner_debug>1)
575 576
		v4l_i2c_print_ioctl(&(t->i2c),cmd);

M
Mauro Carvalho Chehab 已提交
577
	switch (cmd) {
L
Linus Torvalds 已提交
578
	/* --- configuration --- */
579
	case TUNER_SET_TYPE_ADDR:
M
Mauro Carvalho Chehab 已提交
580 581 582 583 584 585
		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);
586
		break;
L
Linus Torvalds 已提交
587
	case AUDC_SET_RADIO:
588 589 590 591 592
		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 已提交
593
		break;
594
	case TUNER_SET_STANDBY:
595 596
		if (check_mode(t, "TUNER_SET_STANDBY") == EINVAL)
			return 0;
597
		t->mode = T_STANDBY;
598 599 600
		if (t->standby)
			t->standby (client);
		break;
601
#ifdef CONFIG_VIDEO_V4L1
602 603 604 605 606 607 608 609
	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 已提交
610
		break;
L
Linus Torvalds 已提交
611
	case VIDIOCSCHAN:
M
Mauro Carvalho Chehab 已提交
612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631
		{
			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);
632 633
			if (t->tv_freq)
				set_tv_freq(client, t->tv_freq);
M
Mauro Carvalho Chehab 已提交
634 635
			return 0;
		}
L
Linus Torvalds 已提交
636
	case VIDIOCSFREQ:
M
Mauro Carvalho Chehab 已提交
637 638
		{
			unsigned long *v = arg;
L
Linus Torvalds 已提交
639

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

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

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

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

M
Mauro Carvalho Chehab 已提交
678 679
			return 0;
		}
L
Linus Torvalds 已提交
680
	case VIDIOCGAUDIO:
M
Mauro Carvalho Chehab 已提交
681 682 683 684 685 686 687 688 689 690 691 692 693
		{
			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;
		}
694 695 696 697
#endif
	case TDA9887_SET_CONFIG:
		if (t->type == TUNER_TDA9887) {
			int *i = arg;
L
Linus Torvalds 已提交
698

699 700 701 702 703 704 705
			t->tda9887_config = *i;
			set_freq(client, t->tv_freq);
		}
		break;
	/* --- v4l ioctls --- */
	/* take care: bttv does userspace copying, we'll get a
	   kernel pointer here... */
L
Linus Torvalds 已提交
706
	case VIDIOC_S_STD:
M
Mauro Carvalho Chehab 已提交
707 708
		{
			v4l2_std_id *id = arg;
L
Linus Torvalds 已提交
709

M
Mauro Carvalho Chehab 已提交
710 711 712
			if (set_mode (client, t, V4L2_TUNER_ANALOG_TV, "VIDIOC_S_STD")
					== EINVAL)
				return 0;
713

M
Mauro Carvalho Chehab 已提交
714 715 716 717
			switch_v4l2();

			t->std = *id;
			tuner_fixup_std(t);
718 719
			if (t->tv_freq)
				set_freq(client, t->tv_freq);
M
Mauro Carvalho Chehab 已提交
720 721
			break;
		}
L
Linus Torvalds 已提交
722
	case VIDIOC_S_FREQUENCY:
M
Mauro Carvalho Chehab 已提交
723 724 725
		{
			struct v4l2_frequency *f = arg;

726 727 728
			if (set_mode (client, t, f->type, "VIDIOC_S_FREQUENCY")
					== EINVAL)
				return 0;
M
Mauro Carvalho Chehab 已提交
729
			switch_v4l2();
730
			set_freq(client,f->frequency);
731

M
Mauro Carvalho Chehab 已提交
732 733 734 735 736 737 738 739 740 741
			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;
742 743
			f->frequency = (V4L2_TUNER_RADIO == t->mode) ?
				t->radio_freq : t->tv_freq;
M
Mauro Carvalho Chehab 已提交
744 745
			break;
		}
L
Linus Torvalds 已提交
746
	case VIDIOC_G_TUNER:
M
Mauro Carvalho Chehab 已提交
747 748 749 750 751 752 753
		{
			struct v4l2_tuner *tuner = arg;

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

754
			tuner->type = t->mode;
755 756
			if (t->get_afc)
				tuner->afc=t->get_afc(client);
757 758
			if (t->mode == V4L2_TUNER_ANALOG_TV)
				tuner->capability |= V4L2_TUNER_CAP_NORM;
759
			if (t->mode != V4L2_TUNER_RADIO) {
M
Mauro Carvalho Chehab 已提交
760 761
				tuner->rangelow = tv_range[0] * 16;
				tuner->rangehigh = tv_range[1] * 16;
762 763 764 765 766 767 768 769 770 771 772 773
				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;
774
			}
775 776 777 778 779 780

			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 已提交
781 782 783 784 785 786 787 788 789 790 791
			break;
		}
	case VIDIOC_S_TUNER:
		{
			struct v4l2_tuner *tuner = arg;

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

			switch_v4l2();

792 793 794 795 796
			/* 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 已提交
797
			break;
798
		}
799
	case VIDIOC_LOG_STATUS:
800 801
		if (t->tuner_status)
			t->tuner_status(client);
802
		break;
L
Linus Torvalds 已提交
803 804 805 806 807
	}

	return 0;
}

808
static int tuner_suspend(struct device *dev, pm_message_t state)
L
Linus Torvalds 已提交
809
{
M
Mauro Carvalho Chehab 已提交
810 811
	struct i2c_client *c = container_of (dev, struct i2c_client, dev);
	struct tuner *t = i2c_get_clientdata (c);
L
Linus Torvalds 已提交
812

M
Mauro Carvalho Chehab 已提交
813
	tuner_dbg ("suspend\n");
L
Linus Torvalds 已提交
814 815 816 817
	/* FIXME: power down ??? */
	return 0;
}

818
static int tuner_resume(struct device *dev)
L
Linus Torvalds 已提交
819
{
M
Mauro Carvalho Chehab 已提交
820 821
	struct i2c_client *c = container_of (dev, struct i2c_client, dev);
	struct tuner *t = i2c_get_clientdata (c);
L
Linus Torvalds 已提交
822

M
Mauro Carvalho Chehab 已提交
823
	tuner_dbg ("resume\n");
824 825 826 827 828 829 830
	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 已提交
831 832 833 834 835 836
	return 0;
}

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

static struct i2c_driver driver = {
M
Mauro Carvalho Chehab 已提交
837 838 839 840
	.id = I2C_DRIVERID_TUNER,
	.attach_adapter = tuner_probe,
	.detach_client = tuner_detach,
	.command = tuner_command,
L
Linus Torvalds 已提交
841
	.driver = {
842 843 844 845
		.name    = "tuner",
		.suspend = tuner_suspend,
		.resume  = tuner_resume,
	},
L
Linus Torvalds 已提交
846
};
M
Mauro Carvalho Chehab 已提交
847
static struct i2c_client client_template = {
848
	.name = "(tuner unset)",
M
Mauro Carvalho Chehab 已提交
849
	.driver = &driver,
L
Linus Torvalds 已提交
850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871
};

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