diff options
Diffstat (limited to 'sound/oss/harmony.c')
-rw-r--r-- | sound/oss/harmony.c | 1330 |
1 files changed, 1330 insertions, 0 deletions
diff --git a/sound/oss/harmony.c b/sound/oss/harmony.c new file mode 100644 index 000000000000..bee9d344cd26 --- /dev/null +++ b/sound/oss/harmony.c | |||
@@ -0,0 +1,1330 @@ | |||
1 | /* | ||
2 | drivers/sound/harmony.c | ||
3 | |||
4 | This is a sound driver for ASP's and Lasi's Harmony sound chip | ||
5 | and is unlikely to be used for anything other than on a HP PA-RISC. | ||
6 | |||
7 | Harmony is found in HP 712s, 715/new and many other GSC based machines. | ||
8 | On older 715 machines you'll find the technically identical chip | ||
9 | called 'Vivace'. Both Harmony and Vicace are supported by this driver. | ||
10 | |||
11 | Copyright 2000 (c) Linuxcare Canada, Alex deVries <alex@onefishtwo.ca> | ||
12 | Copyright 2000-2003 (c) Helge Deller <deller@gmx.de> | ||
13 | Copyright 2001 (c) Matthieu Delahaye <delahaym@esiee.fr> | ||
14 | Copyright 2001 (c) Jean-Christophe Vaugeois <vaugeoij@esiee.fr> | ||
15 | Copyright 2004 (c) Stuart Brady <sdbrady@ntlworld.com> | ||
16 | |||
17 | |||
18 | TODO: | ||
19 | - fix SNDCTL_DSP_GETOSPACE and SNDCTL_DSP_GETISPACE ioctls to | ||
20 | return the real values | ||
21 | - add private ioctl for selecting line- or microphone input | ||
22 | (only one of them is available at the same time) | ||
23 | - add module parameters | ||
24 | - implement mmap functionality | ||
25 | - implement gain meter ? | ||
26 | - ... | ||
27 | */ | ||
28 | |||
29 | #include <linux/delay.h> | ||
30 | #include <linux/errno.h> | ||
31 | #include <linux/init.h> | ||
32 | #include <linux/interrupt.h> | ||
33 | #include <linux/ioport.h> | ||
34 | #include <linux/types.h> | ||
35 | #include <linux/mm.h> | ||
36 | #include <linux/pci.h> | ||
37 | |||
38 | #include <asm/parisc-device.h> | ||
39 | #include <asm/io.h> | ||
40 | |||
41 | #include "sound_config.h" | ||
42 | |||
43 | |||
44 | #define PFX "harmony: " | ||
45 | #define HARMONY_VERSION "V0.9a" | ||
46 | |||
47 | #undef DEBUG | ||
48 | #ifdef DEBUG | ||
49 | # define DPRINTK printk | ||
50 | #else | ||
51 | # define DPRINTK(x,...) | ||
52 | #endif | ||
53 | |||
54 | |||
55 | #define MAX_BUFS 10 /* maximum number of rotating buffers */ | ||
56 | #define HARMONY_BUF_SIZE 4096 /* needs to be a multiple of PAGE_SIZE (4096)! */ | ||
57 | |||
58 | #define CNTL_C 0x80000000 | ||
59 | #define CNTL_ST 0x00000020 | ||
60 | #define CNTL_44100 0x00000015 /* HARMONY_SR_44KHZ */ | ||
61 | #define CNTL_8000 0x00000008 /* HARMONY_SR_8KHZ */ | ||
62 | |||
63 | #define GAINCTL_HE 0x08000000 | ||
64 | #define GAINCTL_LE 0x04000000 | ||
65 | #define GAINCTL_SE 0x02000000 | ||
66 | |||
67 | #define DSTATUS_PN 0x00000200 | ||
68 | #define DSTATUS_RN 0x00000002 | ||
69 | |||
70 | #define DSTATUS_IE 0x80000000 | ||
71 | |||
72 | #define HARMONY_DF_16BIT_LINEAR 0 | ||
73 | #define HARMONY_DF_8BIT_ULAW 1 | ||
74 | #define HARMONY_DF_8BIT_ALAW 2 | ||
75 | |||
76 | #define HARMONY_SS_MONO 0 | ||
77 | #define HARMONY_SS_STEREO 1 | ||
78 | |||
79 | #define HARMONY_SR_8KHZ 0x08 | ||
80 | #define HARMONY_SR_16KHZ 0x09 | ||
81 | #define HARMONY_SR_27KHZ 0x0A | ||
82 | #define HARMONY_SR_32KHZ 0x0B | ||
83 | #define HARMONY_SR_48KHZ 0x0E | ||
84 | #define HARMONY_SR_9KHZ 0x0F | ||
85 | #define HARMONY_SR_5KHZ 0x10 | ||
86 | #define HARMONY_SR_11KHZ 0x11 | ||
87 | #define HARMONY_SR_18KHZ 0x12 | ||
88 | #define HARMONY_SR_22KHZ 0x13 | ||
89 | #define HARMONY_SR_37KHZ 0x14 | ||
90 | #define HARMONY_SR_44KHZ 0x15 | ||
91 | #define HARMONY_SR_33KHZ 0x16 | ||
92 | #define HARMONY_SR_6KHZ 0x17 | ||
93 | |||
94 | /* | ||
95 | * Some magics numbers used to auto-detect file formats | ||
96 | */ | ||
97 | |||
98 | #define HARMONY_MAGIC_8B_ULAW 1 | ||
99 | #define HARMONY_MAGIC_8B_ALAW 27 | ||
100 | #define HARMONY_MAGIC_16B_LINEAR 3 | ||
101 | #define HARMONY_MAGIC_MONO 1 | ||
102 | #define HARMONY_MAGIC_STEREO 2 | ||
103 | |||
104 | /* | ||
105 | * Channels Positions in mixer register | ||
106 | */ | ||
107 | |||
108 | #define GAIN_HE_SHIFT 27 | ||
109 | #define GAIN_HE_MASK ( 1 << GAIN_HE_SHIFT) | ||
110 | #define GAIN_LE_SHIFT 26 | ||
111 | #define GAIN_LE_MASK ( 1 << GAIN_LE_SHIFT) | ||
112 | #define GAIN_SE_SHIFT 25 | ||
113 | #define GAIN_SE_MASK ( 1 << GAIN_SE_SHIFT) | ||
114 | #define GAIN_IS_SHIFT 24 | ||
115 | #define GAIN_IS_MASK ( 1 << GAIN_IS_SHIFT) | ||
116 | #define GAIN_MA_SHIFT 20 | ||
117 | #define GAIN_MA_MASK ( 0x0f << GAIN_MA_SHIFT) | ||
118 | #define GAIN_LI_SHIFT 16 | ||
119 | #define GAIN_LI_MASK ( 0x0f << GAIN_LI_SHIFT) | ||
120 | #define GAIN_RI_SHIFT 12 | ||
121 | #define GAIN_RI_MASK ( 0x0f << GAIN_RI_SHIFT) | ||
122 | #define GAIN_LO_SHIFT 6 | ||
123 | #define GAIN_LO_MASK ( 0x3f << GAIN_LO_SHIFT) | ||
124 | #define GAIN_RO_SHIFT 0 | ||
125 | #define GAIN_RO_MASK ( 0x3f << GAIN_RO_SHIFT) | ||
126 | |||
127 | |||
128 | #define MAX_OUTPUT_LEVEL (GAIN_RO_MASK >> GAIN_RO_SHIFT) | ||
129 | #define MAX_INPUT_LEVEL (GAIN_RI_MASK >> GAIN_RI_SHIFT) | ||
130 | #define MAX_MONITOR_LEVEL (GAIN_MA_MASK >> GAIN_MA_SHIFT) | ||
131 | |||
132 | #define MIXER_INTERNAL SOUND_MIXER_LINE1 | ||
133 | #define MIXER_LINEOUT SOUND_MIXER_LINE2 | ||
134 | #define MIXER_HEADPHONES SOUND_MIXER_LINE3 | ||
135 | |||
136 | #define MASK_INTERNAL SOUND_MASK_LINE1 | ||
137 | #define MASK_LINEOUT SOUND_MASK_LINE2 | ||
138 | #define MASK_HEADPHONES SOUND_MASK_LINE3 | ||
139 | |||
140 | /* | ||
141 | * Channels Mask in mixer register | ||
142 | */ | ||
143 | |||
144 | #define GAIN_TOTAL_SILENCE 0x00F00FFF | ||
145 | #define GAIN_DEFAULT 0x0FF00000 | ||
146 | |||
147 | |||
148 | struct harmony_hpa { | ||
149 | u8 unused000; | ||
150 | u8 id; | ||
151 | u8 teleshare_id; | ||
152 | u8 unused003; | ||
153 | u32 reset; | ||
154 | u32 cntl; | ||
155 | u32 gainctl; | ||
156 | u32 pnxtadd; | ||
157 | u32 pcuradd; | ||
158 | u32 rnxtadd; | ||
159 | u32 rcuradd; | ||
160 | u32 dstatus; | ||
161 | u32 ov; | ||
162 | u32 pio; | ||
163 | u32 unused02c; | ||
164 | u32 unused030[3]; | ||
165 | u32 diag; | ||
166 | }; | ||
167 | |||
168 | struct harmony_dev { | ||
169 | struct harmony_hpa *hpa; | ||
170 | struct parisc_device *dev; | ||
171 | u32 current_gain; | ||
172 | u32 dac_rate; /* 8000 ... 48000 (Hz) */ | ||
173 | u8 data_format; /* HARMONY_DF_xx_BIT_xxx */ | ||
174 | u8 sample_rate; /* HARMONY_SR_xx_KHZ */ | ||
175 | u8 stereo_select; /* HARMONY_SS_MONO or HARMONY_SS_STEREO */ | ||
176 | int format_initialized :1; | ||
177 | int suspended_playing :1; | ||
178 | int suspended_recording :1; | ||
179 | |||
180 | int blocked_playing :1; | ||
181 | int blocked_recording :1; | ||
182 | int audio_open :1; | ||
183 | int mixer_open :1; | ||
184 | |||
185 | wait_queue_head_t wq_play, wq_record; | ||
186 | int first_filled_play; /* first buffer containing data (next to play) */ | ||
187 | int nb_filled_play; | ||
188 | int play_offset; | ||
189 | int first_filled_record; | ||
190 | int nb_filled_record; | ||
191 | |||
192 | int dsp_unit, mixer_unit; | ||
193 | }; | ||
194 | |||
195 | |||
196 | static struct harmony_dev harmony; | ||
197 | |||
198 | |||
199 | /* | ||
200 | * Dynamic sound buffer allocation and DMA memory | ||
201 | */ | ||
202 | |||
203 | struct harmony_buffer { | ||
204 | unsigned char *addr; | ||
205 | dma_addr_t dma_handle; | ||
206 | int dma_coherent; /* Zero if dma_alloc_coherent() fails */ | ||
207 | unsigned int len; | ||
208 | }; | ||
209 | |||
210 | /* | ||
211 | * Harmony memory buffers | ||
212 | */ | ||
213 | |||
214 | static struct harmony_buffer played_buf, recorded_buf, silent, graveyard; | ||
215 | |||
216 | |||
217 | #define CHECK_WBACK_INV_OFFSET(b,offset,len) \ | ||
218 | do { if (!b.dma_coherent) \ | ||
219 | dma_cache_wback_inv((unsigned long)b.addr+offset,len); \ | ||
220 | } while (0) | ||
221 | |||
222 | |||
223 | static int __init harmony_alloc_buffer(struct harmony_buffer *b, | ||
224 | unsigned int buffer_count) | ||
225 | { | ||
226 | b->len = buffer_count * HARMONY_BUF_SIZE; | ||
227 | b->addr = dma_alloc_coherent(&harmony.dev->dev, | ||
228 | b->len, &b->dma_handle, GFP_KERNEL|GFP_DMA); | ||
229 | if (b->addr && b->dma_handle) { | ||
230 | b->dma_coherent = 1; | ||
231 | DPRINTK(KERN_INFO PFX "coherent memory: 0x%lx, played_buf: 0x%lx\n", | ||
232 | (unsigned long)b->dma_handle, (unsigned long)b->addr); | ||
233 | } else { | ||
234 | b->dma_coherent = 0; | ||
235 | /* kmalloc()ed memory will HPMC on ccio machines ! */ | ||
236 | b->addr = kmalloc(b->len, GFP_KERNEL); | ||
237 | if (!b->addr) { | ||
238 | printk(KERN_ERR PFX "couldn't allocate memory\n"); | ||
239 | return -EBUSY; | ||
240 | } | ||
241 | b->dma_handle = __pa(b->addr); | ||
242 | } | ||
243 | return 0; | ||
244 | } | ||
245 | |||
246 | static void __exit harmony_free_buffer(struct harmony_buffer *b) | ||
247 | { | ||
248 | if (!b->addr) | ||
249 | return; | ||
250 | |||
251 | if (b->dma_coherent) | ||
252 | dma_free_coherent(&harmony.dev->dev, | ||
253 | b->len, b->addr, b->dma_handle); | ||
254 | else | ||
255 | kfree(b->addr); | ||
256 | |||
257 | memset(b, 0, sizeof(*b)); | ||
258 | } | ||
259 | |||
260 | |||
261 | |||
262 | /* | ||
263 | * Low-Level sound-chip programming | ||
264 | */ | ||
265 | |||
266 | static void __inline__ harmony_wait_CNTL(void) | ||
267 | { | ||
268 | /* Wait until we're out of control mode */ | ||
269 | while (gsc_readl(&harmony.hpa->cntl) & CNTL_C) | ||
270 | /* wait */ ; | ||
271 | } | ||
272 | |||
273 | |||
274 | static void harmony_update_control(void) | ||
275 | { | ||
276 | u32 default_cntl; | ||
277 | |||
278 | /* Set CNTL */ | ||
279 | default_cntl = (CNTL_C | /* The C bit */ | ||
280 | (harmony.data_format << 6) | /* Set the data format */ | ||
281 | (harmony.stereo_select << 5) | /* Stereo select */ | ||
282 | (harmony.sample_rate)); /* Set sample rate */ | ||
283 | harmony.format_initialized = 1; | ||
284 | |||
285 | /* initialize CNTL */ | ||
286 | gsc_writel(default_cntl, &harmony.hpa->cntl); | ||
287 | } | ||
288 | |||
289 | static void harmony_set_control(u8 data_format, u8 sample_rate, u8 stereo_select) | ||
290 | { | ||
291 | harmony.sample_rate = sample_rate; | ||
292 | harmony.data_format = data_format; | ||
293 | harmony.stereo_select = stereo_select; | ||
294 | harmony_update_control(); | ||
295 | } | ||
296 | |||
297 | static void harmony_set_rate(u8 data_rate) | ||
298 | { | ||
299 | harmony.sample_rate = data_rate; | ||
300 | harmony_update_control(); | ||
301 | } | ||
302 | |||
303 | static int harmony_detect_rate(int *freq) | ||
304 | { | ||
305 | int newrate; | ||
306 | switch (*freq) { | ||
307 | case 8000: newrate = HARMONY_SR_8KHZ; break; | ||
308 | case 16000: newrate = HARMONY_SR_16KHZ; break; | ||
309 | case 27428: newrate = HARMONY_SR_27KHZ; break; | ||
310 | case 32000: newrate = HARMONY_SR_32KHZ; break; | ||
311 | case 48000: newrate = HARMONY_SR_48KHZ; break; | ||
312 | case 9600: newrate = HARMONY_SR_9KHZ; break; | ||
313 | case 5512: newrate = HARMONY_SR_5KHZ; break; | ||
314 | case 11025: newrate = HARMONY_SR_11KHZ; break; | ||
315 | case 18900: newrate = HARMONY_SR_18KHZ; break; | ||
316 | case 22050: newrate = HARMONY_SR_22KHZ; break; | ||
317 | case 37800: newrate = HARMONY_SR_37KHZ; break; | ||
318 | case 44100: newrate = HARMONY_SR_44KHZ; break; | ||
319 | case 33075: newrate = HARMONY_SR_33KHZ; break; | ||
320 | case 6615: newrate = HARMONY_SR_6KHZ; break; | ||
321 | default: newrate = HARMONY_SR_8KHZ; | ||
322 | *freq = 8000; break; | ||
323 | } | ||
324 | return newrate; | ||
325 | } | ||
326 | |||
327 | static void harmony_set_format(u8 data_format) | ||
328 | { | ||
329 | harmony.data_format = data_format; | ||
330 | harmony_update_control(); | ||
331 | } | ||
332 | |||
333 | static void harmony_set_stereo(u8 stereo_select) | ||
334 | { | ||
335 | harmony.stereo_select = stereo_select; | ||
336 | harmony_update_control(); | ||
337 | } | ||
338 | |||
339 | static void harmony_disable_interrupts(void) | ||
340 | { | ||
341 | harmony_wait_CNTL(); | ||
342 | gsc_writel(0, &harmony.hpa->dstatus); | ||
343 | } | ||
344 | |||
345 | static void harmony_enable_interrupts(void) | ||
346 | { | ||
347 | harmony_wait_CNTL(); | ||
348 | gsc_writel(DSTATUS_IE, &harmony.hpa->dstatus); | ||
349 | } | ||
350 | |||
351 | /* | ||
352 | * harmony_silence() | ||
353 | * | ||
354 | * This subroutine fills in a buffer starting at location start and | ||
355 | * silences for length bytes. This references the current | ||
356 | * configuration of the audio format. | ||
357 | * | ||
358 | */ | ||
359 | |||
360 | static void harmony_silence(struct harmony_buffer *buffer, int start, int length) | ||
361 | { | ||
362 | u8 silence_char; | ||
363 | |||
364 | /* Despite what you hear, silence is different in | ||
365 | different audio formats. */ | ||
366 | switch (harmony.data_format) { | ||
367 | case HARMONY_DF_8BIT_ULAW: silence_char = 0x55; break; | ||
368 | case HARMONY_DF_8BIT_ALAW: silence_char = 0xff; break; | ||
369 | case HARMONY_DF_16BIT_LINEAR: /* fall through */ | ||
370 | default: silence_char = 0; | ||
371 | } | ||
372 | |||
373 | memset(buffer->addr+start, silence_char, length); | ||
374 | } | ||
375 | |||
376 | |||
377 | static int harmony_audio_open(struct inode *inode, struct file *file) | ||
378 | { | ||
379 | if (harmony.audio_open) | ||
380 | return -EBUSY; | ||
381 | |||
382 | harmony.audio_open = 1; | ||
383 | harmony.suspended_playing = harmony.suspended_recording = 1; | ||
384 | harmony.blocked_playing = harmony.blocked_recording = 0; | ||
385 | harmony.first_filled_play = harmony.first_filled_record = 0; | ||
386 | harmony.nb_filled_play = harmony.nb_filled_record = 0; | ||
387 | harmony.play_offset = 0; | ||
388 | init_waitqueue_head(&harmony.wq_play); | ||
389 | init_waitqueue_head(&harmony.wq_record); | ||
390 | |||
391 | /* Start off in a balanced mode. */ | ||
392 | harmony_set_control(HARMONY_DF_8BIT_ULAW, HARMONY_SR_8KHZ, HARMONY_SS_MONO); | ||
393 | harmony_update_control(); | ||
394 | harmony.format_initialized = 0; | ||
395 | |||
396 | /* Clear out all the buffers and flush to cache */ | ||
397 | harmony_silence(&played_buf, 0, HARMONY_BUF_SIZE*MAX_BUFS); | ||
398 | CHECK_WBACK_INV_OFFSET(played_buf, 0, HARMONY_BUF_SIZE*MAX_BUFS); | ||
399 | |||
400 | return 0; | ||
401 | } | ||
402 | |||
403 | /* | ||
404 | * Release (close) the audio device. | ||
405 | */ | ||
406 | |||
407 | static int harmony_audio_release(struct inode *inode, struct file *file) | ||
408 | { | ||
409 | if (!harmony.audio_open) | ||
410 | return -EBUSY; | ||
411 | |||
412 | harmony.audio_open = 0; | ||
413 | |||
414 | return 0; | ||
415 | } | ||
416 | |||
417 | /* | ||
418 | * Read recorded data off the audio device. | ||
419 | */ | ||
420 | |||
421 | static ssize_t harmony_audio_read(struct file *file, | ||
422 | char *buffer, | ||
423 | size_t size_count, | ||
424 | loff_t *ppos) | ||
425 | { | ||
426 | int total_count = (int) size_count; | ||
427 | int count = 0; | ||
428 | int buf_to_read; | ||
429 | |||
430 | while (count<total_count) { | ||
431 | /* Wait until we're out of control mode */ | ||
432 | harmony_wait_CNTL(); | ||
433 | |||
434 | /* Figure out which buffer to fill in */ | ||
435 | if (harmony.nb_filled_record <= 2) { | ||
436 | harmony.blocked_recording = 1; | ||
437 | if (harmony.suspended_recording) { | ||
438 | harmony.suspended_recording = 0; | ||
439 | harmony_enable_interrupts(); | ||
440 | } | ||
441 | |||
442 | interruptible_sleep_on(&harmony.wq_record); | ||
443 | harmony.blocked_recording = 0; | ||
444 | } | ||
445 | |||
446 | if (harmony.nb_filled_record < 2) | ||
447 | return -EBUSY; | ||
448 | |||
449 | buf_to_read = harmony.first_filled_record; | ||
450 | |||
451 | /* Copy the page to an aligned buffer */ | ||
452 | if (copy_to_user(buffer+count, recorded_buf.addr + | ||
453 | (HARMONY_BUF_SIZE*buf_to_read), | ||
454 | HARMONY_BUF_SIZE)) { | ||
455 | count = -EFAULT; | ||
456 | break; | ||
457 | } | ||
458 | |||
459 | harmony.nb_filled_record--; | ||
460 | harmony.first_filled_record++; | ||
461 | harmony.first_filled_record %= MAX_BUFS; | ||
462 | |||
463 | count += HARMONY_BUF_SIZE; | ||
464 | } | ||
465 | return count; | ||
466 | } | ||
467 | |||
468 | |||
469 | |||
470 | |||
471 | /* | ||
472 | * Here is the place where we try to recognize file format. | ||
473 | * Sun/NeXT .au files begin with the string .snd | ||
474 | * At offset 12 is specified the encoding. | ||
475 | * At offset 16 is specified speed rate | ||
476 | * At Offset 20 is specified the numbers of voices | ||
477 | */ | ||
478 | |||
479 | #define four_bytes_to_u32(start) (file_header[start] << 24)|\ | ||
480 | (file_header[start+1] << 16)|\ | ||
481 | (file_header[start+2] << 8)|\ | ||
482 | (file_header[start+3]); | ||
483 | |||
484 | #define test_rate(tested,real_value,harmony_value) if ((tested)<=(real_value))\ | ||
485 | |||
486 | |||
487 | static int harmony_format_auto_detect(const char *buffer, int block_size) | ||
488 | { | ||
489 | u8 file_header[24]; | ||
490 | u32 start_string; | ||
491 | int ret = 0; | ||
492 | |||
493 | if (block_size>24) { | ||
494 | if (copy_from_user(file_header, buffer, sizeof(file_header))) | ||
495 | ret = -EFAULT; | ||
496 | |||
497 | start_string = four_bytes_to_u32(0); | ||
498 | |||
499 | if ((file_header[4]==0) && (start_string==0x2E736E64)) { | ||
500 | u32 format; | ||
501 | u32 nb_voices; | ||
502 | u32 speed; | ||
503 | |||
504 | format = four_bytes_to_u32(12); | ||
505 | nb_voices = four_bytes_to_u32(20); | ||
506 | speed = four_bytes_to_u32(16); | ||
507 | |||
508 | switch (format) { | ||
509 | case HARMONY_MAGIC_8B_ULAW: | ||
510 | harmony.data_format = HARMONY_DF_8BIT_ULAW; | ||
511 | break; | ||
512 | case HARMONY_MAGIC_8B_ALAW: | ||
513 | harmony.data_format = HARMONY_DF_8BIT_ALAW; | ||
514 | break; | ||
515 | case HARMONY_MAGIC_16B_LINEAR: | ||
516 | harmony.data_format = HARMONY_DF_16BIT_LINEAR; | ||
517 | break; | ||
518 | default: | ||
519 | harmony_set_control(HARMONY_DF_16BIT_LINEAR, | ||
520 | HARMONY_SR_44KHZ, HARMONY_SS_STEREO); | ||
521 | goto out; | ||
522 | } | ||
523 | switch (nb_voices) { | ||
524 | case HARMONY_MAGIC_MONO: | ||
525 | harmony.stereo_select = HARMONY_SS_MONO; | ||
526 | break; | ||
527 | case HARMONY_MAGIC_STEREO: | ||
528 | harmony.stereo_select = HARMONY_SS_STEREO; | ||
529 | break; | ||
530 | default: | ||
531 | harmony.stereo_select = HARMONY_SS_MONO; | ||
532 | break; | ||
533 | } | ||
534 | harmony_set_rate(harmony_detect_rate(&speed)); | ||
535 | harmony.dac_rate = speed; | ||
536 | goto out; | ||
537 | } | ||
538 | } | ||
539 | harmony_set_control(HARMONY_DF_8BIT_ULAW, HARMONY_SR_8KHZ, HARMONY_SS_MONO); | ||
540 | out: | ||
541 | return ret; | ||
542 | } | ||
543 | #undef four_bytes_to_u32 | ||
544 | |||
545 | |||
546 | static ssize_t harmony_audio_write(struct file *file, | ||
547 | const char *buffer, | ||
548 | size_t size_count, | ||
549 | loff_t *ppos) | ||
550 | { | ||
551 | int total_count = (int) size_count; | ||
552 | int count = 0; | ||
553 | int frame_size; | ||
554 | int buf_to_fill; | ||
555 | int fresh_buffer; | ||
556 | |||
557 | if (!harmony.format_initialized) { | ||
558 | if (harmony_format_auto_detect(buffer, total_count)) | ||
559 | return -EFAULT; | ||
560 | } | ||
561 | |||
562 | while (count<total_count) { | ||
563 | /* Wait until we're out of control mode */ | ||
564 | harmony_wait_CNTL(); | ||
565 | |||
566 | /* Figure out which buffer to fill in */ | ||
567 | if (harmony.nb_filled_play+2 >= MAX_BUFS && !harmony.play_offset) { | ||
568 | harmony.blocked_playing = 1; | ||
569 | interruptible_sleep_on(&harmony.wq_play); | ||
570 | harmony.blocked_playing = 0; | ||
571 | } | ||
572 | if (harmony.nb_filled_play+2 >= MAX_BUFS && !harmony.play_offset) | ||
573 | return -EBUSY; | ||
574 | |||
575 | |||
576 | buf_to_fill = (harmony.first_filled_play+harmony.nb_filled_play); | ||
577 | if (harmony.play_offset) { | ||
578 | buf_to_fill--; | ||
579 | buf_to_fill += MAX_BUFS; | ||
580 | } | ||
581 | buf_to_fill %= MAX_BUFS; | ||
582 | |||
583 | fresh_buffer = (harmony.play_offset == 0); | ||
584 | |||
585 | /* Figure out the size of the frame */ | ||
586 | if ((total_count-count) >= HARMONY_BUF_SIZE - harmony.play_offset) { | ||
587 | frame_size = HARMONY_BUF_SIZE - harmony.play_offset; | ||
588 | } else { | ||
589 | frame_size = total_count - count; | ||
590 | /* Clear out the buffer, since there we'll only be | ||
591 | overlaying part of the old buffer with the new one */ | ||
592 | harmony_silence(&played_buf, | ||
593 | HARMONY_BUF_SIZE*buf_to_fill+frame_size+harmony.play_offset, | ||
594 | HARMONY_BUF_SIZE-frame_size-harmony.play_offset); | ||
595 | } | ||
596 | |||
597 | /* Copy the page to an aligned buffer */ | ||
598 | if (copy_from_user(played_buf.addr +(HARMONY_BUF_SIZE*buf_to_fill) + harmony.play_offset, | ||
599 | buffer+count, frame_size)) | ||
600 | return -EFAULT; | ||
601 | CHECK_WBACK_INV_OFFSET(played_buf, (HARMONY_BUF_SIZE*buf_to_fill + harmony.play_offset), | ||
602 | frame_size); | ||
603 | |||
604 | if (fresh_buffer) | ||
605 | harmony.nb_filled_play++; | ||
606 | |||
607 | count += frame_size; | ||
608 | harmony.play_offset += frame_size; | ||
609 | harmony.play_offset %= HARMONY_BUF_SIZE; | ||
610 | if (harmony.suspended_playing && (harmony.nb_filled_play>=4)) | ||
611 | harmony_enable_interrupts(); | ||
612 | } | ||
613 | |||
614 | return count; | ||
615 | } | ||
616 | |||
617 | static unsigned int harmony_audio_poll(struct file *file, | ||
618 | struct poll_table_struct *wait) | ||
619 | { | ||
620 | unsigned int mask = 0; | ||
621 | |||
622 | if (file->f_mode & FMODE_READ) { | ||
623 | if (!harmony.suspended_recording) | ||
624 | poll_wait(file, &harmony.wq_record, wait); | ||
625 | if (harmony.nb_filled_record) | ||
626 | mask |= POLLIN | POLLRDNORM; | ||
627 | } | ||
628 | |||
629 | if (file->f_mode & FMODE_WRITE) { | ||
630 | if (!harmony.suspended_playing) | ||
631 | poll_wait(file, &harmony.wq_play, wait); | ||
632 | if (harmony.nb_filled_play) | ||
633 | mask |= POLLOUT | POLLWRNORM; | ||
634 | } | ||
635 | |||
636 | return mask; | ||
637 | } | ||
638 | |||
639 | static int harmony_audio_ioctl(struct inode *inode, | ||
640 | struct file *file, | ||
641 | unsigned int cmd, | ||
642 | unsigned long arg) | ||
643 | { | ||
644 | int ival, new_format; | ||
645 | int frag_size, frag_buf; | ||
646 | struct audio_buf_info info; | ||
647 | |||
648 | switch (cmd) { | ||
649 | case OSS_GETVERSION: | ||
650 | return put_user(SOUND_VERSION, (int *) arg); | ||
651 | |||
652 | case SNDCTL_DSP_GETCAPS: | ||
653 | ival = DSP_CAP_DUPLEX; | ||
654 | return put_user(ival, (int *) arg); | ||
655 | |||
656 | case SNDCTL_DSP_GETFMTS: | ||
657 | ival = (AFMT_S16_BE | AFMT_MU_LAW | AFMT_A_LAW ); | ||
658 | return put_user(ival, (int *) arg); | ||
659 | |||
660 | case SNDCTL_DSP_SETFMT: | ||
661 | if (get_user(ival, (int *) arg)) | ||
662 | return -EFAULT; | ||
663 | if (ival != AFMT_QUERY) { | ||
664 | switch (ival) { | ||
665 | case AFMT_MU_LAW: new_format = HARMONY_DF_8BIT_ULAW; break; | ||
666 | case AFMT_A_LAW: new_format = HARMONY_DF_8BIT_ALAW; break; | ||
667 | case AFMT_S16_BE: new_format = HARMONY_DF_16BIT_LINEAR; break; | ||
668 | default: { | ||
669 | DPRINTK(KERN_WARNING PFX | ||
670 | "unsupported sound format 0x%04x requested.\n", | ||
671 | ival); | ||
672 | ival = AFMT_S16_BE; | ||
673 | return put_user(ival, (int *) arg); | ||
674 | } | ||
675 | } | ||
676 | harmony_set_format(new_format); | ||
677 | return 0; | ||
678 | } else { | ||
679 | switch (harmony.data_format) { | ||
680 | case HARMONY_DF_8BIT_ULAW: ival = AFMT_MU_LAW; break; | ||
681 | case HARMONY_DF_8BIT_ALAW: ival = AFMT_A_LAW; break; | ||
682 | case HARMONY_DF_16BIT_LINEAR: ival = AFMT_U16_BE; break; | ||
683 | default: ival = 0; | ||
684 | } | ||
685 | return put_user(ival, (int *) arg); | ||
686 | } | ||
687 | |||
688 | case SOUND_PCM_READ_RATE: | ||
689 | ival = harmony.dac_rate; | ||
690 | return put_user(ival, (int *) arg); | ||
691 | |||
692 | case SNDCTL_DSP_SPEED: | ||
693 | if (get_user(ival, (int *) arg)) | ||
694 | return -EFAULT; | ||
695 | harmony_set_rate(harmony_detect_rate(&ival)); | ||
696 | harmony.dac_rate = ival; | ||
697 | return put_user(ival, (int*) arg); | ||
698 | |||
699 | case SNDCTL_DSP_STEREO: | ||
700 | if (get_user(ival, (int *) arg)) | ||
701 | return -EFAULT; | ||
702 | if (ival != 0 && ival != 1) | ||
703 | return -EINVAL; | ||
704 | harmony_set_stereo(ival); | ||
705 | return 0; | ||
706 | |||
707 | case SNDCTL_DSP_CHANNELS: | ||
708 | if (get_user(ival, (int *) arg)) | ||
709 | return -EFAULT; | ||
710 | if (ival != 1 && ival != 2) { | ||
711 | ival = harmony.stereo_select == HARMONY_SS_MONO ? 1 : 2; | ||
712 | return put_user(ival, (int *) arg); | ||
713 | } | ||
714 | harmony_set_stereo(ival-1); | ||
715 | return 0; | ||
716 | |||
717 | case SNDCTL_DSP_GETBLKSIZE: | ||
718 | ival = HARMONY_BUF_SIZE; | ||
719 | return put_user(ival, (int *) arg); | ||
720 | |||
721 | case SNDCTL_DSP_NONBLOCK: | ||
722 | file->f_flags |= O_NONBLOCK; | ||
723 | return 0; | ||
724 | |||
725 | case SNDCTL_DSP_RESET: | ||
726 | if (!harmony.suspended_recording) { | ||
727 | /* TODO: stop_recording() */ | ||
728 | } | ||
729 | return 0; | ||
730 | |||
731 | case SNDCTL_DSP_SETFRAGMENT: | ||
732 | if (get_user(ival, (int *)arg)) | ||
733 | return -EFAULT; | ||
734 | frag_size = ival & 0xffff; | ||
735 | frag_buf = (ival>>16) & 0xffff; | ||
736 | /* TODO: We use hardcoded fragment sizes and numbers for now */ | ||
737 | frag_size = 12; /* 4096 == 2^12 */ | ||
738 | frag_buf = MAX_BUFS; | ||
739 | ival = (frag_buf << 16) + frag_size; | ||
740 | return put_user(ival, (int *) arg); | ||
741 | |||
742 | case SNDCTL_DSP_GETOSPACE: | ||
743 | if (!(file->f_mode & FMODE_WRITE)) | ||
744 | return -EINVAL; | ||
745 | info.fragstotal = MAX_BUFS; | ||
746 | info.fragments = MAX_BUFS - harmony.nb_filled_play; | ||
747 | info.fragsize = HARMONY_BUF_SIZE; | ||
748 | info.bytes = info.fragments * info.fragsize; | ||
749 | return copy_to_user((void *)arg, &info, sizeof(info)) ? -EFAULT : 0; | ||
750 | |||
751 | case SNDCTL_DSP_GETISPACE: | ||
752 | if (!(file->f_mode & FMODE_READ)) | ||
753 | return -EINVAL; | ||
754 | info.fragstotal = MAX_BUFS; | ||
755 | info.fragments = /*MAX_BUFS-*/ harmony.nb_filled_record; | ||
756 | info.fragsize = HARMONY_BUF_SIZE; | ||
757 | info.bytes = info.fragments * info.fragsize; | ||
758 | return copy_to_user((void *)arg, &info, sizeof(info)) ? -EFAULT : 0; | ||
759 | |||
760 | case SNDCTL_DSP_SYNC: | ||
761 | return 0; | ||
762 | } | ||
763 | |||
764 | return -EINVAL; | ||
765 | } | ||
766 | |||
767 | |||
768 | /* | ||
769 | * harmony_interrupt() | ||
770 | * | ||
771 | * harmony interruption service routine | ||
772 | * | ||
773 | */ | ||
774 | |||
775 | static irqreturn_t harmony_interrupt(int irq, void *dev, struct pt_regs *regs) | ||
776 | { | ||
777 | u32 dstatus; | ||
778 | struct harmony_hpa *hpa; | ||
779 | |||
780 | /* Setup the hpa */ | ||
781 | hpa = ((struct harmony_dev *)dev)->hpa; | ||
782 | harmony_wait_CNTL(); | ||
783 | |||
784 | /* Read dstatus and pcuradd (the current address) */ | ||
785 | dstatus = gsc_readl(&hpa->dstatus); | ||
786 | |||
787 | /* Turn off interrupts */ | ||
788 | harmony_disable_interrupts(); | ||
789 | |||
790 | /* Check if this is a request to get the next play buffer */ | ||
791 | if (dstatus & DSTATUS_PN) { | ||
792 | if (!harmony.nb_filled_play) { | ||
793 | harmony.suspended_playing = 1; | ||
794 | gsc_writel((unsigned long)silent.dma_handle, &hpa->pnxtadd); | ||
795 | |||
796 | if (!harmony.suspended_recording) | ||
797 | harmony_enable_interrupts(); | ||
798 | } else { | ||
799 | harmony.suspended_playing = 0; | ||
800 | gsc_writel((unsigned long)played_buf.dma_handle + | ||
801 | (HARMONY_BUF_SIZE*harmony.first_filled_play), | ||
802 | &hpa->pnxtadd); | ||
803 | harmony.first_filled_play++; | ||
804 | harmony.first_filled_play %= MAX_BUFS; | ||
805 | harmony.nb_filled_play--; | ||
806 | |||
807 | harmony_enable_interrupts(); | ||
808 | } | ||
809 | |||
810 | if (harmony.blocked_playing) | ||
811 | wake_up_interruptible(&harmony.wq_play); | ||
812 | } | ||
813 | |||
814 | /* Check if we're being asked to fill in a recording buffer */ | ||
815 | if (dstatus & DSTATUS_RN) { | ||
816 | if((harmony.nb_filled_record+2>=MAX_BUFS) || harmony.suspended_recording) | ||
817 | { | ||
818 | harmony.nb_filled_record = 0; | ||
819 | harmony.first_filled_record = 0; | ||
820 | harmony.suspended_recording = 1; | ||
821 | gsc_writel((unsigned long)graveyard.dma_handle, &hpa->rnxtadd); | ||
822 | if (!harmony.suspended_playing) | ||
823 | harmony_enable_interrupts(); | ||
824 | } else { | ||
825 | int buf_to_fill; | ||
826 | buf_to_fill = (harmony.first_filled_record+harmony.nb_filled_record) % MAX_BUFS; | ||
827 | CHECK_WBACK_INV_OFFSET(recorded_buf, HARMONY_BUF_SIZE*buf_to_fill, HARMONY_BUF_SIZE); | ||
828 | gsc_writel((unsigned long)recorded_buf.dma_handle + | ||
829 | HARMONY_BUF_SIZE*buf_to_fill, | ||
830 | &hpa->rnxtadd); | ||
831 | harmony.nb_filled_record++; | ||
832 | harmony_enable_interrupts(); | ||
833 | } | ||
834 | |||
835 | if (harmony.blocked_recording && harmony.nb_filled_record>3) | ||
836 | wake_up_interruptible(&harmony.wq_record); | ||
837 | } | ||
838 | return IRQ_HANDLED; | ||
839 | } | ||
840 | |||
841 | /* | ||
842 | * Sound playing functions | ||
843 | */ | ||
844 | |||
845 | static struct file_operations harmony_audio_fops = { | ||
846 | .owner = THIS_MODULE, | ||
847 | .llseek = no_llseek, | ||
848 | .read = harmony_audio_read, | ||
849 | .write = harmony_audio_write, | ||
850 | .poll = harmony_audio_poll, | ||
851 | .ioctl = harmony_audio_ioctl, | ||
852 | .open = harmony_audio_open, | ||
853 | .release = harmony_audio_release, | ||
854 | }; | ||
855 | |||
856 | static int harmony_audio_init(void) | ||
857 | { | ||
858 | /* Request that IRQ */ | ||
859 | if (request_irq(harmony.dev->irq, harmony_interrupt, 0 ,"harmony", &harmony)) { | ||
860 | printk(KERN_ERR PFX "Error requesting irq %d.\n", harmony.dev->irq); | ||
861 | return -EFAULT; | ||
862 | } | ||
863 | |||
864 | harmony.dsp_unit = register_sound_dsp(&harmony_audio_fops, -1); | ||
865 | if (harmony.dsp_unit < 0) { | ||
866 | printk(KERN_ERR PFX "Error registering dsp\n"); | ||
867 | free_irq(harmony.dev->irq, &harmony); | ||
868 | return -EFAULT; | ||
869 | } | ||
870 | |||
871 | /* Clear the buffers so you don't end up with crap in the buffers. */ | ||
872 | harmony_silence(&played_buf, 0, HARMONY_BUF_SIZE*MAX_BUFS); | ||
873 | |||
874 | /* Make sure this makes it to cache */ | ||
875 | CHECK_WBACK_INV_OFFSET(played_buf, 0, HARMONY_BUF_SIZE*MAX_BUFS); | ||
876 | |||
877 | /* Clear out the silent buffer and flush to cache */ | ||
878 | harmony_silence(&silent, 0, HARMONY_BUF_SIZE); | ||
879 | CHECK_WBACK_INV_OFFSET(silent, 0, HARMONY_BUF_SIZE); | ||
880 | |||
881 | harmony.audio_open = 0; | ||
882 | |||
883 | return 0; | ||
884 | } | ||
885 | |||
886 | |||
887 | /* | ||
888 | * mixer functions | ||
889 | */ | ||
890 | |||
891 | static void harmony_mixer_set_gain(void) | ||
892 | { | ||
893 | harmony_wait_CNTL(); | ||
894 | gsc_writel(harmony.current_gain, &harmony.hpa->gainctl); | ||
895 | } | ||
896 | |||
897 | /* | ||
898 | * Read gain of selected channel. | ||
899 | * The OSS rate is from 0 (silent) to 100 -> need some conversions | ||
900 | * | ||
901 | * The harmony gain are attenuation for output and monitor gain. | ||
902 | * is amplifaction for input gain | ||
903 | */ | ||
904 | #define to_harmony_level(level,max) ((level)*max/100) | ||
905 | #define to_oss_level(level,max) ((level)*100/max) | ||
906 | |||
907 | static int harmony_mixer_get_level(int channel) | ||
908 | { | ||
909 | int left_level; | ||
910 | int right_level; | ||
911 | |||
912 | switch (channel) { | ||
913 | case SOUND_MIXER_VOLUME: | ||
914 | left_level = (harmony.current_gain & GAIN_LO_MASK) >> GAIN_LO_SHIFT; | ||
915 | right_level = (harmony.current_gain & GAIN_RO_MASK) >> GAIN_RO_SHIFT; | ||
916 | left_level = to_oss_level(MAX_OUTPUT_LEVEL - left_level, MAX_OUTPUT_LEVEL); | ||
917 | right_level = to_oss_level(MAX_OUTPUT_LEVEL - right_level, MAX_OUTPUT_LEVEL); | ||
918 | return (right_level << 8)+left_level; | ||
919 | |||
920 | case SOUND_MIXER_IGAIN: | ||
921 | left_level = (harmony.current_gain & GAIN_LI_MASK) >> GAIN_LI_SHIFT; | ||
922 | right_level= (harmony.current_gain & GAIN_RI_MASK) >> GAIN_RI_SHIFT; | ||
923 | left_level = to_oss_level(left_level, MAX_INPUT_LEVEL); | ||
924 | right_level= to_oss_level(right_level, MAX_INPUT_LEVEL); | ||
925 | return (right_level << 8)+left_level; | ||
926 | |||
927 | case SOUND_MIXER_MONITOR: | ||
928 | left_level = (harmony.current_gain & GAIN_MA_MASK) >> GAIN_MA_SHIFT; | ||
929 | left_level = to_oss_level(MAX_MONITOR_LEVEL-left_level, MAX_MONITOR_LEVEL); | ||
930 | return (left_level << 8)+left_level; | ||
931 | } | ||
932 | return -EINVAL; | ||
933 | } | ||
934 | |||
935 | |||
936 | |||
937 | /* | ||
938 | * Some conversions for the same reasons. | ||
939 | * We give back the new real value(s) due to | ||
940 | * the rescale. | ||
941 | */ | ||
942 | |||
943 | static int harmony_mixer_set_level(int channel, int value) | ||
944 | { | ||
945 | int left_level; | ||
946 | int right_level; | ||
947 | int new_left_level; | ||
948 | int new_right_level; | ||
949 | |||
950 | right_level = (value & 0x0000ff00) >> 8; | ||
951 | left_level = value & 0x000000ff; | ||
952 | if (right_level > 100) right_level = 100; | ||
953 | if (left_level > 100) left_level = 100; | ||
954 | |||
955 | switch (channel) { | ||
956 | case SOUND_MIXER_VOLUME: | ||
957 | right_level = to_harmony_level(100-right_level, MAX_OUTPUT_LEVEL); | ||
958 | left_level = to_harmony_level(100-left_level, MAX_OUTPUT_LEVEL); | ||
959 | new_right_level = to_oss_level(MAX_OUTPUT_LEVEL - right_level, MAX_OUTPUT_LEVEL); | ||
960 | new_left_level = to_oss_level(MAX_OUTPUT_LEVEL - left_level, MAX_OUTPUT_LEVEL); | ||
961 | harmony.current_gain = (harmony.current_gain & ~(GAIN_LO_MASK | GAIN_RO_MASK)) | ||
962 | | (left_level << GAIN_LO_SHIFT) | (right_level << GAIN_RO_SHIFT); | ||
963 | harmony_mixer_set_gain(); | ||
964 | return (new_right_level << 8) + new_left_level; | ||
965 | |||
966 | case SOUND_MIXER_IGAIN: | ||
967 | right_level = to_harmony_level(right_level, MAX_INPUT_LEVEL); | ||
968 | left_level = to_harmony_level(left_level, MAX_INPUT_LEVEL); | ||
969 | new_right_level = to_oss_level(right_level, MAX_INPUT_LEVEL); | ||
970 | new_left_level = to_oss_level(left_level, MAX_INPUT_LEVEL); | ||
971 | harmony.current_gain = (harmony.current_gain & ~(GAIN_LI_MASK | GAIN_RI_MASK)) | ||
972 | | (left_level << GAIN_LI_SHIFT) | (right_level << GAIN_RI_SHIFT); | ||
973 | harmony_mixer_set_gain(); | ||
974 | return (new_right_level << 8) + new_left_level; | ||
975 | |||
976 | case SOUND_MIXER_MONITOR: | ||
977 | left_level = to_harmony_level(100-left_level, MAX_MONITOR_LEVEL); | ||
978 | new_left_level = to_oss_level(MAX_MONITOR_LEVEL-left_level, MAX_MONITOR_LEVEL); | ||
979 | harmony.current_gain = (harmony.current_gain & ~GAIN_MA_MASK) | (left_level << GAIN_MA_SHIFT); | ||
980 | harmony_mixer_set_gain(); | ||
981 | return (new_left_level << 8) + new_left_level; | ||
982 | } | ||
983 | |||
984 | return -EINVAL; | ||
985 | } | ||
986 | |||
987 | #undef to_harmony_level | ||
988 | #undef to_oss_level | ||
989 | |||
990 | /* | ||
991 | * Return the selected input device (mic or line) | ||
992 | */ | ||
993 | |||
994 | static int harmony_mixer_get_recmask(void) | ||
995 | { | ||
996 | int current_input_line; | ||
997 | |||
998 | current_input_line = (harmony.current_gain & GAIN_IS_MASK) | ||
999 | >> GAIN_IS_SHIFT; | ||
1000 | if (current_input_line) | ||
1001 | return SOUND_MASK_MIC; | ||
1002 | |||
1003 | return SOUND_MASK_LINE; | ||
1004 | } | ||
1005 | |||
1006 | /* | ||
1007 | * Set the input (only one at time, arbitrary priority to line in) | ||
1008 | */ | ||
1009 | |||
1010 | static int harmony_mixer_set_recmask(int recmask) | ||
1011 | { | ||
1012 | int new_input_line; | ||
1013 | int new_input_mask; | ||
1014 | int current_input_line; | ||
1015 | |||
1016 | current_input_line = (harmony.current_gain & GAIN_IS_MASK) | ||
1017 | >> GAIN_IS_SHIFT; | ||
1018 | if ((current_input_line && ((recmask & SOUND_MASK_LINE) || !(recmask & SOUND_MASK_MIC))) || | ||
1019 | (!current_input_line && ((recmask & SOUND_MASK_LINE) && !(recmask & SOUND_MASK_MIC)))) { | ||
1020 | new_input_line = 0; | ||
1021 | new_input_mask = SOUND_MASK_LINE; | ||
1022 | } else { | ||
1023 | new_input_line = 1; | ||
1024 | new_input_mask = SOUND_MASK_MIC; | ||
1025 | } | ||
1026 | harmony.current_gain = ((harmony.current_gain & ~GAIN_IS_MASK) | | ||
1027 | (new_input_line << GAIN_IS_SHIFT )); | ||
1028 | harmony_mixer_set_gain(); | ||
1029 | return new_input_mask; | ||
1030 | } | ||
1031 | |||
1032 | |||
1033 | /* | ||
1034 | * give the active outlines | ||
1035 | */ | ||
1036 | |||
1037 | static int harmony_mixer_get_outmask(void) | ||
1038 | { | ||
1039 | int outmask = 0; | ||
1040 | |||
1041 | if (harmony.current_gain & GAIN_SE_MASK) outmask |= MASK_INTERNAL; | ||
1042 | if (harmony.current_gain & GAIN_LE_MASK) outmask |= MASK_LINEOUT; | ||
1043 | if (harmony.current_gain & GAIN_HE_MASK) outmask |= MASK_HEADPHONES; | ||
1044 | |||
1045 | return outmask; | ||
1046 | } | ||
1047 | |||
1048 | |||
1049 | static int harmony_mixer_set_outmask(int outmask) | ||
1050 | { | ||
1051 | if (outmask & MASK_INTERNAL) | ||
1052 | harmony.current_gain |= GAIN_SE_MASK; | ||
1053 | else | ||
1054 | harmony.current_gain &= ~GAIN_SE_MASK; | ||
1055 | |||
1056 | if (outmask & MASK_LINEOUT) | ||
1057 | harmony.current_gain |= GAIN_LE_MASK; | ||
1058 | else | ||
1059 | harmony.current_gain &= ~GAIN_LE_MASK; | ||
1060 | |||
1061 | if (outmask & MASK_HEADPHONES) | ||
1062 | harmony.current_gain |= GAIN_HE_MASK; | ||
1063 | else | ||
1064 | harmony.current_gain &= ~GAIN_HE_MASK; | ||
1065 | |||
1066 | harmony_mixer_set_gain(); | ||
1067 | |||
1068 | return (outmask & (MASK_INTERNAL | MASK_LINEOUT | MASK_HEADPHONES)); | ||
1069 | } | ||
1070 | |||
1071 | /* | ||
1072 | * This code is inspired from sb_mixer.c | ||
1073 | */ | ||
1074 | |||
1075 | static int harmony_mixer_ioctl(struct inode * inode, struct file * file, | ||
1076 | unsigned int cmd, unsigned long arg) | ||
1077 | { | ||
1078 | int val; | ||
1079 | int ret; | ||
1080 | |||
1081 | if (cmd == SOUND_MIXER_INFO) { | ||
1082 | mixer_info info; | ||
1083 | memset(&info, 0, sizeof(info)); | ||
1084 | strncpy(info.id, "harmony", sizeof(info.id)-1); | ||
1085 | strncpy(info.name, "Harmony audio", sizeof(info.name)-1); | ||
1086 | info.modify_counter = 1; /* ? */ | ||
1087 | if (copy_to_user((void *)arg, &info, sizeof(info))) | ||
1088 | return -EFAULT; | ||
1089 | return 0; | ||
1090 | } | ||
1091 | |||
1092 | if (cmd == OSS_GETVERSION) | ||
1093 | return put_user(SOUND_VERSION, (int *)arg); | ||
1094 | |||
1095 | /* read */ | ||
1096 | val = 0; | ||
1097 | if (_SIOC_DIR(cmd) & _SIOC_WRITE) | ||
1098 | if (get_user(val, (int *)arg)) | ||
1099 | return -EFAULT; | ||
1100 | |||
1101 | switch (cmd) { | ||
1102 | case MIXER_READ(SOUND_MIXER_CAPS): | ||
1103 | ret = SOUND_CAP_EXCL_INPUT; | ||
1104 | break; | ||
1105 | case MIXER_READ(SOUND_MIXER_STEREODEVS): | ||
1106 | ret = SOUND_MASK_VOLUME | SOUND_MASK_IGAIN; | ||
1107 | break; | ||
1108 | |||
1109 | case MIXER_READ(SOUND_MIXER_RECMASK): | ||
1110 | ret = SOUND_MASK_MIC | SOUND_MASK_LINE; | ||
1111 | break; | ||
1112 | case MIXER_READ(SOUND_MIXER_DEVMASK): | ||
1113 | ret = SOUND_MASK_VOLUME | SOUND_MASK_IGAIN | | ||
1114 | SOUND_MASK_MONITOR; | ||
1115 | break; | ||
1116 | case MIXER_READ(SOUND_MIXER_OUTMASK): | ||
1117 | ret = MASK_INTERNAL | MASK_LINEOUT | | ||
1118 | MASK_HEADPHONES; | ||
1119 | break; | ||
1120 | |||
1121 | case MIXER_WRITE(SOUND_MIXER_RECSRC): | ||
1122 | ret = harmony_mixer_set_recmask(val); | ||
1123 | break; | ||
1124 | case MIXER_READ(SOUND_MIXER_RECSRC): | ||
1125 | ret = harmony_mixer_get_recmask(); | ||
1126 | break; | ||
1127 | |||
1128 | case MIXER_WRITE(SOUND_MIXER_OUTSRC): | ||
1129 | ret = harmony_mixer_set_outmask(val); | ||
1130 | break; | ||
1131 | case MIXER_READ(SOUND_MIXER_OUTSRC): | ||
1132 | ret = harmony_mixer_get_outmask(); | ||
1133 | break; | ||
1134 | |||
1135 | case MIXER_WRITE(SOUND_MIXER_VOLUME): | ||
1136 | case MIXER_WRITE(SOUND_MIXER_IGAIN): | ||
1137 | case MIXER_WRITE(SOUND_MIXER_MONITOR): | ||
1138 | ret = harmony_mixer_set_level(cmd & 0xff, val); | ||
1139 | break; | ||
1140 | |||
1141 | case MIXER_READ(SOUND_MIXER_VOLUME): | ||
1142 | case MIXER_READ(SOUND_MIXER_IGAIN): | ||
1143 | case MIXER_READ(SOUND_MIXER_MONITOR): | ||
1144 | ret = harmony_mixer_get_level(cmd & 0xff); | ||
1145 | break; | ||
1146 | |||
1147 | default: | ||
1148 | return -EINVAL; | ||
1149 | } | ||
1150 | |||
1151 | if (put_user(ret, (int *)arg)) | ||
1152 | return -EFAULT; | ||
1153 | return 0; | ||
1154 | } | ||
1155 | |||
1156 | |||
1157 | static int harmony_mixer_open(struct inode *inode, struct file *file) | ||
1158 | { | ||
1159 | if (harmony.mixer_open) | ||
1160 | return -EBUSY; | ||
1161 | harmony.mixer_open = 1; | ||
1162 | return 0; | ||
1163 | } | ||
1164 | |||
1165 | static int harmony_mixer_release(struct inode *inode, struct file *file) | ||
1166 | { | ||
1167 | if (!harmony.mixer_open) | ||
1168 | return -EBUSY; | ||
1169 | harmony.mixer_open = 0; | ||
1170 | return 0; | ||
1171 | } | ||
1172 | |||
1173 | static struct file_operations harmony_mixer_fops = { | ||
1174 | .owner = THIS_MODULE, | ||
1175 | .llseek = no_llseek, | ||
1176 | .open = harmony_mixer_open, | ||
1177 | .release = harmony_mixer_release, | ||
1178 | .ioctl = harmony_mixer_ioctl, | ||
1179 | }; | ||
1180 | |||
1181 | |||
1182 | /* | ||
1183 | * Mute all the output and reset Harmony. | ||
1184 | */ | ||
1185 | |||
1186 | static void __init harmony_mixer_reset(void) | ||
1187 | { | ||
1188 | harmony.current_gain = GAIN_TOTAL_SILENCE; | ||
1189 | harmony_mixer_set_gain(); | ||
1190 | harmony_wait_CNTL(); | ||
1191 | gsc_writel(1, &harmony.hpa->reset); | ||
1192 | mdelay(50); /* wait 50 ms */ | ||
1193 | gsc_writel(0, &harmony.hpa->reset); | ||
1194 | harmony.current_gain = GAIN_DEFAULT; | ||
1195 | harmony_mixer_set_gain(); | ||
1196 | } | ||
1197 | |||
1198 | static int __init harmony_mixer_init(void) | ||
1199 | { | ||
1200 | /* Register the device file operations */ | ||
1201 | harmony.mixer_unit = register_sound_mixer(&harmony_mixer_fops, -1); | ||
1202 | if (harmony.mixer_unit < 0) { | ||
1203 | printk(KERN_WARNING PFX "Error Registering Mixer Driver\n"); | ||
1204 | return -EFAULT; | ||
1205 | } | ||
1206 | |||
1207 | harmony_mixer_reset(); | ||
1208 | harmony.mixer_open = 0; | ||
1209 | |||
1210 | return 0; | ||
1211 | } | ||
1212 | |||
1213 | |||
1214 | |||
1215 | /* | ||
1216 | * This is the callback that's called by the inventory hardware code | ||
1217 | * if it finds a match to the registered driver. | ||
1218 | */ | ||
1219 | static int __devinit | ||
1220 | harmony_driver_probe(struct parisc_device *dev) | ||
1221 | { | ||
1222 | u8 id; | ||
1223 | u8 rev; | ||
1224 | u32 cntl; | ||
1225 | int ret; | ||
1226 | |||
1227 | if (harmony.hpa) { | ||
1228 | /* We only support one Harmony at this time */ | ||
1229 | printk(KERN_ERR PFX "driver already registered\n"); | ||
1230 | return -EBUSY; | ||
1231 | } | ||
1232 | |||
1233 | if (!dev->irq) { | ||
1234 | printk(KERN_ERR PFX "no irq found\n"); | ||
1235 | return -ENODEV; | ||
1236 | } | ||
1237 | |||
1238 | /* Set the HPA of harmony */ | ||
1239 | harmony.hpa = (struct harmony_hpa *)dev->hpa; | ||
1240 | harmony.dev = dev; | ||
1241 | |||
1242 | /* Grab the ID and revision from the device */ | ||
1243 | id = gsc_readb(&harmony.hpa->id); | ||
1244 | if ((id | 1) != 0x15) { | ||
1245 | printk(KERN_WARNING PFX "wrong harmony id 0x%02x\n", id); | ||
1246 | return -EBUSY; | ||
1247 | } | ||
1248 | cntl = gsc_readl(&harmony.hpa->cntl); | ||
1249 | rev = (cntl>>20) & 0xff; | ||
1250 | |||
1251 | printk(KERN_INFO "Lasi Harmony Audio driver " HARMONY_VERSION ", " | ||
1252 | "h/w id %i, rev. %i at 0x%lx, IRQ %i\n", | ||
1253 | id, rev, dev->hpa, harmony.dev->irq); | ||
1254 | |||
1255 | /* Make sure the control bit isn't set, although I don't think it | ||
1256 | ever is. */ | ||
1257 | if (cntl & CNTL_C) { | ||
1258 | printk(KERN_WARNING PFX "CNTL busy\n"); | ||
1259 | harmony.hpa = 0; | ||
1260 | return -EBUSY; | ||
1261 | } | ||
1262 | |||
1263 | /* Initialize the memory buffers */ | ||
1264 | if (harmony_alloc_buffer(&played_buf, MAX_BUFS) || | ||
1265 | harmony_alloc_buffer(&recorded_buf, MAX_BUFS) || | ||
1266 | harmony_alloc_buffer(&graveyard, 1) || | ||
1267 | harmony_alloc_buffer(&silent, 1)) { | ||
1268 | ret = -EBUSY; | ||
1269 | goto out_err; | ||
1270 | } | ||
1271 | |||
1272 | /* Initialize /dev/mixer and /dev/audio */ | ||
1273 | if ((ret=harmony_mixer_init())) | ||
1274 | goto out_err; | ||
1275 | if ((ret=harmony_audio_init())) | ||
1276 | goto out_err; | ||
1277 | |||
1278 | return 0; | ||
1279 | |||
1280 | out_err: | ||
1281 | harmony.hpa = 0; | ||
1282 | harmony_free_buffer(&played_buf); | ||
1283 | harmony_free_buffer(&recorded_buf); | ||
1284 | harmony_free_buffer(&graveyard); | ||
1285 | harmony_free_buffer(&silent); | ||
1286 | return ret; | ||
1287 | } | ||
1288 | |||
1289 | |||
1290 | static struct parisc_device_id harmony_tbl[] = { | ||
1291 | /* { HPHW_FIO, HVERSION_REV_ANY_ID, HVERSION_ANY_ID, 0x0007A }, Bushmaster/Flounder */ | ||
1292 | { HPHW_FIO, HVERSION_REV_ANY_ID, HVERSION_ANY_ID, 0x0007B }, /* 712/715 Audio */ | ||
1293 | { HPHW_FIO, HVERSION_REV_ANY_ID, HVERSION_ANY_ID, 0x0007E }, /* Pace Audio */ | ||
1294 | { HPHW_FIO, HVERSION_REV_ANY_ID, HVERSION_ANY_ID, 0x0007F }, /* Outfield / Coral II */ | ||
1295 | { 0, } | ||
1296 | }; | ||
1297 | |||
1298 | MODULE_DEVICE_TABLE(parisc, harmony_tbl); | ||
1299 | |||
1300 | static struct parisc_driver harmony_driver = { | ||
1301 | .name = "Lasi Harmony", | ||
1302 | .id_table = harmony_tbl, | ||
1303 | .probe = harmony_driver_probe, | ||
1304 | }; | ||
1305 | |||
1306 | static int __init init_harmony(void) | ||
1307 | { | ||
1308 | return register_parisc_driver(&harmony_driver); | ||
1309 | } | ||
1310 | |||
1311 | static void __exit cleanup_harmony(void) | ||
1312 | { | ||
1313 | free_irq(harmony.dev->irq, &harmony); | ||
1314 | unregister_sound_mixer(harmony.mixer_unit); | ||
1315 | unregister_sound_dsp(harmony.dsp_unit); | ||
1316 | harmony_free_buffer(&played_buf); | ||
1317 | harmony_free_buffer(&recorded_buf); | ||
1318 | harmony_free_buffer(&graveyard); | ||
1319 | harmony_free_buffer(&silent); | ||
1320 | unregister_parisc_driver(&harmony_driver); | ||
1321 | } | ||
1322 | |||
1323 | |||
1324 | MODULE_AUTHOR("Alex DeVries <alex@onefishtwo.ca>"); | ||
1325 | MODULE_DESCRIPTION("Harmony sound driver"); | ||
1326 | MODULE_LICENSE("GPL"); | ||
1327 | |||
1328 | module_init(init_harmony); | ||
1329 | module_exit(cleanup_harmony); | ||
1330 | |||