1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56#include <linux/interrupt.h>
57#include <linux/delay.h>
58#include <linux/irq.h>
59#include <linux/io.h>
60#include <linux/dma-mapping.h>
61
62#include <sound/core.h>
63#include <sound/pcm.h>
64#include <sound/pcm_params.h>
65#include <sound/info.h>
66#include <sound/control.h>
67#include <sound/initval.h>
68
69#include <linux/of.h>
70#include <linux/of_device.h>
71#include <asm/atomic.h>
72
73MODULE_AUTHOR("Rudolf Koenig, Brent Baccala and Martin Habets");
74MODULE_DESCRIPTION("Sun DBRI");
75MODULE_LICENSE("GPL");
76MODULE_SUPPORTED_DEVICE("{{Sun,DBRI}}");
77
78static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;
79static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;
80
81static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
82
83module_param_array(index, int, NULL, 0444);
84MODULE_PARM_DESC(index, "Index value for Sun DBRI soundcard.");
85module_param_array(id, charp, NULL, 0444);
86MODULE_PARM_DESC(id, "ID string for Sun DBRI soundcard.");
87module_param_array(enable, bool, NULL, 0444);
88MODULE_PARM_DESC(enable, "Enable Sun DBRI soundcard.");
89
90#undef DBRI_DEBUG
91
92#define D_INT (1<<0)
93#define D_GEN (1<<1)
94#define D_CMD (1<<2)
95#define D_MM (1<<3)
96#define D_USR (1<<4)
97#define D_DESC (1<<5)
98
99static int dbri_debug;
100module_param(dbri_debug, int, 0644);
101MODULE_PARM_DESC(dbri_debug, "Debug value for Sun DBRI soundcard.");
102
103#ifdef DBRI_DEBUG
104static char *cmds[] = {
105 "WAIT", "PAUSE", "JUMP", "IIQ", "REX", "SDP", "CDP", "DTS",
106 "SSP", "CHI", "NT", "TE", "CDEC", "TEST", "CDM", "RESRV"
107};
108
109#define dprintk(a, x...) if (dbri_debug & a) printk(KERN_DEBUG x)
110
111#else
112#define dprintk(a, x...) do { } while (0)
113
114#endif
115
116#define DBRI_CMD(cmd, intr, value) ((cmd << 28) | \
117 (intr << 27) | \
118 value)
119
120
121
122
123
124struct cs4215 {
125 __u8 data[4];
126 __u8 ctrl[4];
127 __u8 onboard;
128 __u8 offset;
129 volatile __u32 status;
130 volatile __u32 version;
131 __u8 precision;
132 __u8 channels;
133};
134
135
136
137
138
139
140#define CS4215_CLB (1<<2)
141#define CS4215_OLB (1<<3)
142
143#define CS4215_MLB (1<<4)
144#define CS4215_RSRVD_1 (1<<5)
145
146
147#define CS4215_DFR_LINEAR16 0
148#define CS4215_DFR_ULAW 1
149#define CS4215_DFR_ALAW 2
150#define CS4215_DFR_LINEAR8 3
151#define CS4215_DFR_STEREO (1<<2)
152static struct {
153 unsigned short freq;
154 unsigned char xtal;
155 unsigned char csval;
156} CS4215_FREQ[] = {
157 { 8000, (1 << 4), (0 << 3) },
158 { 16000, (1 << 4), (1 << 3) },
159 { 27429, (1 << 4), (2 << 3) },
160 { 32000, (1 << 4), (3 << 3) },
161
162
163 { 48000, (1 << 4), (6 << 3) },
164 { 9600, (1 << 4), (7 << 3) },
165 { 5512, (2 << 4), (0 << 3) },
166 { 11025, (2 << 4), (1 << 3) },
167 { 18900, (2 << 4), (2 << 3) },
168 { 22050, (2 << 4), (3 << 3) },
169 { 37800, (2 << 4), (4 << 3) },
170 { 44100, (2 << 4), (5 << 3) },
171 { 33075, (2 << 4), (6 << 3) },
172 { 6615, (2 << 4), (7 << 3) },
173 { 0, 0, 0}
174};
175
176#define CS4215_HPF (1<<7)
177
178#define CS4215_12_MASK 0xfcbf
179
180
181#define CS4215_XEN (1<<0)
182#define CS4215_XCLK (1<<1)
183#define CS4215_BSEL_64 (0<<2)
184#define CS4215_BSEL_128 (1<<2)
185#define CS4215_BSEL_256 (2<<2)
186#define CS4215_MCK_MAST (0<<4)
187#define CS4215_MCK_XTL1 (1<<4)
188#define CS4215_MCK_XTL2 (2<<4)
189#define CS4215_MCK_CLK1 (3<<4)
190#define CS4215_MCK_CLK2 (4<<4)
191
192
193#define CS4215_DAD (1<<0)
194#define CS4215_ENL (1<<1)
195
196
197
198
199
200
201
202#define CS4215_VERSION_MASK 0xf
203
204
205
206
207
208
209
210
211
212#define CS4215_LO(v) v
213#define CS4215_LE (1<<6)
214#define CS4215_HE (1<<7)
215
216
217#define CS4215_RO(v) v
218#define CS4215_SE (1<<6)
219#define CS4215_ADI (1<<7)
220
221
222#define CS4215_LG(v) v
223#define CS4215_IS (1<<4)
224#define CS4215_OVR (1<<5)
225#define CS4215_PIO0 (1<<6)
226#define CS4215_PIO1 (1<<7)
227
228
229#define CS4215_RG(v) v
230#define CS4215_MA(v) (v<<4)
231
232
233
234
235
236
237#define REG0 0x00
238#define REG1 0x04
239#define REG2 0x08
240#define REG3 0x0c
241#define REG8 0x20
242#define REG9 0x24
243
244#define DBRI_NO_CMDS 64
245#define DBRI_INT_BLK 64
246#define DBRI_NO_DESCS 64
247#define DBRI_NO_PIPES 32
248#define DBRI_MAX_PIPE (DBRI_NO_PIPES - 1)
249
250#define DBRI_REC 0
251#define DBRI_PLAY 1
252#define DBRI_NO_STREAMS 2
253
254
255
256struct dbri_mem {
257 volatile __u32 word1;
258 __u32 ba;
259 __u32 nda;
260 volatile __u32 word4;
261};
262
263
264
265
266struct dbri_dma {
267 s32 cmd[DBRI_NO_CMDS];
268 volatile s32 intr[DBRI_INT_BLK];
269 struct dbri_mem desc[DBRI_NO_DESCS];
270};
271
272#define dbri_dma_off(member, elem) \
273 ((u32)(unsigned long) \
274 (&(((struct dbri_dma *)0)->member[elem])))
275
276enum in_or_out { PIPEinput, PIPEoutput };
277
278struct dbri_pipe {
279 u32 sdp;
280 int nextpipe;
281 int length;
282 int first_desc;
283 int desc;
284 volatile __u32 *recv_fixed_ptr;
285};
286
287
288struct dbri_streaminfo {
289 struct snd_pcm_substream *substream;
290 u32 dvma_buffer;
291 int size;
292 size_t offset;
293 int pipe;
294 int left_gain;
295 int right_gain;
296};
297
298
299struct snd_dbri {
300 int regs_size, irq;
301 struct of_device *op;
302 spinlock_t lock;
303
304 struct dbri_dma *dma;
305 u32 dma_dvma;
306
307 void __iomem *regs;
308 int dbri_irqp;
309
310 struct dbri_pipe pipes[DBRI_NO_PIPES];
311 int next_desc[DBRI_NO_DESCS];
312 spinlock_t cmdlock;
313 s32 *cmdptr;
314
315 int chi_bpf;
316
317 struct cs4215 mm;
318
319 struct dbri_streaminfo stream_info[DBRI_NO_STREAMS];
320};
321
322#define DBRI_MAX_VOLUME 63
323#define DBRI_MAX_GAIN 15
324
325
326#define D_P (1<<15)
327#define D_G (1<<14)
328#define D_S (1<<13)
329#define D_E (1<<12)
330#define D_X (1<<7)
331#define D_T (1<<6)
332#define D_N (1<<5)
333#define D_C (1<<4)
334#define D_F (1<<3)
335#define D_D (1<<2)
336#define D_H (1<<1)
337#define D_R (1<<0)
338
339
340#define D_LITTLE_END (1<<8)
341#define D_BIG_END (0<<8)
342#define D_MRR (1<<4)
343#define D_MLE (1<<3)
344#define D_LBG (1<<2)
345#define D_MBE (1<<1)
346#define D_IR (1<<0)
347
348
349#define D_ENPIO3 (1<<7)
350#define D_ENPIO2 (1<<6)
351#define D_ENPIO1 (1<<5)
352#define D_ENPIO0 (1<<4)
353#define D_ENPIO (0xf0)
354#define D_PIO3 (1<<3)
355#define D_PIO2 (1<<2)
356#define D_PIO1 (1<<1)
357#define D_PIO0 (1<<0)
358
359
360#define D_WAIT 0x0
361#define D_PAUSE 0x1
362#define D_JUMP 0x2
363#define D_IIQ 0x3
364#define D_REX 0x4
365#define D_SDP 0x5
366#define D_CDP 0x6
367#define D_DTS 0x7
368#define D_SSP 0x8
369#define D_CHI 0x9
370#define D_NT 0xa
371#define D_TE 0xb
372#define D_CDEC 0xc
373#define D_TEST 0xd
374#define D_CDM 0xe
375
376
377#define D_PIPE(v) ((v)<<0)
378
379
380
381#define D_SDP_2SAME (1<<18)
382#define D_SDP_CHANGE (2<<18)
383#define D_SDP_EVERY (3<<18)
384#define D_SDP_EOL (1<<17)
385#define D_SDP_IDLE (1<<16)
386
387
388#define D_SDP_MEM (0<<13)
389#define D_SDP_HDLC (2<<13)
390#define D_SDP_HDLC_D (3<<13)
391#define D_SDP_SER (4<<13)
392#define D_SDP_FIXED (6<<13)
393#define D_SDP_MODE(v) ((v)&(7<<13))
394
395#define D_SDP_TO_SER (1<<12)
396#define D_SDP_FROM_SER (0<<12)
397#define D_SDP_MSB (1<<11)
398#define D_SDP_LSB (0<<11)
399#define D_SDP_P (1<<10)
400#define D_SDP_A (1<<8)
401#define D_SDP_C (1<<7)
402
403
404#define D_DTS_VI (1<<17)
405#define D_DTS_VO (1<<16)
406#define D_DTS_INS (1<<15)
407#define D_DTS_DEL (0<<15)
408#define D_DTS_PRVIN(v) ((v)<<10)
409#define D_DTS_PRVOUT(v) ((v)<<5)
410
411
412#define D_TS_LEN(v) ((v)<<24)
413#define D_TS_CYCLE(v) ((v)<<14)
414#define D_TS_DI (1<<13)
415#define D_TS_1CHANNEL (0<<10)
416#define D_TS_MONITOR (2<<10)
417#define D_TS_NONCONTIG (3<<10)
418#define D_TS_ANCHOR (7<<10)
419#define D_TS_MON(v) ((v)<<5)
420#define D_TS_NEXT(v) ((v)<<0)
421
422
423#define D_CHI_CHICM(v) ((v)<<16)
424#define D_CHI_IR (1<<15)
425#define D_CHI_EN (1<<14)
426#define D_CHI_OD (1<<13)
427#define D_CHI_FE (1<<12)
428#define D_CHI_FD (1<<11)
429#define D_CHI_BPF(v) ((v)<<0)
430
431
432#define D_NT_FBIT (1<<17)
433#define D_NT_NBF (1<<16)
434#define D_NT_IRM_IMM (1<<15)
435#define D_NT_IRM_EN (1<<14)
436#define D_NT_ISNT (1<<13)
437#define D_NT_FT (1<<12)
438#define D_NT_EZ (1<<11)
439#define D_NT_IFA (1<<10)
440#define D_NT_ACT (1<<9)
441#define D_NT_MFE (1<<8)
442#define D_NT_RLB(v) ((v)<<5)
443#define D_NT_LLB(v) ((v)<<2)
444#define D_NT_FACT (1<<1)
445#define D_NT_ABV (1<<0)
446
447
448#define D_CDEC_CK(v) ((v)<<24)
449#define D_CDEC_FED(v) ((v)<<12)
450#define D_CDEC_RED(v) ((v)<<0)
451
452
453#define D_TEST_RAM(v) ((v)<<16)
454#define D_TEST_SIZE(v) ((v)<<11)
455#define D_TEST_ROMONOFF 0x5
456#define D_TEST_PROC 0x6
457#define D_TEST_SER 0x7
458#define D_TEST_RAMREAD 0x8
459#define D_TEST_RAMWRITE 0x9
460#define D_TEST_RAMBIST 0xa
461#define D_TEST_MCBIST 0xb
462#define D_TEST_DUMP 0xe
463
464
465#define D_CDM_THI (1 << 8)
466#define D_CDM_RHI (1 << 7)
467#define D_CDM_RCE (1 << 6)
468#define D_CDM_XCE (1 << 2)
469#define D_CDM_XEN (1 << 1)
470#define D_CDM_REN (1 << 0)
471
472
473#define D_INTR_BRDY 1
474#define D_INTR_MINT 2
475#define D_INTR_IBEG 3
476#define D_INTR_IEND 4
477#define D_INTR_EOL 5
478#define D_INTR_CMDI 6
479#define D_INTR_XCMP 8
480#define D_INTR_SBRI 9
481#define D_INTR_FXDT 10
482#define D_INTR_CHIL 11
483#define D_INTR_COLL 11
484#define D_INTR_DBYT 12
485#define D_INTR_RBYT 13
486#define D_INTR_LINT 14
487#define D_INTR_UNDR 15
488
489#define D_INTR_TE 32
490#define D_INTR_NT 34
491#define D_INTR_CHI 36
492#define D_INTR_CMD 38
493
494#define D_INTR_GETCHAN(v) (((v) >> 24) & 0x3f)
495#define D_INTR_GETCODE(v) (((v) >> 20) & 0xf)
496#define D_INTR_GETCMD(v) (((v) >> 16) & 0xf)
497#define D_INTR_GETVAL(v) ((v) & 0xffff)
498#define D_INTR_GETRVAL(v) ((v) & 0xfffff)
499
500#define D_P_0 0
501#define D_P_1 1
502#define D_P_2 2
503#define D_P_3 3
504#define D_P_4 4
505#define D_P_5 5
506#define D_P_6 6
507#define D_P_7 7
508#define D_P_8 8
509#define D_P_9 9
510#define D_P_10 10
511#define D_P_11 11
512#define D_P_12 12
513#define D_P_13 13
514#define D_P_14 14
515#define D_P_15 15
516#define D_P_16 16
517#define D_P_17 17
518#define D_P_18 18
519#define D_P_19 19
520#define D_P_20 20
521#define D_P_21 21
522#define D_P_22 22
523#define D_P_23 23
524#define D_P_24 24
525#define D_P_25 25
526#define D_P_26 26
527#define D_P_27 27
528#define D_P_28 28
529#define D_P_29 29
530#define D_P_30 30
531#define D_P_31 31
532
533
534#define DBRI_TD_F (1 << 31)
535#define DBRI_TD_D (1 << 30)
536#define DBRI_TD_CNT(v) ((v) << 16)
537#define DBRI_TD_B (1 << 15)
538#define DBRI_TD_M (1 << 14)
539#define DBRI_TD_I (1 << 13)
540#define DBRI_TD_FCNT(v) (v)
541#define DBRI_TD_UNR (1 << 3)
542#define DBRI_TD_ABT (1 << 2)
543#define DBRI_TD_TBC (1 << 0)
544#define DBRI_TD_STATUS(v) ((v) & 0xff)
545
546#define DBRI_TD_MAXCNT ((1 << 13) - 4)
547
548
549#define DBRI_RD_F (1 << 31)
550#define DBRI_RD_C (1 << 30)
551#define DBRI_RD_B (1 << 15)
552#define DBRI_RD_M (1 << 14)
553#define DBRI_RD_BCNT(v) (v)
554#define DBRI_RD_CRC (1 << 7)
555#define DBRI_RD_BBC (1 << 6)
556#define DBRI_RD_ABT (1 << 5)
557#define DBRI_RD_OVRN (1 << 3)
558#define DBRI_RD_STATUS(v) ((v) & 0xff)
559#define DBRI_RD_CNT(v) (((v) >> 16) & 0x1fff)
560
561
562
563#define DBRI_STREAMNO(substream) \
564 (substream->stream == \
565 SNDRV_PCM_STREAM_PLAYBACK ? DBRI_PLAY: DBRI_REC)
566
567
568#define DBRI_STREAM(dbri, substream) \
569 &dbri->stream_info[DBRI_STREAMNO(substream)]
570
571
572
573
574
575static __u32 reverse_bytes(__u32 b, int len)
576{
577 switch (len) {
578 case 32:
579 b = ((b & 0xffff0000) >> 16) | ((b & 0x0000ffff) << 16);
580 case 16:
581 b = ((b & 0xff00ff00) >> 8) | ((b & 0x00ff00ff) << 8);
582 case 8:
583 b = ((b & 0xf0f0f0f0) >> 4) | ((b & 0x0f0f0f0f) << 4);
584 case 4:
585 b = ((b & 0xcccccccc) >> 2) | ((b & 0x33333333) << 2);
586 case 2:
587 b = ((b & 0xaaaaaaaa) >> 1) | ((b & 0x55555555) << 1);
588 case 1:
589 case 0:
590 break;
591 default:
592 printk(KERN_ERR "DBRI reverse_bytes: unsupported length\n");
593 };
594
595 return b;
596}
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628#define MAXLOOPS 20
629
630
631
632static void dbri_cmdwait(struct snd_dbri *dbri)
633{
634 int maxloops = MAXLOOPS;
635 unsigned long flags;
636
637
638 spin_lock_irqsave(&dbri->lock, flags);
639 while ((--maxloops) > 0 && (sbus_readl(dbri->regs + REG0) & D_P)) {
640 spin_unlock_irqrestore(&dbri->lock, flags);
641 msleep_interruptible(1);
642 spin_lock_irqsave(&dbri->lock, flags);
643 }
644 spin_unlock_irqrestore(&dbri->lock, flags);
645
646 if (maxloops == 0)
647 printk(KERN_ERR "DBRI: Chip never completed command buffer\n");
648 else
649 dprintk(D_CMD, "Chip completed command buffer (%d)\n",
650 MAXLOOPS - maxloops - 1);
651}
652
653
654
655
656static s32 *dbri_cmdlock(struct snd_dbri *dbri, int len)
657{
658
659 len += 2;
660 spin_lock(&dbri->cmdlock);
661 if (dbri->cmdptr - dbri->dma->cmd + len < DBRI_NO_CMDS - 2)
662 return dbri->cmdptr + 2;
663 else if (len < sbus_readl(dbri->regs + REG8) - dbri->dma_dvma)
664 return dbri->dma->cmd;
665 else
666 printk(KERN_ERR "DBRI: no space for commands.");
667
668 return NULL;
669}
670
671
672
673
674
675
676
677
678
679static void dbri_cmdsend(struct snd_dbri *dbri, s32 *cmd, int len)
680{
681 s32 tmp, addr;
682 static int wait_id = 0;
683
684 wait_id++;
685 wait_id &= 0xffff;
686 *(cmd) = DBRI_CMD(D_WAIT, 1, wait_id);
687 *(cmd+1) = DBRI_CMD(D_WAIT, 1, wait_id);
688
689
690 addr = dbri->dma_dvma + (cmd - len - dbri->dma->cmd) * sizeof(s32);
691 *(dbri->cmdptr+1) = addr;
692 *(dbri->cmdptr) = DBRI_CMD(D_JUMP, 0, 0);
693
694#ifdef DBRI_DEBUG
695 if (cmd > dbri->cmdptr) {
696 s32 *ptr;
697
698 for (ptr = dbri->cmdptr; ptr < cmd+2; ptr++)
699 dprintk(D_CMD, "cmd: %lx:%08x\n",
700 (unsigned long)ptr, *ptr);
701 } else {
702 s32 *ptr = dbri->cmdptr;
703
704 dprintk(D_CMD, "cmd: %lx:%08x\n", (unsigned long)ptr, *ptr);
705 ptr++;
706 dprintk(D_CMD, "cmd: %lx:%08x\n", (unsigned long)ptr, *ptr);
707 for (ptr = dbri->dma->cmd; ptr < cmd+2; ptr++)
708 dprintk(D_CMD, "cmd: %lx:%08x\n",
709 (unsigned long)ptr, *ptr);
710 }
711#endif
712
713
714 tmp = sbus_readl(dbri->regs + REG0);
715 tmp |= D_P;
716 sbus_writel(tmp, dbri->regs + REG0);
717
718 dbri->cmdptr = cmd;
719 spin_unlock(&dbri->cmdlock);
720}
721
722
723static void dbri_reset(struct snd_dbri *dbri)
724{
725 int i;
726 u32 tmp;
727
728 dprintk(D_GEN, "reset 0:%x 2:%x 8:%x 9:%x\n",
729 sbus_readl(dbri->regs + REG0),
730 sbus_readl(dbri->regs + REG2),
731 sbus_readl(dbri->regs + REG8), sbus_readl(dbri->regs + REG9));
732
733 sbus_writel(D_R, dbri->regs + REG0);
734 for (i = 0; (sbus_readl(dbri->regs + REG0) & D_R) && i < 64; i++)
735 udelay(10);
736
737
738
739 tmp = sbus_readl(dbri->regs + REG0);
740 tmp |= D_G | D_E;
741 tmp &= ~D_S;
742 sbus_writel(tmp, dbri->regs + REG0);
743}
744
745
746static void __devinit dbri_initialize(struct snd_dbri *dbri)
747{
748 s32 *cmd;
749 u32 dma_addr;
750 unsigned long flags;
751 int n;
752
753 spin_lock_irqsave(&dbri->lock, flags);
754
755 dbri_reset(dbri);
756
757
758 for (n = 0; n < DBRI_NO_PIPES; n++)
759 dbri->pipes[n].desc = dbri->pipes[n].first_desc = -1;
760
761 spin_lock_init(&dbri->cmdlock);
762
763
764
765 dma_addr = dbri->dma_dvma + dbri_dma_off(intr, 0);
766 dbri->dma->intr[0] = dma_addr;
767 dbri->dbri_irqp = 1;
768
769
770
771 spin_lock(&dbri->cmdlock);
772 cmd = dbri->cmdptr = dbri->dma->cmd;
773 *(cmd++) = DBRI_CMD(D_IIQ, 0, 0);
774 *(cmd++) = dma_addr;
775 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
776 dbri->cmdptr = cmd;
777 *(cmd++) = DBRI_CMD(D_WAIT, 1, 0);
778 *(cmd++) = DBRI_CMD(D_WAIT, 1, 0);
779 dma_addr = dbri->dma_dvma + dbri_dma_off(cmd, 0);
780 sbus_writel(dma_addr, dbri->regs + REG8);
781 spin_unlock(&dbri->cmdlock);
782
783 spin_unlock_irqrestore(&dbri->lock, flags);
784 dbri_cmdwait(dbri);
785}
786
787
788
789
790
791
792
793
794
795
796
797
798
799
800
801static inline int pipe_active(struct snd_dbri *dbri, int pipe)
802{
803 return ((pipe >= 0) && (dbri->pipes[pipe].desc != -1));
804}
805
806
807
808
809
810
811static void reset_pipe(struct snd_dbri *dbri, int pipe)
812{
813 int sdp;
814 int desc;
815 s32 *cmd;
816
817 if (pipe < 0 || pipe > DBRI_MAX_PIPE) {
818 printk(KERN_ERR "DBRI: reset_pipe called with "
819 "illegal pipe number\n");
820 return;
821 }
822
823 sdp = dbri->pipes[pipe].sdp;
824 if (sdp == 0) {
825 printk(KERN_ERR "DBRI: reset_pipe called "
826 "on uninitialized pipe\n");
827 return;
828 }
829
830 cmd = dbri_cmdlock(dbri, 3);
831 *(cmd++) = DBRI_CMD(D_SDP, 0, sdp | D_SDP_C | D_SDP_P);
832 *(cmd++) = 0;
833 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
834 dbri_cmdsend(dbri, cmd, 3);
835
836 desc = dbri->pipes[pipe].first_desc;
837 if (desc >= 0)
838 do {
839 dbri->dma->desc[desc].ba = 0;
840 dbri->dma->desc[desc].nda = 0;
841 desc = dbri->next_desc[desc];
842 } while (desc != -1 && desc != dbri->pipes[pipe].first_desc);
843
844 dbri->pipes[pipe].desc = -1;
845 dbri->pipes[pipe].first_desc = -1;
846}
847
848
849
850
851static void setup_pipe(struct snd_dbri *dbri, int pipe, int sdp)
852{
853 if (pipe < 0 || pipe > DBRI_MAX_PIPE) {
854 printk(KERN_ERR "DBRI: setup_pipe called "
855 "with illegal pipe number\n");
856 return;
857 }
858
859 if ((sdp & 0xf800) != sdp) {
860 printk(KERN_ERR "DBRI: setup_pipe called "
861 "with strange SDP value\n");
862
863 }
864
865
866
867
868 if (D_SDP_MODE(sdp) == D_SDP_FIXED && !(sdp & D_SDP_TO_SER))
869 sdp |= D_SDP_CHANGE;
870
871 sdp |= D_PIPE(pipe);
872 dbri->pipes[pipe].sdp = sdp;
873 dbri->pipes[pipe].desc = -1;
874 dbri->pipes[pipe].first_desc = -1;
875
876 reset_pipe(dbri, pipe);
877}
878
879
880
881
882static void link_time_slot(struct snd_dbri *dbri, int pipe,
883 int prevpipe, int nextpipe,
884 int length, int cycle)
885{
886 s32 *cmd;
887 int val;
888
889 if (pipe < 0 || pipe > DBRI_MAX_PIPE
890 || prevpipe < 0 || prevpipe > DBRI_MAX_PIPE
891 || nextpipe < 0 || nextpipe > DBRI_MAX_PIPE) {
892 printk(KERN_ERR
893 "DBRI: link_time_slot called with illegal pipe number\n");
894 return;
895 }
896
897 if (dbri->pipes[pipe].sdp == 0
898 || dbri->pipes[prevpipe].sdp == 0
899 || dbri->pipes[nextpipe].sdp == 0) {
900 printk(KERN_ERR "DBRI: link_time_slot called "
901 "on uninitialized pipe\n");
902 return;
903 }
904
905 dbri->pipes[prevpipe].nextpipe = pipe;
906 dbri->pipes[pipe].nextpipe = nextpipe;
907 dbri->pipes[pipe].length = length;
908
909 cmd = dbri_cmdlock(dbri, 4);
910
911 if (dbri->pipes[pipe].sdp & D_SDP_TO_SER) {
912
913
914
915
916
917 if (prevpipe == 16 && cycle == 0)
918 cycle = dbri->chi_bpf;
919
920 val = D_DTS_VO | D_DTS_INS | D_DTS_PRVOUT(prevpipe) | pipe;
921 *(cmd++) = DBRI_CMD(D_DTS, 0, val);
922 *(cmd++) = 0;
923 *(cmd++) =
924 D_TS_LEN(length) | D_TS_CYCLE(cycle) | D_TS_NEXT(nextpipe);
925 } else {
926 val = D_DTS_VI | D_DTS_INS | D_DTS_PRVIN(prevpipe) | pipe;
927 *(cmd++) = DBRI_CMD(D_DTS, 0, val);
928 *(cmd++) =
929 D_TS_LEN(length) | D_TS_CYCLE(cycle) | D_TS_NEXT(nextpipe);
930 *(cmd++) = 0;
931 }
932 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
933
934 dbri_cmdsend(dbri, cmd, 4);
935}
936
937#if 0
938
939
940
941static void unlink_time_slot(struct snd_dbri *dbri, int pipe,
942 enum in_or_out direction, int prevpipe,
943 int nextpipe)
944{
945 s32 *cmd;
946 int val;
947
948 if (pipe < 0 || pipe > DBRI_MAX_PIPE
949 || prevpipe < 0 || prevpipe > DBRI_MAX_PIPE
950 || nextpipe < 0 || nextpipe > DBRI_MAX_PIPE) {
951 printk(KERN_ERR
952 "DBRI: unlink_time_slot called with illegal pipe number\n");
953 return;
954 }
955
956 cmd = dbri_cmdlock(dbri, 4);
957
958 if (direction == PIPEinput) {
959 val = D_DTS_VI | D_DTS_DEL | D_DTS_PRVIN(prevpipe) | pipe;
960 *(cmd++) = DBRI_CMD(D_DTS, 0, val);
961 *(cmd++) = D_TS_NEXT(nextpipe);
962 *(cmd++) = 0;
963 } else {
964 val = D_DTS_VO | D_DTS_DEL | D_DTS_PRVOUT(prevpipe) | pipe;
965 *(cmd++) = DBRI_CMD(D_DTS, 0, val);
966 *(cmd++) = 0;
967 *(cmd++) = D_TS_NEXT(nextpipe);
968 }
969 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
970
971 dbri_cmdsend(dbri, cmd, 4);
972}
973#endif
974
975
976
977
978
979
980
981
982
983
984
985
986
987
988
989
990
991static void xmit_fixed(struct snd_dbri *dbri, int pipe, unsigned int data)
992{
993 s32 *cmd;
994 unsigned long flags;
995
996 if (pipe < 16 || pipe > DBRI_MAX_PIPE) {
997 printk(KERN_ERR "DBRI: xmit_fixed: Illegal pipe number\n");
998 return;
999 }
1000
1001 if (D_SDP_MODE(dbri->pipes[pipe].sdp) == 0) {
1002 printk(KERN_ERR "DBRI: xmit_fixed: "
1003 "Uninitialized pipe %d\n", pipe);
1004 return;
1005 }
1006
1007 if (D_SDP_MODE(dbri->pipes[pipe].sdp) != D_SDP_FIXED) {
1008 printk(KERN_ERR "DBRI: xmit_fixed: Non-fixed pipe %d\n", pipe);
1009 return;
1010 }
1011
1012 if (!(dbri->pipes[pipe].sdp & D_SDP_TO_SER)) {
1013 printk(KERN_ERR "DBRI: xmit_fixed: Called on receive pipe %d\n",
1014 pipe);
1015 return;
1016 }
1017
1018
1019
1020 if (dbri->pipes[pipe].sdp & D_SDP_MSB)
1021 data = reverse_bytes(data, dbri->pipes[pipe].length);
1022
1023 cmd = dbri_cmdlock(dbri, 3);
1024
1025 *(cmd++) = DBRI_CMD(D_SSP, 0, pipe);
1026 *(cmd++) = data;
1027 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
1028
1029 spin_lock_irqsave(&dbri->lock, flags);
1030 dbri_cmdsend(dbri, cmd, 3);
1031 spin_unlock_irqrestore(&dbri->lock, flags);
1032 dbri_cmdwait(dbri);
1033
1034}
1035
1036static void recv_fixed(struct snd_dbri *dbri, int pipe, volatile __u32 *ptr)
1037{
1038 if (pipe < 16 || pipe > DBRI_MAX_PIPE) {
1039 printk(KERN_ERR "DBRI: recv_fixed called with "
1040 "illegal pipe number\n");
1041 return;
1042 }
1043
1044 if (D_SDP_MODE(dbri->pipes[pipe].sdp) != D_SDP_FIXED) {
1045 printk(KERN_ERR "DBRI: recv_fixed called on "
1046 "non-fixed pipe %d\n", pipe);
1047 return;
1048 }
1049
1050 if (dbri->pipes[pipe].sdp & D_SDP_TO_SER) {
1051 printk(KERN_ERR "DBRI: recv_fixed called on "
1052 "transmit pipe %d\n", pipe);
1053 return;
1054 }
1055
1056 dbri->pipes[pipe].recv_fixed_ptr = ptr;
1057}
1058
1059
1060
1061
1062
1063
1064
1065
1066
1067
1068
1069
1070
1071
1072
1073
1074
1075static int setup_descs(struct snd_dbri *dbri, int streamno, unsigned int period)
1076{
1077 struct dbri_streaminfo *info = &dbri->stream_info[streamno];
1078 __u32 dvma_buffer;
1079 int desc;
1080 int len;
1081 int first_desc = -1;
1082 int last_desc = -1;
1083
1084 if (info->pipe < 0 || info->pipe > 15) {
1085 printk(KERN_ERR "DBRI: setup_descs: Illegal pipe number\n");
1086 return -2;
1087 }
1088
1089 if (dbri->pipes[info->pipe].sdp == 0) {
1090 printk(KERN_ERR "DBRI: setup_descs: Uninitialized pipe %d\n",
1091 info->pipe);
1092 return -2;
1093 }
1094
1095 dvma_buffer = info->dvma_buffer;
1096 len = info->size;
1097
1098 if (streamno == DBRI_PLAY) {
1099 if (!(dbri->pipes[info->pipe].sdp & D_SDP_TO_SER)) {
1100 printk(KERN_ERR "DBRI: setup_descs: "
1101 "Called on receive pipe %d\n", info->pipe);
1102 return -2;
1103 }
1104 } else {
1105 if (dbri->pipes[info->pipe].sdp & D_SDP_TO_SER) {
1106 printk(KERN_ERR
1107 "DBRI: setup_descs: Called on transmit pipe %d\n",
1108 info->pipe);
1109 return -2;
1110 }
1111
1112
1113
1114 if (pipe_active(dbri, info->pipe)) {
1115 printk(KERN_ERR "DBRI: recv_on_pipe: "
1116 "Called on active pipe %d\n", info->pipe);
1117 return -2;
1118 }
1119
1120
1121 len &= ~3;
1122 }
1123
1124
1125 desc = dbri->pipes[info->pipe].first_desc;
1126 if (desc >= 0)
1127 do {
1128 dbri->dma->desc[desc].ba = 0;
1129 dbri->dma->desc[desc].nda = 0;
1130 desc = dbri->next_desc[desc];
1131 } while (desc != -1 &&
1132 desc != dbri->pipes[info->pipe].first_desc);
1133
1134 dbri->pipes[info->pipe].desc = -1;
1135 dbri->pipes[info->pipe].first_desc = -1;
1136
1137 desc = 0;
1138 while (len > 0) {
1139 int mylen;
1140
1141 for (; desc < DBRI_NO_DESCS; desc++) {
1142 if (!dbri->dma->desc[desc].ba)
1143 break;
1144 }
1145
1146 if (desc == DBRI_NO_DESCS) {
1147 printk(KERN_ERR "DBRI: setup_descs: No descriptors\n");
1148 return -1;
1149 }
1150
1151 if (len > DBRI_TD_MAXCNT)
1152 mylen = DBRI_TD_MAXCNT;
1153 else
1154 mylen = len;
1155
1156 if (mylen > period)
1157 mylen = period;
1158
1159 dbri->next_desc[desc] = -1;
1160 dbri->dma->desc[desc].ba = dvma_buffer;
1161 dbri->dma->desc[desc].nda = 0;
1162
1163 if (streamno == DBRI_PLAY) {
1164 dbri->dma->desc[desc].word1 = DBRI_TD_CNT(mylen);
1165 dbri->dma->desc[desc].word4 = 0;
1166 dbri->dma->desc[desc].word1 |= DBRI_TD_F | DBRI_TD_B;
1167 } else {
1168 dbri->dma->desc[desc].word1 = 0;
1169 dbri->dma->desc[desc].word4 =
1170 DBRI_RD_B | DBRI_RD_BCNT(mylen);
1171 }
1172
1173 if (first_desc == -1)
1174 first_desc = desc;
1175 else {
1176 dbri->next_desc[last_desc] = desc;
1177 dbri->dma->desc[last_desc].nda =
1178 dbri->dma_dvma + dbri_dma_off(desc, desc);
1179 }
1180
1181 last_desc = desc;
1182 dvma_buffer += mylen;
1183 len -= mylen;
1184 }
1185
1186 if (first_desc == -1 || last_desc == -1) {
1187 printk(KERN_ERR "DBRI: setup_descs: "
1188 " Not enough descriptors available\n");
1189 return -1;
1190 }
1191
1192 dbri->dma->desc[last_desc].nda =
1193 dbri->dma_dvma + dbri_dma_off(desc, first_desc);
1194 dbri->next_desc[last_desc] = first_desc;
1195 dbri->pipes[info->pipe].first_desc = first_desc;
1196 dbri->pipes[info->pipe].desc = first_desc;
1197
1198#ifdef DBRI_DEBUG
1199 for (desc = first_desc; desc != -1;) {
1200 dprintk(D_DESC, "DESC %d: %08x %08x %08x %08x\n",
1201 desc,
1202 dbri->dma->desc[desc].word1,
1203 dbri->dma->desc[desc].ba,
1204 dbri->dma->desc[desc].nda, dbri->dma->desc[desc].word4);
1205 desc = dbri->next_desc[desc];
1206 if (desc == first_desc)
1207 break;
1208 }
1209#endif
1210 return 0;
1211}
1212
1213
1214
1215
1216
1217
1218
1219
1220
1221
1222
1223
1224enum master_or_slave { CHImaster, CHIslave };
1225
1226
1227
1228
1229static void reset_chi(struct snd_dbri *dbri,
1230 enum master_or_slave master_or_slave,
1231 int bits_per_frame)
1232{
1233 s32 *cmd;
1234 int val;
1235
1236
1237
1238 cmd = dbri_cmdlock(dbri, 4);
1239 val = D_DTS_VO | D_DTS_VI | D_DTS_INS
1240 | D_DTS_PRVIN(16) | D_PIPE(16) | D_DTS_PRVOUT(16);
1241 *(cmd++) = DBRI_CMD(D_DTS, 0, val);
1242 *(cmd++) = D_TS_ANCHOR | D_TS_NEXT(16);
1243 *(cmd++) = D_TS_ANCHOR | D_TS_NEXT(16);
1244 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
1245 dbri_cmdsend(dbri, cmd, 4);
1246
1247 dbri->pipes[16].sdp = 1;
1248 dbri->pipes[16].nextpipe = 16;
1249
1250 cmd = dbri_cmdlock(dbri, 4);
1251
1252 if (master_or_slave == CHIslave) {
1253
1254
1255
1256
1257
1258
1259 *(cmd++) = DBRI_CMD(D_CHI, 0, D_CHI_CHICM(0));
1260 } else {
1261
1262
1263
1264
1265
1266
1267 int clockrate = bits_per_frame * 8;
1268 int divisor = 12288 / clockrate;
1269
1270 if (divisor > 255 || divisor * clockrate != 12288)
1271 printk(KERN_ERR "DBRI: illegal bits_per_frame "
1272 "in setup_chi\n");
1273
1274 *(cmd++) = DBRI_CMD(D_CHI, 0, D_CHI_CHICM(divisor) | D_CHI_FD
1275 | D_CHI_BPF(bits_per_frame));
1276 }
1277
1278 dbri->chi_bpf = bits_per_frame;
1279
1280
1281
1282
1283
1284
1285
1286
1287
1288 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
1289 *(cmd++) = DBRI_CMD(D_CDM, 0, D_CDM_XCE | D_CDM_XEN | D_CDM_REN);
1290 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
1291
1292 dbri_cmdsend(dbri, cmd, 4);
1293}
1294
1295
1296
1297
1298
1299
1300
1301
1302
1303
1304
1305
1306static __devinit void cs4215_setup_pipes(struct snd_dbri *dbri)
1307{
1308 unsigned long flags;
1309
1310 spin_lock_irqsave(&dbri->lock, flags);
1311
1312
1313
1314
1315
1316
1317
1318
1319
1320
1321
1322
1323
1324
1325
1326 setup_pipe(dbri, 4, D_SDP_MEM | D_SDP_TO_SER | D_SDP_MSB);
1327 setup_pipe(dbri, 20, D_SDP_FIXED | D_SDP_TO_SER | D_SDP_MSB);
1328 setup_pipe(dbri, 6, D_SDP_MEM | D_SDP_FROM_SER | D_SDP_MSB);
1329 setup_pipe(dbri, 21, D_SDP_FIXED | D_SDP_FROM_SER | D_SDP_MSB);
1330
1331 setup_pipe(dbri, 17, D_SDP_FIXED | D_SDP_TO_SER | D_SDP_MSB);
1332 setup_pipe(dbri, 18, D_SDP_FIXED | D_SDP_FROM_SER | D_SDP_MSB);
1333 setup_pipe(dbri, 19, D_SDP_FIXED | D_SDP_FROM_SER | D_SDP_MSB);
1334 spin_unlock_irqrestore(&dbri->lock, flags);
1335
1336 dbri_cmdwait(dbri);
1337}
1338
1339static __devinit int cs4215_init_data(struct cs4215 *mm)
1340{
1341
1342
1343
1344
1345
1346
1347
1348 mm->data[0] = CS4215_LO(0x20) | CS4215_HE | CS4215_LE;
1349 mm->data[1] = CS4215_RO(0x20) | CS4215_SE;
1350 mm->data[2] = CS4215_LG(0x8) | CS4215_IS | CS4215_PIO0 | CS4215_PIO1;
1351 mm->data[3] = CS4215_RG(0x8) | CS4215_MA(0xf);
1352
1353
1354
1355
1356
1357
1358
1359
1360 mm->ctrl[0] = CS4215_RSRVD_1 | CS4215_MLB;
1361 mm->ctrl[1] = CS4215_DFR_ULAW | CS4215_FREQ[0].csval;
1362 mm->ctrl[2] = CS4215_XCLK | CS4215_BSEL_128 | CS4215_FREQ[0].xtal;
1363 mm->ctrl[3] = 0;
1364
1365 mm->status = 0;
1366 mm->version = 0xff;
1367 mm->precision = 8;
1368 mm->channels = 1;
1369
1370 return 0;
1371}
1372
1373static void cs4215_setdata(struct snd_dbri *dbri, int muted)
1374{
1375 if (muted) {
1376 dbri->mm.data[0] |= 63;
1377 dbri->mm.data[1] |= 63;
1378 dbri->mm.data[2] &= ~15;
1379 dbri->mm.data[3] &= ~15;
1380 } else {
1381
1382 struct dbri_streaminfo *info = &dbri->stream_info[DBRI_PLAY];
1383 int left_gain = info->left_gain & 0x3f;
1384 int right_gain = info->right_gain & 0x3f;
1385
1386 dbri->mm.data[0] &= ~0x3f;
1387 dbri->mm.data[1] &= ~0x3f;
1388 dbri->mm.data[0] |= (DBRI_MAX_VOLUME - left_gain);
1389 dbri->mm.data[1] |= (DBRI_MAX_VOLUME - right_gain);
1390
1391
1392 info = &dbri->stream_info[DBRI_REC];
1393 left_gain = info->left_gain & 0xf;
1394 right_gain = info->right_gain & 0xf;
1395 dbri->mm.data[2] |= CS4215_LG(left_gain);
1396 dbri->mm.data[3] |= CS4215_RG(right_gain);
1397 }
1398
1399 xmit_fixed(dbri, 20, *(int *)dbri->mm.data);
1400}
1401
1402
1403
1404
1405static void cs4215_open(struct snd_dbri *dbri)
1406{
1407 int data_width;
1408 u32 tmp;
1409 unsigned long flags;
1410
1411 dprintk(D_MM, "cs4215_open: %d channels, %d bits\n",
1412 dbri->mm.channels, dbri->mm.precision);
1413
1414
1415
1416
1417
1418 cs4215_setdata(dbri, 1);
1419 udelay(125);
1420
1421
1422
1423
1424
1425
1426
1427
1428
1429
1430
1431
1432
1433
1434 spin_lock_irqsave(&dbri->lock, flags);
1435 tmp = sbus_readl(dbri->regs + REG0);
1436 tmp &= ~(D_C);
1437 sbus_writel(tmp, dbri->regs + REG0);
1438
1439
1440 sbus_writel(D_ENPIO | D_PIO1 | D_PIO3 |
1441 (dbri->mm.onboard ? D_PIO0 : D_PIO2), dbri->regs + REG2);
1442
1443 reset_chi(dbri, CHIslave, 128);
1444
1445
1446
1447
1448
1449
1450
1451 data_width = dbri->mm.channels * dbri->mm.precision;
1452
1453 link_time_slot(dbri, 4, 16, 16, data_width, dbri->mm.offset);
1454 link_time_slot(dbri, 20, 4, 16, 32, dbri->mm.offset + 32);
1455 link_time_slot(dbri, 6, 16, 16, data_width, dbri->mm.offset);
1456 link_time_slot(dbri, 21, 6, 16, 16, dbri->mm.offset + 40);
1457
1458
1459 tmp = sbus_readl(dbri->regs + REG0);
1460 tmp |= D_C;
1461 sbus_writel(tmp, dbri->regs + REG0);
1462 spin_unlock_irqrestore(&dbri->lock, flags);
1463
1464 cs4215_setdata(dbri, 0);
1465}
1466
1467
1468
1469
1470static int cs4215_setctrl(struct snd_dbri *dbri)
1471{
1472 int i, val;
1473 u32 tmp;
1474 unsigned long flags;
1475
1476
1477
1478
1479
1480
1481 cs4215_setdata(dbri, 1);
1482 udelay(125);
1483
1484
1485
1486
1487
1488 val = D_ENPIO | D_PIO1 | (dbri->mm.onboard ? D_PIO0 : D_PIO2);
1489 sbus_writel(val, dbri->regs + REG2);
1490 dprintk(D_MM, "cs4215_setctrl: reg2=0x%x\n", val);
1491 udelay(34);
1492
1493
1494
1495
1496
1497
1498
1499
1500
1501
1502
1503
1504
1505
1506
1507
1508
1509
1510
1511 spin_lock_irqsave(&dbri->lock, flags);
1512 tmp = sbus_readl(dbri->regs + REG0);
1513 tmp &= ~D_C;
1514 sbus_writel(tmp, dbri->regs + REG0);
1515
1516 reset_chi(dbri, CHImaster, 128);
1517
1518
1519
1520
1521
1522
1523
1524
1525 link_time_slot(dbri, 17, 16, 16, 32, dbri->mm.offset);
1526 link_time_slot(dbri, 18, 16, 16, 8, dbri->mm.offset);
1527 link_time_slot(dbri, 19, 18, 16, 8, dbri->mm.offset + 48);
1528 spin_unlock_irqrestore(&dbri->lock, flags);
1529
1530
1531 dbri->mm.ctrl[0] &= ~CS4215_CLB;
1532 xmit_fixed(dbri, 17, *(int *)dbri->mm.ctrl);
1533
1534 spin_lock_irqsave(&dbri->lock, flags);
1535 tmp = sbus_readl(dbri->regs + REG0);
1536 tmp |= D_C;
1537 sbus_writel(tmp, dbri->regs + REG0);
1538 spin_unlock_irqrestore(&dbri->lock, flags);
1539
1540 for (i = 10; ((dbri->mm.status & 0xe4) != 0x20); --i)
1541 msleep_interruptible(1);
1542
1543 if (i == 0) {
1544 dprintk(D_MM, "CS4215 didn't respond to CLB (0x%02x)\n",
1545 dbri->mm.status);
1546 return -1;
1547 }
1548
1549
1550
1551
1552 recv_fixed(dbri, 19, NULL);
1553
1554
1555
1556
1557 dbri->mm.ctrl[0] |= CS4215_CLB;
1558 xmit_fixed(dbri, 17, *(int *)dbri->mm.ctrl);
1559
1560
1561 udelay(250);
1562
1563 cs4215_setdata(dbri, 0);
1564
1565 return 0;
1566}
1567
1568
1569
1570
1571
1572
1573
1574static int cs4215_prepare(struct snd_dbri *dbri, unsigned int rate,
1575 snd_pcm_format_t format, unsigned int channels)
1576{
1577 int freq_idx;
1578 int ret = 0;
1579
1580
1581 for (freq_idx = 0; CS4215_FREQ[freq_idx].freq != 0; freq_idx++) {
1582 if (CS4215_FREQ[freq_idx].freq == rate)
1583 break;
1584 }
1585 if (CS4215_FREQ[freq_idx].freq != rate) {
1586 printk(KERN_WARNING "DBRI: Unsupported rate %d Hz\n", rate);
1587 return -1;
1588 }
1589
1590 switch (format) {
1591 case SNDRV_PCM_FORMAT_MU_LAW:
1592 dbri->mm.ctrl[1] = CS4215_DFR_ULAW;
1593 dbri->mm.precision = 8;
1594 break;
1595 case SNDRV_PCM_FORMAT_A_LAW:
1596 dbri->mm.ctrl[1] = CS4215_DFR_ALAW;
1597 dbri->mm.precision = 8;
1598 break;
1599 case SNDRV_PCM_FORMAT_U8:
1600 dbri->mm.ctrl[1] = CS4215_DFR_LINEAR8;
1601 dbri->mm.precision = 8;
1602 break;
1603 case SNDRV_PCM_FORMAT_S16_BE:
1604 dbri->mm.ctrl[1] = CS4215_DFR_LINEAR16;
1605 dbri->mm.precision = 16;
1606 break;
1607 default:
1608 printk(KERN_WARNING "DBRI: Unsupported format %d\n", format);
1609 return -1;
1610 }
1611
1612
1613 dbri->mm.ctrl[1] |= CS4215_FREQ[freq_idx].csval;
1614 dbri->mm.ctrl[2] = CS4215_XCLK |
1615 CS4215_BSEL_128 | CS4215_FREQ[freq_idx].xtal;
1616
1617 dbri->mm.channels = channels;
1618 if (channels == 2)
1619 dbri->mm.ctrl[1] |= CS4215_DFR_STEREO;
1620
1621 ret = cs4215_setctrl(dbri);
1622 if (ret == 0)
1623 cs4215_open(dbri);
1624
1625 return ret;
1626}
1627
1628
1629
1630
1631static __devinit int cs4215_init(struct snd_dbri *dbri)
1632{
1633 u32 reg2 = sbus_readl(dbri->regs + REG2);
1634 dprintk(D_MM, "cs4215_init: reg2=0x%x\n", reg2);
1635
1636
1637 if (reg2 & D_PIO2) {
1638 dprintk(D_MM, "Onboard CS4215 detected\n");
1639 dbri->mm.onboard = 1;
1640 }
1641 if (reg2 & D_PIO0) {
1642 dprintk(D_MM, "Speakerbox detected\n");
1643 dbri->mm.onboard = 0;
1644
1645 if (reg2 & D_PIO2) {
1646 printk(KERN_INFO "DBRI: Using speakerbox / "
1647 "ignoring onboard mmcodec.\n");
1648 sbus_writel(D_ENPIO2, dbri->regs + REG2);
1649 }
1650 }
1651
1652 if (!(reg2 & (D_PIO0 | D_PIO2))) {
1653 printk(KERN_ERR "DBRI: no mmcodec found.\n");
1654 return -EIO;
1655 }
1656
1657 cs4215_setup_pipes(dbri);
1658 cs4215_init_data(&dbri->mm);
1659
1660
1661 recv_fixed(dbri, 18, &dbri->mm.status);
1662 recv_fixed(dbri, 19, &dbri->mm.version);
1663
1664 dbri->mm.offset = dbri->mm.onboard ? 0 : 8;
1665 if (cs4215_setctrl(dbri) == -1 || dbri->mm.version == 0xff) {
1666 dprintk(D_MM, "CS4215 failed probe at offset %d\n",
1667 dbri->mm.offset);
1668 return -EIO;
1669 }
1670 dprintk(D_MM, "Found CS4215 at offset %d\n", dbri->mm.offset);
1671
1672 return 0;
1673}
1674
1675
1676
1677
1678
1679
1680
1681
1682
1683
1684
1685
1686
1687
1688
1689
1690
1691
1692
1693
1694
1695static void xmit_descs(struct snd_dbri *dbri)
1696{
1697 struct dbri_streaminfo *info;
1698 s32 *cmd;
1699 unsigned long flags;
1700 int first_td;
1701
1702 if (dbri == NULL)
1703 return;
1704
1705 info = &dbri->stream_info[DBRI_REC];
1706 spin_lock_irqsave(&dbri->lock, flags);
1707
1708 if (info->pipe >= 0) {
1709 first_td = dbri->pipes[info->pipe].first_desc;
1710
1711 dprintk(D_DESC, "xmit_descs rec @ TD %d\n", first_td);
1712
1713
1714 if (first_td >= 0) {
1715 cmd = dbri_cmdlock(dbri, 2);
1716 *(cmd++) = DBRI_CMD(D_SDP, 0,
1717 dbri->pipes[info->pipe].sdp
1718 | D_SDP_P | D_SDP_EVERY | D_SDP_C);
1719 *(cmd++) = dbri->dma_dvma +
1720 dbri_dma_off(desc, first_td);
1721 dbri_cmdsend(dbri, cmd, 2);
1722
1723
1724 dbri->pipes[info->pipe].desc = first_td;
1725 }
1726 }
1727
1728 info = &dbri->stream_info[DBRI_PLAY];
1729
1730 if (info->pipe >= 0) {
1731 first_td = dbri->pipes[info->pipe].first_desc;
1732
1733 dprintk(D_DESC, "xmit_descs play @ TD %d\n", first_td);
1734
1735
1736 if (first_td >= 0) {
1737 cmd = dbri_cmdlock(dbri, 2);
1738 *(cmd++) = DBRI_CMD(D_SDP, 0,
1739 dbri->pipes[info->pipe].sdp
1740 | D_SDP_P | D_SDP_EVERY | D_SDP_C);
1741 *(cmd++) = dbri->dma_dvma +
1742 dbri_dma_off(desc, first_td);
1743 dbri_cmdsend(dbri, cmd, 2);
1744
1745
1746 dbri->pipes[info->pipe].desc = first_td;
1747 }
1748 }
1749
1750 spin_unlock_irqrestore(&dbri->lock, flags);
1751}
1752
1753
1754
1755
1756
1757
1758
1759
1760
1761
1762
1763
1764
1765
1766
1767static void transmission_complete_intr(struct snd_dbri *dbri, int pipe)
1768{
1769 struct dbri_streaminfo *info = &dbri->stream_info[DBRI_PLAY];
1770 int td = dbri->pipes[pipe].desc;
1771 int status;
1772
1773 while (td >= 0) {
1774 if (td >= DBRI_NO_DESCS) {
1775 printk(KERN_ERR "DBRI: invalid td on pipe %d\n", pipe);
1776 return;
1777 }
1778
1779 status = DBRI_TD_STATUS(dbri->dma->desc[td].word4);
1780 if (!(status & DBRI_TD_TBC))
1781 break;
1782
1783 dprintk(D_INT, "TD %d, status 0x%02x\n", td, status);
1784
1785 dbri->dma->desc[td].word4 = 0;
1786 info->offset += DBRI_RD_CNT(dbri->dma->desc[td].word1);
1787
1788 td = dbri->next_desc[td];
1789 dbri->pipes[pipe].desc = td;
1790 }
1791
1792
1793 spin_unlock(&dbri->lock);
1794 snd_pcm_period_elapsed(info->substream);
1795 spin_lock(&dbri->lock);
1796}
1797
1798static void reception_complete_intr(struct snd_dbri *dbri, int pipe)
1799{
1800 struct dbri_streaminfo *info;
1801 int rd = dbri->pipes[pipe].desc;
1802 s32 status;
1803
1804 if (rd < 0 || rd >= DBRI_NO_DESCS) {
1805 printk(KERN_ERR "DBRI: invalid rd on pipe %d\n", pipe);
1806 return;
1807 }
1808
1809 dbri->pipes[pipe].desc = dbri->next_desc[rd];
1810 status = dbri->dma->desc[rd].word1;
1811 dbri->dma->desc[rd].word1 = 0;
1812
1813 info = &dbri->stream_info[DBRI_REC];
1814 info->offset += DBRI_RD_CNT(status);
1815
1816
1817
1818 dprintk(D_INT, "Recv RD %d, status 0x%02x, len %d\n",
1819 rd, DBRI_RD_STATUS(status), DBRI_RD_CNT(status));
1820
1821
1822 spin_unlock(&dbri->lock);
1823 snd_pcm_period_elapsed(info->substream);
1824 spin_lock(&dbri->lock);
1825}
1826
1827static void dbri_process_one_interrupt(struct snd_dbri *dbri, int x)
1828{
1829 int val = D_INTR_GETVAL(x);
1830 int channel = D_INTR_GETCHAN(x);
1831 int command = D_INTR_GETCMD(x);
1832 int code = D_INTR_GETCODE(x);
1833#ifdef DBRI_DEBUG
1834 int rval = D_INTR_GETRVAL(x);
1835#endif
1836
1837 if (channel == D_INTR_CMD) {
1838 dprintk(D_CMD, "INTR: Command: %-5s Value:%d\n",
1839 cmds[command], val);
1840 } else {
1841 dprintk(D_INT, "INTR: Chan:%d Code:%d Val:%#x\n",
1842 channel, code, rval);
1843 }
1844
1845 switch (code) {
1846 case D_INTR_CMDI:
1847 if (command != D_WAIT)
1848 printk(KERN_ERR "DBRI: Command read interrupt\n");
1849 break;
1850 case D_INTR_BRDY:
1851 reception_complete_intr(dbri, channel);
1852 break;
1853 case D_INTR_XCMP:
1854 case D_INTR_MINT:
1855 transmission_complete_intr(dbri, channel);
1856 break;
1857 case D_INTR_UNDR:
1858
1859
1860
1861 {
1862
1863 printk(KERN_ERR "DBRI: Underrun error\n");
1864#if 0
1865 s32 *cmd;
1866 int pipe = channel;
1867 int td = dbri->pipes[pipe].desc;
1868
1869 dbri->dma->desc[td].word4 = 0;
1870 cmd = dbri_cmdlock(dbri, NoGetLock);
1871 *(cmd++) = DBRI_CMD(D_SDP, 0,
1872 dbri->pipes[pipe].sdp
1873 | D_SDP_P | D_SDP_C | D_SDP_2SAME);
1874 *(cmd++) = dbri->dma_dvma + dbri_dma_off(desc, td);
1875 dbri_cmdsend(dbri, cmd);
1876#endif
1877 }
1878 break;
1879 case D_INTR_FXDT:
1880
1881 if (dbri->pipes[channel].sdp & D_SDP_MSB)
1882 val = reverse_bytes(val, dbri->pipes[channel].length);
1883
1884 if (dbri->pipes[channel].recv_fixed_ptr)
1885 *(dbri->pipes[channel].recv_fixed_ptr) = val;
1886 break;
1887 default:
1888 if (channel != D_INTR_CMD)
1889 printk(KERN_WARNING
1890 "DBRI: Ignored Interrupt: %d (0x%x)\n", code, x);
1891 }
1892}
1893
1894
1895
1896
1897
1898
1899static void dbri_process_interrupt_buffer(struct snd_dbri *dbri)
1900{
1901 s32 x;
1902
1903 while ((x = dbri->dma->intr[dbri->dbri_irqp]) != 0) {
1904 dbri->dma->intr[dbri->dbri_irqp] = 0;
1905 dbri->dbri_irqp++;
1906 if (dbri->dbri_irqp == DBRI_INT_BLK)
1907 dbri->dbri_irqp = 1;
1908
1909 dbri_process_one_interrupt(dbri, x);
1910 }
1911}
1912
1913static irqreturn_t snd_dbri_interrupt(int irq, void *dev_id)
1914{
1915 struct snd_dbri *dbri = dev_id;
1916 static int errcnt = 0;
1917 int x;
1918
1919 if (dbri == NULL)
1920 return IRQ_NONE;
1921 spin_lock(&dbri->lock);
1922
1923
1924
1925
1926 x = sbus_readl(dbri->regs + REG1);
1927
1928 if (x & (D_MRR | D_MLE | D_LBG | D_MBE)) {
1929 u32 tmp;
1930
1931 if (x & D_MRR)
1932 printk(KERN_ERR
1933 "DBRI: Multiple Error Ack on SBus reg1=0x%x\n",
1934 x);
1935 if (x & D_MLE)
1936 printk(KERN_ERR
1937 "DBRI: Multiple Late Error on SBus reg1=0x%x\n",
1938 x);
1939 if (x & D_LBG)
1940 printk(KERN_ERR
1941 "DBRI: Lost Bus Grant on SBus reg1=0x%x\n", x);
1942 if (x & D_MBE)
1943 printk(KERN_ERR
1944 "DBRI: Burst Error on SBus reg1=0x%x\n", x);
1945
1946
1947
1948
1949
1950
1951
1952
1953
1954 if ((++errcnt) % 10 == 0) {
1955 dprintk(D_INT, "Interrupt errors exceeded.\n");
1956 dbri_reset(dbri);
1957 } else {
1958 tmp = sbus_readl(dbri->regs + REG0);
1959 tmp &= ~(D_D);
1960 sbus_writel(tmp, dbri->regs + REG0);
1961 }
1962 }
1963
1964 dbri_process_interrupt_buffer(dbri);
1965
1966 spin_unlock(&dbri->lock);
1967
1968 return IRQ_HANDLED;
1969}
1970
1971
1972
1973
1974static struct snd_pcm_hardware snd_dbri_pcm_hw = {
1975 .info = SNDRV_PCM_INFO_MMAP |
1976 SNDRV_PCM_INFO_INTERLEAVED |
1977 SNDRV_PCM_INFO_BLOCK_TRANSFER |
1978 SNDRV_PCM_INFO_MMAP_VALID |
1979 SNDRV_PCM_INFO_BATCH,
1980 .formats = SNDRV_PCM_FMTBIT_MU_LAW |
1981 SNDRV_PCM_FMTBIT_A_LAW |
1982 SNDRV_PCM_FMTBIT_U8 |
1983 SNDRV_PCM_FMTBIT_S16_BE,
1984 .rates = SNDRV_PCM_RATE_8000_48000 | SNDRV_PCM_RATE_5512,
1985 .rate_min = 5512,
1986 .rate_max = 48000,
1987 .channels_min = 1,
1988 .channels_max = 2,
1989 .buffer_bytes_max = 64 * 1024,
1990 .period_bytes_min = 1,
1991 .period_bytes_max = DBRI_TD_MAXCNT,
1992 .periods_min = 1,
1993 .periods_max = 1024,
1994};
1995
1996static int snd_hw_rule_format(struct snd_pcm_hw_params *params,
1997 struct snd_pcm_hw_rule *rule)
1998{
1999 struct snd_interval *c = hw_param_interval(params,
2000 SNDRV_PCM_HW_PARAM_CHANNELS);
2001 struct snd_mask *f = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT);
2002 struct snd_mask fmt;
2003
2004 snd_mask_any(&fmt);
2005 if (c->min > 1) {
2006 fmt.bits[0] &= SNDRV_PCM_FMTBIT_S16_BE;
2007 return snd_mask_refine(f, &fmt);
2008 }
2009 return 0;
2010}
2011
2012static int snd_hw_rule_channels(struct snd_pcm_hw_params *params,
2013 struct snd_pcm_hw_rule *rule)
2014{
2015 struct snd_interval *c = hw_param_interval(params,
2016 SNDRV_PCM_HW_PARAM_CHANNELS);
2017 struct snd_mask *f = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT);
2018 struct snd_interval ch;
2019
2020 snd_interval_any(&ch);
2021 if (!(f->bits[0] & SNDRV_PCM_FMTBIT_S16_BE)) {
2022 ch.min = 1;
2023 ch.max = 1;
2024 ch.integer = 1;
2025 return snd_interval_refine(c, &ch);
2026 }
2027 return 0;
2028}
2029
2030static int snd_dbri_open(struct snd_pcm_substream *substream)
2031{
2032 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2033 struct snd_pcm_runtime *runtime = substream->runtime;
2034 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2035 unsigned long flags;
2036
2037 dprintk(D_USR, "open audio output.\n");
2038 runtime->hw = snd_dbri_pcm_hw;
2039
2040 spin_lock_irqsave(&dbri->lock, flags);
2041 info->substream = substream;
2042 info->offset = 0;
2043 info->dvma_buffer = 0;
2044 info->pipe = -1;
2045 spin_unlock_irqrestore(&dbri->lock, flags);
2046
2047 snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_CHANNELS,
2048 snd_hw_rule_format, NULL, SNDRV_PCM_HW_PARAM_FORMAT,
2049 -1);
2050 snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_FORMAT,
2051 snd_hw_rule_channels, NULL,
2052 SNDRV_PCM_HW_PARAM_CHANNELS,
2053 -1);
2054
2055 cs4215_open(dbri);
2056
2057 return 0;
2058}
2059
2060static int snd_dbri_close(struct snd_pcm_substream *substream)
2061{
2062 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2063 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2064
2065 dprintk(D_USR, "close audio output.\n");
2066 info->substream = NULL;
2067 info->offset = 0;
2068
2069 return 0;
2070}
2071
2072static int snd_dbri_hw_params(struct snd_pcm_substream *substream,
2073 struct snd_pcm_hw_params *hw_params)
2074{
2075 struct snd_pcm_runtime *runtime = substream->runtime;
2076 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2077 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2078 int direction;
2079 int ret;
2080
2081
2082 ret = cs4215_prepare(dbri, params_rate(hw_params),
2083 params_format(hw_params),
2084 params_channels(hw_params));
2085 if (ret != 0)
2086 return ret;
2087
2088 if ((ret = snd_pcm_lib_malloc_pages(substream,
2089 params_buffer_bytes(hw_params))) < 0) {
2090 printk(KERN_ERR "malloc_pages failed with %d\n", ret);
2091 return ret;
2092 }
2093
2094
2095
2096 if (info->dvma_buffer == 0) {
2097 if (DBRI_STREAMNO(substream) == DBRI_PLAY)
2098 direction = DMA_TO_DEVICE;
2099 else
2100 direction = DMA_FROM_DEVICE;
2101
2102 info->dvma_buffer =
2103 dma_map_single(&dbri->op->dev,
2104 runtime->dma_area,
2105 params_buffer_bytes(hw_params),
2106 direction);
2107 }
2108
2109 direction = params_buffer_bytes(hw_params);
2110 dprintk(D_USR, "hw_params: %d bytes, dvma=%x\n",
2111 direction, info->dvma_buffer);
2112 return 0;
2113}
2114
2115static int snd_dbri_hw_free(struct snd_pcm_substream *substream)
2116{
2117 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2118 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2119 int direction;
2120
2121 dprintk(D_USR, "hw_free.\n");
2122
2123
2124
2125 if (info->dvma_buffer) {
2126 if (DBRI_STREAMNO(substream) == DBRI_PLAY)
2127 direction = DMA_TO_DEVICE;
2128 else
2129 direction = DMA_FROM_DEVICE;
2130
2131 dma_unmap_single(&dbri->op->dev, info->dvma_buffer,
2132 substream->runtime->buffer_size, direction);
2133 info->dvma_buffer = 0;
2134 }
2135 if (info->pipe != -1) {
2136 reset_pipe(dbri, info->pipe);
2137 info->pipe = -1;
2138 }
2139
2140 return snd_pcm_lib_free_pages(substream);
2141}
2142
2143static int snd_dbri_prepare(struct snd_pcm_substream *substream)
2144{
2145 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2146 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2147 int ret;
2148
2149 info->size = snd_pcm_lib_buffer_bytes(substream);
2150 if (DBRI_STREAMNO(substream) == DBRI_PLAY)
2151 info->pipe = 4;
2152 else
2153 info->pipe = 6;
2154
2155 spin_lock_irq(&dbri->lock);
2156 info->offset = 0;
2157
2158
2159
2160
2161 ret = setup_descs(dbri, DBRI_STREAMNO(substream),
2162 snd_pcm_lib_period_bytes(substream));
2163
2164 spin_unlock_irq(&dbri->lock);
2165
2166 dprintk(D_USR, "prepare audio output. %d bytes\n", info->size);
2167 return ret;
2168}
2169
2170static int snd_dbri_trigger(struct snd_pcm_substream *substream, int cmd)
2171{
2172 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2173 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2174 int ret = 0;
2175
2176 switch (cmd) {
2177 case SNDRV_PCM_TRIGGER_START:
2178 dprintk(D_USR, "start audio, period is %d bytes\n",
2179 (int)snd_pcm_lib_period_bytes(substream));
2180
2181 xmit_descs(dbri);
2182 break;
2183 case SNDRV_PCM_TRIGGER_STOP:
2184 dprintk(D_USR, "stop audio.\n");
2185 reset_pipe(dbri, info->pipe);
2186 break;
2187 default:
2188 ret = -EINVAL;
2189 }
2190
2191 return ret;
2192}
2193
2194static snd_pcm_uframes_t snd_dbri_pointer(struct snd_pcm_substream *substream)
2195{
2196 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2197 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2198 snd_pcm_uframes_t ret;
2199
2200 ret = bytes_to_frames(substream->runtime, info->offset)
2201 % substream->runtime->buffer_size;
2202 dprintk(D_USR, "I/O pointer: %ld frames of %ld.\n",
2203 ret, substream->runtime->buffer_size);
2204 return ret;
2205}
2206
2207static struct snd_pcm_ops snd_dbri_ops = {
2208 .open = snd_dbri_open,
2209 .close = snd_dbri_close,
2210 .ioctl = snd_pcm_lib_ioctl,
2211 .hw_params = snd_dbri_hw_params,
2212 .hw_free = snd_dbri_hw_free,
2213 .prepare = snd_dbri_prepare,
2214 .trigger = snd_dbri_trigger,
2215 .pointer = snd_dbri_pointer,
2216};
2217
2218static int __devinit snd_dbri_pcm(struct snd_card *card)
2219{
2220 struct snd_pcm *pcm;
2221 int err;
2222
2223 if ((err = snd_pcm_new(card,
2224 "sun_dbri",
2225 0,
2226 1,
2227 1, &pcm)) < 0)
2228 return err;
2229
2230 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_dbri_ops);
2231 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_dbri_ops);
2232
2233 pcm->private_data = card->private_data;
2234 pcm->info_flags = 0;
2235 strcpy(pcm->name, card->shortname);
2236
2237 if ((err = snd_pcm_lib_preallocate_pages_for_all(pcm,
2238 SNDRV_DMA_TYPE_CONTINUOUS,
2239 snd_dma_continuous_data(GFP_KERNEL),
2240 64 * 1024, 64 * 1024)) < 0)
2241 return err;
2242
2243 return 0;
2244}
2245
2246
2247
2248
2249
2250static int snd_cs4215_info_volume(struct snd_kcontrol *kcontrol,
2251 struct snd_ctl_elem_info *uinfo)
2252{
2253 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2254 uinfo->count = 2;
2255 uinfo->value.integer.min = 0;
2256 if (kcontrol->private_value == DBRI_PLAY)
2257 uinfo->value.integer.max = DBRI_MAX_VOLUME;
2258 else
2259 uinfo->value.integer.max = DBRI_MAX_GAIN;
2260 return 0;
2261}
2262
2263static int snd_cs4215_get_volume(struct snd_kcontrol *kcontrol,
2264 struct snd_ctl_elem_value *ucontrol)
2265{
2266 struct snd_dbri *dbri = snd_kcontrol_chip(kcontrol);
2267 struct dbri_streaminfo *info;
2268
2269 if (snd_BUG_ON(!dbri))
2270 return -EINVAL;
2271 info = &dbri->stream_info[kcontrol->private_value];
2272
2273 ucontrol->value.integer.value[0] = info->left_gain;
2274 ucontrol->value.integer.value[1] = info->right_gain;
2275 return 0;
2276}
2277
2278static int snd_cs4215_put_volume(struct snd_kcontrol *kcontrol,
2279 struct snd_ctl_elem_value *ucontrol)
2280{
2281 struct snd_dbri *dbri = snd_kcontrol_chip(kcontrol);
2282 struct dbri_streaminfo *info =
2283 &dbri->stream_info[kcontrol->private_value];
2284 unsigned int vol[2];
2285 int changed = 0;
2286
2287 vol[0] = ucontrol->value.integer.value[0];
2288 vol[1] = ucontrol->value.integer.value[1];
2289 if (kcontrol->private_value == DBRI_PLAY) {
2290 if (vol[0] > DBRI_MAX_VOLUME || vol[1] > DBRI_MAX_VOLUME)
2291 return -EINVAL;
2292 } else {
2293 if (vol[0] > DBRI_MAX_GAIN || vol[1] > DBRI_MAX_GAIN)
2294 return -EINVAL;
2295 }
2296
2297 if (info->left_gain != vol[0]) {
2298 info->left_gain = vol[0];
2299 changed = 1;
2300 }
2301 if (info->right_gain != vol[1]) {
2302 info->right_gain = vol[1];
2303 changed = 1;
2304 }
2305 if (changed) {
2306
2307
2308
2309 cs4215_setdata(dbri, 1);
2310 udelay(125);
2311 cs4215_setdata(dbri, 0);
2312 }
2313 return changed;
2314}
2315
2316static int snd_cs4215_info_single(struct snd_kcontrol *kcontrol,
2317 struct snd_ctl_elem_info *uinfo)
2318{
2319 int mask = (kcontrol->private_value >> 16) & 0xff;
2320
2321 uinfo->type = (mask == 1) ?
2322 SNDRV_CTL_ELEM_TYPE_BOOLEAN : SNDRV_CTL_ELEM_TYPE_INTEGER;
2323 uinfo->count = 1;
2324 uinfo->value.integer.min = 0;
2325 uinfo->value.integer.max = mask;
2326 return 0;
2327}
2328
2329static int snd_cs4215_get_single(struct snd_kcontrol *kcontrol,
2330 struct snd_ctl_elem_value *ucontrol)
2331{
2332 struct snd_dbri *dbri = snd_kcontrol_chip(kcontrol);
2333 int elem = kcontrol->private_value & 0xff;
2334 int shift = (kcontrol->private_value >> 8) & 0xff;
2335 int mask = (kcontrol->private_value >> 16) & 0xff;
2336 int invert = (kcontrol->private_value >> 24) & 1;
2337
2338 if (snd_BUG_ON(!dbri))
2339 return -EINVAL;
2340
2341 if (elem < 4)
2342 ucontrol->value.integer.value[0] =
2343 (dbri->mm.data[elem] >> shift) & mask;
2344 else
2345 ucontrol->value.integer.value[0] =
2346 (dbri->mm.ctrl[elem - 4] >> shift) & mask;
2347
2348 if (invert == 1)
2349 ucontrol->value.integer.value[0] =
2350 mask - ucontrol->value.integer.value[0];
2351 return 0;
2352}
2353
2354static int snd_cs4215_put_single(struct snd_kcontrol *kcontrol,
2355 struct snd_ctl_elem_value *ucontrol)
2356{
2357 struct snd_dbri *dbri = snd_kcontrol_chip(kcontrol);
2358 int elem = kcontrol->private_value & 0xff;
2359 int shift = (kcontrol->private_value >> 8) & 0xff;
2360 int mask = (kcontrol->private_value >> 16) & 0xff;
2361 int invert = (kcontrol->private_value >> 24) & 1;
2362 int changed = 0;
2363 unsigned short val;
2364
2365 if (snd_BUG_ON(!dbri))
2366 return -EINVAL;
2367
2368 val = (ucontrol->value.integer.value[0] & mask);
2369 if (invert == 1)
2370 val = mask - val;
2371 val <<= shift;
2372
2373 if (elem < 4) {
2374 dbri->mm.data[elem] = (dbri->mm.data[elem] &
2375 ~(mask << shift)) | val;
2376 changed = (val != dbri->mm.data[elem]);
2377 } else {
2378 dbri->mm.ctrl[elem - 4] = (dbri->mm.ctrl[elem - 4] &
2379 ~(mask << shift)) | val;
2380 changed = (val != dbri->mm.ctrl[elem - 4]);
2381 }
2382
2383 dprintk(D_GEN, "put_single: mask=0x%x, changed=%d, "
2384 "mixer-value=%ld, mm-value=0x%x\n",
2385 mask, changed, ucontrol->value.integer.value[0],
2386 dbri->mm.data[elem & 3]);
2387
2388 if (changed) {
2389
2390
2391
2392 cs4215_setdata(dbri, 1);
2393 udelay(125);
2394 cs4215_setdata(dbri, 0);
2395 }
2396 return changed;
2397}
2398
2399
2400
2401
2402
2403#define CS4215_SINGLE(xname, entry, shift, mask, invert) \
2404{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname), \
2405 .info = snd_cs4215_info_single, \
2406 .get = snd_cs4215_get_single, .put = snd_cs4215_put_single, \
2407 .private_value = (entry) | ((shift) << 8) | ((mask) << 16) | \
2408 ((invert) << 24) },
2409
2410static struct snd_kcontrol_new dbri_controls[] __devinitdata = {
2411 {
2412 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2413 .name = "Playback Volume",
2414 .info = snd_cs4215_info_volume,
2415 .get = snd_cs4215_get_volume,
2416 .put = snd_cs4215_put_volume,
2417 .private_value = DBRI_PLAY,
2418 },
2419 CS4215_SINGLE("Headphone switch", 0, 7, 1, 0)
2420 CS4215_SINGLE("Line out switch", 0, 6, 1, 0)
2421 CS4215_SINGLE("Speaker switch", 1, 6, 1, 0)
2422 {
2423 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2424 .name = "Capture Volume",
2425 .info = snd_cs4215_info_volume,
2426 .get = snd_cs4215_get_volume,
2427 .put = snd_cs4215_put_volume,
2428 .private_value = DBRI_REC,
2429 },
2430
2431 CS4215_SINGLE("Line in switch", 2, 4, 1, 0)
2432 CS4215_SINGLE("High Pass Filter switch", 5, 7, 1, 0)
2433 CS4215_SINGLE("Monitor Volume", 3, 4, 0xf, 1)
2434 CS4215_SINGLE("Mic boost", 4, 4, 1, 1)
2435};
2436
2437static int __devinit snd_dbri_mixer(struct snd_card *card)
2438{
2439 int idx, err;
2440 struct snd_dbri *dbri;
2441
2442 if (snd_BUG_ON(!card || !card->private_data))
2443 return -EINVAL;
2444 dbri = card->private_data;
2445
2446 strcpy(card->mixername, card->shortname);
2447
2448 for (idx = 0; idx < ARRAY_SIZE(dbri_controls); idx++) {
2449 err = snd_ctl_add(card,
2450 snd_ctl_new1(&dbri_controls[idx], dbri));
2451 if (err < 0)
2452 return err;
2453 }
2454
2455 for (idx = DBRI_REC; idx < DBRI_NO_STREAMS; idx++) {
2456 dbri->stream_info[idx].left_gain = 0;
2457 dbri->stream_info[idx].right_gain = 0;
2458 }
2459
2460 return 0;
2461}
2462
2463
2464
2465
2466static void dbri_regs_read(struct snd_info_entry *entry,
2467 struct snd_info_buffer *buffer)
2468{
2469 struct snd_dbri *dbri = entry->private_data;
2470
2471 snd_iprintf(buffer, "REG0: 0x%x\n", sbus_readl(dbri->regs + REG0));
2472 snd_iprintf(buffer, "REG2: 0x%x\n", sbus_readl(dbri->regs + REG2));
2473 snd_iprintf(buffer, "REG8: 0x%x\n", sbus_readl(dbri->regs + REG8));
2474 snd_iprintf(buffer, "REG9: 0x%x\n", sbus_readl(dbri->regs + REG9));
2475}
2476
2477#ifdef DBRI_DEBUG
2478static void dbri_debug_read(struct snd_info_entry *entry,
2479 struct snd_info_buffer *buffer)
2480{
2481 struct snd_dbri *dbri = entry->private_data;
2482 int pipe;
2483 snd_iprintf(buffer, "debug=%d\n", dbri_debug);
2484
2485 for (pipe = 0; pipe < 32; pipe++) {
2486 if (pipe_active(dbri, pipe)) {
2487 struct dbri_pipe *pptr = &dbri->pipes[pipe];
2488 snd_iprintf(buffer,
2489 "Pipe %d: %s SDP=0x%x desc=%d, "
2490 "len=%d next %d\n",
2491 pipe,
2492 (pptr->sdp & D_SDP_TO_SER) ? "output" :
2493 "input",
2494 pptr->sdp, pptr->desc,
2495 pptr->length, pptr->nextpipe);
2496 }
2497 }
2498}
2499#endif
2500
2501static void __devinit snd_dbri_proc(struct snd_card *card)
2502{
2503 struct snd_dbri *dbri = card->private_data;
2504 struct snd_info_entry *entry;
2505
2506 if (!snd_card_proc_new(card, "regs", &entry))
2507 snd_info_set_text_ops(entry, dbri, dbri_regs_read);
2508
2509#ifdef DBRI_DEBUG
2510 if (!snd_card_proc_new(card, "debug", &entry)) {
2511 snd_info_set_text_ops(entry, dbri, dbri_debug_read);
2512 entry->mode = S_IFREG | S_IRUGO;
2513 }
2514#endif
2515}
2516
2517
2518
2519
2520
2521
2522static void snd_dbri_free(struct snd_dbri *dbri);
2523
2524static int __devinit snd_dbri_create(struct snd_card *card,
2525 struct of_device *op,
2526 int irq, int dev)
2527{
2528 struct snd_dbri *dbri = card->private_data;
2529 int err;
2530
2531 spin_lock_init(&dbri->lock);
2532 dbri->op = op;
2533 dbri->irq = irq;
2534
2535 dbri->dma = dma_alloc_coherent(&op->dev,
2536 sizeof(struct dbri_dma),
2537 &dbri->dma_dvma, GFP_ATOMIC);
2538 if (!dbri->dma)
2539 return -ENOMEM;
2540 memset((void *)dbri->dma, 0, sizeof(struct dbri_dma));
2541
2542 dprintk(D_GEN, "DMA Cmd Block 0x%p (0x%08x)\n",
2543 dbri->dma, dbri->dma_dvma);
2544
2545
2546 dbri->regs_size = resource_size(&op->resource[0]);
2547 dbri->regs = of_ioremap(&op->resource[0], 0,
2548 dbri->regs_size, "DBRI Registers");
2549 if (!dbri->regs) {
2550 printk(KERN_ERR "DBRI: could not allocate registers\n");
2551 dma_free_coherent(&op->dev, sizeof(struct dbri_dma),
2552 (void *)dbri->dma, dbri->dma_dvma);
2553 return -EIO;
2554 }
2555
2556 err = request_irq(dbri->irq, snd_dbri_interrupt, IRQF_SHARED,
2557 "DBRI audio", dbri);
2558 if (err) {
2559 printk(KERN_ERR "DBRI: Can't get irq %d\n", dbri->irq);
2560 of_iounmap(&op->resource[0], dbri->regs, dbri->regs_size);
2561 dma_free_coherent(&op->dev, sizeof(struct dbri_dma),
2562 (void *)dbri->dma, dbri->dma_dvma);
2563 return err;
2564 }
2565
2566
2567 dbri_initialize(dbri);
2568 err = cs4215_init(dbri);
2569 if (err) {
2570 snd_dbri_free(dbri);
2571 return err;
2572 }
2573
2574 return 0;
2575}
2576
2577static void snd_dbri_free(struct snd_dbri *dbri)
2578{
2579 dprintk(D_GEN, "snd_dbri_free\n");
2580 dbri_reset(dbri);
2581
2582 if (dbri->irq)
2583 free_irq(dbri->irq, dbri);
2584
2585 if (dbri->regs)
2586 of_iounmap(&dbri->op->resource[0], dbri->regs, dbri->regs_size);
2587
2588 if (dbri->dma)
2589 dma_free_coherent(&dbri->op->dev,
2590 sizeof(struct dbri_dma),
2591 (void *)dbri->dma, dbri->dma_dvma);
2592}
2593
2594static int __devinit dbri_probe(struct of_device *op, const struct of_device_id *match)
2595{
2596 struct snd_dbri *dbri;
2597 struct resource *rp;
2598 struct snd_card *card;
2599 static int dev = 0;
2600 int irq;
2601 int err;
2602
2603 if (dev >= SNDRV_CARDS)
2604 return -ENODEV;
2605 if (!enable[dev]) {
2606 dev++;
2607 return -ENOENT;
2608 }
2609
2610 irq = op->irqs[0];
2611 if (irq <= 0) {
2612 printk(KERN_ERR "DBRI-%d: No IRQ.\n", dev);
2613 return -ENODEV;
2614 }
2615
2616 err = snd_card_create(index[dev], id[dev], THIS_MODULE,
2617 sizeof(struct snd_dbri), &card);
2618 if (err < 0)
2619 return err;
2620
2621 strcpy(card->driver, "DBRI");
2622 strcpy(card->shortname, "Sun DBRI");
2623 rp = &op->resource[0];
2624 sprintf(card->longname, "%s at 0x%02lx:0x%016Lx, irq %d",
2625 card->shortname,
2626 rp->flags & 0xffL, (unsigned long long)rp->start, irq);
2627
2628 err = snd_dbri_create(card, op, irq, dev);
2629 if (err < 0) {
2630 snd_card_free(card);
2631 return err;
2632 }
2633
2634 dbri = card->private_data;
2635 err = snd_dbri_pcm(card);
2636 if (err < 0)
2637 goto _err;
2638
2639 err = snd_dbri_mixer(card);
2640 if (err < 0)
2641 goto _err;
2642
2643
2644 snd_dbri_proc(card);
2645 dev_set_drvdata(&op->dev, card);
2646
2647 err = snd_card_register(card);
2648 if (err < 0)
2649 goto _err;
2650
2651 printk(KERN_INFO "audio%d at %p (irq %d) is DBRI(%c)+CS4215(%d)\n",
2652 dev, dbri->regs,
2653 dbri->irq, op->node->name[9], dbri->mm.version);
2654 dev++;
2655
2656 return 0;
2657
2658_err:
2659 snd_dbri_free(dbri);
2660 snd_card_free(card);
2661 return err;
2662}
2663
2664static int __devexit dbri_remove(struct of_device *op)
2665{
2666 struct snd_card *card = dev_get_drvdata(&op->dev);
2667
2668 snd_dbri_free(card->private_data);
2669 snd_card_free(card);
2670
2671 dev_set_drvdata(&op->dev, NULL);
2672
2673 return 0;
2674}
2675
2676static const struct of_device_id dbri_match[] = {
2677 {
2678 .name = "SUNW,DBRIe",
2679 },
2680 {
2681 .name = "SUNW,DBRIf",
2682 },
2683 {},
2684};
2685
2686MODULE_DEVICE_TABLE(of, dbri_match);
2687
2688static struct of_platform_driver dbri_sbus_driver = {
2689 .name = "dbri",
2690 .match_table = dbri_match,
2691 .probe = dbri_probe,
2692 .remove = __devexit_p(dbri_remove),
2693};
2694
2695
2696static int __init dbri_init(void)
2697{
2698 return of_register_driver(&dbri_sbus_driver, &of_bus_type);
2699}
2700
2701static void __exit dbri_exit(void)
2702{
2703 of_unregister_driver(&dbri_sbus_driver);
2704}
2705
2706module_init(dbri_init);
2707module_exit(dbri_exit);
2708