/* * saa7706.c Philips SAA7706H Car Radio DSP driver * Copyright (c) 2009 Intel Corporation * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. */ #include <linux/module.h> #include <linux/init.h> #include <linux/delay.h> #include <linux/errno.h> #include <linux/kernel.h> #include <linux/interrupt.h> #include <linux/i2c.h> #include <linux/slab.h> #include <media/v4l2-device.h> #include <media/v4l2-ctrls.h> #define DRIVER_NAME "saa7706h" /* the I2C memory map looks like this $1C00 - $FFFF Not Used $2200 - $3FFF Reserved YRAM (DSP2) space $2000 - $21FF YRAM (DSP2) $1FF0 - $1FFF Hardware Registers $1280 - $1FEF Reserved XRAM (DSP2) space $1000 - $127F XRAM (DSP2) $0FFF DSP CONTROL $0A00 - $0FFE Reserved $0980 - $09FF Reserved YRAM (DSP1) space $0800 - $097F YRAM (DSP1) $0200 - $07FF Not Used $0180 - $01FF Reserved XRAM (DSP1) space $0000 - $017F XRAM (DSP1) */ #define SAA7706H_REG_CTRL 0x0fff #define SAA7706H_CTRL_BYP_PLL 0x0001 #define SAA7706H_CTRL_PLL_DIV_MASK 0x003e #define SAA7706H_CTRL_PLL3_62975MHZ 0x003e #define SAA7706H_CTRL_DSP_TURBO 0x0040 #define SAA7706H_CTRL_PC_RESET_DSP1 0x0080 #define SAA7706H_CTRL_PC_RESET_DSP2 0x0100 #define SAA7706H_CTRL_DSP1_ROM_EN_MASK 0x0600 #define SAA7706H_CTRL_DSP1_FUNC_PROM 0x0000 #define SAA7706H_CTRL_DSP2_ROM_EN_MASK 0x1800 #define SAA7706H_CTRL_DSP2_FUNC_PROM 0x0000 #define SAA7706H_CTRL_DIG_SIL_INTERPOL 0x8000 #define SAA7706H_REG_EVALUATION 0x1ff0 #define SAA7706H_EVAL_DISABLE_CHARGE_PUMP 0x000001 #define SAA7706H_EVAL_DCS_CLOCK 0x000002 #define SAA7706H_EVAL_GNDRC1_ENABLE 0x000004 #define SAA7706H_EVAL_GNDRC2_ENABLE 0x000008 #define SAA7706H_REG_CL_GEN1 0x1ff3 #define SAA7706H_CL_GEN1_MIN_LOOPGAIN_MASK 0x00000f #define SAA7706H_CL_GEN1_LOOPGAIN_MASK 0x0000f0 #define SAA7706H_CL_GEN1_COARSE_RATION 0xffff00 #define SAA7706H_REG_CL_GEN2 0x1ff4 #define SAA7706H_CL_GEN2_WSEDGE_FALLING 0x000001 #define SAA7706H_CL_GEN2_STOP_VCO 0x000002 #define SAA7706H_CL_GEN2_FRERUN 0x000004 #define SAA7706H_CL_GEN2_ADAPTIVE 0x000008 #define SAA7706H_CL_GEN2_FINE_RATIO_MASK 0x0ffff0 #define SAA7706H_REG_CL_GEN4 0x1ff6 #define SAA7706H_CL_GEN4_BYPASS_PLL1 0x001000 #define SAA7706H_CL_GEN4_PLL1_DIV_MASK 0x03e000 #define SAA7706H_CL_GEN4_DSP1_TURBO 0x040000 #define SAA7706H_REG_SEL 0x1ff7 #define SAA7706H_SEL_DSP2_SRCA_MASK 0x000007 #define SAA7706H_SEL_DSP2_FMTA_MASK 0x000031 #define SAA7706H_SEL_DSP2_SRCB_MASK 0x0001c0 #define SAA7706H_SEL_DSP2_FMTB_MASK 0x000e00 #define SAA7706H_SEL_DSP1_SRC_MASK 0x003000 #define SAA7706H_SEL_DSP1_FMT_MASK 0x01c003 #define SAA7706H_SEL_SPDIF2 0x020000 #define SAA7706H_SEL_HOST_IO_FMT_MASK 0x1c0000 #define SAA7706H_SEL_EN_HOST_IO 0x200000 #define SAA7706H_REG_IAC 0x1ff8 #define SAA7706H_REG_CLK_SET 0x1ff9 #define SAA7706H_REG_CLK_COEFF 0x1ffa #define SAA7706H_REG_INPUT_SENS 0x1ffb #define SAA7706H_INPUT_SENS_RDS_VOL_MASK 0x0003f #define SAA7706H_INPUT_SENS_FM_VOL_MASK 0x00fc0 #define SAA7706H_INPUT_SENS_FM_MPX 0x01000 #define SAA7706H_INPUT_SENS_OFF_FILTER_A_EN 0x02000 #define SAA7706H_INPUT_SENS_OFF_FILTER_B_EN 0x04000 #define SAA7706H_REG_PHONE_NAV_AUDIO 0x1ffc #define SAA7706H_REG_IO_CONF_DSP2 0x1ffd #define SAA7706H_REG_STATUS_DSP2 0x1ffe #define SAA7706H_REG_PC_DSP2 0x1fff #define SAA7706H_DSP1_MOD0 0x0800 #define SAA7706H_DSP1_ROM_VER 0x097f #define SAA7706H_DSP2_MPTR0 0x1000 #define SAA7706H_DSP1_MODPNTR 0x0000 #define SAA7706H_DSP2_XMEM_CONTLLCW 0x113e #define SAA7706H_DSP2_XMEM_BUSAMP 0x114a #define SAA7706H_DSP2_XMEM_FDACPNTR 0x11f9 #define SAA7706H_DSP2_XMEM_IIS1PNTR 0x11fb #define SAA7706H_DSP2_YMEM_PVGA 0x212a #define SAA7706H_DSP2_YMEM_PVAT1 0x212b #define SAA7706H_DSP2_YMEM_PVAT 0x212c #define SAA7706H_DSP2_YMEM_ROM_VER 0x21ff #define SUPPORTED_DSP1_ROM_VER 0x667 struct saa7706h_state { struct v4l2_subdev sd; struct v4l2_ctrl_handler hdl; unsigned muted; }; static inline struct saa7706h_state *to_state(struct v4l2_subdev *sd) { return container_of(sd, struct saa7706h_state, sd); } static int saa7706h_i2c_send(struct i2c_client *client, const u8 *data, int len) { int err = i2c_master_send(client, data, len); if (err == len) return 0; return err > 0 ? -EIO : err; } static int saa7706h_i2c_transfer(struct i2c_client *client, struct i2c_msg *msgs, int num) { int err = i2c_transfer(client->adapter, msgs, num); if (err == num) return 0; return err > 0 ? -EIO : err; } static int saa7706h_set_reg24(struct v4l2_subdev *sd, u16 reg, u32 val) { struct i2c_client *client = v4l2_get_subdevdata(sd); u8 buf[5]; int pos = 0; buf[pos++] = reg >> 8; buf[pos++] = reg; buf[pos++] = val >> 16; buf[pos++] = val >> 8; buf[pos++] = val; return saa7706h_i2c_send(client, buf, pos); } static int saa7706h_set_reg24_err(struct v4l2_subdev *sd, u16 reg, u32 val, int *err) { return *err ? *err : saa7706h_set_reg24(sd, reg, val); } static int saa7706h_set_reg16(struct v4l2_subdev *sd, u16 reg, u16 val) { struct i2c_client *client = v4l2_get_subdevdata(sd); u8 buf[4]; int pos = 0; buf[pos++] = reg >> 8; buf[pos++] = reg; buf[pos++] = val >> 8; buf[pos++] = val; return saa7706h_i2c_send(client, buf, pos); } static int saa7706h_set_reg16_err(struct v4l2_subdev *sd, u16 reg, u16 val, int *err) { return *err ? *err : saa7706h_set_reg16(sd, reg, val); } static int saa7706h_get_reg16(struct v4l2_subdev *sd, u16 reg) { struct i2c_client *client = v4l2_get_subdevdata(sd); u8 buf[2]; int err; u8 regaddr[] = {reg >> 8, reg}; struct i2c_msg msg[] = { { .addr = client->addr, .len = sizeof(regaddr), .buf = regaddr }, { .addr = client->addr, .flags = I2C_M_RD, .len = sizeof(buf), .buf = buf } }; err = saa7706h_i2c_transfer(client, msg, ARRAY_SIZE(msg)); if (err) return err; return buf[0] << 8 | buf[1]; } static int saa7706h_unmute(struct v4l2_subdev *sd) { struct saa7706h_state *state = to_state(sd); int err = 0; err = saa7706h_set_reg16_err(sd, SAA7706H_REG_CTRL, SAA7706H_CTRL_PLL3_62975MHZ | SAA7706H_CTRL_PC_RESET_DSP1 | SAA7706H_CTRL_PC_RESET_DSP2, &err); /* newer versions of the chip requires a small sleep after reset */ msleep(1); err = saa7706h_set_reg16_err(sd, SAA7706H_REG_CTRL, SAA7706H_CTRL_PLL3_62975MHZ, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_REG_EVALUATION, 0, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_REG_CL_GEN1, 0x040022, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_REG_CL_GEN2, SAA7706H_CL_GEN2_WSEDGE_FALLING, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_REG_CL_GEN4, 0x024080, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_REG_SEL, 0x200080, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_REG_IAC, 0xf4caed, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_REG_CLK_SET, 0x124334, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_REG_CLK_COEFF, 0x004a1a, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_REG_INPUT_SENS, 0x0071c7, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_REG_PHONE_NAV_AUDIO, 0x0e22ff, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_REG_IO_CONF_DSP2, 0x001ff8, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_REG_STATUS_DSP2, 0x080003, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_REG_PC_DSP2, 0x000004, &err); err = saa7706h_set_reg16_err(sd, SAA7706H_DSP1_MOD0, 0x0c6c, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_MPTR0, 0x000b4b, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_DSP1_MODPNTR, 0x000600, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_DSP1_MODPNTR, 0x0000c0, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_CONTLLCW, 0x000819, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_CONTLLCW, 0x00085a, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_BUSAMP, 0x7fffff, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_FDACPNTR, 0x2000cb, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_IIS1PNTR, 0x2000cb, &err); err = saa7706h_set_reg16_err(sd, SAA7706H_DSP2_YMEM_PVGA, 0x0f80, &err); err = saa7706h_set_reg16_err(sd, SAA7706H_DSP2_YMEM_PVAT1, 0x0800, &err); err = saa7706h_set_reg16_err(sd, SAA7706H_DSP2_YMEM_PVAT, 0x0800, &err); err = saa7706h_set_reg24_err(sd, SAA7706H_DSP2_XMEM_CONTLLCW, 0x000905, &err); if (!err) state->muted = 0; return err; } static int saa7706h_mute(struct v4l2_subdev *sd) { struct saa7706h_state *state = to_state(sd); int err; err = saa7706h_set_reg16(sd, SAA7706H_REG_CTRL, SAA7706H_CTRL_PLL3_62975MHZ | SAA7706H_CTRL_PC_RESET_DSP1 | SAA7706H_CTRL_PC_RESET_DSP2); if (!err) state->muted = 1; return err; } static int saa7706h_s_ctrl(struct v4l2_ctrl *ctrl) { struct saa7706h_state *state = container_of(ctrl->handler, struct saa7706h_state, hdl); switch (ctrl->id) { case V4L2_CID_AUDIO_MUTE: if (ctrl->val) return saa7706h_mute(&state->sd); return saa7706h_unmute(&state->sd); } return -EINVAL; } static const struct v4l2_ctrl_ops saa7706h_ctrl_ops = { .s_ctrl = saa7706h_s_ctrl, }; static const struct v4l2_subdev_ops empty_ops = {}; /* * Generic i2c probe * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1' */ static int saa7706h_probe(struct i2c_client *client, const struct i2c_device_id *id) { struct saa7706h_state *state; struct v4l2_subdev *sd; int err; /* Check if the adapter supports the needed features */ if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA)) return -EIO; v4l_info(client, "chip found @ 0x%02x (%s)\n", client->addr << 1, client->adapter->name); state = kzalloc(sizeof(struct saa7706h_state), GFP_KERNEL); if (state == NULL) return -ENOMEM; sd = &state->sd; v4l2_i2c_subdev_init(sd, client, &empty_ops); v4l2_ctrl_handler_init(&state->hdl, 4); v4l2_ctrl_new_std(&state->hdl, &saa7706h_ctrl_ops, V4L2_CID_AUDIO_MUTE, 0, 1, 1, 1); sd->ctrl_handler = &state->hdl; err = state->hdl.error; if (err) goto err; /* check the rom versions */ err = saa7706h_get_reg16(sd, SAA7706H_DSP1_ROM_VER); if (err < 0) goto err; if (err != SUPPORTED_DSP1_ROM_VER) v4l2_warn(sd, "Unknown DSP1 ROM code version: 0x%x\n", err); state->muted = 1; /* startup in a muted state */ err = saa7706h_mute(sd); if (err) goto err; return 0; err: v4l2_device_unregister_subdev(sd); v4l2_ctrl_handler_free(&state->hdl); kfree(to_state(sd)); printk(KERN_ERR DRIVER_NAME ": Failed to probe: %d\n", err); return err; } static int saa7706h_remove(struct i2c_client *client) { struct v4l2_subdev *sd = i2c_get_clientdata(client); struct saa7706h_state *state = to_state(sd); saa7706h_mute(sd); v4l2_device_unregister_subdev(sd); v4l2_ctrl_handler_free(&state->hdl); kfree(to_state(sd)); return 0; } static const struct i2c_device_id saa7706h_id[] = { {DRIVER_NAME, 0}, {}, }; MODULE_DEVICE_TABLE(i2c, saa7706h_id); static struct i2c_driver saa7706h_driver = { .driver = { .name = DRIVER_NAME, }, .probe = saa7706h_probe, .remove = saa7706h_remove, .id_table = saa7706h_id, }; module_i2c_driver(saa7706h_driver); MODULE_DESCRIPTION("SAA7706H Car Radio DSP driver"); MODULE_AUTHOR("Mocean Laboratories"); MODULE_LICENSE("GPL v2");