Merge branch 'for-jeff' of git://htj.dyndns.org/libata-tj into tejun-merge
[linux-2.6] / sound / oss / harmony.c
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.start;
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.start, 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