Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
tvaudio.c
Go to the documentation of this file.
1 /*
2  * Driver for simple i2c audio chips.
3  *
4  * Copyright (c) 2000 Gerd Knorr
5  * based on code by:
6  * Eric Sandeen ([email protected])
7  * Steve VanDeBogart ([email protected])
8  * Greg Alexander ([email protected])
9  *
10  * For the TDA9875 part:
11  * Copyright (c) 2000 Guillaume Delvit based on Gerd Knorr source
12  * and Eric Sandeen
13  *
14  * Copyright(c) 2005-2008 Mauro Carvalho Chehab
15  * - Some cleanups, code fixes, etc
16  * - Convert it to V4L2 API
17  *
18  * This code is placed under the terms of the GNU General Public License
19  *
20  * OPTIONS:
21  * debug - set to 1 if you'd like to see debug messages
22  *
23  */
24 
25 #include <linux/module.h>
26 #include <linux/kernel.h>
27 #include <linux/sched.h>
28 #include <linux/string.h>
29 #include <linux/timer.h>
30 #include <linux/delay.h>
31 #include <linux/errno.h>
32 #include <linux/slab.h>
33 #include <linux/videodev2.h>
34 #include <linux/i2c.h>
35 #include <linux/init.h>
36 #include <linux/kthread.h>
37 #include <linux/freezer.h>
38 
39 #include <media/tvaudio.h>
40 #include <media/v4l2-device.h>
41 #include <media/v4l2-chip-ident.h>
42 
43 #include <media/i2c-addr.h>
44 
45 /* ---------------------------------------------------------------------- */
46 /* insmod args */
47 
48 static int debug; /* insmod parameter */
49 module_param(debug, int, 0644);
50 
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");
54 
55 #define UNSET (-1U)
56 
57 /* ---------------------------------------------------------------------- */
58 /* our structs */
59 
60 #define MAXREGS 256
61 
62 struct CHIPSTATE;
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);
68 
69 /* i2c command */
70 typedef struct AUDIOCMD {
71  int count; /* # of bytes to send */
72  unsigned char bytes[MAXREGS+1]; /* addr, data, data, ... */
73 } audiocmd;
74 
75 /* chip description */
76 struct CHIPDESC {
77  char *name; /* chip name */
78  int addr_lo, addr_hi; /* i2c address range */
79  int registers; /* # of registers */
80 
81  int *insmodopt;
84  int flags;
85 #define CHIP_HAS_VOLUME 1
86 #define CHIP_HAS_BASSTREBLE 2
87 #define CHIP_HAS_INPUTSEL 4
88 #define CHIP_NEED_CHECKMODE 8
89 
90  /* various i2c command sequences */
92 
93  /* which register has which value */
95 
96  /* initialize with (defaults to 65535/65535/32768/32768 */
98 
99  /* functions to convert the values (v4l -> chip) */
101 
102  /* get/set mode */
105 
106  /* input switch register + values for v4l inputs */
107  int inputreg;
108  int inputmap[4];
111 };
112 
113 /* current state of the chip */
114 struct CHIPSTATE {
115  struct v4l2_subdev sd;
116 
117  /* chip-specific description - should point to
118  an entry at CHIPDESC table */
119  struct CHIPDESC *desc;
120 
121  /* shadow register set */
123 
124  /* current settings */
126  int prevmode;
127  int radio;
128  int input;
129 
130  /* thread */
132  struct timer_list wt;
133  int audmode;
134 };
135 
136 static inline struct CHIPSTATE *to_state(struct v4l2_subdev *sd)
137 {
138  return container_of(sd, struct CHIPSTATE, sd);
139 }
140 
141 
142 /* ---------------------------------------------------------------------- */
143 /* i2c I/O functions */
144 
145 static int chip_write(struct CHIPSTATE *chip, int subaddr, int val)
146 {
147  struct v4l2_subdev *sd = &chip->sd;
148  struct i2c_client *c = v4l2_get_subdevdata(sd);
149  unsigned char buffer[2];
150 
151  if (subaddr < 0) {
152  v4l2_dbg(1, debug, sd, "chip_write: 0x%x\n", val);
153  chip->shadow.bytes[1] = val;
154  buffer[0] = val;
155  if (1 != i2c_master_send(c, buffer, 1)) {
156  v4l2_warn(sd, "I/O error (write 0x%x)\n", val);
157  return -1;
158  }
159  } else {
160  if (subaddr + 1 >= ARRAY_SIZE(chip->shadow.bytes)) {
161  v4l2_info(sd,
162  "Tried to access a non-existent register: %d\n",
163  subaddr);
164  return -EINVAL;
165  }
166 
167  v4l2_dbg(1, debug, sd, "chip_write: reg%d=0x%x\n",
168  subaddr, val);
169  chip->shadow.bytes[subaddr+1] = val;
170  buffer[0] = subaddr;
171  buffer[1] = val;
172  if (2 != i2c_master_send(c, buffer, 2)) {
173  v4l2_warn(sd, "I/O error (write reg%d=0x%x)\n",
174  subaddr, val);
175  return -1;
176  }
177  }
178  return 0;
179 }
180 
181 static int chip_write_masked(struct CHIPSTATE *chip,
182  int subaddr, int val, int mask)
183 {
184  struct v4l2_subdev *sd = &chip->sd;
185 
186  if (mask != 0) {
187  if (subaddr < 0) {
188  val = (chip->shadow.bytes[1] & ~mask) | (val & mask);
189  } else {
190  if (subaddr + 1 >= ARRAY_SIZE(chip->shadow.bytes)) {
191  v4l2_info(sd,
192  "Tried to access a non-existent register: %d\n",
193  subaddr);
194  return -EINVAL;
195  }
196 
197  val = (chip->shadow.bytes[subaddr+1] & ~mask) | (val & mask);
198  }
199  }
200  return chip_write(chip, subaddr, val);
201 }
202 
203 static int chip_read(struct CHIPSTATE *chip)
204 {
205  struct v4l2_subdev *sd = &chip->sd;
206  struct i2c_client *c = v4l2_get_subdevdata(sd);
207  unsigned char buffer;
208 
209  if (1 != i2c_master_recv(c, &buffer, 1)) {
210  v4l2_warn(sd, "I/O error (read)\n");
211  return -1;
212  }
213  v4l2_dbg(1, debug, sd, "chip_read: 0x%x\n", buffer);
214  return buffer;
215 }
216 
217 static int chip_read2(struct CHIPSTATE *chip, int subaddr)
218 {
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] = {
224  {
225  .addr = c->addr,
226  .len = 1,
227  .buf = write
228  },
229  {
230  .addr = c->addr,
231  .flags = I2C_M_RD,
232  .len = 1,
233  .buf = read
234  }
235  };
236 
237  write[0] = subaddr;
238 
239  if (2 != i2c_transfer(c->adapter, msgs, 2)) {
240  v4l2_warn(sd, "I/O error (read2)\n");
241  return -1;
242  }
243  v4l2_dbg(1, debug, sd, "chip_read2: reg%d=0x%x\n",
244  subaddr, read[0]);
245  return read[0];
246 }
247 
248 static int chip_cmd(struct CHIPSTATE *chip, char *name, audiocmd *cmd)
249 {
250  struct v4l2_subdev *sd = &chip->sd;
251  struct i2c_client *c = v4l2_get_subdevdata(sd);
252  int i;
253 
254  if (0 == cmd->count)
255  return 0;
256 
257  if (cmd->count + cmd->bytes[0] - 1 >= ARRAY_SIZE(chip->shadow.bytes)) {
258  v4l2_info(sd,
259  "Tried to access a non-existent register range: %d to %d\n",
260  cmd->bytes[0] + 1, cmd->bytes[0] + cmd->count - 1);
261  return -EINVAL;
262  }
263 
264  /* FIXME: it seems that the shadow bytes are wrong bellow !*/
265 
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++) {
270  if (debug)
271  printk(KERN_CONT " 0x%x", cmd->bytes[i]);
272  chip->shadow.bytes[i+cmd->bytes[0]] = cmd->bytes[i];
273  }
274  if (debug)
275  printk(KERN_CONT "\n");
276 
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);
280  return -1;
281  }
282  return 0;
283 }
284 
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
289  * if available, ...
290  */
291 
292 static void chip_thread_wake(unsigned long data)
293 {
294  struct CHIPSTATE *chip = (struct CHIPSTATE*)data;
295  wake_up_process(chip->thread);
296 }
297 
298 static int chip_thread(void *data)
299 {
300  struct CHIPSTATE *chip = data;
301  struct CHIPDESC *desc = chip->desc;
302  struct v4l2_subdev *sd = &chip->sd;
303  int mode, selected;
304 
305  v4l2_dbg(1, debug, sd, "thread started\n");
306  set_freezable();
307  for (;;) {
309  if (!kthread_should_stop())
310  schedule();
312  try_to_freeze();
313  if (kthread_should_stop())
314  break;
315  v4l2_dbg(1, debug, sd, "thread wakeup\n");
316 
317  /* don't do anything for radio */
318  if (chip->radio)
319  continue;
320 
321  /* have a look what's going on */
322  mode = desc->getrxsubchans(chip);
323  if (mode == chip->prevmode)
324  continue;
325 
326  /* chip detected a new audio mode - set it */
327  v4l2_dbg(1, debug, sd, "thread checkmode\n");
328 
329  chip->prevmode = mode;
330 
331  selected = V4L2_TUNER_MODE_MONO;
332  switch (chip->audmode) {
334  if (mode & V4L2_TUNER_SUB_LANG1)
335  selected = V4L2_TUNER_MODE_LANG1;
336  break;
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;
343  break;
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;
349  break;
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;
355  }
356  desc->setaudmode(chip, selected);
357 
358  /* schedule next check */
359  mod_timer(&chip->wt, jiffies+msecs_to_jiffies(2000));
360  }
361 
362  v4l2_dbg(1, debug, sd, "thread exiting\n");
363  return 0;
364 }
365 
366 /* ---------------------------------------------------------------------- */
367 /* audio chip descriptions - defines+functions for tda9840 */
368 
369 #define TDA9840_SW 0x00
370 #define TDA9840_LVADJ 0x02
371 #define TDA9840_STADJ 0x03
372 #define TDA9840_TEST 0x04
373 
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
381 
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 */
385 
386 #define TDA9840_TEST_INT1SN 0x1 /* Integration time 0.5s when set */
387 #define TDA9840_TEST_INTFU 0x02 /* Disables integrator function */
388 
389 static int tda9840_getrxsubchans(struct CHIPSTATE *chip)
390 {
391  struct v4l2_subdev *sd = &chip->sd;
392  int val, mode;
393 
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;
400 
401  v4l2_dbg(1, debug, sd,
402  "tda9840_getrxsubchans(): raw chip read: %d, return: %d\n",
403  val, mode);
404  return mode;
405 }
406 
407 static void tda9840_setaudmode(struct CHIPSTATE *chip, int mode)
408 {
409  int update = 1;
410  int t = chip->shadow.bytes[TDA9840_SW + 1] & ~0x7e;
411 
412  switch (mode) {
414  t |= TDA9840_MONO;
415  break;
417  t |= TDA9840_STEREO;
418  break;
420  t |= TDA9840_DUALA;
421  break;
423  t |= TDA9840_DUALB;
424  break;
426  t |= TDA9840_DUALAB;
427  break;
428  default:
429  update = 0;
430  }
431 
432  if (update)
433  chip_write(chip, TDA9840_SW, t);
434 }
435 
436 static int tda9840_checkit(struct CHIPSTATE *chip)
437 {
438  int rc;
439  rc = chip_read(chip);
440  /* lower 5 bits should be 0 */
441  return ((rc & 0x1f) == 0) ? 1 : 0;
442 }
443 
444 /* ---------------------------------------------------------------------- */
445 /* audio chip descriptions - defines+functions for tda985x */
446 
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 */
453 
454 /* subaddresses for TDA9850 */
455 #define TDA9850_C4 0x04 /* Control 1 for TDA9850 */
456 
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 */
464 
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 */
470 
471 
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 */
475 
476 
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 */
480 
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 */
486 
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 */
490 
491 
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) */
503 
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 */
507 
508 
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) */
516 
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*/
525 
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 */
530 
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)*/
538 
539 /* 0x0a - A3 */
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 */
544 
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; }
548 
549 static int tda985x_getrxsubchans(struct CHIPSTATE *chip)
550 {
551  int mode, val;
552 
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;
561  return mode;
562 }
563 
564 static void tda985x_setaudmode(struct CHIPSTATE *chip, int mode)
565 {
566  int update = 1;
567  int c6 = chip->shadow.bytes[TDA985x_C6+1] & 0x3f;
568 
569  switch (mode) {
571  c6 |= TDA985x_MONO;
572  break;
575  c6 |= TDA985x_STEREO;
576  break;
577  case V4L2_TUNER_MODE_SAP:
578  c6 |= TDA985x_SAP;
579  break;
581  c6 |= TDA985x_MONOSAP;
582  break;
583  default:
584  update = 0;
585  }
586  if (update)
587  chip_write(chip,TDA985x_C6,c6);
588 }
589 
590 
591 /* ---------------------------------------------------------------------- */
592 /* audio chip descriptions - defines+functions for tda9873h */
593 
594 /* Subaddresses for TDA9873H */
595 
596 #define TDA9873_SW 0x00 /* Switching */
597 #define TDA9873_AD 0x01 /* Adjust */
598 #define TDA9873_PT 0x02 /* Port */
599 
600 /* Subaddress 0x00: Switching Data
601  * B7..B0:
602  *
603  * B1, B0: Input source selection
604  * 0, 0 internal
605  * 1, 0 external stereo
606  * 0, 1 external mono
607  */
608 #define TDA9873_INP_MASK 3
609 #define TDA9873_INTERNAL 0
610 #define TDA9873_EXT_STEREO 2
611 #define TDA9873_EXT_MONO 1
612 
613 /* B3, B2: output signal select
614  * B4 : transmission mode
615  * 0, 0, 1 Mono
616  * 1, 0, 0 Stereo
617  * 1, 1, 1 Stereo (reversed channel)
618  * 0, 0, 0 Dual AB
619  * 0, 0, 1 Dual AA
620  * 0, 1, 0 Dual BB
621  * 0, 1, 1 Dual BA
622  */
623 
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
631 
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)
636  */
637 
638 #define TDA9873_GAIN_NORMAL 1 << 5
639 #define TDA9873_MUTE 1 << 6
640 #define TDA9873_AUTOMUTE 1 << 7
641 
642 /* Subaddress 0x01: Adjust/standard */
643 
644 /* Lower 4 bits (C3..C0) control stereo adjustment on R channel (-0.6 - +0.7 dB)
645  * Recommended value is +0 dB
646  */
647 
648 #define TDA9873_STEREO_ADJ 0x06 /* 0dB gain */
649 
650 /* Bits C6..C4 control FM stantard
651  * C6, C5, C4
652  * 0, 0, 0 B/G (PAL FM)
653  * 0, 0, 1 M
654  * 0, 1, 0 D/K(1)
655  * 0, 1, 1 D/K(2)
656  * 1, 0, 0 D/K(3)
657  * 1, 0, 1 I
658  */
659 #define TDA9873_BG 0
660 #define TDA9873_M 1
661 #define TDA9873_DK1 2
662 #define TDA9873_DK2 3
663 #define TDA9873_DK3 4
664 #define TDA9873_I 5
665 
666 /* C7 controls identification response time (1=fast/0=normal)
667  */
668 #define TDA9873_IDR_NORM 0
669 #define TDA9873_IDR_FAST 1 << 7
670 
671 
672 /* Subaddress 0x02: Port data */
673 
674 /* E1, E0 free programmable ports P1/P2
675  0, 0 both ports low
676  0, 1 P1 high
677  1, 0 P2 high
678  1, 1 both ports high
679 */
680 
681 #define TDA9873_PORTS 3
682 
683 /* E2: test port */
684 #define TDA9873_TST_PORT 1 << 2
685 
686 /* E5..E3 control mono output channel (together with transmission mode bit B4)
687  *
688  * E5 E4 E3 B4 OUTM
689  * 0 0 0 0 mono
690  * 0 0 1 0 DUAL B
691  * 0 1 0 1 mono (from stereo decoder)
692  */
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))
703 
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 */
708 
709 static int tda9873_getrxsubchans(struct CHIPSTATE *chip)
710 {
711  struct v4l2_subdev *sd = &chip->sd;
712  int val,mode;
713 
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",
722  val, mode);
723  return mode;
724 }
725 
726 static void tda9873_setaudmode(struct CHIPSTATE *chip, int mode)
727 {
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] ; */
731 
732  if ((sw_data & TDA9873_INP_MASK) != TDA9873_INTERNAL) {
733  v4l2_dbg(1, debug, sd,
734  "tda9873_setaudmode(): external input\n");
735  return;
736  }
737 
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",
742  sw_data);
743 
744  switch (mode) {
746  sw_data |= TDA9873_TR_MONO;
747  break;
749  sw_data |= TDA9873_TR_STEREO;
750  break;
752  sw_data |= TDA9873_TR_DUALA;
753  break;
755  sw_data |= TDA9873_TR_DUALB;
756  break;
758  sw_data |= TDA9873_TR_DUALAB;
759  break;
760  default:
761  return;
762  }
763 
764  chip_write(chip, TDA9873_SW, sw_data);
765  v4l2_dbg(1, debug, sd,
766  "tda9873_setaudmode(): req. mode %d; chip_write: %d\n",
767  mode, sw_data);
768 }
769 
770 static int tda9873_checkit(struct CHIPSTATE *chip)
771 {
772  int rc;
773 
774  if (-1 == (rc = chip_read2(chip,254)))
775  return 0;
776  return (rc & ~0x1f) == 0x80;
777 }
778 
779 
780 /* ---------------------------------------------------------------------- */
781 /* audio chip description - defines+functions for tda9874h and tda9874a */
782 /* Dariusz Kowalewski <[email protected]> */
783 
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) */
811 
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 */
825 
826 
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 */
832 
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);
840 
841 /*
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.
848  */
849 static struct tda9874a_MODES {
850  char *name;
851  audiocmd cmd;
852 } tda9874a_modelist[9] = {
853  { "A2, B/G", /* default */
854  { 9, { TDA9874A_C1FRA, 0x72,0x95,0x55, 0x77,0xA0,0x00, 0x00,0x00 }} },
855  { "A2, M (Korea)",
856  { 9, { TDA9874A_C1FRA, 0x5D,0xC0,0x00, 0x62,0x6A,0xAA, 0x20,0x22 }} },
857  { "A2, D/K (1)",
858  { 9, { TDA9874A_C1FRA, 0x87,0x6A,0xAA, 0x82,0x60,0x00, 0x00,0x00 }} },
859  { "A2, D/K (2)",
860  { 9, { TDA9874A_C1FRA, 0x87,0x6A,0xAA, 0x8C,0x75,0x55, 0x00,0x00 }} },
861  { "A2, D/K (3)",
862  { 9, { TDA9874A_C1FRA, 0x87,0x6A,0xAA, 0x77,0xA0,0x00, 0x00,0x00 }} },
863  { "NICAM, I",
864  { 9, { TDA9874A_C1FRA, 0x7D,0x00,0x00, 0x88,0x8A,0xAA, 0x08,0x33 }} },
865  { "NICAM, B/G",
866  { 9, { TDA9874A_C1FRA, 0x72,0x95,0x55, 0x79,0xEA,0xAA, 0x08,0x33 }} },
867  { "NICAM, D/K",
868  { 9, { TDA9874A_C1FRA, 0x87,0x6A,0xAA, 0x79,0xEA,0xAA, 0x08,0x33 }} },
869  { "NICAM, L",
870  { 9, { TDA9874A_C1FRA, 0x87,0x6A,0xAA, 0x79,0xEA,0xAA, 0x09,0x33 }} }
871 };
872 
873 static int tda9874a_setup(struct CHIPSTATE *chip)
874 {
875  struct v4l2_subdev *sd = &chip->sd;
876 
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);
885  }
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 */
895 
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 */
906  }
907  v4l2_dbg(1, debug, sd, "tda9874a_setup(): %s [0x%02X].\n",
908  tda9874a_modelist[tda9874a_STD].name,tda9874a_STD);
909  return 1;
910 }
911 
912 static int tda9874a_getrxsubchans(struct CHIPSTATE *chip)
913 {
914  struct v4l2_subdev *sd = &chip->sd;
915  int dsr,nsr,mode;
916  int necr; /* just for debugging */
917 
918  mode = V4L2_TUNER_SUB_MONO;
919 
920  if(-1 == (dsr = chip_read2(chip,TDA9874A_DSR)))
921  return mode;
922  if(-1 == (nsr = chip_read2(chip,TDA9874A_NSR)))
923  return mode;
924  if(-1 == (necr = chip_read2(chip,TDA9874A_NECR)))
925  return mode;
926 
927  /* need to store dsr/nsr somewhere */
928  chip->shadow.bytes[MAXREGS-2] = dsr;
929  chip->shadow.bytes[MAXREGS-1] = nsr;
930 
931  if(tda9874a_mode) {
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().
939  */
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;
944  } else {
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;
949  }
950 
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);
954  return mode;
955 }
956 
957 static void tda9874a_setaudmode(struct CHIPSTATE *chip, int mode)
958 {
959  struct v4l2_subdev *sd = &chip->sd;
960 
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. */
963  if (tda9874a_mode) {
964  if(chip->shadow.bytes[MAXREGS-2] & 0x20) /* DSR.RSSF=1 */
965  tda9874a_NCONR &= 0xfe; /* enable */
966  else
967  tda9874a_NCONR |= 0x01; /* disable */
968  chip_write(chip, TDA9874A_NCONR, tda9874a_NCONR);
969  }
970 
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).
976  */
977  if(tda9874a_dic == 0x11) {
978  int aosr = 0x80;
979  int mdacosr = (tda9874a_mode) ? 0x82:0x80;
980 
981  switch(mode) {
984  break;
986  aosr = 0x80; /* auto-select, dual A/A */
987  mdacosr = (tda9874a_mode) ? 0x82:0x80;
988  break;
990  aosr = 0xa0; /* auto-select, dual B/B */
991  mdacosr = (tda9874a_mode) ? 0x83:0x81;
992  break;
994  aosr = 0x00; /* always route L to L and R to R */
995  mdacosr = (tda9874a_mode) ? 0x82:0x80;
996  break;
997  default:
998  return;
999  }
1000  chip_write(chip, TDA9874A_AOSR, aosr);
1001  chip_write(chip, TDA9874A_MDACOSR, mdacosr);
1002 
1003  v4l2_dbg(1, debug, sd,
1004  "tda9874a_setaudmode(): req. mode %d; AOSR=0x%X, MDACOSR=0x%X.\n",
1005  mode, aosr, mdacosr);
1006 
1007  } else { /* dic == 0x07 */
1008  int fmmr,aosr;
1009 
1010  switch(mode) {
1011  case V4L2_TUNER_MODE_MONO:
1012  fmmr = 0x00; /* mono */
1013  aosr = 0x10; /* A/A */
1014  break;
1016  if(tda9874a_mode) {
1017  fmmr = 0x00;
1018  aosr = 0x00; /* handled by NICAM auto-mute */
1019  } else {
1020  fmmr = (tda9874a_ESP == 1) ? 0x05 : 0x04; /* stereo */
1021  aosr = 0x00;
1022  }
1023  break;
1024  case V4L2_TUNER_MODE_LANG1:
1025  fmmr = 0x02; /* dual */
1026  aosr = 0x10; /* dual A/A */
1027  break;
1028  case V4L2_TUNER_MODE_LANG2:
1029  fmmr = 0x02; /* dual */
1030  aosr = 0x20; /* dual B/B */
1031  break;
1033  fmmr = 0x02; /* dual */
1034  aosr = 0x00; /* dual A/B */
1035  break;
1036  default:
1037  return;
1038  }
1039  chip_write(chip, TDA9874A_FMMR, fmmr);
1040  chip_write(chip, TDA9874A_AOSR, aosr);
1041 
1042  v4l2_dbg(1, debug, sd,
1043  "tda9874a_setaudmode(): req. mode %d; FMMR=0x%X, AOSR=0x%X.\n",
1044  mode, fmmr, aosr);
1045  }
1046 }
1047 
1048 static int tda9874a_checkit(struct CHIPSTATE *chip)
1049 {
1050  struct v4l2_subdev *sd = &chip->sd;
1051  int dic,sic; /* device id. and software id. codes */
1052 
1053  if(-1 == (dic = chip_read2(chip,TDA9874A_DIC)))
1054  return 0;
1055  if(-1 == (sic = chip_read2(chip,TDA9874A_SIC)))
1056  return 0;
1057 
1058  v4l2_dbg(1, debug, sd, "tda9874a_checkit(): DIC=0x%X, SIC=0x%X.\n", dic, sic);
1059 
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. */
1063  return 1;
1064  }
1065  return 0; /* not found */
1066 }
1067 
1068 static int tda9874a_initialize(struct CHIPSTATE *chip)
1069 {
1070  if (tda9874a_SIF > 2)
1071  tda9874a_SIF = 1;
1072  if (tda9874a_STD >= ARRAY_SIZE(tda9874a_modelist))
1073  tda9874a_STD = 0;
1074  if(tda9874a_AMSEL > 1)
1075  tda9874a_AMSEL = 0;
1076 
1077  if(tda9874a_SIF == 1)
1078  tda9874a_GCONR = 0xc0; /* sound IF input 1 */
1079  else
1080  tda9874a_GCONR = 0xc1; /* sound IF input 2 */
1081 
1082  tda9874a_ESP = tda9874a_STD;
1083  tda9874a_mode = (tda9874a_STD < 5) ? 0 : 1;
1084 
1085  if(tda9874a_AMSEL == 0)
1086  tda9874a_NCONR = 0x01; /* auto-mute: analog mono input */
1087  else
1088  tda9874a_NCONR = 0x05; /* auto-mute: 1st carrier FM or AM */
1089 
1090  tda9874a_setup(chip);
1091  return 0;
1092 }
1093 
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
1099  *
1100  */
1101 
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*/
1107 
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)*/
1112 
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 */
1125 
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*/
1136 
1137 /* values */
1138 #define TDA9875_MUTE_ON 0xff /* general mute */
1139 #define TDA9875_MUTE_OFF 0xcc /* general no mute */
1140 
1141 static int tda9875_initialize(struct CHIPSTATE *chip)
1142 {
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)*/
1156 
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*/
1173 
1174  chip_write(chip, TDA9875_MUT, 0xcc); /* General mute */
1175  return 0;
1176 }
1177 
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); }
1181 
1182 /* ----------------------------------------------------------------------- */
1183 
1184 
1185 /* *********************** *
1186  * i2c interface functions *
1187  * *********************** */
1188 
1189 static int tda9875_checkit(struct CHIPSTATE *chip)
1190 {
1191  struct v4l2_subdev *sd = &chip->sd;
1192  int dic, rev;
1193 
1194  dic = chip_read2(chip, 254);
1195  rev = chip_read2(chip, 255);
1196 
1197  if (dic == 0 || dic == 2) { /* tda9875 and tda9875A */
1198  v4l2_info(sd, "found tda9875%s rev. %d.\n",
1199  dic == 0 ? "" : "A", rev);
1200  return 1;
1201  }
1202  return 0;
1203 }
1204 
1205 /* ---------------------------------------------------------------------- */
1206 /* audio chip descriptions - defines+functions for tea6420 */
1207 
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 */
1219 
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 */
1234 
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 */
1241 
1242 static int tea6300_shift10(int val) { return val >> 10; }
1243 static int tea6300_shift12(int val) { return val >> 12; }
1244 
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)
1250 {
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);
1255 
1256  return 0;
1257 }
1258 
1259 
1260 /* ---------------------------------------------------------------------- */
1261 /* audio chip descriptions - defines+functions for tda8425 */
1262 
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 */
1283 
1284 
1285 static int tda8425_shift10(int val) { return (val >> 10) | 0xc0; }
1286 static int tda8425_shift12(int val) { return (val >> 12) | 0xf0; }
1287 
1288 static void tda8425_setaudmode(struct CHIPSTATE *chip, int mode)
1289 {
1290  int s1 = chip->shadow.bytes[TDA8425_S1+1] & 0xe1;
1291 
1292  switch (mode) {
1293  case V4L2_TUNER_MODE_LANG1:
1294  s1 |= TDA8425_S1_ML_SOUND_A;
1296  break;
1297  case V4L2_TUNER_MODE_LANG2:
1298  s1 |= TDA8425_S1_ML_SOUND_B;
1300  break;
1302  s1 |= TDA8425_S1_ML_STEREO;
1304  break;
1305  case V4L2_TUNER_MODE_MONO:
1306  s1 |= TDA8425_S1_ML_STEREO;
1307  s1 |= TDA8425_S1_STEREO_MONO;
1308  break;
1310  s1 |= TDA8425_S1_ML_STEREO;
1312  break;
1313  default:
1314  return;
1315  }
1316  chip_write(chip,TDA8425_S1,s1);
1317 }
1318 
1319 
1320 /* ---------------------------------------------------------------------- */
1321 /* audio chip descriptions - defines+functions for pic16c54 (PV951) */
1322 
1323 /* the registers of 16C54, I2C sub address. */
1324 #define PIC16C54_REG_KEY_CODE 0x01 /* Not use. */
1325 #define PIC16C54_REG_MISC 0x02
1326 
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 */
1337 
1338 /* ---------------------------------------------------------------------- */
1339 /* audio chip descriptions - defines+functions for TA8874Z */
1340 
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
1350 
1351 /* write 2nd byte */
1352 /*#define TA8874Z_TI 0x80 */ /* test mode */
1353 #define TA8874Z_SEPARATION 0x3f
1354 #define TA8874Z_SEPARATION_DEFAULT 0x10
1355 
1356 /* read */
1357 #define TA8874Z_B1 0x80
1358 #define TA8874Z_B0 0x40
1359 #define TA8874Z_CHAG_FLAG 0x20
1360 
1361 /*
1362  * B1 B0
1363  * mono L H
1364  * stereo L L
1365  * BIL H L
1366  */
1367 static int ta8874z_getrxsubchans(struct CHIPSTATE *chip)
1368 {
1369  int val, mode;
1370 
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;
1377  }
1378  /* v4l2_dbg(1, debug, &chip->sd,
1379  "ta8874z_getrxsubchans(): raw chip read: 0x%02x, return: 0x%02x\n",
1380  val, mode); */
1381  return mode;
1382 }
1383 
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}};
1389 
1390 static void ta8874z_setaudmode(struct CHIPSTATE *chip, int mode)
1391 {
1392  struct v4l2_subdev *sd = &chip->sd;
1393  int update = 1;
1394  audiocmd *t = NULL;
1395 
1396  v4l2_dbg(1, debug, sd, "ta8874z_setaudmode(): mode: 0x%02x\n", mode);
1397 
1398  switch(mode){
1399  case V4L2_TUNER_MODE_MONO:
1400  t = &ta8874z_mono;
1401  break;
1403  t = &ta8874z_stereo;
1404  break;
1405  case V4L2_TUNER_MODE_LANG1:
1406  t = &ta8874z_main;
1407  break;
1408  case V4L2_TUNER_MODE_LANG2:
1409  t = &ta8874z_sub;
1410  break;
1412  t = &ta8874z_both;
1413  break;
1414  default:
1415  update = 0;
1416  }
1417 
1418  if(update)
1419  chip_cmd(chip, "TA8874Z", t);
1420 }
1421 
1422 static int ta8874z_checkit(struct CHIPSTATE *chip)
1423 {
1424  int rc;
1425  rc = chip_read(chip);
1426  return ((rc & 0x1f) == 0x1f) ? 1 : 0;
1427 }
1428 
1429 /* ---------------------------------------------------------------------- */
1430 /* audio chip descriptions - struct CHIPDESC */
1431 
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 */
1445 
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);
1458 
1459 static struct CHIPDESC chiplist[] = {
1460  {
1461  .name = "tda9840",
1462  .insmodopt = &tda9840,
1463  .addr_lo = I2C_ADDR_TDA9840 >> 1,
1464  .addr_hi = I2C_ADDR_TDA9840 >> 1,
1465  .registers = 5,
1466  .flags = CHIP_NEED_CHECKMODE,
1467 
1468  /* callbacks */
1469  .checkit = tda9840_checkit,
1470  .getrxsubchans = tda9840_getrxsubchans,
1471  .setaudmode = tda9840_setaudmode,
1472 
1473  .init = { 2, { TDA9840_TEST, TDA9840_TEST_INT1SN
1474  /* ,TDA9840_SW, TDA9840_MONO */} }
1475  },
1476  {
1477  .name = "tda9873h",
1478  .insmodopt = &tda9873,
1479  .addr_lo = I2C_ADDR_TDA985x_L >> 1,
1480  .addr_hi = I2C_ADDR_TDA985x_H >> 1,
1481  .registers = 3,
1483 
1484  /* callbacks */
1485  .checkit = tda9873_checkit,
1486  .getrxsubchans = tda9873_getrxsubchans,
1487  .setaudmode = tda9873_setaudmode,
1488 
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,
1494 
1495  },
1496  {
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,
1502 
1503  /* callbacks */
1504  .initialize = tda9874a_initialize,
1505  .checkit = tda9874a_checkit,
1506  .getrxsubchans = tda9874a_getrxsubchans,
1507  .setaudmode = tda9874a_setaudmode,
1508  },
1509  {
1510  .name = "tda9875",
1511  .insmodopt = &tda9875,
1512  .addr_lo = I2C_ADDR_TDA9875 >> 1,
1513  .addr_hi = I2C_ADDR_TDA9875 >> 1,
1515 
1516  /* callbacks */
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,
1526  .leftinit = 58880,
1527  .rightinit = 58880,
1528  },
1529  {
1530  .name = "tda9850",
1531  .insmodopt = &tda9850,
1532  .addr_lo = I2C_ADDR_TDA985x_L >> 1,
1533  .addr_hi = I2C_ADDR_TDA985x_H >> 1,
1534  .registers = 11,
1535 
1536  .getrxsubchans = tda985x_getrxsubchans,
1537  .setaudmode = tda985x_setaudmode,
1538 
1539  .init = { 8, { TDA9850_C4, 0x08, 0x08, TDA985x_STEREO, 0x07, 0x10, 0x10, 0x03 } }
1540  },
1541  {
1542  .name = "tda9855",
1543  .insmodopt = &tda9855,
1544  .addr_lo = I2C_ADDR_TDA985x_L >> 1,
1545  .addr_hi = I2C_ADDR_TDA985x_H >> 1,
1546  .registers = 11,
1548 
1549  .leftreg = TDA9855_VL,
1550  .rightreg = TDA9855_VR,
1551  .bassreg = TDA9855_BA,
1552  .treblereg = TDA9855_TR,
1553 
1554  /* callbacks */
1555  .volfunc = tda9855_volume,
1556  .bassfunc = tda9855_bass,
1557  .treblefunc = tda9855_treble,
1558  .getrxsubchans = tda985x_getrxsubchans,
1559  .setaudmode = tda985x_setaudmode,
1560 
1561  .init = { 12, { 0, 0x6f, 0x6f, 0x0e, 0x07<<1, 0x8<<2,
1564  0x07, 0x10, 0x10, 0x03 }}
1565  },
1566  {
1567  .name = "tea6300",
1568  .insmodopt = &tea6300,
1569  .addr_lo = I2C_ADDR_TEA6300 >> 1,
1570  .addr_hi = I2C_ADDR_TEA6300 >> 1,
1571  .registers = 6,
1573 
1574  .leftreg = TEA6300_VR,
1575  .rightreg = TEA6300_VL,
1576  .bassreg = TEA6300_BA,
1577  .treblereg = TEA6300_TR,
1578 
1579  /* callbacks */
1580  .volfunc = tea6300_shift10,
1581  .bassfunc = tea6300_shift12,
1582  .treblefunc = tea6300_shift12,
1583 
1584  .inputreg = TEA6300_S,
1585  .inputmap = { TEA6300_S_SA, TEA6300_S_SB, TEA6300_S_SC },
1586  .inputmute = TEA6300_S_GMU,
1587  },
1588  {
1589  .name = "tea6320",
1590  .insmodopt = &tea6320,
1591  .addr_lo = I2C_ADDR_TEA6300 >> 1,
1592  .addr_hi = I2C_ADDR_TEA6300 >> 1,
1593  .registers = 8,
1595 
1596  .leftreg = TEA6320_V,
1597  .rightreg = TEA6320_V,
1598  .bassreg = TEA6320_BA,
1599  .treblereg = TEA6320_TR,
1600 
1601  /* callbacks */
1602  .initialize = tea6320_initialize,
1603  .volfunc = tea6320_volume,
1604  .bassfunc = tea6320_shift11,
1605  .treblefunc = tea6320_shift11,
1606 
1607  .inputreg = TEA6320_S,
1609  .inputmute = TEA6300_S_GMU,
1610  },
1611  {
1612  .name = "tea6420",
1613  .insmodopt = &tea6420,
1614  .addr_lo = I2C_ADDR_TEA6420 >> 1,
1615  .addr_hi = I2C_ADDR_TEA6420 >> 1,
1616  .registers = 1,
1617  .flags = CHIP_HAS_INPUTSEL,
1618 
1619  .inputreg = -1,
1620  .inputmap = { TEA6420_S_SA, TEA6420_S_SB, TEA6420_S_SC },
1621  .inputmute = TEA6300_S_GMU,
1622  },
1623  {
1624  .name = "tda8425",
1625  .insmodopt = &tda8425,
1626  .addr_lo = I2C_ADDR_TDA8425 >> 1,
1627  .addr_hi = I2C_ADDR_TDA8425 >> 1,
1628  .registers = 9,
1630 
1631  .leftreg = TDA8425_VL,
1632  .rightreg = TDA8425_VR,
1633  .bassreg = TDA8425_BA,
1634  .treblereg = TDA8425_TR,
1635 
1636  /* callbacks */
1637  .volfunc = tda8425_shift10,
1638  .bassfunc = tda8425_shift12,
1639  .treblefunc = tda8425_shift12,
1640  .setaudmode = tda8425_setaudmode,
1641 
1642  .inputreg = TDA8425_S1,
1643  .inputmap = { TDA8425_S1_CH1, TDA8425_S1_CH1, TDA8425_S1_CH1 },
1644  .inputmute = TDA8425_S1_OFF,
1645 
1646  },
1647  {
1648  .name = "pic16c54 (PV951)",
1649  .insmodopt = &pic16c54,
1650  .addr_lo = I2C_ADDR_PIC16C54 >> 1,
1651  .addr_hi = I2C_ADDR_PIC16C54>> 1,
1652  .registers = 2,
1653  .flags = CHIP_HAS_INPUTSEL,
1654 
1655  .inputreg = PIC16C54_REG_MISC,
1660  .inputmute = PIC16C54_MISC_SND_MUTE,
1661  },
1662  {
1663  .name = "ta8874z",
1664  .checkit = ta8874z_checkit,
1665  .insmodopt = &ta8874z,
1666  .addr_lo = I2C_ADDR_TDA9840 >> 1,
1667  .addr_hi = I2C_ADDR_TDA9840 >> 1,
1668  .registers = 2,
1669 
1670  /* callbacks */
1671  .getrxsubchans = ta8874z_getrxsubchans,
1672  .setaudmode = ta8874z_setaudmode,
1673 
1675  },
1676  { .name = NULL } /* EOF */
1677 };
1678 
1679 
1680 /* ---------------------------------------------------------------------- */
1681 
1682 static int tvaudio_g_ctrl(struct v4l2_subdev *sd,
1683  struct v4l2_control *ctrl)
1684 {
1685  struct CHIPSTATE *chip = to_state(sd);
1686  struct CHIPDESC *desc = chip->desc;
1687 
1688  switch (ctrl->id) {
1689  case V4L2_CID_AUDIO_MUTE:
1690  if (!(desc->flags & CHIP_HAS_INPUTSEL))
1691  break;
1692  ctrl->value=chip->muted;
1693  return 0;
1694  case V4L2_CID_AUDIO_VOLUME:
1695  if (!(desc->flags & CHIP_HAS_VOLUME))
1696  break;
1697  ctrl->value = max(chip->left,chip->right);
1698  return 0;
1700  {
1701  int volume;
1702  if (!(desc->flags & CHIP_HAS_VOLUME))
1703  break;
1704  volume = max(chip->left,chip->right);
1705  if (volume)
1706  ctrl->value=(32768*min(chip->left,chip->right))/volume;
1707  else
1708  ctrl->value=32768;
1709  return 0;
1710  }
1711  case V4L2_CID_AUDIO_BASS:
1712  if (!(desc->flags & CHIP_HAS_BASSTREBLE))
1713  break;
1714  ctrl->value = chip->bass;
1715  return 0;
1716  case V4L2_CID_AUDIO_TREBLE:
1717  if (!(desc->flags & CHIP_HAS_BASSTREBLE))
1718  break;
1719  ctrl->value = chip->treble;
1720  return 0;
1721  }
1722  return -EINVAL;
1723 }
1724 
1725 static int tvaudio_s_ctrl(struct v4l2_subdev *sd,
1726  struct v4l2_control *ctrl)
1727 {
1728  struct CHIPSTATE *chip = to_state(sd);
1729  struct CHIPDESC *desc = chip->desc;
1730 
1731  switch (ctrl->id) {
1732  case V4L2_CID_AUDIO_MUTE:
1733  if (!(desc->flags & CHIP_HAS_INPUTSEL))
1734  break;
1735 
1736  if (ctrl->value < 0 || ctrl->value >= 2)
1737  return -ERANGE;
1738  chip->muted = ctrl->value;
1739  if (chip->muted)
1740  chip_write_masked(chip,desc->inputreg,desc->inputmute,desc->inputmask);
1741  else
1742  chip_write_masked(chip,desc->inputreg,
1743  desc->inputmap[chip->input],desc->inputmask);
1744  return 0;
1745  case V4L2_CID_AUDIO_VOLUME:
1746  {
1747  int volume,balance;
1748 
1749  if (!(desc->flags & CHIP_HAS_VOLUME))
1750  break;
1751 
1752  volume = max(chip->left,chip->right);
1753  if (volume)
1754  balance=(32768*min(chip->left,chip->right))/volume;
1755  else
1756  balance=32768;
1757 
1758  volume=ctrl->value;
1759  chip->left = (min(65536 - balance,32768) * volume) / 32768;
1760  chip->right = (min(balance,volume *(__u16)32768)) / 32768;
1761 
1762  chip_write(chip,desc->leftreg,desc->volfunc(chip->left));
1763  chip_write(chip,desc->rightreg,desc->volfunc(chip->right));
1764 
1765  return 0;
1766  }
1768  {
1769  int volume, balance;
1770 
1771  if (!(desc->flags & CHIP_HAS_VOLUME))
1772  break;
1773 
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;
1778 
1779  chip_write(chip, desc->leftreg, desc->volfunc(chip->left));
1780  chip_write(chip, desc->rightreg, desc->volfunc(chip->right));
1781 
1782  return 0;
1783  }
1784  case V4L2_CID_AUDIO_BASS:
1785  if (!(desc->flags & CHIP_HAS_BASSTREBLE))
1786  break;
1787  chip->bass = ctrl->value;
1788  chip_write(chip,desc->bassreg,desc->bassfunc(chip->bass));
1789 
1790  return 0;
1791  case V4L2_CID_AUDIO_TREBLE:
1792  if (!(desc->flags & CHIP_HAS_BASSTREBLE))
1793  break;
1794  chip->treble = ctrl->value;
1795  chip_write(chip,desc->treblereg,desc->treblefunc(chip->treble));
1796 
1797  return 0;
1798  }
1799  return -EINVAL;
1800 }
1801 
1802 
1803 /* ---------------------------------------------------------------------- */
1804 /* video4linux interface */
1805 
1806 static int tvaudio_s_radio(struct v4l2_subdev *sd)
1807 {
1808  struct CHIPSTATE *chip = to_state(sd);
1809 
1810  chip->radio = 1;
1811  /* del_timer(&chip->wt); */
1812  return 0;
1813 }
1814 
1815 static int tvaudio_queryctrl(struct v4l2_subdev *sd, struct v4l2_queryctrl *qc)
1816 {
1817  struct CHIPSTATE *chip = to_state(sd);
1818  struct CHIPDESC *desc = chip->desc;
1819 
1820  switch (qc->id) {
1821  case V4L2_CID_AUDIO_MUTE:
1822  if (desc->flags & CHIP_HAS_INPUTSEL)
1823  return v4l2_ctrl_query_fill(qc, 0, 1, 1, 0);
1824  break;
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);
1828  break;
1830  if (desc->flags & CHIP_HAS_VOLUME)
1831  return v4l2_ctrl_query_fill(qc, 0, 65535, 65535 / 100, 32768);
1832  break;
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);
1837  break;
1838  default:
1839  break;
1840  }
1841  return -EINVAL;
1842 }
1843 
1844 static int tvaudio_s_routing(struct v4l2_subdev *sd,
1845  u32 input, u32 output, u32 config)
1846 {
1847  struct CHIPSTATE *chip = to_state(sd);
1848  struct CHIPDESC *desc = chip->desc;
1849 
1850  if (!(desc->flags & CHIP_HAS_INPUTSEL))
1851  return 0;
1852  if (input >= 4)
1853  return -EINVAL;
1854  /* There are four inputs: tuner, radio, extern and intern. */
1855  chip->input = input;
1856  if (chip->muted)
1857  return 0;
1858  chip_write_masked(chip, desc->inputreg,
1859  desc->inputmap[chip->input], desc->inputmask);
1860  return 0;
1861 }
1862 
1863 static int tvaudio_s_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt)
1864 {
1865  struct CHIPSTATE *chip = to_state(sd);
1866  struct CHIPDESC *desc = chip->desc;
1867 
1868  if (!desc->setaudmode)
1869  return 0;
1870  if (chip->radio)
1871  return 0;
1872 
1873  switch (vt->audmode) {
1874  case V4L2_TUNER_MODE_MONO:
1876  case V4L2_TUNER_MODE_LANG1:
1877  case V4L2_TUNER_MODE_LANG2:
1879  break;
1880  default:
1881  return -EINVAL;
1882  }
1883  chip->audmode = vt->audmode;
1884 
1885  if (chip->thread)
1886  wake_up_process(chip->thread);
1887  else
1888  desc->setaudmode(chip, vt->audmode);
1889 
1890  return 0;
1891 }
1892 
1893 static int tvaudio_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *vt)
1894 {
1895  struct CHIPSTATE *chip = to_state(sd);
1896  struct CHIPDESC *desc = chip->desc;
1897 
1898  if (!desc->getrxsubchans)
1899  return 0;
1900  if (chip->radio)
1901  return 0;
1902 
1903  vt->audmode = chip->audmode;
1904  vt->rxsubchans = desc->getrxsubchans(chip);
1907 
1908  return 0;
1909 }
1910 
1911 static int tvaudio_s_std(struct v4l2_subdev *sd, v4l2_std_id std)
1912 {
1913  struct CHIPSTATE *chip = to_state(sd);
1914 
1915  chip->radio = 0;
1916  return 0;
1917 }
1918 
1919 static int tvaudio_s_frequency(struct v4l2_subdev *sd, struct v4l2_frequency *freq)
1920 {
1921  struct CHIPSTATE *chip = to_state(sd);
1922  struct CHIPDESC *desc = chip->desc;
1923 
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
1930  audio carrier.
1931  */
1932  if (chip->thread) {
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));
1936  }
1937  return 0;
1938 }
1939 
1940 static int tvaudio_g_chip_ident(struct v4l2_subdev *sd, struct v4l2_dbg_chip_ident *chip)
1941 {
1942  struct i2c_client *client = v4l2_get_subdevdata(sd);
1943 
1944  return v4l2_chip_ident_i2c_client(client, chip, V4L2_IDENT_TVAUDIO, 0);
1945 }
1946 
1947 /* ----------------------------------------------------------------------- */
1948 
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,
1955 };
1956 
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,
1962 };
1963 
1964 static const struct v4l2_subdev_audio_ops tvaudio_audio_ops = {
1965  .s_routing = tvaudio_s_routing,
1966 };
1967 
1968 static const struct v4l2_subdev_ops tvaudio_ops = {
1969  .core = &tvaudio_core_ops,
1970  .tuner = &tvaudio_tuner_ops,
1971  .audio = &tvaudio_audio_ops,
1972 };
1973 
1974 /* ----------------------------------------------------------------------- */
1975 
1976 
1977 /* i2c registration */
1978 
1979 static int tvaudio_probe(struct i2c_client *client, const struct i2c_device_id *id)
1980 {
1981  struct CHIPSTATE *chip;
1982  struct CHIPDESC *desc;
1983  struct v4l2_subdev *sd;
1984 
1985  if (debug) {
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);
1990  printk("\n");
1991  }
1992 
1993  chip = kzalloc(sizeof(*chip), GFP_KERNEL);
1994  if (!chip)
1995  return -ENOMEM;
1996  sd = &chip->sd;
1997  v4l2_i2c_subdev_init(sd, client, &tvaudio_ops);
1998 
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))
2003  continue;
2004  if (client->addr < desc->addr_lo ||
2005  client->addr > desc->addr_hi)
2006  continue;
2007  if (desc->checkit && !desc->checkit(chip))
2008  continue;
2009  break;
2010  }
2011  if (desc->name == NULL) {
2012  v4l2_dbg(1, debug, sd, "no matching chip description found\n");
2013  kfree(chip);
2014  return -EIO;
2015  }
2016  v4l2_info(sd, "%s found @ 0x%x (%s)\n", desc->name, client->addr<<1, client->adapter->name);
2017  if (desc->flags) {
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" : "");
2022  }
2023 
2024  /* fill required data structures */
2025  if (!id)
2026  strlcpy(client->name, desc->name, I2C_NAME_SIZE);
2027  chip->desc = desc;
2028  chip->shadow.count = desc->registers+1;
2029  chip->prevmode = -1;
2031 
2032  /* initialization */
2033  if (desc->initialize != NULL)
2034  desc->initialize(chip);
2035  else
2036  chip_cmd(chip, "init", &desc->init);
2037 
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
2042  */
2043  v4l2_info(sd, "volume callback undefined!\n");
2044  desc->flags &= ~CHIP_HAS_VOLUME;
2045  } else {
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));
2052  }
2053  }
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
2058  */
2059  v4l2_info(sd, "bass/treble callbacks undefined!\n");
2060  desc->flags &= ~CHIP_HAS_BASSTREBLE;
2061  } else {
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));
2070  }
2071  }
2072 
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
2078  without kthread
2079  */
2080  v4l2_info(sd, "set/get mode callbacks undefined!\n");
2081  return 0;
2082  }
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;
2090  }
2091  }
2092  return 0;
2093 }
2094 
2095 static int tvaudio_remove(struct i2c_client *client)
2096 {
2097  struct v4l2_subdev *sd = i2c_get_clientdata(client);
2098  struct CHIPSTATE *chip = to_state(sd);
2099 
2100  del_timer_sync(&chip->wt);
2101  if (chip->thread) {
2102  /* shutdown async thread */
2103  kthread_stop(chip->thread);
2104  chip->thread = NULL;
2105  }
2106 
2108  kfree(chip);
2109  return 0;
2110 }
2111 
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[] = {
2116  { "tvaudio", 0 },
2117  { }
2118 };
2119 MODULE_DEVICE_TABLE(i2c, tvaudio_id);
2120 
2121 static struct i2c_driver tvaudio_driver = {
2122  .driver = {
2123  .owner = THIS_MODULE,
2124  .name = "tvaudio",
2125  },
2126  .probe = tvaudio_probe,
2127  .remove = tvaudio_remove,
2128  .id_table = tvaudio_id,
2129 };
2130 
2131 module_i2c_driver(tvaudio_driver);