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