[CIFS] Check return code on failed alloc
[linux-2.6/mini2440.git] / sound / i2c / tea6330t.c
blobae5b1e3a68cee3c155e9f63defa3bfce6db68c07
1 /*
2 * Routines for control of the TEA6330T circuit via i2c bus
3 * Sound fader control circuit for car radios by Philips Semiconductors
4 * Copyright (c) by Jaroslav Kysela <perex@suse.cz>
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.
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.
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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
23 #include <sound/driver.h>
24 #include <linux/init.h>
25 #include <linux/slab.h>
26 #include <sound/core.h>
27 #include <sound/control.h>
28 #include <sound/tea6330t.h>
30 MODULE_AUTHOR("Jaroslav Kysela <perex@suse.cz>");
31 MODULE_DESCRIPTION("Routines for control of the TEA6330T circuit via i2c bus");
32 MODULE_LICENSE("GPL");
34 #define TEA6330T_ADDR (0x80>>1) /* fixed address */
36 #define TEA6330T_SADDR_VOLUME_LEFT 0x00 /* volume left */
37 #define TEA6330T_SADDR_VOLUME_RIGHT 0x01 /* volume right */
38 #define TEA6330T_SADDR_BASS 0x02 /* bass control */
39 #define TEA6330T_SADDR_TREBLE 0x03 /* treble control */
40 #define TEA6330T_SADDR_FADER 0x04 /* fader control */
41 #define TEA6330T_MFN 0x20 /* mute control for selected channels */
42 #define TEA6330T_FCH 0x10 /* select fader channels - front or rear */
43 #define TEA6330T_SADDR_AUDIO_SWITCH 0x05 /* audio switch */
44 #define TEA6330T_GMU 0x80 /* mute control, general mute */
45 #define TEA6330T_EQN 0x40 /* equalizer switchover (0=equalizer-on) */
48 struct tea6330t {
49 struct snd_i2c_device *device;
50 struct snd_i2c_bus *bus;
51 int equalizer;
52 int fader;
53 unsigned char regs[8];
54 unsigned char mleft, mright;
55 unsigned char bass, treble;
56 unsigned char max_bass, max_treble;
60 int snd_tea6330t_detect(struct snd_i2c_bus *bus, int equalizer)
62 int res;
64 snd_i2c_lock(bus);
65 res = snd_i2c_probeaddr(bus, TEA6330T_ADDR);
66 snd_i2c_unlock(bus);
67 return res;
70 #if 0
71 static void snd_tea6330t_set(struct tea6330t *tea,
72 unsigned char addr, unsigned char value)
74 #if 0
75 printk(KERN_DEBUG "set - 0x%x/0x%x\n", addr, value);
76 #endif
77 snd_i2c_write(tea->bus, TEA6330T_ADDR, addr, value, 1);
79 #endif
81 #define TEA6330T_MASTER_VOLUME(xname, xindex) \
82 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
83 .info = snd_tea6330t_info_master_volume, \
84 .get = snd_tea6330t_get_master_volume, .put = snd_tea6330t_put_master_volume }
86 static int snd_tea6330t_info_master_volume(struct snd_kcontrol *kcontrol,
87 struct snd_ctl_elem_info *uinfo)
89 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
90 uinfo->count = 2;
91 uinfo->value.integer.min = 0;
92 uinfo->value.integer.max = 43;
93 return 0;
96 static int snd_tea6330t_get_master_volume(struct snd_kcontrol *kcontrol,
97 struct snd_ctl_elem_value *ucontrol)
99 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
101 snd_i2c_lock(tea->bus);
102 ucontrol->value.integer.value[0] = tea->mleft - 0x14;
103 ucontrol->value.integer.value[1] = tea->mright - 0x14;
104 snd_i2c_unlock(tea->bus);
105 return 0;
108 static int snd_tea6330t_put_master_volume(struct snd_kcontrol *kcontrol,
109 struct snd_ctl_elem_value *ucontrol)
111 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
112 int change, count, err;
113 unsigned char bytes[3];
114 unsigned char val1, val2;
116 val1 = (ucontrol->value.integer.value[0] % 44) + 0x14;
117 val2 = (ucontrol->value.integer.value[1] % 44) + 0x14;
118 snd_i2c_lock(tea->bus);
119 change = val1 != tea->mleft || val2 != tea->mright;
120 tea->mleft = val1;
121 tea->mright = val2;
122 count = 0;
123 if (tea->regs[TEA6330T_SADDR_VOLUME_LEFT] != 0) {
124 bytes[count++] = TEA6330T_SADDR_VOLUME_LEFT;
125 bytes[count++] = tea->regs[TEA6330T_SADDR_VOLUME_LEFT] = tea->mleft;
127 if (tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] != 0) {
128 if (count == 0)
129 bytes[count++] = TEA6330T_SADDR_VOLUME_RIGHT;
130 bytes[count++] = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] = tea->mright;
132 if (count > 0) {
133 if ((err = snd_i2c_sendbytes(tea->device, bytes, count)) < 0)
134 change = err;
136 snd_i2c_unlock(tea->bus);
137 return change;
140 #define TEA6330T_MASTER_SWITCH(xname, xindex) \
141 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
142 .info = snd_tea6330t_info_master_switch, \
143 .get = snd_tea6330t_get_master_switch, .put = snd_tea6330t_put_master_switch }
145 static int snd_tea6330t_info_master_switch(struct snd_kcontrol *kcontrol,
146 struct snd_ctl_elem_info *uinfo)
148 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
149 uinfo->count = 2;
150 uinfo->value.integer.min = 0;
151 uinfo->value.integer.max = 1;
152 return 0;
155 static int snd_tea6330t_get_master_switch(struct snd_kcontrol *kcontrol,
156 struct snd_ctl_elem_value *ucontrol)
158 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
160 snd_i2c_lock(tea->bus);
161 ucontrol->value.integer.value[0] = tea->regs[TEA6330T_SADDR_VOLUME_LEFT] == 0 ? 0 : 1;
162 ucontrol->value.integer.value[1] = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] == 0 ? 0 : 1;
163 snd_i2c_unlock(tea->bus);
164 return 0;
167 static int snd_tea6330t_put_master_switch(struct snd_kcontrol *kcontrol,
168 struct snd_ctl_elem_value *ucontrol)
170 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
171 int change, err;
172 unsigned char bytes[3];
173 unsigned char oval1, oval2, val1, val2;
175 val1 = ucontrol->value.integer.value[0] & 1;
176 val2 = ucontrol->value.integer.value[1] & 1;
177 snd_i2c_lock(tea->bus);
178 oval1 = tea->regs[TEA6330T_SADDR_VOLUME_LEFT] == 0 ? 0 : 1;
179 oval2 = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] == 0 ? 0 : 1;
180 change = val1 != oval1 || val2 != oval2;
181 tea->regs[TEA6330T_SADDR_VOLUME_LEFT] = val1 ? tea->mleft : 0;
182 tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] = val2 ? tea->mright : 0;
183 bytes[0] = TEA6330T_SADDR_VOLUME_LEFT;
184 bytes[1] = tea->regs[TEA6330T_SADDR_VOLUME_LEFT];
185 bytes[2] = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT];
186 if ((err = snd_i2c_sendbytes(tea->device, bytes, 3)) < 0)
187 change = err;
188 snd_i2c_unlock(tea->bus);
189 return change;
192 #define TEA6330T_BASS(xname, xindex) \
193 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
194 .info = snd_tea6330t_info_bass, \
195 .get = snd_tea6330t_get_bass, .put = snd_tea6330t_put_bass }
197 static int snd_tea6330t_info_bass(struct snd_kcontrol *kcontrol,
198 struct snd_ctl_elem_info *uinfo)
200 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
202 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
203 uinfo->count = 1;
204 uinfo->value.integer.min = 0;
205 uinfo->value.integer.max = tea->max_bass;
206 return 0;
209 static int snd_tea6330t_get_bass(struct snd_kcontrol *kcontrol,
210 struct snd_ctl_elem_value *ucontrol)
212 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
214 ucontrol->value.integer.value[0] = tea->bass;
215 return 0;
218 static int snd_tea6330t_put_bass(struct snd_kcontrol *kcontrol,
219 struct snd_ctl_elem_value *ucontrol)
221 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
222 int change, err;
223 unsigned char bytes[2];
224 unsigned char val1;
226 val1 = ucontrol->value.integer.value[0] % (tea->max_bass + 1);
227 snd_i2c_lock(tea->bus);
228 tea->bass = val1;
229 val1 += tea->equalizer ? 7 : 3;
230 change = tea->regs[TEA6330T_SADDR_BASS] != val1;
231 bytes[0] = TEA6330T_SADDR_BASS;
232 bytes[1] = tea->regs[TEA6330T_SADDR_BASS] = val1;
233 if ((err = snd_i2c_sendbytes(tea->device, bytes, 2)) < 0)
234 change = err;
235 snd_i2c_unlock(tea->bus);
236 return change;
239 #define TEA6330T_TREBLE(xname, xindex) \
240 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
241 .info = snd_tea6330t_info_treble, \
242 .get = snd_tea6330t_get_treble, .put = snd_tea6330t_put_treble }
244 static int snd_tea6330t_info_treble(struct snd_kcontrol *kcontrol,
245 struct snd_ctl_elem_info *uinfo)
247 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
249 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
250 uinfo->count = 1;
251 uinfo->value.integer.min = 0;
252 uinfo->value.integer.max = tea->max_treble;
253 return 0;
256 static int snd_tea6330t_get_treble(struct snd_kcontrol *kcontrol,
257 struct snd_ctl_elem_value *ucontrol)
259 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
261 ucontrol->value.integer.value[0] = tea->treble;
262 return 0;
265 static int snd_tea6330t_put_treble(struct snd_kcontrol *kcontrol,
266 struct snd_ctl_elem_value *ucontrol)
268 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
269 int change, err;
270 unsigned char bytes[2];
271 unsigned char val1;
273 val1 = ucontrol->value.integer.value[0] % (tea->max_treble + 1);
274 snd_i2c_lock(tea->bus);
275 tea->treble = val1;
276 val1 += 3;
277 change = tea->regs[TEA6330T_SADDR_TREBLE] != val1;
278 bytes[0] = TEA6330T_SADDR_TREBLE;
279 bytes[1] = tea->regs[TEA6330T_SADDR_TREBLE] = val1;
280 if ((err = snd_i2c_sendbytes(tea->device, bytes, 2)) < 0)
281 change = err;
282 snd_i2c_unlock(tea->bus);
283 return change;
286 static struct snd_kcontrol_new snd_tea6330t_controls[] = {
287 TEA6330T_MASTER_SWITCH("Master Playback Switch", 0),
288 TEA6330T_MASTER_VOLUME("Master Playback Volume", 0),
289 TEA6330T_BASS("Tone Control - Bass", 0),
290 TEA6330T_TREBLE("Tone Control - Treble", 0)
293 static void snd_tea6330_free(struct snd_i2c_device *device)
295 kfree(device->private_data);
298 int snd_tea6330t_update_mixer(struct snd_card *card,
299 struct snd_i2c_bus *bus,
300 int equalizer, int fader)
302 struct snd_i2c_device *device;
303 struct tea6330t *tea;
304 struct snd_kcontrol_new *knew;
305 unsigned int idx;
306 int err = -ENOMEM;
307 u8 default_treble, default_bass;
308 unsigned char bytes[7];
310 tea = kzalloc(sizeof(*tea), GFP_KERNEL);
311 if (tea == NULL)
312 return -ENOMEM;
313 if ((err = snd_i2c_device_create(bus, "TEA6330T", TEA6330T_ADDR, &device)) < 0) {
314 kfree(tea);
315 return err;
317 tea->device = device;
318 tea->bus = bus;
319 tea->equalizer = equalizer;
320 tea->fader = fader;
321 device->private_data = tea;
322 device->private_free = snd_tea6330_free;
324 snd_i2c_lock(bus);
326 /* turn fader off and handle equalizer */
327 tea->regs[TEA6330T_SADDR_FADER] = 0x3f;
328 tea->regs[TEA6330T_SADDR_AUDIO_SWITCH] = equalizer ? 0 : TEA6330T_EQN;
329 /* initialize mixer */
330 if (!tea->equalizer) {
331 tea->max_bass = 9;
332 tea->max_treble = 8;
333 default_bass = 3 + 4;
334 tea->bass = 4;
335 default_treble = 3 + 4;
336 tea->treble = 4;
337 } else {
338 tea->max_bass = 5;
339 tea->max_treble = 0;
340 default_bass = 7 + 4;
341 tea->bass = 4;
342 default_treble = 3;
343 tea->treble = 0;
345 tea->mleft = tea->mright = 0x14;
346 tea->regs[TEA6330T_SADDR_BASS] = default_bass;
347 tea->regs[TEA6330T_SADDR_TREBLE] = default_treble;
349 /* compose I2C message and put the hardware to initial state */
350 bytes[0] = TEA6330T_SADDR_VOLUME_LEFT;
351 for (idx = 0; idx < 6; idx++)
352 bytes[idx+1] = tea->regs[idx];
353 if ((err = snd_i2c_sendbytes(device, bytes, 7)) < 0)
354 goto __error;
356 strcat(card->mixername, ",TEA6330T");
357 if ((err = snd_component_add(card, "TEA6330T")) < 0)
358 goto __error;
360 for (idx = 0; idx < ARRAY_SIZE(snd_tea6330t_controls); idx++) {
361 knew = &snd_tea6330t_controls[idx];
362 if (tea->treble == 0 && !strcmp(knew->name, "Tone Control - Treble"))
363 continue;
364 if ((err = snd_ctl_add(card, snd_ctl_new1(knew, tea))) < 0)
365 goto __error;
368 snd_i2c_unlock(bus);
369 return 0;
371 __error:
372 snd_i2c_unlock(bus);
373 snd_i2c_device_free(device);
374 return err;
377 EXPORT_SYMBOL(snd_tea6330t_detect);
378 EXPORT_SYMBOL(snd_tea6330t_update_mixer);
381 * INIT part
384 static int __init alsa_tea6330t_init(void)
386 return 0;
389 static void __exit alsa_tea6330t_exit(void)
393 module_init(alsa_tea6330t_init)
394 module_exit(alsa_tea6330t_exit)