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