2 * Driver for simple i2c audio chips.
4 * Copyright (c) 2000 Gerd Knorr
6 * Eric Sandeen (eric_sandeen@bigfoot.com)
7 * Steve VanDeBogart (vandebo@uclink.berkeley.edu)
8 * Greg Alexander (galexand@acm.org)
10 * For the TDA9875 part:
11 * Copyright (c) 2000 Guillaume Delvit based on Gerd Knorr source
14 * Copyright(c) 2005-2008 Mauro Carvalho Chehab
15 * - Some cleanups, code fixes, etc
16 * - Convert it to V4L2 API
18 * This code is placed under the terms of the GNU General Public License
21 * debug - set to 1 if you'd like to see debug messages
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>
39 #include <media/tvaudio.h>
40 #include <media/v4l2-device.h>
41 #include <media/v4l2-chip-ident.h>
43 #include <media/i2c-addr.h>
45 /* ---------------------------------------------------------------------- */
48 static int debug
; /* insmod parameter */
49 module_param(debug
, int, 0644);
51 MODULE_DESCRIPTION("device driver for various i2c TV sound decoder / audiomux chips");
52 MODULE_AUTHOR("Eric Sandeen, Steve VanDeBogart, Greg Alexander, Gerd Knorr");
53 MODULE_LICENSE("GPL");
57 /* ---------------------------------------------------------------------- */
63 typedef int (*getvalue
)(int);
64 typedef int (*checkit
)(struct CHIPSTATE
*);
65 typedef int (*initialize
)(struct CHIPSTATE
*);
66 typedef int (*getrxsubchans
)(struct CHIPSTATE
*);
67 typedef void (*setaudmode
)(struct CHIPSTATE
*, int mode
);
70 typedef struct AUDIOCMD
{
71 int count
; /* # of bytes to send */
72 unsigned char bytes
[MAXREGS
+1]; /* addr, data, data, ... */
75 /* chip description */
77 char *name
; /* chip name */
78 int addr_lo
, addr_hi
; /* i2c address range */
79 int registers
; /* # of registers */
83 initialize initialize
;
85 #define CHIP_HAS_VOLUME 1
86 #define CHIP_HAS_BASSTREBLE 2
87 #define CHIP_HAS_INPUTSEL 4
88 #define CHIP_NEED_CHECKMODE 8
90 /* various i2c command sequences */
93 /* which register has which value */
94 int leftreg
,rightreg
,treblereg
,bassreg
;
96 /* initialize with (defaults to 65535/65535/32768/32768 */
97 int leftinit
,rightinit
,trebleinit
,bassinit
;
99 /* functions to convert the values (v4l -> chip) */
100 getvalue volfunc
,treblefunc
,bassfunc
;
103 getrxsubchans getrxsubchans
;
104 setaudmode setaudmode
;
106 /* input switch register + values for v4l inputs */
113 /* current state of the chip */
115 struct v4l2_subdev sd
;
117 /* chip-specific description - should point to
118 an entry at CHIPDESC table */
119 struct CHIPDESC
*desc
;
121 /* shadow register set */
124 /* current settings */
125 __u16 left
, right
, treble
, bass
, muted
;
131 struct task_struct
*thread
;
132 struct timer_list wt
;
136 static inline struct CHIPSTATE
*to_state(struct v4l2_subdev
*sd
)
138 return container_of(sd
, struct CHIPSTATE
, sd
);
142 /* ---------------------------------------------------------------------- */
143 /* i2c I/O functions */
145 static int chip_write(struct CHIPSTATE
*chip
, int subaddr
, int val
)
147 struct v4l2_subdev
*sd
= &chip
->sd
;
148 struct i2c_client
*c
= v4l2_get_subdevdata(sd
);
149 unsigned char buffer
[2];
152 v4l2_dbg(1, debug
, sd
, "chip_write: 0x%x\n", val
);
153 chip
->shadow
.bytes
[1] = val
;
155 if (1 != i2c_master_send(c
, buffer
, 1)) {
156 v4l2_warn(sd
, "I/O error (write 0x%x)\n", val
);
160 if (subaddr
+ 1 >= ARRAY_SIZE(chip
->shadow
.bytes
)) {
162 "Tried to access a non-existent register: %d\n",
167 v4l2_dbg(1, debug
, sd
, "chip_write: reg%d=0x%x\n",
169 chip
->shadow
.bytes
[subaddr
+1] = val
;
172 if (2 != i2c_master_send(c
, buffer
, 2)) {
173 v4l2_warn(sd
, "I/O error (write reg%d=0x%x)\n",
181 static int chip_write_masked(struct CHIPSTATE
*chip
,
182 int subaddr
, int val
, int mask
)
184 struct v4l2_subdev
*sd
= &chip
->sd
;
188 val
= (chip
->shadow
.bytes
[1] & ~mask
) | (val
& mask
);
190 if (subaddr
+ 1 >= ARRAY_SIZE(chip
->shadow
.bytes
)) {
192 "Tried to access a non-existent register: %d\n",
197 val
= (chip
->shadow
.bytes
[subaddr
+1] & ~mask
) | (val
& mask
);
200 return chip_write(chip
, subaddr
, val
);
203 static int chip_read(struct CHIPSTATE
*chip
)
205 struct v4l2_subdev
*sd
= &chip
->sd
;
206 struct i2c_client
*c
= v4l2_get_subdevdata(sd
);
207 unsigned char buffer
;
209 if (1 != i2c_master_recv(c
, &buffer
, 1)) {
210 v4l2_warn(sd
, "I/O error (read)\n");
213 v4l2_dbg(1, debug
, sd
, "chip_read: 0x%x\n", buffer
);
217 static int chip_read2(struct CHIPSTATE
*chip
, int subaddr
)
219 struct v4l2_subdev
*sd
= &chip
->sd
;
220 struct i2c_client
*c
= v4l2_get_subdevdata(sd
);
221 unsigned char write
[1];
222 unsigned char read
[1];
223 struct i2c_msg msgs
[2] = {
239 if (2 != i2c_transfer(c
->adapter
, msgs
, 2)) {
240 v4l2_warn(sd
, "I/O error (read2)\n");
243 v4l2_dbg(1, debug
, sd
, "chip_read2: reg%d=0x%x\n",
248 static int chip_cmd(struct CHIPSTATE
*chip
, char *name
, audiocmd
*cmd
)
250 struct v4l2_subdev
*sd
= &chip
->sd
;
251 struct i2c_client
*c
= v4l2_get_subdevdata(sd
);
257 if (cmd
->count
+ cmd
->bytes
[0] - 1 >= ARRAY_SIZE(chip
->shadow
.bytes
)) {
259 "Tried to access a non-existent register range: %d to %d\n",
260 cmd
->bytes
[0] + 1, cmd
->bytes
[0] + cmd
->count
- 1);
264 /* FIXME: it seems that the shadow bytes are wrong bellow !*/
266 /* update our shadow register set; print bytes if (debug > 0) */
267 v4l2_dbg(1, debug
, sd
, "chip_cmd(%s): reg=%d, data:",
268 name
, cmd
->bytes
[0]);
269 for (i
= 1; i
< cmd
->count
; i
++) {
271 printk(KERN_CONT
" 0x%x", cmd
->bytes
[i
]);
272 chip
->shadow
.bytes
[i
+cmd
->bytes
[0]] = cmd
->bytes
[i
];
275 printk(KERN_CONT
"\n");
277 /* send data to the chip */
278 if (cmd
->count
!= i2c_master_send(c
, cmd
->bytes
, cmd
->count
)) {
279 v4l2_warn(sd
, "I/O error (%s)\n", name
);
285 /* ---------------------------------------------------------------------- */
286 /* kernel thread for doing i2c stuff asyncronly
287 * right now it is used only to check the audio mode (mono/stereo/whatever)
288 * some time after switching to another TV channel, then turn on stereo
292 static void chip_thread_wake(unsigned long data
)
294 struct CHIPSTATE
*chip
= (struct CHIPSTATE
*)data
;
295 wake_up_process(chip
->thread
);
298 static int chip_thread(void *data
)
300 struct CHIPSTATE
*chip
= data
;
301 struct CHIPDESC
*desc
= chip
->desc
;
302 struct v4l2_subdev
*sd
= &chip
->sd
;
305 v4l2_dbg(1, debug
, sd
, "thread started\n");
308 set_current_state(TASK_INTERRUPTIBLE
);
309 if (!kthread_should_stop())
311 set_current_state(TASK_RUNNING
);
313 if (kthread_should_stop())
315 v4l2_dbg(1, debug
, sd
, "thread wakeup\n");
317 /* don't do anything for radio */
321 /* have a look what's going on */
322 mode
= desc
->getrxsubchans(chip
);
323 if (mode
== chip
->prevmode
)
326 /* chip detected a new audio mode - set it */
327 v4l2_dbg(1, debug
, sd
, "thread checkmode\n");
329 chip
->prevmode
= mode
;
331 selected
= V4L2_TUNER_MODE_MONO
;
332 switch (chip
->audmode
) {
333 case V4L2_TUNER_MODE_MONO
:
334 if (mode
& V4L2_TUNER_SUB_LANG1
)
335 selected
= V4L2_TUNER_MODE_LANG1
;
337 case V4L2_TUNER_MODE_STEREO
:
338 case V4L2_TUNER_MODE_LANG1
:
339 if (mode
& V4L2_TUNER_SUB_LANG1
)
340 selected
= V4L2_TUNER_MODE_LANG1
;
341 else if (mode
& V4L2_TUNER_SUB_STEREO
)
342 selected
= V4L2_TUNER_MODE_STEREO
;
344 case V4L2_TUNER_MODE_LANG2
:
345 if (mode
& V4L2_TUNER_SUB_LANG2
)
346 selected
= V4L2_TUNER_MODE_LANG2
;
347 else if (mode
& V4L2_TUNER_SUB_STEREO
)
348 selected
= V4L2_TUNER_MODE_STEREO
;
350 case V4L2_TUNER_MODE_LANG1_LANG2
:
351 if (mode
& V4L2_TUNER_SUB_LANG2
)
352 selected
= V4L2_TUNER_MODE_LANG1_LANG2
;
353 else if (mode
& V4L2_TUNER_SUB_STEREO
)
354 selected
= V4L2_TUNER_MODE_STEREO
;
356 desc
->setaudmode(chip
, selected
);
358 /* schedule next check */
359 mod_timer(&chip
->wt
, jiffies
+msecs_to_jiffies(2000));
362 v4l2_dbg(1, debug
, sd
, "thread exiting\n");
366 /* ---------------------------------------------------------------------- */
367 /* audio chip descriptions - defines+functions for tda9840 */
369 #define TDA9840_SW 0x00
370 #define TDA9840_LVADJ 0x02
371 #define TDA9840_STADJ 0x03
372 #define TDA9840_TEST 0x04
374 #define TDA9840_MONO 0x10
375 #define TDA9840_STEREO 0x2a
376 #define TDA9840_DUALA 0x12
377 #define TDA9840_DUALB 0x1e
378 #define TDA9840_DUALAB 0x1a
379 #define TDA9840_DUALBA 0x16
380 #define TDA9840_EXTERNAL 0x7a
382 #define TDA9840_DS_DUAL 0x20 /* Dual sound identified */
383 #define TDA9840_ST_STEREO 0x40 /* Stereo sound identified */
384 #define TDA9840_PONRES 0x80 /* Power-on reset detected if = 1 */
386 #define TDA9840_TEST_INT1SN 0x1 /* Integration time 0.5s when set */
387 #define TDA9840_TEST_INTFU 0x02 /* Disables integrator function */
389 static int tda9840_getrxsubchans(struct CHIPSTATE
*chip
)
391 struct v4l2_subdev
*sd
= &chip
->sd
;
394 val
= chip_read(chip
);
395 mode
= V4L2_TUNER_SUB_MONO
;
396 if (val
& TDA9840_DS_DUAL
)
397 mode
|= V4L2_TUNER_SUB_LANG1
| V4L2_TUNER_SUB_LANG2
;
398 if (val
& TDA9840_ST_STEREO
)
399 mode
= V4L2_TUNER_SUB_STEREO
;
401 v4l2_dbg(1, debug
, sd
,
402 "tda9840_getrxsubchans(): raw chip read: %d, return: %d\n",
407 static void tda9840_setaudmode(struct CHIPSTATE
*chip
, int mode
)
410 int t
= chip
->shadow
.bytes
[TDA9840_SW
+ 1] & ~0x7e;
413 case V4L2_TUNER_MODE_MONO
:
416 case V4L2_TUNER_MODE_STEREO
:
419 case V4L2_TUNER_MODE_LANG1
:
422 case V4L2_TUNER_MODE_LANG2
:
425 case V4L2_TUNER_MODE_LANG1_LANG2
:
433 chip_write(chip
, TDA9840_SW
, t
);
436 static int tda9840_checkit(struct CHIPSTATE
*chip
)
439 rc
= chip_read(chip
);
440 /* lower 5 bits should be 0 */
441 return ((rc
& 0x1f) == 0) ? 1 : 0;
444 /* ---------------------------------------------------------------------- */
445 /* audio chip descriptions - defines+functions for tda985x */
447 /* subaddresses for TDA9855 */
448 #define TDA9855_VR 0x00 /* Volume, right */
449 #define TDA9855_VL 0x01 /* Volume, left */
450 #define TDA9855_BA 0x02 /* Bass */
451 #define TDA9855_TR 0x03 /* Treble */
452 #define TDA9855_SW 0x04 /* Subwoofer - not connected on DTV2000 */
454 /* subaddresses for TDA9850 */
455 #define TDA9850_C4 0x04 /* Control 1 for TDA9850 */
457 /* subaddesses for both chips */
458 #define TDA985x_C5 0x05 /* Control 2 for TDA9850, Control 1 for TDA9855 */
459 #define TDA985x_C6 0x06 /* Control 3 for TDA9850, Control 2 for TDA9855 */
460 #define TDA985x_C7 0x07 /* Control 4 for TDA9850, Control 3 for TDA9855 */
461 #define TDA985x_A1 0x08 /* Alignment 1 for both chips */
462 #define TDA985x_A2 0x09 /* Alignment 2 for both chips */
463 #define TDA985x_A3 0x0a /* Alignment 3 for both chips */
465 /* Masks for bits in TDA9855 subaddresses */
466 /* 0x00 - VR in TDA9855 */
467 /* 0x01 - VL in TDA9855 */
468 /* lower 7 bits control gain from -71dB (0x28) to 16dB (0x7f)
469 * in 1dB steps - mute is 0x27 */
472 /* 0x02 - BA in TDA9855 */
473 /* lower 5 bits control bass gain from -12dB (0x06) to 16.5dB (0x19)
474 * in .5dB steps - 0 is 0x0E */
477 /* 0x03 - TR in TDA9855 */
478 /* 4 bits << 1 control treble gain from -12dB (0x3) to 12dB (0xb)
479 * in 3dB steps - 0 is 0x7 */
481 /* Masks for bits in both chips' subaddresses */
482 /* 0x04 - SW in TDA9855, C4/Control 1 in TDA9850 */
483 /* Unique to TDA9855: */
484 /* 4 bits << 2 control subwoofer/surround gain from -14db (0x1) to 14db (0xf)
485 * in 3dB steps - mute is 0x0 */
487 /* Unique to TDA9850: */
488 /* lower 4 bits control stereo noise threshold, over which stereo turns off
489 * set to values of 0x00 through 0x0f for Ster1 through Ster16 */
492 /* 0x05 - C5 - Control 1 in TDA9855 , Control 2 in TDA9850*/
493 /* Unique to TDA9855: */
494 #define TDA9855_MUTE 1<<7 /* GMU, Mute at outputs */
495 #define TDA9855_AVL 1<<6 /* AVL, Automatic Volume Level */
496 #define TDA9855_LOUD 1<<5 /* Loudness, 1==off */
497 #define TDA9855_SUR 1<<3 /* Surround / Subwoofer 1==.5(L-R) 0==.5(L+R) */
498 /* Bits 0 to 3 select various combinations
499 * of line in and line out, only the
500 * interesting ones are defined */
501 #define TDA9855_EXT 1<<2 /* Selects inputs LIR and LIL. Pins 41 & 12 */
502 #define TDA9855_INT 0 /* Selects inputs LOR and LOL. (internal) */
504 /* Unique to TDA9850: */
505 /* lower 4 bits contol SAP noise threshold, over which SAP turns off
506 * set to values of 0x00 through 0x0f for SAP1 through SAP16 */
509 /* 0x06 - C6 - Control 2 in TDA9855, Control 3 in TDA9850 */
510 /* Common to TDA9855 and TDA9850: */
511 #define TDA985x_SAP 3<<6 /* Selects SAP output, mute if not received */
512 #define TDA985x_MONOSAP 2<<6 /* Selects Mono on left, SAP on right */
513 #define TDA985x_STEREO 1<<6 /* Selects Stereo ouput, mono if not received */
514 #define TDA985x_MONO 0 /* Forces Mono output */
515 #define TDA985x_LMU 1<<3 /* Mute (LOR/LOL for 9855, OUTL/OUTR for 9850) */
517 /* Unique to TDA9855: */
518 #define TDA9855_TZCM 1<<5 /* If set, don't mute till zero crossing */
519 #define TDA9855_VZCM 1<<4 /* If set, don't change volume till zero crossing*/
520 #define TDA9855_LINEAR 0 /* Linear Stereo */
521 #define TDA9855_PSEUDO 1 /* Pseudo Stereo */
522 #define TDA9855_SPAT_30 2 /* Spatial Stereo, 30% anti-phase crosstalk */
523 #define TDA9855_SPAT_50 3 /* Spatial Stereo, 52% anti-phase crosstalk */
524 #define TDA9855_E_MONO 7 /* Forced mono - mono select elseware, so useless*/
526 /* 0x07 - C7 - Control 3 in TDA9855, Control 4 in TDA9850 */
527 /* Common to both TDA9855 and TDA9850: */
528 /* lower 4 bits control input gain from -3.5dB (0x0) to 4dB (0xF)
529 * in .5dB steps - 0dB is 0x7 */
531 /* 0x08, 0x09 - A1 and A2 (read/write) */
532 /* Common to both TDA9855 and TDA9850: */
533 /* lower 5 bites are wideband and spectral expander alignment
534 * from 0x00 to 0x1f - nominal at 0x0f and 0x10 (read/write) */
535 #define TDA985x_STP 1<<5 /* Stereo Pilot/detect (read-only) */
536 #define TDA985x_SAPP 1<<6 /* SAP Pilot/detect (read-only) */
537 #define TDA985x_STS 1<<7 /* Stereo trigger 1= <35mV 0= <30mV (write-only)*/
540 /* Common to both TDA9855 and TDA9850: */
541 /* lower 3 bits control timing current for alignment: -30% (0x0), -20% (0x1),
542 * -10% (0x2), nominal (0x3), +10% (0x6), +20% (0x5), +30% (0x4) */
543 #define TDA985x_ADJ 1<<7 /* Stereo adjust on/off (wideband and spectral */
545 static int tda9855_volume(int val
) { return val
/0x2e8+0x27; }
546 static int tda9855_bass(int val
) { return val
/0xccc+0x06; }
547 static int tda9855_treble(int val
) { return (val
/0x1c71+0x3)<<1; }
549 static int tda985x_getrxsubchans(struct CHIPSTATE
*chip
)
553 /* Add mono mode regardless of SAP and stereo */
554 /* Allows forced mono */
555 mode
= V4L2_TUNER_SUB_MONO
;
556 val
= chip_read(chip
);
557 if (val
& TDA985x_STP
)
558 mode
= V4L2_TUNER_SUB_STEREO
;
559 if (val
& TDA985x_SAPP
)
560 mode
|= V4L2_TUNER_SUB_SAP
;
564 static void tda985x_setaudmode(struct CHIPSTATE
*chip
, int mode
)
567 int c6
= chip
->shadow
.bytes
[TDA985x_C6
+1] & 0x3f;
570 case V4L2_TUNER_MODE_MONO
:
573 case V4L2_TUNER_MODE_STEREO
:
574 case V4L2_TUNER_MODE_LANG1
:
575 c6
|= TDA985x_STEREO
;
577 case V4L2_TUNER_MODE_SAP
:
580 case V4L2_TUNER_MODE_LANG1_LANG2
:
581 c6
|= TDA985x_MONOSAP
;
587 chip_write(chip
,TDA985x_C6
,c6
);
591 /* ---------------------------------------------------------------------- */
592 /* audio chip descriptions - defines+functions for tda9873h */
594 /* Subaddresses for TDA9873H */
596 #define TDA9873_SW 0x00 /* Switching */
597 #define TDA9873_AD 0x01 /* Adjust */
598 #define TDA9873_PT 0x02 /* Port */
600 /* Subaddress 0x00: Switching Data
603 * B1, B0: Input source selection
605 * 1, 0 external stereo
608 #define TDA9873_INP_MASK 3
609 #define TDA9873_INTERNAL 0
610 #define TDA9873_EXT_STEREO 2
611 #define TDA9873_EXT_MONO 1
613 /* B3, B2: output signal select
614 * B4 : transmission mode
617 * 1, 1, 1 Stereo (reversed channel)
624 #define TDA9873_TR_MASK (7 << 2)
625 #define TDA9873_TR_MONO 4
626 #define TDA9873_TR_STEREO 1 << 4
627 #define TDA9873_TR_REVERSE ((1 << 3) | (1 << 2))
628 #define TDA9873_TR_DUALA 1 << 2
629 #define TDA9873_TR_DUALB 1 << 3
630 #define TDA9873_TR_DUALAB 0
632 /* output level controls
633 * B5: output level switch (0 = reduced gain, 1 = normal gain)
634 * B6: mute (1 = muted)
635 * B7: auto-mute (1 = auto-mute enabled)
638 #define TDA9873_GAIN_NORMAL 1 << 5
639 #define TDA9873_MUTE 1 << 6
640 #define TDA9873_AUTOMUTE 1 << 7
642 /* Subaddress 0x01: Adjust/standard */
644 /* Lower 4 bits (C3..C0) control stereo adjustment on R channel (-0.6 - +0.7 dB)
645 * Recommended value is +0 dB
648 #define TDA9873_STEREO_ADJ 0x06 /* 0dB gain */
650 /* Bits C6..C4 control FM stantard
652 * 0, 0, 0 B/G (PAL FM)
661 #define TDA9873_DK1 2
662 #define TDA9873_DK2 3
663 #define TDA9873_DK3 4
666 /* C7 controls identification response time (1=fast/0=normal)
668 #define TDA9873_IDR_NORM 0
669 #define TDA9873_IDR_FAST 1 << 7
672 /* Subaddress 0x02: Port data */
674 /* E1, E0 free programmable ports P1/P2
681 #define TDA9873_PORTS 3
684 #define TDA9873_TST_PORT 1 << 2
686 /* E5..E3 control mono output channel (together with transmission mode bit B4)
691 * 0 1 0 1 mono (from stereo decoder)
693 #define TDA9873_MOUT_MONO 0
694 #define TDA9873_MOUT_FMONO 0
695 #define TDA9873_MOUT_DUALA 0
696 #define TDA9873_MOUT_DUALB 1 << 3
697 #define TDA9873_MOUT_ST 1 << 4
698 #define TDA9873_MOUT_EXTM ((1 << 4) | (1 << 3))
699 #define TDA9873_MOUT_EXTL 1 << 5
700 #define TDA9873_MOUT_EXTR ((1 << 5) | (1 << 3))
701 #define TDA9873_MOUT_EXTLR ((1 << 5) | (1 << 4))
702 #define TDA9873_MOUT_MUTE ((1 << 5) | (1 << 4) | (1 << 3))
704 /* Status bits: (chip read) */
705 #define TDA9873_PONR 0 /* Power-on reset detected if = 1 */
706 #define TDA9873_STEREO 2 /* Stereo sound is identified */
707 #define TDA9873_DUAL 4 /* Dual sound is identified */
709 static int tda9873_getrxsubchans(struct CHIPSTATE
*chip
)
711 struct v4l2_subdev
*sd
= &chip
->sd
;
714 val
= chip_read(chip
);
715 mode
= V4L2_TUNER_SUB_MONO
;
716 if (val
& TDA9873_STEREO
)
717 mode
= V4L2_TUNER_SUB_STEREO
;
718 if (val
& TDA9873_DUAL
)
719 mode
|= V4L2_TUNER_SUB_LANG1
| V4L2_TUNER_SUB_LANG2
;
720 v4l2_dbg(1, debug
, sd
,
721 "tda9873_getrxsubchans(): raw chip read: %d, return: %d\n",
726 static void tda9873_setaudmode(struct CHIPSTATE
*chip
, int mode
)
728 struct v4l2_subdev
*sd
= &chip
->sd
;
729 int sw_data
= chip
->shadow
.bytes
[TDA9873_SW
+1] & ~ TDA9873_TR_MASK
;
730 /* int adj_data = chip->shadow.bytes[TDA9873_AD+1] ; */
732 if ((sw_data
& TDA9873_INP_MASK
) != TDA9873_INTERNAL
) {
733 v4l2_dbg(1, debug
, sd
,
734 "tda9873_setaudmode(): external input\n");
738 v4l2_dbg(1, debug
, sd
,
739 "tda9873_setaudmode(): chip->shadow.bytes[%d] = %d\n",
740 TDA9873_SW
+1, chip
->shadow
.bytes
[TDA9873_SW
+1]);
741 v4l2_dbg(1, debug
, sd
, "tda9873_setaudmode(): sw_data = %d\n",
745 case V4L2_TUNER_MODE_MONO
:
746 sw_data
|= TDA9873_TR_MONO
;
748 case V4L2_TUNER_MODE_STEREO
:
749 sw_data
|= TDA9873_TR_STEREO
;
751 case V4L2_TUNER_MODE_LANG1
:
752 sw_data
|= TDA9873_TR_DUALA
;
754 case V4L2_TUNER_MODE_LANG2
:
755 sw_data
|= TDA9873_TR_DUALB
;
757 case V4L2_TUNER_MODE_LANG1_LANG2
:
758 sw_data
|= TDA9873_TR_DUALAB
;
764 chip_write(chip
, TDA9873_SW
, sw_data
);
765 v4l2_dbg(1, debug
, sd
,
766 "tda9873_setaudmode(): req. mode %d; chip_write: %d\n",
770 static int tda9873_checkit(struct CHIPSTATE
*chip
)
774 if (-1 == (rc
= chip_read2(chip
,254)))
776 return (rc
& ~0x1f) == 0x80;
780 /* ---------------------------------------------------------------------- */
781 /* audio chip description - defines+functions for tda9874h and tda9874a */
782 /* Dariusz Kowalewski <darekk@automex.pl> */
784 /* Subaddresses for TDA9874H and TDA9874A (slave rx) */
785 #define TDA9874A_AGCGR 0x00 /* AGC gain */
786 #define TDA9874A_GCONR 0x01 /* general config */
787 #define TDA9874A_MSR 0x02 /* monitor select */
788 #define TDA9874A_C1FRA 0x03 /* carrier 1 freq. */
789 #define TDA9874A_C1FRB 0x04 /* carrier 1 freq. */
790 #define TDA9874A_C1FRC 0x05 /* carrier 1 freq. */
791 #define TDA9874A_C2FRA 0x06 /* carrier 2 freq. */
792 #define TDA9874A_C2FRB 0x07 /* carrier 2 freq. */
793 #define TDA9874A_C2FRC 0x08 /* carrier 2 freq. */
794 #define TDA9874A_DCR 0x09 /* demodulator config */
795 #define TDA9874A_FMER 0x0a /* FM de-emphasis */
796 #define TDA9874A_FMMR 0x0b /* FM dematrix */
797 #define TDA9874A_C1OLAR 0x0c /* ch.1 output level adj. */
798 #define TDA9874A_C2OLAR 0x0d /* ch.2 output level adj. */
799 #define TDA9874A_NCONR 0x0e /* NICAM config */
800 #define TDA9874A_NOLAR 0x0f /* NICAM output level adj. */
801 #define TDA9874A_NLELR 0x10 /* NICAM lower error limit */
802 #define TDA9874A_NUELR 0x11 /* NICAM upper error limit */
803 #define TDA9874A_AMCONR 0x12 /* audio mute control */
804 #define TDA9874A_SDACOSR 0x13 /* stereo DAC output select */
805 #define TDA9874A_AOSR 0x14 /* analog output select */
806 #define TDA9874A_DAICONR 0x15 /* digital audio interface config */
807 #define TDA9874A_I2SOSR 0x16 /* I2S-bus output select */
808 #define TDA9874A_I2SOLAR 0x17 /* I2S-bus output level adj. */
809 #define TDA9874A_MDACOSR 0x18 /* mono DAC output select (tda9874a) */
810 #define TDA9874A_ESP 0xFF /* easy standard progr. (tda9874a) */
812 /* Subaddresses for TDA9874H and TDA9874A (slave tx) */
813 #define TDA9874A_DSR 0x00 /* device status */
814 #define TDA9874A_NSR 0x01 /* NICAM status */
815 #define TDA9874A_NECR 0x02 /* NICAM error count */
816 #define TDA9874A_DR1 0x03 /* add. data LSB */
817 #define TDA9874A_DR2 0x04 /* add. data MSB */
818 #define TDA9874A_LLRA 0x05 /* monitor level read-out LSB */
819 #define TDA9874A_LLRB 0x06 /* monitor level read-out MSB */
820 #define TDA9874A_SIFLR 0x07 /* SIF level */
821 #define TDA9874A_TR2 252 /* test reg. 2 */
822 #define TDA9874A_TR1 253 /* test reg. 1 */
823 #define TDA9874A_DIC 254 /* device id. code */
824 #define TDA9874A_SIC 255 /* software id. code */
827 static int tda9874a_mode
= 1; /* 0: A2, 1: NICAM */
828 static int tda9874a_GCONR
= 0xc0; /* default config. input pin: SIFSEL=0 */
829 static int tda9874a_NCONR
= 0x01; /* default NICAM config.: AMSEL=0,AMUTE=1 */
830 static int tda9874a_ESP
= 0x07; /* default standard: NICAM D/K */
831 static int tda9874a_dic
= -1; /* device id. code */
833 /* insmod options for tda9874a */
834 static unsigned int tda9874a_SIF
= UNSET
;
835 static unsigned int tda9874a_AMSEL
= UNSET
;
836 static unsigned int tda9874a_STD
= UNSET
;
837 module_param(tda9874a_SIF
, int, 0444);
838 module_param(tda9874a_AMSEL
, int, 0444);
839 module_param(tda9874a_STD
, int, 0444);
842 * initialization table for tda9874 decoder:
843 * - carrier 1 freq. registers (3 bytes)
844 * - carrier 2 freq. registers (3 bytes)
845 * - demudulator config register
846 * - FM de-emphasis register (slow identification mode)
847 * Note: frequency registers must be written in single i2c transfer.
849 static struct tda9874a_MODES
{
852 } tda9874a_modelist
[9] = {
853 { "A2, B/G", /* default */
854 { 9, { TDA9874A_C1FRA
, 0x72,0x95,0x55, 0x77,0xA0,0x00, 0x00,0x00 }} },
856 { 9, { TDA9874A_C1FRA
, 0x5D,0xC0,0x00, 0x62,0x6A,0xAA, 0x20,0x22 }} },
858 { 9, { TDA9874A_C1FRA
, 0x87,0x6A,0xAA, 0x82,0x60,0x00, 0x00,0x00 }} },
860 { 9, { TDA9874A_C1FRA
, 0x87,0x6A,0xAA, 0x8C,0x75,0x55, 0x00,0x00 }} },
862 { 9, { TDA9874A_C1FRA
, 0x87,0x6A,0xAA, 0x77,0xA0,0x00, 0x00,0x00 }} },
864 { 9, { TDA9874A_C1FRA
, 0x7D,0x00,0x00, 0x88,0x8A,0xAA, 0x08,0x33 }} },
866 { 9, { TDA9874A_C1FRA
, 0x72,0x95,0x55, 0x79,0xEA,0xAA, 0x08,0x33 }} },
868 { 9, { TDA9874A_C1FRA
, 0x87,0x6A,0xAA, 0x79,0xEA,0xAA, 0x08,0x33 }} },
870 { 9, { TDA9874A_C1FRA
, 0x87,0x6A,0xAA, 0x79,0xEA,0xAA, 0x09,0x33 }} }
873 static int tda9874a_setup(struct CHIPSTATE
*chip
)
875 struct v4l2_subdev
*sd
= &chip
->sd
;
877 chip_write(chip
, TDA9874A_AGCGR
, 0x00); /* 0 dB */
878 chip_write(chip
, TDA9874A_GCONR
, tda9874a_GCONR
);
879 chip_write(chip
, TDA9874A_MSR
, (tda9874a_mode
) ? 0x03:0x02);
880 if(tda9874a_dic
== 0x11) {
881 chip_write(chip
, TDA9874A_FMMR
, 0x80);
882 } else { /* dic == 0x07 */
883 chip_cmd(chip
,"tda9874_modelist",&tda9874a_modelist
[tda9874a_STD
].cmd
);
884 chip_write(chip
, TDA9874A_FMMR
, 0x00);
886 chip_write(chip
, TDA9874A_C1OLAR
, 0x00); /* 0 dB */
887 chip_write(chip
, TDA9874A_C2OLAR
, 0x00); /* 0 dB */
888 chip_write(chip
, TDA9874A_NCONR
, tda9874a_NCONR
);
889 chip_write(chip
, TDA9874A_NOLAR
, 0x00); /* 0 dB */
890 /* Note: If signal quality is poor you may want to change NICAM */
891 /* error limit registers (NLELR and NUELR) to some greater values. */
892 /* Then the sound would remain stereo, but won't be so clear. */
893 chip_write(chip
, TDA9874A_NLELR
, 0x14); /* default */
894 chip_write(chip
, TDA9874A_NUELR
, 0x50); /* default */
896 if(tda9874a_dic
== 0x11) {
897 chip_write(chip
, TDA9874A_AMCONR
, 0xf9);
898 chip_write(chip
, TDA9874A_SDACOSR
, (tda9874a_mode
) ? 0x81:0x80);
899 chip_write(chip
, TDA9874A_AOSR
, 0x80);
900 chip_write(chip
, TDA9874A_MDACOSR
, (tda9874a_mode
) ? 0x82:0x80);
901 chip_write(chip
, TDA9874A_ESP
, tda9874a_ESP
);
902 } else { /* dic == 0x07 */
903 chip_write(chip
, TDA9874A_AMCONR
, 0xfb);
904 chip_write(chip
, TDA9874A_SDACOSR
, (tda9874a_mode
) ? 0x81:0x80);
905 chip_write(chip
, TDA9874A_AOSR
, 0x00); /* or 0x10 */
907 v4l2_dbg(1, debug
, sd
, "tda9874a_setup(): %s [0x%02X].\n",
908 tda9874a_modelist
[tda9874a_STD
].name
,tda9874a_STD
);
912 static int tda9874a_getrxsubchans(struct CHIPSTATE
*chip
)
914 struct v4l2_subdev
*sd
= &chip
->sd
;
916 int necr
; /* just for debugging */
918 mode
= V4L2_TUNER_SUB_MONO
;
920 if(-1 == (dsr
= chip_read2(chip
,TDA9874A_DSR
)))
922 if(-1 == (nsr
= chip_read2(chip
,TDA9874A_NSR
)))
924 if(-1 == (necr
= chip_read2(chip
,TDA9874A_NECR
)))
927 /* need to store dsr/nsr somewhere */
928 chip
->shadow
.bytes
[MAXREGS
-2] = dsr
;
929 chip
->shadow
.bytes
[MAXREGS
-1] = nsr
;
932 /* Note: DSR.RSSF and DSR.AMSTAT bits are also checked.
933 * If NICAM auto-muting is enabled, DSR.AMSTAT=1 indicates
934 * that sound has (temporarily) switched from NICAM to
935 * mono FM (or AM) on 1st sound carrier due to high NICAM bit
936 * error count. So in fact there is no stereo in this case :-(
937 * But changing the mode to V4L2_TUNER_MODE_MONO would switch
938 * external 4052 multiplexer in audio_hook().
940 if(nsr
& 0x02) /* NSR.S/MB=1 */
941 mode
= V4L2_TUNER_SUB_STEREO
;
942 if(nsr
& 0x01) /* NSR.D/SB=1 */
943 mode
|= V4L2_TUNER_SUB_LANG1
| V4L2_TUNER_SUB_LANG2
;
945 if(dsr
& 0x02) /* DSR.IDSTE=1 */
946 mode
= V4L2_TUNER_SUB_STEREO
;
947 if(dsr
& 0x04) /* DSR.IDDUA=1 */
948 mode
|= V4L2_TUNER_SUB_LANG1
| V4L2_TUNER_SUB_LANG2
;
951 v4l2_dbg(1, debug
, sd
,
952 "tda9874a_getrxsubchans(): DSR=0x%X, NSR=0x%X, NECR=0x%X, return: %d.\n",
953 dsr
, nsr
, necr
, mode
);
957 static void tda9874a_setaudmode(struct CHIPSTATE
*chip
, int mode
)
959 struct v4l2_subdev
*sd
= &chip
->sd
;
961 /* Disable/enable NICAM auto-muting (based on DSR.RSSF status bit). */
962 /* If auto-muting is disabled, we can hear a signal of degrading quality. */
964 if(chip
->shadow
.bytes
[MAXREGS
-2] & 0x20) /* DSR.RSSF=1 */
965 tda9874a_NCONR
&= 0xfe; /* enable */
967 tda9874a_NCONR
|= 0x01; /* disable */
968 chip_write(chip
, TDA9874A_NCONR
, tda9874a_NCONR
);
971 /* Note: TDA9874A supports automatic FM dematrixing (FMMR register)
972 * and has auto-select function for audio output (AOSR register).
973 * Old TDA9874H doesn't support these features.
974 * TDA9874A also has additional mono output pin (OUTM), which
975 * on same (all?) tv-cards is not used, anyway (as well as MONOIN).
977 if(tda9874a_dic
== 0x11) {
979 int mdacosr
= (tda9874a_mode
) ? 0x82:0x80;
982 case V4L2_TUNER_MODE_MONO
:
983 case V4L2_TUNER_MODE_STEREO
:
985 case V4L2_TUNER_MODE_LANG1
:
986 aosr
= 0x80; /* auto-select, dual A/A */
987 mdacosr
= (tda9874a_mode
) ? 0x82:0x80;
989 case V4L2_TUNER_MODE_LANG2
:
990 aosr
= 0xa0; /* auto-select, dual B/B */
991 mdacosr
= (tda9874a_mode
) ? 0x83:0x81;
993 case V4L2_TUNER_MODE_LANG1_LANG2
:
994 aosr
= 0x00; /* always route L to L and R to R */
995 mdacosr
= (tda9874a_mode
) ? 0x82:0x80;
1000 chip_write(chip
, TDA9874A_AOSR
, aosr
);
1001 chip_write(chip
, TDA9874A_MDACOSR
, mdacosr
);
1003 v4l2_dbg(1, debug
, sd
,
1004 "tda9874a_setaudmode(): req. mode %d; AOSR=0x%X, MDACOSR=0x%X.\n",
1005 mode
, aosr
, mdacosr
);
1007 } else { /* dic == 0x07 */
1011 case V4L2_TUNER_MODE_MONO
:
1012 fmmr
= 0x00; /* mono */
1013 aosr
= 0x10; /* A/A */
1015 case V4L2_TUNER_MODE_STEREO
:
1018 aosr
= 0x00; /* handled by NICAM auto-mute */
1020 fmmr
= (tda9874a_ESP
== 1) ? 0x05 : 0x04; /* stereo */
1024 case V4L2_TUNER_MODE_LANG1
:
1025 fmmr
= 0x02; /* dual */
1026 aosr
= 0x10; /* dual A/A */
1028 case V4L2_TUNER_MODE_LANG2
:
1029 fmmr
= 0x02; /* dual */
1030 aosr
= 0x20; /* dual B/B */
1032 case V4L2_TUNER_MODE_LANG1_LANG2
:
1033 fmmr
= 0x02; /* dual */
1034 aosr
= 0x00; /* dual A/B */
1039 chip_write(chip
, TDA9874A_FMMR
, fmmr
);
1040 chip_write(chip
, TDA9874A_AOSR
, aosr
);
1042 v4l2_dbg(1, debug
, sd
,
1043 "tda9874a_setaudmode(): req. mode %d; FMMR=0x%X, AOSR=0x%X.\n",
1048 static int tda9874a_checkit(struct CHIPSTATE
*chip
)
1050 struct v4l2_subdev
*sd
= &chip
->sd
;
1051 int dic
,sic
; /* device id. and software id. codes */
1053 if(-1 == (dic
= chip_read2(chip
,TDA9874A_DIC
)))
1055 if(-1 == (sic
= chip_read2(chip
,TDA9874A_SIC
)))
1058 v4l2_dbg(1, debug
, sd
, "tda9874a_checkit(): DIC=0x%X, SIC=0x%X.\n", dic
, sic
);
1060 if((dic
== 0x11)||(dic
== 0x07)) {
1061 v4l2_info(sd
, "found tda9874%s.\n", (dic
== 0x11) ? "a" : "h");
1062 tda9874a_dic
= dic
; /* remember device id. */
1065 return 0; /* not found */
1068 static int tda9874a_initialize(struct CHIPSTATE
*chip
)
1070 if (tda9874a_SIF
> 2)
1072 if (tda9874a_STD
>= ARRAY_SIZE(tda9874a_modelist
))
1074 if(tda9874a_AMSEL
> 1)
1077 if(tda9874a_SIF
== 1)
1078 tda9874a_GCONR
= 0xc0; /* sound IF input 1 */
1080 tda9874a_GCONR
= 0xc1; /* sound IF input 2 */
1082 tda9874a_ESP
= tda9874a_STD
;
1083 tda9874a_mode
= (tda9874a_STD
< 5) ? 0 : 1;
1085 if(tda9874a_AMSEL
== 0)
1086 tda9874a_NCONR
= 0x01; /* auto-mute: analog mono input */
1088 tda9874a_NCONR
= 0x05; /* auto-mute: 1st carrier FM or AM */
1090 tda9874a_setup(chip
);
1094 /* ---------------------------------------------------------------------- */
1095 /* audio chip description - defines+functions for tda9875 */
1096 /* The TDA9875 is made by Philips Semiconductor
1097 * http://www.semiconductors.philips.com
1098 * TDA9875: I2C-bus controlled DSP audio processor, FM demodulator
1102 /* subaddresses for TDA9875 */
1103 #define TDA9875_MUT 0x12 /*General mute (value --> 0b11001100*/
1104 #define TDA9875_CFG 0x01 /* Config register (value --> 0b00000000 */
1105 #define TDA9875_DACOS 0x13 /*DAC i/o select (ADC) 0b0000100*/
1106 #define TDA9875_LOSR 0x16 /*Line output select regirter 0b0100 0001*/
1108 #define TDA9875_CH1V 0x0c /*Channel 1 volume (mute)*/
1109 #define TDA9875_CH2V 0x0d /*Channel 2 volume (mute)*/
1110 #define TDA9875_SC1 0x14 /*SCART 1 in (mono)*/
1111 #define TDA9875_SC2 0x15 /*SCART 2 in (mono)*/
1113 #define TDA9875_ADCIS 0x17 /*ADC input select (mono) 0b0110 000*/
1114 #define TDA9875_AER 0x19 /*Audio effect (AVL+Pseudo) 0b0000 0110*/
1115 #define TDA9875_MCS 0x18 /*Main channel select (DAC) 0b0000100*/
1116 #define TDA9875_MVL 0x1a /* Main volume gauche */
1117 #define TDA9875_MVR 0x1b /* Main volume droite */
1118 #define TDA9875_MBA 0x1d /* Main Basse */
1119 #define TDA9875_MTR 0x1e /* Main treble */
1120 #define TDA9875_ACS 0x1f /* Auxiliary channel select (FM) 0b0000000*/
1121 #define TDA9875_AVL 0x20 /* Auxiliary volume gauche */
1122 #define TDA9875_AVR 0x21 /* Auxiliary volume droite */
1123 #define TDA9875_ABA 0x22 /* Auxiliary Basse */
1124 #define TDA9875_ATR 0x23 /* Auxiliary treble */
1126 #define TDA9875_MSR 0x02 /* Monitor select register */
1127 #define TDA9875_C1MSB 0x03 /* Carrier 1 (FM) frequency register MSB */
1128 #define TDA9875_C1MIB 0x04 /* Carrier 1 (FM) frequency register (16-8]b */
1129 #define TDA9875_C1LSB 0x05 /* Carrier 1 (FM) frequency register LSB */
1130 #define TDA9875_C2MSB 0x06 /* Carrier 2 (nicam) frequency register MSB */
1131 #define TDA9875_C2MIB 0x07 /* Carrier 2 (nicam) frequency register (16-8]b */
1132 #define TDA9875_C2LSB 0x08 /* Carrier 2 (nicam) frequency register LSB */
1133 #define TDA9875_DCR 0x09 /* Demodulateur configuration regirter*/
1134 #define TDA9875_DEEM 0x0a /* FM de-emphasis regirter*/
1135 #define TDA9875_FMAT 0x0b /* FM Matrix regirter*/
1138 #define TDA9875_MUTE_ON 0xff /* general mute */
1139 #define TDA9875_MUTE_OFF 0xcc /* general no mute */
1141 static int tda9875_initialize(struct CHIPSTATE
*chip
)
1143 chip_write(chip
, TDA9875_CFG
, 0xd0); /*reg de config 0 (reset)*/
1144 chip_write(chip
, TDA9875_MSR
, 0x03); /* Monitor 0b00000XXX*/
1145 chip_write(chip
, TDA9875_C1MSB
, 0x00); /*Car1(FM) MSB XMHz*/
1146 chip_write(chip
, TDA9875_C1MIB
, 0x00); /*Car1(FM) MIB XMHz*/
1147 chip_write(chip
, TDA9875_C1LSB
, 0x00); /*Car1(FM) LSB XMHz*/
1148 chip_write(chip
, TDA9875_C2MSB
, 0x00); /*Car2(NICAM) MSB XMHz*/
1149 chip_write(chip
, TDA9875_C2MIB
, 0x00); /*Car2(NICAM) MIB XMHz*/
1150 chip_write(chip
, TDA9875_C2LSB
, 0x00); /*Car2(NICAM) LSB XMHz*/
1151 chip_write(chip
, TDA9875_DCR
, 0x00); /*Demod config 0x00*/
1152 chip_write(chip
, TDA9875_DEEM
, 0x44); /*DE-Emph 0b0100 0100*/
1153 chip_write(chip
, TDA9875_FMAT
, 0x00); /*FM Matrix reg 0x00*/
1154 chip_write(chip
, TDA9875_SC1
, 0x00); /* SCART 1 (SC1)*/
1155 chip_write(chip
, TDA9875_SC2
, 0x01); /* SCART 2 (sc2)*/
1157 chip_write(chip
, TDA9875_CH1V
, 0x10); /* Channel volume 1 mute*/
1158 chip_write(chip
, TDA9875_CH2V
, 0x10); /* Channel volume 2 mute */
1159 chip_write(chip
, TDA9875_DACOS
, 0x02); /* sig DAC i/o(in:nicam)*/
1160 chip_write(chip
, TDA9875_ADCIS
, 0x6f); /* sig ADC input(in:mono)*/
1161 chip_write(chip
, TDA9875_LOSR
, 0x00); /* line out (in:mono)*/
1162 chip_write(chip
, TDA9875_AER
, 0x00); /*06 Effect (AVL+PSEUDO) */
1163 chip_write(chip
, TDA9875_MCS
, 0x44); /* Main ch select (DAC) */
1164 chip_write(chip
, TDA9875_MVL
, 0x03); /* Vol Main left 10dB */
1165 chip_write(chip
, TDA9875_MVR
, 0x03); /* Vol Main right 10dB*/
1166 chip_write(chip
, TDA9875_MBA
, 0x00); /* Main Bass Main 0dB*/
1167 chip_write(chip
, TDA9875_MTR
, 0x00); /* Main Treble Main 0dB*/
1168 chip_write(chip
, TDA9875_ACS
, 0x44); /* Aux chan select (dac)*/
1169 chip_write(chip
, TDA9875_AVL
, 0x00); /* Vol Aux left 0dB*/
1170 chip_write(chip
, TDA9875_AVR
, 0x00); /* Vol Aux right 0dB*/
1171 chip_write(chip
, TDA9875_ABA
, 0x00); /* Aux Bass Main 0dB*/
1172 chip_write(chip
, TDA9875_ATR
, 0x00); /* Aux Aigus Main 0dB*/
1174 chip_write(chip
, TDA9875_MUT
, 0xcc); /* General mute */
1178 static int tda9875_volume(int val
) { return (unsigned char)(val
/ 602 - 84); }
1179 static int tda9875_bass(int val
) { return (unsigned char)(max(-12, val
/ 2115 - 15)); }
1180 static int tda9875_treble(int val
) { return (unsigned char)(val
/ 2622 - 12); }
1182 /* ----------------------------------------------------------------------- */
1185 /* *********************** *
1186 * i2c interface functions *
1187 * *********************** */
1189 static int tda9875_checkit(struct CHIPSTATE
*chip
)
1191 struct v4l2_subdev
*sd
= &chip
->sd
;
1194 dic
= chip_read2(chip
, 254);
1195 rev
= chip_read2(chip
, 255);
1197 if (dic
== 0 || dic
== 2) { /* tda9875 and tda9875A */
1198 v4l2_info(sd
, "found tda9875%s rev. %d.\n",
1199 dic
== 0 ? "" : "A", rev
);
1205 /* ---------------------------------------------------------------------- */
1206 /* audio chip descriptions - defines+functions for tea6420 */
1208 #define TEA6300_VL 0x00 /* volume left */
1209 #define TEA6300_VR 0x01 /* volume right */
1210 #define TEA6300_BA 0x02 /* bass */
1211 #define TEA6300_TR 0x03 /* treble */
1212 #define TEA6300_FA 0x04 /* fader control */
1213 #define TEA6300_S 0x05 /* switch register */
1214 /* values for those registers: */
1215 #define TEA6300_S_SA 0x01 /* stereo A input */
1216 #define TEA6300_S_SB 0x02 /* stereo B */
1217 #define TEA6300_S_SC 0x04 /* stereo C */
1218 #define TEA6300_S_GMU 0x80 /* general mute */
1220 #define TEA6320_V 0x00 /* volume (0-5)/loudness off (6)/zero crossing mute(7) */
1221 #define TEA6320_FFR 0x01 /* fader front right (0-5) */
1222 #define TEA6320_FFL 0x02 /* fader front left (0-5) */
1223 #define TEA6320_FRR 0x03 /* fader rear right (0-5) */
1224 #define TEA6320_FRL 0x04 /* fader rear left (0-5) */
1225 #define TEA6320_BA 0x05 /* bass (0-4) */
1226 #define TEA6320_TR 0x06 /* treble (0-4) */
1227 #define TEA6320_S 0x07 /* switch register */
1228 /* values for those registers: */
1229 #define TEA6320_S_SA 0x07 /* stereo A input */
1230 #define TEA6320_S_SB 0x06 /* stereo B */
1231 #define TEA6320_S_SC 0x05 /* stereo C */
1232 #define TEA6320_S_SD 0x04 /* stereo D */
1233 #define TEA6320_S_GMU 0x80 /* general mute */
1235 #define TEA6420_S_SA 0x00 /* stereo A input */
1236 #define TEA6420_S_SB 0x01 /* stereo B */
1237 #define TEA6420_S_SC 0x02 /* stereo C */
1238 #define TEA6420_S_SD 0x03 /* stereo D */
1239 #define TEA6420_S_SE 0x04 /* stereo E */
1240 #define TEA6420_S_GMU 0x05 /* general mute */
1242 static int tea6300_shift10(int val
) { return val
>> 10; }
1243 static int tea6300_shift12(int val
) { return val
>> 12; }
1245 /* Assumes 16bit input (values 0x3f to 0x0c are unique, values less than */
1246 /* 0x0c mirror those immediately higher) */
1247 static int tea6320_volume(int val
) { return (val
/ (65535/(63-12)) + 12) & 0x3f; }
1248 static int tea6320_shift11(int val
) { return val
>> 11; }
1249 static int tea6320_initialize(struct CHIPSTATE
* chip
)
1251 chip_write(chip
, TEA6320_FFR
, 0x3f);
1252 chip_write(chip
, TEA6320_FFL
, 0x3f);
1253 chip_write(chip
, TEA6320_FRR
, 0x3f);
1254 chip_write(chip
, TEA6320_FRL
, 0x3f);
1260 /* ---------------------------------------------------------------------- */
1261 /* audio chip descriptions - defines+functions for tda8425 */
1263 #define TDA8425_VL 0x00 /* volume left */
1264 #define TDA8425_VR 0x01 /* volume right */
1265 #define TDA8425_BA 0x02 /* bass */
1266 #define TDA8425_TR 0x03 /* treble */
1267 #define TDA8425_S1 0x08 /* switch functions */
1268 /* values for those registers: */
1269 #define TDA8425_S1_OFF 0xEE /* audio off (mute on) */
1270 #define TDA8425_S1_CH1 0xCE /* audio channel 1 (mute off) - "linear stereo" mode */
1271 #define TDA8425_S1_CH2 0xCF /* audio channel 2 (mute off) - "linear stereo" mode */
1272 #define TDA8425_S1_MU 0x20 /* mute bit */
1273 #define TDA8425_S1_STEREO 0x18 /* stereo bits */
1274 #define TDA8425_S1_STEREO_SPATIAL 0x18 /* spatial stereo */
1275 #define TDA8425_S1_STEREO_LINEAR 0x08 /* linear stereo */
1276 #define TDA8425_S1_STEREO_PSEUDO 0x10 /* pseudo stereo */
1277 #define TDA8425_S1_STEREO_MONO 0x00 /* forced mono */
1278 #define TDA8425_S1_ML 0x06 /* language selector */
1279 #define TDA8425_S1_ML_SOUND_A 0x02 /* sound a */
1280 #define TDA8425_S1_ML_SOUND_B 0x04 /* sound b */
1281 #define TDA8425_S1_ML_STEREO 0x06 /* stereo */
1282 #define TDA8425_S1_IS 0x01 /* channel selector */
1285 static int tda8425_shift10(int val
) { return (val
>> 10) | 0xc0; }
1286 static int tda8425_shift12(int val
) { return (val
>> 12) | 0xf0; }
1288 static void tda8425_setaudmode(struct CHIPSTATE
*chip
, int mode
)
1290 int s1
= chip
->shadow
.bytes
[TDA8425_S1
+1] & 0xe1;
1293 case V4L2_TUNER_MODE_LANG1
:
1294 s1
|= TDA8425_S1_ML_SOUND_A
;
1295 s1
|= TDA8425_S1_STEREO_PSEUDO
;
1297 case V4L2_TUNER_MODE_LANG2
:
1298 s1
|= TDA8425_S1_ML_SOUND_B
;
1299 s1
|= TDA8425_S1_STEREO_PSEUDO
;
1301 case V4L2_TUNER_MODE_LANG1_LANG2
:
1302 s1
|= TDA8425_S1_ML_STEREO
;
1303 s1
|= TDA8425_S1_STEREO_LINEAR
;
1305 case V4L2_TUNER_MODE_MONO
:
1306 s1
|= TDA8425_S1_ML_STEREO
;
1307 s1
|= TDA8425_S1_STEREO_MONO
;
1309 case V4L2_TUNER_MODE_STEREO
:
1310 s1
|= TDA8425_S1_ML_STEREO
;
1311 s1
|= TDA8425_S1_STEREO_SPATIAL
;
1316 chip_write(chip
,TDA8425_S1
,s1
);
1320 /* ---------------------------------------------------------------------- */
1321 /* audio chip descriptions - defines+functions for pic16c54 (PV951) */
1323 /* the registers of 16C54, I2C sub address. */
1324 #define PIC16C54_REG_KEY_CODE 0x01 /* Not use. */
1325 #define PIC16C54_REG_MISC 0x02
1327 /* bit definition of the RESET register, I2C data. */
1328 #define PIC16C54_MISC_RESET_REMOTE_CTL 0x01 /* bit 0, Reset to receive the key */
1329 /* code of remote controller */
1330 #define PIC16C54_MISC_MTS_MAIN 0x02 /* bit 1 */
1331 #define PIC16C54_MISC_MTS_SAP 0x04 /* bit 2 */
1332 #define PIC16C54_MISC_MTS_BOTH 0x08 /* bit 3 */
1333 #define PIC16C54_MISC_SND_MUTE 0x10 /* bit 4, Mute Audio(Line-in and Tuner) */
1334 #define PIC16C54_MISC_SND_NOTMUTE 0x20 /* bit 5 */
1335 #define PIC16C54_MISC_SWITCH_TUNER 0x40 /* bit 6 , Switch to Line-in */
1336 #define PIC16C54_MISC_SWITCH_LINE 0x80 /* bit 7 , Switch to Tuner */
1338 /* ---------------------------------------------------------------------- */
1339 /* audio chip descriptions - defines+functions for TA8874Z */
1341 /* write 1st byte */
1342 #define TA8874Z_LED_STE 0x80
1343 #define TA8874Z_LED_BIL 0x40
1344 #define TA8874Z_LED_EXT 0x20
1345 #define TA8874Z_MONO_SET 0x10
1346 #define TA8874Z_MUTE 0x08
1347 #define TA8874Z_F_MONO 0x04
1348 #define TA8874Z_MODE_SUB 0x02
1349 #define TA8874Z_MODE_MAIN 0x01
1351 /* write 2nd byte */
1352 /*#define TA8874Z_TI 0x80 */ /* test mode */
1353 #define TA8874Z_SEPARATION 0x3f
1354 #define TA8874Z_SEPARATION_DEFAULT 0x10
1357 #define TA8874Z_B1 0x80
1358 #define TA8874Z_B0 0x40
1359 #define TA8874Z_CHAG_FLAG 0x20
1367 static int ta8874z_getrxsubchans(struct CHIPSTATE
*chip
)
1371 val
= chip_read(chip
);
1372 mode
= V4L2_TUNER_SUB_MONO
;
1373 if (val
& TA8874Z_B1
){
1374 mode
|= V4L2_TUNER_SUB_LANG1
| V4L2_TUNER_SUB_LANG2
;
1375 }else if (!(val
& TA8874Z_B0
)){
1376 mode
= V4L2_TUNER_SUB_STEREO
;
1378 /* v4l2_dbg(1, debug, &chip->sd,
1379 "ta8874z_getrxsubchans(): raw chip read: 0x%02x, return: 0x%02x\n",
1384 static audiocmd ta8874z_stereo
= { 2, {0, TA8874Z_SEPARATION_DEFAULT
}};
1385 static audiocmd ta8874z_mono
= {2, { TA8874Z_MONO_SET
, TA8874Z_SEPARATION_DEFAULT
}};
1386 static audiocmd ta8874z_main
= {2, { 0, TA8874Z_SEPARATION_DEFAULT
}};
1387 static audiocmd ta8874z_sub
= {2, { TA8874Z_MODE_SUB
, TA8874Z_SEPARATION_DEFAULT
}};
1388 static audiocmd ta8874z_both
= {2, { TA8874Z_MODE_MAIN
| TA8874Z_MODE_SUB
, TA8874Z_SEPARATION_DEFAULT
}};
1390 static void ta8874z_setaudmode(struct CHIPSTATE
*chip
, int mode
)
1392 struct v4l2_subdev
*sd
= &chip
->sd
;
1396 v4l2_dbg(1, debug
, sd
, "ta8874z_setaudmode(): mode: 0x%02x\n", mode
);
1399 case V4L2_TUNER_MODE_MONO
:
1402 case V4L2_TUNER_MODE_STEREO
:
1403 t
= &ta8874z_stereo
;
1405 case V4L2_TUNER_MODE_LANG1
:
1408 case V4L2_TUNER_MODE_LANG2
:
1411 case V4L2_TUNER_MODE_LANG1_LANG2
:
1419 chip_cmd(chip
, "TA8874Z", t
);
1422 static int ta8874z_checkit(struct CHIPSTATE
*chip
)
1425 rc
= chip_read(chip
);
1426 return ((rc
& 0x1f) == 0x1f) ? 1 : 0;
1429 /* ---------------------------------------------------------------------- */
1430 /* audio chip descriptions - struct CHIPDESC */
1432 /* insmod options to enable/disable individual audio chips */
1433 static int tda8425
= 1;
1434 static int tda9840
= 1;
1435 static int tda9850
= 1;
1436 static int tda9855
= 1;
1437 static int tda9873
= 1;
1438 static int tda9874a
= 1;
1439 static int tda9875
= 1;
1440 static int tea6300
; /* default 0 - address clash with msp34xx */
1441 static int tea6320
; /* default 0 - address clash with msp34xx */
1442 static int tea6420
= 1;
1443 static int pic16c54
= 1;
1444 static int ta8874z
; /* default 0 - address clash with tda9840 */
1446 module_param(tda8425
, int, 0444);
1447 module_param(tda9840
, int, 0444);
1448 module_param(tda9850
, int, 0444);
1449 module_param(tda9855
, int, 0444);
1450 module_param(tda9873
, int, 0444);
1451 module_param(tda9874a
, int, 0444);
1452 module_param(tda9875
, int, 0444);
1453 module_param(tea6300
, int, 0444);
1454 module_param(tea6320
, int, 0444);
1455 module_param(tea6420
, int, 0444);
1456 module_param(pic16c54
, int, 0444);
1457 module_param(ta8874z
, int, 0444);
1459 static struct CHIPDESC chiplist
[] = {
1462 .insmodopt
= &tda9840
,
1463 .addr_lo
= I2C_ADDR_TDA9840
>> 1,
1464 .addr_hi
= I2C_ADDR_TDA9840
>> 1,
1466 .flags
= CHIP_NEED_CHECKMODE
,
1469 .checkit
= tda9840_checkit
,
1470 .getrxsubchans
= tda9840_getrxsubchans
,
1471 .setaudmode
= tda9840_setaudmode
,
1473 .init
= { 2, { TDA9840_TEST
, TDA9840_TEST_INT1SN
1474 /* ,TDA9840_SW, TDA9840_MONO */} }
1478 .insmodopt
= &tda9873
,
1479 .addr_lo
= I2C_ADDR_TDA985x_L
>> 1,
1480 .addr_hi
= I2C_ADDR_TDA985x_H
>> 1,
1482 .flags
= CHIP_HAS_INPUTSEL
| CHIP_NEED_CHECKMODE
,
1485 .checkit
= tda9873_checkit
,
1486 .getrxsubchans
= tda9873_getrxsubchans
,
1487 .setaudmode
= tda9873_setaudmode
,
1489 .init
= { 4, { TDA9873_SW
, 0xa4, 0x06, 0x03 } },
1490 .inputreg
= TDA9873_SW
,
1491 .inputmute
= TDA9873_MUTE
| TDA9873_AUTOMUTE
,
1492 .inputmap
= {0xa0, 0xa2, 0xa0, 0xa0},
1493 .inputmask
= TDA9873_INP_MASK
|TDA9873_MUTE
|TDA9873_AUTOMUTE
,
1497 .name
= "tda9874h/a",
1498 .insmodopt
= &tda9874a
,
1499 .addr_lo
= I2C_ADDR_TDA9874
>> 1,
1500 .addr_hi
= I2C_ADDR_TDA9874
>> 1,
1501 .flags
= CHIP_NEED_CHECKMODE
,
1504 .initialize
= tda9874a_initialize
,
1505 .checkit
= tda9874a_checkit
,
1506 .getrxsubchans
= tda9874a_getrxsubchans
,
1507 .setaudmode
= tda9874a_setaudmode
,
1511 .insmodopt
= &tda9875
,
1512 .addr_lo
= I2C_ADDR_TDA9875
>> 1,
1513 .addr_hi
= I2C_ADDR_TDA9875
>> 1,
1514 .flags
= CHIP_HAS_VOLUME
| CHIP_HAS_BASSTREBLE
,
1517 .initialize
= tda9875_initialize
,
1518 .checkit
= tda9875_checkit
,
1519 .volfunc
= tda9875_volume
,
1520 .bassfunc
= tda9875_bass
,
1521 .treblefunc
= tda9875_treble
,
1522 .leftreg
= TDA9875_MVL
,
1523 .rightreg
= TDA9875_MVR
,
1524 .bassreg
= TDA9875_MBA
,
1525 .treblereg
= TDA9875_MTR
,
1531 .insmodopt
= &tda9850
,
1532 .addr_lo
= I2C_ADDR_TDA985x_L
>> 1,
1533 .addr_hi
= I2C_ADDR_TDA985x_H
>> 1,
1536 .getrxsubchans
= tda985x_getrxsubchans
,
1537 .setaudmode
= tda985x_setaudmode
,
1539 .init
= { 8, { TDA9850_C4
, 0x08, 0x08, TDA985x_STEREO
, 0x07, 0x10, 0x10, 0x03 } }
1543 .insmodopt
= &tda9855
,
1544 .addr_lo
= I2C_ADDR_TDA985x_L
>> 1,
1545 .addr_hi
= I2C_ADDR_TDA985x_H
>> 1,
1547 .flags
= CHIP_HAS_VOLUME
| CHIP_HAS_BASSTREBLE
,
1549 .leftreg
= TDA9855_VL
,
1550 .rightreg
= TDA9855_VR
,
1551 .bassreg
= TDA9855_BA
,
1552 .treblereg
= TDA9855_TR
,
1555 .volfunc
= tda9855_volume
,
1556 .bassfunc
= tda9855_bass
,
1557 .treblefunc
= tda9855_treble
,
1558 .getrxsubchans
= tda985x_getrxsubchans
,
1559 .setaudmode
= tda985x_setaudmode
,
1561 .init
= { 12, { 0, 0x6f, 0x6f, 0x0e, 0x07<<1, 0x8<<2,
1562 TDA9855_MUTE
| TDA9855_AVL
| TDA9855_LOUD
| TDA9855_INT
,
1563 TDA985x_STEREO
| TDA9855_LINEAR
| TDA9855_TZCM
| TDA9855_VZCM
,
1564 0x07, 0x10, 0x10, 0x03 }}
1568 .insmodopt
= &tea6300
,
1569 .addr_lo
= I2C_ADDR_TEA6300
>> 1,
1570 .addr_hi
= I2C_ADDR_TEA6300
>> 1,
1572 .flags
= CHIP_HAS_VOLUME
| CHIP_HAS_BASSTREBLE
| CHIP_HAS_INPUTSEL
,
1574 .leftreg
= TEA6300_VR
,
1575 .rightreg
= TEA6300_VL
,
1576 .bassreg
= TEA6300_BA
,
1577 .treblereg
= TEA6300_TR
,
1580 .volfunc
= tea6300_shift10
,
1581 .bassfunc
= tea6300_shift12
,
1582 .treblefunc
= tea6300_shift12
,
1584 .inputreg
= TEA6300_S
,
1585 .inputmap
= { TEA6300_S_SA
, TEA6300_S_SB
, TEA6300_S_SC
},
1586 .inputmute
= TEA6300_S_GMU
,
1590 .insmodopt
= &tea6320
,
1591 .addr_lo
= I2C_ADDR_TEA6300
>> 1,
1592 .addr_hi
= I2C_ADDR_TEA6300
>> 1,
1594 .flags
= CHIP_HAS_VOLUME
| CHIP_HAS_BASSTREBLE
| CHIP_HAS_INPUTSEL
,
1596 .leftreg
= TEA6320_V
,
1597 .rightreg
= TEA6320_V
,
1598 .bassreg
= TEA6320_BA
,
1599 .treblereg
= TEA6320_TR
,
1602 .initialize
= tea6320_initialize
,
1603 .volfunc
= tea6320_volume
,
1604 .bassfunc
= tea6320_shift11
,
1605 .treblefunc
= tea6320_shift11
,
1607 .inputreg
= TEA6320_S
,
1608 .inputmap
= { TEA6320_S_SA
, TEA6420_S_SB
, TEA6300_S_SC
, TEA6320_S_SD
},
1609 .inputmute
= TEA6300_S_GMU
,
1613 .insmodopt
= &tea6420
,
1614 .addr_lo
= I2C_ADDR_TEA6420
>> 1,
1615 .addr_hi
= I2C_ADDR_TEA6420
>> 1,
1617 .flags
= CHIP_HAS_INPUTSEL
,
1620 .inputmap
= { TEA6420_S_SA
, TEA6420_S_SB
, TEA6420_S_SC
},
1621 .inputmute
= TEA6300_S_GMU
,
1625 .insmodopt
= &tda8425
,
1626 .addr_lo
= I2C_ADDR_TDA8425
>> 1,
1627 .addr_hi
= I2C_ADDR_TDA8425
>> 1,
1629 .flags
= CHIP_HAS_VOLUME
| CHIP_HAS_BASSTREBLE
| CHIP_HAS_INPUTSEL
,
1631 .leftreg
= TDA8425_VL
,
1632 .rightreg
= TDA8425_VR
,
1633 .bassreg
= TDA8425_BA
,
1634 .treblereg
= TDA8425_TR
,
1637 .volfunc
= tda8425_shift10
,
1638 .bassfunc
= tda8425_shift12
,
1639 .treblefunc
= tda8425_shift12
,
1640 .setaudmode
= tda8425_setaudmode
,
1642 .inputreg
= TDA8425_S1
,
1643 .inputmap
= { TDA8425_S1_CH1
, TDA8425_S1_CH1
, TDA8425_S1_CH1
},
1644 .inputmute
= TDA8425_S1_OFF
,
1648 .name
= "pic16c54 (PV951)",
1649 .insmodopt
= &pic16c54
,
1650 .addr_lo
= I2C_ADDR_PIC16C54
>> 1,
1651 .addr_hi
= I2C_ADDR_PIC16C54
>> 1,
1653 .flags
= CHIP_HAS_INPUTSEL
,
1655 .inputreg
= PIC16C54_REG_MISC
,
1656 .inputmap
= {PIC16C54_MISC_SND_NOTMUTE
|PIC16C54_MISC_SWITCH_TUNER
,
1657 PIC16C54_MISC_SND_NOTMUTE
|PIC16C54_MISC_SWITCH_LINE
,
1658 PIC16C54_MISC_SND_NOTMUTE
|PIC16C54_MISC_SWITCH_LINE
,
1659 PIC16C54_MISC_SND_MUTE
},
1660 .inputmute
= PIC16C54_MISC_SND_MUTE
,
1664 .checkit
= ta8874z_checkit
,
1665 .insmodopt
= &ta8874z
,
1666 .addr_lo
= I2C_ADDR_TDA9840
>> 1,
1667 .addr_hi
= I2C_ADDR_TDA9840
>> 1,
1671 .getrxsubchans
= ta8874z_getrxsubchans
,
1672 .setaudmode
= ta8874z_setaudmode
,
1674 .init
= {2, { TA8874Z_MONO_SET
, TA8874Z_SEPARATION_DEFAULT
}},
1676 { .name
= NULL
} /* EOF */
1680 /* ---------------------------------------------------------------------- */
1682 static int tvaudio_g_ctrl(struct v4l2_subdev
*sd
,
1683 struct v4l2_control
*ctrl
)
1685 struct CHIPSTATE
*chip
= to_state(sd
);
1686 struct CHIPDESC
*desc
= chip
->desc
;
1689 case V4L2_CID_AUDIO_MUTE
:
1690 if (!(desc
->flags
& CHIP_HAS_INPUTSEL
))
1692 ctrl
->value
=chip
->muted
;
1694 case V4L2_CID_AUDIO_VOLUME
:
1695 if (!(desc
->flags
& CHIP_HAS_VOLUME
))
1697 ctrl
->value
= max(chip
->left
,chip
->right
);
1699 case V4L2_CID_AUDIO_BALANCE
:
1702 if (!(desc
->flags
& CHIP_HAS_VOLUME
))
1704 volume
= max(chip
->left
,chip
->right
);
1706 ctrl
->value
=(32768*min(chip
->left
,chip
->right
))/volume
;
1711 case V4L2_CID_AUDIO_BASS
:
1712 if (!(desc
->flags
& CHIP_HAS_BASSTREBLE
))
1714 ctrl
->value
= chip
->bass
;
1716 case V4L2_CID_AUDIO_TREBLE
:
1717 if (!(desc
->flags
& CHIP_HAS_BASSTREBLE
))
1719 ctrl
->value
= chip
->treble
;
1725 static int tvaudio_s_ctrl(struct v4l2_subdev
*sd
,
1726 struct v4l2_control
*ctrl
)
1728 struct CHIPSTATE
*chip
= to_state(sd
);
1729 struct CHIPDESC
*desc
= chip
->desc
;
1732 case V4L2_CID_AUDIO_MUTE
:
1733 if (!(desc
->flags
& CHIP_HAS_INPUTSEL
))
1736 if (ctrl
->value
< 0 || ctrl
->value
>= 2)
1738 chip
->muted
= ctrl
->value
;
1740 chip_write_masked(chip
,desc
->inputreg
,desc
->inputmute
,desc
->inputmask
);
1742 chip_write_masked(chip
,desc
->inputreg
,
1743 desc
->inputmap
[chip
->input
],desc
->inputmask
);
1745 case V4L2_CID_AUDIO_VOLUME
:
1749 if (!(desc
->flags
& CHIP_HAS_VOLUME
))
1752 volume
= max(chip
->left
,chip
->right
);
1754 balance
=(32768*min(chip
->left
,chip
->right
))/volume
;
1759 chip
->left
= (min(65536 - balance
,32768) * volume
) / 32768;
1760 chip
->right
= (min(balance
,volume
*(__u16
)32768)) / 32768;
1762 chip_write(chip
,desc
->leftreg
,desc
->volfunc(chip
->left
));
1763 chip_write(chip
,desc
->rightreg
,desc
->volfunc(chip
->right
));
1767 case V4L2_CID_AUDIO_BALANCE
:
1769 int volume
, balance
;
1771 if (!(desc
->flags
& CHIP_HAS_VOLUME
))
1774 volume
= max(chip
->left
, chip
->right
);
1775 balance
= ctrl
->value
;
1776 chip
->left
= (min(65536 - balance
, 32768) * volume
) / 32768;
1777 chip
->right
= (min(balance
, volume
* (__u16
)32768)) / 32768;
1779 chip_write(chip
, desc
->leftreg
, desc
->volfunc(chip
->left
));
1780 chip_write(chip
, desc
->rightreg
, desc
->volfunc(chip
->right
));
1784 case V4L2_CID_AUDIO_BASS
:
1785 if (!(desc
->flags
& CHIP_HAS_BASSTREBLE
))
1787 chip
->bass
= ctrl
->value
;
1788 chip_write(chip
,desc
->bassreg
,desc
->bassfunc(chip
->bass
));
1791 case V4L2_CID_AUDIO_TREBLE
:
1792 if (!(desc
->flags
& CHIP_HAS_BASSTREBLE
))
1794 chip
->treble
= ctrl
->value
;
1795 chip_write(chip
,desc
->treblereg
,desc
->treblefunc(chip
->treble
));
1803 /* ---------------------------------------------------------------------- */
1804 /* video4linux interface */
1806 static int tvaudio_s_radio(struct v4l2_subdev
*sd
)
1808 struct CHIPSTATE
*chip
= to_state(sd
);
1811 /* del_timer(&chip->wt); */
1815 static int tvaudio_queryctrl(struct v4l2_subdev
*sd
, struct v4l2_queryctrl
*qc
)
1817 struct CHIPSTATE
*chip
= to_state(sd
);
1818 struct CHIPDESC
*desc
= chip
->desc
;
1821 case V4L2_CID_AUDIO_MUTE
:
1822 if (desc
->flags
& CHIP_HAS_INPUTSEL
)
1823 return v4l2_ctrl_query_fill(qc
, 0, 1, 1, 0);
1825 case V4L2_CID_AUDIO_VOLUME
:
1826 if (desc
->flags
& CHIP_HAS_VOLUME
)
1827 return v4l2_ctrl_query_fill(qc
, 0, 65535, 65535 / 100, 58880);
1829 case V4L2_CID_AUDIO_BALANCE
:
1830 if (desc
->flags
& CHIP_HAS_VOLUME
)
1831 return v4l2_ctrl_query_fill(qc
, 0, 65535, 65535 / 100, 32768);
1833 case V4L2_CID_AUDIO_BASS
:
1834 case V4L2_CID_AUDIO_TREBLE
:
1835 if (desc
->flags
& CHIP_HAS_BASSTREBLE
)
1836 return v4l2_ctrl_query_fill(qc
, 0, 65535, 65535 / 100, 32768);
1844 static int tvaudio_s_routing(struct v4l2_subdev
*sd
,
1845 u32 input
, u32 output
, u32 config
)
1847 struct CHIPSTATE
*chip
= to_state(sd
);
1848 struct CHIPDESC
*desc
= chip
->desc
;
1850 if (!(desc
->flags
& CHIP_HAS_INPUTSEL
))
1854 /* There are four inputs: tuner, radio, extern and intern. */
1855 chip
->input
= input
;
1858 chip_write_masked(chip
, desc
->inputreg
,
1859 desc
->inputmap
[chip
->input
], desc
->inputmask
);
1863 static int tvaudio_s_tuner(struct v4l2_subdev
*sd
, struct v4l2_tuner
*vt
)
1865 struct CHIPSTATE
*chip
= to_state(sd
);
1866 struct CHIPDESC
*desc
= chip
->desc
;
1868 if (!desc
->setaudmode
)
1873 switch (vt
->audmode
) {
1874 case V4L2_TUNER_MODE_MONO
:
1875 case V4L2_TUNER_MODE_STEREO
:
1876 case V4L2_TUNER_MODE_LANG1
:
1877 case V4L2_TUNER_MODE_LANG2
:
1878 case V4L2_TUNER_MODE_LANG1_LANG2
:
1883 chip
->audmode
= vt
->audmode
;
1886 wake_up_process(chip
->thread
);
1888 desc
->setaudmode(chip
, vt
->audmode
);
1893 static int tvaudio_g_tuner(struct v4l2_subdev
*sd
, struct v4l2_tuner
*vt
)
1895 struct CHIPSTATE
*chip
= to_state(sd
);
1896 struct CHIPDESC
*desc
= chip
->desc
;
1898 if (!desc
->getrxsubchans
)
1903 vt
->audmode
= chip
->audmode
;
1904 vt
->rxsubchans
= desc
->getrxsubchans(chip
);
1905 vt
->capability
= V4L2_TUNER_CAP_STEREO
|
1906 V4L2_TUNER_CAP_LANG1
| V4L2_TUNER_CAP_LANG2
;
1911 static int tvaudio_s_std(struct v4l2_subdev
*sd
, v4l2_std_id std
)
1913 struct CHIPSTATE
*chip
= to_state(sd
);
1919 static int tvaudio_s_frequency(struct v4l2_subdev
*sd
, struct v4l2_frequency
*freq
)
1921 struct CHIPSTATE
*chip
= to_state(sd
);
1922 struct CHIPDESC
*desc
= chip
->desc
;
1924 /* For chips that provide getrxsubchans and setaudmode, and doesn't
1925 automatically follows the stereo carrier, a kthread is
1926 created to set the audio standard. In this case, when then
1927 the video channel is changed, tvaudio starts on MONO mode.
1928 After waiting for 2 seconds, the kernel thread is called,
1929 to follow whatever audio standard is pointed by the
1933 desc
->setaudmode(chip
, V4L2_TUNER_MODE_MONO
);
1934 chip
->prevmode
= -1; /* reset previous mode */
1935 mod_timer(&chip
->wt
, jiffies
+msecs_to_jiffies(2000));
1940 static int tvaudio_g_chip_ident(struct v4l2_subdev
*sd
, struct v4l2_dbg_chip_ident
*chip
)
1942 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
1944 return v4l2_chip_ident_i2c_client(client
, chip
, V4L2_IDENT_TVAUDIO
, 0);
1947 /* ----------------------------------------------------------------------- */
1949 static const struct v4l2_subdev_core_ops tvaudio_core_ops
= {
1950 .g_chip_ident
= tvaudio_g_chip_ident
,
1951 .queryctrl
= tvaudio_queryctrl
,
1952 .g_ctrl
= tvaudio_g_ctrl
,
1953 .s_ctrl
= tvaudio_s_ctrl
,
1954 .s_std
= tvaudio_s_std
,
1957 static const struct v4l2_subdev_tuner_ops tvaudio_tuner_ops
= {
1958 .s_radio
= tvaudio_s_radio
,
1959 .s_frequency
= tvaudio_s_frequency
,
1960 .s_tuner
= tvaudio_s_tuner
,
1961 .g_tuner
= tvaudio_g_tuner
,
1964 static const struct v4l2_subdev_audio_ops tvaudio_audio_ops
= {
1965 .s_routing
= tvaudio_s_routing
,
1968 static const struct v4l2_subdev_ops tvaudio_ops
= {
1969 .core
= &tvaudio_core_ops
,
1970 .tuner
= &tvaudio_tuner_ops
,
1971 .audio
= &tvaudio_audio_ops
,
1974 /* ----------------------------------------------------------------------- */
1977 /* i2c registration */
1979 static int tvaudio_probe(struct i2c_client
*client
, const struct i2c_device_id
*id
)
1981 struct CHIPSTATE
*chip
;
1982 struct CHIPDESC
*desc
;
1983 struct v4l2_subdev
*sd
;
1986 printk(KERN_INFO
"tvaudio: TV audio decoder + audio/video mux driver\n");
1987 printk(KERN_INFO
"tvaudio: known chips: ");
1988 for (desc
= chiplist
; desc
->name
!= NULL
; desc
++)
1989 printk("%s%s", (desc
== chiplist
) ? "" : ", ", desc
->name
);
1993 chip
= kzalloc(sizeof(*chip
), GFP_KERNEL
);
1997 v4l2_i2c_subdev_init(sd
, client
, &tvaudio_ops
);
1999 /* find description for the chip */
2000 v4l2_dbg(1, debug
, sd
, "chip found @ 0x%x\n", client
->addr
<<1);
2001 for (desc
= chiplist
; desc
->name
!= NULL
; desc
++) {
2002 if (0 == *(desc
->insmodopt
))
2004 if (client
->addr
< desc
->addr_lo
||
2005 client
->addr
> desc
->addr_hi
)
2007 if (desc
->checkit
&& !desc
->checkit(chip
))
2011 if (desc
->name
== NULL
) {
2012 v4l2_dbg(1, debug
, sd
, "no matching chip description found\n");
2016 v4l2_info(sd
, "%s found @ 0x%x (%s)\n", desc
->name
, client
->addr
<<1, client
->adapter
->name
);
2018 v4l2_dbg(1, debug
, sd
, "matches:%s%s%s.\n",
2019 (desc
->flags
& CHIP_HAS_VOLUME
) ? " volume" : "",
2020 (desc
->flags
& CHIP_HAS_BASSTREBLE
) ? " bass/treble" : "",
2021 (desc
->flags
& CHIP_HAS_INPUTSEL
) ? " audiomux" : "");
2024 /* fill required data structures */
2026 strlcpy(client
->name
, desc
->name
, I2C_NAME_SIZE
);
2028 chip
->shadow
.count
= desc
->registers
+1;
2029 chip
->prevmode
= -1;
2030 chip
->audmode
= V4L2_TUNER_MODE_LANG1
;
2032 /* initialization */
2033 if (desc
->initialize
!= NULL
)
2034 desc
->initialize(chip
);
2036 chip_cmd(chip
, "init", &desc
->init
);
2038 if (desc
->flags
& CHIP_HAS_VOLUME
) {
2039 if (!desc
->volfunc
) {
2040 /* This shouldn't be happen. Warn user, but keep working
2041 without volume controls
2043 v4l2_info(sd
, "volume callback undefined!\n");
2044 desc
->flags
&= ~CHIP_HAS_VOLUME
;
2046 chip
->left
= desc
->leftinit
? desc
->leftinit
: 65535;
2047 chip
->right
= desc
->rightinit
? desc
->rightinit
: 65535;
2048 chip_write(chip
, desc
->leftreg
,
2049 desc
->volfunc(chip
->left
));
2050 chip_write(chip
, desc
->rightreg
,
2051 desc
->volfunc(chip
->right
));
2054 if (desc
->flags
& CHIP_HAS_BASSTREBLE
) {
2055 if (!desc
->bassfunc
|| !desc
->treblefunc
) {
2056 /* This shouldn't be happen. Warn user, but keep working
2057 without bass/treble controls
2059 v4l2_info(sd
, "bass/treble callbacks undefined!\n");
2060 desc
->flags
&= ~CHIP_HAS_BASSTREBLE
;
2062 chip
->treble
= desc
->trebleinit
?
2063 desc
->trebleinit
: 32768;
2064 chip
->bass
= desc
->bassinit
?
2065 desc
->bassinit
: 32768;
2066 chip_write(chip
, desc
->bassreg
,
2067 desc
->bassfunc(chip
->bass
));
2068 chip_write(chip
, desc
->treblereg
,
2069 desc
->treblefunc(chip
->treble
));
2073 chip
->thread
= NULL
;
2074 init_timer(&chip
->wt
);
2075 if (desc
->flags
& CHIP_NEED_CHECKMODE
) {
2076 if (!desc
->getrxsubchans
|| !desc
->setaudmode
) {
2077 /* This shouldn't be happen. Warn user, but keep working
2080 v4l2_info(sd
, "set/get mode callbacks undefined!\n");
2083 /* start async thread */
2084 chip
->wt
.function
= chip_thread_wake
;
2085 chip
->wt
.data
= (unsigned long)chip
;
2086 chip
->thread
= kthread_run(chip_thread
, chip
, client
->name
);
2087 if (IS_ERR(chip
->thread
)) {
2088 v4l2_warn(sd
, "failed to create kthread\n");
2089 chip
->thread
= NULL
;
2095 static int tvaudio_remove(struct i2c_client
*client
)
2097 struct v4l2_subdev
*sd
= i2c_get_clientdata(client
);
2098 struct CHIPSTATE
*chip
= to_state(sd
);
2100 del_timer_sync(&chip
->wt
);
2102 /* shutdown async thread */
2103 kthread_stop(chip
->thread
);
2104 chip
->thread
= NULL
;
2107 v4l2_device_unregister_subdev(sd
);
2112 /* This driver supports many devices and the idea is to let the driver
2113 detect which device is present. So rather than listing all supported
2114 devices here, we pretend to support a single, fake device type. */
2115 static const struct i2c_device_id tvaudio_id
[] = {
2119 MODULE_DEVICE_TABLE(i2c
, tvaudio_id
);
2121 static struct i2c_driver tvaudio_driver
= {
2123 .owner
= THIS_MODULE
,
2126 .probe
= tvaudio_probe
,
2127 .remove
= tvaudio_remove
,
2128 .id_table
= tvaudio_id
,
2131 module_i2c_driver(tvaudio_driver
);