2 * cs5345 Cirrus Logic 24-bit, 192 kHz Stereo Audio ADC
3 * Copyright (C) 2007 Hans Verkuil
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21 #include <linux/module.h>
22 #include <linux/kernel.h>
23 #include <linux/i2c.h>
24 #include <linux/videodev2.h>
25 #include <media/v4l2-device.h>
26 #include <media/v4l2-chip-ident.h>
27 #include <media/v4l2-i2c-drv.h>
29 MODULE_DESCRIPTION("i2c device driver for cs5345 Audio ADC");
30 MODULE_AUTHOR("Hans Verkuil");
31 MODULE_LICENSE("GPL");
35 module_param(debug
, bool, 0644);
37 MODULE_PARM_DESC(debug
, "Debugging messages, 0=Off (default), 1=On");
40 /* ----------------------------------------------------------------------- */
42 static inline int cs5345_write(struct v4l2_subdev
*sd
, u8 reg
, u8 value
)
44 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
46 return i2c_smbus_write_byte_data(client
, reg
, value
);
49 static inline int cs5345_read(struct v4l2_subdev
*sd
, u8 reg
)
51 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
53 return i2c_smbus_read_byte_data(client
, reg
);
56 static int cs5345_s_routing(struct v4l2_subdev
*sd
, const struct v4l2_routing
*route
)
58 if ((route
->input
& 0xf) > 6) {
59 v4l2_err(sd
, "Invalid input %d.\n", route
->input
);
62 cs5345_write(sd
, 0x09, route
->input
& 0xf);
63 cs5345_write(sd
, 0x05, route
->input
& 0xf0);
67 static int cs5345_g_ctrl(struct v4l2_subdev
*sd
, struct v4l2_control
*ctrl
)
69 if (ctrl
->id
== V4L2_CID_AUDIO_MUTE
) {
70 ctrl
->value
= (cs5345_read(sd
, 0x04) & 0x08) != 0;
73 if (ctrl
->id
!= V4L2_CID_AUDIO_VOLUME
)
75 ctrl
->value
= cs5345_read(sd
, 0x07) & 0x3f;
76 if (ctrl
->value
>= 32)
77 ctrl
->value
= ctrl
->value
- 64;
81 static int cs5345_s_ctrl(struct v4l2_subdev
*sd
, struct v4l2_control
*ctrl
)
83 if (ctrl
->id
== V4L2_CID_AUDIO_MUTE
) {
84 cs5345_write(sd
, 0x04, ctrl
->value
? 0x80 : 0);
87 if (ctrl
->id
!= V4L2_CID_AUDIO_VOLUME
)
89 if (ctrl
->value
> 24 || ctrl
->value
< -24)
91 cs5345_write(sd
, 0x07, ((u8
)ctrl
->value
) & 0x3f);
92 cs5345_write(sd
, 0x08, ((u8
)ctrl
->value
) & 0x3f);
96 #ifdef CONFIG_VIDEO_ADV_DEBUG
97 static int cs5345_g_register(struct v4l2_subdev
*sd
, struct v4l2_dbg_register
*reg
)
99 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
101 if (!v4l2_chip_match_i2c_client(client
, ®
->match
))
103 if (!capable(CAP_SYS_ADMIN
))
106 reg
->val
= cs5345_read(sd
, reg
->reg
& 0x1f);
110 static int cs5345_s_register(struct v4l2_subdev
*sd
, struct v4l2_dbg_register
*reg
)
112 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
114 if (!v4l2_chip_match_i2c_client(client
, ®
->match
))
116 if (!capable(CAP_SYS_ADMIN
))
118 cs5345_write(sd
, reg
->reg
& 0x1f, reg
->val
& 0xff);
123 static int cs5345_g_chip_ident(struct v4l2_subdev
*sd
, struct v4l2_dbg_chip_ident
*chip
)
125 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
127 return v4l2_chip_ident_i2c_client(client
, chip
, V4L2_IDENT_CS5345
, 0);
130 static int cs5345_log_status(struct v4l2_subdev
*sd
)
132 u8 v
= cs5345_read(sd
, 0x09) & 7;
133 u8 m
= cs5345_read(sd
, 0x04);
134 int vol
= cs5345_read(sd
, 0x08) & 0x3f;
136 v4l2_info(sd
, "Input: %d%s\n", v
,
137 (m
& 0x80) ? " (muted)" : "");
140 v4l2_info(sd
, "Volume: %d dB\n", vol
);
144 static int cs5345_command(struct i2c_client
*client
, unsigned cmd
, void *arg
)
146 return v4l2_subdev_command(i2c_get_clientdata(client
), cmd
, arg
);
149 /* ----------------------------------------------------------------------- */
151 static const struct v4l2_subdev_core_ops cs5345_core_ops
= {
152 .log_status
= cs5345_log_status
,
153 .g_chip_ident
= cs5345_g_chip_ident
,
154 .g_ctrl
= cs5345_g_ctrl
,
155 .s_ctrl
= cs5345_s_ctrl
,
156 #ifdef CONFIG_VIDEO_ADV_DEBUG
157 .g_register
= cs5345_g_register
,
158 .s_register
= cs5345_s_register
,
162 static const struct v4l2_subdev_audio_ops cs5345_audio_ops
= {
163 .s_routing
= cs5345_s_routing
,
166 static const struct v4l2_subdev_ops cs5345_ops
= {
167 .core
= &cs5345_core_ops
,
168 .audio
= &cs5345_audio_ops
,
171 /* ----------------------------------------------------------------------- */
173 static int cs5345_probe(struct i2c_client
*client
,
174 const struct i2c_device_id
*id
)
176 struct v4l2_subdev
*sd
;
178 /* Check if the adapter supports the needed features */
179 if (!i2c_check_functionality(client
->adapter
, I2C_FUNC_SMBUS_BYTE_DATA
))
182 v4l_info(client
, "chip found @ 0x%x (%s)\n",
183 client
->addr
<< 1, client
->adapter
->name
);
185 sd
= kzalloc(sizeof(struct v4l2_subdev
), GFP_KERNEL
);
188 v4l2_i2c_subdev_init(sd
, client
, &cs5345_ops
);
190 cs5345_write(sd
, 0x02, 0x00);
191 cs5345_write(sd
, 0x04, 0x01);
192 cs5345_write(sd
, 0x09, 0x01);
196 /* ----------------------------------------------------------------------- */
198 static int cs5345_remove(struct i2c_client
*client
)
200 struct v4l2_subdev
*sd
= i2c_get_clientdata(client
);
202 v4l2_device_unregister_subdev(sd
);
207 /* ----------------------------------------------------------------------- */
209 static const struct i2c_device_id cs5345_id
[] = {
213 MODULE_DEVICE_TABLE(i2c
, cs5345_id
);
215 static struct v4l2_i2c_driver_data v4l2_i2c_data
= {
217 .driverid
= I2C_DRIVERID_CS5345
,
218 .command
= cs5345_command
,
219 .probe
= cs5345_probe
,
220 .remove
= cs5345_remove
,
221 .id_table
= cs5345_id
,