linux/drivers/media/i2c/cs53l32a.c
<<
>>
Prefs
   1/*
   2 * cs53l32a (Adaptec AVC-2010 and AVC-2410) i2c ivtv driver.
   3 * Copyright (C) 2005  Martin Vaughan
   4 *
   5 * Audio source switching for Adaptec AVC-2410 added by Trev Jackson
   6 *
   7 * This program is free software; you can redistribute it and/or modify
   8 * it under the terms of the GNU General Public License as published by
   9 * the Free Software Foundation; either version 2 of the License, or
  10 * (at your option) any later version.
  11 *
  12 * This program is distributed in the hope that it will be useful,
  13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15 * GNU General Public License for more details.
  16 *
  17 * You should have received a copy of the GNU General Public License
  18 * along with this program; if not, write to the Free Software
  19 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  20 */
  21
  22
  23#include <linux/module.h>
  24#include <linux/types.h>
  25#include <linux/slab.h>
  26#include <linux/ioctl.h>
  27#include <asm/uaccess.h>
  28#include <linux/i2c.h>
  29#include <linux/videodev2.h>
  30#include <media/v4l2-device.h>
  31#include <media/v4l2-ctrls.h>
  32
  33MODULE_DESCRIPTION("i2c device driver for cs53l32a Audio ADC");
  34MODULE_AUTHOR("Martin Vaughan");
  35MODULE_LICENSE("GPL");
  36
  37static bool debug;
  38
  39module_param(debug, bool, 0644);
  40
  41MODULE_PARM_DESC(debug, "Debugging messages, 0=Off (default), 1=On");
  42
  43
  44struct cs53l32a_state {
  45        struct v4l2_subdev sd;
  46        struct v4l2_ctrl_handler hdl;
  47};
  48
  49static inline struct cs53l32a_state *to_state(struct v4l2_subdev *sd)
  50{
  51        return container_of(sd, struct cs53l32a_state, sd);
  52}
  53
  54static inline struct v4l2_subdev *to_sd(struct v4l2_ctrl *ctrl)
  55{
  56        return &container_of(ctrl->handler, struct cs53l32a_state, hdl)->sd;
  57}
  58
  59/* ----------------------------------------------------------------------- */
  60
  61static int cs53l32a_write(struct v4l2_subdev *sd, u8 reg, u8 value)
  62{
  63        struct i2c_client *client = v4l2_get_subdevdata(sd);
  64
  65        return i2c_smbus_write_byte_data(client, reg, value);
  66}
  67
  68static int cs53l32a_read(struct v4l2_subdev *sd, u8 reg)
  69{
  70        struct i2c_client *client = v4l2_get_subdevdata(sd);
  71
  72        return i2c_smbus_read_byte_data(client, reg);
  73}
  74
  75static int cs53l32a_s_routing(struct v4l2_subdev *sd,
  76                              u32 input, u32 output, u32 config)
  77{
  78        /* There are 2 physical inputs, but the second input can be
  79           placed in two modes, the first mode bypasses the PGA (gain),
  80           the second goes through the PGA. Hence there are three
  81           possible inputs to choose from. */
  82        if (input > 2) {
  83                v4l2_err(sd, "Invalid input %d.\n", input);
  84                return -EINVAL;
  85        }
  86        cs53l32a_write(sd, 0x01, 0x01 + (input << 4));
  87        return 0;
  88}
  89
  90static int cs53l32a_s_ctrl(struct v4l2_ctrl *ctrl)
  91{
  92        struct v4l2_subdev *sd = to_sd(ctrl);
  93
  94        switch (ctrl->id) {
  95        case V4L2_CID_AUDIO_MUTE:
  96                cs53l32a_write(sd, 0x03, ctrl->val ? 0xf0 : 0x30);
  97                return 0;
  98        case V4L2_CID_AUDIO_VOLUME:
  99                cs53l32a_write(sd, 0x04, (u8)ctrl->val);
 100                cs53l32a_write(sd, 0x05, (u8)ctrl->val);
 101                return 0;
 102        }
 103        return -EINVAL;
 104}
 105
 106static int cs53l32a_log_status(struct v4l2_subdev *sd)
 107{
 108        struct cs53l32a_state *state = to_state(sd);
 109        u8 v = cs53l32a_read(sd, 0x01);
 110
 111        v4l2_info(sd, "Input:  %d\n", (v >> 4) & 3);
 112        v4l2_ctrl_handler_log_status(&state->hdl, sd->name);
 113        return 0;
 114}
 115
 116/* ----------------------------------------------------------------------- */
 117
 118static const struct v4l2_ctrl_ops cs53l32a_ctrl_ops = {
 119        .s_ctrl = cs53l32a_s_ctrl,
 120};
 121
 122static const struct v4l2_subdev_core_ops cs53l32a_core_ops = {
 123        .log_status = cs53l32a_log_status,
 124        .g_ext_ctrls = v4l2_subdev_g_ext_ctrls,
 125        .try_ext_ctrls = v4l2_subdev_try_ext_ctrls,
 126        .s_ext_ctrls = v4l2_subdev_s_ext_ctrls,
 127        .g_ctrl = v4l2_subdev_g_ctrl,
 128        .s_ctrl = v4l2_subdev_s_ctrl,
 129        .queryctrl = v4l2_subdev_queryctrl,
 130        .querymenu = v4l2_subdev_querymenu,
 131};
 132
 133static const struct v4l2_subdev_audio_ops cs53l32a_audio_ops = {
 134        .s_routing = cs53l32a_s_routing,
 135};
 136
 137static const struct v4l2_subdev_ops cs53l32a_ops = {
 138        .core = &cs53l32a_core_ops,
 139        .audio = &cs53l32a_audio_ops,
 140};
 141
 142/* ----------------------------------------------------------------------- */
 143
 144/* i2c implementation */
 145
 146/*
 147 * Generic i2c probe
 148 * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1'
 149 */
 150
 151static int cs53l32a_probe(struct i2c_client *client,
 152                          const struct i2c_device_id *id)
 153{
 154        struct cs53l32a_state *state;
 155        struct v4l2_subdev *sd;
 156        int i;
 157
 158        /* Check if the adapter supports the needed features */
 159        if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
 160                return -EIO;
 161
 162        if (!id)
 163                strlcpy(client->name, "cs53l32a", sizeof(client->name));
 164
 165        v4l_info(client, "chip found @ 0x%x (%s)\n",
 166                        client->addr << 1, client->adapter->name);
 167
 168        state = devm_kzalloc(&client->dev, sizeof(*state), GFP_KERNEL);
 169        if (state == NULL)
 170                return -ENOMEM;
 171        sd = &state->sd;
 172        v4l2_i2c_subdev_init(sd, client, &cs53l32a_ops);
 173
 174        for (i = 1; i <= 7; i++) {
 175                u8 v = cs53l32a_read(sd, i);
 176
 177                v4l2_dbg(1, debug, sd, "Read Reg %d %02x\n", i, v);
 178        }
 179
 180        v4l2_ctrl_handler_init(&state->hdl, 2);
 181        v4l2_ctrl_new_std(&state->hdl, &cs53l32a_ctrl_ops,
 182                        V4L2_CID_AUDIO_VOLUME, -96, 12, 1, 0);
 183        v4l2_ctrl_new_std(&state->hdl, &cs53l32a_ctrl_ops,
 184                        V4L2_CID_AUDIO_MUTE, 0, 1, 1, 0);
 185        sd->ctrl_handler = &state->hdl;
 186        if (state->hdl.error) {
 187                int err = state->hdl.error;
 188
 189                v4l2_ctrl_handler_free(&state->hdl);
 190                return err;
 191        }
 192
 193        /* Set cs53l32a internal register for Adaptec 2010/2410 setup */
 194
 195        cs53l32a_write(sd, 0x01, 0x21);
 196        cs53l32a_write(sd, 0x02, 0x29);
 197        cs53l32a_write(sd, 0x03, 0x30);
 198        cs53l32a_write(sd, 0x04, 0x00);
 199        cs53l32a_write(sd, 0x05, 0x00);
 200        cs53l32a_write(sd, 0x06, 0x00);
 201        cs53l32a_write(sd, 0x07, 0x00);
 202
 203        /* Display results, should be 0x21,0x29,0x30,0x00,0x00,0x00,0x00 */
 204
 205        for (i = 1; i <= 7; i++) {
 206                u8 v = cs53l32a_read(sd, i);
 207
 208                v4l2_dbg(1, debug, sd, "Read Reg %d %02x\n", i, v);
 209        }
 210        return 0;
 211}
 212
 213static int cs53l32a_remove(struct i2c_client *client)
 214{
 215        struct v4l2_subdev *sd = i2c_get_clientdata(client);
 216        struct cs53l32a_state *state = to_state(sd);
 217
 218        v4l2_device_unregister_subdev(sd);
 219        v4l2_ctrl_handler_free(&state->hdl);
 220        return 0;
 221}
 222
 223static const struct i2c_device_id cs53l32a_id[] = {
 224        { "cs53l32a", 0 },
 225        { }
 226};
 227MODULE_DEVICE_TABLE(i2c, cs53l32a_id);
 228
 229static struct i2c_driver cs53l32a_driver = {
 230        .driver = {
 231                .owner  = THIS_MODULE,
 232                .name   = "cs53l32a",
 233        },
 234        .probe          = cs53l32a_probe,
 235        .remove         = cs53l32a_remove,
 236        .id_table       = cs53l32a_id,
 237};
 238
 239module_i2c_driver(cs53l32a_driver);
 240