[PARISC] Update harmony from parisc tree
[linux-2.6.git] / sound / parisc / harmony.c
1 /* Hewlett-Packard Harmony audio driver
2  *
3  *   This is a driver for the Harmony audio chipset found
4  *   on the LASI ASIC of various early HP PA-RISC workstations.
5  *
6  *   Copyright (C) 2004, Kyle McMartin <kyle@{debian.org,parisc-linux.org}>
7  *
8  *     Based on the previous Harmony incarnations by,
9  *       Copyright 2000 (c) Linuxcare Canada, Alex deVries
10  *       Copyright 2000-2003 (c) Helge Deller
11  *       Copyright 2001 (c) Matthieu Delahaye
12  *       Copyright 2001 (c) Jean-Christophe Vaugeois
13  *       Copyright 2003 (c) Laurent Canet
14  *       Copyright 2004 (c) Stuart Brady
15  *
16  *   This program is free software; you can redistribute it and/or modify
17  *   it under the terms of the GNU General Public License, version 2, as
18  *   published by the Free Software Foundation.
19  *
20  *   This program is distributed in the hope that it will be useful,
21  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
22  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
23  *   GNU General Public License for more details.
24  *
25  *   You should have received a copy of the GNU General Public License
26  *   along with this program; if not, write to the Free Software
27  *   Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
28  *
29  * Notes:
30  *   - graveyard and silence buffers last for lifetime of
31  *     the driver. playback and capture buffers are allocated
32  *     per _open()/_close().
33  * 
34  * TODO:
35  *
36  */
37
38 #include <linux/init.h>
39 #include <linux/slab.h>
40 #include <linux/time.h>
41 #include <linux/wait.h>
42 #include <linux/delay.h>
43 #include <linux/module.h>
44 #include <linux/interrupt.h>
45 #include <linux/spinlock.h>
46 #include <linux/dma-mapping.h>
47
48 #include <sound/driver.h>
49 #include <sound/core.h>
50 #include <sound/pcm.h>
51 #include <sound/control.h>
52 #include <sound/rawmidi.h>
53 #include <sound/initval.h>
54 #include <sound/info.h>
55
56 #include <asm/io.h>
57 #include <asm/hardware.h>
58 #include <asm/parisc-device.h>
59
60 #include "harmony.h"
61
62 static struct parisc_device_id snd_harmony_devtable[] = {
63         /* bushmaster / flounder */
64         { HPHW_FIO, HVERSION_REV_ANY_ID, HVERSION_ANY_ID, 0x0007A }, 
65         /* 712 / 715 */
66         { HPHW_FIO, HVERSION_REV_ANY_ID, HVERSION_ANY_ID, 0x0007B }, 
67         /* pace */
68         { HPHW_FIO, HVERSION_REV_ANY_ID, HVERSION_ANY_ID, 0x0007E }, 
69         /* outfield / coral II */
70         { HPHW_FIO, HVERSION_REV_ANY_ID, HVERSION_ANY_ID, 0x0007F },
71         { 0, }
72 };
73
74 MODULE_DEVICE_TABLE(parisc, snd_harmony_devtable);
75
76 #define NAME "harmony"
77 #define PFX  NAME ": "
78
79 static unsigned int snd_harmony_rates[] = {
80         5512, 6615, 8000, 9600,
81         11025, 16000, 18900, 22050,
82         27428, 32000, 33075, 37800,
83         44100, 48000
84 };
85
86 static unsigned int rate_bits[14] = {
87         HARMONY_SR_5KHZ, HARMONY_SR_6KHZ, HARMONY_SR_8KHZ,
88         HARMONY_SR_9KHZ, HARMONY_SR_11KHZ, HARMONY_SR_16KHZ,
89         HARMONY_SR_18KHZ, HARMONY_SR_22KHZ, HARMONY_SR_27KHZ,
90         HARMONY_SR_32KHZ, HARMONY_SR_33KHZ, HARMONY_SR_37KHZ,
91         HARMONY_SR_44KHZ, HARMONY_SR_48KHZ
92 };
93
94 static snd_pcm_hw_constraint_list_t hw_constraint_rates = {
95         .count = ARRAY_SIZE(snd_harmony_rates),
96         .list = snd_harmony_rates,
97         .mask = 0,
98 };
99
100 inline unsigned long
101 harmony_read(harmony_t *h, unsigned r)
102 {
103         return __raw_readl(h->iobase + r);
104 }
105
106 inline void
107 harmony_write(harmony_t *h, unsigned r, unsigned long v)
108 {
109         __raw_writel(v, h->iobase + r);
110 }
111
112 static void
113 harmony_wait_for_control(harmony_t *h)
114 {
115         while (harmony_read(h, HARMONY_CNTL) & HARMONY_CNTL_C) ;
116 }
117
118 inline void
119 harmony_reset(harmony_t *h)
120 {
121         harmony_write(h, HARMONY_RESET, 1);
122         mdelay(50);
123         harmony_write(h, HARMONY_RESET, 0);
124 }
125
126 static void
127 harmony_disable_interrupts(harmony_t *h)
128 {
129         u32 dstatus;
130         harmony_wait_for_control(h);
131         dstatus = harmony_read(h, HARMONY_DSTATUS);
132         dstatus &= ~HARMONY_DSTATUS_IE;
133         harmony_write(h, HARMONY_DSTATUS, dstatus);
134 }
135
136 static void
137 harmony_enable_interrupts(harmony_t *h)
138 {
139         u32 dstatus;
140         harmony_wait_for_control(h);
141         dstatus = harmony_read(h, HARMONY_DSTATUS);
142         dstatus |= HARMONY_DSTATUS_IE;
143         harmony_write(h, HARMONY_DSTATUS, dstatus);
144 }
145
146 static void
147 harmony_mute(harmony_t *h)
148 {
149         unsigned long flags;
150
151         spin_lock_irqsave(&h->mixer_lock, flags);
152         harmony_wait_for_control(h);
153         harmony_write(h, HARMONY_GAINCTL, HARMONY_GAIN_SILENCE);
154         spin_unlock_irqrestore(&h->mixer_lock, flags);
155 }
156
157 static void
158 harmony_unmute(harmony_t *h)
159 {
160         unsigned long flags;
161
162         spin_lock_irqsave(&h->mixer_lock, flags);
163         harmony_wait_for_control(h);
164         harmony_write(h, HARMONY_GAINCTL, h->st.gain);
165         spin_unlock_irqrestore(&h->mixer_lock, flags);
166 }
167
168 static void
169 harmony_set_control(harmony_t *h)
170 {
171         u32 ctrl;
172         unsigned long flags;
173
174         spin_lock_irqsave(&h->lock, flags);
175
176         ctrl = (HARMONY_CNTL_C      |
177                 (h->st.format << 6) |
178                 (h->st.stereo << 5) |
179                 (h->st.rate));
180
181         harmony_wait_for_control(h);
182         harmony_write(h, HARMONY_CNTL, ctrl);
183
184         spin_unlock_irqrestore(&h->lock, flags);
185 }
186
187 static irqreturn_t
188 snd_harmony_interrupt(int irq, void *dev, struct pt_regs *regs)
189 {
190         u32 dstatus;
191         harmony_t *h = dev;
192
193         spin_lock(&h->lock);
194         harmony_disable_interrupts(h);
195         harmony_wait_for_control(h);
196         dstatus = harmony_read(h, HARMONY_DSTATUS);
197         spin_unlock(&h->lock);
198
199         if (dstatus & HARMONY_DSTATUS_PN) {
200                 if (h->psubs && h->st.playing) {
201                         spin_lock(&h->lock);
202                         h->pbuf.buf += h->pbuf.count; /* PAGE_SIZE */
203                         h->pbuf.buf %= h->pbuf.size; /* MAX_BUFS*PAGE_SIZE */
204
205                         harmony_write(h, HARMONY_PNXTADD, 
206                                       h->pbuf.addr + h->pbuf.buf);
207                         h->stats.play_intr++;
208                         spin_unlock(&h->lock);
209                         snd_pcm_period_elapsed(h->psubs);
210                 } else {
211                         spin_lock(&h->lock);
212                         harmony_write(h, HARMONY_PNXTADD, h->sdma.addr);
213                         h->stats.silence_intr++;
214                         spin_unlock(&h->lock);
215                 }
216         }
217
218         if (dstatus & HARMONY_DSTATUS_RN) {
219                 if (h->csubs && h->st.capturing) {
220                         spin_lock(&h->lock);
221                         h->cbuf.buf += h->cbuf.count;
222                         h->cbuf.buf %= h->cbuf.size;
223
224                         harmony_write(h, HARMONY_RNXTADD,
225                                       h->cbuf.addr + h->cbuf.buf);
226                         h->stats.rec_intr++;
227                         spin_unlock(&h->lock);
228                         snd_pcm_period_elapsed(h->csubs);
229                 } else {
230                         spin_lock(&h->lock);
231                         harmony_write(h, HARMONY_RNXTADD, h->gdma.addr);
232                         h->stats.graveyard_intr++;
233                         spin_unlock(&h->lock);
234                 }
235         }
236
237         spin_lock(&h->lock);
238         harmony_enable_interrupts(h);
239         spin_unlock(&h->lock);
240
241         return IRQ_HANDLED;
242 }
243
244 static unsigned int 
245 snd_harmony_rate_bits(int rate)
246 {
247         unsigned int i;
248         
249         for (i = 0; i < ARRAY_SIZE(snd_harmony_rates); i++)
250                 if (snd_harmony_rates[i] == rate)
251                         return rate_bits[i];
252
253         return HARMONY_SR_44KHZ;
254 }
255
256 static snd_pcm_hardware_t snd_harmony_playback =
257 {
258         .info = (SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED | 
259                  SNDRV_PCM_INFO_JOINT_DUPLEX | SNDRV_PCM_INFO_MMAP_VALID |
260                  SNDRV_PCM_INFO_BLOCK_TRANSFER),
261         .formats = (SNDRV_PCM_FMTBIT_S16_BE | SNDRV_PCM_FMTBIT_MU_LAW |
262                     SNDRV_PCM_FMTBIT_A_LAW),
263         .rates = (SNDRV_PCM_RATE_5512 | SNDRV_PCM_RATE_8000_48000 |
264                   SNDRV_PCM_RATE_KNOT),
265         .rate_min = 5512,
266         .rate_max = 48000,
267         .channels_min = 1,
268         .channels_max = 2,
269         .buffer_bytes_max = MAX_BUF_SIZE,
270         .period_bytes_min = BUF_SIZE,
271         .period_bytes_max = BUF_SIZE,
272         .periods_min = 1,
273         .periods_max = MAX_BUFS,
274         .fifo_size = 0,
275 };
276
277 static snd_pcm_hardware_t snd_harmony_capture =
278 {
279         .info = (SNDRV_PCM_INFO_MMAP | SNDRV_PCM_INFO_INTERLEAVED |
280                  SNDRV_PCM_INFO_JOINT_DUPLEX | SNDRV_PCM_INFO_MMAP_VALID |
281                  SNDRV_PCM_INFO_BLOCK_TRANSFER),
282         .formats = (SNDRV_PCM_FMTBIT_S16_BE | SNDRV_PCM_FMTBIT_MU_LAW |
283                     SNDRV_PCM_FMTBIT_A_LAW),
284         .rates = (SNDRV_PCM_RATE_5512 | SNDRV_PCM_RATE_8000_48000 |
285                   SNDRV_PCM_RATE_KNOT),
286         .rate_min = 5512,
287         .rate_max = 48000,
288         .channels_min = 1,
289         .channels_max = 2,
290         .buffer_bytes_max = MAX_BUF_SIZE,
291         .period_bytes_min = BUF_SIZE,
292         .period_bytes_max = BUF_SIZE,
293         .periods_min = 1,
294         .periods_max = MAX_BUFS,
295         .fifo_size = 0,
296 };
297
298 static int
299 snd_harmony_playback_trigger(snd_pcm_substream_t *ss, int cmd)
300 {
301         harmony_t *h = snd_pcm_substream_chip(ss);
302         unsigned long flags;
303
304         if (h->st.capturing)
305                 return -EBUSY;
306
307         spin_lock_irqsave(&h->lock, flags);
308         switch (cmd) {
309         case SNDRV_PCM_TRIGGER_START:
310                 h->st.playing = 1;
311                 harmony_write(h, HARMONY_PNXTADD, h->pbuf.addr);
312                 harmony_write(h, HARMONY_RNXTADD, h->gdma.addr);
313                 harmony_unmute(h);
314                 harmony_enable_interrupts(h);
315                 break;
316         case SNDRV_PCM_TRIGGER_STOP:
317                 h->st.playing = 0;
318                 harmony_mute(h);
319                 harmony_write(h, HARMONY_PNXTADD, h->sdma.addr);
320                 harmony_disable_interrupts(h);
321                 break;
322         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
323         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
324         case SNDRV_PCM_TRIGGER_SUSPEND:
325         default:
326                 spin_unlock_irqrestore(&h->lock, flags);
327                 snd_BUG();
328                 return -EINVAL;
329         }
330         spin_unlock_irqrestore(&h->lock, flags);
331         
332         return 0;
333 }
334
335 static int
336 snd_harmony_capture_trigger(snd_pcm_substream_t *ss, int cmd)
337 {
338         harmony_t *h = snd_pcm_substream_chip(ss);
339         unsigned long flags;
340
341         if (h->st.playing)
342                 return -EBUSY;
343
344         spin_lock_irqsave(&h->lock, flags);
345         switch (cmd) {
346         case SNDRV_PCM_TRIGGER_START:
347                 h->st.capturing = 1;
348                 harmony_write(h, HARMONY_PNXTADD, h->sdma.addr);
349                 harmony_write(h, HARMONY_RNXTADD, h->cbuf.addr);
350                 harmony_unmute(h);
351                 harmony_enable_interrupts(h);
352                 break;
353         case SNDRV_PCM_TRIGGER_STOP:
354                 h->st.capturing = 0;
355                 harmony_mute(h);
356                 harmony_write(h, HARMONY_RNXTADD, h->gdma.addr);
357                 harmony_disable_interrupts(h);
358                 break;
359         case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
360         case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
361         case SNDRV_PCM_TRIGGER_SUSPEND:
362         default:
363                 spin_unlock_irqrestore(&h->lock, flags);
364                 snd_BUG();
365                 return -EINVAL;
366         }
367         spin_unlock_irqrestore(&h->lock, flags);
368                 
369         return 0;
370 }
371
372 static int
373 snd_harmony_set_data_format(harmony_t *h, int fmt, int force)
374 {
375         int o = h->st.format;
376         int n;
377
378         switch(fmt) {
379         case SNDRV_PCM_FORMAT_S16_BE:
380                 n = HARMONY_DF_16BIT_LINEAR;
381                 break;
382         case SNDRV_PCM_FORMAT_A_LAW:
383                 n = HARMONY_DF_8BIT_ALAW;
384                 break;
385         case SNDRV_PCM_FORMAT_MU_LAW:
386                 n = HARMONY_DF_8BIT_ULAW;
387                 break;
388         default:
389                 n = HARMONY_DF_16BIT_LINEAR;
390                 break;
391         }
392
393         if (force || o != n) {
394                 snd_pcm_format_set_silence(fmt, h->sdma.area, SILENCE_BUFSZ / 
395                                            (snd_pcm_format_physical_width(fmt)
396                                             / 8));
397         }
398
399         return n;
400 }
401
402 static int
403 snd_harmony_playback_prepare(snd_pcm_substream_t *ss)
404 {
405         harmony_t *h = snd_pcm_substream_chip(ss);
406         snd_pcm_runtime_t *rt = ss->runtime;
407         
408         if (h->st.capturing)
409                 return -EBUSY;
410         
411         h->pbuf.size = snd_pcm_lib_buffer_bytes(ss);
412         h->pbuf.count = snd_pcm_lib_period_bytes(ss);
413         if (h->pbuf.buf >= h->pbuf.size)
414                 h->pbuf.buf = 0;
415         h->st.playing = 0;
416
417         h->st.rate = snd_harmony_rate_bits(rt->rate);
418         h->st.format = snd_harmony_set_data_format(h, rt->format, 0);
419         
420         if (rt->channels == 2)
421                 h->st.stereo = HARMONY_SS_STEREO;
422         else
423                 h->st.stereo = HARMONY_SS_MONO;
424
425         harmony_set_control(h);
426
427         h->pbuf.addr = rt->dma_addr;
428
429         return 0;
430 }
431
432 static int
433 snd_harmony_capture_prepare(snd_pcm_substream_t *ss)
434 {
435         harmony_t *h = snd_pcm_substream_chip(ss);
436         snd_pcm_runtime_t *rt = ss->runtime;
437
438         if (h->st.playing)
439                 return -EBUSY;
440
441         h->cbuf.size = snd_pcm_lib_buffer_bytes(ss);
442         h->cbuf.count = snd_pcm_lib_period_bytes(ss);
443         if (h->cbuf.buf >= h->cbuf.size)
444                 h->cbuf.buf = 0;
445         h->st.capturing = 0;
446
447         h->st.rate = snd_harmony_rate_bits(rt->rate);
448         h->st.format = snd_harmony_set_data_format(h, rt->format, 0);
449
450         if (rt->channels == 2)
451                 h->st.stereo = HARMONY_SS_STEREO;
452         else
453                 h->st.stereo = HARMONY_SS_MONO;
454
455         harmony_set_control(h);
456
457         h->cbuf.addr = rt->dma_addr;
458
459         return 0;
460 }
461
462 static snd_pcm_uframes_t 
463 snd_harmony_playback_pointer(snd_pcm_substream_t *ss)
464 {
465         snd_pcm_runtime_t *rt = ss->runtime;
466         harmony_t *h = snd_pcm_substream_chip(ss);
467         unsigned long pcuradd;
468         unsigned long played;
469
470         if (!(h->st.playing) || (h->psubs == NULL)) 
471                 return 0;
472
473         if ((h->pbuf.addr == 0) || (h->pbuf.size == 0))
474                 return 0;
475         
476         pcuradd = harmony_read(h, HARMONY_PCURADD);
477         played = pcuradd - h->pbuf.addr;
478
479 #ifdef HARMONY_DEBUG
480         printk(KERN_DEBUG PFX "playback_pointer is 0x%lx-0x%lx = %d bytes\n", 
481                pcuradd, h->pbuf.addr, played);  
482 #endif
483
484         if (pcuradd > h->pbuf.addr + h->pbuf.size) {
485                 return 0;
486         }
487
488         return bytes_to_frames(rt, played);
489 }
490
491 static snd_pcm_uframes_t
492 snd_harmony_capture_pointer(snd_pcm_substream_t *ss)
493 {
494         snd_pcm_runtime_t *rt = ss->runtime;
495         harmony_t *h = snd_pcm_substream_chip(ss);
496         unsigned long rcuradd;
497         unsigned long caught;
498
499         if (!(h->st.capturing) || (h->csubs == NULL))
500                 return 0;
501
502         if ((h->cbuf.addr == 0) || (h->cbuf.size == 0))
503                 return 0;
504
505         rcuradd = harmony_read(h, HARMONY_RCURADD);
506         caught = rcuradd - h->cbuf.addr;
507
508 #ifdef HARMONY_DEBUG
509         printk(KERN_DEBUG PFX "capture_pointer is 0x%lx-0x%lx = %d bytes\n",
510                rcuradd, h->cbuf.addr, caught);
511 #endif
512
513         if (rcuradd > h->cbuf.addr + h->cbuf.size) {
514                 return 0;
515         }
516
517         return bytes_to_frames(rt, caught);
518 }
519
520 static int 
521 snd_harmony_playback_open(snd_pcm_substream_t *ss)
522 {
523         harmony_t *h = snd_pcm_substream_chip(ss);
524         snd_pcm_runtime_t *rt = ss->runtime;
525         int err;
526         
527         h->psubs = ss;
528         rt->hw = snd_harmony_playback;
529         snd_pcm_hw_constraint_list(rt, 0, SNDRV_PCM_HW_PARAM_RATE, 
530                                    &hw_constraint_rates);
531         
532         err = snd_pcm_hw_constraint_integer(rt, SNDRV_PCM_HW_PARAM_PERIODS);
533         if (err < 0)
534                 return err;
535         
536         return 0;
537 }
538
539 static int
540 snd_harmony_capture_open(snd_pcm_substream_t *ss)
541 {
542         harmony_t *h = snd_pcm_substream_chip(ss);
543         snd_pcm_runtime_t *rt = ss->runtime;
544         int err;
545
546         h->csubs = ss;
547         rt->hw = snd_harmony_capture;
548         snd_pcm_hw_constraint_list(rt, 0, SNDRV_PCM_HW_PARAM_RATE,
549                                    &hw_constraint_rates);
550
551         err = snd_pcm_hw_constraint_integer(rt, SNDRV_PCM_HW_PARAM_PERIODS);
552         if (err < 0)
553                 return err;
554
555         return 0;
556 }
557
558 static int 
559 snd_harmony_playback_close(snd_pcm_substream_t *ss)
560 {
561         harmony_t *h = snd_pcm_substream_chip(ss);
562         h->psubs = NULL;
563         return 0;
564 }
565
566 static int
567 snd_harmony_capture_close(snd_pcm_substream_t *ss)
568 {
569         harmony_t *h = snd_pcm_substream_chip(ss);
570         h->csubs = NULL;
571         return 0;
572 }
573
574 static int 
575 snd_harmony_hw_params(snd_pcm_substream_t *ss,
576                       snd_pcm_hw_params_t *hw)
577 {
578         int err;
579         harmony_t *h = snd_pcm_substream_chip(ss);
580         
581         err = snd_pcm_lib_malloc_pages(ss, params_buffer_bytes(hw));
582         if (err > 0 && h->dma.type == SNDRV_DMA_TYPE_CONTINUOUS)
583                 ss->runtime->dma_addr = __pa(ss->runtime->dma_area);
584         
585         return err;
586 }
587
588 static int 
589 snd_harmony_hw_free(snd_pcm_substream_t *ss) 
590 {
591         return snd_pcm_lib_free_pages(ss);
592 }
593
594 static snd_pcm_ops_t snd_harmony_playback_ops = {
595         .open = snd_harmony_playback_open,
596         .close = snd_harmony_playback_close,
597         .ioctl = snd_pcm_lib_ioctl,
598         .hw_params = snd_harmony_hw_params,
599         .hw_free = snd_harmony_hw_free,
600         .prepare = snd_harmony_playback_prepare,
601         .trigger = snd_harmony_playback_trigger,
602         .pointer = snd_harmony_playback_pointer,
603 };
604
605 static snd_pcm_ops_t snd_harmony_capture_ops = {
606         .open = snd_harmony_capture_open,
607         .close = snd_harmony_capture_close,
608         .ioctl = snd_pcm_lib_ioctl,
609         .hw_params = snd_harmony_hw_params,
610         .hw_free = snd_harmony_hw_free,
611         .prepare = snd_harmony_capture_prepare,
612         .trigger = snd_harmony_capture_trigger,
613         .pointer = snd_harmony_capture_pointer,
614 };
615
616 static int 
617 snd_harmony_pcm_init(harmony_t *h)
618 {
619         snd_pcm_t *pcm;
620         int err;
621
622         harmony_disable_interrupts(h);
623         
624         err = snd_pcm_new(h->card, "harmony", 0, 1, 1, &pcm);
625         if (err < 0)
626                 return err;
627         
628         snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, 
629                         &snd_harmony_playback_ops);
630         snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE,
631                         &snd_harmony_capture_ops);
632
633         pcm->private_data = h;
634         pcm->info_flags = 0;
635         strcpy(pcm->name, "harmony");
636         h->pcm = pcm;
637
638         h->psubs = NULL;
639         h->csubs = NULL;
640         
641         /* initialize graveyard buffer */
642         h->dma.type = SNDRV_DMA_TYPE_DEV;
643         h->dma.dev = &h->dev->dev;
644         err = snd_dma_alloc_pages(h->dma.type,
645                                   h->dma.dev,
646                                   BUF_SIZE*GRAVEYARD_BUFS,
647                                   &h->gdma);
648         if (err < 0) {
649                 printk(KERN_ERR PFX "cannot allocate graveyard buffer!\n");
650                 return err;
651         }
652         
653         /* initialize silence buffers */
654         err = snd_dma_alloc_pages(h->dma.type,
655                                   h->dma.dev,
656                                   BUF_SIZE*SILENCE_BUFS,
657                                   &h->sdma);
658         if (err < 0) {
659                 printk(KERN_ERR PFX "cannot allocate silence buffer!\n");
660                 return err;
661         }
662
663         /* pre-allocate space for DMA */
664         err = snd_pcm_lib_preallocate_pages_for_all(pcm, h->dma.type,
665                                                     h->dma.dev,
666                                                     MAX_BUF_SIZE, 
667                                                     MAX_BUF_SIZE);
668         if (err < 0) {
669                 printk(KERN_ERR PFX "buffer allocation error: %d\n", err);
670                 return err;
671         }
672
673         h->st.format = snd_harmony_set_data_format(h,
674                 SNDRV_PCM_FORMAT_S16_BE, 1);
675
676         return 0;
677 }
678
679 static void 
680 snd_harmony_set_new_gain(harmony_t *h)
681 {
682         harmony_wait_for_control(h);
683         harmony_write(h, HARMONY_GAINCTL, h->st.gain);
684 }
685
686 static int 
687 snd_harmony_mixercontrol_info(snd_kcontrol_t *kc, 
688                               snd_ctl_elem_info_t *uinfo)
689 {
690         int mask = (kc->private_value >> 16) & 0xff;
691         int left_shift = (kc->private_value) & 0xff;
692         int right_shift = (kc->private_value >> 8) & 0xff;
693         
694         uinfo->type = mask == 1 ? SNDRV_CTL_ELEM_TYPE_BOOLEAN : 
695                        SNDRV_CTL_ELEM_TYPE_INTEGER;
696         uinfo->count = left_shift == right_shift ? 1 : 2;
697         uinfo->value.integer.min = 0;
698         uinfo->value.integer.max = mask;
699
700         return 0;
701 }
702
703 static int 
704 snd_harmony_volume_get(snd_kcontrol_t *kc, 
705                        snd_ctl_elem_value_t *ucontrol)
706 {
707         harmony_t *h = snd_kcontrol_chip(kc);
708         int shift_left = (kc->private_value) & 0xff;
709         int shift_right = (kc->private_value >> 8) & 0xff;
710         int mask = (kc->private_value >> 16) & 0xff;
711         int invert = (kc->private_value >> 24) & 0xff;
712         int left, right;
713         unsigned long flags;
714         
715         spin_lock_irqsave(&h->mixer_lock, flags);
716
717         left = (h->st.gain >> shift_left) & mask;
718         right = (h->st.gain >> shift_right) & mask;
719         if (invert) {
720                 left = mask - left;
721                 right = mask - right;
722         }
723         
724         ucontrol->value.integer.value[0] = left;
725         if (shift_left != shift_right)
726                 ucontrol->value.integer.value[1] = right;
727
728         spin_unlock_irqrestore(&h->mixer_lock, flags);
729
730         return 0;
731 }  
732
733 static int 
734 snd_harmony_volume_put(snd_kcontrol_t *kc, 
735                        snd_ctl_elem_value_t *ucontrol)
736 {
737         harmony_t *h = snd_kcontrol_chip(kc);
738         int shift_left = (kc->private_value) & 0xff;
739         int shift_right = (kc->private_value >> 8) & 0xff;
740         int mask = (kc->private_value >> 16) & 0xff;
741         int invert = (kc->private_value >> 24) & 0xff;
742         int left, right;
743         int old_gain = h->st.gain;
744         unsigned long flags;
745         
746         spin_lock_irqsave(&h->mixer_lock, flags);
747
748         left = ucontrol->value.integer.value[0] & mask;
749         if (invert)
750                 left = mask - left;
751         h->st.gain &= ~( (mask << shift_left ) );
752         h->st.gain |= (left << shift_left);
753
754         if (shift_left != shift_right) {
755                 right = ucontrol->value.integer.value[1] & mask;
756                 if (invert)
757                         right = mask - right;
758                 h->st.gain &= ~( (mask << shift_right) );
759                 h->st.gain |= (right << shift_right);
760         }
761
762         snd_harmony_set_new_gain(h);
763
764         spin_unlock_irqrestore(&h->mixer_lock, flags);
765         
766         return h->st.gain != old_gain;
767 }
768
769 static int 
770 snd_harmony_captureroute_info(snd_kcontrol_t *kc, 
771                               snd_ctl_elem_info_t *uinfo)
772 {
773         static char *texts[2] = { "Line", "Mic" };
774         uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
775         uinfo->count = 1;
776         uinfo->value.enumerated.items = 2;
777         if (uinfo->value.enumerated.item > 1)
778                 uinfo->value.enumerated.item = 1;
779         strcpy(uinfo->value.enumerated.name,
780                texts[uinfo->value.enumerated.item]);
781         return 0;
782 }
783
784 static int 
785 snd_harmony_captureroute_get(snd_kcontrol_t *kc, 
786                              snd_ctl_elem_value_t *ucontrol)
787 {
788         harmony_t *h = snd_kcontrol_chip(kc);
789         int value;
790         unsigned long flags;
791         
792         spin_lock_irqsave(&h->mixer_lock, flags);
793
794         value = (h->st.gain >> HARMONY_GAIN_IS_SHIFT) & 1;
795         ucontrol->value.enumerated.item[0] = value;
796
797         spin_unlock_irqrestore(&h->mixer_lock, flags);
798
799         return 0;
800 }  
801
802 static int 
803 snd_harmony_captureroute_put(snd_kcontrol_t *kc, 
804                              snd_ctl_elem_value_t *ucontrol)
805 {
806         harmony_t *h = snd_kcontrol_chip(kc);
807         int value;
808         int old_gain = h->st.gain;
809         unsigned long flags;
810         
811         spin_lock_irqsave(&h->mixer_lock, flags);
812
813         value = ucontrol->value.enumerated.item[0] & 1;
814         h->st.gain &= ~HARMONY_GAIN_IS_MASK;
815         h->st.gain |= value << HARMONY_GAIN_IS_SHIFT;
816
817         snd_harmony_set_new_gain(h);
818
819         spin_unlock_irqrestore(&h->mixer_lock, flags);
820         
821         return h->st.gain != old_gain;
822 }
823
824 #define HARMONY_CONTROLS (sizeof(snd_harmony_controls)/ \
825                           sizeof(snd_kcontrol_new_t))
826
827 #define HARMONY_VOLUME(xname, left_shift, right_shift, mask, invert) \
828 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname,                \
829   .info = snd_harmony_mixercontrol_info,                             \
830   .get = snd_harmony_volume_get, .put = snd_harmony_volume_put,      \
831   .private_value = ((left_shift) | ((right_shift) << 8) |            \
832                    ((mask) << 16) | ((invert) << 24)) }
833
834 static snd_kcontrol_new_t snd_harmony_controls[] = {
835         HARMONY_VOLUME("Master Playback Volume", HARMONY_GAIN_LO_SHIFT, 
836                        HARMONY_GAIN_RO_SHIFT, HARMONY_GAIN_OUT, 1),
837         HARMONY_VOLUME("Capture Volume", HARMONY_GAIN_LI_SHIFT,
838                        HARMONY_GAIN_RI_SHIFT, HARMONY_GAIN_IN, 0),
839         HARMONY_VOLUME("Monitor Volume", HARMONY_GAIN_MA_SHIFT,
840                        HARMONY_GAIN_MA_SHIFT, HARMONY_GAIN_MA, 1),
841         {
842                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
843                 .name = "Input Route",
844                 .info = snd_harmony_captureroute_info,
845                 .get = snd_harmony_captureroute_get,
846                 .put = snd_harmony_captureroute_put
847         },
848         HARMONY_VOLUME("Internal Speaker Switch", HARMONY_GAIN_SE_SHIFT,
849                        HARMONY_GAIN_SE_SHIFT, 1, 0),
850         HARMONY_VOLUME("Line-Out Switch", HARMONY_GAIN_LE_SHIFT,
851                        HARMONY_GAIN_LE_SHIFT, 1, 0),
852         HARMONY_VOLUME("Headphones Switch", HARMONY_GAIN_HE_SHIFT,
853                        HARMONY_GAIN_HE_SHIFT, 1, 0),
854 };
855
856 static void __init 
857 snd_harmony_mixer_reset(harmony_t *h)
858 {
859         harmony_mute(h);
860         harmony_reset(h);
861         h->st.gain = HARMONY_GAIN_DEFAULT;
862         harmony_unmute(h);
863 }
864
865 static int __init 
866 snd_harmony_mixer_init(harmony_t *h)
867 {
868         snd_card_t *card = h->card;
869         int idx, err;
870
871         snd_assert(h != NULL, return -EINVAL);
872         strcpy(card->mixername, "Harmony Gain control interface");
873
874         for (idx = 0; idx < HARMONY_CONTROLS; idx++) {
875                 err = snd_ctl_add(card, 
876                                   snd_ctl_new1(&snd_harmony_controls[idx], h));
877                 if (err < 0)
878                         return err;
879         }
880         
881         snd_harmony_mixer_reset(h);
882
883         return 0;
884 }
885
886 static int
887 snd_harmony_free(harmony_t *h)
888 {
889         if (h->gdma.addr)
890                 snd_dma_free_pages(&h->gdma);
891         if (h->sdma.addr)
892                 snd_dma_free_pages(&h->sdma);
893
894         if (h->irq >= 0)
895                 free_irq(h->irq, h);
896
897         if (h->iobase)
898                 iounmap(h->iobase);
899
900         parisc_set_drvdata(h->dev, NULL);
901
902         kfree(h);
903         return 0;
904 }
905
906 static int
907 snd_harmony_dev_free(snd_device_t *dev)
908 {
909         harmony_t *h = dev->device_data;
910         return snd_harmony_free(h);
911 }
912
913 static int __devinit
914 snd_harmony_create(snd_card_t *card, 
915                    struct parisc_device *padev, 
916                    harmony_t **rchip)
917 {
918         int err;
919         harmony_t *h;
920         static snd_device_ops_t ops = {
921                 .dev_free = snd_harmony_dev_free,
922         };
923
924         *rchip = NULL;
925
926         h = kmalloc(sizeof(*h), GFP_KERNEL);
927         if (h == NULL)
928                 return -ENOMEM;
929
930         memset(&h->st, 0, sizeof(h->st));
931         memset(&h->stats, 0, sizeof(h->stats));
932         memset(&h->pbuf, 0, sizeof(h->pbuf));
933         memset(&h->cbuf, 0, sizeof(h->cbuf));
934
935         h->hpa = padev->hpa.start;
936         h->card = card;
937         h->dev = padev;
938         h->irq = padev->irq;
939         h->iobase = ioremap_nocache(padev->hpa.start, HARMONY_SIZE);
940         if (h->iobase == NULL) {
941                 printk(KERN_ERR PFX "unable to remap hpa 0x%lx\n",
942                        padev->hpa.start);
943                 err = -EBUSY;
944                 goto free_and_ret;
945         }
946                 
947         err = request_irq(h->irq, snd_harmony_interrupt, 0,
948                           "harmony", h);
949         if (err) {
950                 printk(KERN_ERR PFX "could not obtain interrupt %d",
951                        h->irq);
952                 goto free_and_ret;
953         }
954
955         spin_lock_init(&h->mixer_lock);
956         spin_lock_init(&h->lock);
957
958         if ((err = snd_device_new(card, SNDRV_DEV_LOWLEVEL,
959                                   h, &ops)) < 0) {
960                 goto free_and_ret;
961         }
962
963         snd_card_set_dev(card, &padev->dev);
964
965         *rchip = h;
966
967         return 0;
968
969 free_and_ret:
970         snd_harmony_free(h);
971         return err;
972 }
973
974 static int __devinit
975 snd_harmony_probe(struct parisc_device *padev)
976 {
977         int err;
978         static int dev;
979         snd_card_t *card;
980         harmony_t *h;
981         static int index = SNDRV_DEFAULT_IDX1;
982         static char *id = SNDRV_DEFAULT_STR1;
983
984         h = parisc_get_drvdata(padev);
985         if (h != NULL) {
986                 return -ENODEV;
987         }
988
989         card = snd_card_new(index, id, THIS_MODULE, 0);
990         if (card == NULL)
991                 return -ENOMEM;
992
993         err = snd_harmony_create(card, padev, &h);
994         if (err < 0) {
995                 goto free_and_ret;
996         }
997
998         err = snd_harmony_pcm_init(h);
999         if (err < 0) {
1000                 goto free_and_ret;
1001         }
1002
1003         err = snd_harmony_mixer_init(h);
1004         if (err < 0) {
1005                 goto free_and_ret;
1006         }
1007
1008         strcpy(card->driver, "harmony");
1009         strcpy(card->shortname, "Harmony");
1010         sprintf(card->longname, "%s at 0x%lx, irq %i",
1011                 card->shortname, h->hpa, h->irq);
1012
1013         err = snd_card_register(card);
1014         if (err < 0) {
1015                 goto free_and_ret;
1016         }
1017
1018         dev++;
1019         parisc_set_drvdata(padev, h);
1020
1021         return 0;
1022
1023 free_and_ret:
1024         snd_card_free(card);
1025         return err;
1026 }
1027
1028 static int __devexit
1029 snd_harmony_remove(struct parisc_device *padev)
1030 {
1031         harmony_t *h = parisc_get_drvdata(padev);
1032         snd_card_free(h->card);
1033         return 0;
1034 }
1035
1036 static struct parisc_driver snd_harmony_driver = {
1037         .name = "harmony",
1038         .id_table = snd_harmony_devtable,
1039         .probe = snd_harmony_probe,
1040         .remove = snd_harmony_remove,
1041 };
1042
1043 static int __init 
1044 alsa_harmony_init(void)
1045 {
1046         int err;
1047
1048         err = register_parisc_driver(&snd_harmony_driver);
1049         if (err < 0) {
1050                 printk(KERN_ERR PFX "device not found\n");
1051                 return err;
1052         }
1053
1054         return 0;
1055 }
1056
1057 static void __exit
1058 alsa_harmony_fini(void)
1059 {
1060         int err;
1061
1062         err = unregister_parisc_driver(&snd_harmony_driver);
1063         if (err < 0) {
1064                 printk(KERN_ERR PFX "failed to unregister\n");
1065         }
1066         
1067         return;
1068 }
1069
1070 MODULE_LICENSE("GPL");
1071 MODULE_AUTHOR("Kyle McMartin <kyle@parisc-linux.org>");
1072 MODULE_DESCRIPTION("Harmony sound driver");
1073
1074 module_init(alsa_harmony_init);
1075 module_exit(alsa_harmony_fini);