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