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 <linux/slab.h>
26 #include <media/v4l2-device.h>
27 #include <media/v4l2-chip-ident.h>
28 #include <media/v4l2-i2c-drv.h>
30 MODULE_DESCRIPTION("i2c device driver for cs5345 Audio ADC");
31 MODULE_AUTHOR("Hans Verkuil");
32 MODULE_LICENSE("GPL");
36 module_param(debug
, bool, 0644);
38 MODULE_PARM_DESC(debug
, "Debugging messages, 0=Off (default), 1=On");
41 /* ----------------------------------------------------------------------- */
43 static inline int cs5345_write(struct v4l2_subdev
*sd
, u8 reg
, u8 value
)
45 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
47 return i2c_smbus_write_byte_data(client
, reg
, value
);
50 static inline int cs5345_read(struct v4l2_subdev
*sd
, u8 reg
)
52 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
54 return i2c_smbus_read_byte_data(client
, reg
);
57 static int cs5345_s_routing(struct v4l2_subdev
*sd
,
58 u32 input
, u32 output
, u32 config
)
60 if ((input
& 0xf) > 6) {
61 v4l2_err(sd
, "Invalid input %d.\n", input
);
64 cs5345_write(sd
, 0x09, input
& 0xf);
65 cs5345_write(sd
, 0x05, input
& 0xf0);
69 static int cs5345_g_ctrl(struct v4l2_subdev
*sd
, struct v4l2_control
*ctrl
)
71 if (ctrl
->id
== V4L2_CID_AUDIO_MUTE
) {
72 ctrl
->value
= (cs5345_read(sd
, 0x04) & 0x08) != 0;
75 if (ctrl
->id
!= V4L2_CID_AUDIO_VOLUME
)
77 ctrl
->value
= cs5345_read(sd
, 0x07) & 0x3f;
78 if (ctrl
->value
>= 32)
79 ctrl
->value
= ctrl
->value
- 64;
83 static int cs5345_s_ctrl(struct v4l2_subdev
*sd
, struct v4l2_control
*ctrl
)
85 if (ctrl
->id
== V4L2_CID_AUDIO_MUTE
) {
86 cs5345_write(sd
, 0x04, ctrl
->value
? 0x80 : 0);
89 if (ctrl
->id
!= V4L2_CID_AUDIO_VOLUME
)
91 if (ctrl
->value
> 24 || ctrl
->value
< -24)
93 cs5345_write(sd
, 0x07, ((u8
)ctrl
->value
) & 0x3f);
94 cs5345_write(sd
, 0x08, ((u8
)ctrl
->value
) & 0x3f);
98 #ifdef CONFIG_VIDEO_ADV_DEBUG
99 static int cs5345_g_register(struct v4l2_subdev
*sd
, struct v4l2_dbg_register
*reg
)
101 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
103 if (!v4l2_chip_match_i2c_client(client
, ®
->match
))
105 if (!capable(CAP_SYS_ADMIN
))
108 reg
->val
= cs5345_read(sd
, reg
->reg
& 0x1f);
112 static int cs5345_s_register(struct v4l2_subdev
*sd
, struct v4l2_dbg_register
*reg
)
114 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
116 if (!v4l2_chip_match_i2c_client(client
, ®
->match
))
118 if (!capable(CAP_SYS_ADMIN
))
120 cs5345_write(sd
, reg
->reg
& 0x1f, reg
->val
& 0xff);
125 static int cs5345_g_chip_ident(struct v4l2_subdev
*sd
, struct v4l2_dbg_chip_ident
*chip
)
127 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
129 return v4l2_chip_ident_i2c_client(client
, chip
, V4L2_IDENT_CS5345
, 0);
132 static int cs5345_log_status(struct v4l2_subdev
*sd
)
134 u8 v
= cs5345_read(sd
, 0x09) & 7;
135 u8 m
= cs5345_read(sd
, 0x04);
136 int vol
= cs5345_read(sd
, 0x08) & 0x3f;
138 v4l2_info(sd
, "Input: %d%s\n", v
,
139 (m
& 0x80) ? " (muted)" : "");
142 v4l2_info(sd
, "Volume: %d dB\n", vol
);
146 /* ----------------------------------------------------------------------- */
148 static const struct v4l2_subdev_core_ops cs5345_core_ops
= {
149 .log_status
= cs5345_log_status
,
150 .g_chip_ident
= cs5345_g_chip_ident
,
151 .g_ctrl
= cs5345_g_ctrl
,
152 .s_ctrl
= cs5345_s_ctrl
,
153 #ifdef CONFIG_VIDEO_ADV_DEBUG
154 .g_register
= cs5345_g_register
,
155 .s_register
= cs5345_s_register
,
159 static const struct v4l2_subdev_audio_ops cs5345_audio_ops
= {
160 .s_routing
= cs5345_s_routing
,
163 static const struct v4l2_subdev_ops cs5345_ops
= {
164 .core
= &cs5345_core_ops
,
165 .audio
= &cs5345_audio_ops
,
168 /* ----------------------------------------------------------------------- */
170 static int cs5345_probe(struct i2c_client
*client
,
171 const struct i2c_device_id
*id
)
173 struct v4l2_subdev
*sd
;
175 /* Check if the adapter supports the needed features */
176 if (!i2c_check_functionality(client
->adapter
, I2C_FUNC_SMBUS_BYTE_DATA
))
179 v4l_info(client
, "chip found @ 0x%x (%s)\n",
180 client
->addr
<< 1, client
->adapter
->name
);
182 sd
= kzalloc(sizeof(struct v4l2_subdev
), GFP_KERNEL
);
185 v4l2_i2c_subdev_init(sd
, client
, &cs5345_ops
);
187 cs5345_write(sd
, 0x02, 0x00);
188 cs5345_write(sd
, 0x04, 0x01);
189 cs5345_write(sd
, 0x09, 0x01);
193 /* ----------------------------------------------------------------------- */
195 static int cs5345_remove(struct i2c_client
*client
)
197 struct v4l2_subdev
*sd
= i2c_get_clientdata(client
);
199 v4l2_device_unregister_subdev(sd
);
204 /* ----------------------------------------------------------------------- */
206 static const struct i2c_device_id cs5345_id
[] = {
210 MODULE_DEVICE_TABLE(i2c
, cs5345_id
);
212 static struct v4l2_i2c_driver_data v4l2_i2c_data
= {
214 .probe
= cs5345_probe
,
215 .remove
= cs5345_remove
,
216 .id_table
= cs5345_id
,