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 * Copyright(c) 2005-2008 Mauro Carvalho Chehab
11 * - Some cleanups, code fixes, etc
12 * - Convert it to V4L2 API
14 * This code is placed under the terms of the GNU General Public License
17 * debug - set to 1 if you'd like to see debug messages
21 #include <linux/module.h>
22 #include <linux/kernel.h>
23 #include <linux/sched.h>
24 #include <linux/string.h>
25 #include <linux/timer.h>
26 #include <linux/delay.h>
27 #include <linux/errno.h>
28 #include <linux/slab.h>
29 #include <linux/videodev2.h>
30 #include <linux/i2c.h>
31 #include <linux/init.h>
32 #include <linux/kthread.h>
33 #include <linux/freezer.h>
35 #include <media/tvaudio.h>
36 #include <media/v4l2-device.h>
37 #include <media/v4l2-chip-ident.h>
39 #include <media/i2c-addr.h>
41 /* ---------------------------------------------------------------------- */
44 static int debug
; /* insmod parameter */
45 module_param(debug
, int, 0644);
47 MODULE_DESCRIPTION("device driver for various i2c TV sound decoder / audiomux chips");
48 MODULE_AUTHOR("Eric Sandeen, Steve VanDeBogart, Greg Alexander, Gerd Knorr");
49 MODULE_LICENSE("GPL");
53 /* ---------------------------------------------------------------------- */
59 typedef int (*getvalue
)(int);
60 typedef int (*checkit
)(struct CHIPSTATE
*);
61 typedef int (*initialize
)(struct CHIPSTATE
*);
62 typedef int (*getmode
)(struct CHIPSTATE
*);
63 typedef void (*setmode
)(struct CHIPSTATE
*, int mode
);
66 typedef struct AUDIOCMD
{
67 int count
; /* # of bytes to send */
68 unsigned char bytes
[MAXREGS
+1]; /* addr, data, data, ... */
71 /* chip description */
73 char *name
; /* chip name */
74 int addr_lo
, addr_hi
; /* i2c address range */
75 int registers
; /* # of registers */
79 initialize initialize
;
81 #define CHIP_HAS_VOLUME 1
82 #define CHIP_HAS_BASSTREBLE 2
83 #define CHIP_HAS_INPUTSEL 4
84 #define CHIP_NEED_CHECKMODE 8
86 /* various i2c command sequences */
89 /* which register has which value */
90 int leftreg
,rightreg
,treblereg
,bassreg
;
92 /* initialize with (defaults to 65535/65535/32768/32768 */
93 int leftinit
,rightinit
,trebleinit
,bassinit
;
95 /* functions to convert the values (v4l -> chip) */
96 getvalue volfunc
,treblefunc
,bassfunc
;
102 /* input switch register + values for v4l inputs */
109 /* current state of the chip */
111 struct v4l2_subdev sd
;
113 /* chip-specific description - should point to
114 an entry at CHIPDESC table */
115 struct CHIPDESC
*desc
;
117 /* shadow register set */
120 /* current settings */
121 __u16 left
,right
,treble
,bass
,muted
,mode
;
127 struct task_struct
*thread
;
128 struct timer_list wt
;
133 static inline struct CHIPSTATE
*to_state(struct v4l2_subdev
*sd
)
135 return container_of(sd
, struct CHIPSTATE
, sd
);
139 /* ---------------------------------------------------------------------- */
140 /* i2c I/O functions */
142 static int chip_write(struct CHIPSTATE
*chip
, int subaddr
, int val
)
144 struct v4l2_subdev
*sd
= &chip
->sd
;
145 struct i2c_client
*c
= v4l2_get_subdevdata(sd
);
146 unsigned char buffer
[2];
149 v4l2_dbg(1, debug
, sd
, "chip_write: 0x%x\n", val
);
150 chip
->shadow
.bytes
[1] = val
;
152 if (1 != i2c_master_send(c
, buffer
, 1)) {
153 v4l2_warn(sd
, "I/O error (write 0x%x)\n", val
);
157 if (subaddr
+ 1 >= ARRAY_SIZE(chip
->shadow
.bytes
)) {
159 "Tried to access a non-existent register: %d\n",
164 v4l2_dbg(1, debug
, sd
, "chip_write: reg%d=0x%x\n",
166 chip
->shadow
.bytes
[subaddr
+1] = val
;
169 if (2 != i2c_master_send(c
, buffer
, 2)) {
170 v4l2_warn(sd
, "I/O error (write reg%d=0x%x)\n",
178 static int chip_write_masked(struct CHIPSTATE
*chip
,
179 int subaddr
, int val
, int mask
)
181 struct v4l2_subdev
*sd
= &chip
->sd
;
185 val
= (chip
->shadow
.bytes
[1] & ~mask
) | (val
& mask
);
187 if (subaddr
+ 1 >= ARRAY_SIZE(chip
->shadow
.bytes
)) {
189 "Tried to access a non-existent register: %d\n",
194 val
= (chip
->shadow
.bytes
[subaddr
+1] & ~mask
) | (val
& mask
);
197 return chip_write(chip
, subaddr
, val
);
200 static int chip_read(struct CHIPSTATE
*chip
)
202 struct v4l2_subdev
*sd
= &chip
->sd
;
203 struct i2c_client
*c
= v4l2_get_subdevdata(sd
);
204 unsigned char buffer
;
206 if (1 != i2c_master_recv(c
, &buffer
, 1)) {
207 v4l2_warn(sd
, "I/O error (read)\n");
210 v4l2_dbg(1, debug
, sd
, "chip_read: 0x%x\n", buffer
);
214 static int chip_read2(struct CHIPSTATE
*chip
, int subaddr
)
216 struct v4l2_subdev
*sd
= &chip
->sd
;
217 struct i2c_client
*c
= v4l2_get_subdevdata(sd
);
218 unsigned char write
[1];
219 unsigned char read
[1];
220 struct i2c_msg msgs
[2] = {
221 { c
->addr
, 0, 1, write
},
222 { c
->addr
, I2C_M_RD
, 1, read
}
227 if (2 != i2c_transfer(c
->adapter
, msgs
, 2)) {
228 v4l2_warn(sd
, "I/O error (read2)\n");
231 v4l2_dbg(1, debug
, sd
, "chip_read2: reg%d=0x%x\n",
236 static int chip_cmd(struct CHIPSTATE
*chip
, char *name
, audiocmd
*cmd
)
238 struct v4l2_subdev
*sd
= &chip
->sd
;
239 struct i2c_client
*c
= v4l2_get_subdevdata(sd
);
245 if (cmd
->count
+ cmd
->bytes
[0] - 1 >= ARRAY_SIZE(chip
->shadow
.bytes
)) {
247 "Tried to access a non-existent register range: %d to %d\n",
248 cmd
->bytes
[0] + 1, cmd
->bytes
[0] + cmd
->count
- 1);
252 /* FIXME: it seems that the shadow bytes are wrong bellow !*/
254 /* update our shadow register set; print bytes if (debug > 0) */
255 v4l2_dbg(1, debug
, sd
, "chip_cmd(%s): reg=%d, data:",
256 name
, cmd
->bytes
[0]);
257 for (i
= 1; i
< cmd
->count
; i
++) {
259 printk(KERN_CONT
" 0x%x", cmd
->bytes
[i
]);
260 chip
->shadow
.bytes
[i
+cmd
->bytes
[0]] = cmd
->bytes
[i
];
263 printk(KERN_CONT
"\n");
265 /* send data to the chip */
266 if (cmd
->count
!= i2c_master_send(c
, cmd
->bytes
, cmd
->count
)) {
267 v4l2_warn(sd
, "I/O error (%s)\n", name
);
273 /* ---------------------------------------------------------------------- */
274 /* kernel thread for doing i2c stuff asyncronly
275 * right now it is used only to check the audio mode (mono/stereo/whatever)
276 * some time after switching to another TV channel, then turn on stereo
280 static void chip_thread_wake(unsigned long data
)
282 struct CHIPSTATE
*chip
= (struct CHIPSTATE
*)data
;
283 wake_up_process(chip
->thread
);
286 static int chip_thread(void *data
)
288 struct CHIPSTATE
*chip
= data
;
289 struct CHIPDESC
*desc
= chip
->desc
;
290 struct v4l2_subdev
*sd
= &chip
->sd
;
293 v4l2_dbg(1, debug
, sd
, "thread started\n");
296 set_current_state(TASK_INTERRUPTIBLE
);
297 if (!kthread_should_stop())
299 set_current_state(TASK_RUNNING
);
301 if (kthread_should_stop())
303 v4l2_dbg(1, debug
, sd
, "thread wakeup\n");
305 /* don't do anything for radio or if mode != auto */
306 if (chip
->radio
|| chip
->mode
!= 0)
309 /* have a look what's going on */
310 mode
= desc
->getmode(chip
);
311 if (mode
== chip
->prevmode
)
314 /* chip detected a new audio mode - set it */
315 v4l2_dbg(1, debug
, sd
, "thread checkmode\n");
317 chip
->prevmode
= mode
;
319 if (mode
& V4L2_TUNER_MODE_STEREO
)
320 desc
->setmode(chip
, V4L2_TUNER_MODE_STEREO
);
321 if (mode
& V4L2_TUNER_MODE_LANG1_LANG2
)
322 desc
->setmode(chip
, V4L2_TUNER_MODE_STEREO
);
323 else if (mode
& V4L2_TUNER_MODE_LANG1
)
324 desc
->setmode(chip
, V4L2_TUNER_MODE_LANG1
);
325 else if (mode
& V4L2_TUNER_MODE_LANG2
)
326 desc
->setmode(chip
, V4L2_TUNER_MODE_LANG2
);
328 desc
->setmode(chip
, V4L2_TUNER_MODE_MONO
);
330 /* schedule next check */
331 mod_timer(&chip
->wt
, jiffies
+msecs_to_jiffies(2000));
334 v4l2_dbg(1, debug
, sd
, "thread exiting\n");
338 /* ---------------------------------------------------------------------- */
339 /* audio chip descriptions - defines+functions for tda9840 */
341 #define TDA9840_SW 0x00
342 #define TDA9840_LVADJ 0x02
343 #define TDA9840_STADJ 0x03
344 #define TDA9840_TEST 0x04
346 #define TDA9840_MONO 0x10
347 #define TDA9840_STEREO 0x2a
348 #define TDA9840_DUALA 0x12
349 #define TDA9840_DUALB 0x1e
350 #define TDA9840_DUALAB 0x1a
351 #define TDA9840_DUALBA 0x16
352 #define TDA9840_EXTERNAL 0x7a
354 #define TDA9840_DS_DUAL 0x20 /* Dual sound identified */
355 #define TDA9840_ST_STEREO 0x40 /* Stereo sound identified */
356 #define TDA9840_PONRES 0x80 /* Power-on reset detected if = 1 */
358 #define TDA9840_TEST_INT1SN 0x1 /* Integration time 0.5s when set */
359 #define TDA9840_TEST_INTFU 0x02 /* Disables integrator function */
361 static int tda9840_getmode(struct CHIPSTATE
*chip
)
363 struct v4l2_subdev
*sd
= &chip
->sd
;
366 val
= chip_read(chip
);
367 mode
= V4L2_TUNER_MODE_MONO
;
368 if (val
& TDA9840_DS_DUAL
)
369 mode
|= V4L2_TUNER_MODE_LANG1
| V4L2_TUNER_MODE_LANG2
;
370 if (val
& TDA9840_ST_STEREO
)
371 mode
|= V4L2_TUNER_MODE_STEREO
;
373 v4l2_dbg(1, debug
, sd
, "tda9840_getmode(): raw chip read: %d, return: %d\n",
378 static void tda9840_setmode(struct CHIPSTATE
*chip
, int mode
)
381 int t
= chip
->shadow
.bytes
[TDA9840_SW
+ 1] & ~0x7e;
384 case V4L2_TUNER_MODE_MONO
:
387 case V4L2_TUNER_MODE_STEREO
:
390 case V4L2_TUNER_MODE_LANG1
:
393 case V4L2_TUNER_MODE_LANG2
:
401 chip_write(chip
, TDA9840_SW
, t
);
404 static int tda9840_checkit(struct CHIPSTATE
*chip
)
407 rc
= chip_read(chip
);
408 /* lower 5 bits should be 0 */
409 return ((rc
& 0x1f) == 0) ? 1 : 0;
412 /* ---------------------------------------------------------------------- */
413 /* audio chip descriptions - defines+functions for tda985x */
415 /* subaddresses for TDA9855 */
416 #define TDA9855_VR 0x00 /* Volume, right */
417 #define TDA9855_VL 0x01 /* Volume, left */
418 #define TDA9855_BA 0x02 /* Bass */
419 #define TDA9855_TR 0x03 /* Treble */
420 #define TDA9855_SW 0x04 /* Subwoofer - not connected on DTV2000 */
422 /* subaddresses for TDA9850 */
423 #define TDA9850_C4 0x04 /* Control 1 for TDA9850 */
425 /* subaddesses for both chips */
426 #define TDA985x_C5 0x05 /* Control 2 for TDA9850, Control 1 for TDA9855 */
427 #define TDA985x_C6 0x06 /* Control 3 for TDA9850, Control 2 for TDA9855 */
428 #define TDA985x_C7 0x07 /* Control 4 for TDA9850, Control 3 for TDA9855 */
429 #define TDA985x_A1 0x08 /* Alignment 1 for both chips */
430 #define TDA985x_A2 0x09 /* Alignment 2 for both chips */
431 #define TDA985x_A3 0x0a /* Alignment 3 for both chips */
433 /* Masks for bits in TDA9855 subaddresses */
434 /* 0x00 - VR in TDA9855 */
435 /* 0x01 - VL in TDA9855 */
436 /* lower 7 bits control gain from -71dB (0x28) to 16dB (0x7f)
437 * in 1dB steps - mute is 0x27 */
440 /* 0x02 - BA in TDA9855 */
441 /* lower 5 bits control bass gain from -12dB (0x06) to 16.5dB (0x19)
442 * in .5dB steps - 0 is 0x0E */
445 /* 0x03 - TR in TDA9855 */
446 /* 4 bits << 1 control treble gain from -12dB (0x3) to 12dB (0xb)
447 * in 3dB steps - 0 is 0x7 */
449 /* Masks for bits in both chips' subaddresses */
450 /* 0x04 - SW in TDA9855, C4/Control 1 in TDA9850 */
451 /* Unique to TDA9855: */
452 /* 4 bits << 2 control subwoofer/surround gain from -14db (0x1) to 14db (0xf)
453 * in 3dB steps - mute is 0x0 */
455 /* Unique to TDA9850: */
456 /* lower 4 bits control stereo noise threshold, over which stereo turns off
457 * set to values of 0x00 through 0x0f for Ster1 through Ster16 */
460 /* 0x05 - C5 - Control 1 in TDA9855 , Control 2 in TDA9850*/
461 /* Unique to TDA9855: */
462 #define TDA9855_MUTE 1<<7 /* GMU, Mute at outputs */
463 #define TDA9855_AVL 1<<6 /* AVL, Automatic Volume Level */
464 #define TDA9855_LOUD 1<<5 /* Loudness, 1==off */
465 #define TDA9855_SUR 1<<3 /* Surround / Subwoofer 1==.5(L-R) 0==.5(L+R) */
466 /* Bits 0 to 3 select various combinations
467 * of line in and line out, only the
468 * interesting ones are defined */
469 #define TDA9855_EXT 1<<2 /* Selects inputs LIR and LIL. Pins 41 & 12 */
470 #define TDA9855_INT 0 /* Selects inputs LOR and LOL. (internal) */
472 /* Unique to TDA9850: */
473 /* lower 4 bits contol SAP noise threshold, over which SAP turns off
474 * set to values of 0x00 through 0x0f for SAP1 through SAP16 */
477 /* 0x06 - C6 - Control 2 in TDA9855, Control 3 in TDA9850 */
478 /* Common to TDA9855 and TDA9850: */
479 #define TDA985x_SAP 3<<6 /* Selects SAP output, mute if not received */
480 #define TDA985x_STEREO 1<<6 /* Selects Stereo ouput, mono if not received */
481 #define TDA985x_MONO 0 /* Forces Mono output */
482 #define TDA985x_LMU 1<<3 /* Mute (LOR/LOL for 9855, OUTL/OUTR for 9850) */
484 /* Unique to TDA9855: */
485 #define TDA9855_TZCM 1<<5 /* If set, don't mute till zero crossing */
486 #define TDA9855_VZCM 1<<4 /* If set, don't change volume till zero crossing*/
487 #define TDA9855_LINEAR 0 /* Linear Stereo */
488 #define TDA9855_PSEUDO 1 /* Pseudo Stereo */
489 #define TDA9855_SPAT_30 2 /* Spatial Stereo, 30% anti-phase crosstalk */
490 #define TDA9855_SPAT_50 3 /* Spatial Stereo, 52% anti-phase crosstalk */
491 #define TDA9855_E_MONO 7 /* Forced mono - mono select elseware, so useless*/
493 /* 0x07 - C7 - Control 3 in TDA9855, Control 4 in TDA9850 */
494 /* Common to both TDA9855 and TDA9850: */
495 /* lower 4 bits control input gain from -3.5dB (0x0) to 4dB (0xF)
496 * in .5dB steps - 0dB is 0x7 */
498 /* 0x08, 0x09 - A1 and A2 (read/write) */
499 /* Common to both TDA9855 and TDA9850: */
500 /* lower 5 bites are wideband and spectral expander alignment
501 * from 0x00 to 0x1f - nominal at 0x0f and 0x10 (read/write) */
502 #define TDA985x_STP 1<<5 /* Stereo Pilot/detect (read-only) */
503 #define TDA985x_SAPP 1<<6 /* SAP Pilot/detect (read-only) */
504 #define TDA985x_STS 1<<7 /* Stereo trigger 1= <35mV 0= <30mV (write-only)*/
507 /* Common to both TDA9855 and TDA9850: */
508 /* lower 3 bits control timing current for alignment: -30% (0x0), -20% (0x1),
509 * -10% (0x2), nominal (0x3), +10% (0x6), +20% (0x5), +30% (0x4) */
510 #define TDA985x_ADJ 1<<7 /* Stereo adjust on/off (wideband and spectral */
512 static int tda9855_volume(int val
) { return val
/0x2e8+0x27; }
513 static int tda9855_bass(int val
) { return val
/0xccc+0x06; }
514 static int tda9855_treble(int val
) { return (val
/0x1c71+0x3)<<1; }
516 static int tda985x_getmode(struct CHIPSTATE
*chip
)
520 mode
= ((TDA985x_STP
| TDA985x_SAPP
) &
521 chip_read(chip
)) >> 4;
522 /* Add mono mode regardless of SAP and stereo */
523 /* Allows forced mono */
524 return mode
| V4L2_TUNER_MODE_MONO
;
527 static void tda985x_setmode(struct CHIPSTATE
*chip
, int mode
)
530 int c6
= chip
->shadow
.bytes
[TDA985x_C6
+1] & 0x3f;
533 case V4L2_TUNER_MODE_MONO
:
536 case V4L2_TUNER_MODE_STEREO
:
537 c6
|= TDA985x_STEREO
;
539 case V4L2_TUNER_MODE_LANG1
:
546 chip_write(chip
,TDA985x_C6
,c6
);
550 /* ---------------------------------------------------------------------- */
551 /* audio chip descriptions - defines+functions for tda9873h */
553 /* Subaddresses for TDA9873H */
555 #define TDA9873_SW 0x00 /* Switching */
556 #define TDA9873_AD 0x01 /* Adjust */
557 #define TDA9873_PT 0x02 /* Port */
559 /* Subaddress 0x00: Switching Data
562 * B1, B0: Input source selection
564 * 1, 0 external stereo
567 #define TDA9873_INP_MASK 3
568 #define TDA9873_INTERNAL 0
569 #define TDA9873_EXT_STEREO 2
570 #define TDA9873_EXT_MONO 1
572 /* B3, B2: output signal select
573 * B4 : transmission mode
576 * 1, 1, 1 Stereo (reversed channel)
583 #define TDA9873_TR_MASK (7 << 2)
584 #define TDA9873_TR_MONO 4
585 #define TDA9873_TR_STEREO 1 << 4
586 #define TDA9873_TR_REVERSE (1 << 3) & (1 << 2)
587 #define TDA9873_TR_DUALA 1 << 2
588 #define TDA9873_TR_DUALB 1 << 3
590 /* output level controls
591 * B5: output level switch (0 = reduced gain, 1 = normal gain)
592 * B6: mute (1 = muted)
593 * B7: auto-mute (1 = auto-mute enabled)
596 #define TDA9873_GAIN_NORMAL 1 << 5
597 #define TDA9873_MUTE 1 << 6
598 #define TDA9873_AUTOMUTE 1 << 7
600 /* Subaddress 0x01: Adjust/standard */
602 /* Lower 4 bits (C3..C0) control stereo adjustment on R channel (-0.6 - +0.7 dB)
603 * Recommended value is +0 dB
606 #define TDA9873_STEREO_ADJ 0x06 /* 0dB gain */
608 /* Bits C6..C4 control FM stantard
610 * 0, 0, 0 B/G (PAL FM)
619 #define TDA9873_DK1 2
620 #define TDA9873_DK2 3
621 #define TDA9873_DK3 4
624 /* C7 controls identification response time (1=fast/0=normal)
626 #define TDA9873_IDR_NORM 0
627 #define TDA9873_IDR_FAST 1 << 7
630 /* Subaddress 0x02: Port data */
632 /* E1, E0 free programmable ports P1/P2
639 #define TDA9873_PORTS 3
642 #define TDA9873_TST_PORT 1 << 2
644 /* E5..E3 control mono output channel (together with transmission mode bit B4)
649 * 0 1 0 1 mono (from stereo decoder)
651 #define TDA9873_MOUT_MONO 0
652 #define TDA9873_MOUT_FMONO 0
653 #define TDA9873_MOUT_DUALA 0
654 #define TDA9873_MOUT_DUALB 1 << 3
655 #define TDA9873_MOUT_ST 1 << 4
656 #define TDA9873_MOUT_EXTM (1 << 4 ) & (1 << 3)
657 #define TDA9873_MOUT_EXTL 1 << 5
658 #define TDA9873_MOUT_EXTR (1 << 5 ) & (1 << 3)
659 #define TDA9873_MOUT_EXTLR (1 << 5 ) & (1 << 4)
660 #define TDA9873_MOUT_MUTE (1 << 5 ) & (1 << 4) & (1 << 3)
662 /* Status bits: (chip read) */
663 #define TDA9873_PONR 0 /* Power-on reset detected if = 1 */
664 #define TDA9873_STEREO 2 /* Stereo sound is identified */
665 #define TDA9873_DUAL 4 /* Dual sound is identified */
667 static int tda9873_getmode(struct CHIPSTATE
*chip
)
669 struct v4l2_subdev
*sd
= &chip
->sd
;
672 val
= chip_read(chip
);
673 mode
= V4L2_TUNER_MODE_MONO
;
674 if (val
& TDA9873_STEREO
)
675 mode
|= V4L2_TUNER_MODE_STEREO
;
676 if (val
& TDA9873_DUAL
)
677 mode
|= V4L2_TUNER_MODE_LANG1
| V4L2_TUNER_MODE_LANG2
;
678 v4l2_dbg(1, debug
, sd
, "tda9873_getmode(): raw chip read: %d, return: %d\n",
683 static void tda9873_setmode(struct CHIPSTATE
*chip
, int mode
)
685 struct v4l2_subdev
*sd
= &chip
->sd
;
686 int sw_data
= chip
->shadow
.bytes
[TDA9873_SW
+1] & ~ TDA9873_TR_MASK
;
687 /* int adj_data = chip->shadow.bytes[TDA9873_AD+1] ; */
689 if ((sw_data
& TDA9873_INP_MASK
) != TDA9873_INTERNAL
) {
690 v4l2_dbg(1, debug
, sd
, "tda9873_setmode(): external input\n");
694 v4l2_dbg(1, debug
, sd
, "tda9873_setmode(): chip->shadow.bytes[%d] = %d\n", TDA9873_SW
+1, chip
->shadow
.bytes
[TDA9873_SW
+1]);
695 v4l2_dbg(1, debug
, sd
, "tda9873_setmode(): sw_data = %d\n", sw_data
);
698 case V4L2_TUNER_MODE_MONO
:
699 sw_data
|= TDA9873_TR_MONO
;
701 case V4L2_TUNER_MODE_STEREO
:
702 sw_data
|= TDA9873_TR_STEREO
;
704 case V4L2_TUNER_MODE_LANG1
:
705 sw_data
|= TDA9873_TR_DUALA
;
707 case V4L2_TUNER_MODE_LANG2
:
708 sw_data
|= TDA9873_TR_DUALB
;
715 chip_write(chip
, TDA9873_SW
, sw_data
);
716 v4l2_dbg(1, debug
, sd
, "tda9873_setmode(): req. mode %d; chip_write: %d\n",
720 static int tda9873_checkit(struct CHIPSTATE
*chip
)
724 if (-1 == (rc
= chip_read2(chip
,254)))
726 return (rc
& ~0x1f) == 0x80;
730 /* ---------------------------------------------------------------------- */
731 /* audio chip description - defines+functions for tda9874h and tda9874a */
732 /* Dariusz Kowalewski <darekk@automex.pl> */
734 /* Subaddresses for TDA9874H and TDA9874A (slave rx) */
735 #define TDA9874A_AGCGR 0x00 /* AGC gain */
736 #define TDA9874A_GCONR 0x01 /* general config */
737 #define TDA9874A_MSR 0x02 /* monitor select */
738 #define TDA9874A_C1FRA 0x03 /* carrier 1 freq. */
739 #define TDA9874A_C1FRB 0x04 /* carrier 1 freq. */
740 #define TDA9874A_C1FRC 0x05 /* carrier 1 freq. */
741 #define TDA9874A_C2FRA 0x06 /* carrier 2 freq. */
742 #define TDA9874A_C2FRB 0x07 /* carrier 2 freq. */
743 #define TDA9874A_C2FRC 0x08 /* carrier 2 freq. */
744 #define TDA9874A_DCR 0x09 /* demodulator config */
745 #define TDA9874A_FMER 0x0a /* FM de-emphasis */
746 #define TDA9874A_FMMR 0x0b /* FM dematrix */
747 #define TDA9874A_C1OLAR 0x0c /* ch.1 output level adj. */
748 #define TDA9874A_C2OLAR 0x0d /* ch.2 output level adj. */
749 #define TDA9874A_NCONR 0x0e /* NICAM config */
750 #define TDA9874A_NOLAR 0x0f /* NICAM output level adj. */
751 #define TDA9874A_NLELR 0x10 /* NICAM lower error limit */
752 #define TDA9874A_NUELR 0x11 /* NICAM upper error limit */
753 #define TDA9874A_AMCONR 0x12 /* audio mute control */
754 #define TDA9874A_SDACOSR 0x13 /* stereo DAC output select */
755 #define TDA9874A_AOSR 0x14 /* analog output select */
756 #define TDA9874A_DAICONR 0x15 /* digital audio interface config */
757 #define TDA9874A_I2SOSR 0x16 /* I2S-bus output select */
758 #define TDA9874A_I2SOLAR 0x17 /* I2S-bus output level adj. */
759 #define TDA9874A_MDACOSR 0x18 /* mono DAC output select (tda9874a) */
760 #define TDA9874A_ESP 0xFF /* easy standard progr. (tda9874a) */
762 /* Subaddresses for TDA9874H and TDA9874A (slave tx) */
763 #define TDA9874A_DSR 0x00 /* device status */
764 #define TDA9874A_NSR 0x01 /* NICAM status */
765 #define TDA9874A_NECR 0x02 /* NICAM error count */
766 #define TDA9874A_DR1 0x03 /* add. data LSB */
767 #define TDA9874A_DR2 0x04 /* add. data MSB */
768 #define TDA9874A_LLRA 0x05 /* monitor level read-out LSB */
769 #define TDA9874A_LLRB 0x06 /* monitor level read-out MSB */
770 #define TDA9874A_SIFLR 0x07 /* SIF level */
771 #define TDA9874A_TR2 252 /* test reg. 2 */
772 #define TDA9874A_TR1 253 /* test reg. 1 */
773 #define TDA9874A_DIC 254 /* device id. code */
774 #define TDA9874A_SIC 255 /* software id. code */
777 static int tda9874a_mode
= 1; /* 0: A2, 1: NICAM */
778 static int tda9874a_GCONR
= 0xc0; /* default config. input pin: SIFSEL=0 */
779 static int tda9874a_NCONR
= 0x01; /* default NICAM config.: AMSEL=0,AMUTE=1 */
780 static int tda9874a_ESP
= 0x07; /* default standard: NICAM D/K */
781 static int tda9874a_dic
= -1; /* device id. code */
783 /* insmod options for tda9874a */
784 static unsigned int tda9874a_SIF
= UNSET
;
785 static unsigned int tda9874a_AMSEL
= UNSET
;
786 static unsigned int tda9874a_STD
= UNSET
;
787 module_param(tda9874a_SIF
, int, 0444);
788 module_param(tda9874a_AMSEL
, int, 0444);
789 module_param(tda9874a_STD
, int, 0444);
792 * initialization table for tda9874 decoder:
793 * - carrier 1 freq. registers (3 bytes)
794 * - carrier 2 freq. registers (3 bytes)
795 * - demudulator config register
796 * - FM de-emphasis register (slow identification mode)
797 * Note: frequency registers must be written in single i2c transfer.
799 static struct tda9874a_MODES
{
802 } tda9874a_modelist
[9] = {
803 { "A2, B/G", /* default */
804 { 9, { TDA9874A_C1FRA
, 0x72,0x95,0x55, 0x77,0xA0,0x00, 0x00,0x00 }} },
806 { 9, { TDA9874A_C1FRA
, 0x5D,0xC0,0x00, 0x62,0x6A,0xAA, 0x20,0x22 }} },
808 { 9, { TDA9874A_C1FRA
, 0x87,0x6A,0xAA, 0x82,0x60,0x00, 0x00,0x00 }} },
810 { 9, { TDA9874A_C1FRA
, 0x87,0x6A,0xAA, 0x8C,0x75,0x55, 0x00,0x00 }} },
812 { 9, { TDA9874A_C1FRA
, 0x87,0x6A,0xAA, 0x77,0xA0,0x00, 0x00,0x00 }} },
814 { 9, { TDA9874A_C1FRA
, 0x7D,0x00,0x00, 0x88,0x8A,0xAA, 0x08,0x33 }} },
816 { 9, { TDA9874A_C1FRA
, 0x72,0x95,0x55, 0x79,0xEA,0xAA, 0x08,0x33 }} },
818 { 9, { TDA9874A_C1FRA
, 0x87,0x6A,0xAA, 0x79,0xEA,0xAA, 0x08,0x33 }} },
820 { 9, { TDA9874A_C1FRA
, 0x87,0x6A,0xAA, 0x79,0xEA,0xAA, 0x09,0x33 }} }
823 static int tda9874a_setup(struct CHIPSTATE
*chip
)
825 struct v4l2_subdev
*sd
= &chip
->sd
;
827 chip_write(chip
, TDA9874A_AGCGR
, 0x00); /* 0 dB */
828 chip_write(chip
, TDA9874A_GCONR
, tda9874a_GCONR
);
829 chip_write(chip
, TDA9874A_MSR
, (tda9874a_mode
) ? 0x03:0x02);
830 if(tda9874a_dic
== 0x11) {
831 chip_write(chip
, TDA9874A_FMMR
, 0x80);
832 } else { /* dic == 0x07 */
833 chip_cmd(chip
,"tda9874_modelist",&tda9874a_modelist
[tda9874a_STD
].cmd
);
834 chip_write(chip
, TDA9874A_FMMR
, 0x00);
836 chip_write(chip
, TDA9874A_C1OLAR
, 0x00); /* 0 dB */
837 chip_write(chip
, TDA9874A_C2OLAR
, 0x00); /* 0 dB */
838 chip_write(chip
, TDA9874A_NCONR
, tda9874a_NCONR
);
839 chip_write(chip
, TDA9874A_NOLAR
, 0x00); /* 0 dB */
840 /* Note: If signal quality is poor you may want to change NICAM */
841 /* error limit registers (NLELR and NUELR) to some greater values. */
842 /* Then the sound would remain stereo, but won't be so clear. */
843 chip_write(chip
, TDA9874A_NLELR
, 0x14); /* default */
844 chip_write(chip
, TDA9874A_NUELR
, 0x50); /* default */
846 if(tda9874a_dic
== 0x11) {
847 chip_write(chip
, TDA9874A_AMCONR
, 0xf9);
848 chip_write(chip
, TDA9874A_SDACOSR
, (tda9874a_mode
) ? 0x81:0x80);
849 chip_write(chip
, TDA9874A_AOSR
, 0x80);
850 chip_write(chip
, TDA9874A_MDACOSR
, (tda9874a_mode
) ? 0x82:0x80);
851 chip_write(chip
, TDA9874A_ESP
, tda9874a_ESP
);
852 } else { /* dic == 0x07 */
853 chip_write(chip
, TDA9874A_AMCONR
, 0xfb);
854 chip_write(chip
, TDA9874A_SDACOSR
, (tda9874a_mode
) ? 0x81:0x80);
855 chip_write(chip
, TDA9874A_AOSR
, 0x00); /* or 0x10 */
857 v4l2_dbg(1, debug
, sd
, "tda9874a_setup(): %s [0x%02X].\n",
858 tda9874a_modelist
[tda9874a_STD
].name
,tda9874a_STD
);
862 static int tda9874a_getmode(struct CHIPSTATE
*chip
)
864 struct v4l2_subdev
*sd
= &chip
->sd
;
866 int necr
; /* just for debugging */
868 mode
= V4L2_TUNER_MODE_MONO
;
870 if(-1 == (dsr
= chip_read2(chip
,TDA9874A_DSR
)))
872 if(-1 == (nsr
= chip_read2(chip
,TDA9874A_NSR
)))
874 if(-1 == (necr
= chip_read2(chip
,TDA9874A_NECR
)))
877 /* need to store dsr/nsr somewhere */
878 chip
->shadow
.bytes
[MAXREGS
-2] = dsr
;
879 chip
->shadow
.bytes
[MAXREGS
-1] = nsr
;
882 /* Note: DSR.RSSF and DSR.AMSTAT bits are also checked.
883 * If NICAM auto-muting is enabled, DSR.AMSTAT=1 indicates
884 * that sound has (temporarily) switched from NICAM to
885 * mono FM (or AM) on 1st sound carrier due to high NICAM bit
886 * error count. So in fact there is no stereo in this case :-(
887 * But changing the mode to V4L2_TUNER_MODE_MONO would switch
888 * external 4052 multiplexer in audio_hook().
890 if(nsr
& 0x02) /* NSR.S/MB=1 */
891 mode
|= V4L2_TUNER_MODE_STEREO
;
892 if(nsr
& 0x01) /* NSR.D/SB=1 */
893 mode
|= V4L2_TUNER_MODE_LANG1
| V4L2_TUNER_MODE_LANG2
;
895 if(dsr
& 0x02) /* DSR.IDSTE=1 */
896 mode
|= V4L2_TUNER_MODE_STEREO
;
897 if(dsr
& 0x04) /* DSR.IDDUA=1 */
898 mode
|= V4L2_TUNER_MODE_LANG1
| V4L2_TUNER_MODE_LANG2
;
901 v4l2_dbg(1, debug
, sd
, "tda9874a_getmode(): DSR=0x%X, NSR=0x%X, NECR=0x%X, return: %d.\n",
902 dsr
, nsr
, necr
, mode
);
906 static void tda9874a_setmode(struct CHIPSTATE
*chip
, int mode
)
908 struct v4l2_subdev
*sd
= &chip
->sd
;
910 /* Disable/enable NICAM auto-muting (based on DSR.RSSF status bit). */
911 /* If auto-muting is disabled, we can hear a signal of degrading quality. */
913 if(chip
->shadow
.bytes
[MAXREGS
-2] & 0x20) /* DSR.RSSF=1 */
914 tda9874a_NCONR
&= 0xfe; /* enable */
916 tda9874a_NCONR
|= 0x01; /* disable */
917 chip_write(chip
, TDA9874A_NCONR
, tda9874a_NCONR
);
920 /* Note: TDA9874A supports automatic FM dematrixing (FMMR register)
921 * and has auto-select function for audio output (AOSR register).
922 * Old TDA9874H doesn't support these features.
923 * TDA9874A also has additional mono output pin (OUTM), which
924 * on same (all?) tv-cards is not used, anyway (as well as MONOIN).
926 if(tda9874a_dic
== 0x11) {
928 int mdacosr
= (tda9874a_mode
) ? 0x82:0x80;
931 case V4L2_TUNER_MODE_MONO
:
932 case V4L2_TUNER_MODE_STEREO
:
934 case V4L2_TUNER_MODE_LANG1
:
935 aosr
= 0x80; /* auto-select, dual A/A */
936 mdacosr
= (tda9874a_mode
) ? 0x82:0x80;
938 case V4L2_TUNER_MODE_LANG2
:
939 aosr
= 0xa0; /* auto-select, dual B/B */
940 mdacosr
= (tda9874a_mode
) ? 0x83:0x81;
946 chip_write(chip
, TDA9874A_AOSR
, aosr
);
947 chip_write(chip
, TDA9874A_MDACOSR
, mdacosr
);
949 v4l2_dbg(1, debug
, sd
, "tda9874a_setmode(): req. mode %d; AOSR=0x%X, MDACOSR=0x%X.\n",
950 mode
, aosr
, mdacosr
);
952 } else { /* dic == 0x07 */
956 case V4L2_TUNER_MODE_MONO
:
957 fmmr
= 0x00; /* mono */
958 aosr
= 0x10; /* A/A */
960 case V4L2_TUNER_MODE_STEREO
:
963 aosr
= 0x00; /* handled by NICAM auto-mute */
965 fmmr
= (tda9874a_ESP
== 1) ? 0x05 : 0x04; /* stereo */
969 case V4L2_TUNER_MODE_LANG1
:
970 fmmr
= 0x02; /* dual */
971 aosr
= 0x10; /* dual A/A */
973 case V4L2_TUNER_MODE_LANG2
:
974 fmmr
= 0x02; /* dual */
975 aosr
= 0x20; /* dual B/B */
981 chip_write(chip
, TDA9874A_FMMR
, fmmr
);
982 chip_write(chip
, TDA9874A_AOSR
, aosr
);
984 v4l2_dbg(1, debug
, sd
, "tda9874a_setmode(): req. mode %d; FMMR=0x%X, AOSR=0x%X.\n",
989 static int tda9874a_checkit(struct CHIPSTATE
*chip
)
991 struct v4l2_subdev
*sd
= &chip
->sd
;
992 int dic
,sic
; /* device id. and software id. codes */
994 if(-1 == (dic
= chip_read2(chip
,TDA9874A_DIC
)))
996 if(-1 == (sic
= chip_read2(chip
,TDA9874A_SIC
)))
999 v4l2_dbg(1, debug
, sd
, "tda9874a_checkit(): DIC=0x%X, SIC=0x%X.\n", dic
, sic
);
1001 if((dic
== 0x11)||(dic
== 0x07)) {
1002 v4l2_info(sd
, "found tda9874%s.\n", (dic
== 0x11) ? "a" : "h");
1003 tda9874a_dic
= dic
; /* remember device id. */
1006 return 0; /* not found */
1009 static int tda9874a_initialize(struct CHIPSTATE
*chip
)
1011 if (tda9874a_SIF
> 2)
1013 if (tda9874a_STD
>= ARRAY_SIZE(tda9874a_modelist
))
1015 if(tda9874a_AMSEL
> 1)
1018 if(tda9874a_SIF
== 1)
1019 tda9874a_GCONR
= 0xc0; /* sound IF input 1 */
1021 tda9874a_GCONR
= 0xc1; /* sound IF input 2 */
1023 tda9874a_ESP
= tda9874a_STD
;
1024 tda9874a_mode
= (tda9874a_STD
< 5) ? 0 : 1;
1026 if(tda9874a_AMSEL
== 0)
1027 tda9874a_NCONR
= 0x01; /* auto-mute: analog mono input */
1029 tda9874a_NCONR
= 0x05; /* auto-mute: 1st carrier FM or AM */
1031 tda9874a_setup(chip
);
1035 /* ---------------------------------------------------------------------- */
1036 /* audio chip description - defines+functions for tda9875 */
1037 /* The TDA9875 is made by Philips Semiconductor
1038 * http://www.semiconductors.philips.com
1039 * TDA9875: I2C-bus controlled DSP audio processor, FM demodulator
1043 /* subaddresses for TDA9875 */
1044 #define TDA9875_MUT 0x12 /*General mute (value --> 0b11001100*/
1045 #define TDA9875_CFG 0x01 /* Config register (value --> 0b00000000 */
1046 #define TDA9875_DACOS 0x13 /*DAC i/o select (ADC) 0b0000100*/
1047 #define TDA9875_LOSR 0x16 /*Line output select regirter 0b0100 0001*/
1049 #define TDA9875_CH1V 0x0c /*Channel 1 volume (mute)*/
1050 #define TDA9875_CH2V 0x0d /*Channel 2 volume (mute)*/
1051 #define TDA9875_SC1 0x14 /*SCART 1 in (mono)*/
1052 #define TDA9875_SC2 0x15 /*SCART 2 in (mono)*/
1054 #define TDA9875_ADCIS 0x17 /*ADC input select (mono) 0b0110 000*/
1055 #define TDA9875_AER 0x19 /*Audio effect (AVL+Pseudo) 0b0000 0110*/
1056 #define TDA9875_MCS 0x18 /*Main channel select (DAC) 0b0000100*/
1057 #define TDA9875_MVL 0x1a /* Main volume gauche */
1058 #define TDA9875_MVR 0x1b /* Main volume droite */
1059 #define TDA9875_MBA 0x1d /* Main Basse */
1060 #define TDA9875_MTR 0x1e /* Main treble */
1061 #define TDA9875_ACS 0x1f /* Auxiliary channel select (FM) 0b0000000*/
1062 #define TDA9875_AVL 0x20 /* Auxiliary volume gauche */
1063 #define TDA9875_AVR 0x21 /* Auxiliary volume droite */
1064 #define TDA9875_ABA 0x22 /* Auxiliary Basse */
1065 #define TDA9875_ATR 0x23 /* Auxiliary treble */
1067 #define TDA9875_MSR 0x02 /* Monitor select register */
1068 #define TDA9875_C1MSB 0x03 /* Carrier 1 (FM) frequency register MSB */
1069 #define TDA9875_C1MIB 0x04 /* Carrier 1 (FM) frequency register (16-8]b */
1070 #define TDA9875_C1LSB 0x05 /* Carrier 1 (FM) frequency register LSB */
1071 #define TDA9875_C2MSB 0x06 /* Carrier 2 (nicam) frequency register MSB */
1072 #define TDA9875_C2MIB 0x07 /* Carrier 2 (nicam) frequency register (16-8]b */
1073 #define TDA9875_C2LSB 0x08 /* Carrier 2 (nicam) frequency register LSB */
1074 #define TDA9875_DCR 0x09 /* Demodulateur configuration regirter*/
1075 #define TDA9875_DEEM 0x0a /* FM de-emphasis regirter*/
1076 #define TDA9875_FMAT 0x0b /* FM Matrix regirter*/
1079 #define TDA9875_MUTE_ON 0xff /* general mute */
1080 #define TDA9875_MUTE_OFF 0xcc /* general no mute */
1082 static int tda9875_initialize(struct CHIPSTATE
*chip
)
1084 chip_write(chip
, TDA9875_CFG
, 0xd0); /*reg de config 0 (reset)*/
1085 chip_write(chip
, TDA9875_MSR
, 0x03); /* Monitor 0b00000XXX*/
1086 chip_write(chip
, TDA9875_C1MSB
, 0x00); /*Car1(FM) MSB XMHz*/
1087 chip_write(chip
, TDA9875_C1MIB
, 0x00); /*Car1(FM) MIB XMHz*/
1088 chip_write(chip
, TDA9875_C1LSB
, 0x00); /*Car1(FM) LSB XMHz*/
1089 chip_write(chip
, TDA9875_C2MSB
, 0x00); /*Car2(NICAM) MSB XMHz*/
1090 chip_write(chip
, TDA9875_C2MIB
, 0x00); /*Car2(NICAM) MIB XMHz*/
1091 chip_write(chip
, TDA9875_C2LSB
, 0x00); /*Car2(NICAM) LSB XMHz*/
1092 chip_write(chip
, TDA9875_DCR
, 0x00); /*Demod config 0x00*/
1093 chip_write(chip
, TDA9875_DEEM
, 0x44); /*DE-Emph 0b0100 0100*/
1094 chip_write(chip
, TDA9875_FMAT
, 0x00); /*FM Matrix reg 0x00*/
1095 chip_write(chip
, TDA9875_SC1
, 0x00); /* SCART 1 (SC1)*/
1096 chip_write(chip
, TDA9875_SC2
, 0x01); /* SCART 2 (sc2)*/
1098 chip_write(chip
, TDA9875_CH1V
, 0x10); /* Channel volume 1 mute*/
1099 chip_write(chip
, TDA9875_CH2V
, 0x10); /* Channel volume 2 mute */
1100 chip_write(chip
, TDA9875_DACOS
, 0x02); /* sig DAC i/o(in:nicam)*/
1101 chip_write(chip
, TDA9875_ADCIS
, 0x6f); /* sig ADC input(in:mono)*/
1102 chip_write(chip
, TDA9875_LOSR
, 0x00); /* line out (in:mono)*/
1103 chip_write(chip
, TDA9875_AER
, 0x00); /*06 Effect (AVL+PSEUDO) */
1104 chip_write(chip
, TDA9875_MCS
, 0x44); /* Main ch select (DAC) */
1105 chip_write(chip
, TDA9875_MVL
, 0x03); /* Vol Main left 10dB */
1106 chip_write(chip
, TDA9875_MVR
, 0x03); /* Vol Main right 10dB*/
1107 chip_write(chip
, TDA9875_MBA
, 0x00); /* Main Bass Main 0dB*/
1108 chip_write(chip
, TDA9875_MTR
, 0x00); /* Main Treble Main 0dB*/
1109 chip_write(chip
, TDA9875_ACS
, 0x44); /* Aux chan select (dac)*/
1110 chip_write(chip
, TDA9875_AVL
, 0x00); /* Vol Aux left 0dB*/
1111 chip_write(chip
, TDA9875_AVR
, 0x00); /* Vol Aux right 0dB*/
1112 chip_write(chip
, TDA9875_ABA
, 0x00); /* Aux Bass Main 0dB*/
1113 chip_write(chip
, TDA9875_ATR
, 0x00); /* Aux Aigus Main 0dB*/
1115 chip_write(chip
, TDA9875_MUT
, 0xcc); /* General mute */
1119 static int tda9875_volume(int val
) { return (unsigned char)(val
/ 602 - 84); }
1120 static int tda9875_bass(int val
) { return (unsigned char)(max(-12, val
/ 2115 - 15)); }
1121 static int tda9875_treble(int val
) { return (unsigned char)(val
/ 2622 - 12); }
1123 /* ----------------------------------------------------------------------- */
1126 /* *********************** *
1127 * i2c interface functions *
1128 * *********************** */
1130 static int tda9875_checkit(struct CHIPSTATE
*chip
)
1132 struct v4l2_subdev
*sd
= &chip
->sd
;
1135 dic
= chip_read2(chip
, 254);
1136 rev
= chip_read2(chip
, 255);
1138 if (dic
== 0 || dic
== 2) { /* tda9875 and tda9875A */
1139 v4l2_info(sd
, "found tda9875%s rev. %d.\n",
1140 dic
== 0 ? "" : "A", rev
);
1146 /* ---------------------------------------------------------------------- */
1147 /* audio chip descriptions - defines+functions for tea6420 */
1149 #define TEA6300_VL 0x00 /* volume left */
1150 #define TEA6300_VR 0x01 /* volume right */
1151 #define TEA6300_BA 0x02 /* bass */
1152 #define TEA6300_TR 0x03 /* treble */
1153 #define TEA6300_FA 0x04 /* fader control */
1154 #define TEA6300_S 0x05 /* switch register */
1155 /* values for those registers: */
1156 #define TEA6300_S_SA 0x01 /* stereo A input */
1157 #define TEA6300_S_SB 0x02 /* stereo B */
1158 #define TEA6300_S_SC 0x04 /* stereo C */
1159 #define TEA6300_S_GMU 0x80 /* general mute */
1161 #define TEA6320_V 0x00 /* volume (0-5)/loudness off (6)/zero crossing mute(7) */
1162 #define TEA6320_FFR 0x01 /* fader front right (0-5) */
1163 #define TEA6320_FFL 0x02 /* fader front left (0-5) */
1164 #define TEA6320_FRR 0x03 /* fader rear right (0-5) */
1165 #define TEA6320_FRL 0x04 /* fader rear left (0-5) */
1166 #define TEA6320_BA 0x05 /* bass (0-4) */
1167 #define TEA6320_TR 0x06 /* treble (0-4) */
1168 #define TEA6320_S 0x07 /* switch register */
1169 /* values for those registers: */
1170 #define TEA6320_S_SA 0x07 /* stereo A input */
1171 #define TEA6320_S_SB 0x06 /* stereo B */
1172 #define TEA6320_S_SC 0x05 /* stereo C */
1173 #define TEA6320_S_SD 0x04 /* stereo D */
1174 #define TEA6320_S_GMU 0x80 /* general mute */
1176 #define TEA6420_S_SA 0x00 /* stereo A input */
1177 #define TEA6420_S_SB 0x01 /* stereo B */
1178 #define TEA6420_S_SC 0x02 /* stereo C */
1179 #define TEA6420_S_SD 0x03 /* stereo D */
1180 #define TEA6420_S_SE 0x04 /* stereo E */
1181 #define TEA6420_S_GMU 0x05 /* general mute */
1183 static int tea6300_shift10(int val
) { return val
>> 10; }
1184 static int tea6300_shift12(int val
) { return val
>> 12; }
1186 /* Assumes 16bit input (values 0x3f to 0x0c are unique, values less than */
1187 /* 0x0c mirror those immediately higher) */
1188 static int tea6320_volume(int val
) { return (val
/ (65535/(63-12)) + 12) & 0x3f; }
1189 static int tea6320_shift11(int val
) { return val
>> 11; }
1190 static int tea6320_initialize(struct CHIPSTATE
* chip
)
1192 chip_write(chip
, TEA6320_FFR
, 0x3f);
1193 chip_write(chip
, TEA6320_FFL
, 0x3f);
1194 chip_write(chip
, TEA6320_FRR
, 0x3f);
1195 chip_write(chip
, TEA6320_FRL
, 0x3f);
1201 /* ---------------------------------------------------------------------- */
1202 /* audio chip descriptions - defines+functions for tda8425 */
1204 #define TDA8425_VL 0x00 /* volume left */
1205 #define TDA8425_VR 0x01 /* volume right */
1206 #define TDA8425_BA 0x02 /* bass */
1207 #define TDA8425_TR 0x03 /* treble */
1208 #define TDA8425_S1 0x08 /* switch functions */
1209 /* values for those registers: */
1210 #define TDA8425_S1_OFF 0xEE /* audio off (mute on) */
1211 #define TDA8425_S1_CH1 0xCE /* audio channel 1 (mute off) - "linear stereo" mode */
1212 #define TDA8425_S1_CH2 0xCF /* audio channel 2 (mute off) - "linear stereo" mode */
1213 #define TDA8425_S1_MU 0x20 /* mute bit */
1214 #define TDA8425_S1_STEREO 0x18 /* stereo bits */
1215 #define TDA8425_S1_STEREO_SPATIAL 0x18 /* spatial stereo */
1216 #define TDA8425_S1_STEREO_LINEAR 0x08 /* linear stereo */
1217 #define TDA8425_S1_STEREO_PSEUDO 0x10 /* pseudo stereo */
1218 #define TDA8425_S1_STEREO_MONO 0x00 /* forced mono */
1219 #define TDA8425_S1_ML 0x06 /* language selector */
1220 #define TDA8425_S1_ML_SOUND_A 0x02 /* sound a */
1221 #define TDA8425_S1_ML_SOUND_B 0x04 /* sound b */
1222 #define TDA8425_S1_ML_STEREO 0x06 /* stereo */
1223 #define TDA8425_S1_IS 0x01 /* channel selector */
1226 static int tda8425_shift10(int val
) { return (val
>> 10) | 0xc0; }
1227 static int tda8425_shift12(int val
) { return (val
>> 12) | 0xf0; }
1229 static void tda8425_setmode(struct CHIPSTATE
*chip
, int mode
)
1231 int s1
= chip
->shadow
.bytes
[TDA8425_S1
+1] & 0xe1;
1233 if (mode
& V4L2_TUNER_MODE_LANG1
) {
1234 s1
|= TDA8425_S1_ML_SOUND_A
;
1235 s1
|= TDA8425_S1_STEREO_PSEUDO
;
1237 } else if (mode
& V4L2_TUNER_MODE_LANG2
) {
1238 s1
|= TDA8425_S1_ML_SOUND_B
;
1239 s1
|= TDA8425_S1_STEREO_PSEUDO
;
1242 s1
|= TDA8425_S1_ML_STEREO
;
1244 if (mode
& V4L2_TUNER_MODE_MONO
)
1245 s1
|= TDA8425_S1_STEREO_MONO
;
1246 if (mode
& V4L2_TUNER_MODE_STEREO
)
1247 s1
|= TDA8425_S1_STEREO_SPATIAL
;
1249 chip_write(chip
,TDA8425_S1
,s1
);
1253 /* ---------------------------------------------------------------------- */
1254 /* audio chip descriptions - defines+functions for pic16c54 (PV951) */
1256 /* the registers of 16C54, I2C sub address. */
1257 #define PIC16C54_REG_KEY_CODE 0x01 /* Not use. */
1258 #define PIC16C54_REG_MISC 0x02
1260 /* bit definition of the RESET register, I2C data. */
1261 #define PIC16C54_MISC_RESET_REMOTE_CTL 0x01 /* bit 0, Reset to receive the key */
1262 /* code of remote controller */
1263 #define PIC16C54_MISC_MTS_MAIN 0x02 /* bit 1 */
1264 #define PIC16C54_MISC_MTS_SAP 0x04 /* bit 2 */
1265 #define PIC16C54_MISC_MTS_BOTH 0x08 /* bit 3 */
1266 #define PIC16C54_MISC_SND_MUTE 0x10 /* bit 4, Mute Audio(Line-in and Tuner) */
1267 #define PIC16C54_MISC_SND_NOTMUTE 0x20 /* bit 5 */
1268 #define PIC16C54_MISC_SWITCH_TUNER 0x40 /* bit 6 , Switch to Line-in */
1269 #define PIC16C54_MISC_SWITCH_LINE 0x80 /* bit 7 , Switch to Tuner */
1271 /* ---------------------------------------------------------------------- */
1272 /* audio chip descriptions - defines+functions for TA8874Z */
1274 /* write 1st byte */
1275 #define TA8874Z_LED_STE 0x80
1276 #define TA8874Z_LED_BIL 0x40
1277 #define TA8874Z_LED_EXT 0x20
1278 #define TA8874Z_MONO_SET 0x10
1279 #define TA8874Z_MUTE 0x08
1280 #define TA8874Z_F_MONO 0x04
1281 #define TA8874Z_MODE_SUB 0x02
1282 #define TA8874Z_MODE_MAIN 0x01
1284 /* write 2nd byte */
1285 /*#define TA8874Z_TI 0x80 */ /* test mode */
1286 #define TA8874Z_SEPARATION 0x3f
1287 #define TA8874Z_SEPARATION_DEFAULT 0x10
1290 #define TA8874Z_B1 0x80
1291 #define TA8874Z_B0 0x40
1292 #define TA8874Z_CHAG_FLAG 0x20
1300 static int ta8874z_getmode(struct CHIPSTATE
*chip
)
1304 val
= chip_read(chip
);
1305 mode
= V4L2_TUNER_MODE_MONO
;
1306 if (val
& TA8874Z_B1
){
1307 mode
|= V4L2_TUNER_MODE_LANG1
| V4L2_TUNER_MODE_LANG2
;
1308 }else if (!(val
& TA8874Z_B0
)){
1309 mode
|= V4L2_TUNER_MODE_STEREO
;
1311 /* v4l_dbg(1, debug, chip->c, "ta8874z_getmode(): raw chip read: 0x%02x, return: 0x%02x\n", val, mode); */
1315 static audiocmd ta8874z_stereo
= { 2, {0, TA8874Z_SEPARATION_DEFAULT
}};
1316 static audiocmd ta8874z_mono
= {2, { TA8874Z_MONO_SET
, TA8874Z_SEPARATION_DEFAULT
}};
1317 static audiocmd ta8874z_main
= {2, { 0, TA8874Z_SEPARATION_DEFAULT
}};
1318 static audiocmd ta8874z_sub
= {2, { TA8874Z_MODE_SUB
, TA8874Z_SEPARATION_DEFAULT
}};
1320 static void ta8874z_setmode(struct CHIPSTATE
*chip
, int mode
)
1322 struct v4l2_subdev
*sd
= &chip
->sd
;
1326 v4l2_dbg(1, debug
, sd
, "ta8874z_setmode(): mode: 0x%02x\n", mode
);
1329 case V4L2_TUNER_MODE_MONO
:
1332 case V4L2_TUNER_MODE_STEREO
:
1333 t
= &ta8874z_stereo
;
1335 case V4L2_TUNER_MODE_LANG1
:
1338 case V4L2_TUNER_MODE_LANG2
:
1346 chip_cmd(chip
, "TA8874Z", t
);
1349 static int ta8874z_checkit(struct CHIPSTATE
*chip
)
1352 rc
= chip_read(chip
);
1353 return ((rc
& 0x1f) == 0x1f) ? 1 : 0;
1356 /* ---------------------------------------------------------------------- */
1357 /* audio chip descriptions - struct CHIPDESC */
1359 /* insmod options to enable/disable individual audio chips */
1360 static int tda8425
= 1;
1361 static int tda9840
= 1;
1362 static int tda9850
= 1;
1363 static int tda9855
= 1;
1364 static int tda9873
= 1;
1365 static int tda9874a
= 1;
1366 static int tda9875
= 1;
1367 static int tea6300
; /* default 0 - address clash with msp34xx */
1368 static int tea6320
; /* default 0 - address clash with msp34xx */
1369 static int tea6420
= 1;
1370 static int pic16c54
= 1;
1371 static int ta8874z
; /* default 0 - address clash with tda9840 */
1373 module_param(tda8425
, int, 0444);
1374 module_param(tda9840
, int, 0444);
1375 module_param(tda9850
, int, 0444);
1376 module_param(tda9855
, int, 0444);
1377 module_param(tda9873
, int, 0444);
1378 module_param(tda9874a
, int, 0444);
1379 module_param(tda9875
, int, 0444);
1380 module_param(tea6300
, int, 0444);
1381 module_param(tea6320
, int, 0444);
1382 module_param(tea6420
, int, 0444);
1383 module_param(pic16c54
, int, 0444);
1384 module_param(ta8874z
, int, 0444);
1386 static struct CHIPDESC chiplist
[] = {
1389 .insmodopt
= &tda9840
,
1390 .addr_lo
= I2C_ADDR_TDA9840
>> 1,
1391 .addr_hi
= I2C_ADDR_TDA9840
>> 1,
1393 .flags
= CHIP_NEED_CHECKMODE
,
1396 .checkit
= tda9840_checkit
,
1397 .getmode
= tda9840_getmode
,
1398 .setmode
= tda9840_setmode
,
1400 .init
= { 2, { TDA9840_TEST
, TDA9840_TEST_INT1SN
1401 /* ,TDA9840_SW, TDA9840_MONO */} }
1405 .insmodopt
= &tda9873
,
1406 .addr_lo
= I2C_ADDR_TDA985x_L
>> 1,
1407 .addr_hi
= I2C_ADDR_TDA985x_H
>> 1,
1409 .flags
= CHIP_HAS_INPUTSEL
| CHIP_NEED_CHECKMODE
,
1412 .checkit
= tda9873_checkit
,
1413 .getmode
= tda9873_getmode
,
1414 .setmode
= tda9873_setmode
,
1416 .init
= { 4, { TDA9873_SW
, 0xa4, 0x06, 0x03 } },
1417 .inputreg
= TDA9873_SW
,
1418 .inputmute
= TDA9873_MUTE
| TDA9873_AUTOMUTE
,
1419 .inputmap
= {0xa0, 0xa2, 0xa0, 0xa0},
1420 .inputmask
= TDA9873_INP_MASK
|TDA9873_MUTE
|TDA9873_AUTOMUTE
,
1424 .name
= "tda9874h/a",
1425 .insmodopt
= &tda9874a
,
1426 .addr_lo
= I2C_ADDR_TDA9874
>> 1,
1427 .addr_hi
= I2C_ADDR_TDA9874
>> 1,
1428 .flags
= CHIP_NEED_CHECKMODE
,
1431 .initialize
= tda9874a_initialize
,
1432 .checkit
= tda9874a_checkit
,
1433 .getmode
= tda9874a_getmode
,
1434 .setmode
= tda9874a_setmode
,
1438 .insmodopt
= &tda9875
,
1439 .addr_lo
= I2C_ADDR_TDA9875
>> 1,
1440 .addr_hi
= I2C_ADDR_TDA9875
>> 1,
1441 .flags
= CHIP_HAS_VOLUME
| CHIP_HAS_BASSTREBLE
,
1444 .initialize
= tda9875_initialize
,
1445 .checkit
= tda9875_checkit
,
1446 .volfunc
= tda9875_volume
,
1447 .bassfunc
= tda9875_bass
,
1448 .treblefunc
= tda9875_treble
,
1449 .leftreg
= TDA9875_MVL
,
1450 .rightreg
= TDA9875_MVR
,
1451 .bassreg
= TDA9875_MBA
,
1452 .treblereg
= TDA9875_MTR
,
1458 .insmodopt
= &tda9850
,
1459 .addr_lo
= I2C_ADDR_TDA985x_L
>> 1,
1460 .addr_hi
= I2C_ADDR_TDA985x_H
>> 1,
1463 .getmode
= tda985x_getmode
,
1464 .setmode
= tda985x_setmode
,
1466 .init
= { 8, { TDA9850_C4
, 0x08, 0x08, TDA985x_STEREO
, 0x07, 0x10, 0x10, 0x03 } }
1470 .insmodopt
= &tda9855
,
1471 .addr_lo
= I2C_ADDR_TDA985x_L
>> 1,
1472 .addr_hi
= I2C_ADDR_TDA985x_H
>> 1,
1474 .flags
= CHIP_HAS_VOLUME
| CHIP_HAS_BASSTREBLE
,
1476 .leftreg
= TDA9855_VL
,
1477 .rightreg
= TDA9855_VR
,
1478 .bassreg
= TDA9855_BA
,
1479 .treblereg
= TDA9855_TR
,
1482 .volfunc
= tda9855_volume
,
1483 .bassfunc
= tda9855_bass
,
1484 .treblefunc
= tda9855_treble
,
1485 .getmode
= tda985x_getmode
,
1486 .setmode
= tda985x_setmode
,
1488 .init
= { 12, { 0, 0x6f, 0x6f, 0x0e, 0x07<<1, 0x8<<2,
1489 TDA9855_MUTE
| TDA9855_AVL
| TDA9855_LOUD
| TDA9855_INT
,
1490 TDA985x_STEREO
| TDA9855_LINEAR
| TDA9855_TZCM
| TDA9855_VZCM
,
1491 0x07, 0x10, 0x10, 0x03 }}
1495 .insmodopt
= &tea6300
,
1496 .addr_lo
= I2C_ADDR_TEA6300
>> 1,
1497 .addr_hi
= I2C_ADDR_TEA6300
>> 1,
1499 .flags
= CHIP_HAS_VOLUME
| CHIP_HAS_BASSTREBLE
| CHIP_HAS_INPUTSEL
,
1501 .leftreg
= TEA6300_VR
,
1502 .rightreg
= TEA6300_VL
,
1503 .bassreg
= TEA6300_BA
,
1504 .treblereg
= TEA6300_TR
,
1507 .volfunc
= tea6300_shift10
,
1508 .bassfunc
= tea6300_shift12
,
1509 .treblefunc
= tea6300_shift12
,
1511 .inputreg
= TEA6300_S
,
1512 .inputmap
= { TEA6300_S_SA
, TEA6300_S_SB
, TEA6300_S_SC
},
1513 .inputmute
= TEA6300_S_GMU
,
1517 .insmodopt
= &tea6320
,
1518 .addr_lo
= I2C_ADDR_TEA6300
>> 1,
1519 .addr_hi
= I2C_ADDR_TEA6300
>> 1,
1521 .flags
= CHIP_HAS_VOLUME
| CHIP_HAS_BASSTREBLE
| CHIP_HAS_INPUTSEL
,
1523 .leftreg
= TEA6320_V
,
1524 .rightreg
= TEA6320_V
,
1525 .bassreg
= TEA6320_BA
,
1526 .treblereg
= TEA6320_TR
,
1529 .initialize
= tea6320_initialize
,
1530 .volfunc
= tea6320_volume
,
1531 .bassfunc
= tea6320_shift11
,
1532 .treblefunc
= tea6320_shift11
,
1534 .inputreg
= TEA6320_S
,
1535 .inputmap
= { TEA6320_S_SA
, TEA6420_S_SB
, TEA6300_S_SC
, TEA6320_S_SD
},
1536 .inputmute
= TEA6300_S_GMU
,
1540 .insmodopt
= &tea6420
,
1541 .addr_lo
= I2C_ADDR_TEA6420
>> 1,
1542 .addr_hi
= I2C_ADDR_TEA6420
>> 1,
1544 .flags
= CHIP_HAS_INPUTSEL
,
1547 .inputmap
= { TEA6420_S_SA
, TEA6420_S_SB
, TEA6420_S_SC
},
1548 .inputmute
= TEA6300_S_GMU
,
1552 .insmodopt
= &tda8425
,
1553 .addr_lo
= I2C_ADDR_TDA8425
>> 1,
1554 .addr_hi
= I2C_ADDR_TDA8425
>> 1,
1556 .flags
= CHIP_HAS_VOLUME
| CHIP_HAS_BASSTREBLE
| CHIP_HAS_INPUTSEL
,
1558 .leftreg
= TDA8425_VL
,
1559 .rightreg
= TDA8425_VR
,
1560 .bassreg
= TDA8425_BA
,
1561 .treblereg
= TDA8425_TR
,
1564 .volfunc
= tda8425_shift10
,
1565 .bassfunc
= tda8425_shift12
,
1566 .treblefunc
= tda8425_shift12
,
1567 .setmode
= tda8425_setmode
,
1569 .inputreg
= TDA8425_S1
,
1570 .inputmap
= { TDA8425_S1_CH1
, TDA8425_S1_CH1
, TDA8425_S1_CH1
},
1571 .inputmute
= TDA8425_S1_OFF
,
1575 .name
= "pic16c54 (PV951)",
1576 .insmodopt
= &pic16c54
,
1577 .addr_lo
= I2C_ADDR_PIC16C54
>> 1,
1578 .addr_hi
= I2C_ADDR_PIC16C54
>> 1,
1580 .flags
= CHIP_HAS_INPUTSEL
,
1582 .inputreg
= PIC16C54_REG_MISC
,
1583 .inputmap
= {PIC16C54_MISC_SND_NOTMUTE
|PIC16C54_MISC_SWITCH_TUNER
,
1584 PIC16C54_MISC_SND_NOTMUTE
|PIC16C54_MISC_SWITCH_LINE
,
1585 PIC16C54_MISC_SND_NOTMUTE
|PIC16C54_MISC_SWITCH_LINE
,
1586 PIC16C54_MISC_SND_MUTE
},
1587 .inputmute
= PIC16C54_MISC_SND_MUTE
,
1591 .checkit
= ta8874z_checkit
,
1592 .insmodopt
= &ta8874z
,
1593 .addr_lo
= I2C_ADDR_TDA9840
>> 1,
1594 .addr_hi
= I2C_ADDR_TDA9840
>> 1,
1596 .flags
= CHIP_NEED_CHECKMODE
,
1599 .getmode
= ta8874z_getmode
,
1600 .setmode
= ta8874z_setmode
,
1602 .init
= {2, { TA8874Z_MONO_SET
, TA8874Z_SEPARATION_DEFAULT
}},
1604 { .name
= NULL
} /* EOF */
1608 /* ---------------------------------------------------------------------- */
1610 static int tvaudio_g_ctrl(struct v4l2_subdev
*sd
,
1611 struct v4l2_control
*ctrl
)
1613 struct CHIPSTATE
*chip
= to_state(sd
);
1614 struct CHIPDESC
*desc
= chip
->desc
;
1617 case V4L2_CID_AUDIO_MUTE
:
1618 if (!(desc
->flags
& CHIP_HAS_INPUTSEL
))
1620 ctrl
->value
=chip
->muted
;
1622 case V4L2_CID_AUDIO_VOLUME
:
1623 if (!(desc
->flags
& CHIP_HAS_VOLUME
))
1625 ctrl
->value
= max(chip
->left
,chip
->right
);
1627 case V4L2_CID_AUDIO_BALANCE
:
1630 if (!(desc
->flags
& CHIP_HAS_VOLUME
))
1632 volume
= max(chip
->left
,chip
->right
);
1634 ctrl
->value
=(32768*min(chip
->left
,chip
->right
))/volume
;
1639 case V4L2_CID_AUDIO_BASS
:
1640 if (!(desc
->flags
& CHIP_HAS_BASSTREBLE
))
1642 ctrl
->value
= chip
->bass
;
1644 case V4L2_CID_AUDIO_TREBLE
:
1645 if (!(desc
->flags
& CHIP_HAS_BASSTREBLE
))
1647 ctrl
->value
= chip
->treble
;
1653 static int tvaudio_s_ctrl(struct v4l2_subdev
*sd
,
1654 struct v4l2_control
*ctrl
)
1656 struct CHIPSTATE
*chip
= to_state(sd
);
1657 struct CHIPDESC
*desc
= chip
->desc
;
1660 case V4L2_CID_AUDIO_MUTE
:
1661 if (!(desc
->flags
& CHIP_HAS_INPUTSEL
))
1664 if (ctrl
->value
< 0 || ctrl
->value
>= 2)
1666 chip
->muted
= ctrl
->value
;
1668 chip_write_masked(chip
,desc
->inputreg
,desc
->inputmute
,desc
->inputmask
);
1670 chip_write_masked(chip
,desc
->inputreg
,
1671 desc
->inputmap
[chip
->input
],desc
->inputmask
);
1673 case V4L2_CID_AUDIO_VOLUME
:
1677 if (!(desc
->flags
& CHIP_HAS_VOLUME
))
1680 volume
= max(chip
->left
,chip
->right
);
1682 balance
=(32768*min(chip
->left
,chip
->right
))/volume
;
1687 chip
->left
= (min(65536 - balance
,32768) * volume
) / 32768;
1688 chip
->right
= (min(balance
,volume
*(__u16
)32768)) / 32768;
1690 chip_write(chip
,desc
->leftreg
,desc
->volfunc(chip
->left
));
1691 chip_write(chip
,desc
->rightreg
,desc
->volfunc(chip
->right
));
1695 case V4L2_CID_AUDIO_BALANCE
:
1697 int volume
, balance
;
1699 if (!(desc
->flags
& CHIP_HAS_VOLUME
))
1702 volume
= max(chip
->left
, chip
->right
);
1703 balance
= ctrl
->value
;
1704 chip
->left
= (min(65536 - balance
, 32768) * volume
) / 32768;
1705 chip
->right
= (min(balance
, volume
* (__u16
)32768)) / 32768;
1707 chip_write(chip
, desc
->leftreg
, desc
->volfunc(chip
->left
));
1708 chip_write(chip
, desc
->rightreg
, desc
->volfunc(chip
->right
));
1712 case V4L2_CID_AUDIO_BASS
:
1713 if (!(desc
->flags
& CHIP_HAS_BASSTREBLE
))
1715 chip
->bass
= ctrl
->value
;
1716 chip_write(chip
,desc
->bassreg
,desc
->bassfunc(chip
->bass
));
1719 case V4L2_CID_AUDIO_TREBLE
:
1720 if (!(desc
->flags
& CHIP_HAS_BASSTREBLE
))
1722 chip
->treble
= ctrl
->value
;
1723 chip_write(chip
,desc
->treblereg
,desc
->treblefunc(chip
->treble
));
1731 /* ---------------------------------------------------------------------- */
1732 /* video4linux interface */
1734 static int tvaudio_s_radio(struct v4l2_subdev
*sd
)
1736 struct CHIPSTATE
*chip
= to_state(sd
);
1739 chip
->watch_stereo
= 0;
1740 /* del_timer(&chip->wt); */
1744 static int tvaudio_queryctrl(struct v4l2_subdev
*sd
, struct v4l2_queryctrl
*qc
)
1746 struct CHIPSTATE
*chip
= to_state(sd
);
1747 struct CHIPDESC
*desc
= chip
->desc
;
1750 case V4L2_CID_AUDIO_MUTE
:
1751 if (desc
->flags
& CHIP_HAS_INPUTSEL
)
1752 return v4l2_ctrl_query_fill(qc
, 0, 1, 1, 0);
1754 case V4L2_CID_AUDIO_VOLUME
:
1755 if (desc
->flags
& CHIP_HAS_VOLUME
)
1756 return v4l2_ctrl_query_fill(qc
, 0, 65535, 65535 / 100, 58880);
1758 case V4L2_CID_AUDIO_BALANCE
:
1759 if (desc
->flags
& CHIP_HAS_VOLUME
)
1760 return v4l2_ctrl_query_fill(qc
, 0, 65535, 65535 / 100, 32768);
1762 case V4L2_CID_AUDIO_BASS
:
1763 case V4L2_CID_AUDIO_TREBLE
:
1764 if (desc
->flags
& CHIP_HAS_BASSTREBLE
)
1765 return v4l2_ctrl_query_fill(qc
, 0, 65535, 65535 / 100, 32768);
1773 static int tvaudio_s_routing(struct v4l2_subdev
*sd
,
1774 u32 input
, u32 output
, u32 config
)
1776 struct CHIPSTATE
*chip
= to_state(sd
);
1777 struct CHIPDESC
*desc
= chip
->desc
;
1779 if (!(desc
->flags
& CHIP_HAS_INPUTSEL
))
1783 /* There are four inputs: tuner, radio, extern and intern. */
1784 chip
->input
= input
;
1787 chip_write_masked(chip
, desc
->inputreg
,
1788 desc
->inputmap
[chip
->input
], desc
->inputmask
);
1792 static int tvaudio_s_tuner(struct v4l2_subdev
*sd
, struct v4l2_tuner
*vt
)
1794 struct CHIPSTATE
*chip
= to_state(sd
);
1795 struct CHIPDESC
*desc
= chip
->desc
;
1803 switch (vt
->audmode
) {
1804 case V4L2_TUNER_MODE_MONO
:
1805 case V4L2_TUNER_MODE_STEREO
:
1806 case V4L2_TUNER_MODE_LANG1
:
1807 case V4L2_TUNER_MODE_LANG2
:
1810 case V4L2_TUNER_MODE_LANG1_LANG2
:
1811 mode
= V4L2_TUNER_MODE_STEREO
;
1816 chip
->audmode
= vt
->audmode
;
1819 chip
->watch_stereo
= 0;
1820 /* del_timer(&chip->wt); */
1822 desc
->setmode(chip
, mode
);
1827 static int tvaudio_g_tuner(struct v4l2_subdev
*sd
, struct v4l2_tuner
*vt
)
1829 struct CHIPSTATE
*chip
= to_state(sd
);
1830 struct CHIPDESC
*desc
= chip
->desc
;
1831 int mode
= V4L2_TUNER_MODE_MONO
;
1838 vt
->audmode
= chip
->audmode
;
1840 vt
->capability
= V4L2_TUNER_CAP_STEREO
|
1841 V4L2_TUNER_CAP_LANG1
| V4L2_TUNER_CAP_LANG2
;
1843 mode
= desc
->getmode(chip
);
1845 if (mode
& V4L2_TUNER_MODE_MONO
)
1846 vt
->rxsubchans
|= V4L2_TUNER_SUB_MONO
;
1847 if (mode
& V4L2_TUNER_MODE_STEREO
)
1848 vt
->rxsubchans
|= V4L2_TUNER_SUB_STEREO
;
1849 /* Note: for SAP it should be mono/lang2 or stereo/lang2.
1850 When this module is converted fully to v4l2, then this
1851 should change for those chips that can detect SAP. */
1852 if (mode
& V4L2_TUNER_MODE_LANG1
)
1853 vt
->rxsubchans
= V4L2_TUNER_SUB_LANG1
|
1854 V4L2_TUNER_SUB_LANG2
;
1858 static int tvaudio_s_std(struct v4l2_subdev
*sd
, v4l2_std_id std
)
1860 struct CHIPSTATE
*chip
= to_state(sd
);
1866 static int tvaudio_s_frequency(struct v4l2_subdev
*sd
, struct v4l2_frequency
*freq
)
1868 struct CHIPSTATE
*chip
= to_state(sd
);
1869 struct CHIPDESC
*desc
= chip
->desc
;
1871 chip
->mode
= 0; /* automatic */
1873 /* For chips that provide getmode and setmode, and doesn't
1874 automatically follows the stereo carrier, a kthread is
1875 created to set the audio standard. In this case, when then
1876 the video channel is changed, tvaudio starts on MONO mode.
1877 After waiting for 2 seconds, the kernel thread is called,
1878 to follow whatever audio standard is pointed by the
1882 desc
->setmode(chip
, V4L2_TUNER_MODE_MONO
);
1883 if (chip
->prevmode
!= V4L2_TUNER_MODE_MONO
)
1884 chip
->prevmode
= -1; /* reset previous mode */
1885 mod_timer(&chip
->wt
, jiffies
+msecs_to_jiffies(2000));
1890 static int tvaudio_g_chip_ident(struct v4l2_subdev
*sd
, struct v4l2_dbg_chip_ident
*chip
)
1892 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
1894 return v4l2_chip_ident_i2c_client(client
, chip
, V4L2_IDENT_TVAUDIO
, 0);
1897 /* ----------------------------------------------------------------------- */
1899 static const struct v4l2_subdev_core_ops tvaudio_core_ops
= {
1900 .g_chip_ident
= tvaudio_g_chip_ident
,
1901 .queryctrl
= tvaudio_queryctrl
,
1902 .g_ctrl
= tvaudio_g_ctrl
,
1903 .s_ctrl
= tvaudio_s_ctrl
,
1904 .s_std
= tvaudio_s_std
,
1907 static const struct v4l2_subdev_tuner_ops tvaudio_tuner_ops
= {
1908 .s_radio
= tvaudio_s_radio
,
1909 .s_frequency
= tvaudio_s_frequency
,
1910 .s_tuner
= tvaudio_s_tuner
,
1911 .g_tuner
= tvaudio_g_tuner
,
1914 static const struct v4l2_subdev_audio_ops tvaudio_audio_ops
= {
1915 .s_routing
= tvaudio_s_routing
,
1918 static const struct v4l2_subdev_ops tvaudio_ops
= {
1919 .core
= &tvaudio_core_ops
,
1920 .tuner
= &tvaudio_tuner_ops
,
1921 .audio
= &tvaudio_audio_ops
,
1924 /* ----------------------------------------------------------------------- */
1927 /* i2c registration */
1929 static int tvaudio_probe(struct i2c_client
*client
, const struct i2c_device_id
*id
)
1931 struct CHIPSTATE
*chip
;
1932 struct CHIPDESC
*desc
;
1933 struct v4l2_subdev
*sd
;
1936 printk(KERN_INFO
"tvaudio: TV audio decoder + audio/video mux driver\n");
1937 printk(KERN_INFO
"tvaudio: known chips: ");
1938 for (desc
= chiplist
; desc
->name
!= NULL
; desc
++)
1939 printk("%s%s", (desc
== chiplist
) ? "" : ", ", desc
->name
);
1943 chip
= kzalloc(sizeof(*chip
), GFP_KERNEL
);
1947 v4l2_i2c_subdev_init(sd
, client
, &tvaudio_ops
);
1949 /* find description for the chip */
1950 v4l2_dbg(1, debug
, sd
, "chip found @ 0x%x\n", client
->addr
<<1);
1951 for (desc
= chiplist
; desc
->name
!= NULL
; desc
++) {
1952 if (0 == *(desc
->insmodopt
))
1954 if (client
->addr
< desc
->addr_lo
||
1955 client
->addr
> desc
->addr_hi
)
1957 if (desc
->checkit
&& !desc
->checkit(chip
))
1961 if (desc
->name
== NULL
) {
1962 v4l2_dbg(1, debug
, sd
, "no matching chip description found\n");
1966 v4l2_info(sd
, "%s found @ 0x%x (%s)\n", desc
->name
, client
->addr
<<1, client
->adapter
->name
);
1968 v4l2_dbg(1, debug
, sd
, "matches:%s%s%s.\n",
1969 (desc
->flags
& CHIP_HAS_VOLUME
) ? " volume" : "",
1970 (desc
->flags
& CHIP_HAS_BASSTREBLE
) ? " bass/treble" : "",
1971 (desc
->flags
& CHIP_HAS_INPUTSEL
) ? " audiomux" : "");
1974 /* fill required data structures */
1976 strlcpy(client
->name
, desc
->name
, I2C_NAME_SIZE
);
1978 chip
->shadow
.count
= desc
->registers
+1;
1979 chip
->prevmode
= -1;
1980 chip
->audmode
= V4L2_TUNER_MODE_LANG1
;
1982 /* initialization */
1983 if (desc
->initialize
!= NULL
)
1984 desc
->initialize(chip
);
1986 chip_cmd(chip
, "init", &desc
->init
);
1988 if (desc
->flags
& CHIP_HAS_VOLUME
) {
1989 if (!desc
->volfunc
) {
1990 /* This shouldn't be happen. Warn user, but keep working
1991 without volume controls
1993 v4l2_info(sd
, "volume callback undefined!\n");
1994 desc
->flags
&= ~CHIP_HAS_VOLUME
;
1996 chip
->left
= desc
->leftinit
? desc
->leftinit
: 65535;
1997 chip
->right
= desc
->rightinit
? desc
->rightinit
: 65535;
1998 chip_write(chip
, desc
->leftreg
,
1999 desc
->volfunc(chip
->left
));
2000 chip_write(chip
, desc
->rightreg
,
2001 desc
->volfunc(chip
->right
));
2004 if (desc
->flags
& CHIP_HAS_BASSTREBLE
) {
2005 if (!desc
->bassfunc
|| !desc
->treblefunc
) {
2006 /* This shouldn't be happen. Warn user, but keep working
2007 without bass/treble controls
2009 v4l2_info(sd
, "bass/treble callbacks undefined!\n");
2010 desc
->flags
&= ~CHIP_HAS_BASSTREBLE
;
2012 chip
->treble
= desc
->trebleinit
?
2013 desc
->trebleinit
: 32768;
2014 chip
->bass
= desc
->bassinit
?
2015 desc
->bassinit
: 32768;
2016 chip_write(chip
, desc
->bassreg
,
2017 desc
->bassfunc(chip
->bass
));
2018 chip_write(chip
, desc
->treblereg
,
2019 desc
->treblefunc(chip
->treble
));
2023 chip
->thread
= NULL
;
2024 init_timer(&chip
->wt
);
2025 if (desc
->flags
& CHIP_NEED_CHECKMODE
) {
2026 if (!desc
->getmode
|| !desc
->setmode
) {
2027 /* This shouldn't be happen. Warn user, but keep working
2030 v4l2_info(sd
, "set/get mode callbacks undefined!\n");
2033 /* start async thread */
2034 chip
->wt
.function
= chip_thread_wake
;
2035 chip
->wt
.data
= (unsigned long)chip
;
2036 chip
->thread
= kthread_run(chip_thread
, chip
, client
->name
);
2037 if (IS_ERR(chip
->thread
)) {
2038 v4l2_warn(sd
, "failed to create kthread\n");
2039 chip
->thread
= NULL
;
2045 static int tvaudio_remove(struct i2c_client
*client
)
2047 struct v4l2_subdev
*sd
= i2c_get_clientdata(client
);
2048 struct CHIPSTATE
*chip
= to_state(sd
);
2050 del_timer_sync(&chip
->wt
);
2052 /* shutdown async thread */
2053 kthread_stop(chip
->thread
);
2054 chip
->thread
= NULL
;
2057 v4l2_device_unregister_subdev(sd
);
2062 /* This driver supports many devices and the idea is to let the driver
2063 detect which device is present. So rather than listing all supported
2064 devices here, we pretend to support a single, fake device type. */
2065 static const struct i2c_device_id tvaudio_id
[] = {
2069 MODULE_DEVICE_TABLE(i2c
, tvaudio_id
);
2071 static struct i2c_driver tvaudio_driver
= {
2073 .owner
= THIS_MODULE
,
2076 .probe
= tvaudio_probe
,
2077 .remove
= tvaudio_remove
,
2078 .id_table
= tvaudio_id
,
2081 static __init
int init_tvaudio(void)
2083 return i2c_add_driver(&tvaudio_driver
);
2086 static __exit
void exit_tvaudio(void)
2088 i2c_del_driver(&tvaudio_driver
);
2091 module_init(init_tvaudio
);
2092 module_exit(exit_tvaudio
);