1 #include <linux/module.h>
2 #include <linux/kernel.h>
3 #include <linux/init.h>
4 #include "ac97.h"
5
6 /* Flag for mono controls. */
7 #define MO 0
8 /* And for stereo. */
9 #define ST 1
10
11 /* Whether or not the bits in the channel are inverted. */
12 #define INV 1
13 #define NINV 0
14
15 static struct ac97_chn_desc {
16 int ac97_regnum;
17 int oss_channel;
18 int maxval;
19 int is_stereo;
20 int oss_mask;
21 int recordNum;
22 u16 regmask;
23 int is_inverted;
24 } mixerRegs[] = {
25 { AC97_MASTER_VOL_STEREO, SOUND_MIXER_VOLUME, 0x3f, ST, SOUND_MASK_VOLUME, 5, 0x0000, INV },
26 { AC97_MASTER_VOL_MONO, SOUND_MIXER_PHONEOUT, 0x3f, MO, SOUND_MASK_PHONEOUT, 6, 0x0000, INV },
27 { AC97_MASTER_TONE, SOUND_MIXER_TREBLE, 0x0f, MO, SOUND_MASK_TREBLE, -1, 0x00ff, INV },
28 { AC97_MASTER_TONE, SOUND_MIXER_BASS, 0x0f, MO, SOUND_MASK_BASS, -1, 0xff00, INV },
29 { AC97_PCBEEP_VOL, SOUND_MIXER_SPEAKER, 0x0f, MO, SOUND_MASK_SPEAKER, -1, 0x001e, INV },
30 { AC97_PHONE_VOL, SOUND_MIXER_PHONEIN, 0x1f, MO, SOUND_MASK_PHONEIN, 7, 0x0000, INV },
31 { AC97_MIC_VOL, SOUND_MIXER_MIC, 0x1f, MO, SOUND_MASK_MIC, 0, 0x0000, INV },
32 { AC97_LINEIN_VOL, SOUND_MIXER_LINE, 0x1f, ST, SOUND_MASK_LINE, 4, 0x0000, INV },
33 { AC97_CD_VOL, SOUND_MIXER_CD, 0x1f, ST, SOUND_MASK_CD, 1, 0x0000, INV },
34 { AC97_VIDEO_VOL, SOUND_MIXER_VIDEO, 0x1f, ST, SOUND_MASK_VIDEO, 2, 0x0000, INV },
35 { AC97_AUX_VOL, SOUND_MIXER_LINE1, 0x1f, ST, SOUND_MASK_LINE1, 3, 0x0000, INV },
36 { AC97_PCMOUT_VOL, SOUND_MIXER_PCM, 0x1f, ST, SOUND_MASK_PCM, -1, 0x0000, INV },
37 { AC97_RECORD_GAIN, SOUND_MIXER_IGAIN, 0x0f, ST, SOUND_MASK_IGAIN, -1, 0x0000, NINV },
38 { -1, -1, 0xff, 0, 0, -1, 0x0000, 0 },
39 };
40
41 static struct ac97_chn_desc *
ac97_find_chndesc(struct ac97_hwint * dev,int oss_channel)42 ac97_find_chndesc (struct ac97_hwint *dev, int oss_channel)
43 {
44 int x;
45
46 for (x = 0; mixerRegs[x].oss_channel != -1; x++) {
47 if (mixerRegs[x].oss_channel == oss_channel)
48 return mixerRegs + x;
49 }
50
51 return NULL;
52 }
53
54 static inline int
ac97_is_valid_channel(struct ac97_hwint * dev,struct ac97_chn_desc * chn)55 ac97_is_valid_channel (struct ac97_hwint *dev, struct ac97_chn_desc *chn)
56 {
57 return (dev->last_written_mixer_values[chn->ac97_regnum / 2]
58 != AC97_REG_UNSUPPORTED);
59 }
60
61 int
ac97_init(struct ac97_hwint * dev)62 ac97_init (struct ac97_hwint *dev)
63 {
64 int x;
65 int reg0;
66
67 /* Clear out the arrays of cached values. */
68 for (x = 0; x < AC97_REG_CNT; x++)
69 dev->last_written_mixer_values[x] = AC97_REGVAL_UNKNOWN;
70
71 for (x = 0; x < SOUND_MIXER_NRDEVICES; x++)
72 dev->last_written_OSS_values[x] = AC97_REGVAL_UNKNOWN;
73
74 /* Clear the device masks. */
75 dev->mixer_devmask = 0;
76 dev->mixer_stereomask = 0;
77 dev->mixer_recmask = 0;
78
79 /* ??? Do a "standard reset" via register 0? */
80
81 /* Hardware-dependent reset. */
82 if (dev->reset_device (dev))
83 return -1;
84
85 /* Check the mixer device capabilities. */
86 reg0 = dev->read_reg (dev, AC97_RESET);
87
88 if (reg0 < 0)
89 return -1;
90
91 /* Check for support for treble/bass controls. */
92 if (! (reg0 & 4)) {
93 dev->last_written_mixer_values[AC97_MASTER_TONE / 2]
94 = AC97_REG_UNSUPPORTED;
95 }
96
97 /* ??? There may be other tests here? */
98
99 /* Fill in the device masks. */
100 for (x = 0; mixerRegs[x].ac97_regnum != -1; x++) {
101 if (ac97_is_valid_channel (dev, mixerRegs + x)) {
102 dev->mixer_devmask |= mixerRegs[x].oss_mask;
103
104 if (mixerRegs[x].is_stereo)
105 dev->mixer_stereomask |= mixerRegs[x].oss_mask;
106
107 if (mixerRegs[x].recordNum != -1)
108 dev->mixer_recmask |= mixerRegs[x].oss_mask;
109 }
110 }
111
112 return 0;
113 }
114
115 /* Reset the mixer to the currently saved settings. */
116 int
ac97_reset(struct ac97_hwint * dev)117 ac97_reset (struct ac97_hwint *dev)
118 {
119 int x;
120
121 if (dev->reset_device (dev))
122 return -1;
123
124 /* Now set the registers back to their last-written values. */
125 for (x = 0; mixerRegs[x].ac97_regnum != -1; x++) {
126 int regnum = mixerRegs[x].ac97_regnum;
127 int value = dev->last_written_mixer_values [regnum / 2];
128 if (value >= 0)
129 ac97_put_register (dev, regnum, value);
130 }
131 return 0;
132 }
133
134 /* Return the contents of register REG; use the cache if the value in it
135 is valid. Returns a negative error code on failure. */
136 int
ac97_get_register(struct ac97_hwint * dev,u8 reg)137 ac97_get_register (struct ac97_hwint *dev, u8 reg)
138 {
139 if (reg > 127 || (reg & 1))
140 return -EINVAL;
141
142 /* See if it's in the cache, or if it's just plain invalid. */
143 switch (dev->last_written_mixer_values[reg / 2]) {
144 case AC97_REG_UNSUPPORTED:
145 return -EINVAL;
146 break;
147 case AC97_REGVAL_UNKNOWN:
148 dev->last_written_mixer_values[reg / 2] = dev->read_reg (dev, reg);
149 break;
150 default:
151 break;
152 }
153 return dev->last_written_mixer_values[reg / 2];
154 }
155
156 /* Write VALUE to AC97 register REG, and cache its value in the last-written
157 cache. Returns a negative error code on failure, or 0 on success. */
158 int
ac97_put_register(struct ac97_hwint * dev,u8 reg,u16 value)159 ac97_put_register (struct ac97_hwint *dev, u8 reg, u16 value)
160 {
161 if (reg > 127 || (reg & 1))
162 return -EINVAL;
163
164 if (dev->last_written_mixer_values[reg / 2] == AC97_REG_UNSUPPORTED)
165 return -EINVAL;
166 else {
167 int res = dev->write_reg (dev, reg, value);
168 if (res >= 0) {
169 dev->last_written_mixer_values[reg / 2] = value;
170 return 0;
171 }
172 else
173 return res;
174 }
175 }
176
177 /* Scale VALUE (a value fro 0 to MAXVAL) to a value from 0-100. If
178 IS_STEREO is set, VALUE is a stereo value; the left channel value
179 is in the lower 8 bits, and the right channel value is in the upper
180 8 bits.
181
182 A negative error code is returned on failure, or the unsigned
183 scaled value on success. */
184
185 static int
ac97_scale_to_oss_val(int value,int maxval,int is_stereo,int inv)186 ac97_scale_to_oss_val (int value, int maxval, int is_stereo, int inv)
187 {
188 /* Muted? */
189 if (value & AC97_MUTE)
190 return 0;
191
192 if (is_stereo)
193 return (ac97_scale_to_oss_val (value & 255, maxval, 0, inv) << 8)
194 | (ac97_scale_to_oss_val ((value >> 8) & 255, maxval, 0, inv) << 0);
195 else {
196 int i;
197
198 /* Inverted. */
199 if (inv)
200 value = maxval - value;
201
202 i = (value * 100 + (maxval / 2)) / maxval;
203 if (i > 100)
204 i = 100;
205 if (i < 0)
206 i = 0;
207 return i;
208 }
209 }
210
211 static int
ac97_scale_from_oss_val(int value,int maxval,int is_stereo,int inv)212 ac97_scale_from_oss_val (int value, int maxval, int is_stereo, int inv)
213 {
214 if (is_stereo)
215 return (ac97_scale_from_oss_val (value & 255, maxval, 0, inv) << 8)
216 | (ac97_scale_from_oss_val ((value >> 8) & 255, maxval, 0, inv) << 0);
217 else {
218 int i = ((value & 255) * maxval + 50) / 100;
219 if (inv)
220 i = maxval - i;
221 if (i < 0)
222 i = 0;
223 if (i > maxval)
224 i = maxval;
225 return i;
226 }
227 }
228
229 int
ac97_set_mixer(struct ac97_hwint * dev,int oss_channel,u16 oss_value)230 ac97_set_mixer (struct ac97_hwint *dev, int oss_channel, u16 oss_value)
231 {
232 int scaled_value;
233 struct ac97_chn_desc *channel = ac97_find_chndesc (dev, oss_channel);
234 int result;
235
236 if (channel == NULL)
237 return -ENODEV;
238 if (! ac97_is_valid_channel (dev, channel))
239 return -ENODEV;
240 scaled_value = ac97_scale_from_oss_val (oss_value, channel->maxval,
241 channel->is_stereo,
242 channel->is_inverted);
243 if (scaled_value < 0)
244 return scaled_value;
245
246 if (channel->regmask != 0) {
247 int mv;
248
249 int oldval = ac97_get_register (dev, channel->ac97_regnum);
250 if (oldval < 0)
251 return oldval;
252
253 for (mv = channel->regmask; ! (mv & 1); mv >>= 1)
254 scaled_value <<= 1;
255
256 scaled_value &= channel->regmask;
257 scaled_value |= (oldval & ~channel->regmask);
258 }
259 result = ac97_put_register (dev, channel->ac97_regnum, scaled_value);
260 if (result == 0)
261 dev->last_written_OSS_values[oss_channel] = oss_value;
262 return result;
263 }
264
265 int
ac97_get_mixer_scaled(struct ac97_hwint * dev,int oss_channel)266 ac97_get_mixer_scaled (struct ac97_hwint *dev, int oss_channel)
267 {
268 struct ac97_chn_desc *channel = ac97_find_chndesc (dev, oss_channel);
269 int regval;
270
271 if (channel == NULL)
272 return -ENODEV;
273
274 if (! ac97_is_valid_channel (dev, channel))
275 return -ENODEV;
276
277 regval = ac97_get_register (dev, channel->ac97_regnum);
278
279 if (regval < 0)
280 return regval;
281
282 if (channel->regmask != 0) {
283 int mv;
284
285 regval &= channel->regmask;
286
287 for (mv = channel->regmask; ! (mv & 1); mv >>= 1)
288 regval >>= 1;
289 }
290 return ac97_scale_to_oss_val (regval, channel->maxval,
291 channel->is_stereo,
292 channel->is_inverted);
293 }
294
295 int
ac97_get_recmask(struct ac97_hwint * dev)296 ac97_get_recmask (struct ac97_hwint *dev)
297 {
298 int recReg = ac97_get_register (dev, AC97_RECORD_SELECT);
299
300 if (recReg < 0)
301 return recReg;
302 else {
303 int x;
304 for (x = 0; mixerRegs[x].ac97_regnum >= 0; x++) {
305 if (mixerRegs[x].recordNum == (recReg & 7))
306 return mixerRegs[x].oss_mask;
307 }
308 return -ENODEV;
309 }
310 }
311
312 int
ac97_set_recmask(struct ac97_hwint * dev,int oss_recmask)313 ac97_set_recmask (struct ac97_hwint *dev, int oss_recmask)
314 {
315 int x;
316
317 if (oss_recmask == 0)
318 oss_recmask = SOUND_MIXER_MIC;
319
320 for (x = 0; mixerRegs[x].ac97_regnum >= 0; x++) {
321 if ((mixerRegs[x].recordNum >= 0)
322 && (oss_recmask & mixerRegs[x].oss_mask))
323 break;
324 }
325 if (mixerRegs[x].ac97_regnum < 0)
326 return -ENODEV;
327 else {
328 int regval = (mixerRegs[x].recordNum << 8) | mixerRegs[x].recordNum;
329 int res = ac97_put_register (dev, AC97_RECORD_SELECT, regval);
330 if (res == 0)
331 return ac97_get_recmask (dev);
332 else
333 return res;
334 }
335 }
336
337 /* Set the mixer DEV to the list of values in VALUE_LIST. Return 0 on
338 success, or a negative error code. */
339 int
ac97_set_values(struct ac97_hwint * dev,struct ac97_mixer_value_list * value_list)340 ac97_set_values (struct ac97_hwint *dev,
341 struct ac97_mixer_value_list *value_list)
342 {
343 int x;
344
345 for (x = 0; value_list[x].oss_channel != -1; x++) {
346 int chnum = value_list[x].oss_channel;
347 struct ac97_chn_desc *chent = ac97_find_chndesc (dev, chnum);
348 if (chent != NULL) {
349 u16 val;
350 int res;
351
352 if (chent->is_stereo)
353 val = (value_list[x].value.stereo.right << 8)
354 | value_list[x].value.stereo.left;
355 else {
356 /* We do this so the returned value looks OK in the
357 mixer app. It's not necessary otherwise. */
358 val = (value_list[x].value.mono << 8)
359 | value_list[x].value.mono;
360 }
361 res = ac97_set_mixer (dev, chnum, val);
362 if (res < 0)
363 return res;
364 }
365 else
366 return -ENODEV;
367 }
368 return 0;
369 }
370
371 int
ac97_mixer_ioctl(struct ac97_hwint * dev,unsigned int cmd,caddr_t arg)372 ac97_mixer_ioctl (struct ac97_hwint *dev, unsigned int cmd, caddr_t arg)
373 {
374 int ret;
375
376 switch (cmd) {
377 case SOUND_MIXER_READ_RECSRC:
378 ret = ac97_get_recmask (dev);
379 break;
380
381 case SOUND_MIXER_WRITE_RECSRC:
382 {
383 if (get_user (ret, (int *) arg))
384 ret = -EFAULT;
385 else
386 ret = ac97_set_recmask (dev, ret);
387 }
388 break;
389
390 case SOUND_MIXER_READ_CAPS:
391 ret = SOUND_CAP_EXCL_INPUT;
392 break;
393
394 case SOUND_MIXER_READ_DEVMASK:
395 ret = dev->mixer_devmask;
396 break;
397
398 case SOUND_MIXER_READ_RECMASK:
399 ret = dev->mixer_recmask;
400 break;
401
402 case SOUND_MIXER_READ_STEREODEVS:
403 ret = dev->mixer_stereomask;
404 break;
405
406 default:
407 /* Read or write request. */
408 ret = -EINVAL;
409 if (_IOC_TYPE (cmd) == 'M') {
410 int dir = _SIOC_DIR (cmd);
411 int channel = _IOC_NR (cmd);
412
413 if (channel >= 0 && channel < SOUND_MIXER_NRDEVICES) {
414 ret = 0;
415 if (dir & _SIOC_WRITE) {
416 int val;
417 if (get_user (val, (int *) arg) == 0)
418 ret = ac97_set_mixer (dev, channel, val);
419 else
420 ret = -EFAULT;
421 }
422 if (ret >= 0 && (dir & _SIOC_READ)) {
423 if (dev->last_written_OSS_values[channel]
424 == AC97_REGVAL_UNKNOWN)
425 dev->last_written_OSS_values[channel]
426 = ac97_get_mixer_scaled (dev, channel);
427 ret = dev->last_written_OSS_values[channel];
428 }
429 }
430 }
431 break;
432 }
433
434 if (ret < 0)
435 return ret;
436 else
437 return put_user(ret, (int *) arg);
438 }
439
440 EXPORT_SYMBOL(ac97_init);
441 EXPORT_SYMBOL(ac97_set_values);
442 EXPORT_SYMBOL(ac97_set_mixer);
443 EXPORT_SYMBOL(ac97_get_register);
444 EXPORT_SYMBOL(ac97_put_register);
445 EXPORT_SYMBOL(ac97_get_mixer_scaled);
446 EXPORT_SYMBOL(ac97_mixer_ioctl);
447 EXPORT_SYMBOL(ac97_reset);
448 MODULE_LICENSE("GPL");
449
450
451 /*
452 * Local variables:
453 * c-basic-offset: 4
454 * End:
455 */
456