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