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

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

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

L
Linus Torvalds 已提交
409 410
/* ---------------------------------------------------------------------- */

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

M
Mauro Carvalho Chehab 已提交
421 422
	client_template.adapter = adap;
	client_template.addr = addr;
L
Linus Torvalds 已提交
423

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

435 436 437 438 439 440
	if (show_i2c) {
		unsigned char buffer[16];
		int i,rc;

		memset(buffer, 0, sizeof(buffer));
		rc = i2c_master_recv(&t->i2c, buffer, sizeof(buffer));
441
		tuner_info("I2C RECV = ");
442 443 444 445
		for (i=0;i<rc;i++)
			printk("%02x ",buffer[i]);
		printk("\n");
	}
446 447 448 449
	/* 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;

450
	/* autodetection code based on the i2c addr */
451
	if (!no_autodetect) {
452 453 454 455
		switch (addr) {
		case 0x42:
		case 0x43:
		case 0x4a:
456
		case 0x4b:
457 458
			/* If chip is not tda8290, don't register.
			   since it can be tda9887*/
459 460 461 462 463 464 465 466
			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;
467
			}
468 469 470 471 472 473
			break;
		case 0x60:
			if (tea5767_autodetection(&t->i2c) != EINVAL) {
				t->type = TUNER_TEA5767;
				t->mode_mask = T_RADIO;
				t->mode = T_STANDBY;
474
				t->radio_freq = 87.5 * 16000; /* Sets freq to FM range */
475
				default_mode_mask &= ~T_RADIO;
476

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

M
Mauro Carvalho Chehab 已提交
483 484 485 486
	/* 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;
487 488
		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 已提交
489 490
		default_mode_mask = T_UNINITIALIZED;
	}
491

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

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

M
Mauro Carvalho Chehab 已提交
507
	default_mode_mask = T_RADIO | T_ANALOG_TV | T_DIGITAL_TV;
508

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

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

	kfree(t);
	return 0;
}

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

#define switch_v4l2()	if (!t->using_v4l2) \
554 555
			    tuner_dbg("switching to v4l2\n"); \
			t->using_v4l2 = 1;
M
Mauro Carvalho Chehab 已提交
556 557 558

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

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

570
	if (tuner_debug>1)
571 572
		v4l_i2c_print_ioctl(&(t->i2c),cmd);

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

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

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

M
Mauro Carvalho Chehab 已提交
666 667
				vt->rangelow = radio_range[0] * 16000;
				vt->rangehigh = radio_range[1] * 16000;
668

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

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

695 696 697 698 699 700 701
			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 已提交
702
	case VIDIOC_S_STD:
M
Mauro Carvalho Chehab 已提交
703 704
		{
			v4l2_std_id *id = arg;
L
Linus Torvalds 已提交
705

M
Mauro Carvalho Chehab 已提交
706 707 708
			if (set_mode (client, t, V4L2_TUNER_ANALOG_TV, "VIDIOC_S_STD")
					== EINVAL)
				return 0;
709

M
Mauro Carvalho Chehab 已提交
710 711 712 713
			switch_v4l2();

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

722 723 724
			if (set_mode (client, t, f->type, "VIDIOC_S_FREQUENCY")
					== EINVAL)
				return 0;
M
Mauro Carvalho Chehab 已提交
725
			switch_v4l2();
726
			set_freq(client,f->frequency);
727

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

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

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

			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 已提交
777 778 779 780 781 782 783 784 785 786 787
			break;
		}
	case VIDIOC_S_TUNER:
		{
			struct v4l2_tuner *tuner = arg;

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

			switch_v4l2();

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

	return 0;
}

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

M
Mauro Carvalho Chehab 已提交
809
	tuner_dbg ("suspend\n");
L
Linus Torvalds 已提交
810 811 812 813
	/* FIXME: power down ??? */
	return 0;
}

814
static int tuner_resume(struct device *dev)
L
Linus Torvalds 已提交
815
{
M
Mauro Carvalho Chehab 已提交
816 817
	struct i2c_client *c = container_of (dev, struct i2c_client, dev);
	struct tuner *t = i2c_get_clientdata (c);
L
Linus Torvalds 已提交
818

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

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

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

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