This source file includes following definitions.
- snd_tea6330t_detect
- snd_tea6330t_set
- snd_tea6330t_info_master_volume
- snd_tea6330t_get_master_volume
- snd_tea6330t_put_master_volume
- snd_tea6330t_get_master_switch
- snd_tea6330t_put_master_switch
- snd_tea6330t_info_bass
- snd_tea6330t_get_bass
- snd_tea6330t_put_bass
- snd_tea6330t_info_treble
- snd_tea6330t_get_treble
- snd_tea6330t_put_treble
- snd_tea6330_free
- snd_tea6330t_update_mixer
1
2
3
4
5
6
7
8 #include <linux/init.h>
9 #include <linux/slab.h>
10 #include <linux/module.h>
11 #include <sound/core.h>
12 #include <sound/control.h>
13 #include <sound/tea6330t.h>
14
15 MODULE_AUTHOR("Jaroslav Kysela <perex@perex.cz>");
16 MODULE_DESCRIPTION("Routines for control of the TEA6330T circuit via i2c bus");
17 MODULE_LICENSE("GPL");
18
19 #define TEA6330T_ADDR (0x80>>1)
20
21 #define TEA6330T_SADDR_VOLUME_LEFT 0x00
22 #define TEA6330T_SADDR_VOLUME_RIGHT 0x01
23 #define TEA6330T_SADDR_BASS 0x02
24 #define TEA6330T_SADDR_TREBLE 0x03
25 #define TEA6330T_SADDR_FADER 0x04
26 #define TEA6330T_MFN 0x20
27 #define TEA6330T_FCH 0x10
28 #define TEA6330T_SADDR_AUDIO_SWITCH 0x05
29 #define TEA6330T_GMU 0x80
30 #define TEA6330T_EQN 0x40
31
32
33 struct tea6330t {
34 struct snd_i2c_device *device;
35 struct snd_i2c_bus *bus;
36 int equalizer;
37 int fader;
38 unsigned char regs[8];
39 unsigned char mleft, mright;
40 unsigned char bass, treble;
41 unsigned char max_bass, max_treble;
42 };
43
44
45 int snd_tea6330t_detect(struct snd_i2c_bus *bus, int equalizer)
46 {
47 int res;
48
49 snd_i2c_lock(bus);
50 res = snd_i2c_probeaddr(bus, TEA6330T_ADDR);
51 snd_i2c_unlock(bus);
52 return res;
53 }
54
55 #if 0
56 static void snd_tea6330t_set(struct tea6330t *tea,
57 unsigned char addr, unsigned char value)
58 {
59 #if 0
60 printk(KERN_DEBUG "set - 0x%x/0x%x\n", addr, value);
61 #endif
62 snd_i2c_write(tea->bus, TEA6330T_ADDR, addr, value, 1);
63 }
64 #endif
65
66 #define TEA6330T_MASTER_VOLUME(xname, xindex) \
67 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
68 .info = snd_tea6330t_info_master_volume, \
69 .get = snd_tea6330t_get_master_volume, .put = snd_tea6330t_put_master_volume }
70
71 static int snd_tea6330t_info_master_volume(struct snd_kcontrol *kcontrol,
72 struct snd_ctl_elem_info *uinfo)
73 {
74 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
75 uinfo->count = 2;
76 uinfo->value.integer.min = 0;
77 uinfo->value.integer.max = 43;
78 return 0;
79 }
80
81 static int snd_tea6330t_get_master_volume(struct snd_kcontrol *kcontrol,
82 struct snd_ctl_elem_value *ucontrol)
83 {
84 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
85
86 snd_i2c_lock(tea->bus);
87 ucontrol->value.integer.value[0] = tea->mleft - 0x14;
88 ucontrol->value.integer.value[1] = tea->mright - 0x14;
89 snd_i2c_unlock(tea->bus);
90 return 0;
91 }
92
93 static int snd_tea6330t_put_master_volume(struct snd_kcontrol *kcontrol,
94 struct snd_ctl_elem_value *ucontrol)
95 {
96 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
97 int change, count, err;
98 unsigned char bytes[3];
99 unsigned char val1, val2;
100
101 val1 = (ucontrol->value.integer.value[0] % 44) + 0x14;
102 val2 = (ucontrol->value.integer.value[1] % 44) + 0x14;
103 snd_i2c_lock(tea->bus);
104 change = val1 != tea->mleft || val2 != tea->mright;
105 tea->mleft = val1;
106 tea->mright = val2;
107 count = 0;
108 if (tea->regs[TEA6330T_SADDR_VOLUME_LEFT] != 0) {
109 bytes[count++] = TEA6330T_SADDR_VOLUME_LEFT;
110 bytes[count++] = tea->regs[TEA6330T_SADDR_VOLUME_LEFT] = tea->mleft;
111 }
112 if (tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] != 0) {
113 if (count == 0)
114 bytes[count++] = TEA6330T_SADDR_VOLUME_RIGHT;
115 bytes[count++] = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] = tea->mright;
116 }
117 if (count > 0) {
118 if ((err = snd_i2c_sendbytes(tea->device, bytes, count)) < 0)
119 change = err;
120 }
121 snd_i2c_unlock(tea->bus);
122 return change;
123 }
124
125 #define TEA6330T_MASTER_SWITCH(xname, xindex) \
126 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
127 .info = snd_tea6330t_info_master_switch, \
128 .get = snd_tea6330t_get_master_switch, .put = snd_tea6330t_put_master_switch }
129
130 #define snd_tea6330t_info_master_switch snd_ctl_boolean_stereo_info
131
132 static int snd_tea6330t_get_master_switch(struct snd_kcontrol *kcontrol,
133 struct snd_ctl_elem_value *ucontrol)
134 {
135 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
136
137 snd_i2c_lock(tea->bus);
138 ucontrol->value.integer.value[0] = tea->regs[TEA6330T_SADDR_VOLUME_LEFT] == 0 ? 0 : 1;
139 ucontrol->value.integer.value[1] = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] == 0 ? 0 : 1;
140 snd_i2c_unlock(tea->bus);
141 return 0;
142 }
143
144 static int snd_tea6330t_put_master_switch(struct snd_kcontrol *kcontrol,
145 struct snd_ctl_elem_value *ucontrol)
146 {
147 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
148 int change, err;
149 unsigned char bytes[3];
150 unsigned char oval1, oval2, val1, val2;
151
152 val1 = ucontrol->value.integer.value[0] & 1;
153 val2 = ucontrol->value.integer.value[1] & 1;
154 snd_i2c_lock(tea->bus);
155 oval1 = tea->regs[TEA6330T_SADDR_VOLUME_LEFT] == 0 ? 0 : 1;
156 oval2 = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] == 0 ? 0 : 1;
157 change = val1 != oval1 || val2 != oval2;
158 tea->regs[TEA6330T_SADDR_VOLUME_LEFT] = val1 ? tea->mleft : 0;
159 tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] = val2 ? tea->mright : 0;
160 bytes[0] = TEA6330T_SADDR_VOLUME_LEFT;
161 bytes[1] = tea->regs[TEA6330T_SADDR_VOLUME_LEFT];
162 bytes[2] = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT];
163 if ((err = snd_i2c_sendbytes(tea->device, bytes, 3)) < 0)
164 change = err;
165 snd_i2c_unlock(tea->bus);
166 return change;
167 }
168
169 #define TEA6330T_BASS(xname, xindex) \
170 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
171 .info = snd_tea6330t_info_bass, \
172 .get = snd_tea6330t_get_bass, .put = snd_tea6330t_put_bass }
173
174 static int snd_tea6330t_info_bass(struct snd_kcontrol *kcontrol,
175 struct snd_ctl_elem_info *uinfo)
176 {
177 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
178
179 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
180 uinfo->count = 1;
181 uinfo->value.integer.min = 0;
182 uinfo->value.integer.max = tea->max_bass;
183 return 0;
184 }
185
186 static int snd_tea6330t_get_bass(struct snd_kcontrol *kcontrol,
187 struct snd_ctl_elem_value *ucontrol)
188 {
189 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
190
191 ucontrol->value.integer.value[0] = tea->bass;
192 return 0;
193 }
194
195 static int snd_tea6330t_put_bass(struct snd_kcontrol *kcontrol,
196 struct snd_ctl_elem_value *ucontrol)
197 {
198 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
199 int change, err;
200 unsigned char bytes[2];
201 unsigned char val1;
202
203 val1 = ucontrol->value.integer.value[0] % (tea->max_bass + 1);
204 snd_i2c_lock(tea->bus);
205 tea->bass = val1;
206 val1 += tea->equalizer ? 7 : 3;
207 change = tea->regs[TEA6330T_SADDR_BASS] != val1;
208 bytes[0] = TEA6330T_SADDR_BASS;
209 bytes[1] = tea->regs[TEA6330T_SADDR_BASS] = val1;
210 if ((err = snd_i2c_sendbytes(tea->device, bytes, 2)) < 0)
211 change = err;
212 snd_i2c_unlock(tea->bus);
213 return change;
214 }
215
216 #define TEA6330T_TREBLE(xname, xindex) \
217 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
218 .info = snd_tea6330t_info_treble, \
219 .get = snd_tea6330t_get_treble, .put = snd_tea6330t_put_treble }
220
221 static int snd_tea6330t_info_treble(struct snd_kcontrol *kcontrol,
222 struct snd_ctl_elem_info *uinfo)
223 {
224 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
225
226 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
227 uinfo->count = 1;
228 uinfo->value.integer.min = 0;
229 uinfo->value.integer.max = tea->max_treble;
230 return 0;
231 }
232
233 static int snd_tea6330t_get_treble(struct snd_kcontrol *kcontrol,
234 struct snd_ctl_elem_value *ucontrol)
235 {
236 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
237
238 ucontrol->value.integer.value[0] = tea->treble;
239 return 0;
240 }
241
242 static int snd_tea6330t_put_treble(struct snd_kcontrol *kcontrol,
243 struct snd_ctl_elem_value *ucontrol)
244 {
245 struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
246 int change, err;
247 unsigned char bytes[2];
248 unsigned char val1;
249
250 val1 = ucontrol->value.integer.value[0] % (tea->max_treble + 1);
251 snd_i2c_lock(tea->bus);
252 tea->treble = val1;
253 val1 += 3;
254 change = tea->regs[TEA6330T_SADDR_TREBLE] != val1;
255 bytes[0] = TEA6330T_SADDR_TREBLE;
256 bytes[1] = tea->regs[TEA6330T_SADDR_TREBLE] = val1;
257 if ((err = snd_i2c_sendbytes(tea->device, bytes, 2)) < 0)
258 change = err;
259 snd_i2c_unlock(tea->bus);
260 return change;
261 }
262
263 static struct snd_kcontrol_new snd_tea6330t_controls[] = {
264 TEA6330T_MASTER_SWITCH("Master Playback Switch", 0),
265 TEA6330T_MASTER_VOLUME("Master Playback Volume", 0),
266 TEA6330T_BASS("Tone Control - Bass", 0),
267 TEA6330T_TREBLE("Tone Control - Treble", 0)
268 };
269
270 static void snd_tea6330_free(struct snd_i2c_device *device)
271 {
272 kfree(device->private_data);
273 }
274
275 int snd_tea6330t_update_mixer(struct snd_card *card,
276 struct snd_i2c_bus *bus,
277 int equalizer, int fader)
278 {
279 struct snd_i2c_device *device;
280 struct tea6330t *tea;
281 struct snd_kcontrol_new *knew;
282 unsigned int idx;
283 int err = -ENOMEM;
284 u8 default_treble, default_bass;
285 unsigned char bytes[7];
286
287 tea = kzalloc(sizeof(*tea), GFP_KERNEL);
288 if (tea == NULL)
289 return -ENOMEM;
290 if ((err = snd_i2c_device_create(bus, "TEA6330T", TEA6330T_ADDR, &device)) < 0) {
291 kfree(tea);
292 return err;
293 }
294 tea->device = device;
295 tea->bus = bus;
296 tea->equalizer = equalizer;
297 tea->fader = fader;
298 device->private_data = tea;
299 device->private_free = snd_tea6330_free;
300
301 snd_i2c_lock(bus);
302
303
304 tea->regs[TEA6330T_SADDR_FADER] = 0x3f;
305 tea->regs[TEA6330T_SADDR_AUDIO_SWITCH] = equalizer ? 0 : TEA6330T_EQN;
306
307 if (!tea->equalizer) {
308 tea->max_bass = 9;
309 tea->max_treble = 8;
310 default_bass = 3 + 4;
311 tea->bass = 4;
312 default_treble = 3 + 4;
313 tea->treble = 4;
314 } else {
315 tea->max_bass = 5;
316 tea->max_treble = 0;
317 default_bass = 7 + 4;
318 tea->bass = 4;
319 default_treble = 3;
320 tea->treble = 0;
321 }
322 tea->mleft = tea->mright = 0x14;
323 tea->regs[TEA6330T_SADDR_BASS] = default_bass;
324 tea->regs[TEA6330T_SADDR_TREBLE] = default_treble;
325
326
327 bytes[0] = TEA6330T_SADDR_VOLUME_LEFT;
328 for (idx = 0; idx < 6; idx++)
329 bytes[idx+1] = tea->regs[idx];
330 if ((err = snd_i2c_sendbytes(device, bytes, 7)) < 0)
331 goto __error;
332
333 strcat(card->mixername, ",TEA6330T");
334 if ((err = snd_component_add(card, "TEA6330T")) < 0)
335 goto __error;
336
337 for (idx = 0; idx < ARRAY_SIZE(snd_tea6330t_controls); idx++) {
338 knew = &snd_tea6330t_controls[idx];
339 if (tea->treble == 0 && !strcmp(knew->name, "Tone Control - Treble"))
340 continue;
341 if ((err = snd_ctl_add(card, snd_ctl_new1(knew, tea))) < 0)
342 goto __error;
343 }
344
345 snd_i2c_unlock(bus);
346 return 0;
347
348 __error:
349 snd_i2c_unlock(bus);
350 snd_i2c_device_free(device);
351 return err;
352 }
353
354 EXPORT_SYMBOL(snd_tea6330t_detect);
355 EXPORT_SYMBOL(snd_tea6330t_update_mixer);