xref: /openbmc/linux/drivers/media/i2c/tvaudio.c (revision e2c75e76)
1 /*
2  * Driver for simple i2c audio chips.
3  *
4  * Copyright (c) 2000 Gerd Knorr
5  * based on code by:
6  *   Eric Sandeen (eric_sandeen@bigfoot.com)
7  *   Steve VanDeBogart (vandebo@uclink.berkeley.edu)
8  *   Greg Alexander (galexand@acm.org)
9  *
10  * For the TDA9875 part:
11  * Copyright (c) 2000 Guillaume Delvit based on Gerd Knorr source
12  * and Eric Sandeen
13  *
14  * Copyright(c) 2005-2008 Mauro Carvalho Chehab
15  *	- Some cleanups, code fixes, etc
16  *	- Convert it to V4L2 API
17  *
18  * This code is placed under the terms of the GNU General Public License
19  *
20  * OPTIONS:
21  *   debug - set to 1 if you'd like to see debug messages
22  *
23  */
24 
25 #include <linux/module.h>
26 #include <linux/kernel.h>
27 #include <linux/sched.h>
28 #include <linux/string.h>
29 #include <linux/timer.h>
30 #include <linux/delay.h>
31 #include <linux/errno.h>
32 #include <linux/slab.h>
33 #include <linux/videodev2.h>
34 #include <linux/i2c.h>
35 #include <linux/init.h>
36 #include <linux/kthread.h>
37 #include <linux/freezer.h>
38 
39 #include <media/i2c/tvaudio.h>
40 #include <media/v4l2-device.h>
41 #include <media/v4l2-ctrls.h>
42 
43 /* ---------------------------------------------------------------------- */
44 /* insmod args                                                            */
45 
46 static int debug;	/* insmod parameter */
47 module_param(debug, int, 0644);
48 
49 MODULE_DESCRIPTION("device driver for various i2c TV sound decoder / audiomux chips");
50 MODULE_AUTHOR("Eric Sandeen, Steve VanDeBogart, Greg Alexander, Gerd Knorr");
51 MODULE_LICENSE("GPL");
52 
53 #define UNSET    (-1U)
54 
55 /* ---------------------------------------------------------------------- */
56 /* our structs                                                            */
57 
58 #define MAXREGS 256
59 
60 struct CHIPSTATE;
61 typedef int  (*getvalue)(int);
62 typedef int  (*checkit)(struct CHIPSTATE*);
63 typedef int  (*initialize)(struct CHIPSTATE*);
64 typedef int  (*getrxsubchans)(struct CHIPSTATE *);
65 typedef void (*setaudmode)(struct CHIPSTATE*, int mode);
66 
67 /* i2c command */
68 typedef struct AUDIOCMD {
69 	int             count;             /* # of bytes to send */
70 	unsigned char   bytes[MAXREGS+1];  /* addr, data, data, ... */
71 } audiocmd;
72 
73 /* chip description */
74 struct CHIPDESC {
75 	char       *name;             /* chip name         */
76 	int        addr_lo, addr_hi;  /* i2c address range */
77 	int        registers;         /* # of registers    */
78 
79 	int        *insmodopt;
80 	checkit    checkit;
81 	initialize initialize;
82 	int        flags;
83 #define CHIP_HAS_VOLUME      1
84 #define CHIP_HAS_BASSTREBLE  2
85 #define CHIP_HAS_INPUTSEL    4
86 #define CHIP_NEED_CHECKMODE  8
87 
88 	/* various i2c command sequences */
89 	audiocmd   init;
90 
91 	/* which register has which value */
92 	int    leftreg, rightreg, treblereg, bassreg;
93 
94 	/* initialize with (defaults to 65535/32768/32768 */
95 	int    volinit, trebleinit, bassinit;
96 
97 	/* functions to convert the values (v4l -> chip) */
98 	getvalue volfunc, treblefunc, bassfunc;
99 
100 	/* get/set mode */
101 	getrxsubchans	getrxsubchans;
102 	setaudmode	setaudmode;
103 
104 	/* input switch register + values for v4l inputs */
105 	int  inputreg;
106 	int  inputmap[4];
107 	int  inputmute;
108 	int  inputmask;
109 };
110 
111 /* current state of the chip */
112 struct CHIPSTATE {
113 	struct v4l2_subdev sd;
114 	struct v4l2_ctrl_handler hdl;
115 	struct {
116 		/* volume/balance cluster */
117 		struct v4l2_ctrl *volume;
118 		struct v4l2_ctrl *balance;
119 	};
120 
121 	/* chip-specific description - should point to
122 	   an entry at CHIPDESC table */
123 	struct CHIPDESC *desc;
124 
125 	/* shadow register set */
126 	audiocmd   shadow;
127 
128 	/* current settings */
129 	u16 muted;
130 	int prevmode;
131 	int radio;
132 	int input;
133 
134 	/* thread */
135 	struct task_struct   *thread;
136 	struct timer_list    wt;
137 	int		     audmode;
138 };
139 
140 static inline struct CHIPSTATE *to_state(struct v4l2_subdev *sd)
141 {
142 	return container_of(sd, struct CHIPSTATE, sd);
143 }
144 
145 static inline struct v4l2_subdev *to_sd(struct v4l2_ctrl *ctrl)
146 {
147 	return &container_of(ctrl->handler, struct CHIPSTATE, hdl)->sd;
148 }
149 
150 
151 /* ---------------------------------------------------------------------- */
152 /* i2c I/O functions                                                      */
153 
154 static int chip_write(struct CHIPSTATE *chip, int subaddr, int val)
155 {
156 	struct v4l2_subdev *sd = &chip->sd;
157 	struct i2c_client *c = v4l2_get_subdevdata(sd);
158 	unsigned char buffer[2];
159 
160 	if (subaddr < 0) {
161 		v4l2_dbg(1, debug, sd, "chip_write: 0x%x\n", val);
162 		chip->shadow.bytes[1] = val;
163 		buffer[0] = val;
164 		if (1 != i2c_master_send(c, buffer, 1)) {
165 			v4l2_warn(sd, "I/O error (write 0x%x)\n", val);
166 			return -1;
167 		}
168 	} else {
169 		if (subaddr + 1 >= ARRAY_SIZE(chip->shadow.bytes)) {
170 			v4l2_info(sd,
171 				"Tried to access a non-existent register: %d\n",
172 				subaddr);
173 			return -EINVAL;
174 		}
175 
176 		v4l2_dbg(1, debug, sd, "chip_write: reg%d=0x%x\n",
177 			subaddr, val);
178 		chip->shadow.bytes[subaddr+1] = val;
179 		buffer[0] = subaddr;
180 		buffer[1] = val;
181 		if (2 != i2c_master_send(c, buffer, 2)) {
182 			v4l2_warn(sd, "I/O error (write reg%d=0x%x)\n",
183 				subaddr, val);
184 			return -1;
185 		}
186 	}
187 	return 0;
188 }
189 
190 static int chip_write_masked(struct CHIPSTATE *chip,
191 			     int subaddr, int val, int mask)
192 {
193 	struct v4l2_subdev *sd = &chip->sd;
194 
195 	if (mask != 0) {
196 		if (subaddr < 0) {
197 			val = (chip->shadow.bytes[1] & ~mask) | (val & mask);
198 		} else {
199 			if (subaddr + 1 >= ARRAY_SIZE(chip->shadow.bytes)) {
200 				v4l2_info(sd,
201 					"Tried to access a non-existent register: %d\n",
202 					subaddr);
203 				return -EINVAL;
204 			}
205 
206 			val = (chip->shadow.bytes[subaddr+1] & ~mask) | (val & mask);
207 		}
208 	}
209 	return chip_write(chip, subaddr, val);
210 }
211 
212 static int chip_read(struct CHIPSTATE *chip)
213 {
214 	struct v4l2_subdev *sd = &chip->sd;
215 	struct i2c_client *c = v4l2_get_subdevdata(sd);
216 	unsigned char buffer;
217 
218 	if (1 != i2c_master_recv(c, &buffer, 1)) {
219 		v4l2_warn(sd, "I/O error (read)\n");
220 		return -1;
221 	}
222 	v4l2_dbg(1, debug, sd, "chip_read: 0x%x\n", buffer);
223 	return buffer;
224 }
225 
226 static int chip_read2(struct CHIPSTATE *chip, int subaddr)
227 {
228 	struct v4l2_subdev *sd = &chip->sd;
229 	struct i2c_client *c = v4l2_get_subdevdata(sd);
230 	unsigned char write[1];
231 	unsigned char read[1];
232 	struct i2c_msg msgs[2] = {
233 		{
234 			.addr = c->addr,
235 			.len = 1,
236 			.buf = write
237 		},
238 		{
239 			.addr = c->addr,
240 			.flags = I2C_M_RD,
241 			.len = 1,
242 			.buf = read
243 		}
244 	};
245 
246 	write[0] = subaddr;
247 
248 	if (2 != i2c_transfer(c->adapter, msgs, 2)) {
249 		v4l2_warn(sd, "I/O error (read2)\n");
250 		return -1;
251 	}
252 	v4l2_dbg(1, debug, sd, "chip_read2: reg%d=0x%x\n",
253 		subaddr, read[0]);
254 	return read[0];
255 }
256 
257 static int chip_cmd(struct CHIPSTATE *chip, char *name, audiocmd *cmd)
258 {
259 	struct v4l2_subdev *sd = &chip->sd;
260 	struct i2c_client *c = v4l2_get_subdevdata(sd);
261 	int i;
262 
263 	if (0 == cmd->count)
264 		return 0;
265 
266 	if (cmd->count + cmd->bytes[0] - 1 >= ARRAY_SIZE(chip->shadow.bytes)) {
267 		v4l2_info(sd,
268 			 "Tried to access a non-existent register range: %d to %d\n",
269 			 cmd->bytes[0] + 1, cmd->bytes[0] + cmd->count - 1);
270 		return -EINVAL;
271 	}
272 
273 	/* FIXME: it seems that the shadow bytes are wrong below !*/
274 
275 	/* update our shadow register set; print bytes if (debug > 0) */
276 	v4l2_dbg(1, debug, sd, "chip_cmd(%s): reg=%d, data:",
277 		name, cmd->bytes[0]);
278 	for (i = 1; i < cmd->count; i++) {
279 		if (debug)
280 			printk(KERN_CONT " 0x%x", cmd->bytes[i]);
281 		chip->shadow.bytes[i+cmd->bytes[0]] = cmd->bytes[i];
282 	}
283 	if (debug)
284 		printk(KERN_CONT "\n");
285 
286 	/* send data to the chip */
287 	if (cmd->count != i2c_master_send(c, cmd->bytes, cmd->count)) {
288 		v4l2_warn(sd, "I/O error (%s)\n", name);
289 		return -1;
290 	}
291 	return 0;
292 }
293 
294 /* ---------------------------------------------------------------------- */
295 /* kernel thread for doing i2c stuff asyncronly
296  *   right now it is used only to check the audio mode (mono/stereo/whatever)
297  *   some time after switching to another TV channel, then turn on stereo
298  *   if available, ...
299  */
300 
301 static void chip_thread_wake(struct timer_list *t)
302 {
303 	struct CHIPSTATE *chip = from_timer(chip, t, wt);
304 	wake_up_process(chip->thread);
305 }
306 
307 static int chip_thread(void *data)
308 {
309 	struct CHIPSTATE *chip = data;
310 	struct CHIPDESC  *desc = chip->desc;
311 	struct v4l2_subdev *sd = &chip->sd;
312 	int mode, selected;
313 
314 	v4l2_dbg(1, debug, sd, "thread started\n");
315 	set_freezable();
316 	for (;;) {
317 		set_current_state(TASK_INTERRUPTIBLE);
318 		if (!kthread_should_stop())
319 			schedule();
320 		set_current_state(TASK_RUNNING);
321 		try_to_freeze();
322 		if (kthread_should_stop())
323 			break;
324 		v4l2_dbg(1, debug, sd, "thread wakeup\n");
325 
326 		/* don't do anything for radio */
327 		if (chip->radio)
328 			continue;
329 
330 		/* have a look what's going on */
331 		mode = desc->getrxsubchans(chip);
332 		if (mode == chip->prevmode)
333 			continue;
334 
335 		/* chip detected a new audio mode - set it */
336 		v4l2_dbg(1, debug, sd, "thread checkmode\n");
337 
338 		chip->prevmode = mode;
339 
340 		selected = V4L2_TUNER_MODE_MONO;
341 		switch (chip->audmode) {
342 		case V4L2_TUNER_MODE_MONO:
343 			if (mode & V4L2_TUNER_SUB_LANG1)
344 				selected = V4L2_TUNER_MODE_LANG1;
345 			break;
346 		case V4L2_TUNER_MODE_STEREO:
347 		case V4L2_TUNER_MODE_LANG1:
348 			if (mode & V4L2_TUNER_SUB_LANG1)
349 				selected = V4L2_TUNER_MODE_LANG1;
350 			else if (mode & V4L2_TUNER_SUB_STEREO)
351 				selected = V4L2_TUNER_MODE_STEREO;
352 			break;
353 		case V4L2_TUNER_MODE_LANG2:
354 			if (mode & V4L2_TUNER_SUB_LANG2)
355 				selected = V4L2_TUNER_MODE_LANG2;
356 			else if (mode & V4L2_TUNER_SUB_STEREO)
357 				selected = V4L2_TUNER_MODE_STEREO;
358 			break;
359 		case V4L2_TUNER_MODE_LANG1_LANG2:
360 			if (mode & V4L2_TUNER_SUB_LANG2)
361 				selected = V4L2_TUNER_MODE_LANG1_LANG2;
362 			else if (mode & V4L2_TUNER_SUB_STEREO)
363 				selected = V4L2_TUNER_MODE_STEREO;
364 		}
365 		desc->setaudmode(chip, selected);
366 
367 		/* schedule next check */
368 		mod_timer(&chip->wt, jiffies+msecs_to_jiffies(2000));
369 	}
370 
371 	v4l2_dbg(1, debug, sd, "thread exiting\n");
372 	return 0;
373 }
374 
375 /* ---------------------------------------------------------------------- */
376 /* audio chip descriptions - defines+functions for tda9840                */
377 
378 #define TDA9840_SW         0x00
379 #define TDA9840_LVADJ      0x02
380 #define TDA9840_STADJ      0x03
381 #define TDA9840_TEST       0x04
382 
383 #define TDA9840_MONO       0x10
384 #define TDA9840_STEREO     0x2a
385 #define TDA9840_DUALA      0x12
386 #define TDA9840_DUALB      0x1e
387 #define TDA9840_DUALAB     0x1a
388 #define TDA9840_DUALBA     0x16
389 #define TDA9840_EXTERNAL   0x7a
390 
391 #define TDA9840_DS_DUAL    0x20 /* Dual sound identified          */
392 #define TDA9840_ST_STEREO  0x40 /* Stereo sound identified        */
393 #define TDA9840_PONRES     0x80 /* Power-on reset detected if = 1 */
394 
395 #define TDA9840_TEST_INT1SN 0x1 /* Integration time 0.5s when set */
396 #define TDA9840_TEST_INTFU 0x02 /* Disables integrator function */
397 
398 static int tda9840_getrxsubchans(struct CHIPSTATE *chip)
399 {
400 	struct v4l2_subdev *sd = &chip->sd;
401 	int val, mode;
402 
403 	val = chip_read(chip);
404 	mode = V4L2_TUNER_SUB_MONO;
405 	if (val & TDA9840_DS_DUAL)
406 		mode |= V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
407 	if (val & TDA9840_ST_STEREO)
408 		mode = V4L2_TUNER_SUB_STEREO;
409 
410 	v4l2_dbg(1, debug, sd,
411 		"tda9840_getrxsubchans(): raw chip read: %d, return: %d\n",
412 		val, mode);
413 	return mode;
414 }
415 
416 static void tda9840_setaudmode(struct CHIPSTATE *chip, int mode)
417 {
418 	int update = 1;
419 	int t = chip->shadow.bytes[TDA9840_SW + 1] & ~0x7e;
420 
421 	switch (mode) {
422 	case V4L2_TUNER_MODE_MONO:
423 		t |= TDA9840_MONO;
424 		break;
425 	case V4L2_TUNER_MODE_STEREO:
426 		t |= TDA9840_STEREO;
427 		break;
428 	case V4L2_TUNER_MODE_LANG1:
429 		t |= TDA9840_DUALA;
430 		break;
431 	case V4L2_TUNER_MODE_LANG2:
432 		t |= TDA9840_DUALB;
433 		break;
434 	case V4L2_TUNER_MODE_LANG1_LANG2:
435 		t |= TDA9840_DUALAB;
436 		break;
437 	default:
438 		update = 0;
439 	}
440 
441 	if (update)
442 		chip_write(chip, TDA9840_SW, t);
443 }
444 
445 static int tda9840_checkit(struct CHIPSTATE *chip)
446 {
447 	int rc;
448 	rc = chip_read(chip);
449 	/* lower 5 bits should be 0 */
450 	return ((rc & 0x1f) == 0) ? 1 : 0;
451 }
452 
453 /* ---------------------------------------------------------------------- */
454 /* audio chip descriptions - defines+functions for tda985x                */
455 
456 /* subaddresses for TDA9855 */
457 #define TDA9855_VR	0x00 /* Volume, right */
458 #define TDA9855_VL	0x01 /* Volume, left */
459 #define TDA9855_BA	0x02 /* Bass */
460 #define TDA9855_TR	0x03 /* Treble */
461 #define TDA9855_SW	0x04 /* Subwoofer - not connected on DTV2000 */
462 
463 /* subaddresses for TDA9850 */
464 #define TDA9850_C4	0x04 /* Control 1 for TDA9850 */
465 
466 /* subaddesses for both chips */
467 #define TDA985x_C5	0x05 /* Control 2 for TDA9850, Control 1 for TDA9855 */
468 #define TDA985x_C6	0x06 /* Control 3 for TDA9850, Control 2 for TDA9855 */
469 #define TDA985x_C7	0x07 /* Control 4 for TDA9850, Control 3 for TDA9855 */
470 #define TDA985x_A1	0x08 /* Alignment 1 for both chips */
471 #define TDA985x_A2	0x09 /* Alignment 2 for both chips */
472 #define TDA985x_A3	0x0a /* Alignment 3 for both chips */
473 
474 /* Masks for bits in TDA9855 subaddresses */
475 /* 0x00 - VR in TDA9855 */
476 /* 0x01 - VL in TDA9855 */
477 /* lower 7 bits control gain from -71dB (0x28) to 16dB (0x7f)
478  * in 1dB steps - mute is 0x27 */
479 
480 
481 /* 0x02 - BA in TDA9855 */
482 /* lower 5 bits control bass gain from -12dB (0x06) to 16.5dB (0x19)
483  * in .5dB steps - 0 is 0x0E */
484 
485 
486 /* 0x03 - TR in TDA9855 */
487 /* 4 bits << 1 control treble gain from -12dB (0x3) to 12dB (0xb)
488  * in 3dB steps - 0 is 0x7 */
489 
490 /* Masks for bits in both chips' subaddresses */
491 /* 0x04 - SW in TDA9855, C4/Control 1 in TDA9850 */
492 /* Unique to TDA9855: */
493 /* 4 bits << 2 control subwoofer/surround gain from -14db (0x1) to 14db (0xf)
494  * in 3dB steps - mute is 0x0 */
495 
496 /* Unique to TDA9850: */
497 /* lower 4 bits control stereo noise threshold, over which stereo turns off
498  * set to values of 0x00 through 0x0f for Ster1 through Ster16 */
499 
500 
501 /* 0x05 - C5 - Control 1 in TDA9855 , Control 2 in TDA9850*/
502 /* Unique to TDA9855: */
503 #define TDA9855_MUTE	1<<7 /* GMU, Mute at outputs */
504 #define TDA9855_AVL	1<<6 /* AVL, Automatic Volume Level */
505 #define TDA9855_LOUD	1<<5 /* Loudness, 1==off */
506 #define TDA9855_SUR	1<<3 /* Surround / Subwoofer 1==.5(L-R) 0==.5(L+R) */
507 			     /* Bits 0 to 3 select various combinations
508 			      * of line in and line out, only the
509 			      * interesting ones are defined */
510 #define TDA9855_EXT	1<<2 /* Selects inputs LIR and LIL.  Pins 41 & 12 */
511 #define TDA9855_INT	0    /* Selects inputs LOR and LOL.  (internal) */
512 
513 /* Unique to TDA9850:  */
514 /* lower 4 bits contol SAP noise threshold, over which SAP turns off
515  * set to values of 0x00 through 0x0f for SAP1 through SAP16 */
516 
517 
518 /* 0x06 - C6 - Control 2 in TDA9855, Control 3 in TDA9850 */
519 /* Common to TDA9855 and TDA9850: */
520 #define TDA985x_SAP	3<<6 /* Selects SAP output, mute if not received */
521 #define TDA985x_MONOSAP	2<<6 /* Selects Mono on left, SAP on right */
522 #define TDA985x_STEREO	1<<6 /* Selects Stereo ouput, mono if not received */
523 #define TDA985x_MONO	0    /* Forces Mono output */
524 #define TDA985x_LMU	1<<3 /* Mute (LOR/LOL for 9855, OUTL/OUTR for 9850) */
525 
526 /* Unique to TDA9855: */
527 #define TDA9855_TZCM	1<<5 /* If set, don't mute till zero crossing */
528 #define TDA9855_VZCM	1<<4 /* If set, don't change volume till zero crossing*/
529 #define TDA9855_LINEAR	0    /* Linear Stereo */
530 #define TDA9855_PSEUDO	1    /* Pseudo Stereo */
531 #define TDA9855_SPAT_30	2    /* Spatial Stereo, 30% anti-phase crosstalk */
532 #define TDA9855_SPAT_50	3    /* Spatial Stereo, 52% anti-phase crosstalk */
533 #define TDA9855_E_MONO	7    /* Forced mono - mono select elseware, so useless*/
534 
535 /* 0x07 - C7 - Control 3 in TDA9855, Control 4 in TDA9850 */
536 /* Common to both TDA9855 and TDA9850: */
537 /* lower 4 bits control input gain from -3.5dB (0x0) to 4dB (0xF)
538  * in .5dB steps -  0dB is 0x7 */
539 
540 /* 0x08, 0x09 - A1 and A2 (read/write) */
541 /* Common to both TDA9855 and TDA9850: */
542 /* lower 5 bites are wideband and spectral expander alignment
543  * from 0x00 to 0x1f - nominal at 0x0f and 0x10 (read/write) */
544 #define TDA985x_STP	1<<5 /* Stereo Pilot/detect (read-only) */
545 #define TDA985x_SAPP	1<<6 /* SAP Pilot/detect (read-only) */
546 #define TDA985x_STS	1<<7 /* Stereo trigger 1= <35mV 0= <30mV (write-only)*/
547 
548 /* 0x0a - A3 */
549 /* Common to both TDA9855 and TDA9850: */
550 /* lower 3 bits control timing current for alignment: -30% (0x0), -20% (0x1),
551  * -10% (0x2), nominal (0x3), +10% (0x6), +20% (0x5), +30% (0x4) */
552 #define TDA985x_ADJ	1<<7 /* Stereo adjust on/off (wideband and spectral */
553 
554 static int tda9855_volume(int val) { return val/0x2e8+0x27; }
555 static int tda9855_bass(int val)   { return val/0xccc+0x06; }
556 static int tda9855_treble(int val) { return (val/0x1c71+0x3)<<1; }
557 
558 static int  tda985x_getrxsubchans(struct CHIPSTATE *chip)
559 {
560 	int mode, val;
561 
562 	/* Add mono mode regardless of SAP and stereo */
563 	/* Allows forced mono */
564 	mode = V4L2_TUNER_SUB_MONO;
565 	val = chip_read(chip);
566 	if (val & TDA985x_STP)
567 		mode = V4L2_TUNER_SUB_STEREO;
568 	if (val & TDA985x_SAPP)
569 		mode |= V4L2_TUNER_SUB_SAP;
570 	return mode;
571 }
572 
573 static void tda985x_setaudmode(struct CHIPSTATE *chip, int mode)
574 {
575 	int update = 1;
576 	int c6 = chip->shadow.bytes[TDA985x_C6+1] & 0x3f;
577 
578 	switch (mode) {
579 	case V4L2_TUNER_MODE_MONO:
580 		c6 |= TDA985x_MONO;
581 		break;
582 	case V4L2_TUNER_MODE_STEREO:
583 	case V4L2_TUNER_MODE_LANG1:
584 		c6 |= TDA985x_STEREO;
585 		break;
586 	case V4L2_TUNER_MODE_SAP:
587 		c6 |= TDA985x_SAP;
588 		break;
589 	case V4L2_TUNER_MODE_LANG1_LANG2:
590 		c6 |= TDA985x_MONOSAP;
591 		break;
592 	default:
593 		update = 0;
594 	}
595 	if (update)
596 		chip_write(chip,TDA985x_C6,c6);
597 }
598 
599 
600 /* ---------------------------------------------------------------------- */
601 /* audio chip descriptions - defines+functions for tda9873h               */
602 
603 /* Subaddresses for TDA9873H */
604 
605 #define TDA9873_SW	0x00 /* Switching                    */
606 #define TDA9873_AD	0x01 /* Adjust                       */
607 #define TDA9873_PT	0x02 /* Port                         */
608 
609 /* Subaddress 0x00: Switching Data
610  * B7..B0:
611  *
612  * B1, B0: Input source selection
613  *  0,  0  internal
614  *  1,  0  external stereo
615  *  0,  1  external mono
616  */
617 #define TDA9873_INP_MASK    3
618 #define TDA9873_INTERNAL    0
619 #define TDA9873_EXT_STEREO  2
620 #define TDA9873_EXT_MONO    1
621 
622 /*    B3, B2: output signal select
623  * B4    : transmission mode
624  *  0, 0, 1   Mono
625  *  1, 0, 0   Stereo
626  *  1, 1, 1   Stereo (reversed channel)
627  *  0, 0, 0   Dual AB
628  *  0, 0, 1   Dual AA
629  *  0, 1, 0   Dual BB
630  *  0, 1, 1   Dual BA
631  */
632 
633 #define TDA9873_TR_MASK     (7 << 2)
634 #define TDA9873_TR_MONO     4
635 #define TDA9873_TR_STEREO   1 << 4
636 #define TDA9873_TR_REVERSE  ((1 << 3) | (1 << 2))
637 #define TDA9873_TR_DUALA    1 << 2
638 #define TDA9873_TR_DUALB    1 << 3
639 #define TDA9873_TR_DUALAB   0
640 
641 /* output level controls
642  * B5:  output level switch (0 = reduced gain, 1 = normal gain)
643  * B6:  mute                (1 = muted)
644  * B7:  auto-mute           (1 = auto-mute enabled)
645  */
646 
647 #define TDA9873_GAIN_NORMAL 1 << 5
648 #define TDA9873_MUTE        1 << 6
649 #define TDA9873_AUTOMUTE    1 << 7
650 
651 /* Subaddress 0x01:  Adjust/standard */
652 
653 /* Lower 4 bits (C3..C0) control stereo adjustment on R channel (-0.6 - +0.7 dB)
654  * Recommended value is +0 dB
655  */
656 
657 #define	TDA9873_STEREO_ADJ	0x06 /* 0dB gain */
658 
659 /* Bits C6..C4 control FM stantard
660  * C6, C5, C4
661  *  0,  0,  0   B/G (PAL FM)
662  *  0,  0,  1   M
663  *  0,  1,  0   D/K(1)
664  *  0,  1,  1   D/K(2)
665  *  1,  0,  0   D/K(3)
666  *  1,  0,  1   I
667  */
668 #define TDA9873_BG		0
669 #define TDA9873_M       1
670 #define TDA9873_DK1     2
671 #define TDA9873_DK2     3
672 #define TDA9873_DK3     4
673 #define TDA9873_I       5
674 
675 /* C7 controls identification response time (1=fast/0=normal)
676  */
677 #define TDA9873_IDR_NORM 0
678 #define TDA9873_IDR_FAST 1 << 7
679 
680 
681 /* Subaddress 0x02: Port data */
682 
683 /* E1, E0   free programmable ports P1/P2
684     0,  0   both ports low
685     0,  1   P1 high
686     1,  0   P2 high
687     1,  1   both ports high
688 */
689 
690 #define TDA9873_PORTS    3
691 
692 /* E2: test port */
693 #define TDA9873_TST_PORT 1 << 2
694 
695 /* E5..E3 control mono output channel (together with transmission mode bit B4)
696  *
697  * E5 E4 E3 B4     OUTM
698  *  0  0  0  0     mono
699  *  0  0  1  0     DUAL B
700  *  0  1  0  1     mono (from stereo decoder)
701  */
702 #define TDA9873_MOUT_MONO   0
703 #define TDA9873_MOUT_FMONO  0
704 #define TDA9873_MOUT_DUALA  0
705 #define TDA9873_MOUT_DUALB  1 << 3
706 #define TDA9873_MOUT_ST     1 << 4
707 #define TDA9873_MOUT_EXTM   ((1 << 4) | (1 << 3))
708 #define TDA9873_MOUT_EXTL   1 << 5
709 #define TDA9873_MOUT_EXTR   ((1 << 5) | (1 << 3))
710 #define TDA9873_MOUT_EXTLR  ((1 << 5) | (1 << 4))
711 #define TDA9873_MOUT_MUTE   ((1 << 5) | (1 << 4) | (1 << 3))
712 
713 /* Status bits: (chip read) */
714 #define TDA9873_PONR        0 /* Power-on reset detected if = 1 */
715 #define TDA9873_STEREO      2 /* Stereo sound is identified     */
716 #define TDA9873_DUAL        4 /* Dual sound is identified       */
717 
718 static int tda9873_getrxsubchans(struct CHIPSTATE *chip)
719 {
720 	struct v4l2_subdev *sd = &chip->sd;
721 	int val,mode;
722 
723 	val = chip_read(chip);
724 	mode = V4L2_TUNER_SUB_MONO;
725 	if (val & TDA9873_STEREO)
726 		mode = V4L2_TUNER_SUB_STEREO;
727 	if (val & TDA9873_DUAL)
728 		mode |= V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
729 	v4l2_dbg(1, debug, sd,
730 		"tda9873_getrxsubchans(): raw chip read: %d, return: %d\n",
731 		val, mode);
732 	return mode;
733 }
734 
735 static void tda9873_setaudmode(struct CHIPSTATE *chip, int mode)
736 {
737 	struct v4l2_subdev *sd = &chip->sd;
738 	int sw_data  = chip->shadow.bytes[TDA9873_SW+1] & ~ TDA9873_TR_MASK;
739 	/*	int adj_data = chip->shadow.bytes[TDA9873_AD+1] ; */
740 
741 	if ((sw_data & TDA9873_INP_MASK) != TDA9873_INTERNAL) {
742 		v4l2_dbg(1, debug, sd,
743 			 "tda9873_setaudmode(): external input\n");
744 		return;
745 	}
746 
747 	v4l2_dbg(1, debug, sd,
748 		 "tda9873_setaudmode(): chip->shadow.bytes[%d] = %d\n",
749 		 TDA9873_SW+1, chip->shadow.bytes[TDA9873_SW+1]);
750 	v4l2_dbg(1, debug, sd, "tda9873_setaudmode(): sw_data  = %d\n",
751 		 sw_data);
752 
753 	switch (mode) {
754 	case V4L2_TUNER_MODE_MONO:
755 		sw_data |= TDA9873_TR_MONO;
756 		break;
757 	case V4L2_TUNER_MODE_STEREO:
758 		sw_data |= TDA9873_TR_STEREO;
759 		break;
760 	case V4L2_TUNER_MODE_LANG1:
761 		sw_data |= TDA9873_TR_DUALA;
762 		break;
763 	case V4L2_TUNER_MODE_LANG2:
764 		sw_data |= TDA9873_TR_DUALB;
765 		break;
766 	case V4L2_TUNER_MODE_LANG1_LANG2:
767 		sw_data |= TDA9873_TR_DUALAB;
768 		break;
769 	default:
770 		return;
771 	}
772 
773 	chip_write(chip, TDA9873_SW, sw_data);
774 	v4l2_dbg(1, debug, sd,
775 		"tda9873_setaudmode(): req. mode %d; chip_write: %d\n",
776 		mode, sw_data);
777 }
778 
779 static int tda9873_checkit(struct CHIPSTATE *chip)
780 {
781 	int rc;
782 
783 	if (-1 == (rc = chip_read2(chip,254)))
784 		return 0;
785 	return (rc & ~0x1f) == 0x80;
786 }
787 
788 
789 /* ---------------------------------------------------------------------- */
790 /* audio chip description - defines+functions for tda9874h and tda9874a   */
791 /* Dariusz Kowalewski <darekk@automex.pl>                                 */
792 
793 /* Subaddresses for TDA9874H and TDA9874A (slave rx) */
794 #define TDA9874A_AGCGR		0x00	/* AGC gain */
795 #define TDA9874A_GCONR		0x01	/* general config */
796 #define TDA9874A_MSR		0x02	/* monitor select */
797 #define TDA9874A_C1FRA		0x03	/* carrier 1 freq. */
798 #define TDA9874A_C1FRB		0x04	/* carrier 1 freq. */
799 #define TDA9874A_C1FRC		0x05	/* carrier 1 freq. */
800 #define TDA9874A_C2FRA		0x06	/* carrier 2 freq. */
801 #define TDA9874A_C2FRB		0x07	/* carrier 2 freq. */
802 #define TDA9874A_C2FRC		0x08	/* carrier 2 freq. */
803 #define TDA9874A_DCR		0x09	/* demodulator config */
804 #define TDA9874A_FMER		0x0a	/* FM de-emphasis */
805 #define TDA9874A_FMMR		0x0b	/* FM dematrix */
806 #define TDA9874A_C1OLAR		0x0c	/* ch.1 output level adj. */
807 #define TDA9874A_C2OLAR		0x0d	/* ch.2 output level adj. */
808 #define TDA9874A_NCONR		0x0e	/* NICAM config */
809 #define TDA9874A_NOLAR		0x0f	/* NICAM output level adj. */
810 #define TDA9874A_NLELR		0x10	/* NICAM lower error limit */
811 #define TDA9874A_NUELR		0x11	/* NICAM upper error limit */
812 #define TDA9874A_AMCONR		0x12	/* audio mute control */
813 #define TDA9874A_SDACOSR	0x13	/* stereo DAC output select */
814 #define TDA9874A_AOSR		0x14	/* analog output select */
815 #define TDA9874A_DAICONR	0x15	/* digital audio interface config */
816 #define TDA9874A_I2SOSR		0x16	/* I2S-bus output select */
817 #define TDA9874A_I2SOLAR	0x17	/* I2S-bus output level adj. */
818 #define TDA9874A_MDACOSR	0x18	/* mono DAC output select (tda9874a) */
819 #define TDA9874A_ESP		0xFF	/* easy standard progr. (tda9874a) */
820 
821 /* Subaddresses for TDA9874H and TDA9874A (slave tx) */
822 #define TDA9874A_DSR		0x00	/* device status */
823 #define TDA9874A_NSR		0x01	/* NICAM status */
824 #define TDA9874A_NECR		0x02	/* NICAM error count */
825 #define TDA9874A_DR1		0x03	/* add. data LSB */
826 #define TDA9874A_DR2		0x04	/* add. data MSB */
827 #define TDA9874A_LLRA		0x05	/* monitor level read-out LSB */
828 #define TDA9874A_LLRB		0x06	/* monitor level read-out MSB */
829 #define TDA9874A_SIFLR		0x07	/* SIF level */
830 #define TDA9874A_TR2		252	/* test reg. 2 */
831 #define TDA9874A_TR1		253	/* test reg. 1 */
832 #define TDA9874A_DIC		254	/* device id. code */
833 #define TDA9874A_SIC		255	/* software id. code */
834 
835 
836 static int tda9874a_mode = 1;		/* 0: A2, 1: NICAM */
837 static int tda9874a_GCONR = 0xc0;	/* default config. input pin: SIFSEL=0 */
838 static int tda9874a_NCONR = 0x01;	/* default NICAM config.: AMSEL=0,AMUTE=1 */
839 static int tda9874a_ESP = 0x07;		/* default standard: NICAM D/K */
840 static int tda9874a_dic = -1;		/* device id. code */
841 
842 /* insmod options for tda9874a */
843 static unsigned int tda9874a_SIF   = UNSET;
844 static unsigned int tda9874a_AMSEL = UNSET;
845 static unsigned int tda9874a_STD   = UNSET;
846 module_param(tda9874a_SIF, int, 0444);
847 module_param(tda9874a_AMSEL, int, 0444);
848 module_param(tda9874a_STD, int, 0444);
849 
850 /*
851  * initialization table for tda9874 decoder:
852  *  - carrier 1 freq. registers (3 bytes)
853  *  - carrier 2 freq. registers (3 bytes)
854  *  - demudulator config register
855  *  - FM de-emphasis register (slow identification mode)
856  * Note: frequency registers must be written in single i2c transfer.
857  */
858 static struct tda9874a_MODES {
859 	char *name;
860 	audiocmd cmd;
861 } tda9874a_modelist[9] = {
862   {	"A2, B/G", /* default */
863 	{ 9, { TDA9874A_C1FRA, 0x72,0x95,0x55, 0x77,0xA0,0x00, 0x00,0x00 }} },
864   {	"A2, M (Korea)",
865 	{ 9, { TDA9874A_C1FRA, 0x5D,0xC0,0x00, 0x62,0x6A,0xAA, 0x20,0x22 }} },
866   {	"A2, D/K (1)",
867 	{ 9, { TDA9874A_C1FRA, 0x87,0x6A,0xAA, 0x82,0x60,0x00, 0x00,0x00 }} },
868   {	"A2, D/K (2)",
869 	{ 9, { TDA9874A_C1FRA, 0x87,0x6A,0xAA, 0x8C,0x75,0x55, 0x00,0x00 }} },
870   {	"A2, D/K (3)",
871 	{ 9, { TDA9874A_C1FRA, 0x87,0x6A,0xAA, 0x77,0xA0,0x00, 0x00,0x00 }} },
872   {	"NICAM, I",
873 	{ 9, { TDA9874A_C1FRA, 0x7D,0x00,0x00, 0x88,0x8A,0xAA, 0x08,0x33 }} },
874   {	"NICAM, B/G",
875 	{ 9, { TDA9874A_C1FRA, 0x72,0x95,0x55, 0x79,0xEA,0xAA, 0x08,0x33 }} },
876   {	"NICAM, D/K",
877 	{ 9, { TDA9874A_C1FRA, 0x87,0x6A,0xAA, 0x79,0xEA,0xAA, 0x08,0x33 }} },
878   {	"NICAM, L",
879 	{ 9, { TDA9874A_C1FRA, 0x87,0x6A,0xAA, 0x79,0xEA,0xAA, 0x09,0x33 }} }
880 };
881 
882 static int tda9874a_setup(struct CHIPSTATE *chip)
883 {
884 	struct v4l2_subdev *sd = &chip->sd;
885 
886 	chip_write(chip, TDA9874A_AGCGR, 0x00); /* 0 dB */
887 	chip_write(chip, TDA9874A_GCONR, tda9874a_GCONR);
888 	chip_write(chip, TDA9874A_MSR, (tda9874a_mode) ? 0x03:0x02);
889 	if(tda9874a_dic == 0x11) {
890 		chip_write(chip, TDA9874A_FMMR, 0x80);
891 	} else { /* dic == 0x07 */
892 		chip_cmd(chip,"tda9874_modelist",&tda9874a_modelist[tda9874a_STD].cmd);
893 		chip_write(chip, TDA9874A_FMMR, 0x00);
894 	}
895 	chip_write(chip, TDA9874A_C1OLAR, 0x00); /* 0 dB */
896 	chip_write(chip, TDA9874A_C2OLAR, 0x00); /* 0 dB */
897 	chip_write(chip, TDA9874A_NCONR, tda9874a_NCONR);
898 	chip_write(chip, TDA9874A_NOLAR, 0x00); /* 0 dB */
899 	/* Note: If signal quality is poor you may want to change NICAM */
900 	/* error limit registers (NLELR and NUELR) to some greater values. */
901 	/* Then the sound would remain stereo, but won't be so clear. */
902 	chip_write(chip, TDA9874A_NLELR, 0x14); /* default */
903 	chip_write(chip, TDA9874A_NUELR, 0x50); /* default */
904 
905 	if(tda9874a_dic == 0x11) {
906 		chip_write(chip, TDA9874A_AMCONR, 0xf9);
907 		chip_write(chip, TDA9874A_SDACOSR, (tda9874a_mode) ? 0x81:0x80);
908 		chip_write(chip, TDA9874A_AOSR, 0x80);
909 		chip_write(chip, TDA9874A_MDACOSR, (tda9874a_mode) ? 0x82:0x80);
910 		chip_write(chip, TDA9874A_ESP, tda9874a_ESP);
911 	} else { /* dic == 0x07 */
912 		chip_write(chip, TDA9874A_AMCONR, 0xfb);
913 		chip_write(chip, TDA9874A_SDACOSR, (tda9874a_mode) ? 0x81:0x80);
914 		chip_write(chip, TDA9874A_AOSR, 0x00); /* or 0x10 */
915 	}
916 	v4l2_dbg(1, debug, sd, "tda9874a_setup(): %s [0x%02X].\n",
917 		tda9874a_modelist[tda9874a_STD].name,tda9874a_STD);
918 	return 1;
919 }
920 
921 static int tda9874a_getrxsubchans(struct CHIPSTATE *chip)
922 {
923 	struct v4l2_subdev *sd = &chip->sd;
924 	int dsr,nsr,mode;
925 	int necr; /* just for debugging */
926 
927 	mode = V4L2_TUNER_SUB_MONO;
928 
929 	if(-1 == (dsr = chip_read2(chip,TDA9874A_DSR)))
930 		return mode;
931 	if(-1 == (nsr = chip_read2(chip,TDA9874A_NSR)))
932 		return mode;
933 	if(-1 == (necr = chip_read2(chip,TDA9874A_NECR)))
934 		return mode;
935 
936 	/* need to store dsr/nsr somewhere */
937 	chip->shadow.bytes[MAXREGS-2] = dsr;
938 	chip->shadow.bytes[MAXREGS-1] = nsr;
939 
940 	if(tda9874a_mode) {
941 		/* Note: DSR.RSSF and DSR.AMSTAT bits are also checked.
942 		 * If NICAM auto-muting is enabled, DSR.AMSTAT=1 indicates
943 		 * that sound has (temporarily) switched from NICAM to
944 		 * mono FM (or AM) on 1st sound carrier due to high NICAM bit
945 		 * error count. So in fact there is no stereo in this case :-(
946 		 * But changing the mode to V4L2_TUNER_MODE_MONO would switch
947 		 * external 4052 multiplexer in audio_hook().
948 		 */
949 		if(nsr & 0x02) /* NSR.S/MB=1 */
950 			mode = V4L2_TUNER_SUB_STEREO;
951 		if(nsr & 0x01) /* NSR.D/SB=1 */
952 			mode |= V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
953 	} else {
954 		if(dsr & 0x02) /* DSR.IDSTE=1 */
955 			mode = V4L2_TUNER_SUB_STEREO;
956 		if(dsr & 0x04) /* DSR.IDDUA=1 */
957 			mode |= V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
958 	}
959 
960 	v4l2_dbg(1, debug, sd,
961 		 "tda9874a_getrxsubchans(): DSR=0x%X, NSR=0x%X, NECR=0x%X, return: %d.\n",
962 		 dsr, nsr, necr, mode);
963 	return mode;
964 }
965 
966 static void tda9874a_setaudmode(struct CHIPSTATE *chip, int mode)
967 {
968 	struct v4l2_subdev *sd = &chip->sd;
969 
970 	/* Disable/enable NICAM auto-muting (based on DSR.RSSF status bit). */
971 	/* If auto-muting is disabled, we can hear a signal of degrading quality. */
972 	if (tda9874a_mode) {
973 		if(chip->shadow.bytes[MAXREGS-2] & 0x20) /* DSR.RSSF=1 */
974 			tda9874a_NCONR &= 0xfe; /* enable */
975 		else
976 			tda9874a_NCONR |= 0x01; /* disable */
977 		chip_write(chip, TDA9874A_NCONR, tda9874a_NCONR);
978 	}
979 
980 	/* Note: TDA9874A supports automatic FM dematrixing (FMMR register)
981 	 * and has auto-select function for audio output (AOSR register).
982 	 * Old TDA9874H doesn't support these features.
983 	 * TDA9874A also has additional mono output pin (OUTM), which
984 	 * on same (all?) tv-cards is not used, anyway (as well as MONOIN).
985 	 */
986 	if(tda9874a_dic == 0x11) {
987 		int aosr = 0x80;
988 		int mdacosr = (tda9874a_mode) ? 0x82:0x80;
989 
990 		switch(mode) {
991 		case V4L2_TUNER_MODE_MONO:
992 		case V4L2_TUNER_MODE_STEREO:
993 			break;
994 		case V4L2_TUNER_MODE_LANG1:
995 			aosr = 0x80; /* auto-select, dual A/A */
996 			mdacosr = (tda9874a_mode) ? 0x82:0x80;
997 			break;
998 		case V4L2_TUNER_MODE_LANG2:
999 			aosr = 0xa0; /* auto-select, dual B/B */
1000 			mdacosr = (tda9874a_mode) ? 0x83:0x81;
1001 			break;
1002 		case V4L2_TUNER_MODE_LANG1_LANG2:
1003 			aosr = 0x00; /* always route L to L and R to R */
1004 			mdacosr = (tda9874a_mode) ? 0x82:0x80;
1005 			break;
1006 		default:
1007 			return;
1008 		}
1009 		chip_write(chip, TDA9874A_AOSR, aosr);
1010 		chip_write(chip, TDA9874A_MDACOSR, mdacosr);
1011 
1012 		v4l2_dbg(1, debug, sd,
1013 			"tda9874a_setaudmode(): req. mode %d; AOSR=0x%X, MDACOSR=0x%X.\n",
1014 			mode, aosr, mdacosr);
1015 
1016 	} else { /* dic == 0x07 */
1017 		int fmmr,aosr;
1018 
1019 		switch(mode) {
1020 		case V4L2_TUNER_MODE_MONO:
1021 			fmmr = 0x00; /* mono */
1022 			aosr = 0x10; /* A/A */
1023 			break;
1024 		case V4L2_TUNER_MODE_STEREO:
1025 			if(tda9874a_mode) {
1026 				fmmr = 0x00;
1027 				aosr = 0x00; /* handled by NICAM auto-mute */
1028 			} else {
1029 				fmmr = (tda9874a_ESP == 1) ? 0x05 : 0x04; /* stereo */
1030 				aosr = 0x00;
1031 			}
1032 			break;
1033 		case V4L2_TUNER_MODE_LANG1:
1034 			fmmr = 0x02; /* dual */
1035 			aosr = 0x10; /* dual A/A */
1036 			break;
1037 		case V4L2_TUNER_MODE_LANG2:
1038 			fmmr = 0x02; /* dual */
1039 			aosr = 0x20; /* dual B/B */
1040 			break;
1041 		case V4L2_TUNER_MODE_LANG1_LANG2:
1042 			fmmr = 0x02; /* dual */
1043 			aosr = 0x00; /* dual A/B */
1044 			break;
1045 		default:
1046 			return;
1047 		}
1048 		chip_write(chip, TDA9874A_FMMR, fmmr);
1049 		chip_write(chip, TDA9874A_AOSR, aosr);
1050 
1051 		v4l2_dbg(1, debug, sd,
1052 			"tda9874a_setaudmode(): req. mode %d; FMMR=0x%X, AOSR=0x%X.\n",
1053 			mode, fmmr, aosr);
1054 	}
1055 }
1056 
1057 static int tda9874a_checkit(struct CHIPSTATE *chip)
1058 {
1059 	struct v4l2_subdev *sd = &chip->sd;
1060 	int dic,sic;	/* device id. and software id. codes */
1061 
1062 	if(-1 == (dic = chip_read2(chip,TDA9874A_DIC)))
1063 		return 0;
1064 	if(-1 == (sic = chip_read2(chip,TDA9874A_SIC)))
1065 		return 0;
1066 
1067 	v4l2_dbg(1, debug, sd, "tda9874a_checkit(): DIC=0x%X, SIC=0x%X.\n", dic, sic);
1068 
1069 	if((dic == 0x11)||(dic == 0x07)) {
1070 		v4l2_info(sd, "found tda9874%s.\n", (dic == 0x11) ? "a" : "h");
1071 		tda9874a_dic = dic;	/* remember device id. */
1072 		return 1;
1073 	}
1074 	return 0;	/* not found */
1075 }
1076 
1077 static int tda9874a_initialize(struct CHIPSTATE *chip)
1078 {
1079 	if (tda9874a_SIF > 2)
1080 		tda9874a_SIF = 1;
1081 	if (tda9874a_STD >= ARRAY_SIZE(tda9874a_modelist))
1082 		tda9874a_STD = 0;
1083 	if(tda9874a_AMSEL > 1)
1084 		tda9874a_AMSEL = 0;
1085 
1086 	if(tda9874a_SIF == 1)
1087 		tda9874a_GCONR = 0xc0;	/* sound IF input 1 */
1088 	else
1089 		tda9874a_GCONR = 0xc1;	/* sound IF input 2 */
1090 
1091 	tda9874a_ESP = tda9874a_STD;
1092 	tda9874a_mode = (tda9874a_STD < 5) ? 0 : 1;
1093 
1094 	if(tda9874a_AMSEL == 0)
1095 		tda9874a_NCONR = 0x01; /* auto-mute: analog mono input */
1096 	else
1097 		tda9874a_NCONR = 0x05; /* auto-mute: 1st carrier FM or AM */
1098 
1099 	tda9874a_setup(chip);
1100 	return 0;
1101 }
1102 
1103 /* ---------------------------------------------------------------------- */
1104 /* audio chip description - defines+functions for tda9875                 */
1105 /* The TDA9875 is made by Philips Semiconductor
1106  * http://www.semiconductors.philips.com
1107  * TDA9875: I2C-bus controlled DSP audio processor, FM demodulator
1108  *
1109  */
1110 
1111 /* subaddresses for TDA9875 */
1112 #define TDA9875_MUT         0x12  /*General mute  (value --> 0b11001100*/
1113 #define TDA9875_CFG         0x01  /* Config register (value --> 0b00000000 */
1114 #define TDA9875_DACOS       0x13  /*DAC i/o select (ADC) 0b0000100*/
1115 #define TDA9875_LOSR        0x16  /*Line output select regirter 0b0100 0001*/
1116 
1117 #define TDA9875_CH1V        0x0c  /*Channel 1 volume (mute)*/
1118 #define TDA9875_CH2V        0x0d  /*Channel 2 volume (mute)*/
1119 #define TDA9875_SC1         0x14  /*SCART 1 in (mono)*/
1120 #define TDA9875_SC2         0x15  /*SCART 2 in (mono)*/
1121 
1122 #define TDA9875_ADCIS       0x17  /*ADC input select (mono) 0b0110 000*/
1123 #define TDA9875_AER         0x19  /*Audio effect (AVL+Pseudo) 0b0000 0110*/
1124 #define TDA9875_MCS         0x18  /*Main channel select (DAC) 0b0000100*/
1125 #define TDA9875_MVL         0x1a  /* Main volume gauche */
1126 #define TDA9875_MVR         0x1b  /* Main volume droite */
1127 #define TDA9875_MBA         0x1d  /* Main Basse */
1128 #define TDA9875_MTR         0x1e  /* Main treble */
1129 #define TDA9875_ACS         0x1f  /* Auxiliary channel select (FM) 0b0000000*/
1130 #define TDA9875_AVL         0x20  /* Auxiliary volume gauche */
1131 #define TDA9875_AVR         0x21  /* Auxiliary volume droite */
1132 #define TDA9875_ABA         0x22  /* Auxiliary Basse */
1133 #define TDA9875_ATR         0x23  /* Auxiliary treble */
1134 
1135 #define TDA9875_MSR         0x02  /* Monitor select register */
1136 #define TDA9875_C1MSB       0x03  /* Carrier 1 (FM) frequency register MSB */
1137 #define TDA9875_C1MIB       0x04  /* Carrier 1 (FM) frequency register (16-8]b */
1138 #define TDA9875_C1LSB       0x05  /* Carrier 1 (FM) frequency register LSB */
1139 #define TDA9875_C2MSB       0x06  /* Carrier 2 (nicam) frequency register MSB */
1140 #define TDA9875_C2MIB       0x07  /* Carrier 2 (nicam) frequency register (16-8]b */
1141 #define TDA9875_C2LSB       0x08  /* Carrier 2 (nicam) frequency register LSB */
1142 #define TDA9875_DCR         0x09  /* Demodulateur configuration regirter*/
1143 #define TDA9875_DEEM        0x0a  /* FM de-emphasis regirter*/
1144 #define TDA9875_FMAT        0x0b  /* FM Matrix regirter*/
1145 
1146 /* values */
1147 #define TDA9875_MUTE_ON	    0xff /* general mute */
1148 #define TDA9875_MUTE_OFF    0xcc /* general no mute */
1149 
1150 static int tda9875_initialize(struct CHIPSTATE *chip)
1151 {
1152 	chip_write(chip, TDA9875_CFG, 0xd0); /*reg de config 0 (reset)*/
1153 	chip_write(chip, TDA9875_MSR, 0x03);    /* Monitor 0b00000XXX*/
1154 	chip_write(chip, TDA9875_C1MSB, 0x00);  /*Car1(FM) MSB XMHz*/
1155 	chip_write(chip, TDA9875_C1MIB, 0x00);  /*Car1(FM) MIB XMHz*/
1156 	chip_write(chip, TDA9875_C1LSB, 0x00);  /*Car1(FM) LSB XMHz*/
1157 	chip_write(chip, TDA9875_C2MSB, 0x00);  /*Car2(NICAM) MSB XMHz*/
1158 	chip_write(chip, TDA9875_C2MIB, 0x00);  /*Car2(NICAM) MIB XMHz*/
1159 	chip_write(chip, TDA9875_C2LSB, 0x00);  /*Car2(NICAM) LSB XMHz*/
1160 	chip_write(chip, TDA9875_DCR, 0x00);    /*Demod config 0x00*/
1161 	chip_write(chip, TDA9875_DEEM, 0x44);   /*DE-Emph 0b0100 0100*/
1162 	chip_write(chip, TDA9875_FMAT, 0x00);   /*FM Matrix reg 0x00*/
1163 	chip_write(chip, TDA9875_SC1, 0x00);    /* SCART 1 (SC1)*/
1164 	chip_write(chip, TDA9875_SC2, 0x01);    /* SCART 2 (sc2)*/
1165 
1166 	chip_write(chip, TDA9875_CH1V, 0x10);  /* Channel volume 1 mute*/
1167 	chip_write(chip, TDA9875_CH2V, 0x10);  /* Channel volume 2 mute */
1168 	chip_write(chip, TDA9875_DACOS, 0x02); /* sig DAC i/o(in:nicam)*/
1169 	chip_write(chip, TDA9875_ADCIS, 0x6f); /* sig ADC input(in:mono)*/
1170 	chip_write(chip, TDA9875_LOSR, 0x00);  /* line out (in:mono)*/
1171 	chip_write(chip, TDA9875_AER, 0x00);   /*06 Effect (AVL+PSEUDO) */
1172 	chip_write(chip, TDA9875_MCS, 0x44);   /* Main ch select (DAC) */
1173 	chip_write(chip, TDA9875_MVL, 0x03);   /* Vol Main left 10dB */
1174 	chip_write(chip, TDA9875_MVR, 0x03);   /* Vol Main right 10dB*/
1175 	chip_write(chip, TDA9875_MBA, 0x00);   /* Main Bass Main 0dB*/
1176 	chip_write(chip, TDA9875_MTR, 0x00);   /* Main Treble Main 0dB*/
1177 	chip_write(chip, TDA9875_ACS, 0x44);   /* Aux chan select (dac)*/
1178 	chip_write(chip, TDA9875_AVL, 0x00);   /* Vol Aux left 0dB*/
1179 	chip_write(chip, TDA9875_AVR, 0x00);   /* Vol Aux right 0dB*/
1180 	chip_write(chip, TDA9875_ABA, 0x00);   /* Aux Bass Main 0dB*/
1181 	chip_write(chip, TDA9875_ATR, 0x00);   /* Aux Aigus Main 0dB*/
1182 
1183 	chip_write(chip, TDA9875_MUT, 0xcc);   /* General mute  */
1184 	return 0;
1185 }
1186 
1187 static int tda9875_volume(int val) { return (unsigned char)(val / 602 - 84); }
1188 static int tda9875_bass(int val) { return (unsigned char)(max(-12, val / 2115 - 15)); }
1189 static int tda9875_treble(int val) { return (unsigned char)(val / 2622 - 12); }
1190 
1191 /* ----------------------------------------------------------------------- */
1192 
1193 
1194 /* *********************** *
1195  * i2c interface functions *
1196  * *********************** */
1197 
1198 static int tda9875_checkit(struct CHIPSTATE *chip)
1199 {
1200 	struct v4l2_subdev *sd = &chip->sd;
1201 	int dic, rev;
1202 
1203 	dic = chip_read2(chip, 254);
1204 	rev = chip_read2(chip, 255);
1205 
1206 	if (dic == 0 || dic == 2) { /* tda9875 and tda9875A */
1207 		v4l2_info(sd, "found tda9875%s rev. %d.\n",
1208 			dic == 0 ? "" : "A", rev);
1209 		return 1;
1210 	}
1211 	return 0;
1212 }
1213 
1214 /* ---------------------------------------------------------------------- */
1215 /* audio chip descriptions - defines+functions for tea6420                */
1216 
1217 #define TEA6300_VL         0x00  /* volume left */
1218 #define TEA6300_VR         0x01  /* volume right */
1219 #define TEA6300_BA         0x02  /* bass */
1220 #define TEA6300_TR         0x03  /* treble */
1221 #define TEA6300_FA         0x04  /* fader control */
1222 #define TEA6300_S          0x05  /* switch register */
1223 				 /* values for those registers: */
1224 #define TEA6300_S_SA       0x01  /* stereo A input */
1225 #define TEA6300_S_SB       0x02  /* stereo B */
1226 #define TEA6300_S_SC       0x04  /* stereo C */
1227 #define TEA6300_S_GMU      0x80  /* general mute */
1228 
1229 #define TEA6320_V          0x00  /* volume (0-5)/loudness off (6)/zero crossing mute(7) */
1230 #define TEA6320_FFR        0x01  /* fader front right (0-5) */
1231 #define TEA6320_FFL        0x02  /* fader front left (0-5) */
1232 #define TEA6320_FRR        0x03  /* fader rear right (0-5) */
1233 #define TEA6320_FRL        0x04  /* fader rear left (0-5) */
1234 #define TEA6320_BA         0x05  /* bass (0-4) */
1235 #define TEA6320_TR         0x06  /* treble (0-4) */
1236 #define TEA6320_S          0x07  /* switch register */
1237 				 /* values for those registers: */
1238 #define TEA6320_S_SA       0x07  /* stereo A input */
1239 #define TEA6320_S_SB       0x06  /* stereo B */
1240 #define TEA6320_S_SC       0x05  /* stereo C */
1241 #define TEA6320_S_SD       0x04  /* stereo D */
1242 #define TEA6320_S_GMU      0x80  /* general mute */
1243 
1244 #define TEA6420_S_SA       0x00  /* stereo A input */
1245 #define TEA6420_S_SB       0x01  /* stereo B */
1246 #define TEA6420_S_SC       0x02  /* stereo C */
1247 #define TEA6420_S_SD       0x03  /* stereo D */
1248 #define TEA6420_S_SE       0x04  /* stereo E */
1249 #define TEA6420_S_GMU      0x05  /* general mute */
1250 
1251 static int tea6300_shift10(int val) { return val >> 10; }
1252 static int tea6300_shift12(int val) { return val >> 12; }
1253 
1254 /* Assumes 16bit input (values 0x3f to 0x0c are unique, values less than */
1255 /* 0x0c mirror those immediately higher) */
1256 static int tea6320_volume(int val) { return (val / (65535/(63-12)) + 12) & 0x3f; }
1257 static int tea6320_shift11(int val) { return val >> 11; }
1258 static int tea6320_initialize(struct CHIPSTATE * chip)
1259 {
1260 	chip_write(chip, TEA6320_FFR, 0x3f);
1261 	chip_write(chip, TEA6320_FFL, 0x3f);
1262 	chip_write(chip, TEA6320_FRR, 0x3f);
1263 	chip_write(chip, TEA6320_FRL, 0x3f);
1264 
1265 	return 0;
1266 }
1267 
1268 
1269 /* ---------------------------------------------------------------------- */
1270 /* audio chip descriptions - defines+functions for tda8425                */
1271 
1272 #define TDA8425_VL         0x00  /* volume left */
1273 #define TDA8425_VR         0x01  /* volume right */
1274 #define TDA8425_BA         0x02  /* bass */
1275 #define TDA8425_TR         0x03  /* treble */
1276 #define TDA8425_S1         0x08  /* switch functions */
1277 				 /* values for those registers: */
1278 #define TDA8425_S1_OFF     0xEE  /* audio off (mute on) */
1279 #define TDA8425_S1_CH1     0xCE  /* audio channel 1 (mute off) - "linear stereo" mode */
1280 #define TDA8425_S1_CH2     0xCF  /* audio channel 2 (mute off) - "linear stereo" mode */
1281 #define TDA8425_S1_MU      0x20  /* mute bit */
1282 #define TDA8425_S1_STEREO  0x18  /* stereo bits */
1283 #define TDA8425_S1_STEREO_SPATIAL 0x18 /* spatial stereo */
1284 #define TDA8425_S1_STEREO_LINEAR  0x08 /* linear stereo */
1285 #define TDA8425_S1_STEREO_PSEUDO  0x10 /* pseudo stereo */
1286 #define TDA8425_S1_STEREO_MONO    0x00 /* forced mono */
1287 #define TDA8425_S1_ML      0x06        /* language selector */
1288 #define TDA8425_S1_ML_SOUND_A 0x02     /* sound a */
1289 #define TDA8425_S1_ML_SOUND_B 0x04     /* sound b */
1290 #define TDA8425_S1_ML_STEREO  0x06     /* stereo */
1291 #define TDA8425_S1_IS      0x01        /* channel selector */
1292 
1293 
1294 static int tda8425_shift10(int val) { return (val >> 10) | 0xc0; }
1295 static int tda8425_shift12(int val) { return (val >> 12) | 0xf0; }
1296 
1297 static void tda8425_setaudmode(struct CHIPSTATE *chip, int mode)
1298 {
1299 	int s1 = chip->shadow.bytes[TDA8425_S1+1] & 0xe1;
1300 
1301 	switch (mode) {
1302 	case V4L2_TUNER_MODE_LANG1:
1303 		s1 |= TDA8425_S1_ML_SOUND_A;
1304 		s1 |= TDA8425_S1_STEREO_PSEUDO;
1305 		break;
1306 	case V4L2_TUNER_MODE_LANG2:
1307 		s1 |= TDA8425_S1_ML_SOUND_B;
1308 		s1 |= TDA8425_S1_STEREO_PSEUDO;
1309 		break;
1310 	case V4L2_TUNER_MODE_LANG1_LANG2:
1311 		s1 |= TDA8425_S1_ML_STEREO;
1312 		s1 |= TDA8425_S1_STEREO_LINEAR;
1313 		break;
1314 	case V4L2_TUNER_MODE_MONO:
1315 		s1 |= TDA8425_S1_ML_STEREO;
1316 		s1 |= TDA8425_S1_STEREO_MONO;
1317 		break;
1318 	case V4L2_TUNER_MODE_STEREO:
1319 		s1 |= TDA8425_S1_ML_STEREO;
1320 		s1 |= TDA8425_S1_STEREO_SPATIAL;
1321 		break;
1322 	default:
1323 		return;
1324 	}
1325 	chip_write(chip,TDA8425_S1,s1);
1326 }
1327 
1328 
1329 /* ---------------------------------------------------------------------- */
1330 /* audio chip descriptions - defines+functions for pic16c54 (PV951)       */
1331 
1332 /* the registers of 16C54, I2C sub address. */
1333 #define PIC16C54_REG_KEY_CODE     0x01	       /* Not use. */
1334 #define PIC16C54_REG_MISC         0x02
1335 
1336 /* bit definition of the RESET register, I2C data. */
1337 #define PIC16C54_MISC_RESET_REMOTE_CTL 0x01 /* bit 0, Reset to receive the key */
1338 					    /*        code of remote controller */
1339 #define PIC16C54_MISC_MTS_MAIN         0x02 /* bit 1 */
1340 #define PIC16C54_MISC_MTS_SAP          0x04 /* bit 2 */
1341 #define PIC16C54_MISC_MTS_BOTH         0x08 /* bit 3 */
1342 #define PIC16C54_MISC_SND_MUTE         0x10 /* bit 4, Mute Audio(Line-in and Tuner) */
1343 #define PIC16C54_MISC_SND_NOTMUTE      0x20 /* bit 5 */
1344 #define PIC16C54_MISC_SWITCH_TUNER     0x40 /* bit 6	, Switch to Line-in */
1345 #define PIC16C54_MISC_SWITCH_LINE      0x80 /* bit 7	, Switch to Tuner */
1346 
1347 /* ---------------------------------------------------------------------- */
1348 /* audio chip descriptions - defines+functions for TA8874Z                */
1349 
1350 /* write 1st byte */
1351 #define TA8874Z_LED_STE	0x80
1352 #define TA8874Z_LED_BIL	0x40
1353 #define TA8874Z_LED_EXT	0x20
1354 #define TA8874Z_MONO_SET	0x10
1355 #define TA8874Z_MUTE	0x08
1356 #define TA8874Z_F_MONO	0x04
1357 #define TA8874Z_MODE_SUB	0x02
1358 #define TA8874Z_MODE_MAIN	0x01
1359 
1360 /* write 2nd byte */
1361 /*#define TA8874Z_TI	0x80  */ /* test mode */
1362 #define TA8874Z_SEPARATION	0x3f
1363 #define TA8874Z_SEPARATION_DEFAULT	0x10
1364 
1365 /* read */
1366 #define TA8874Z_B1	0x80
1367 #define TA8874Z_B0	0x40
1368 #define TA8874Z_CHAG_FLAG	0x20
1369 
1370 /*
1371  *        B1 B0
1372  * mono    L  H
1373  * stereo  L  L
1374  * BIL     H  L
1375  */
1376 static int ta8874z_getrxsubchans(struct CHIPSTATE *chip)
1377 {
1378 	int val, mode;
1379 
1380 	val = chip_read(chip);
1381 	mode = V4L2_TUNER_SUB_MONO;
1382 	if (val & TA8874Z_B1){
1383 		mode |= V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
1384 	}else if (!(val & TA8874Z_B0)){
1385 		mode = V4L2_TUNER_SUB_STEREO;
1386 	}
1387 	/* v4l2_dbg(1, debug, &chip->sd,
1388 		 "ta8874z_getrxsubchans(): raw chip read: 0x%02x, return: 0x%02x\n",
1389 		 val, mode); */
1390 	return mode;
1391 }
1392 
1393 static audiocmd ta8874z_stereo = { 2, {0, TA8874Z_SEPARATION_DEFAULT}};
1394 static audiocmd ta8874z_mono = {2, { TA8874Z_MONO_SET, TA8874Z_SEPARATION_DEFAULT}};
1395 static audiocmd ta8874z_main = {2, { 0, TA8874Z_SEPARATION_DEFAULT}};
1396 static audiocmd ta8874z_sub = {2, { TA8874Z_MODE_SUB, TA8874Z_SEPARATION_DEFAULT}};
1397 static audiocmd ta8874z_both = {2, { TA8874Z_MODE_MAIN | TA8874Z_MODE_SUB, TA8874Z_SEPARATION_DEFAULT}};
1398 
1399 static void ta8874z_setaudmode(struct CHIPSTATE *chip, int mode)
1400 {
1401 	struct v4l2_subdev *sd = &chip->sd;
1402 	int update = 1;
1403 	audiocmd *t = NULL;
1404 
1405 	v4l2_dbg(1, debug, sd, "ta8874z_setaudmode(): mode: 0x%02x\n", mode);
1406 
1407 	switch(mode){
1408 	case V4L2_TUNER_MODE_MONO:
1409 		t = &ta8874z_mono;
1410 		break;
1411 	case V4L2_TUNER_MODE_STEREO:
1412 		t = &ta8874z_stereo;
1413 		break;
1414 	case V4L2_TUNER_MODE_LANG1:
1415 		t = &ta8874z_main;
1416 		break;
1417 	case V4L2_TUNER_MODE_LANG2:
1418 		t = &ta8874z_sub;
1419 		break;
1420 	case V4L2_TUNER_MODE_LANG1_LANG2:
1421 		t = &ta8874z_both;
1422 		break;
1423 	default:
1424 		update = 0;
1425 	}
1426 
1427 	if(update)
1428 		chip_cmd(chip, "TA8874Z", t);
1429 }
1430 
1431 static int ta8874z_checkit(struct CHIPSTATE *chip)
1432 {
1433 	int rc;
1434 	rc = chip_read(chip);
1435 	return ((rc & 0x1f) == 0x1f) ? 1 : 0;
1436 }
1437 
1438 /* ---------------------------------------------------------------------- */
1439 /* audio chip descriptions - struct CHIPDESC                              */
1440 
1441 /* insmod options to enable/disable individual audio chips */
1442 static int tda8425  = 1;
1443 static int tda9840  = 1;
1444 static int tda9850  = 1;
1445 static int tda9855  = 1;
1446 static int tda9873  = 1;
1447 static int tda9874a = 1;
1448 static int tda9875  = 1;
1449 static int tea6300;	/* default 0 - address clash with msp34xx */
1450 static int tea6320;	/* default 0 - address clash with msp34xx */
1451 static int tea6420  = 1;
1452 static int pic16c54 = 1;
1453 static int ta8874z;	/* default 0 - address clash with tda9840 */
1454 
1455 module_param(tda8425, int, 0444);
1456 module_param(tda9840, int, 0444);
1457 module_param(tda9850, int, 0444);
1458 module_param(tda9855, int, 0444);
1459 module_param(tda9873, int, 0444);
1460 module_param(tda9874a, int, 0444);
1461 module_param(tda9875, int, 0444);
1462 module_param(tea6300, int, 0444);
1463 module_param(tea6320, int, 0444);
1464 module_param(tea6420, int, 0444);
1465 module_param(pic16c54, int, 0444);
1466 module_param(ta8874z, int, 0444);
1467 
1468 static struct CHIPDESC chiplist[] = {
1469 	{
1470 		.name       = "tda9840",
1471 		.insmodopt  = &tda9840,
1472 		.addr_lo    = I2C_ADDR_TDA9840 >> 1,
1473 		.addr_hi    = I2C_ADDR_TDA9840 >> 1,
1474 		.registers  = 5,
1475 		.flags      = CHIP_NEED_CHECKMODE,
1476 
1477 		/* callbacks */
1478 		.checkit    = tda9840_checkit,
1479 		.getrxsubchans = tda9840_getrxsubchans,
1480 		.setaudmode = tda9840_setaudmode,
1481 
1482 		.init       = { 2, { TDA9840_TEST, TDA9840_TEST_INT1SN
1483 				/* ,TDA9840_SW, TDA9840_MONO */} }
1484 	},
1485 	{
1486 		.name       = "tda9873h",
1487 		.insmodopt  = &tda9873,
1488 		.addr_lo    = I2C_ADDR_TDA985x_L >> 1,
1489 		.addr_hi    = I2C_ADDR_TDA985x_H >> 1,
1490 		.registers  = 3,
1491 		.flags      = CHIP_HAS_INPUTSEL | CHIP_NEED_CHECKMODE,
1492 
1493 		/* callbacks */
1494 		.checkit    = tda9873_checkit,
1495 		.getrxsubchans = tda9873_getrxsubchans,
1496 		.setaudmode = tda9873_setaudmode,
1497 
1498 		.init       = { 4, { TDA9873_SW, 0xa4, 0x06, 0x03 } },
1499 		.inputreg   = TDA9873_SW,
1500 		.inputmute  = TDA9873_MUTE | TDA9873_AUTOMUTE,
1501 		.inputmap   = {0xa0, 0xa2, 0xa0, 0xa0},
1502 		.inputmask  = TDA9873_INP_MASK|TDA9873_MUTE|TDA9873_AUTOMUTE,
1503 
1504 	},
1505 	{
1506 		.name       = "tda9874h/a",
1507 		.insmodopt  = &tda9874a,
1508 		.addr_lo    = I2C_ADDR_TDA9874 >> 1,
1509 		.addr_hi    = I2C_ADDR_TDA9874 >> 1,
1510 		.flags      = CHIP_NEED_CHECKMODE,
1511 
1512 		/* callbacks */
1513 		.initialize = tda9874a_initialize,
1514 		.checkit    = tda9874a_checkit,
1515 		.getrxsubchans = tda9874a_getrxsubchans,
1516 		.setaudmode = tda9874a_setaudmode,
1517 	},
1518 	{
1519 		.name       = "tda9875",
1520 		.insmodopt  = &tda9875,
1521 		.addr_lo    = I2C_ADDR_TDA9875 >> 1,
1522 		.addr_hi    = I2C_ADDR_TDA9875 >> 1,
1523 		.flags      = CHIP_HAS_VOLUME | CHIP_HAS_BASSTREBLE,
1524 
1525 		/* callbacks */
1526 		.initialize = tda9875_initialize,
1527 		.checkit    = tda9875_checkit,
1528 		.volfunc    = tda9875_volume,
1529 		.bassfunc   = tda9875_bass,
1530 		.treblefunc = tda9875_treble,
1531 		.leftreg    = TDA9875_MVL,
1532 		.rightreg   = TDA9875_MVR,
1533 		.bassreg    = TDA9875_MBA,
1534 		.treblereg  = TDA9875_MTR,
1535 		.volinit    = 58880,
1536 	},
1537 	{
1538 		.name       = "tda9850",
1539 		.insmodopt  = &tda9850,
1540 		.addr_lo    = I2C_ADDR_TDA985x_L >> 1,
1541 		.addr_hi    = I2C_ADDR_TDA985x_H >> 1,
1542 		.registers  = 11,
1543 
1544 		.getrxsubchans = tda985x_getrxsubchans,
1545 		.setaudmode = tda985x_setaudmode,
1546 
1547 		.init       = { 8, { TDA9850_C4, 0x08, 0x08, TDA985x_STEREO, 0x07, 0x10, 0x10, 0x03 } }
1548 	},
1549 	{
1550 		.name       = "tda9855",
1551 		.insmodopt  = &tda9855,
1552 		.addr_lo    = I2C_ADDR_TDA985x_L >> 1,
1553 		.addr_hi    = I2C_ADDR_TDA985x_H >> 1,
1554 		.registers  = 11,
1555 		.flags      = CHIP_HAS_VOLUME | CHIP_HAS_BASSTREBLE,
1556 
1557 		.leftreg    = TDA9855_VL,
1558 		.rightreg   = TDA9855_VR,
1559 		.bassreg    = TDA9855_BA,
1560 		.treblereg  = TDA9855_TR,
1561 
1562 		/* callbacks */
1563 		.volfunc    = tda9855_volume,
1564 		.bassfunc   = tda9855_bass,
1565 		.treblefunc = tda9855_treble,
1566 		.getrxsubchans = tda985x_getrxsubchans,
1567 		.setaudmode = tda985x_setaudmode,
1568 
1569 		.init       = { 12, { 0, 0x6f, 0x6f, 0x0e, 0x07<<1, 0x8<<2,
1570 				    TDA9855_MUTE | TDA9855_AVL | TDA9855_LOUD | TDA9855_INT,
1571 				    TDA985x_STEREO | TDA9855_LINEAR | TDA9855_TZCM | TDA9855_VZCM,
1572 				    0x07, 0x10, 0x10, 0x03 }}
1573 	},
1574 	{
1575 		.name       = "tea6300",
1576 		.insmodopt  = &tea6300,
1577 		.addr_lo    = I2C_ADDR_TEA6300 >> 1,
1578 		.addr_hi    = I2C_ADDR_TEA6300 >> 1,
1579 		.registers  = 6,
1580 		.flags      = CHIP_HAS_VOLUME | CHIP_HAS_BASSTREBLE | CHIP_HAS_INPUTSEL,
1581 
1582 		.leftreg    = TEA6300_VR,
1583 		.rightreg   = TEA6300_VL,
1584 		.bassreg    = TEA6300_BA,
1585 		.treblereg  = TEA6300_TR,
1586 
1587 		/* callbacks */
1588 		.volfunc    = tea6300_shift10,
1589 		.bassfunc   = tea6300_shift12,
1590 		.treblefunc = tea6300_shift12,
1591 
1592 		.inputreg   = TEA6300_S,
1593 		.inputmap   = { TEA6300_S_SA, TEA6300_S_SB, TEA6300_S_SC },
1594 		.inputmute  = TEA6300_S_GMU,
1595 	},
1596 	{
1597 		.name       = "tea6320",
1598 		.insmodopt  = &tea6320,
1599 		.addr_lo    = I2C_ADDR_TEA6300 >> 1,
1600 		.addr_hi    = I2C_ADDR_TEA6300 >> 1,
1601 		.registers  = 8,
1602 		.flags      = CHIP_HAS_VOLUME | CHIP_HAS_BASSTREBLE | CHIP_HAS_INPUTSEL,
1603 
1604 		.leftreg    = TEA6320_V,
1605 		.rightreg   = TEA6320_V,
1606 		.bassreg    = TEA6320_BA,
1607 		.treblereg  = TEA6320_TR,
1608 
1609 		/* callbacks */
1610 		.initialize = tea6320_initialize,
1611 		.volfunc    = tea6320_volume,
1612 		.bassfunc   = tea6320_shift11,
1613 		.treblefunc = tea6320_shift11,
1614 
1615 		.inputreg   = TEA6320_S,
1616 		.inputmap   = { TEA6320_S_SA, TEA6420_S_SB, TEA6300_S_SC, TEA6320_S_SD },
1617 		.inputmute  = TEA6300_S_GMU,
1618 	},
1619 	{
1620 		.name       = "tea6420",
1621 		.insmodopt  = &tea6420,
1622 		.addr_lo    = I2C_ADDR_TEA6420 >> 1,
1623 		.addr_hi    = I2C_ADDR_TEA6420 >> 1,
1624 		.registers  = 1,
1625 		.flags      = CHIP_HAS_INPUTSEL,
1626 
1627 		.inputreg   = -1,
1628 		.inputmap   = { TEA6420_S_SA, TEA6420_S_SB, TEA6420_S_SC },
1629 		.inputmute  = TEA6420_S_GMU,
1630 		.inputmask  = 0x07,
1631 	},
1632 	{
1633 		.name       = "tda8425",
1634 		.insmodopt  = &tda8425,
1635 		.addr_lo    = I2C_ADDR_TDA8425 >> 1,
1636 		.addr_hi    = I2C_ADDR_TDA8425 >> 1,
1637 		.registers  = 9,
1638 		.flags      = CHIP_HAS_VOLUME | CHIP_HAS_BASSTREBLE | CHIP_HAS_INPUTSEL,
1639 
1640 		.leftreg    = TDA8425_VL,
1641 		.rightreg   = TDA8425_VR,
1642 		.bassreg    = TDA8425_BA,
1643 		.treblereg  = TDA8425_TR,
1644 
1645 		/* callbacks */
1646 		.volfunc    = tda8425_shift10,
1647 		.bassfunc   = tda8425_shift12,
1648 		.treblefunc = tda8425_shift12,
1649 		.setaudmode = tda8425_setaudmode,
1650 
1651 		.inputreg   = TDA8425_S1,
1652 		.inputmap   = { TDA8425_S1_CH1, TDA8425_S1_CH1, TDA8425_S1_CH1 },
1653 		.inputmute  = TDA8425_S1_OFF,
1654 
1655 	},
1656 	{
1657 		.name       = "pic16c54 (PV951)",
1658 		.insmodopt  = &pic16c54,
1659 		.addr_lo    = I2C_ADDR_PIC16C54 >> 1,
1660 		.addr_hi    = I2C_ADDR_PIC16C54>> 1,
1661 		.registers  = 2,
1662 		.flags      = CHIP_HAS_INPUTSEL,
1663 
1664 		.inputreg   = PIC16C54_REG_MISC,
1665 		.inputmap   = {PIC16C54_MISC_SND_NOTMUTE|PIC16C54_MISC_SWITCH_TUNER,
1666 			     PIC16C54_MISC_SND_NOTMUTE|PIC16C54_MISC_SWITCH_LINE,
1667 			     PIC16C54_MISC_SND_NOTMUTE|PIC16C54_MISC_SWITCH_LINE,
1668 			     PIC16C54_MISC_SND_MUTE},
1669 		.inputmute  = PIC16C54_MISC_SND_MUTE,
1670 	},
1671 	{
1672 		.name       = "ta8874z",
1673 		.checkit    = ta8874z_checkit,
1674 		.insmodopt  = &ta8874z,
1675 		.addr_lo    = I2C_ADDR_TDA9840 >> 1,
1676 		.addr_hi    = I2C_ADDR_TDA9840 >> 1,
1677 		.registers  = 2,
1678 
1679 		/* callbacks */
1680 		.getrxsubchans = ta8874z_getrxsubchans,
1681 		.setaudmode = ta8874z_setaudmode,
1682 
1683 		.init       = {2, { TA8874Z_MONO_SET, TA8874Z_SEPARATION_DEFAULT}},
1684 	},
1685 	{ .name = NULL } /* EOF */
1686 };
1687 
1688 
1689 /* ---------------------------------------------------------------------- */
1690 
1691 static int tvaudio_s_ctrl(struct v4l2_ctrl *ctrl)
1692 {
1693 	struct v4l2_subdev *sd = to_sd(ctrl);
1694 	struct CHIPSTATE *chip = to_state(sd);
1695 	struct CHIPDESC *desc = chip->desc;
1696 
1697 	switch (ctrl->id) {
1698 	case V4L2_CID_AUDIO_MUTE:
1699 		chip->muted = ctrl->val;
1700 		if (chip->muted)
1701 			chip_write_masked(chip,desc->inputreg,desc->inputmute,desc->inputmask);
1702 		else
1703 			chip_write_masked(chip,desc->inputreg,
1704 					desc->inputmap[chip->input],desc->inputmask);
1705 		return 0;
1706 	case V4L2_CID_AUDIO_VOLUME: {
1707 		u32 volume, balance;
1708 		u32 left, right;
1709 
1710 		volume = chip->volume->val;
1711 		balance = chip->balance->val;
1712 		left = (min(65536U - balance, 32768U) * volume) / 32768U;
1713 		right = (min(balance, 32768U) * volume) / 32768U;
1714 
1715 		chip_write(chip, desc->leftreg, desc->volfunc(left));
1716 		chip_write(chip, desc->rightreg, desc->volfunc(right));
1717 		return 0;
1718 	}
1719 	case V4L2_CID_AUDIO_BASS:
1720 		chip_write(chip, desc->bassreg, desc->bassfunc(ctrl->val));
1721 		return 0;
1722 	case V4L2_CID_AUDIO_TREBLE:
1723 		chip_write(chip, desc->treblereg, desc->treblefunc(ctrl->val));
1724 		return 0;
1725 	}
1726 	return -EINVAL;
1727 }
1728 
1729 
1730 /* ---------------------------------------------------------------------- */
1731 /* video4linux interface                                                  */
1732 
1733 static int tvaudio_s_radio(struct v4l2_subdev *sd)
1734 {
1735 	struct CHIPSTATE *chip = to_state(sd);
1736 
1737 	chip->radio = 1;
1738 	/* del_timer(&chip->wt); */
1739 	return 0;
1740 }
1741 
1742 static int tvaudio_s_routing(struct v4l2_subdev *sd,
1743 			     u32 input, u32 output, u32 config)
1744 {
1745 	struct CHIPSTATE *chip = to_state(sd);
1746 	struct CHIPDESC *desc = chip->desc;
1747 
1748 	if (!(desc->flags & CHIP_HAS_INPUTSEL))
1749 		return 0;
1750 	if (input >= 4)
1751 		return -EINVAL;
1752 	/* There are four inputs: tuner, radio, extern and intern. */
1753 	chip->input = input;
1754 	if (chip->muted)
1755 		return 0;
1756 	chip_write_masked(chip, desc->inputreg,
1757 			desc->inputmap[chip->input], desc->inputmask);
1758 	return 0;
1759 }
1760 
1761 static int tvaudio_s_tuner(struct v4l2_subdev *sd, const struct v4l2_tuner *vt)
1762 {
1763 	struct CHIPSTATE *chip = to_state(sd);
1764 	struct CHIPDESC *desc = chip->desc;
1765 
1766 	if (!desc->setaudmode)
1767 		return 0;
1768 	if (chip->radio)
1769 		return 0;
1770 
1771 	switch (vt->audmode) {
1772 	case V4L2_TUNER_MODE_MONO:
1773 	case V4L2_TUNER_MODE_STEREO:
1774 	case V4L2_TUNER_MODE_LANG1:
1775 	case V4L2_TUNER_MODE_LANG2:
1776 	case V4L2_TUNER_MODE_LANG1_LANG2:
1777 		break;
1778 	default:
1779 		return -EINVAL;
1780 	}
1781 	chip->audmode = vt->audmode;
1782 
1783 	if (chip->thread)
1784 		wake_up_process(chip->thread);
1785 	else
1786 		desc->setaudmode(chip, vt->audmode);
1787 
1788 	return 0;
1789 }
1790 
1791 static int tvaudio_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt)
1792 {
1793 	struct CHIPSTATE *chip = to_state(sd);
1794 	struct CHIPDESC *desc = chip->desc;
1795 
1796 	if (!desc->getrxsubchans)
1797 		return 0;
1798 	if (chip->radio)
1799 		return 0;
1800 
1801 	vt->audmode = chip->audmode;
1802 	vt->rxsubchans = desc->getrxsubchans(chip);
1803 	vt->capability |= V4L2_TUNER_CAP_STEREO |
1804 		V4L2_TUNER_CAP_LANG1 | V4L2_TUNER_CAP_LANG2;
1805 
1806 	return 0;
1807 }
1808 
1809 static int tvaudio_s_std(struct v4l2_subdev *sd, v4l2_std_id std)
1810 {
1811 	struct CHIPSTATE *chip = to_state(sd);
1812 
1813 	chip->radio = 0;
1814 	return 0;
1815 }
1816 
1817 static int tvaudio_s_frequency(struct v4l2_subdev *sd, const struct v4l2_frequency *freq)
1818 {
1819 	struct CHIPSTATE *chip = to_state(sd);
1820 	struct CHIPDESC *desc = chip->desc;
1821 
1822 	/* For chips that provide getrxsubchans and setaudmode, and doesn't
1823 	   automatically follows the stereo carrier, a kthread is
1824 	   created to set the audio standard. In this case, when then
1825 	   the video channel is changed, tvaudio starts on MONO mode.
1826 	   After waiting for 2 seconds, the kernel thread is called,
1827 	   to follow whatever audio standard is pointed by the
1828 	   audio carrier.
1829 	 */
1830 	if (chip->thread) {
1831 		desc->setaudmode(chip, V4L2_TUNER_MODE_MONO);
1832 		chip->prevmode = -1; /* reset previous mode */
1833 		mod_timer(&chip->wt, jiffies+msecs_to_jiffies(2000));
1834 	}
1835 	return 0;
1836 }
1837 
1838 static int tvaudio_log_status(struct v4l2_subdev *sd)
1839 {
1840 	struct CHIPSTATE *chip = to_state(sd);
1841 	struct CHIPDESC *desc = chip->desc;
1842 
1843 	v4l2_info(sd, "Chip: %s\n", desc->name);
1844 	v4l2_ctrl_handler_log_status(&chip->hdl, sd->name);
1845 	return 0;
1846 }
1847 
1848 /* ----------------------------------------------------------------------- */
1849 
1850 static const struct v4l2_ctrl_ops tvaudio_ctrl_ops = {
1851 	.s_ctrl = tvaudio_s_ctrl,
1852 };
1853 
1854 static const struct v4l2_subdev_core_ops tvaudio_core_ops = {
1855 	.log_status = tvaudio_log_status,
1856 };
1857 
1858 static const struct v4l2_subdev_tuner_ops tvaudio_tuner_ops = {
1859 	.s_radio = tvaudio_s_radio,
1860 	.s_frequency = tvaudio_s_frequency,
1861 	.s_tuner = tvaudio_s_tuner,
1862 	.g_tuner = tvaudio_g_tuner,
1863 };
1864 
1865 static const struct v4l2_subdev_audio_ops tvaudio_audio_ops = {
1866 	.s_routing = tvaudio_s_routing,
1867 };
1868 
1869 static const struct v4l2_subdev_video_ops tvaudio_video_ops = {
1870 	.s_std = tvaudio_s_std,
1871 };
1872 
1873 static const struct v4l2_subdev_ops tvaudio_ops = {
1874 	.core = &tvaudio_core_ops,
1875 	.tuner = &tvaudio_tuner_ops,
1876 	.audio = &tvaudio_audio_ops,
1877 	.video = &tvaudio_video_ops,
1878 };
1879 
1880 /* ----------------------------------------------------------------------- */
1881 
1882 
1883 /* i2c registration                                                       */
1884 
1885 static int tvaudio_probe(struct i2c_client *client, const struct i2c_device_id *id)
1886 {
1887 	struct CHIPSTATE *chip;
1888 	struct CHIPDESC  *desc;
1889 	struct v4l2_subdev *sd;
1890 
1891 	if (debug) {
1892 		printk(KERN_INFO "tvaudio: TV audio decoder + audio/video mux driver\n");
1893 		printk(KERN_INFO "tvaudio: known chips: ");
1894 		for (desc = chiplist; desc->name != NULL; desc++)
1895 			printk(KERN_CONT "%s%s",
1896 			       (desc == chiplist) ? "" : ", ", desc->name);
1897 		printk(KERN_CONT "\n");
1898 	}
1899 
1900 	chip = devm_kzalloc(&client->dev, sizeof(*chip), GFP_KERNEL);
1901 	if (!chip)
1902 		return -ENOMEM;
1903 	sd = &chip->sd;
1904 	v4l2_i2c_subdev_init(sd, client, &tvaudio_ops);
1905 
1906 	/* find description for the chip */
1907 	v4l2_dbg(1, debug, sd, "chip found @ 0x%x\n", client->addr<<1);
1908 	for (desc = chiplist; desc->name != NULL; desc++) {
1909 		if (0 == *(desc->insmodopt))
1910 			continue;
1911 		if (client->addr < desc->addr_lo ||
1912 		    client->addr > desc->addr_hi)
1913 			continue;
1914 		if (desc->checkit && !desc->checkit(chip))
1915 			continue;
1916 		break;
1917 	}
1918 	if (desc->name == NULL) {
1919 		v4l2_dbg(1, debug, sd, "no matching chip description found\n");
1920 		return -EIO;
1921 	}
1922 	v4l2_info(sd, "%s found @ 0x%x (%s)\n", desc->name, client->addr<<1, client->adapter->name);
1923 	if (desc->flags) {
1924 		v4l2_dbg(1, debug, sd, "matches:%s%s%s.\n",
1925 			(desc->flags & CHIP_HAS_VOLUME)     ? " volume"      : "",
1926 			(desc->flags & CHIP_HAS_BASSTREBLE) ? " bass/treble" : "",
1927 			(desc->flags & CHIP_HAS_INPUTSEL)   ? " audiomux"    : "");
1928 	}
1929 
1930 	/* fill required data structures */
1931 	if (!id)
1932 		strlcpy(client->name, desc->name, I2C_NAME_SIZE);
1933 	chip->desc = desc;
1934 	chip->shadow.count = desc->registers+1;
1935 	chip->prevmode = -1;
1936 	chip->audmode = V4L2_TUNER_MODE_LANG1;
1937 
1938 	/* initialization  */
1939 	if (desc->initialize != NULL)
1940 		desc->initialize(chip);
1941 	else
1942 		chip_cmd(chip, "init", &desc->init);
1943 
1944 	v4l2_ctrl_handler_init(&chip->hdl, 5);
1945 	if (desc->flags & CHIP_HAS_INPUTSEL)
1946 		v4l2_ctrl_new_std(&chip->hdl, &tvaudio_ctrl_ops,
1947 			V4L2_CID_AUDIO_MUTE, 0, 1, 1, 0);
1948 	if (desc->flags & CHIP_HAS_VOLUME) {
1949 		if (!desc->volfunc) {
1950 			/* This shouldn't be happen. Warn user, but keep working
1951 			   without volume controls
1952 			 */
1953 			v4l2_info(sd, "volume callback undefined!\n");
1954 			desc->flags &= ~CHIP_HAS_VOLUME;
1955 		} else {
1956 			chip->volume = v4l2_ctrl_new_std(&chip->hdl,
1957 				&tvaudio_ctrl_ops, V4L2_CID_AUDIO_VOLUME,
1958 				0, 65535, 65535 / 100,
1959 				desc->volinit ? desc->volinit : 65535);
1960 			chip->balance = v4l2_ctrl_new_std(&chip->hdl,
1961 				&tvaudio_ctrl_ops, V4L2_CID_AUDIO_BALANCE,
1962 				0, 65535, 65535 / 100, 32768);
1963 			v4l2_ctrl_cluster(2, &chip->volume);
1964 		}
1965 	}
1966 	if (desc->flags & CHIP_HAS_BASSTREBLE) {
1967 		if (!desc->bassfunc || !desc->treblefunc) {
1968 			/* This shouldn't be happen. Warn user, but keep working
1969 			   without bass/treble controls
1970 			 */
1971 			v4l2_info(sd, "bass/treble callbacks undefined!\n");
1972 			desc->flags &= ~CHIP_HAS_BASSTREBLE;
1973 		} else {
1974 			v4l2_ctrl_new_std(&chip->hdl,
1975 				&tvaudio_ctrl_ops, V4L2_CID_AUDIO_BASS,
1976 				0, 65535, 65535 / 100,
1977 				desc->bassinit ? desc->bassinit : 32768);
1978 			v4l2_ctrl_new_std(&chip->hdl,
1979 				&tvaudio_ctrl_ops, V4L2_CID_AUDIO_TREBLE,
1980 				0, 65535, 65535 / 100,
1981 				desc->trebleinit ? desc->trebleinit : 32768);
1982 		}
1983 	}
1984 
1985 	sd->ctrl_handler = &chip->hdl;
1986 	if (chip->hdl.error) {
1987 		int err = chip->hdl.error;
1988 
1989 		v4l2_ctrl_handler_free(&chip->hdl);
1990 		return err;
1991 	}
1992 	/* set controls to the default values */
1993 	v4l2_ctrl_handler_setup(&chip->hdl);
1994 
1995 	chip->thread = NULL;
1996 	timer_setup(&chip->wt, chip_thread_wake, 0);
1997 	if (desc->flags & CHIP_NEED_CHECKMODE) {
1998 		if (!desc->getrxsubchans || !desc->setaudmode) {
1999 			/* This shouldn't be happen. Warn user, but keep working
2000 			   without kthread
2001 			 */
2002 			v4l2_info(sd, "set/get mode callbacks undefined!\n");
2003 			return 0;
2004 		}
2005 		/* start async thread */
2006 		chip->thread = kthread_run(chip_thread, chip, "%s",
2007 					   client->name);
2008 		if (IS_ERR(chip->thread)) {
2009 			v4l2_warn(sd, "failed to create kthread\n");
2010 			chip->thread = NULL;
2011 		}
2012 	}
2013 	return 0;
2014 }
2015 
2016 static int tvaudio_remove(struct i2c_client *client)
2017 {
2018 	struct v4l2_subdev *sd = i2c_get_clientdata(client);
2019 	struct CHIPSTATE *chip = to_state(sd);
2020 
2021 	del_timer_sync(&chip->wt);
2022 	if (chip->thread) {
2023 		/* shutdown async thread */
2024 		kthread_stop(chip->thread);
2025 		chip->thread = NULL;
2026 	}
2027 
2028 	v4l2_device_unregister_subdev(sd);
2029 	v4l2_ctrl_handler_free(&chip->hdl);
2030 	return 0;
2031 }
2032 
2033 /* This driver supports many devices and the idea is to let the driver
2034    detect which device is present. So rather than listing all supported
2035    devices here, we pretend to support a single, fake device type. */
2036 static const struct i2c_device_id tvaudio_id[] = {
2037 	{ "tvaudio", 0 },
2038 	{ }
2039 };
2040 MODULE_DEVICE_TABLE(i2c, tvaudio_id);
2041 
2042 static struct i2c_driver tvaudio_driver = {
2043 	.driver = {
2044 		.name	= "tvaudio",
2045 	},
2046 	.probe		= tvaudio_probe,
2047 	.remove		= tvaudio_remove,
2048 	.id_table	= tvaudio_id,
2049 };
2050 
2051 module_i2c_driver(tvaudio_driver);
2052