1ee4b9dbbSRichard Röjfors /* 2ee4b9dbbSRichard Röjfors * saa7706.c Philips SAA7706H Car Radio DSP driver 3ee4b9dbbSRichard Röjfors * Copyright (c) 2009 Intel Corporation 4ee4b9dbbSRichard Röjfors * 5ee4b9dbbSRichard Röjfors * This program is free software; you can redistribute it and/or modify 6ee4b9dbbSRichard Röjfors * it under the terms of the GNU General Public License version 2 as 7ee4b9dbbSRichard Röjfors * published by the Free Software Foundation. 8ee4b9dbbSRichard Röjfors * 9ee4b9dbbSRichard Röjfors * This program is distributed in the hope that it will be useful, 10ee4b9dbbSRichard Röjfors * but WITHOUT ANY WARRANTY; without even the implied warranty of 11ee4b9dbbSRichard Röjfors * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 12ee4b9dbbSRichard Röjfors * GNU General Public License for more details. 13ee4b9dbbSRichard Röjfors * 14ee4b9dbbSRichard Röjfors * You should have received a copy of the GNU General Public License 15ee4b9dbbSRichard Röjfors * along with this program; if not, write to the Free Software 16ee4b9dbbSRichard Röjfors * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 17ee4b9dbbSRichard Röjfors */ 18ee4b9dbbSRichard Röjfors 19ee4b9dbbSRichard Röjfors #include <linux/module.h> 20ee4b9dbbSRichard Röjfors #include <linux/init.h> 21ee4b9dbbSRichard Röjfors #include <linux/delay.h> 22ee4b9dbbSRichard Röjfors #include <linux/errno.h> 23ee4b9dbbSRichard Röjfors #include <linux/kernel.h> 24ee4b9dbbSRichard Röjfors #include <linux/interrupt.h> 25ee4b9dbbSRichard Röjfors #include <linux/i2c.h> 265a0e3ad6STejun Heo #include <linux/slab.h> 27ee4b9dbbSRichard Röjfors #include <media/v4l2-device.h> 28ee4b9dbbSRichard Röjfors #include <media/v4l2-chip-ident.h> 29ee4b9dbbSRichard Röjfors 30ee4b9dbbSRichard Röjfors #define DRIVER_NAME "saa7706h" 31ee4b9dbbSRichard Röjfors 32ee4b9dbbSRichard Röjfors /* the I2C memory map looks like this 33ee4b9dbbSRichard Röjfors 34ee4b9dbbSRichard Röjfors $1C00 - $FFFF Not Used 35ee4b9dbbSRichard Röjfors $2200 - $3FFF Reserved YRAM (DSP2) space 36ee4b9dbbSRichard Röjfors $2000 - $21FF YRAM (DSP2) 37ee4b9dbbSRichard Röjfors $1FF0 - $1FFF Hardware Registers 38ee4b9dbbSRichard Röjfors $1280 - $1FEF Reserved XRAM (DSP2) space 39ee4b9dbbSRichard Röjfors $1000 - $127F XRAM (DSP2) 40ee4b9dbbSRichard Röjfors $0FFF DSP CONTROL 41ee4b9dbbSRichard Röjfors $0A00 - $0FFE Reserved 42ee4b9dbbSRichard Röjfors $0980 - $09FF Reserved YRAM (DSP1) space 43ee4b9dbbSRichard Röjfors $0800 - $097F YRAM (DSP1) 44ee4b9dbbSRichard Röjfors $0200 - $07FF Not Used 45ee4b9dbbSRichard Röjfors $0180 - $01FF Reserved XRAM (DSP1) space 46ee4b9dbbSRichard Röjfors $0000 - $017F XRAM (DSP1) 47ee4b9dbbSRichard Röjfors */ 48ee4b9dbbSRichard Röjfors 49ee4b9dbbSRichard Röjfors #define SAA7706H_REG_CTRL 0x0fff 50ee4b9dbbSRichard Röjfors #define SAA7706H_CTRL_BYP_PLL 0x0001 51ee4b9dbbSRichard Röjfors #define SAA7706H_CTRL_PLL_DIV_MASK 0x003e 52ee4b9dbbSRichard Röjfors #define SAA7706H_CTRL_PLL3_62975MHZ 0x003e 53ee4b9dbbSRichard Röjfors #define SAA7706H_CTRL_DSP_TURBO 0x0040 54ee4b9dbbSRichard Röjfors #define SAA7706H_CTRL_PC_RESET_DSP1 0x0080 55ee4b9dbbSRichard Röjfors #define SAA7706H_CTRL_PC_RESET_DSP2 0x0100 56ee4b9dbbSRichard Röjfors #define SAA7706H_CTRL_DSP1_ROM_EN_MASK 0x0600 57ee4b9dbbSRichard Röjfors #define SAA7706H_CTRL_DSP1_FUNC_PROM 0x0000 58ee4b9dbbSRichard Röjfors #define SAA7706H_CTRL_DSP2_ROM_EN_MASK 0x1800 59ee4b9dbbSRichard Röjfors #define SAA7706H_CTRL_DSP2_FUNC_PROM 0x0000 60ee4b9dbbSRichard Röjfors #define SAA7706H_CTRL_DIG_SIL_INTERPOL 0x8000 61ee4b9dbbSRichard Röjfors 62ee4b9dbbSRichard Röjfors #define SAA7706H_REG_EVALUATION 0x1ff0 63ee4b9dbbSRichard Röjfors #define SAA7706H_EVAL_DISABLE_CHARGE_PUMP 0x000001 64ee4b9dbbSRichard Röjfors #define SAA7706H_EVAL_DCS_CLOCK 0x000002 65ee4b9dbbSRichard Röjfors #define SAA7706H_EVAL_GNDRC1_ENABLE 0x000004 66ee4b9dbbSRichard Röjfors #define SAA7706H_EVAL_GNDRC2_ENABLE 0x000008 67ee4b9dbbSRichard Röjfors 68ee4b9dbbSRichard Röjfors #define SAA7706H_REG_CL_GEN1 0x1ff3 69ee4b9dbbSRichard Röjfors #define SAA7706H_CL_GEN1_MIN_LOOPGAIN_MASK 0x00000f 70ee4b9dbbSRichard Röjfors #define SAA7706H_CL_GEN1_LOOPGAIN_MASK 0x0000f0 71ee4b9dbbSRichard Röjfors #define SAA7706H_CL_GEN1_COARSE_RATION 0xffff00 72ee4b9dbbSRichard Röjfors 73ee4b9dbbSRichard Röjfors #define SAA7706H_REG_CL_GEN2 0x1ff4 74ee4b9dbbSRichard Röjfors #define SAA7706H_CL_GEN2_WSEDGE_FALLING 0x000001 75ee4b9dbbSRichard Röjfors #define SAA7706H_CL_GEN2_STOP_VCO 0x000002 76ee4b9dbbSRichard Röjfors #define SAA7706H_CL_GEN2_FRERUN 0x000004 77ee4b9dbbSRichard Röjfors #define SAA7706H_CL_GEN2_ADAPTIVE 0x000008 78ee4b9dbbSRichard Röjfors #define SAA7706H_CL_GEN2_FINE_RATIO_MASK 0x0ffff0 79ee4b9dbbSRichard Röjfors 80ee4b9dbbSRichard Röjfors #define SAA7706H_REG_CL_GEN4 0x1ff6 81ee4b9dbbSRichard Röjfors #define SAA7706H_CL_GEN4_BYPASS_PLL1 0x001000 82ee4b9dbbSRichard Röjfors #define SAA7706H_CL_GEN4_PLL1_DIV_MASK 0x03e000 83ee4b9dbbSRichard Röjfors #define SAA7706H_CL_GEN4_DSP1_TURBO 0x040000 84ee4b9dbbSRichard Röjfors 85ee4b9dbbSRichard Röjfors #define SAA7706H_REG_SEL 0x1ff7 86ee4b9dbbSRichard Röjfors #define SAA7706H_SEL_DSP2_SRCA_MASK 0x000007 87ee4b9dbbSRichard Röjfors #define SAA7706H_SEL_DSP2_FMTA_MASK 0x000031 88ee4b9dbbSRichard Röjfors #define SAA7706H_SEL_DSP2_SRCB_MASK 0x0001c0 89ee4b9dbbSRichard Röjfors #define SAA7706H_SEL_DSP2_FMTB_MASK 0x000e00 90ee4b9dbbSRichard Röjfors #define SAA7706H_SEL_DSP1_SRC_MASK 0x003000 91ee4b9dbbSRichard Röjfors #define SAA7706H_SEL_DSP1_FMT_MASK 0x01c003 92ee4b9dbbSRichard Röjfors #define SAA7706H_SEL_SPDIF2 0x020000 93ee4b9dbbSRichard Röjfors #define SAA7706H_SEL_HOST_IO_FMT_MASK 0x1c0000 94ee4b9dbbSRichard Röjfors #define SAA7706H_SEL_EN_HOST_IO 0x200000 95ee4b9dbbSRichard Röjfors 96ee4b9dbbSRichard Röjfors #define SAA7706H_REG_IAC 0x1ff8 97ee4b9dbbSRichard Röjfors #define SAA7706H_REG_CLK_SET 0x1ff9 98ee4b9dbbSRichard Röjfors #define SAA7706H_REG_CLK_COEFF 0x1ffa 99ee4b9dbbSRichard Röjfors #define SAA7706H_REG_INPUT_SENS 0x1ffb 100ee4b9dbbSRichard Röjfors #define SAA7706H_INPUT_SENS_RDS_VOL_MASK 0x0003f 101ee4b9dbbSRichard Röjfors #define SAA7706H_INPUT_SENS_FM_VOL_MASK 0x00fc0 102ee4b9dbbSRichard Röjfors #define SAA7706H_INPUT_SENS_FM_MPX 0x01000 103ee4b9dbbSRichard Röjfors #define SAA7706H_INPUT_SENS_OFF_FILTER_A_EN 0x02000 104ee4b9dbbSRichard Röjfors #define SAA7706H_INPUT_SENS_OFF_FILTER_B_EN 0x04000 105ee4b9dbbSRichard Röjfors #define SAA7706H_REG_PHONE_NAV_AUDIO 0x1ffc 106ee4b9dbbSRichard Röjfors #define SAA7706H_REG_IO_CONF_DSP2 0x1ffd 107ee4b9dbbSRichard Röjfors #define SAA7706H_REG_STATUS_DSP2 0x1ffe 108ee4b9dbbSRichard Röjfors #define SAA7706H_REG_PC_DSP2 0x1fff 109ee4b9dbbSRichard Röjfors 110ee4b9dbbSRichard Röjfors #define SAA7706H_DSP1_MOD0 0x0800 111ee4b9dbbSRichard Röjfors #define SAA7706H_DSP1_ROM_VER 0x097f 112ee4b9dbbSRichard Röjfors #define SAA7706H_DSP2_MPTR0 0x1000 113ee4b9dbbSRichard Röjfors 114ee4b9dbbSRichard Röjfors #define SAA7706H_DSP1_MODPNTR 0x0000 115ee4b9dbbSRichard Röjfors 116ee4b9dbbSRichard Röjfors #define SAA7706H_DSP2_XMEM_CONTLLCW 0x113e 117ee4b9dbbSRichard Röjfors #define SAA7706H_DSP2_XMEM_BUSAMP 0x114a 118ee4b9dbbSRichard Röjfors #define SAA7706H_DSP2_XMEM_FDACPNTR 0x11f9 119ee4b9dbbSRichard Röjfors #define SAA7706H_DSP2_XMEM_IIS1PNTR 0x11fb 120ee4b9dbbSRichard Röjfors 121ee4b9dbbSRichard Röjfors #define SAA7706H_DSP2_YMEM_PVGA 0x212a 122ee4b9dbbSRichard Röjfors #define SAA7706H_DSP2_YMEM_PVAT1 0x212b 123ee4b9dbbSRichard Röjfors #define SAA7706H_DSP2_YMEM_PVAT 0x212c 124ee4b9dbbSRichard Röjfors #define SAA7706H_DSP2_YMEM_ROM_VER 0x21ff 125ee4b9dbbSRichard Röjfors 126ee4b9dbbSRichard Röjfors #define SUPPORTED_DSP1_ROM_VER 0x667 127ee4b9dbbSRichard Röjfors 128ee4b9dbbSRichard Röjfors struct saa7706h_state { 129ee4b9dbbSRichard Röjfors struct v4l2_subdev sd; 130ee4b9dbbSRichard Röjfors unsigned muted; 131ee4b9dbbSRichard Röjfors }; 132ee4b9dbbSRichard Röjfors 133ee4b9dbbSRichard Röjfors static inline struct saa7706h_state *to_state(struct v4l2_subdev *sd) 134ee4b9dbbSRichard Röjfors { 135ee4b9dbbSRichard Röjfors return container_of(sd, struct saa7706h_state, sd); 136ee4b9dbbSRichard Röjfors } 137ee4b9dbbSRichard Röjfors 138ee4b9dbbSRichard Röjfors static int saa7706h_i2c_send(struct i2c_client *client, const u8 *data, int len) 139ee4b9dbbSRichard Röjfors { 140ee4b9dbbSRichard Röjfors int err = i2c_master_send(client, data, len); 141ee4b9dbbSRichard Röjfors if (err == len) 142ee4b9dbbSRichard Röjfors return 0; 143ee4b9dbbSRichard Röjfors return err > 0 ? -EIO : err; 144ee4b9dbbSRichard Röjfors } 145ee4b9dbbSRichard Röjfors 146ee4b9dbbSRichard Röjfors static int saa7706h_i2c_transfer(struct i2c_client *client, 147ee4b9dbbSRichard Röjfors struct i2c_msg *msgs, int num) 148ee4b9dbbSRichard Röjfors { 149ee4b9dbbSRichard Röjfors int err = i2c_transfer(client->adapter, msgs, num); 150ee4b9dbbSRichard Röjfors if (err == num) 151ee4b9dbbSRichard Röjfors return 0; 152ee4b9dbbSRichard Röjfors return err > 0 ? -EIO : err; 153ee4b9dbbSRichard Röjfors } 154ee4b9dbbSRichard Röjfors 155ee4b9dbbSRichard Röjfors static int saa7706h_set_reg24(struct v4l2_subdev *sd, u16 reg, u32 val) 156ee4b9dbbSRichard Röjfors { 157ee4b9dbbSRichard Röjfors struct i2c_client *client = v4l2_get_subdevdata(sd); 158ee4b9dbbSRichard Röjfors u8 buf[5]; 159ee4b9dbbSRichard Röjfors int pos = 0; 160ee4b9dbbSRichard Röjfors 161ee4b9dbbSRichard Röjfors buf[pos++] = reg >> 8; 162ee4b9dbbSRichard Röjfors buf[pos++] = reg; 163ee4b9dbbSRichard Röjfors buf[pos++] = val >> 16; 164ee4b9dbbSRichard Röjfors buf[pos++] = val >> 8; 165ee4b9dbbSRichard Röjfors buf[pos++] = val; 166ee4b9dbbSRichard Röjfors 167ee4b9dbbSRichard Röjfors return saa7706h_i2c_send(client, buf, pos); 168ee4b9dbbSRichard Röjfors } 169ee4b9dbbSRichard Röjfors 170ee4b9dbbSRichard Röjfors static int saa7706h_set_reg24_err(struct v4l2_subdev *sd, u16 reg, u32 val, 171ee4b9dbbSRichard Röjfors int *err) 172ee4b9dbbSRichard Röjfors { 173ee4b9dbbSRichard Röjfors return *err ? *err : saa7706h_set_reg24(sd, reg, val); 174ee4b9dbbSRichard Röjfors } 175ee4b9dbbSRichard Röjfors 176ee4b9dbbSRichard Röjfors static int saa7706h_set_reg16(struct v4l2_subdev *sd, u16 reg, u16 val) 177ee4b9dbbSRichard Röjfors { 178ee4b9dbbSRichard Röjfors struct i2c_client *client = v4l2_get_subdevdata(sd); 179ee4b9dbbSRichard Röjfors u8 buf[4]; 180ee4b9dbbSRichard Röjfors int pos = 0; 181ee4b9dbbSRichard Röjfors 182ee4b9dbbSRichard Röjfors buf[pos++] = reg >> 8; 183ee4b9dbbSRichard Röjfors buf[pos++] = reg; 184ee4b9dbbSRichard Röjfors buf[pos++] = val >> 8; 185ee4b9dbbSRichard Röjfors buf[pos++] = val; 186ee4b9dbbSRichard Röjfors 187ee4b9dbbSRichard Röjfors return saa7706h_i2c_send(client, buf, pos); 188ee4b9dbbSRichard Röjfors } 189ee4b9dbbSRichard Röjfors 190ee4b9dbbSRichard Röjfors static int saa7706h_set_reg16_err(struct v4l2_subdev *sd, u16 reg, u16 val, 191ee4b9dbbSRichard Röjfors int *err) 192ee4b9dbbSRichard Röjfors { 193ee4b9dbbSRichard Röjfors return *err ? *err : saa7706h_set_reg16(sd, reg, val); 194ee4b9dbbSRichard Röjfors } 195ee4b9dbbSRichard Röjfors 196ee4b9dbbSRichard Röjfors static int saa7706h_get_reg16(struct v4l2_subdev *sd, u16 reg) 197ee4b9dbbSRichard Röjfors { 198ee4b9dbbSRichard Röjfors struct i2c_client *client = v4l2_get_subdevdata(sd); 199ee4b9dbbSRichard Röjfors u8 buf[2]; 200ee4b9dbbSRichard Röjfors int err; 201ee4b9dbbSRichard Röjfors u8 regaddr[] = {reg >> 8, reg}; 202ee4b9dbbSRichard Röjfors struct i2c_msg msg[] = { {client->addr, 0, sizeof(regaddr), regaddr}, 203ee4b9dbbSRichard Röjfors {client->addr, I2C_M_RD, sizeof(buf), buf} }; 204ee4b9dbbSRichard Röjfors 205ee4b9dbbSRichard Röjfors err = saa7706h_i2c_transfer(client, msg, ARRAY_SIZE(msg)); 206ee4b9dbbSRichard Röjfors if (err) 207ee4b9dbbSRichard Röjfors return err; 208ee4b9dbbSRichard Röjfors 209ee4b9dbbSRichard Röjfors return buf[0] << 8 | buf[1]; 210ee4b9dbbSRichard Röjfors } 211ee4b9dbbSRichard Röjfors 212ee4b9dbbSRichard Röjfors static int saa7706h_unmute(struct v4l2_subdev *sd) 213ee4b9dbbSRichard Röjfors { 214ee4b9dbbSRichard Röjfors struct saa7706h_state *state = to_state(sd); 215ee4b9dbbSRichard Röjfors int err = 0; 216ee4b9dbbSRichard Röjfors 217ee4b9dbbSRichard Röjfors err = saa7706h_set_reg16_err(sd, SAA7706H_REG_CTRL, 218ee4b9dbbSRichard Röjfors SAA7706H_CTRL_PLL3_62975MHZ | SAA7706H_CTRL_PC_RESET_DSP1 | 219ee4b9dbbSRichard Röjfors SAA7706H_CTRL_PC_RESET_DSP2, &err); 220ee4b9dbbSRichard Röjfors 221ee4b9dbbSRichard Röjfors /* newer versions of the chip requires a small sleep after reset */ 222ee4b9dbbSRichard Röjfors msleep(1); 223ee4b9dbbSRichard Röjfors 224ee4b9dbbSRichard Röjfors err = saa7706h_set_reg16_err(sd, SAA7706H_REG_CTRL, 225ee4b9dbbSRichard Röjfors SAA7706H_CTRL_PLL3_62975MHZ, &err); 226ee4b9dbbSRichard Röjfors 227ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_REG_EVALUATION, 0, &err); 228ee4b9dbbSRichard Röjfors 229ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_REG_CL_GEN1, 0x040022, &err); 230ee4b9dbbSRichard Röjfors 231ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_REG_CL_GEN2, 232ee4b9dbbSRichard Röjfors SAA7706H_CL_GEN2_WSEDGE_FALLING, &err); 233ee4b9dbbSRichard Röjfors 234ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_REG_CL_GEN4, 0x024080, &err); 235ee4b9dbbSRichard Röjfors 236ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_REG_SEL, 0x200080, &err); 237ee4b9dbbSRichard Röjfors 238ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_REG_IAC, 0xf4caed, &err); 239ee4b9dbbSRichard Röjfors 240ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_REG_CLK_SET, 0x124334, &err); 241ee4b9dbbSRichard Röjfors 242ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_REG_CLK_COEFF, 0x004a1a, 243ee4b9dbbSRichard Röjfors &err); 244ee4b9dbbSRichard Röjfors 245ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_REG_INPUT_SENS, 0x0071c7, 246ee4b9dbbSRichard Röjfors &err); 247ee4b9dbbSRichard Röjfors 248ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_REG_PHONE_NAV_AUDIO, 249ee4b9dbbSRichard Röjfors 0x0e22ff, &err); 250ee4b9dbbSRichard Röjfors 251ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_REG_IO_CONF_DSP2, 0x001ff8, 252ee4b9dbbSRichard Röjfors &err); 253ee4b9dbbSRichard Röjfors 254ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_REG_STATUS_DSP2, 0x080003, 255ee4b9dbbSRichard Röjfors &err); 256ee4b9dbbSRichard Röjfors 257ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_REG_PC_DSP2, 0x000004, &err); 258ee4b9dbbSRichard Röjfors 259ee4b9dbbSRichard Röjfors err = saa7706h_set_reg16_err(sd, SAA7706H_DSP1_MOD0, 0x0c6c, &err); 260ee4b9dbbSRichard Röjfors 261ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_MPTR0, 0x000b4b, &err); 262ee4b9dbbSRichard Röjfors 263ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_DSP1_MODPNTR, 0x000600, &err); 264ee4b9dbbSRichard Röjfors 265ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_DSP1_MODPNTR, 0x0000c0, &err); 266ee4b9dbbSRichard Röjfors 267ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_CONTLLCW, 0x000819, 268ee4b9dbbSRichard Röjfors &err); 269ee4b9dbbSRichard Röjfors 270ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_CONTLLCW, 0x00085a, 271ee4b9dbbSRichard Röjfors &err); 272ee4b9dbbSRichard Röjfors 273ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_BUSAMP, 0x7fffff, 274ee4b9dbbSRichard Röjfors &err); 275ee4b9dbbSRichard Röjfors 276ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_FDACPNTR, 0x2000cb, 277ee4b9dbbSRichard Röjfors &err); 278ee4b9dbbSRichard Röjfors 279ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_IIS1PNTR, 0x2000cb, 280ee4b9dbbSRichard Röjfors &err); 281ee4b9dbbSRichard Röjfors 282ee4b9dbbSRichard Röjfors err = saa7706h_set_reg16_err(sd, SAA7706H_DSP2_YMEM_PVGA, 0x0f80, &err); 283ee4b9dbbSRichard Röjfors 284ee4b9dbbSRichard Röjfors err = saa7706h_set_reg16_err(sd, SAA7706H_DSP2_YMEM_PVAT1, 0x0800, 285ee4b9dbbSRichard Röjfors &err); 286ee4b9dbbSRichard Röjfors 287ee4b9dbbSRichard Röjfors err = saa7706h_set_reg16_err(sd, SAA7706H_DSP2_YMEM_PVAT, 0x0800, &err); 288ee4b9dbbSRichard Röjfors 289ee4b9dbbSRichard Röjfors err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_CONTLLCW, 0x000905, 290ee4b9dbbSRichard Röjfors &err); 291ee4b9dbbSRichard Röjfors if (!err) 292ee4b9dbbSRichard Röjfors state->muted = 0; 293ee4b9dbbSRichard Röjfors return err; 294ee4b9dbbSRichard Röjfors } 295ee4b9dbbSRichard Röjfors 296ee4b9dbbSRichard Röjfors static int saa7706h_mute(struct v4l2_subdev *sd) 297ee4b9dbbSRichard Röjfors { 298ee4b9dbbSRichard Röjfors struct saa7706h_state *state = to_state(sd); 299ee4b9dbbSRichard Röjfors int err; 300ee4b9dbbSRichard Röjfors 301ee4b9dbbSRichard Röjfors err = saa7706h_set_reg16(sd, SAA7706H_REG_CTRL, 302ee4b9dbbSRichard Röjfors SAA7706H_CTRL_PLL3_62975MHZ | SAA7706H_CTRL_PC_RESET_DSP1 | 303ee4b9dbbSRichard Röjfors SAA7706H_CTRL_PC_RESET_DSP2); 304ee4b9dbbSRichard Röjfors if (!err) 305ee4b9dbbSRichard Röjfors state->muted = 1; 306ee4b9dbbSRichard Röjfors return err; 307ee4b9dbbSRichard Röjfors } 308ee4b9dbbSRichard Röjfors 309ee4b9dbbSRichard Röjfors static int saa7706h_queryctrl(struct v4l2_subdev *sd, struct v4l2_queryctrl *qc) 310ee4b9dbbSRichard Röjfors { 311ee4b9dbbSRichard Röjfors switch (qc->id) { 312ee4b9dbbSRichard Röjfors case V4L2_CID_AUDIO_MUTE: 313ee4b9dbbSRichard Röjfors return v4l2_ctrl_query_fill(qc, 0, 1, 1, 1); 314ee4b9dbbSRichard Röjfors } 315ee4b9dbbSRichard Röjfors return -EINVAL; 316ee4b9dbbSRichard Röjfors } 317ee4b9dbbSRichard Röjfors 318ee4b9dbbSRichard Röjfors static int saa7706h_g_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl) 319ee4b9dbbSRichard Röjfors { 320ee4b9dbbSRichard Röjfors struct saa7706h_state *state = to_state(sd); 321ee4b9dbbSRichard Röjfors 322ee4b9dbbSRichard Röjfors switch (ctrl->id) { 323ee4b9dbbSRichard Röjfors case V4L2_CID_AUDIO_MUTE: 324ee4b9dbbSRichard Röjfors ctrl->value = state->muted; 325ee4b9dbbSRichard Röjfors return 0; 326ee4b9dbbSRichard Röjfors } 327ee4b9dbbSRichard Röjfors return -EINVAL; 328ee4b9dbbSRichard Röjfors } 329ee4b9dbbSRichard Röjfors 330ee4b9dbbSRichard Röjfors static int saa7706h_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl) 331ee4b9dbbSRichard Röjfors { 332ee4b9dbbSRichard Röjfors switch (ctrl->id) { 333ee4b9dbbSRichard Röjfors case V4L2_CID_AUDIO_MUTE: 334ee4b9dbbSRichard Röjfors if (ctrl->value) 335ee4b9dbbSRichard Röjfors return saa7706h_mute(sd); 336ee4b9dbbSRichard Röjfors return saa7706h_unmute(sd); 337ee4b9dbbSRichard Röjfors } 338ee4b9dbbSRichard Röjfors return -EINVAL; 339ee4b9dbbSRichard Röjfors } 340ee4b9dbbSRichard Röjfors 341ee4b9dbbSRichard Röjfors static int saa7706h_g_chip_ident(struct v4l2_subdev *sd, 342ee4b9dbbSRichard Röjfors struct v4l2_dbg_chip_ident *chip) 343ee4b9dbbSRichard Röjfors { 344ee4b9dbbSRichard Röjfors struct i2c_client *client = v4l2_get_subdevdata(sd); 345ee4b9dbbSRichard Röjfors 346ee4b9dbbSRichard Röjfors return v4l2_chip_ident_i2c_client(client, chip, V4L2_IDENT_SAA7706H, 0); 347ee4b9dbbSRichard Röjfors } 348ee4b9dbbSRichard Röjfors 349ee4b9dbbSRichard Röjfors static const struct v4l2_subdev_core_ops saa7706h_core_ops = { 350ee4b9dbbSRichard Röjfors .g_chip_ident = saa7706h_g_chip_ident, 351ee4b9dbbSRichard Röjfors .queryctrl = saa7706h_queryctrl, 352ee4b9dbbSRichard Röjfors .g_ctrl = saa7706h_g_ctrl, 353ee4b9dbbSRichard Röjfors .s_ctrl = saa7706h_s_ctrl, 354ee4b9dbbSRichard Röjfors }; 355ee4b9dbbSRichard Röjfors 356ee4b9dbbSRichard Röjfors static const struct v4l2_subdev_ops saa7706h_ops = { 357ee4b9dbbSRichard Röjfors .core = &saa7706h_core_ops, 358ee4b9dbbSRichard Röjfors }; 359ee4b9dbbSRichard Röjfors 360ee4b9dbbSRichard Röjfors /* 361ee4b9dbbSRichard Röjfors * Generic i2c probe 362ee4b9dbbSRichard Röjfors * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1' 363ee4b9dbbSRichard Röjfors */ 364ee4b9dbbSRichard Röjfors 365ee4b9dbbSRichard Röjfors static int __devinit saa7706h_probe(struct i2c_client *client, 366ee4b9dbbSRichard Röjfors const struct i2c_device_id *id) 367ee4b9dbbSRichard Röjfors { 368ee4b9dbbSRichard Röjfors struct saa7706h_state *state; 369ee4b9dbbSRichard Röjfors struct v4l2_subdev *sd; 370ee4b9dbbSRichard Röjfors int err; 371ee4b9dbbSRichard Röjfors 372ee4b9dbbSRichard Röjfors /* Check if the adapter supports the needed features */ 373ee4b9dbbSRichard Röjfors if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA)) 374ee4b9dbbSRichard Röjfors return -EIO; 375ee4b9dbbSRichard Röjfors 376ee4b9dbbSRichard Röjfors v4l_info(client, "chip found @ 0x%02x (%s)\n", 377ee4b9dbbSRichard Röjfors client->addr << 1, client->adapter->name); 378ee4b9dbbSRichard Röjfors 37980845a33SHerton Ronaldo Krzesinski state = kzalloc(sizeof(struct saa7706h_state), GFP_KERNEL); 380ee4b9dbbSRichard Röjfors if (state == NULL) 381ee4b9dbbSRichard Röjfors return -ENOMEM; 382ee4b9dbbSRichard Röjfors sd = &state->sd; 383ee4b9dbbSRichard Röjfors v4l2_i2c_subdev_init(sd, client, &saa7706h_ops); 384ee4b9dbbSRichard Röjfors 385ee4b9dbbSRichard Röjfors /* check the rom versions */ 386ee4b9dbbSRichard Röjfors err = saa7706h_get_reg16(sd, SAA7706H_DSP1_ROM_VER); 387ee4b9dbbSRichard Röjfors if (err < 0) 388ee4b9dbbSRichard Röjfors goto err; 389ee4b9dbbSRichard Röjfors if (err != SUPPORTED_DSP1_ROM_VER) 390ee4b9dbbSRichard Röjfors v4l2_warn(sd, "Unknown DSP1 ROM code version: 0x%x\n", err); 391ee4b9dbbSRichard Röjfors 392ee4b9dbbSRichard Röjfors state->muted = 1; 393ee4b9dbbSRichard Röjfors 394ee4b9dbbSRichard Röjfors /* startup in a muted state */ 395ee4b9dbbSRichard Röjfors err = saa7706h_mute(sd); 396ee4b9dbbSRichard Röjfors if (err) 397ee4b9dbbSRichard Röjfors goto err; 398ee4b9dbbSRichard Röjfors 399ee4b9dbbSRichard Röjfors return 0; 400ee4b9dbbSRichard Röjfors 401ee4b9dbbSRichard Röjfors err: 402ee4b9dbbSRichard Röjfors v4l2_device_unregister_subdev(sd); 403ee4b9dbbSRichard Röjfors kfree(to_state(sd)); 404ee4b9dbbSRichard Röjfors 405ee4b9dbbSRichard Röjfors printk(KERN_ERR DRIVER_NAME ": Failed to probe: %d\n", err); 406ee4b9dbbSRichard Röjfors 407ee4b9dbbSRichard Röjfors return err; 408ee4b9dbbSRichard Röjfors } 409ee4b9dbbSRichard Röjfors 410ee4b9dbbSRichard Röjfors static int __devexit saa7706h_remove(struct i2c_client *client) 411ee4b9dbbSRichard Röjfors { 412ee4b9dbbSRichard Röjfors struct v4l2_subdev *sd = i2c_get_clientdata(client); 413ee4b9dbbSRichard Röjfors 414ee4b9dbbSRichard Röjfors saa7706h_mute(sd); 415ee4b9dbbSRichard Röjfors v4l2_device_unregister_subdev(sd); 416ee4b9dbbSRichard Röjfors kfree(to_state(sd)); 417ee4b9dbbSRichard Röjfors return 0; 418ee4b9dbbSRichard Röjfors } 419ee4b9dbbSRichard Röjfors 420ee4b9dbbSRichard Röjfors static const struct i2c_device_id saa7706h_id[] = { 421ee4b9dbbSRichard Röjfors {DRIVER_NAME, 0}, 422ee4b9dbbSRichard Röjfors {}, 423ee4b9dbbSRichard Röjfors }; 424ee4b9dbbSRichard Röjfors 425ee4b9dbbSRichard Röjfors MODULE_DEVICE_TABLE(i2c, saa7706h_id); 426ee4b9dbbSRichard Röjfors 427ee4b9dbbSRichard Röjfors static struct i2c_driver saa7706h_driver = { 428ee4b9dbbSRichard Röjfors .driver = { 429ee4b9dbbSRichard Röjfors .owner = THIS_MODULE, 430ee4b9dbbSRichard Röjfors .name = DRIVER_NAME, 431ee4b9dbbSRichard Röjfors }, 432ee4b9dbbSRichard Röjfors .probe = saa7706h_probe, 433ee4b9dbbSRichard Röjfors .remove = saa7706h_remove, 434ee4b9dbbSRichard Röjfors .id_table = saa7706h_id, 435ee4b9dbbSRichard Röjfors }; 436ee4b9dbbSRichard Röjfors 437ee4b9dbbSRichard Röjfors static __init int saa7706h_init(void) 438ee4b9dbbSRichard Röjfors { 439ee4b9dbbSRichard Röjfors return i2c_add_driver(&saa7706h_driver); 440ee4b9dbbSRichard Röjfors } 441ee4b9dbbSRichard Röjfors 442ee4b9dbbSRichard Röjfors static __exit void saa7706h_exit(void) 443ee4b9dbbSRichard Röjfors { 444ee4b9dbbSRichard Röjfors i2c_del_driver(&saa7706h_driver); 445ee4b9dbbSRichard Röjfors } 446ee4b9dbbSRichard Röjfors 447ee4b9dbbSRichard Röjfors module_init(saa7706h_init); 448ee4b9dbbSRichard Röjfors module_exit(saa7706h_exit); 449ee4b9dbbSRichard Röjfors 450ee4b9dbbSRichard Röjfors MODULE_DESCRIPTION("SAA7706H Car Radio DSP driver"); 451ee4b9dbbSRichard Röjfors MODULE_AUTHOR("Mocean Laboratories"); 452ee4b9dbbSRichard Röjfors MODULE_LICENSE("GPL v2"); 453