diff options
Diffstat (limited to 'drivers')
-rw-r--r-- | drivers/media/video/cs53l32a.c | 107 |
1 files changed, 68 insertions, 39 deletions
diff --git a/drivers/media/video/cs53l32a.c b/drivers/media/video/cs53l32a.c index 3cc135a98d82..cc9e84d75ea7 100644 --- a/drivers/media/video/cs53l32a.c +++ b/drivers/media/video/cs53l32a.c | |||
@@ -26,10 +26,10 @@ | |||
26 | #include <linux/ioctl.h> | 26 | #include <linux/ioctl.h> |
27 | #include <asm/uaccess.h> | 27 | #include <asm/uaccess.h> |
28 | #include <linux/i2c.h> | 28 | #include <linux/i2c.h> |
29 | #include <linux/i2c-id.h> | ||
30 | #include <linux/videodev2.h> | 29 | #include <linux/videodev2.h> |
31 | #include <media/v4l2-device.h> | 30 | #include <media/v4l2-device.h> |
32 | #include <media/v4l2-chip-ident.h> | 31 | #include <media/v4l2-chip-ident.h> |
32 | #include <media/v4l2-ctrls.h> | ||
33 | #include <media/v4l2-i2c-drv.h> | 33 | #include <media/v4l2-i2c-drv.h> |
34 | 34 | ||
35 | MODULE_DESCRIPTION("i2c device driver for cs53l32a Audio ADC"); | 35 | MODULE_DESCRIPTION("i2c device driver for cs53l32a Audio ADC"); |
@@ -43,6 +43,21 @@ module_param(debug, bool, 0644); | |||
43 | MODULE_PARM_DESC(debug, "Debugging messages, 0=Off (default), 1=On"); | 43 | MODULE_PARM_DESC(debug, "Debugging messages, 0=Off (default), 1=On"); |
44 | 44 | ||
45 | 45 | ||
46 | struct cs53l32a_state { | ||
47 | struct v4l2_subdev sd; | ||
48 | struct v4l2_ctrl_handler hdl; | ||
49 | }; | ||
50 | |||
51 | static inline struct cs53l32a_state *to_state(struct v4l2_subdev *sd) | ||
52 | { | ||
53 | return container_of(sd, struct cs53l32a_state, sd); | ||
54 | } | ||
55 | |||
56 | static inline struct v4l2_subdev *to_sd(struct v4l2_ctrl *ctrl) | ||
57 | { | ||
58 | return &container_of(ctrl->handler, struct cs53l32a_state, hdl)->sd; | ||
59 | } | ||
60 | |||
46 | /* ----------------------------------------------------------------------- */ | 61 | /* ----------------------------------------------------------------------- */ |
47 | 62 | ||
48 | static int cs53l32a_write(struct v4l2_subdev *sd, u8 reg, u8 value) | 63 | static int cs53l32a_write(struct v4l2_subdev *sd, u8 reg, u8 value) |
@@ -74,31 +89,20 @@ static int cs53l32a_s_routing(struct v4l2_subdev *sd, | |||
74 | return 0; | 89 | return 0; |
75 | } | 90 | } |
76 | 91 | ||
77 | static int cs53l32a_g_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl) | 92 | static int cs53l32a_s_ctrl(struct v4l2_ctrl *ctrl) |
78 | { | 93 | { |
79 | if (ctrl->id == V4L2_CID_AUDIO_MUTE) { | 94 | struct v4l2_subdev *sd = to_sd(ctrl); |
80 | ctrl->value = (cs53l32a_read(sd, 0x03) & 0xc0) != 0; | ||
81 | return 0; | ||
82 | } | ||
83 | if (ctrl->id != V4L2_CID_AUDIO_VOLUME) | ||
84 | return -EINVAL; | ||
85 | ctrl->value = (s8)cs53l32a_read(sd, 0x04); | ||
86 | return 0; | ||
87 | } | ||
88 | 95 | ||
89 | static int cs53l32a_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl) | 96 | switch (ctrl->id) { |
90 | { | 97 | case V4L2_CID_AUDIO_MUTE: |
91 | if (ctrl->id == V4L2_CID_AUDIO_MUTE) { | 98 | cs53l32a_write(sd, 0x03, ctrl->val ? 0xf0 : 0x30); |
92 | cs53l32a_write(sd, 0x03, ctrl->value ? 0xf0 : 0x30); | 99 | return 0; |
100 | case V4L2_CID_AUDIO_VOLUME: | ||
101 | cs53l32a_write(sd, 0x04, (u8)ctrl->val); | ||
102 | cs53l32a_write(sd, 0x05, (u8)ctrl->val); | ||
93 | return 0; | 103 | return 0; |
94 | } | 104 | } |
95 | if (ctrl->id != V4L2_CID_AUDIO_VOLUME) | 105 | return -EINVAL; |
96 | return -EINVAL; | ||
97 | if (ctrl->value > 12 || ctrl->value < -96) | ||
98 | return -EINVAL; | ||
99 | cs53l32a_write(sd, 0x04, (u8) ctrl->value); | ||
100 | cs53l32a_write(sd, 0x05, (u8) ctrl->value); | ||
101 | return 0; | ||
102 | } | 106 | } |
103 | 107 | ||
104 | static int cs53l32a_g_chip_ident(struct v4l2_subdev *sd, struct v4l2_dbg_chip_ident *chip) | 108 | static int cs53l32a_g_chip_ident(struct v4l2_subdev *sd, struct v4l2_dbg_chip_ident *chip) |
@@ -111,23 +115,30 @@ static int cs53l32a_g_chip_ident(struct v4l2_subdev *sd, struct v4l2_dbg_chip_id | |||
111 | 115 | ||
112 | static int cs53l32a_log_status(struct v4l2_subdev *sd) | 116 | static int cs53l32a_log_status(struct v4l2_subdev *sd) |
113 | { | 117 | { |
118 | struct cs53l32a_state *state = to_state(sd); | ||
114 | u8 v = cs53l32a_read(sd, 0x01); | 119 | u8 v = cs53l32a_read(sd, 0x01); |
115 | u8 m = cs53l32a_read(sd, 0x03); | ||
116 | s8 vol = cs53l32a_read(sd, 0x04); | ||
117 | 120 | ||
118 | v4l2_info(sd, "Input: %d%s\n", (v >> 4) & 3, | 121 | v4l2_info(sd, "Input: %d\n", (v >> 4) & 3); |
119 | (m & 0xC0) ? " (muted)" : ""); | 122 | v4l2_ctrl_handler_log_status(&state->hdl, sd->name); |
120 | v4l2_info(sd, "Volume: %d dB\n", vol); | ||
121 | return 0; | 123 | return 0; |
122 | } | 124 | } |
123 | 125 | ||
124 | /* ----------------------------------------------------------------------- */ | 126 | /* ----------------------------------------------------------------------- */ |
125 | 127 | ||
128 | static const struct v4l2_ctrl_ops cs53l32a_ctrl_ops = { | ||
129 | .s_ctrl = cs53l32a_s_ctrl, | ||
130 | }; | ||
131 | |||
126 | static const struct v4l2_subdev_core_ops cs53l32a_core_ops = { | 132 | static const struct v4l2_subdev_core_ops cs53l32a_core_ops = { |
127 | .log_status = cs53l32a_log_status, | 133 | .log_status = cs53l32a_log_status, |
128 | .g_chip_ident = cs53l32a_g_chip_ident, | 134 | .g_chip_ident = cs53l32a_g_chip_ident, |
129 | .g_ctrl = cs53l32a_g_ctrl, | 135 | .g_ext_ctrls = v4l2_subdev_g_ext_ctrls, |
130 | .s_ctrl = cs53l32a_s_ctrl, | 136 | .try_ext_ctrls = v4l2_subdev_try_ext_ctrls, |
137 | .s_ext_ctrls = v4l2_subdev_s_ext_ctrls, | ||
138 | .g_ctrl = v4l2_subdev_g_ctrl, | ||
139 | .s_ctrl = v4l2_subdev_s_ctrl, | ||
140 | .queryctrl = v4l2_subdev_queryctrl, | ||
141 | .querymenu = v4l2_subdev_querymenu, | ||
131 | }; | 142 | }; |
132 | 143 | ||
133 | static const struct v4l2_subdev_audio_ops cs53l32a_audio_ops = { | 144 | static const struct v4l2_subdev_audio_ops cs53l32a_audio_ops = { |
@@ -151,6 +162,7 @@ static const struct v4l2_subdev_ops cs53l32a_ops = { | |||
151 | static int cs53l32a_probe(struct i2c_client *client, | 162 | static int cs53l32a_probe(struct i2c_client *client, |
152 | const struct i2c_device_id *id) | 163 | const struct i2c_device_id *id) |
153 | { | 164 | { |
165 | struct cs53l32a_state *state; | ||
154 | struct v4l2_subdev *sd; | 166 | struct v4l2_subdev *sd; |
155 | int i; | 167 | int i; |
156 | 168 | ||
@@ -164,9 +176,10 @@ static int cs53l32a_probe(struct i2c_client *client, | |||
164 | v4l_info(client, "chip found @ 0x%x (%s)\n", | 176 | v4l_info(client, "chip found @ 0x%x (%s)\n", |
165 | client->addr << 1, client->adapter->name); | 177 | client->addr << 1, client->adapter->name); |
166 | 178 | ||
167 | sd = kmalloc(sizeof(struct v4l2_subdev), GFP_KERNEL); | 179 | state = kzalloc(sizeof(struct cs53l32a_state), GFP_KERNEL); |
168 | if (sd == NULL) | 180 | if (state == NULL) |
169 | return -ENOMEM; | 181 | return -ENOMEM; |
182 | sd = &state->sd; | ||
170 | v4l2_i2c_subdev_init(sd, client, &cs53l32a_ops); | 183 | v4l2_i2c_subdev_init(sd, client, &cs53l32a_ops); |
171 | 184 | ||
172 | for (i = 1; i <= 7; i++) { | 185 | for (i = 1; i <= 7; i++) { |
@@ -175,15 +188,29 @@ static int cs53l32a_probe(struct i2c_client *client, | |||
175 | v4l2_dbg(1, debug, sd, "Read Reg %d %02x\n", i, v); | 188 | v4l2_dbg(1, debug, sd, "Read Reg %d %02x\n", i, v); |
176 | } | 189 | } |
177 | 190 | ||
191 | v4l2_ctrl_handler_init(&state->hdl, 2); | ||
192 | v4l2_ctrl_new_std(&state->hdl, &cs53l32a_ctrl_ops, | ||
193 | V4L2_CID_AUDIO_VOLUME, -96, 12, 1, 0); | ||
194 | v4l2_ctrl_new_std(&state->hdl, &cs53l32a_ctrl_ops, | ||
195 | V4L2_CID_AUDIO_MUTE, 0, 1, 1, 0); | ||
196 | sd->ctrl_handler = &state->hdl; | ||
197 | if (state->hdl.error) { | ||
198 | int err = state->hdl.error; | ||
199 | |||
200 | v4l2_ctrl_handler_free(&state->hdl); | ||
201 | kfree(state); | ||
202 | return err; | ||
203 | } | ||
204 | |||
178 | /* Set cs53l32a internal register for Adaptec 2010/2410 setup */ | 205 | /* Set cs53l32a internal register for Adaptec 2010/2410 setup */ |
179 | 206 | ||
180 | cs53l32a_write(sd, 0x01, (u8) 0x21); | 207 | cs53l32a_write(sd, 0x01, 0x21); |
181 | cs53l32a_write(sd, 0x02, (u8) 0x29); | 208 | cs53l32a_write(sd, 0x02, 0x29); |
182 | cs53l32a_write(sd, 0x03, (u8) 0x30); | 209 | cs53l32a_write(sd, 0x03, 0x30); |
183 | cs53l32a_write(sd, 0x04, (u8) 0x00); | 210 | cs53l32a_write(sd, 0x04, 0x00); |
184 | cs53l32a_write(sd, 0x05, (u8) 0x00); | 211 | cs53l32a_write(sd, 0x05, 0x00); |
185 | cs53l32a_write(sd, 0x06, (u8) 0x00); | 212 | cs53l32a_write(sd, 0x06, 0x00); |
186 | cs53l32a_write(sd, 0x07, (u8) 0x00); | 213 | cs53l32a_write(sd, 0x07, 0x00); |
187 | 214 | ||
188 | /* Display results, should be 0x21,0x29,0x30,0x00,0x00,0x00,0x00 */ | 215 | /* Display results, should be 0x21,0x29,0x30,0x00,0x00,0x00,0x00 */ |
189 | 216 | ||
@@ -198,9 +225,11 @@ static int cs53l32a_probe(struct i2c_client *client, | |||
198 | static int cs53l32a_remove(struct i2c_client *client) | 225 | static int cs53l32a_remove(struct i2c_client *client) |
199 | { | 226 | { |
200 | struct v4l2_subdev *sd = i2c_get_clientdata(client); | 227 | struct v4l2_subdev *sd = i2c_get_clientdata(client); |
228 | struct cs53l32a_state *state = to_state(sd); | ||
201 | 229 | ||
202 | v4l2_device_unregister_subdev(sd); | 230 | v4l2_device_unregister_subdev(sd); |
203 | kfree(sd); | 231 | v4l2_ctrl_handler_free(&state->hdl); |
232 | kfree(state); | ||
204 | return 0; | 233 | return 0; |
205 | } | 234 | } |
206 | 235 | ||