1 | // SPDX-License-Identifier: GPL-2.0-or-later |
2 | /* |
3 | * Copyright (c) 1999 by Uros Bizjak <uros@kss-loka.si> |
4 | * Takashi Iwai <tiwai@suse.de> |
5 | * |
6 | * SB16ASP/AWE32 CSP control |
7 | * |
8 | * CSP microcode loader: |
9 | * alsa-tools/sb16_csp/ |
10 | */ |
11 | |
12 | #include <linux/delay.h> |
13 | #include <linux/init.h> |
14 | #include <linux/slab.h> |
15 | #include <linux/module.h> |
16 | #include <sound/core.h> |
17 | #include <sound/control.h> |
18 | #include <sound/info.h> |
19 | #include <sound/sb16_csp.h> |
20 | #include <sound/initval.h> |
21 | |
22 | MODULE_AUTHOR("Uros Bizjak <uros@kss-loka.si>" ); |
23 | MODULE_DESCRIPTION("ALSA driver for SB16 Creative Signal Processor" ); |
24 | MODULE_LICENSE("GPL" ); |
25 | MODULE_FIRMWARE("sb16/mulaw_main.csp" ); |
26 | MODULE_FIRMWARE("sb16/alaw_main.csp" ); |
27 | MODULE_FIRMWARE("sb16/ima_adpcm_init.csp" ); |
28 | MODULE_FIRMWARE("sb16/ima_adpcm_playback.csp" ); |
29 | MODULE_FIRMWARE("sb16/ima_adpcm_capture.csp" ); |
30 | |
31 | #ifdef SNDRV_LITTLE_ENDIAN |
32 | #define CSP_HDR_VALUE(a,b,c,d) ((a) | ((b)<<8) | ((c)<<16) | ((d)<<24)) |
33 | #else |
34 | #define CSP_HDR_VALUE(a,b,c,d) ((d) | ((c)<<8) | ((b)<<16) | ((a)<<24)) |
35 | #endif |
36 | |
37 | #define CSP_HDR_VALUE('R', 'I', 'F', 'F') |
38 | #define CSP_HDR_VALUE('C', 'S', 'P', ' ') |
39 | #define CSP_HDR_VALUE('L', 'I', 'S', 'T') |
40 | #define CSP_HDR_VALUE('f', 'u', 'n', 'c') |
41 | #define CSP_HDR_VALUE('c', 'o', 'd', 'e') |
42 | #define CSP_HDR_VALUE('i', 'n', 'i', 't') |
43 | #define MAIN_HEADER CSP_HDR_VALUE('m', 'a', 'i', 'n') |
44 | |
45 | /* |
46 | * RIFF data format |
47 | */ |
48 | struct { |
49 | __le32 ; |
50 | __le32 ; |
51 | }; |
52 | |
53 | struct { |
54 | struct riff_header ; |
55 | __le16 ; |
56 | __le16 ; |
57 | __le16 ; |
58 | __le16 ; |
59 | __le16 ; |
60 | __le16 ; |
61 | }; |
62 | |
63 | /* |
64 | * prototypes |
65 | */ |
66 | static void snd_sb_csp_free(struct snd_hwdep *hw); |
67 | static int snd_sb_csp_open(struct snd_hwdep * hw, struct file *file); |
68 | static int snd_sb_csp_ioctl(struct snd_hwdep * hw, struct file *file, unsigned int cmd, unsigned long arg); |
69 | static int snd_sb_csp_release(struct snd_hwdep * hw, struct file *file); |
70 | |
71 | static int csp_detect(struct snd_sb *chip, int *version); |
72 | static int set_codec_parameter(struct snd_sb *chip, unsigned char par, unsigned char val); |
73 | static int set_register(struct snd_sb *chip, unsigned char reg, unsigned char val); |
74 | static int read_register(struct snd_sb *chip, unsigned char reg); |
75 | static int set_mode_register(struct snd_sb *chip, unsigned char mode); |
76 | static int get_version(struct snd_sb *chip); |
77 | |
78 | static int snd_sb_csp_riff_load(struct snd_sb_csp * p, |
79 | struct snd_sb_csp_microcode __user * code); |
80 | static int snd_sb_csp_unload(struct snd_sb_csp * p); |
81 | static int snd_sb_csp_load_user(struct snd_sb_csp * p, const unsigned char __user *buf, int size, int load_flags); |
82 | static int snd_sb_csp_autoload(struct snd_sb_csp * p, snd_pcm_format_t pcm_sfmt, int play_rec_mode); |
83 | static int snd_sb_csp_check_version(struct snd_sb_csp * p); |
84 | |
85 | static int snd_sb_csp_use(struct snd_sb_csp * p); |
86 | static int snd_sb_csp_unuse(struct snd_sb_csp * p); |
87 | static int snd_sb_csp_start(struct snd_sb_csp * p, int sample_width, int channels); |
88 | static int snd_sb_csp_stop(struct snd_sb_csp * p); |
89 | static int snd_sb_csp_pause(struct snd_sb_csp * p); |
90 | static int snd_sb_csp_restart(struct snd_sb_csp * p); |
91 | |
92 | static int snd_sb_qsound_build(struct snd_sb_csp * p); |
93 | static void snd_sb_qsound_destroy(struct snd_sb_csp * p); |
94 | static int snd_sb_csp_qsound_transfer(struct snd_sb_csp * p); |
95 | |
96 | static int init_proc_entry(struct snd_sb_csp * p, int device); |
97 | static void info_read(struct snd_info_entry *entry, struct snd_info_buffer *buffer); |
98 | |
99 | /* |
100 | * Detect CSP chip and create a new instance |
101 | */ |
102 | int snd_sb_csp_new(struct snd_sb *chip, int device, struct snd_hwdep ** rhwdep) |
103 | { |
104 | struct snd_sb_csp *p; |
105 | int version; |
106 | int err; |
107 | struct snd_hwdep *hw; |
108 | |
109 | if (rhwdep) |
110 | *rhwdep = NULL; |
111 | |
112 | if (csp_detect(chip, version: &version)) |
113 | return -ENODEV; |
114 | |
115 | err = snd_hwdep_new(card: chip->card, id: "SB16-CSP" , device, rhwdep: &hw); |
116 | if (err < 0) |
117 | return err; |
118 | |
119 | p = kzalloc(size: sizeof(*p), GFP_KERNEL); |
120 | if (!p) { |
121 | snd_device_free(card: chip->card, device_data: hw); |
122 | return -ENOMEM; |
123 | } |
124 | p->chip = chip; |
125 | p->version = version; |
126 | |
127 | /* CSP operators */ |
128 | p->ops.csp_use = snd_sb_csp_use; |
129 | p->ops.csp_unuse = snd_sb_csp_unuse; |
130 | p->ops.csp_autoload = snd_sb_csp_autoload; |
131 | p->ops.csp_start = snd_sb_csp_start; |
132 | p->ops.csp_stop = snd_sb_csp_stop; |
133 | p->ops.csp_qsound_transfer = snd_sb_csp_qsound_transfer; |
134 | |
135 | mutex_init(&p->access_mutex); |
136 | sprintf(buf: hw->name, fmt: "CSP v%d.%d" , (version >> 4), (version & 0x0f)); |
137 | hw->iface = SNDRV_HWDEP_IFACE_SB16CSP; |
138 | hw->private_data = p; |
139 | hw->private_free = snd_sb_csp_free; |
140 | |
141 | /* operators - only write/ioctl */ |
142 | hw->ops.open = snd_sb_csp_open; |
143 | hw->ops.ioctl = snd_sb_csp_ioctl; |
144 | hw->ops.release = snd_sb_csp_release; |
145 | |
146 | /* create a proc entry */ |
147 | init_proc_entry(p, device); |
148 | if (rhwdep) |
149 | *rhwdep = hw; |
150 | return 0; |
151 | } |
152 | |
153 | /* |
154 | * free_private for hwdep instance |
155 | */ |
156 | static void snd_sb_csp_free(struct snd_hwdep *hwdep) |
157 | { |
158 | int i; |
159 | struct snd_sb_csp *p = hwdep->private_data; |
160 | if (p) { |
161 | if (p->running & SNDRV_SB_CSP_ST_RUNNING) |
162 | snd_sb_csp_stop(p); |
163 | for (i = 0; i < ARRAY_SIZE(p->csp_programs); ++i) |
164 | release_firmware(fw: p->csp_programs[i]); |
165 | kfree(objp: p); |
166 | } |
167 | } |
168 | |
169 | /* ------------------------------ */ |
170 | |
171 | /* |
172 | * open the device exclusively |
173 | */ |
174 | static int snd_sb_csp_open(struct snd_hwdep * hw, struct file *file) |
175 | { |
176 | struct snd_sb_csp *p = hw->private_data; |
177 | return (snd_sb_csp_use(p)); |
178 | } |
179 | |
180 | /* |
181 | * ioctl for hwdep device: |
182 | */ |
183 | static int snd_sb_csp_ioctl(struct snd_hwdep * hw, struct file *file, unsigned int cmd, unsigned long arg) |
184 | { |
185 | struct snd_sb_csp *p = hw->private_data; |
186 | struct snd_sb_csp_info info; |
187 | struct snd_sb_csp_start start_info; |
188 | int err; |
189 | |
190 | if (snd_BUG_ON(!p)) |
191 | return -EINVAL; |
192 | |
193 | if (snd_sb_csp_check_version(p)) |
194 | return -ENODEV; |
195 | |
196 | switch (cmd) { |
197 | /* get information */ |
198 | case SNDRV_SB_CSP_IOCTL_INFO: |
199 | memset(&info, 0, sizeof(info)); |
200 | *info.codec_name = *p->codec_name; |
201 | info.func_nr = p->func_nr; |
202 | info.acc_format = p->acc_format; |
203 | info.acc_channels = p->acc_channels; |
204 | info.acc_width = p->acc_width; |
205 | info.acc_rates = p->acc_rates; |
206 | info.csp_mode = p->mode; |
207 | info.run_channels = p->run_channels; |
208 | info.run_width = p->run_width; |
209 | info.version = p->version; |
210 | info.state = p->running; |
211 | if (copy_to_user(to: (void __user *)arg, from: &info, n: sizeof(info))) |
212 | err = -EFAULT; |
213 | else |
214 | err = 0; |
215 | break; |
216 | |
217 | /* load CSP microcode */ |
218 | case SNDRV_SB_CSP_IOCTL_LOAD_CODE: |
219 | err = (p->running & SNDRV_SB_CSP_ST_RUNNING ? |
220 | -EBUSY : snd_sb_csp_riff_load(p, code: (struct snd_sb_csp_microcode __user *) arg)); |
221 | break; |
222 | case SNDRV_SB_CSP_IOCTL_UNLOAD_CODE: |
223 | err = (p->running & SNDRV_SB_CSP_ST_RUNNING ? |
224 | -EBUSY : snd_sb_csp_unload(p)); |
225 | break; |
226 | |
227 | /* change CSP running state */ |
228 | case SNDRV_SB_CSP_IOCTL_START: |
229 | if (copy_from_user(to: &start_info, from: (void __user *) arg, n: sizeof(start_info))) |
230 | err = -EFAULT; |
231 | else |
232 | err = snd_sb_csp_start(p, sample_width: start_info.sample_width, channels: start_info.channels); |
233 | break; |
234 | case SNDRV_SB_CSP_IOCTL_STOP: |
235 | err = snd_sb_csp_stop(p); |
236 | break; |
237 | case SNDRV_SB_CSP_IOCTL_PAUSE: |
238 | err = snd_sb_csp_pause(p); |
239 | break; |
240 | case SNDRV_SB_CSP_IOCTL_RESTART: |
241 | err = snd_sb_csp_restart(p); |
242 | break; |
243 | default: |
244 | err = -ENOTTY; |
245 | break; |
246 | } |
247 | |
248 | return err; |
249 | } |
250 | |
251 | /* |
252 | * close the device |
253 | */ |
254 | static int snd_sb_csp_release(struct snd_hwdep * hw, struct file *file) |
255 | { |
256 | struct snd_sb_csp *p = hw->private_data; |
257 | return (snd_sb_csp_unuse(p)); |
258 | } |
259 | |
260 | /* ------------------------------ */ |
261 | |
262 | /* |
263 | * acquire device |
264 | */ |
265 | static int snd_sb_csp_use(struct snd_sb_csp * p) |
266 | { |
267 | mutex_lock(&p->access_mutex); |
268 | if (p->used) { |
269 | mutex_unlock(lock: &p->access_mutex); |
270 | return -EAGAIN; |
271 | } |
272 | p->used++; |
273 | mutex_unlock(lock: &p->access_mutex); |
274 | |
275 | return 0; |
276 | |
277 | } |
278 | |
279 | /* |
280 | * release device |
281 | */ |
282 | static int snd_sb_csp_unuse(struct snd_sb_csp * p) |
283 | { |
284 | mutex_lock(&p->access_mutex); |
285 | p->used--; |
286 | mutex_unlock(lock: &p->access_mutex); |
287 | |
288 | return 0; |
289 | } |
290 | |
291 | /* |
292 | * load microcode via ioctl: |
293 | * code is user-space pointer |
294 | */ |
295 | static int snd_sb_csp_riff_load(struct snd_sb_csp * p, |
296 | struct snd_sb_csp_microcode __user * mcode) |
297 | { |
298 | struct snd_sb_csp_mc_header info; |
299 | |
300 | unsigned char __user *data_ptr; |
301 | unsigned char __user *data_end; |
302 | unsigned short func_nr = 0; |
303 | |
304 | struct riff_header file_h, item_h, code_h; |
305 | __le32 item_type; |
306 | struct desc_header funcdesc_h; |
307 | |
308 | unsigned long flags; |
309 | int err; |
310 | |
311 | if (copy_from_user(to: &info, from: mcode, n: sizeof(info))) |
312 | return -EFAULT; |
313 | data_ptr = mcode->data; |
314 | |
315 | if (copy_from_user(to: &file_h, from: data_ptr, n: sizeof(file_h))) |
316 | return -EFAULT; |
317 | if ((le32_to_cpu(file_h.name) != RIFF_HEADER) || |
318 | (le32_to_cpu(file_h.len) >= SNDRV_SB_CSP_MAX_MICROCODE_FILE_SIZE - sizeof(file_h))) { |
319 | snd_printd("%s: Invalid RIFF header\n" , __func__); |
320 | return -EINVAL; |
321 | } |
322 | data_ptr += sizeof(file_h); |
323 | data_end = data_ptr + le32_to_cpu(file_h.len); |
324 | |
325 | if (copy_from_user(to: &item_type, from: data_ptr, n: sizeof(item_type))) |
326 | return -EFAULT; |
327 | if (le32_to_cpu(item_type) != CSP__HEADER) { |
328 | snd_printd("%s: Invalid RIFF file type\n" , __func__); |
329 | return -EINVAL; |
330 | } |
331 | data_ptr += sizeof (item_type); |
332 | |
333 | for (; data_ptr < data_end; data_ptr += le32_to_cpu(item_h.len)) { |
334 | if (copy_from_user(to: &item_h, from: data_ptr, n: sizeof(item_h))) |
335 | return -EFAULT; |
336 | data_ptr += sizeof(item_h); |
337 | if (le32_to_cpu(item_h.name) != LIST_HEADER) |
338 | continue; |
339 | |
340 | if (copy_from_user(to: &item_type, from: data_ptr, n: sizeof(item_type))) |
341 | return -EFAULT; |
342 | switch (le32_to_cpu(item_type)) { |
343 | case FUNC_HEADER: |
344 | if (copy_from_user(to: &funcdesc_h, from: data_ptr + sizeof(item_type), n: sizeof(funcdesc_h))) |
345 | return -EFAULT; |
346 | func_nr = le16_to_cpu(funcdesc_h.func_nr); |
347 | break; |
348 | case CODE_HEADER: |
349 | if (func_nr != info.func_req) |
350 | break; /* not required function, try next */ |
351 | data_ptr += sizeof(item_type); |
352 | |
353 | /* destroy QSound mixer element */ |
354 | if (p->mode == SNDRV_SB_CSP_MODE_QSOUND) { |
355 | snd_sb_qsound_destroy(p); |
356 | } |
357 | /* Clear all flags */ |
358 | p->running = 0; |
359 | p->mode = 0; |
360 | |
361 | /* load microcode blocks */ |
362 | for (;;) { |
363 | if (data_ptr >= data_end) |
364 | return -EINVAL; |
365 | if (copy_from_user(to: &code_h, from: data_ptr, n: sizeof(code_h))) |
366 | return -EFAULT; |
367 | |
368 | /* init microcode blocks */ |
369 | if (le32_to_cpu(code_h.name) != INIT_HEADER) |
370 | break; |
371 | data_ptr += sizeof(code_h); |
372 | err = snd_sb_csp_load_user(p, buf: data_ptr, le32_to_cpu(code_h.len), |
373 | SNDRV_SB_CSP_LOAD_INITBLOCK); |
374 | if (err) |
375 | return err; |
376 | data_ptr += le32_to_cpu(code_h.len); |
377 | } |
378 | /* main microcode block */ |
379 | if (copy_from_user(to: &code_h, from: data_ptr, n: sizeof(code_h))) |
380 | return -EFAULT; |
381 | |
382 | if (le32_to_cpu(code_h.name) != MAIN_HEADER) { |
383 | snd_printd("%s: Missing 'main' microcode\n" , __func__); |
384 | return -EINVAL; |
385 | } |
386 | data_ptr += sizeof(code_h); |
387 | err = snd_sb_csp_load_user(p, buf: data_ptr, |
388 | le32_to_cpu(code_h.len), load_flags: 0); |
389 | if (err) |
390 | return err; |
391 | |
392 | /* fill in codec header */ |
393 | strscpy(p->codec_name, info.codec_name, sizeof(p->codec_name)); |
394 | p->func_nr = func_nr; |
395 | p->mode = le16_to_cpu(funcdesc_h.flags_play_rec); |
396 | switch (le16_to_cpu(funcdesc_h.VOC_type)) { |
397 | case 0x0001: /* QSound decoder */ |
398 | if (le16_to_cpu(funcdesc_h.flags_play_rec) == SNDRV_SB_CSP_MODE_DSP_WRITE) { |
399 | if (snd_sb_qsound_build(p) == 0) |
400 | /* set QSound flag and clear all other mode flags */ |
401 | p->mode = SNDRV_SB_CSP_MODE_QSOUND; |
402 | } |
403 | p->acc_format = 0; |
404 | break; |
405 | case 0x0006: /* A Law codec */ |
406 | p->acc_format = SNDRV_PCM_FMTBIT_A_LAW; |
407 | break; |
408 | case 0x0007: /* Mu Law codec */ |
409 | p->acc_format = SNDRV_PCM_FMTBIT_MU_LAW; |
410 | break; |
411 | case 0x0011: /* what Creative thinks is IMA ADPCM codec */ |
412 | case 0x0200: /* Creative ADPCM codec */ |
413 | p->acc_format = SNDRV_PCM_FMTBIT_IMA_ADPCM; |
414 | break; |
415 | case 201: /* Text 2 Speech decoder */ |
416 | /* TODO: Text2Speech handling routines */ |
417 | p->acc_format = 0; |
418 | break; |
419 | case 0x0202: /* Fast Speech 8 codec */ |
420 | case 0x0203: /* Fast Speech 10 codec */ |
421 | p->acc_format = SNDRV_PCM_FMTBIT_SPECIAL; |
422 | break; |
423 | default: /* other codecs are unsupported */ |
424 | p->acc_format = p->acc_width = p->acc_rates = 0; |
425 | p->mode = 0; |
426 | snd_printd("%s: Unsupported CSP codec type: 0x%04x\n" , |
427 | __func__, |
428 | le16_to_cpu(funcdesc_h.VOC_type)); |
429 | return -EINVAL; |
430 | } |
431 | p->acc_channels = le16_to_cpu(funcdesc_h.flags_stereo_mono); |
432 | p->acc_width = le16_to_cpu(funcdesc_h.flags_16bit_8bit); |
433 | p->acc_rates = le16_to_cpu(funcdesc_h.flags_rates); |
434 | |
435 | /* Decouple CSP from IRQ and DMAREQ lines */ |
436 | spin_lock_irqsave(&p->chip->reg_lock, flags); |
437 | set_mode_register(chip: p->chip, mode: 0xfc); |
438 | set_mode_register(chip: p->chip, mode: 0x00); |
439 | spin_unlock_irqrestore(lock: &p->chip->reg_lock, flags); |
440 | |
441 | /* finished loading successfully */ |
442 | p->running = SNDRV_SB_CSP_ST_LOADED; /* set LOADED flag */ |
443 | return 0; |
444 | } |
445 | } |
446 | snd_printd("%s: Function #%d not found\n" , __func__, info.func_req); |
447 | return -EINVAL; |
448 | } |
449 | |
450 | /* |
451 | * unload CSP microcode |
452 | */ |
453 | static int snd_sb_csp_unload(struct snd_sb_csp * p) |
454 | { |
455 | if (p->running & SNDRV_SB_CSP_ST_RUNNING) |
456 | return -EBUSY; |
457 | if (!(p->running & SNDRV_SB_CSP_ST_LOADED)) |
458 | return -ENXIO; |
459 | |
460 | /* clear supported formats */ |
461 | p->acc_format = 0; |
462 | p->acc_channels = p->acc_width = p->acc_rates = 0; |
463 | /* destroy QSound mixer element */ |
464 | if (p->mode == SNDRV_SB_CSP_MODE_QSOUND) { |
465 | snd_sb_qsound_destroy(p); |
466 | } |
467 | /* clear all flags */ |
468 | p->running = 0; |
469 | p->mode = 0; |
470 | return 0; |
471 | } |
472 | |
473 | /* |
474 | * send command sequence to DSP |
475 | */ |
476 | static inline int command_seq(struct snd_sb *chip, const unsigned char *seq, int size) |
477 | { |
478 | int i; |
479 | for (i = 0; i < size; i++) { |
480 | if (!snd_sbdsp_command(chip, val: seq[i])) |
481 | return -EIO; |
482 | } |
483 | return 0; |
484 | } |
485 | |
486 | /* |
487 | * set CSP codec parameter |
488 | */ |
489 | static int set_codec_parameter(struct snd_sb *chip, unsigned char par, unsigned char val) |
490 | { |
491 | unsigned char dsp_cmd[3]; |
492 | |
493 | dsp_cmd[0] = 0x05; /* CSP set codec parameter */ |
494 | dsp_cmd[1] = val; /* Parameter value */ |
495 | dsp_cmd[2] = par; /* Parameter */ |
496 | command_seq(chip, seq: dsp_cmd, size: 3); |
497 | snd_sbdsp_command(chip, val: 0x03); /* DSP read? */ |
498 | if (snd_sbdsp_get_byte(chip) != par) |
499 | return -EIO; |
500 | return 0; |
501 | } |
502 | |
503 | /* |
504 | * set CSP register |
505 | */ |
506 | static int set_register(struct snd_sb *chip, unsigned char reg, unsigned char val) |
507 | { |
508 | unsigned char dsp_cmd[3]; |
509 | |
510 | dsp_cmd[0] = 0x0e; /* CSP set register */ |
511 | dsp_cmd[1] = reg; /* CSP Register */ |
512 | dsp_cmd[2] = val; /* value */ |
513 | return command_seq(chip, seq: dsp_cmd, size: 3); |
514 | } |
515 | |
516 | /* |
517 | * read CSP register |
518 | * return < 0 -> error |
519 | */ |
520 | static int read_register(struct snd_sb *chip, unsigned char reg) |
521 | { |
522 | unsigned char dsp_cmd[2]; |
523 | |
524 | dsp_cmd[0] = 0x0f; /* CSP read register */ |
525 | dsp_cmd[1] = reg; /* CSP Register */ |
526 | command_seq(chip, seq: dsp_cmd, size: 2); |
527 | return snd_sbdsp_get_byte(chip); /* Read DSP value */ |
528 | } |
529 | |
530 | /* |
531 | * set CSP mode register |
532 | */ |
533 | static int set_mode_register(struct snd_sb *chip, unsigned char mode) |
534 | { |
535 | unsigned char dsp_cmd[2]; |
536 | |
537 | dsp_cmd[0] = 0x04; /* CSP set mode register */ |
538 | dsp_cmd[1] = mode; /* mode */ |
539 | return command_seq(chip, seq: dsp_cmd, size: 2); |
540 | } |
541 | |
542 | /* |
543 | * Detect CSP |
544 | * return 0 if CSP exists. |
545 | */ |
546 | static int csp_detect(struct snd_sb *chip, int *version) |
547 | { |
548 | unsigned char csp_test1, csp_test2; |
549 | unsigned long flags; |
550 | int result = -ENODEV; |
551 | |
552 | spin_lock_irqsave(&chip->reg_lock, flags); |
553 | |
554 | set_codec_parameter(chip, par: 0x00, val: 0x00); |
555 | set_mode_register(chip, mode: 0xfc); /* 0xfc = ?? */ |
556 | |
557 | csp_test1 = read_register(chip, reg: 0x83); |
558 | set_register(chip, reg: 0x83, val: ~csp_test1); |
559 | csp_test2 = read_register(chip, reg: 0x83); |
560 | if (csp_test2 != (csp_test1 ^ 0xff)) |
561 | goto __fail; |
562 | |
563 | set_register(chip, reg: 0x83, val: csp_test1); |
564 | csp_test2 = read_register(chip, reg: 0x83); |
565 | if (csp_test2 != csp_test1) |
566 | goto __fail; |
567 | |
568 | set_mode_register(chip, mode: 0x00); /* 0x00 = ? */ |
569 | |
570 | *version = get_version(chip); |
571 | snd_sbdsp_reset(chip); /* reset DSP after getversion! */ |
572 | if (*version >= 0x10 && *version <= 0x1f) |
573 | result = 0; /* valid version id */ |
574 | |
575 | __fail: |
576 | spin_unlock_irqrestore(lock: &chip->reg_lock, flags); |
577 | return result; |
578 | } |
579 | |
580 | /* |
581 | * get CSP version number |
582 | */ |
583 | static int get_version(struct snd_sb *chip) |
584 | { |
585 | unsigned char dsp_cmd[2]; |
586 | |
587 | dsp_cmd[0] = 0x08; /* SB_DSP_!something! */ |
588 | dsp_cmd[1] = 0x03; /* get chip version id? */ |
589 | command_seq(chip, seq: dsp_cmd, size: 2); |
590 | |
591 | return (snd_sbdsp_get_byte(chip)); |
592 | } |
593 | |
594 | /* |
595 | * check if the CSP version is valid |
596 | */ |
597 | static int snd_sb_csp_check_version(struct snd_sb_csp * p) |
598 | { |
599 | if (p->version < 0x10 || p->version > 0x1f) { |
600 | snd_printd("%s: Invalid CSP version: 0x%x\n" , __func__, p->version); |
601 | return 1; |
602 | } |
603 | return 0; |
604 | } |
605 | |
606 | /* |
607 | * download microcode to CSP (microcode should have one "main" block). |
608 | */ |
609 | static int snd_sb_csp_load(struct snd_sb_csp * p, const unsigned char *buf, int size, int load_flags) |
610 | { |
611 | int status, i; |
612 | int err; |
613 | int result = -EIO; |
614 | unsigned long flags; |
615 | |
616 | spin_lock_irqsave(&p->chip->reg_lock, flags); |
617 | snd_sbdsp_command(chip: p->chip, val: 0x01); /* CSP download command */ |
618 | if (snd_sbdsp_get_byte(chip: p->chip)) { |
619 | snd_printd("%s: Download command failed\n" , __func__); |
620 | goto __fail; |
621 | } |
622 | /* Send CSP low byte (size - 1) */ |
623 | snd_sbdsp_command(chip: p->chip, val: (unsigned char)(size - 1)); |
624 | /* Send high byte */ |
625 | snd_sbdsp_command(chip: p->chip, val: (unsigned char)((size - 1) >> 8)); |
626 | /* send microcode sequence */ |
627 | /* load from kernel space */ |
628 | while (size--) { |
629 | if (!snd_sbdsp_command(chip: p->chip, val: *buf++)) |
630 | goto __fail; |
631 | } |
632 | if (snd_sbdsp_get_byte(chip: p->chip)) |
633 | goto __fail; |
634 | |
635 | if (load_flags & SNDRV_SB_CSP_LOAD_INITBLOCK) { |
636 | i = 0; |
637 | /* some codecs (FastSpeech) take some time to initialize */ |
638 | while (1) { |
639 | snd_sbdsp_command(chip: p->chip, val: 0x03); |
640 | status = snd_sbdsp_get_byte(chip: p->chip); |
641 | if (status == 0x55 || ++i >= 10) |
642 | break; |
643 | udelay (10); |
644 | } |
645 | if (status != 0x55) { |
646 | snd_printd("%s: Microcode initialization failed\n" , __func__); |
647 | goto __fail; |
648 | } |
649 | } else { |
650 | /* |
651 | * Read mixer register SB_DSP4_DMASETUP after loading 'main' code. |
652 | * Start CSP chip if no 16bit DMA channel is set - some kind |
653 | * of autorun or perhaps a bugfix? |
654 | */ |
655 | spin_lock(lock: &p->chip->mixer_lock); |
656 | status = snd_sbmixer_read(chip: p->chip, SB_DSP4_DMASETUP); |
657 | spin_unlock(lock: &p->chip->mixer_lock); |
658 | if (!(status & (SB_DMASETUP_DMA7 | SB_DMASETUP_DMA6 | SB_DMASETUP_DMA5))) { |
659 | err = (set_codec_parameter(chip: p->chip, par: 0xaa, val: 0x00) || |
660 | set_codec_parameter(chip: p->chip, par: 0xff, val: 0x00)); |
661 | snd_sbdsp_reset(chip: p->chip); /* really! */ |
662 | if (err) |
663 | goto __fail; |
664 | set_mode_register(chip: p->chip, mode: 0xc0); /* c0 = STOP */ |
665 | set_mode_register(chip: p->chip, mode: 0x70); /* 70 = RUN */ |
666 | } |
667 | } |
668 | result = 0; |
669 | |
670 | __fail: |
671 | spin_unlock_irqrestore(lock: &p->chip->reg_lock, flags); |
672 | return result; |
673 | } |
674 | |
675 | static int snd_sb_csp_load_user(struct snd_sb_csp * p, const unsigned char __user *buf, int size, int load_flags) |
676 | { |
677 | int err; |
678 | unsigned char *kbuf; |
679 | |
680 | kbuf = memdup_user(buf, size); |
681 | if (IS_ERR(ptr: kbuf)) |
682 | return PTR_ERR(ptr: kbuf); |
683 | |
684 | err = snd_sb_csp_load(p, buf: kbuf, size, load_flags); |
685 | |
686 | kfree(objp: kbuf); |
687 | return err; |
688 | } |
689 | |
690 | static int snd_sb_csp_firmware_load(struct snd_sb_csp *p, int index, int flags) |
691 | { |
692 | static const char *const names[] = { |
693 | "sb16/mulaw_main.csp" , |
694 | "sb16/alaw_main.csp" , |
695 | "sb16/ima_adpcm_init.csp" , |
696 | "sb16/ima_adpcm_playback.csp" , |
697 | "sb16/ima_adpcm_capture.csp" , |
698 | }; |
699 | const struct firmware *program; |
700 | |
701 | BUILD_BUG_ON(ARRAY_SIZE(names) != CSP_PROGRAM_COUNT); |
702 | program = p->csp_programs[index]; |
703 | if (!program) { |
704 | int err = request_firmware(fw: &program, name: names[index], |
705 | device: p->chip->card->dev); |
706 | if (err < 0) |
707 | return err; |
708 | p->csp_programs[index] = program; |
709 | } |
710 | return snd_sb_csp_load(p, buf: program->data, size: program->size, load_flags: flags); |
711 | } |
712 | |
713 | /* |
714 | * autoload hardware codec if necessary |
715 | * return 0 if CSP is loaded and ready to run (p->running != 0) |
716 | */ |
717 | static int snd_sb_csp_autoload(struct snd_sb_csp * p, snd_pcm_format_t pcm_sfmt, int play_rec_mode) |
718 | { |
719 | unsigned long flags; |
720 | int err = 0; |
721 | |
722 | /* if CSP is running or manually loaded then exit */ |
723 | if (p->running & (SNDRV_SB_CSP_ST_RUNNING | SNDRV_SB_CSP_ST_LOADED)) |
724 | return -EBUSY; |
725 | |
726 | /* autoload microcode only if requested hardware codec is not already loaded */ |
727 | if (((1U << (__force int)pcm_sfmt) & p->acc_format) && (play_rec_mode & p->mode)) { |
728 | p->running = SNDRV_SB_CSP_ST_AUTO; |
729 | } else { |
730 | switch (pcm_sfmt) { |
731 | case SNDRV_PCM_FORMAT_MU_LAW: |
732 | err = snd_sb_csp_firmware_load(p, index: CSP_PROGRAM_MULAW, flags: 0); |
733 | p->acc_format = SNDRV_PCM_FMTBIT_MU_LAW; |
734 | p->mode = SNDRV_SB_CSP_MODE_DSP_READ | SNDRV_SB_CSP_MODE_DSP_WRITE; |
735 | break; |
736 | case SNDRV_PCM_FORMAT_A_LAW: |
737 | err = snd_sb_csp_firmware_load(p, index: CSP_PROGRAM_ALAW, flags: 0); |
738 | p->acc_format = SNDRV_PCM_FMTBIT_A_LAW; |
739 | p->mode = SNDRV_SB_CSP_MODE_DSP_READ | SNDRV_SB_CSP_MODE_DSP_WRITE; |
740 | break; |
741 | case SNDRV_PCM_FORMAT_IMA_ADPCM: |
742 | err = snd_sb_csp_firmware_load(p, index: CSP_PROGRAM_ADPCM_INIT, |
743 | SNDRV_SB_CSP_LOAD_INITBLOCK); |
744 | if (err) |
745 | break; |
746 | if (play_rec_mode == SNDRV_SB_CSP_MODE_DSP_WRITE) { |
747 | err = snd_sb_csp_firmware_load |
748 | (p, index: CSP_PROGRAM_ADPCM_PLAYBACK, flags: 0); |
749 | p->mode = SNDRV_SB_CSP_MODE_DSP_WRITE; |
750 | } else { |
751 | err = snd_sb_csp_firmware_load |
752 | (p, index: CSP_PROGRAM_ADPCM_CAPTURE, flags: 0); |
753 | p->mode = SNDRV_SB_CSP_MODE_DSP_READ; |
754 | } |
755 | p->acc_format = SNDRV_PCM_FMTBIT_IMA_ADPCM; |
756 | break; |
757 | default: |
758 | /* Decouple CSP from IRQ and DMAREQ lines */ |
759 | if (p->running & SNDRV_SB_CSP_ST_AUTO) { |
760 | spin_lock_irqsave(&p->chip->reg_lock, flags); |
761 | set_mode_register(chip: p->chip, mode: 0xfc); |
762 | set_mode_register(chip: p->chip, mode: 0x00); |
763 | spin_unlock_irqrestore(lock: &p->chip->reg_lock, flags); |
764 | p->running = 0; /* clear autoloaded flag */ |
765 | } |
766 | return -EINVAL; |
767 | } |
768 | if (err) { |
769 | p->acc_format = 0; |
770 | p->acc_channels = p->acc_width = p->acc_rates = 0; |
771 | |
772 | p->running = 0; /* clear autoloaded flag */ |
773 | p->mode = 0; |
774 | return (err); |
775 | } else { |
776 | p->running = SNDRV_SB_CSP_ST_AUTO; /* set autoloaded flag */ |
777 | p->acc_width = SNDRV_SB_CSP_SAMPLE_16BIT; /* only 16 bit data */ |
778 | p->acc_channels = SNDRV_SB_CSP_MONO | SNDRV_SB_CSP_STEREO; |
779 | p->acc_rates = SNDRV_SB_CSP_RATE_ALL; /* HW codecs accept all rates */ |
780 | } |
781 | |
782 | } |
783 | return (p->running & SNDRV_SB_CSP_ST_AUTO) ? 0 : -ENXIO; |
784 | } |
785 | |
786 | /* |
787 | * start CSP |
788 | */ |
789 | static int snd_sb_csp_start(struct snd_sb_csp * p, int sample_width, int channels) |
790 | { |
791 | unsigned char s_type; /* sample type */ |
792 | unsigned char mixL, mixR; |
793 | int result = -EIO; |
794 | unsigned long flags; |
795 | |
796 | if (!(p->running & (SNDRV_SB_CSP_ST_LOADED | SNDRV_SB_CSP_ST_AUTO))) { |
797 | snd_printd("%s: Microcode not loaded\n" , __func__); |
798 | return -ENXIO; |
799 | } |
800 | if (p->running & SNDRV_SB_CSP_ST_RUNNING) { |
801 | snd_printd("%s: CSP already running\n" , __func__); |
802 | return -EBUSY; |
803 | } |
804 | if (!(sample_width & p->acc_width)) { |
805 | snd_printd("%s: Unsupported PCM sample width\n" , __func__); |
806 | return -EINVAL; |
807 | } |
808 | if (!(channels & p->acc_channels)) { |
809 | snd_printd("%s: Invalid number of channels\n" , __func__); |
810 | return -EINVAL; |
811 | } |
812 | |
813 | /* Mute PCM volume */ |
814 | spin_lock_irqsave(&p->chip->mixer_lock, flags); |
815 | mixL = snd_sbmixer_read(chip: p->chip, SB_DSP4_PCM_DEV); |
816 | mixR = snd_sbmixer_read(chip: p->chip, SB_DSP4_PCM_DEV + 1); |
817 | snd_sbmixer_write(chip: p->chip, SB_DSP4_PCM_DEV, data: mixL & 0x7); |
818 | snd_sbmixer_write(chip: p->chip, SB_DSP4_PCM_DEV + 1, data: mixR & 0x7); |
819 | spin_unlock_irqrestore(lock: &p->chip->mixer_lock, flags); |
820 | |
821 | spin_lock(lock: &p->chip->reg_lock); |
822 | set_mode_register(chip: p->chip, mode: 0xc0); /* c0 = STOP */ |
823 | set_mode_register(chip: p->chip, mode: 0x70); /* 70 = RUN */ |
824 | |
825 | s_type = 0x00; |
826 | if (channels == SNDRV_SB_CSP_MONO) |
827 | s_type = 0x11; /* 000n 000n (n = 1 if mono) */ |
828 | if (sample_width == SNDRV_SB_CSP_SAMPLE_8BIT) |
829 | s_type |= 0x22; /* 00dX 00dX (d = 1 if 8 bit samples) */ |
830 | |
831 | if (set_codec_parameter(chip: p->chip, par: 0x81, val: s_type)) { |
832 | snd_printd("%s: Set sample type command failed\n" , __func__); |
833 | goto __fail; |
834 | } |
835 | if (set_codec_parameter(chip: p->chip, par: 0x80, val: 0x00)) { |
836 | snd_printd("%s: Codec start command failed\n" , __func__); |
837 | goto __fail; |
838 | } |
839 | p->run_width = sample_width; |
840 | p->run_channels = channels; |
841 | |
842 | p->running |= SNDRV_SB_CSP_ST_RUNNING; |
843 | |
844 | if (p->mode & SNDRV_SB_CSP_MODE_QSOUND) { |
845 | set_codec_parameter(chip: p->chip, par: 0xe0, val: 0x01); |
846 | /* enable QSound decoder */ |
847 | set_codec_parameter(chip: p->chip, par: 0x00, val: 0xff); |
848 | set_codec_parameter(chip: p->chip, par: 0x01, val: 0xff); |
849 | p->running |= SNDRV_SB_CSP_ST_QSOUND; |
850 | /* set QSound startup value */ |
851 | snd_sb_csp_qsound_transfer(p); |
852 | } |
853 | result = 0; |
854 | |
855 | __fail: |
856 | spin_unlock(lock: &p->chip->reg_lock); |
857 | |
858 | /* restore PCM volume */ |
859 | spin_lock_irqsave(&p->chip->mixer_lock, flags); |
860 | snd_sbmixer_write(chip: p->chip, SB_DSP4_PCM_DEV, data: mixL); |
861 | snd_sbmixer_write(chip: p->chip, SB_DSP4_PCM_DEV + 1, data: mixR); |
862 | spin_unlock_irqrestore(lock: &p->chip->mixer_lock, flags); |
863 | |
864 | return result; |
865 | } |
866 | |
867 | /* |
868 | * stop CSP |
869 | */ |
870 | static int snd_sb_csp_stop(struct snd_sb_csp * p) |
871 | { |
872 | int result; |
873 | unsigned char mixL, mixR; |
874 | unsigned long flags; |
875 | |
876 | if (!(p->running & SNDRV_SB_CSP_ST_RUNNING)) |
877 | return 0; |
878 | |
879 | /* Mute PCM volume */ |
880 | spin_lock_irqsave(&p->chip->mixer_lock, flags); |
881 | mixL = snd_sbmixer_read(chip: p->chip, SB_DSP4_PCM_DEV); |
882 | mixR = snd_sbmixer_read(chip: p->chip, SB_DSP4_PCM_DEV + 1); |
883 | snd_sbmixer_write(chip: p->chip, SB_DSP4_PCM_DEV, data: mixL & 0x7); |
884 | snd_sbmixer_write(chip: p->chip, SB_DSP4_PCM_DEV + 1, data: mixR & 0x7); |
885 | spin_unlock_irqrestore(lock: &p->chip->mixer_lock, flags); |
886 | |
887 | spin_lock(lock: &p->chip->reg_lock); |
888 | if (p->running & SNDRV_SB_CSP_ST_QSOUND) { |
889 | set_codec_parameter(chip: p->chip, par: 0xe0, val: 0x01); |
890 | /* disable QSound decoder */ |
891 | set_codec_parameter(chip: p->chip, par: 0x00, val: 0x00); |
892 | set_codec_parameter(chip: p->chip, par: 0x01, val: 0x00); |
893 | |
894 | p->running &= ~SNDRV_SB_CSP_ST_QSOUND; |
895 | } |
896 | result = set_mode_register(chip: p->chip, mode: 0xc0); /* c0 = STOP */ |
897 | spin_unlock(lock: &p->chip->reg_lock); |
898 | |
899 | /* restore PCM volume */ |
900 | spin_lock_irqsave(&p->chip->mixer_lock, flags); |
901 | snd_sbmixer_write(chip: p->chip, SB_DSP4_PCM_DEV, data: mixL); |
902 | snd_sbmixer_write(chip: p->chip, SB_DSP4_PCM_DEV + 1, data: mixR); |
903 | spin_unlock_irqrestore(lock: &p->chip->mixer_lock, flags); |
904 | |
905 | if (!(result)) |
906 | p->running &= ~(SNDRV_SB_CSP_ST_PAUSED | SNDRV_SB_CSP_ST_RUNNING); |
907 | return result; |
908 | } |
909 | |
910 | /* |
911 | * pause CSP codec and hold DMA transfer |
912 | */ |
913 | static int snd_sb_csp_pause(struct snd_sb_csp * p) |
914 | { |
915 | int result; |
916 | unsigned long flags; |
917 | |
918 | if (!(p->running & SNDRV_SB_CSP_ST_RUNNING)) |
919 | return -EBUSY; |
920 | |
921 | spin_lock_irqsave(&p->chip->reg_lock, flags); |
922 | result = set_codec_parameter(chip: p->chip, par: 0x80, val: 0xff); |
923 | spin_unlock_irqrestore(lock: &p->chip->reg_lock, flags); |
924 | if (!(result)) |
925 | p->running |= SNDRV_SB_CSP_ST_PAUSED; |
926 | |
927 | return result; |
928 | } |
929 | |
930 | /* |
931 | * restart CSP codec and resume DMA transfer |
932 | */ |
933 | static int snd_sb_csp_restart(struct snd_sb_csp * p) |
934 | { |
935 | int result; |
936 | unsigned long flags; |
937 | |
938 | if (!(p->running & SNDRV_SB_CSP_ST_PAUSED)) |
939 | return -EBUSY; |
940 | |
941 | spin_lock_irqsave(&p->chip->reg_lock, flags); |
942 | result = set_codec_parameter(chip: p->chip, par: 0x80, val: 0x00); |
943 | spin_unlock_irqrestore(lock: &p->chip->reg_lock, flags); |
944 | if (!(result)) |
945 | p->running &= ~SNDRV_SB_CSP_ST_PAUSED; |
946 | |
947 | return result; |
948 | } |
949 | |
950 | /* ------------------------------ */ |
951 | |
952 | /* |
953 | * QSound mixer control for PCM |
954 | */ |
955 | |
956 | #define snd_sb_qsound_switch_info snd_ctl_boolean_mono_info |
957 | |
958 | static int snd_sb_qsound_switch_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) |
959 | { |
960 | struct snd_sb_csp *p = snd_kcontrol_chip(kcontrol); |
961 | |
962 | ucontrol->value.integer.value[0] = p->q_enabled ? 1 : 0; |
963 | return 0; |
964 | } |
965 | |
966 | static int snd_sb_qsound_switch_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) |
967 | { |
968 | struct snd_sb_csp *p = snd_kcontrol_chip(kcontrol); |
969 | unsigned long flags; |
970 | int change; |
971 | unsigned char nval; |
972 | |
973 | nval = ucontrol->value.integer.value[0] & 0x01; |
974 | spin_lock_irqsave(&p->q_lock, flags); |
975 | change = p->q_enabled != nval; |
976 | p->q_enabled = nval; |
977 | spin_unlock_irqrestore(lock: &p->q_lock, flags); |
978 | return change; |
979 | } |
980 | |
981 | static int snd_sb_qsound_space_info(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_info *uinfo) |
982 | { |
983 | uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; |
984 | uinfo->count = 2; |
985 | uinfo->value.integer.min = 0; |
986 | uinfo->value.integer.max = SNDRV_SB_CSP_QSOUND_MAX_RIGHT; |
987 | return 0; |
988 | } |
989 | |
990 | static int snd_sb_qsound_space_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) |
991 | { |
992 | struct snd_sb_csp *p = snd_kcontrol_chip(kcontrol); |
993 | unsigned long flags; |
994 | |
995 | spin_lock_irqsave(&p->q_lock, flags); |
996 | ucontrol->value.integer.value[0] = p->qpos_left; |
997 | ucontrol->value.integer.value[1] = p->qpos_right; |
998 | spin_unlock_irqrestore(lock: &p->q_lock, flags); |
999 | return 0; |
1000 | } |
1001 | |
1002 | static int snd_sb_qsound_space_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) |
1003 | { |
1004 | struct snd_sb_csp *p = snd_kcontrol_chip(kcontrol); |
1005 | unsigned long flags; |
1006 | int change; |
1007 | unsigned char nval1, nval2; |
1008 | |
1009 | nval1 = ucontrol->value.integer.value[0]; |
1010 | if (nval1 > SNDRV_SB_CSP_QSOUND_MAX_RIGHT) |
1011 | nval1 = SNDRV_SB_CSP_QSOUND_MAX_RIGHT; |
1012 | nval2 = ucontrol->value.integer.value[1]; |
1013 | if (nval2 > SNDRV_SB_CSP_QSOUND_MAX_RIGHT) |
1014 | nval2 = SNDRV_SB_CSP_QSOUND_MAX_RIGHT; |
1015 | spin_lock_irqsave(&p->q_lock, flags); |
1016 | change = p->qpos_left != nval1 || p->qpos_right != nval2; |
1017 | p->qpos_left = nval1; |
1018 | p->qpos_right = nval2; |
1019 | p->qpos_changed = change; |
1020 | spin_unlock_irqrestore(lock: &p->q_lock, flags); |
1021 | return change; |
1022 | } |
1023 | |
1024 | static const struct snd_kcontrol_new snd_sb_qsound_switch = { |
1025 | .iface = SNDRV_CTL_ELEM_IFACE_MIXER, |
1026 | .name = "3D Control - Switch" , |
1027 | .info = snd_sb_qsound_switch_info, |
1028 | .get = snd_sb_qsound_switch_get, |
1029 | .put = snd_sb_qsound_switch_put |
1030 | }; |
1031 | |
1032 | static const struct snd_kcontrol_new snd_sb_qsound_space = { |
1033 | .iface = SNDRV_CTL_ELEM_IFACE_MIXER, |
1034 | .name = "3D Control - Space" , |
1035 | .info = snd_sb_qsound_space_info, |
1036 | .get = snd_sb_qsound_space_get, |
1037 | .put = snd_sb_qsound_space_put |
1038 | }; |
1039 | |
1040 | static int snd_sb_qsound_build(struct snd_sb_csp * p) |
1041 | { |
1042 | struct snd_card *card; |
1043 | struct snd_kcontrol *kctl; |
1044 | int err; |
1045 | |
1046 | if (snd_BUG_ON(!p)) |
1047 | return -EINVAL; |
1048 | |
1049 | card = p->chip->card; |
1050 | p->qpos_left = p->qpos_right = SNDRV_SB_CSP_QSOUND_MAX_RIGHT / 2; |
1051 | p->qpos_changed = 0; |
1052 | |
1053 | spin_lock_init(&p->q_lock); |
1054 | |
1055 | kctl = snd_ctl_new1(kcontrolnew: &snd_sb_qsound_switch, private_data: p); |
1056 | err = snd_ctl_add(card, kcontrol: kctl); |
1057 | if (err < 0) |
1058 | goto __error; |
1059 | p->qsound_switch = kctl; |
1060 | kctl = snd_ctl_new1(kcontrolnew: &snd_sb_qsound_space, private_data: p); |
1061 | err = snd_ctl_add(card, kcontrol: kctl); |
1062 | if (err < 0) |
1063 | goto __error; |
1064 | p->qsound_space = kctl; |
1065 | |
1066 | return 0; |
1067 | |
1068 | __error: |
1069 | snd_sb_qsound_destroy(p); |
1070 | return err; |
1071 | } |
1072 | |
1073 | static void snd_sb_qsound_destroy(struct snd_sb_csp * p) |
1074 | { |
1075 | struct snd_card *card; |
1076 | unsigned long flags; |
1077 | |
1078 | if (snd_BUG_ON(!p)) |
1079 | return; |
1080 | |
1081 | card = p->chip->card; |
1082 | |
1083 | if (p->qsound_switch) { |
1084 | snd_ctl_remove(card, kcontrol: p->qsound_switch); |
1085 | p->qsound_switch = NULL; |
1086 | } |
1087 | if (p->qsound_space) { |
1088 | snd_ctl_remove(card, kcontrol: p->qsound_space); |
1089 | p->qsound_space = NULL; |
1090 | } |
1091 | |
1092 | /* cancel pending transfer of QSound parameters */ |
1093 | spin_lock_irqsave (&p->q_lock, flags); |
1094 | p->qpos_changed = 0; |
1095 | spin_unlock_irqrestore (lock: &p->q_lock, flags); |
1096 | } |
1097 | |
1098 | /* |
1099 | * Transfer qsound parameters to CSP, |
1100 | * function should be called from interrupt routine |
1101 | */ |
1102 | static int snd_sb_csp_qsound_transfer(struct snd_sb_csp * p) |
1103 | { |
1104 | int err = -ENXIO; |
1105 | |
1106 | spin_lock(lock: &p->q_lock); |
1107 | if (p->running & SNDRV_SB_CSP_ST_QSOUND) { |
1108 | set_codec_parameter(chip: p->chip, par: 0xe0, val: 0x01); |
1109 | /* left channel */ |
1110 | set_codec_parameter(chip: p->chip, par: 0x00, val: p->qpos_left); |
1111 | set_codec_parameter(chip: p->chip, par: 0x02, val: 0x00); |
1112 | /* right channel */ |
1113 | set_codec_parameter(chip: p->chip, par: 0x00, val: p->qpos_right); |
1114 | set_codec_parameter(chip: p->chip, par: 0x03, val: 0x00); |
1115 | err = 0; |
1116 | } |
1117 | p->qpos_changed = 0; |
1118 | spin_unlock(lock: &p->q_lock); |
1119 | return err; |
1120 | } |
1121 | |
1122 | /* ------------------------------ */ |
1123 | |
1124 | /* |
1125 | * proc interface |
1126 | */ |
1127 | static int init_proc_entry(struct snd_sb_csp * p, int device) |
1128 | { |
1129 | char name[16]; |
1130 | |
1131 | sprintf(buf: name, fmt: "cspD%d" , device); |
1132 | snd_card_ro_proc_new(card: p->chip->card, name, private_data: p, read: info_read); |
1133 | return 0; |
1134 | } |
1135 | |
1136 | static void info_read(struct snd_info_entry *entry, struct snd_info_buffer *buffer) |
1137 | { |
1138 | struct snd_sb_csp *p = entry->private_data; |
1139 | |
1140 | snd_iprintf(buffer, "Creative Signal Processor [v%d.%d]\n" , (p->version >> 4), (p->version & 0x0f)); |
1141 | snd_iprintf(buffer, "State: %cx%c%c%c\n" , ((p->running & SNDRV_SB_CSP_ST_QSOUND) ? 'Q' : '-'), |
1142 | ((p->running & SNDRV_SB_CSP_ST_PAUSED) ? 'P' : '-'), |
1143 | ((p->running & SNDRV_SB_CSP_ST_RUNNING) ? 'R' : '-'), |
1144 | ((p->running & SNDRV_SB_CSP_ST_LOADED) ? 'L' : '-')); |
1145 | if (p->running & SNDRV_SB_CSP_ST_LOADED) { |
1146 | snd_iprintf(buffer, "Codec: %s [func #%d]\n" , p->codec_name, p->func_nr); |
1147 | snd_iprintf(buffer, "Sample rates: " ); |
1148 | if (p->acc_rates == SNDRV_SB_CSP_RATE_ALL) { |
1149 | snd_iprintf(buffer, "All\n" ); |
1150 | } else { |
1151 | snd_iprintf(buffer, "%s%s%s%s\n" , |
1152 | ((p->acc_rates & SNDRV_SB_CSP_RATE_8000) ? "8000Hz " : "" ), |
1153 | ((p->acc_rates & SNDRV_SB_CSP_RATE_11025) ? "11025Hz " : "" ), |
1154 | ((p->acc_rates & SNDRV_SB_CSP_RATE_22050) ? "22050Hz " : "" ), |
1155 | ((p->acc_rates & SNDRV_SB_CSP_RATE_44100) ? "44100Hz" : "" )); |
1156 | } |
1157 | if (p->mode == SNDRV_SB_CSP_MODE_QSOUND) { |
1158 | snd_iprintf(buffer, "QSound decoder %sabled\n" , |
1159 | p->q_enabled ? "en" : "dis" ); |
1160 | } else { |
1161 | snd_iprintf(buffer, "PCM format ID: 0x%x (%s/%s) [%s/%s] [%s/%s]\n" , |
1162 | p->acc_format, |
1163 | ((p->acc_width & SNDRV_SB_CSP_SAMPLE_16BIT) ? "16bit" : "-" ), |
1164 | ((p->acc_width & SNDRV_SB_CSP_SAMPLE_8BIT) ? "8bit" : "-" ), |
1165 | ((p->acc_channels & SNDRV_SB_CSP_MONO) ? "mono" : "-" ), |
1166 | ((p->acc_channels & SNDRV_SB_CSP_STEREO) ? "stereo" : "-" ), |
1167 | ((p->mode & SNDRV_SB_CSP_MODE_DSP_WRITE) ? "playback" : "-" ), |
1168 | ((p->mode & SNDRV_SB_CSP_MODE_DSP_READ) ? "capture" : "-" )); |
1169 | } |
1170 | } |
1171 | if (p->running & SNDRV_SB_CSP_ST_AUTO) { |
1172 | snd_iprintf(buffer, "Autoloaded Mu-Law, A-Law or Ima-ADPCM hardware codec\n" ); |
1173 | } |
1174 | if (p->running & SNDRV_SB_CSP_ST_RUNNING) { |
1175 | snd_iprintf(buffer, "Processing %dbit %s PCM samples\n" , |
1176 | ((p->run_width & SNDRV_SB_CSP_SAMPLE_16BIT) ? 16 : 8), |
1177 | ((p->run_channels & SNDRV_SB_CSP_MONO) ? "mono" : "stereo" )); |
1178 | } |
1179 | if (p->running & SNDRV_SB_CSP_ST_QSOUND) { |
1180 | snd_iprintf(buffer, "Qsound position: left = 0x%x, right = 0x%x\n" , |
1181 | p->qpos_left, p->qpos_right); |
1182 | } |
1183 | } |
1184 | |
1185 | /* */ |
1186 | |
1187 | EXPORT_SYMBOL(snd_sb_csp_new); |
1188 | |