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 u32 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
661 len += 2;
662 spin_lock(&dbri->cmdlock);
663 if (dbri->cmdptr - dbri->dma->cmd + len < DBRI_NO_CMDS - 2)
664 return dbri->cmdptr + 2;
665 else if (len < sbus_readl(dbri->regs + REG8) - dbri->dma_dvma)
666 return dbri->dma->cmd;
667 else
668 printk(KERN_ERR "DBRI: no space for commands.");
669
670 return NULL;
671}
672
673
674
675
676
677
678
679
680
681static void dbri_cmdsend(struct snd_dbri *dbri, s32 *cmd, int len)
682{
683 s32 tmp, addr;
684 static int wait_id = 0;
685
686 wait_id++;
687 wait_id &= 0xffff;
688 *(cmd) = DBRI_CMD(D_WAIT, 1, wait_id);
689 *(cmd+1) = DBRI_CMD(D_WAIT, 1, wait_id);
690
691
692 addr = dbri->dma_dvma + (cmd - len - dbri->dma->cmd) * sizeof(s32);
693 *(dbri->cmdptr+1) = addr;
694 *(dbri->cmdptr) = DBRI_CMD(D_JUMP, 0, 0);
695
696#ifdef DBRI_DEBUG
697 if (cmd > dbri->cmdptr) {
698 s32 *ptr;
699
700 for (ptr = dbri->cmdptr; ptr < cmd+2; ptr++)
701 dprintk(D_CMD, "cmd: %lx:%08x\n",
702 (unsigned long)ptr, *ptr);
703 } else {
704 s32 *ptr = dbri->cmdptr;
705
706 dprintk(D_CMD, "cmd: %lx:%08x\n", (unsigned long)ptr, *ptr);
707 ptr++;
708 dprintk(D_CMD, "cmd: %lx:%08x\n", (unsigned long)ptr, *ptr);
709 for (ptr = dbri->dma->cmd; ptr < cmd+2; ptr++)
710 dprintk(D_CMD, "cmd: %lx:%08x\n",
711 (unsigned long)ptr, *ptr);
712 }
713#endif
714
715
716 tmp = sbus_readl(dbri->regs + REG0);
717 tmp |= D_P;
718 sbus_writel(tmp, dbri->regs + REG0);
719
720 dbri->cmdptr = cmd;
721 spin_unlock(&dbri->cmdlock);
722}
723
724
725static void dbri_reset(struct snd_dbri *dbri)
726{
727 int i;
728 u32 tmp;
729
730 dprintk(D_GEN, "reset 0:%x 2:%x 8:%x 9:%x\n",
731 sbus_readl(dbri->regs + REG0),
732 sbus_readl(dbri->regs + REG2),
733 sbus_readl(dbri->regs + REG8), sbus_readl(dbri->regs + REG9));
734
735 sbus_writel(D_R, dbri->regs + REG0);
736 for (i = 0; (sbus_readl(dbri->regs + REG0) & D_R) && i < 64; i++)
737 udelay(10);
738
739
740
741 tmp = sbus_readl(dbri->regs + REG0);
742 tmp |= D_G | D_E;
743 tmp &= ~D_S;
744 sbus_writel(tmp, dbri->regs + REG0);
745}
746
747
748static void __devinit dbri_initialize(struct snd_dbri *dbri)
749{
750 s32 *cmd;
751 u32 dma_addr;
752 unsigned long flags;
753 int n;
754
755 spin_lock_irqsave(&dbri->lock, flags);
756
757 dbri_reset(dbri);
758
759
760 for (n = 0; n < DBRI_NO_PIPES; n++)
761 dbri->pipes[n].desc = dbri->pipes[n].first_desc = -1;
762
763 spin_lock_init(&dbri->cmdlock);
764
765
766
767 dma_addr = dbri->dma_dvma + dbri_dma_off(intr, 0);
768 dbri->dma->intr[0] = dma_addr;
769 dbri->dbri_irqp = 1;
770
771
772
773 spin_lock(&dbri->cmdlock);
774 cmd = dbri->cmdptr = dbri->dma->cmd;
775 *(cmd++) = DBRI_CMD(D_IIQ, 0, 0);
776 *(cmd++) = dma_addr;
777 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
778 dbri->cmdptr = cmd;
779 *(cmd++) = DBRI_CMD(D_WAIT, 1, 0);
780 *(cmd++) = DBRI_CMD(D_WAIT, 1, 0);
781 dma_addr = dbri->dma_dvma + dbri_dma_off(cmd, 0);
782 sbus_writel(dma_addr, dbri->regs + REG8);
783 spin_unlock(&dbri->cmdlock);
784
785 spin_unlock_irqrestore(&dbri->lock, flags);
786 dbri_cmdwait(dbri);
787}
788
789
790
791
792
793
794
795
796
797
798
799
800
801
802
803static inline int pipe_active(struct snd_dbri *dbri, int pipe)
804{
805 return ((pipe >= 0) && (dbri->pipes[pipe].desc != -1));
806}
807
808
809
810
811
812
813static void reset_pipe(struct snd_dbri *dbri, int pipe)
814{
815 int sdp;
816 int desc;
817 s32 *cmd;
818
819 if (pipe < 0 || pipe > DBRI_MAX_PIPE) {
820 printk(KERN_ERR "DBRI: reset_pipe called with "
821 "illegal pipe number\n");
822 return;
823 }
824
825 sdp = dbri->pipes[pipe].sdp;
826 if (sdp == 0) {
827 printk(KERN_ERR "DBRI: reset_pipe called "
828 "on uninitialized pipe\n");
829 return;
830 }
831
832 cmd = dbri_cmdlock(dbri, 3);
833 *(cmd++) = DBRI_CMD(D_SDP, 0, sdp | D_SDP_C | D_SDP_P);
834 *(cmd++) = 0;
835 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
836 dbri_cmdsend(dbri, cmd, 3);
837
838 desc = dbri->pipes[pipe].first_desc;
839 if (desc >= 0)
840 do {
841 dbri->dma->desc[desc].ba = 0;
842 dbri->dma->desc[desc].nda = 0;
843 desc = dbri->next_desc[desc];
844 } while (desc != -1 && desc != dbri->pipes[pipe].first_desc);
845
846 dbri->pipes[pipe].desc = -1;
847 dbri->pipes[pipe].first_desc = -1;
848}
849
850
851
852
853static void setup_pipe(struct snd_dbri *dbri, int pipe, int sdp)
854{
855 if (pipe < 0 || pipe > DBRI_MAX_PIPE) {
856 printk(KERN_ERR "DBRI: setup_pipe called "
857 "with illegal pipe number\n");
858 return;
859 }
860
861 if ((sdp & 0xf800) != sdp) {
862 printk(KERN_ERR "DBRI: setup_pipe called "
863 "with strange SDP value\n");
864
865 }
866
867
868
869
870 if (D_SDP_MODE(sdp) == D_SDP_FIXED && !(sdp & D_SDP_TO_SER))
871 sdp |= D_SDP_CHANGE;
872
873 sdp |= D_PIPE(pipe);
874 dbri->pipes[pipe].sdp = sdp;
875 dbri->pipes[pipe].desc = -1;
876 dbri->pipes[pipe].first_desc = -1;
877
878 reset_pipe(dbri, pipe);
879}
880
881
882
883
884static void link_time_slot(struct snd_dbri *dbri, int pipe,
885 int prevpipe, int nextpipe,
886 int length, int cycle)
887{
888 s32 *cmd;
889 int val;
890
891 if (pipe < 0 || pipe > DBRI_MAX_PIPE
892 || prevpipe < 0 || prevpipe > DBRI_MAX_PIPE
893 || nextpipe < 0 || nextpipe > DBRI_MAX_PIPE) {
894 printk(KERN_ERR
895 "DBRI: link_time_slot called with illegal pipe number\n");
896 return;
897 }
898
899 if (dbri->pipes[pipe].sdp == 0
900 || dbri->pipes[prevpipe].sdp == 0
901 || dbri->pipes[nextpipe].sdp == 0) {
902 printk(KERN_ERR "DBRI: link_time_slot called "
903 "on uninitialized pipe\n");
904 return;
905 }
906
907 dbri->pipes[prevpipe].nextpipe = pipe;
908 dbri->pipes[pipe].nextpipe = nextpipe;
909 dbri->pipes[pipe].length = length;
910
911 cmd = dbri_cmdlock(dbri, 4);
912
913 if (dbri->pipes[pipe].sdp & D_SDP_TO_SER) {
914
915
916
917
918
919 if (prevpipe == 16 && cycle == 0)
920 cycle = dbri->chi_bpf;
921
922 val = D_DTS_VO | D_DTS_INS | D_DTS_PRVOUT(prevpipe) | pipe;
923 *(cmd++) = DBRI_CMD(D_DTS, 0, val);
924 *(cmd++) = 0;
925 *(cmd++) =
926 D_TS_LEN(length) | D_TS_CYCLE(cycle) | D_TS_NEXT(nextpipe);
927 } else {
928 val = D_DTS_VI | D_DTS_INS | D_DTS_PRVIN(prevpipe) | pipe;
929 *(cmd++) = DBRI_CMD(D_DTS, 0, val);
930 *(cmd++) =
931 D_TS_LEN(length) | D_TS_CYCLE(cycle) | D_TS_NEXT(nextpipe);
932 *(cmd++) = 0;
933 }
934 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
935
936 dbri_cmdsend(dbri, cmd, 4);
937}
938
939#if 0
940
941
942
943static void unlink_time_slot(struct snd_dbri *dbri, int pipe,
944 enum in_or_out direction, int prevpipe,
945 int nextpipe)
946{
947 s32 *cmd;
948 int val;
949
950 if (pipe < 0 || pipe > DBRI_MAX_PIPE
951 || prevpipe < 0 || prevpipe > DBRI_MAX_PIPE
952 || nextpipe < 0 || nextpipe > DBRI_MAX_PIPE) {
953 printk(KERN_ERR
954 "DBRI: unlink_time_slot called with illegal pipe number\n");
955 return;
956 }
957
958 cmd = dbri_cmdlock(dbri, 4);
959
960 if (direction == PIPEinput) {
961 val = D_DTS_VI | D_DTS_DEL | D_DTS_PRVIN(prevpipe) | pipe;
962 *(cmd++) = DBRI_CMD(D_DTS, 0, val);
963 *(cmd++) = D_TS_NEXT(nextpipe);
964 *(cmd++) = 0;
965 } else {
966 val = D_DTS_VO | D_DTS_DEL | D_DTS_PRVOUT(prevpipe) | pipe;
967 *(cmd++) = DBRI_CMD(D_DTS, 0, val);
968 *(cmd++) = 0;
969 *(cmd++) = D_TS_NEXT(nextpipe);
970 }
971 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
972
973 dbri_cmdsend(dbri, cmd, 4);
974}
975#endif
976
977
978
979
980
981
982
983
984
985
986
987
988
989
990
991
992
993static void xmit_fixed(struct snd_dbri *dbri, int pipe, unsigned int data)
994{
995 s32 *cmd;
996 unsigned long flags;
997
998 if (pipe < 16 || pipe > DBRI_MAX_PIPE) {
999 printk(KERN_ERR "DBRI: xmit_fixed: Illegal pipe number\n");
1000 return;
1001 }
1002
1003 if (D_SDP_MODE(dbri->pipes[pipe].sdp) == 0) {
1004 printk(KERN_ERR "DBRI: xmit_fixed: "
1005 "Uninitialized pipe %d\n", pipe);
1006 return;
1007 }
1008
1009 if (D_SDP_MODE(dbri->pipes[pipe].sdp) != D_SDP_FIXED) {
1010 printk(KERN_ERR "DBRI: xmit_fixed: Non-fixed pipe %d\n", pipe);
1011 return;
1012 }
1013
1014 if (!(dbri->pipes[pipe].sdp & D_SDP_TO_SER)) {
1015 printk(KERN_ERR "DBRI: xmit_fixed: Called on receive pipe %d\n",
1016 pipe);
1017 return;
1018 }
1019
1020
1021
1022 if (dbri->pipes[pipe].sdp & D_SDP_MSB)
1023 data = reverse_bytes(data, dbri->pipes[pipe].length);
1024
1025 cmd = dbri_cmdlock(dbri, 3);
1026
1027 *(cmd++) = DBRI_CMD(D_SSP, 0, pipe);
1028 *(cmd++) = data;
1029 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
1030
1031 spin_lock_irqsave(&dbri->lock, flags);
1032 dbri_cmdsend(dbri, cmd, 3);
1033 spin_unlock_irqrestore(&dbri->lock, flags);
1034 dbri_cmdwait(dbri);
1035
1036}
1037
1038static void recv_fixed(struct snd_dbri *dbri, int pipe, volatile __u32 *ptr)
1039{
1040 if (pipe < 16 || pipe > DBRI_MAX_PIPE) {
1041 printk(KERN_ERR "DBRI: recv_fixed called with "
1042 "illegal pipe number\n");
1043 return;
1044 }
1045
1046 if (D_SDP_MODE(dbri->pipes[pipe].sdp) != D_SDP_FIXED) {
1047 printk(KERN_ERR "DBRI: recv_fixed called on "
1048 "non-fixed pipe %d\n", pipe);
1049 return;
1050 }
1051
1052 if (dbri->pipes[pipe].sdp & D_SDP_TO_SER) {
1053 printk(KERN_ERR "DBRI: recv_fixed called on "
1054 "transmit pipe %d\n", pipe);
1055 return;
1056 }
1057
1058 dbri->pipes[pipe].recv_fixed_ptr = ptr;
1059}
1060
1061
1062
1063
1064
1065
1066
1067
1068
1069
1070
1071
1072
1073
1074
1075
1076
1077static int setup_descs(struct snd_dbri *dbri, int streamno, unsigned int period)
1078{
1079 struct dbri_streaminfo *info = &dbri->stream_info[streamno];
1080 __u32 dvma_buffer;
1081 int desc;
1082 int len;
1083 int first_desc = -1;
1084 int last_desc = -1;
1085
1086 if (info->pipe < 0 || info->pipe > 15) {
1087 printk(KERN_ERR "DBRI: setup_descs: Illegal pipe number\n");
1088 return -2;
1089 }
1090
1091 if (dbri->pipes[info->pipe].sdp == 0) {
1092 printk(KERN_ERR "DBRI: setup_descs: Uninitialized pipe %d\n",
1093 info->pipe);
1094 return -2;
1095 }
1096
1097 dvma_buffer = info->dvma_buffer;
1098 len = info->size;
1099
1100 if (streamno == DBRI_PLAY) {
1101 if (!(dbri->pipes[info->pipe].sdp & D_SDP_TO_SER)) {
1102 printk(KERN_ERR "DBRI: setup_descs: "
1103 "Called on receive pipe %d\n", info->pipe);
1104 return -2;
1105 }
1106 } else {
1107 if (dbri->pipes[info->pipe].sdp & D_SDP_TO_SER) {
1108 printk(KERN_ERR
1109 "DBRI: setup_descs: Called on transmit pipe %d\n",
1110 info->pipe);
1111 return -2;
1112 }
1113
1114
1115
1116 if (pipe_active(dbri, info->pipe)) {
1117 printk(KERN_ERR "DBRI: recv_on_pipe: "
1118 "Called on active pipe %d\n", info->pipe);
1119 return -2;
1120 }
1121
1122
1123 len &= ~3;
1124 }
1125
1126
1127 desc = dbri->pipes[info->pipe].first_desc;
1128 if (desc >= 0)
1129 do {
1130 dbri->dma->desc[desc].ba = 0;
1131 dbri->dma->desc[desc].nda = 0;
1132 desc = dbri->next_desc[desc];
1133 } while (desc != -1 &&
1134 desc != dbri->pipes[info->pipe].first_desc);
1135
1136 dbri->pipes[info->pipe].desc = -1;
1137 dbri->pipes[info->pipe].first_desc = -1;
1138
1139 desc = 0;
1140 while (len > 0) {
1141 int mylen;
1142
1143 for (; desc < DBRI_NO_DESCS; desc++) {
1144 if (!dbri->dma->desc[desc].ba)
1145 break;
1146 }
1147
1148 if (desc == DBRI_NO_DESCS) {
1149 printk(KERN_ERR "DBRI: setup_descs: No descriptors\n");
1150 return -1;
1151 }
1152
1153 if (len > DBRI_TD_MAXCNT)
1154 mylen = DBRI_TD_MAXCNT;
1155 else
1156 mylen = len;
1157
1158 if (mylen > period)
1159 mylen = period;
1160
1161 dbri->next_desc[desc] = -1;
1162 dbri->dma->desc[desc].ba = dvma_buffer;
1163 dbri->dma->desc[desc].nda = 0;
1164
1165 if (streamno == DBRI_PLAY) {
1166 dbri->dma->desc[desc].word1 = DBRI_TD_CNT(mylen);
1167 dbri->dma->desc[desc].word4 = 0;
1168 dbri->dma->desc[desc].word1 |= DBRI_TD_F | DBRI_TD_B;
1169 } else {
1170 dbri->dma->desc[desc].word1 = 0;
1171 dbri->dma->desc[desc].word4 =
1172 DBRI_RD_B | DBRI_RD_BCNT(mylen);
1173 }
1174
1175 if (first_desc == -1)
1176 first_desc = desc;
1177 else {
1178 dbri->next_desc[last_desc] = desc;
1179 dbri->dma->desc[last_desc].nda =
1180 dbri->dma_dvma + dbri_dma_off(desc, desc);
1181 }
1182
1183 last_desc = desc;
1184 dvma_buffer += mylen;
1185 len -= mylen;
1186 }
1187
1188 if (first_desc == -1 || last_desc == -1) {
1189 printk(KERN_ERR "DBRI: setup_descs: "
1190 " Not enough descriptors available\n");
1191 return -1;
1192 }
1193
1194 dbri->dma->desc[last_desc].nda =
1195 dbri->dma_dvma + dbri_dma_off(desc, first_desc);
1196 dbri->next_desc[last_desc] = first_desc;
1197 dbri->pipes[info->pipe].first_desc = first_desc;
1198 dbri->pipes[info->pipe].desc = first_desc;
1199
1200#ifdef DBRI_DEBUG
1201 for (desc = first_desc; desc != -1;) {
1202 dprintk(D_DESC, "DESC %d: %08x %08x %08x %08x\n",
1203 desc,
1204 dbri->dma->desc[desc].word1,
1205 dbri->dma->desc[desc].ba,
1206 dbri->dma->desc[desc].nda, dbri->dma->desc[desc].word4);
1207 desc = dbri->next_desc[desc];
1208 if (desc == first_desc)
1209 break;
1210 }
1211#endif
1212 return 0;
1213}
1214
1215
1216
1217
1218
1219
1220
1221
1222
1223
1224
1225
1226enum master_or_slave { CHImaster, CHIslave };
1227
1228
1229
1230
1231static void reset_chi(struct snd_dbri *dbri,
1232 enum master_or_slave master_or_slave,
1233 int bits_per_frame)
1234{
1235 s32 *cmd;
1236 int val;
1237
1238
1239
1240 cmd = dbri_cmdlock(dbri, 4);
1241 val = D_DTS_VO | D_DTS_VI | D_DTS_INS
1242 | D_DTS_PRVIN(16) | D_PIPE(16) | D_DTS_PRVOUT(16);
1243 *(cmd++) = DBRI_CMD(D_DTS, 0, val);
1244 *(cmd++) = D_TS_ANCHOR | D_TS_NEXT(16);
1245 *(cmd++) = D_TS_ANCHOR | D_TS_NEXT(16);
1246 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
1247 dbri_cmdsend(dbri, cmd, 4);
1248
1249 dbri->pipes[16].sdp = 1;
1250 dbri->pipes[16].nextpipe = 16;
1251
1252 cmd = dbri_cmdlock(dbri, 4);
1253
1254 if (master_or_slave == CHIslave) {
1255
1256
1257
1258
1259
1260
1261 *(cmd++) = DBRI_CMD(D_CHI, 0, D_CHI_CHICM(0));
1262 } else {
1263
1264
1265
1266
1267
1268
1269 int clockrate = bits_per_frame * 8;
1270 int divisor = 12288 / clockrate;
1271
1272 if (divisor > 255 || divisor * clockrate != 12288)
1273 printk(KERN_ERR "DBRI: illegal bits_per_frame "
1274 "in setup_chi\n");
1275
1276 *(cmd++) = DBRI_CMD(D_CHI, 0, D_CHI_CHICM(divisor) | D_CHI_FD
1277 | D_CHI_BPF(bits_per_frame));
1278 }
1279
1280 dbri->chi_bpf = bits_per_frame;
1281
1282
1283
1284
1285
1286
1287
1288
1289
1290 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
1291 *(cmd++) = DBRI_CMD(D_CDM, 0, D_CDM_XCE | D_CDM_XEN | D_CDM_REN);
1292 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
1293
1294 dbri_cmdsend(dbri, cmd, 4);
1295}
1296
1297
1298
1299
1300
1301
1302
1303
1304
1305
1306
1307
1308static __devinit void cs4215_setup_pipes(struct snd_dbri *dbri)
1309{
1310 unsigned long flags;
1311
1312 spin_lock_irqsave(&dbri->lock, flags);
1313
1314
1315
1316
1317
1318
1319
1320
1321
1322
1323
1324
1325
1326
1327
1328 setup_pipe(dbri, 4, D_SDP_MEM | D_SDP_TO_SER | D_SDP_MSB);
1329 setup_pipe(dbri, 20, D_SDP_FIXED | D_SDP_TO_SER | D_SDP_MSB);
1330 setup_pipe(dbri, 6, D_SDP_MEM | D_SDP_FROM_SER | D_SDP_MSB);
1331 setup_pipe(dbri, 21, D_SDP_FIXED | D_SDP_FROM_SER | D_SDP_MSB);
1332
1333 setup_pipe(dbri, 17, D_SDP_FIXED | D_SDP_TO_SER | D_SDP_MSB);
1334 setup_pipe(dbri, 18, D_SDP_FIXED | D_SDP_FROM_SER | D_SDP_MSB);
1335 setup_pipe(dbri, 19, D_SDP_FIXED | D_SDP_FROM_SER | D_SDP_MSB);
1336 spin_unlock_irqrestore(&dbri->lock, flags);
1337
1338 dbri_cmdwait(dbri);
1339}
1340
1341static __devinit int cs4215_init_data(struct cs4215 *mm)
1342{
1343
1344
1345
1346
1347
1348
1349
1350 mm->data[0] = CS4215_LO(0x20) | CS4215_HE | CS4215_LE;
1351 mm->data[1] = CS4215_RO(0x20) | CS4215_SE;
1352 mm->data[2] = CS4215_LG(0x8) | CS4215_IS | CS4215_PIO0 | CS4215_PIO1;
1353 mm->data[3] = CS4215_RG(0x8) | CS4215_MA(0xf);
1354
1355
1356
1357
1358
1359
1360
1361
1362 mm->ctrl[0] = CS4215_RSRVD_1 | CS4215_MLB;
1363 mm->ctrl[1] = CS4215_DFR_ULAW | CS4215_FREQ[0].csval;
1364 mm->ctrl[2] = CS4215_XCLK | CS4215_BSEL_128 | CS4215_FREQ[0].xtal;
1365 mm->ctrl[3] = 0;
1366
1367 mm->status = 0;
1368 mm->version = 0xff;
1369 mm->precision = 8;
1370 mm->channels = 1;
1371
1372 return 0;
1373}
1374
1375static void cs4215_setdata(struct snd_dbri *dbri, int muted)
1376{
1377 if (muted) {
1378 dbri->mm.data[0] |= 63;
1379 dbri->mm.data[1] |= 63;
1380 dbri->mm.data[2] &= ~15;
1381 dbri->mm.data[3] &= ~15;
1382 } else {
1383
1384 struct dbri_streaminfo *info = &dbri->stream_info[DBRI_PLAY];
1385 int left_gain = info->left_gain & 0x3f;
1386 int right_gain = info->right_gain & 0x3f;
1387
1388 dbri->mm.data[0] &= ~0x3f;
1389 dbri->mm.data[1] &= ~0x3f;
1390 dbri->mm.data[0] |= (DBRI_MAX_VOLUME - left_gain);
1391 dbri->mm.data[1] |= (DBRI_MAX_VOLUME - right_gain);
1392
1393
1394 info = &dbri->stream_info[DBRI_REC];
1395 left_gain = info->left_gain & 0xf;
1396 right_gain = info->right_gain & 0xf;
1397 dbri->mm.data[2] |= CS4215_LG(left_gain);
1398 dbri->mm.data[3] |= CS4215_RG(right_gain);
1399 }
1400
1401 xmit_fixed(dbri, 20, *(int *)dbri->mm.data);
1402}
1403
1404
1405
1406
1407static void cs4215_open(struct snd_dbri *dbri)
1408{
1409 int data_width;
1410 u32 tmp;
1411 unsigned long flags;
1412
1413 dprintk(D_MM, "cs4215_open: %d channels, %d bits\n",
1414 dbri->mm.channels, dbri->mm.precision);
1415
1416
1417
1418
1419
1420 cs4215_setdata(dbri, 1);
1421 udelay(125);
1422
1423
1424
1425
1426
1427
1428
1429
1430
1431
1432
1433
1434
1435
1436 spin_lock_irqsave(&dbri->lock, flags);
1437 tmp = sbus_readl(dbri->regs + REG0);
1438 tmp &= ~(D_C);
1439 sbus_writel(tmp, dbri->regs + REG0);
1440
1441
1442 sbus_writel(D_ENPIO | D_PIO1 | D_PIO3 |
1443 (dbri->mm.onboard ? D_PIO0 : D_PIO2), dbri->regs + REG2);
1444
1445 reset_chi(dbri, CHIslave, 128);
1446
1447
1448
1449
1450
1451
1452
1453 data_width = dbri->mm.channels * dbri->mm.precision;
1454
1455 link_time_slot(dbri, 4, 16, 16, data_width, dbri->mm.offset);
1456 link_time_slot(dbri, 20, 4, 16, 32, dbri->mm.offset + 32);
1457 link_time_slot(dbri, 6, 16, 16, data_width, dbri->mm.offset);
1458 link_time_slot(dbri, 21, 6, 16, 16, dbri->mm.offset + 40);
1459
1460
1461 tmp = sbus_readl(dbri->regs + REG0);
1462 tmp |= D_C;
1463 sbus_writel(tmp, dbri->regs + REG0);
1464 spin_unlock_irqrestore(&dbri->lock, flags);
1465
1466 cs4215_setdata(dbri, 0);
1467}
1468
1469
1470
1471
1472static int cs4215_setctrl(struct snd_dbri *dbri)
1473{
1474 int i, val;
1475 u32 tmp;
1476 unsigned long flags;
1477
1478
1479
1480
1481
1482
1483 cs4215_setdata(dbri, 1);
1484 udelay(125);
1485
1486
1487
1488
1489
1490 val = D_ENPIO | D_PIO1 | (dbri->mm.onboard ? D_PIO0 : D_PIO2);
1491 sbus_writel(val, dbri->regs + REG2);
1492 dprintk(D_MM, "cs4215_setctrl: reg2=0x%x\n", val);
1493 udelay(34);
1494
1495
1496
1497
1498
1499
1500
1501
1502
1503
1504
1505
1506
1507
1508
1509
1510
1511
1512
1513 spin_lock_irqsave(&dbri->lock, flags);
1514 tmp = sbus_readl(dbri->regs + REG0);
1515 tmp &= ~D_C;
1516 sbus_writel(tmp, dbri->regs + REG0);
1517
1518 reset_chi(dbri, CHImaster, 128);
1519
1520
1521
1522
1523
1524
1525
1526
1527 link_time_slot(dbri, 17, 16, 16, 32, dbri->mm.offset);
1528 link_time_slot(dbri, 18, 16, 16, 8, dbri->mm.offset);
1529 link_time_slot(dbri, 19, 18, 16, 8, dbri->mm.offset + 48);
1530 spin_unlock_irqrestore(&dbri->lock, flags);
1531
1532
1533 dbri->mm.ctrl[0] &= ~CS4215_CLB;
1534 xmit_fixed(dbri, 17, *(int *)dbri->mm.ctrl);
1535
1536 spin_lock_irqsave(&dbri->lock, flags);
1537 tmp = sbus_readl(dbri->regs + REG0);
1538 tmp |= D_C;
1539 sbus_writel(tmp, dbri->regs + REG0);
1540 spin_unlock_irqrestore(&dbri->lock, flags);
1541
1542 for (i = 10; ((dbri->mm.status & 0xe4) != 0x20); --i)
1543 msleep_interruptible(1);
1544
1545 if (i == 0) {
1546 dprintk(D_MM, "CS4215 didn't respond to CLB (0x%02x)\n",
1547 dbri->mm.status);
1548 return -1;
1549 }
1550
1551
1552
1553
1554 recv_fixed(dbri, 19, NULL);
1555
1556
1557
1558
1559 dbri->mm.ctrl[0] |= CS4215_CLB;
1560 xmit_fixed(dbri, 17, *(int *)dbri->mm.ctrl);
1561
1562
1563 udelay(250);
1564
1565 cs4215_setdata(dbri, 0);
1566
1567 return 0;
1568}
1569
1570
1571
1572
1573
1574
1575
1576static int cs4215_prepare(struct snd_dbri *dbri, unsigned int rate,
1577 snd_pcm_format_t format, unsigned int channels)
1578{
1579 int freq_idx;
1580 int ret = 0;
1581
1582
1583 for (freq_idx = 0; CS4215_FREQ[freq_idx].freq != 0; freq_idx++) {
1584 if (CS4215_FREQ[freq_idx].freq == rate)
1585 break;
1586 }
1587 if (CS4215_FREQ[freq_idx].freq != rate) {
1588 printk(KERN_WARNING "DBRI: Unsupported rate %d Hz\n", rate);
1589 return -1;
1590 }
1591
1592 switch (format) {
1593 case SNDRV_PCM_FORMAT_MU_LAW:
1594 dbri->mm.ctrl[1] = CS4215_DFR_ULAW;
1595 dbri->mm.precision = 8;
1596 break;
1597 case SNDRV_PCM_FORMAT_A_LAW:
1598 dbri->mm.ctrl[1] = CS4215_DFR_ALAW;
1599 dbri->mm.precision = 8;
1600 break;
1601 case SNDRV_PCM_FORMAT_U8:
1602 dbri->mm.ctrl[1] = CS4215_DFR_LINEAR8;
1603 dbri->mm.precision = 8;
1604 break;
1605 case SNDRV_PCM_FORMAT_S16_BE:
1606 dbri->mm.ctrl[1] = CS4215_DFR_LINEAR16;
1607 dbri->mm.precision = 16;
1608 break;
1609 default:
1610 printk(KERN_WARNING "DBRI: Unsupported format %d\n", format);
1611 return -1;
1612 }
1613
1614
1615 dbri->mm.ctrl[1] |= CS4215_FREQ[freq_idx].csval;
1616 dbri->mm.ctrl[2] = CS4215_XCLK |
1617 CS4215_BSEL_128 | CS4215_FREQ[freq_idx].xtal;
1618
1619 dbri->mm.channels = channels;
1620 if (channels == 2)
1621 dbri->mm.ctrl[1] |= CS4215_DFR_STEREO;
1622
1623 ret = cs4215_setctrl(dbri);
1624 if (ret == 0)
1625 cs4215_open(dbri);
1626
1627 return ret;
1628}
1629
1630
1631
1632
1633static __devinit int cs4215_init(struct snd_dbri *dbri)
1634{
1635 u32 reg2 = sbus_readl(dbri->regs + REG2);
1636 dprintk(D_MM, "cs4215_init: reg2=0x%x\n", reg2);
1637
1638
1639 if (reg2 & D_PIO2) {
1640 dprintk(D_MM, "Onboard CS4215 detected\n");
1641 dbri->mm.onboard = 1;
1642 }
1643 if (reg2 & D_PIO0) {
1644 dprintk(D_MM, "Speakerbox detected\n");
1645 dbri->mm.onboard = 0;
1646
1647 if (reg2 & D_PIO2) {
1648 printk(KERN_INFO "DBRI: Using speakerbox / "
1649 "ignoring onboard mmcodec.\n");
1650 sbus_writel(D_ENPIO2, dbri->regs + REG2);
1651 }
1652 }
1653
1654 if (!(reg2 & (D_PIO0 | D_PIO2))) {
1655 printk(KERN_ERR "DBRI: no mmcodec found.\n");
1656 return -EIO;
1657 }
1658
1659 cs4215_setup_pipes(dbri);
1660 cs4215_init_data(&dbri->mm);
1661
1662
1663 recv_fixed(dbri, 18, &dbri->mm.status);
1664 recv_fixed(dbri, 19, &dbri->mm.version);
1665
1666 dbri->mm.offset = dbri->mm.onboard ? 0 : 8;
1667 if (cs4215_setctrl(dbri) == -1 || dbri->mm.version == 0xff) {
1668 dprintk(D_MM, "CS4215 failed probe at offset %d\n",
1669 dbri->mm.offset);
1670 return -EIO;
1671 }
1672 dprintk(D_MM, "Found CS4215 at offset %d\n", dbri->mm.offset);
1673
1674 return 0;
1675}
1676
1677
1678
1679
1680
1681
1682
1683
1684
1685
1686
1687
1688
1689
1690
1691
1692
1693
1694
1695
1696
1697static void xmit_descs(struct snd_dbri *dbri)
1698{
1699 struct dbri_streaminfo *info;
1700 s32 *cmd;
1701 unsigned long flags;
1702 int first_td;
1703
1704 if (dbri == NULL)
1705 return;
1706
1707 info = &dbri->stream_info[DBRI_REC];
1708 spin_lock_irqsave(&dbri->lock, flags);
1709
1710 if (info->pipe >= 0) {
1711 first_td = dbri->pipes[info->pipe].first_desc;
1712
1713 dprintk(D_DESC, "xmit_descs rec @ TD %d\n", first_td);
1714
1715
1716 if (first_td >= 0) {
1717 cmd = dbri_cmdlock(dbri, 2);
1718 *(cmd++) = DBRI_CMD(D_SDP, 0,
1719 dbri->pipes[info->pipe].sdp
1720 | D_SDP_P | D_SDP_EVERY | D_SDP_C);
1721 *(cmd++) = dbri->dma_dvma +
1722 dbri_dma_off(desc, first_td);
1723 dbri_cmdsend(dbri, cmd, 2);
1724
1725
1726 dbri->pipes[info->pipe].desc = first_td;
1727 }
1728 }
1729
1730 info = &dbri->stream_info[DBRI_PLAY];
1731
1732 if (info->pipe >= 0) {
1733 first_td = dbri->pipes[info->pipe].first_desc;
1734
1735 dprintk(D_DESC, "xmit_descs play @ TD %d\n", first_td);
1736
1737
1738 if (first_td >= 0) {
1739 cmd = dbri_cmdlock(dbri, 2);
1740 *(cmd++) = DBRI_CMD(D_SDP, 0,
1741 dbri->pipes[info->pipe].sdp
1742 | D_SDP_P | D_SDP_EVERY | D_SDP_C);
1743 *(cmd++) = dbri->dma_dvma +
1744 dbri_dma_off(desc, first_td);
1745 dbri_cmdsend(dbri, cmd, 2);
1746
1747
1748 dbri->pipes[info->pipe].desc = first_td;
1749 }
1750 }
1751
1752 spin_unlock_irqrestore(&dbri->lock, flags);
1753}
1754
1755
1756
1757
1758
1759
1760
1761
1762
1763
1764
1765
1766
1767
1768
1769static void transmission_complete_intr(struct snd_dbri *dbri, int pipe)
1770{
1771 struct dbri_streaminfo *info = &dbri->stream_info[DBRI_PLAY];
1772 int td = dbri->pipes[pipe].desc;
1773 int status;
1774
1775 while (td >= 0) {
1776 if (td >= DBRI_NO_DESCS) {
1777 printk(KERN_ERR "DBRI: invalid td on pipe %d\n", pipe);
1778 return;
1779 }
1780
1781 status = DBRI_TD_STATUS(dbri->dma->desc[td].word4);
1782 if (!(status & DBRI_TD_TBC))
1783 break;
1784
1785 dprintk(D_INT, "TD %d, status 0x%02x\n", td, status);
1786
1787 dbri->dma->desc[td].word4 = 0;
1788 info->offset += DBRI_RD_CNT(dbri->dma->desc[td].word1);
1789
1790 td = dbri->next_desc[td];
1791 dbri->pipes[pipe].desc = td;
1792 }
1793
1794
1795 spin_unlock(&dbri->lock);
1796 snd_pcm_period_elapsed(info->substream);
1797 spin_lock(&dbri->lock);
1798}
1799
1800static void reception_complete_intr(struct snd_dbri *dbri, int pipe)
1801{
1802 struct dbri_streaminfo *info;
1803 int rd = dbri->pipes[pipe].desc;
1804 s32 status;
1805
1806 if (rd < 0 || rd >= DBRI_NO_DESCS) {
1807 printk(KERN_ERR "DBRI: invalid rd on pipe %d\n", pipe);
1808 return;
1809 }
1810
1811 dbri->pipes[pipe].desc = dbri->next_desc[rd];
1812 status = dbri->dma->desc[rd].word1;
1813 dbri->dma->desc[rd].word1 = 0;
1814
1815 info = &dbri->stream_info[DBRI_REC];
1816 info->offset += DBRI_RD_CNT(status);
1817
1818
1819
1820 dprintk(D_INT, "Recv RD %d, status 0x%02x, len %d\n",
1821 rd, DBRI_RD_STATUS(status), DBRI_RD_CNT(status));
1822
1823
1824 spin_unlock(&dbri->lock);
1825 snd_pcm_period_elapsed(info->substream);
1826 spin_lock(&dbri->lock);
1827}
1828
1829static void dbri_process_one_interrupt(struct snd_dbri *dbri, int x)
1830{
1831 int val = D_INTR_GETVAL(x);
1832 int channel = D_INTR_GETCHAN(x);
1833 int command = D_INTR_GETCMD(x);
1834 int code = D_INTR_GETCODE(x);
1835#ifdef DBRI_DEBUG
1836 int rval = D_INTR_GETRVAL(x);
1837#endif
1838
1839 if (channel == D_INTR_CMD) {
1840 dprintk(D_CMD, "INTR: Command: %-5s Value:%d\n",
1841 cmds[command], val);
1842 } else {
1843 dprintk(D_INT, "INTR: Chan:%d Code:%d Val:%#x\n",
1844 channel, code, rval);
1845 }
1846
1847 switch (code) {
1848 case D_INTR_CMDI:
1849 if (command != D_WAIT)
1850 printk(KERN_ERR "DBRI: Command read interrupt\n");
1851 break;
1852 case D_INTR_BRDY:
1853 reception_complete_intr(dbri, channel);
1854 break;
1855 case D_INTR_XCMP:
1856 case D_INTR_MINT:
1857 transmission_complete_intr(dbri, channel);
1858 break;
1859 case D_INTR_UNDR:
1860
1861
1862
1863 {
1864
1865 printk(KERN_ERR "DBRI: Underrun error\n");
1866#if 0
1867 s32 *cmd;
1868 int pipe = channel;
1869 int td = dbri->pipes[pipe].desc;
1870
1871 dbri->dma->desc[td].word4 = 0;
1872 cmd = dbri_cmdlock(dbri, NoGetLock);
1873 *(cmd++) = DBRI_CMD(D_SDP, 0,
1874 dbri->pipes[pipe].sdp
1875 | D_SDP_P | D_SDP_C | D_SDP_2SAME);
1876 *(cmd++) = dbri->dma_dvma + dbri_dma_off(desc, td);
1877 dbri_cmdsend(dbri, cmd);
1878#endif
1879 }
1880 break;
1881 case D_INTR_FXDT:
1882
1883 if (dbri->pipes[channel].sdp & D_SDP_MSB)
1884 val = reverse_bytes(val, dbri->pipes[channel].length);
1885
1886 if (dbri->pipes[channel].recv_fixed_ptr)
1887 *(dbri->pipes[channel].recv_fixed_ptr) = val;
1888 break;
1889 default:
1890 if (channel != D_INTR_CMD)
1891 printk(KERN_WARNING
1892 "DBRI: Ignored Interrupt: %d (0x%x)\n", code, x);
1893 }
1894}
1895
1896
1897
1898
1899
1900
1901static void dbri_process_interrupt_buffer(struct snd_dbri *dbri)
1902{
1903 s32 x;
1904
1905 while ((x = dbri->dma->intr[dbri->dbri_irqp]) != 0) {
1906 dbri->dma->intr[dbri->dbri_irqp] = 0;
1907 dbri->dbri_irqp++;
1908 if (dbri->dbri_irqp == DBRI_INT_BLK)
1909 dbri->dbri_irqp = 1;
1910
1911 dbri_process_one_interrupt(dbri, x);
1912 }
1913}
1914
1915static irqreturn_t snd_dbri_interrupt(int irq, void *dev_id)
1916{
1917 struct snd_dbri *dbri = dev_id;
1918 static int errcnt = 0;
1919 int x;
1920
1921 if (dbri == NULL)
1922 return IRQ_NONE;
1923 spin_lock(&dbri->lock);
1924
1925
1926
1927
1928 x = sbus_readl(dbri->regs + REG1);
1929
1930 if (x & (D_MRR | D_MLE | D_LBG | D_MBE)) {
1931 u32 tmp;
1932
1933 if (x & D_MRR)
1934 printk(KERN_ERR
1935 "DBRI: Multiple Error Ack on SBus reg1=0x%x\n",
1936 x);
1937 if (x & D_MLE)
1938 printk(KERN_ERR
1939 "DBRI: Multiple Late Error on SBus reg1=0x%x\n",
1940 x);
1941 if (x & D_LBG)
1942 printk(KERN_ERR
1943 "DBRI: Lost Bus Grant on SBus reg1=0x%x\n", x);
1944 if (x & D_MBE)
1945 printk(KERN_ERR
1946 "DBRI: Burst Error on SBus reg1=0x%x\n", x);
1947
1948
1949
1950
1951
1952
1953
1954
1955
1956 if ((++errcnt) % 10 == 0) {
1957 dprintk(D_INT, "Interrupt errors exceeded.\n");
1958 dbri_reset(dbri);
1959 } else {
1960 tmp = sbus_readl(dbri->regs + REG0);
1961 tmp &= ~(D_D);
1962 sbus_writel(tmp, dbri->regs + REG0);
1963 }
1964 }
1965
1966 dbri_process_interrupt_buffer(dbri);
1967
1968 spin_unlock(&dbri->lock);
1969
1970 return IRQ_HANDLED;
1971}
1972
1973
1974
1975
1976static struct snd_pcm_hardware snd_dbri_pcm_hw = {
1977 .info = SNDRV_PCM_INFO_MMAP |
1978 SNDRV_PCM_INFO_INTERLEAVED |
1979 SNDRV_PCM_INFO_BLOCK_TRANSFER |
1980 SNDRV_PCM_INFO_MMAP_VALID |
1981 SNDRV_PCM_INFO_BATCH,
1982 .formats = SNDRV_PCM_FMTBIT_MU_LAW |
1983 SNDRV_PCM_FMTBIT_A_LAW |
1984 SNDRV_PCM_FMTBIT_U8 |
1985 SNDRV_PCM_FMTBIT_S16_BE,
1986 .rates = SNDRV_PCM_RATE_8000_48000 | SNDRV_PCM_RATE_5512,
1987 .rate_min = 5512,
1988 .rate_max = 48000,
1989 .channels_min = 1,
1990 .channels_max = 2,
1991 .buffer_bytes_max = 64 * 1024,
1992 .period_bytes_min = 1,
1993 .period_bytes_max = DBRI_TD_MAXCNT,
1994 .periods_min = 1,
1995 .periods_max = 1024,
1996};
1997
1998static int snd_hw_rule_format(struct snd_pcm_hw_params *params,
1999 struct snd_pcm_hw_rule *rule)
2000{
2001 struct snd_interval *c = hw_param_interval(params,
2002 SNDRV_PCM_HW_PARAM_CHANNELS);
2003 struct snd_mask *f = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT);
2004 struct snd_mask fmt;
2005
2006 snd_mask_any(&fmt);
2007 if (c->min > 1) {
2008 fmt.bits[0] &= SNDRV_PCM_FMTBIT_S16_BE;
2009 return snd_mask_refine(f, &fmt);
2010 }
2011 return 0;
2012}
2013
2014static int snd_hw_rule_channels(struct snd_pcm_hw_params *params,
2015 struct snd_pcm_hw_rule *rule)
2016{
2017 struct snd_interval *c = hw_param_interval(params,
2018 SNDRV_PCM_HW_PARAM_CHANNELS);
2019 struct snd_mask *f = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT);
2020 struct snd_interval ch;
2021
2022 snd_interval_any(&ch);
2023 if (!(f->bits[0] & SNDRV_PCM_FMTBIT_S16_BE)) {
2024 ch.min = 1;
2025 ch.max = 1;
2026 ch.integer = 1;
2027 return snd_interval_refine(c, &ch);
2028 }
2029 return 0;
2030}
2031
2032static int snd_dbri_open(struct snd_pcm_substream *substream)
2033{
2034 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2035 struct snd_pcm_runtime *runtime = substream->runtime;
2036 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2037 unsigned long flags;
2038
2039 dprintk(D_USR, "open audio output.\n");
2040 runtime->hw = snd_dbri_pcm_hw;
2041
2042 spin_lock_irqsave(&dbri->lock, flags);
2043 info->substream = substream;
2044 info->offset = 0;
2045 info->dvma_buffer = 0;
2046 info->pipe = -1;
2047 spin_unlock_irqrestore(&dbri->lock, flags);
2048
2049 snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_CHANNELS,
2050 snd_hw_rule_format, NULL, SNDRV_PCM_HW_PARAM_FORMAT,
2051 -1);
2052 snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_FORMAT,
2053 snd_hw_rule_channels, NULL,
2054 SNDRV_PCM_HW_PARAM_CHANNELS,
2055 -1);
2056
2057 cs4215_open(dbri);
2058
2059 return 0;
2060}
2061
2062static int snd_dbri_close(struct snd_pcm_substream *substream)
2063{
2064 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2065 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2066
2067 dprintk(D_USR, "close audio output.\n");
2068 info->substream = NULL;
2069 info->offset = 0;
2070
2071 return 0;
2072}
2073
2074static int snd_dbri_hw_params(struct snd_pcm_substream *substream,
2075 struct snd_pcm_hw_params *hw_params)
2076{
2077 struct snd_pcm_runtime *runtime = substream->runtime;
2078 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2079 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2080 int direction;
2081 int ret;
2082
2083
2084 ret = cs4215_prepare(dbri, params_rate(hw_params),
2085 params_format(hw_params),
2086 params_channels(hw_params));
2087 if (ret != 0)
2088 return ret;
2089
2090 if ((ret = snd_pcm_lib_malloc_pages(substream,
2091 params_buffer_bytes(hw_params))) < 0) {
2092 printk(KERN_ERR "malloc_pages failed with %d\n", ret);
2093 return ret;
2094 }
2095
2096
2097
2098 if (info->dvma_buffer == 0) {
2099 if (DBRI_STREAMNO(substream) == DBRI_PLAY)
2100 direction = DMA_TO_DEVICE;
2101 else
2102 direction = DMA_FROM_DEVICE;
2103
2104 info->dvma_buffer =
2105 dma_map_single(&dbri->op->dev,
2106 runtime->dma_area,
2107 params_buffer_bytes(hw_params),
2108 direction);
2109 }
2110
2111 direction = params_buffer_bytes(hw_params);
2112 dprintk(D_USR, "hw_params: %d bytes, dvma=%x\n",
2113 direction, info->dvma_buffer);
2114 return 0;
2115}
2116
2117static int snd_dbri_hw_free(struct snd_pcm_substream *substream)
2118{
2119 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2120 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2121 int direction;
2122
2123 dprintk(D_USR, "hw_free.\n");
2124
2125
2126
2127 if (info->dvma_buffer) {
2128 if (DBRI_STREAMNO(substream) == DBRI_PLAY)
2129 direction = DMA_TO_DEVICE;
2130 else
2131 direction = DMA_FROM_DEVICE;
2132
2133 dma_unmap_single(&dbri->op->dev, info->dvma_buffer,
2134 substream->runtime->buffer_size, direction);
2135 info->dvma_buffer = 0;
2136 }
2137 if (info->pipe != -1) {
2138 reset_pipe(dbri, info->pipe);
2139 info->pipe = -1;
2140 }
2141
2142 return snd_pcm_lib_free_pages(substream);
2143}
2144
2145static int snd_dbri_prepare(struct snd_pcm_substream *substream)
2146{
2147 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2148 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2149 int ret;
2150
2151 info->size = snd_pcm_lib_buffer_bytes(substream);
2152 if (DBRI_STREAMNO(substream) == DBRI_PLAY)
2153 info->pipe = 4;
2154 else
2155 info->pipe = 6;
2156
2157 spin_lock_irq(&dbri->lock);
2158 info->offset = 0;
2159
2160
2161
2162
2163 ret = setup_descs(dbri, DBRI_STREAMNO(substream),
2164 snd_pcm_lib_period_bytes(substream));
2165
2166 spin_unlock_irq(&dbri->lock);
2167
2168 dprintk(D_USR, "prepare audio output. %d bytes\n", info->size);
2169 return ret;
2170}
2171
2172static int snd_dbri_trigger(struct snd_pcm_substream *substream, int cmd)
2173{
2174 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2175 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2176 int ret = 0;
2177
2178 switch (cmd) {
2179 case SNDRV_PCM_TRIGGER_START:
2180 dprintk(D_USR, "start audio, period is %d bytes\n",
2181 (int)snd_pcm_lib_period_bytes(substream));
2182
2183 xmit_descs(dbri);
2184 break;
2185 case SNDRV_PCM_TRIGGER_STOP:
2186 dprintk(D_USR, "stop audio.\n");
2187 reset_pipe(dbri, info->pipe);
2188 break;
2189 default:
2190 ret = -EINVAL;
2191 }
2192
2193 return ret;
2194}
2195
2196static snd_pcm_uframes_t snd_dbri_pointer(struct snd_pcm_substream *substream)
2197{
2198 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2199 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2200 snd_pcm_uframes_t ret;
2201
2202 ret = bytes_to_frames(substream->runtime, info->offset)
2203 % substream->runtime->buffer_size;
2204 dprintk(D_USR, "I/O pointer: %ld frames of %ld.\n",
2205 ret, substream->runtime->buffer_size);
2206 return ret;
2207}
2208
2209static struct snd_pcm_ops snd_dbri_ops = {
2210 .open = snd_dbri_open,
2211 .close = snd_dbri_close,
2212 .ioctl = snd_pcm_lib_ioctl,
2213 .hw_params = snd_dbri_hw_params,
2214 .hw_free = snd_dbri_hw_free,
2215 .prepare = snd_dbri_prepare,
2216 .trigger = snd_dbri_trigger,
2217 .pointer = snd_dbri_pointer,
2218};
2219
2220static int __devinit snd_dbri_pcm(struct snd_card *card)
2221{
2222 struct snd_pcm *pcm;
2223 int err;
2224
2225 if ((err = snd_pcm_new(card,
2226 "sun_dbri",
2227 0,
2228 1,
2229 1, &pcm)) < 0)
2230 return err;
2231
2232 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_dbri_ops);
2233 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_dbri_ops);
2234
2235 pcm->private_data = card->private_data;
2236 pcm->info_flags = 0;
2237 strcpy(pcm->name, card->shortname);
2238
2239 if ((err = snd_pcm_lib_preallocate_pages_for_all(pcm,
2240 SNDRV_DMA_TYPE_CONTINUOUS,
2241 snd_dma_continuous_data(GFP_KERNEL),
2242 64 * 1024, 64 * 1024)) < 0)
2243 return err;
2244
2245 return 0;
2246}
2247
2248
2249
2250
2251
2252static int snd_cs4215_info_volume(struct snd_kcontrol *kcontrol,
2253 struct snd_ctl_elem_info *uinfo)
2254{
2255 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2256 uinfo->count = 2;
2257 uinfo->value.integer.min = 0;
2258 if (kcontrol->private_value == DBRI_PLAY)
2259 uinfo->value.integer.max = DBRI_MAX_VOLUME;
2260 else
2261 uinfo->value.integer.max = DBRI_MAX_GAIN;
2262 return 0;
2263}
2264
2265static int snd_cs4215_get_volume(struct snd_kcontrol *kcontrol,
2266 struct snd_ctl_elem_value *ucontrol)
2267{
2268 struct snd_dbri *dbri = snd_kcontrol_chip(kcontrol);
2269 struct dbri_streaminfo *info;
2270
2271 if (snd_BUG_ON(!dbri))
2272 return -EINVAL;
2273 info = &dbri->stream_info[kcontrol->private_value];
2274
2275 ucontrol->value.integer.value[0] = info->left_gain;
2276 ucontrol->value.integer.value[1] = info->right_gain;
2277 return 0;
2278}
2279
2280static int snd_cs4215_put_volume(struct snd_kcontrol *kcontrol,
2281 struct snd_ctl_elem_value *ucontrol)
2282{
2283 struct snd_dbri *dbri = snd_kcontrol_chip(kcontrol);
2284 struct dbri_streaminfo *info =
2285 &dbri->stream_info[kcontrol->private_value];
2286 unsigned int vol[2];
2287 int changed = 0;
2288
2289 vol[0] = ucontrol->value.integer.value[0];
2290 vol[1] = ucontrol->value.integer.value[1];
2291 if (kcontrol->private_value == DBRI_PLAY) {
2292 if (vol[0] > DBRI_MAX_VOLUME || vol[1] > DBRI_MAX_VOLUME)
2293 return -EINVAL;
2294 } else {
2295 if (vol[0] > DBRI_MAX_GAIN || vol[1] > DBRI_MAX_GAIN)
2296 return -EINVAL;
2297 }
2298
2299 if (info->left_gain != vol[0]) {
2300 info->left_gain = vol[0];
2301 changed = 1;
2302 }
2303 if (info->right_gain != vol[1]) {
2304 info->right_gain = vol[1];
2305 changed = 1;
2306 }
2307 if (changed) {
2308
2309
2310
2311 cs4215_setdata(dbri, 1);
2312 udelay(125);
2313 cs4215_setdata(dbri, 0);
2314 }
2315 return changed;
2316}
2317
2318static int snd_cs4215_info_single(struct snd_kcontrol *kcontrol,
2319 struct snd_ctl_elem_info *uinfo)
2320{
2321 int mask = (kcontrol->private_value >> 16) & 0xff;
2322
2323 uinfo->type = (mask == 1) ?
2324 SNDRV_CTL_ELEM_TYPE_BOOLEAN : SNDRV_CTL_ELEM_TYPE_INTEGER;
2325 uinfo->count = 1;
2326 uinfo->value.integer.min = 0;
2327 uinfo->value.integer.max = mask;
2328 return 0;
2329}
2330
2331static int snd_cs4215_get_single(struct snd_kcontrol *kcontrol,
2332 struct snd_ctl_elem_value *ucontrol)
2333{
2334 struct snd_dbri *dbri = snd_kcontrol_chip(kcontrol);
2335 int elem = kcontrol->private_value & 0xff;
2336 int shift = (kcontrol->private_value >> 8) & 0xff;
2337 int mask = (kcontrol->private_value >> 16) & 0xff;
2338 int invert = (kcontrol->private_value >> 24) & 1;
2339
2340 if (snd_BUG_ON(!dbri))
2341 return -EINVAL;
2342
2343 if (elem < 4)
2344 ucontrol->value.integer.value[0] =
2345 (dbri->mm.data[elem] >> shift) & mask;
2346 else
2347 ucontrol->value.integer.value[0] =
2348 (dbri->mm.ctrl[elem - 4] >> shift) & mask;
2349
2350 if (invert == 1)
2351 ucontrol->value.integer.value[0] =
2352 mask - ucontrol->value.integer.value[0];
2353 return 0;
2354}
2355
2356static int snd_cs4215_put_single(struct snd_kcontrol *kcontrol,
2357 struct snd_ctl_elem_value *ucontrol)
2358{
2359 struct snd_dbri *dbri = snd_kcontrol_chip(kcontrol);
2360 int elem = kcontrol->private_value & 0xff;
2361 int shift = (kcontrol->private_value >> 8) & 0xff;
2362 int mask = (kcontrol->private_value >> 16) & 0xff;
2363 int invert = (kcontrol->private_value >> 24) & 1;
2364 int changed = 0;
2365 unsigned short val;
2366
2367 if (snd_BUG_ON(!dbri))
2368 return -EINVAL;
2369
2370 val = (ucontrol->value.integer.value[0] & mask);
2371 if (invert == 1)
2372 val = mask - val;
2373 val <<= shift;
2374
2375 if (elem < 4) {
2376 dbri->mm.data[elem] = (dbri->mm.data[elem] &
2377 ~(mask << shift)) | val;
2378 changed = (val != dbri->mm.data[elem]);
2379 } else {
2380 dbri->mm.ctrl[elem - 4] = (dbri->mm.ctrl[elem - 4] &
2381 ~(mask << shift)) | val;
2382 changed = (val != dbri->mm.ctrl[elem - 4]);
2383 }
2384
2385 dprintk(D_GEN, "put_single: mask=0x%x, changed=%d, "
2386 "mixer-value=%ld, mm-value=0x%x\n",
2387 mask, changed, ucontrol->value.integer.value[0],
2388 dbri->mm.data[elem & 3]);
2389
2390 if (changed) {
2391
2392
2393
2394 cs4215_setdata(dbri, 1);
2395 udelay(125);
2396 cs4215_setdata(dbri, 0);
2397 }
2398 return changed;
2399}
2400
2401
2402
2403
2404
2405#define CS4215_SINGLE(xname, entry, shift, mask, invert) \
2406{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname), \
2407 .info = snd_cs4215_info_single, \
2408 .get = snd_cs4215_get_single, .put = snd_cs4215_put_single, \
2409 .private_value = (entry) | ((shift) << 8) | ((mask) << 16) | \
2410 ((invert) << 24) },
2411
2412static struct snd_kcontrol_new dbri_controls[] __devinitdata = {
2413 {
2414 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2415 .name = "Playback Volume",
2416 .info = snd_cs4215_info_volume,
2417 .get = snd_cs4215_get_volume,
2418 .put = snd_cs4215_put_volume,
2419 .private_value = DBRI_PLAY,
2420 },
2421 CS4215_SINGLE("Headphone switch", 0, 7, 1, 0)
2422 CS4215_SINGLE("Line out switch", 0, 6, 1, 0)
2423 CS4215_SINGLE("Speaker switch", 1, 6, 1, 0)
2424 {
2425 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2426 .name = "Capture Volume",
2427 .info = snd_cs4215_info_volume,
2428 .get = snd_cs4215_get_volume,
2429 .put = snd_cs4215_put_volume,
2430 .private_value = DBRI_REC,
2431 },
2432
2433 CS4215_SINGLE("Line in switch", 2, 4, 1, 0)
2434 CS4215_SINGLE("High Pass Filter switch", 5, 7, 1, 0)
2435 CS4215_SINGLE("Monitor Volume", 3, 4, 0xf, 1)
2436 CS4215_SINGLE("Mic boost", 4, 4, 1, 1)
2437};
2438
2439static int __devinit snd_dbri_mixer(struct snd_card *card)
2440{
2441 int idx, err;
2442 struct snd_dbri *dbri;
2443
2444 if (snd_BUG_ON(!card || !card->private_data))
2445 return -EINVAL;
2446 dbri = card->private_data;
2447
2448 strcpy(card->mixername, card->shortname);
2449
2450 for (idx = 0; idx < ARRAY_SIZE(dbri_controls); idx++) {
2451 err = snd_ctl_add(card,
2452 snd_ctl_new1(&dbri_controls[idx], dbri));
2453 if (err < 0)
2454 return err;
2455 }
2456
2457 for (idx = DBRI_REC; idx < DBRI_NO_STREAMS; idx++) {
2458 dbri->stream_info[idx].left_gain = 0;
2459 dbri->stream_info[idx].right_gain = 0;
2460 }
2461
2462 return 0;
2463}
2464
2465
2466
2467
2468static void dbri_regs_read(struct snd_info_entry *entry,
2469 struct snd_info_buffer *buffer)
2470{
2471 struct snd_dbri *dbri = entry->private_data;
2472
2473 snd_iprintf(buffer, "REG0: 0x%x\n", sbus_readl(dbri->regs + REG0));
2474 snd_iprintf(buffer, "REG2: 0x%x\n", sbus_readl(dbri->regs + REG2));
2475 snd_iprintf(buffer, "REG8: 0x%x\n", sbus_readl(dbri->regs + REG8));
2476 snd_iprintf(buffer, "REG9: 0x%x\n", sbus_readl(dbri->regs + REG9));
2477}
2478
2479#ifdef DBRI_DEBUG
2480static void dbri_debug_read(struct snd_info_entry *entry,
2481 struct snd_info_buffer *buffer)
2482{
2483 struct snd_dbri *dbri = entry->private_data;
2484 int pipe;
2485 snd_iprintf(buffer, "debug=%d\n", dbri_debug);
2486
2487 for (pipe = 0; pipe < 32; pipe++) {
2488 if (pipe_active(dbri, pipe)) {
2489 struct dbri_pipe *pptr = &dbri->pipes[pipe];
2490 snd_iprintf(buffer,
2491 "Pipe %d: %s SDP=0x%x desc=%d, "
2492 "len=%d next %d\n",
2493 pipe,
2494 (pptr->sdp & D_SDP_TO_SER) ? "output" :
2495 "input",
2496 pptr->sdp, pptr->desc,
2497 pptr->length, pptr->nextpipe);
2498 }
2499 }
2500}
2501#endif
2502
2503static void __devinit snd_dbri_proc(struct snd_card *card)
2504{
2505 struct snd_dbri *dbri = card->private_data;
2506 struct snd_info_entry *entry;
2507
2508 if (!snd_card_proc_new(card, "regs", &entry))
2509 snd_info_set_text_ops(entry, dbri, dbri_regs_read);
2510
2511#ifdef DBRI_DEBUG
2512 if (!snd_card_proc_new(card, "debug", &entry)) {
2513 snd_info_set_text_ops(entry, dbri, dbri_debug_read);
2514 entry->mode = S_IFREG | S_IRUGO;
2515 }
2516#endif
2517}
2518
2519
2520
2521
2522
2523
2524static void snd_dbri_free(struct snd_dbri *dbri);
2525
2526static int __devinit snd_dbri_create(struct snd_card *card,
2527 struct platform_device *op,
2528 int irq, int dev)
2529{
2530 struct snd_dbri *dbri = card->private_data;
2531 int err;
2532
2533 spin_lock_init(&dbri->lock);
2534 dbri->op = op;
2535 dbri->irq = irq;
2536
2537 dbri->dma = dma_alloc_coherent(&op->dev,
2538 sizeof(struct dbri_dma),
2539 &dbri->dma_dvma, GFP_ATOMIC);
2540 if (!dbri->dma)
2541 return -ENOMEM;
2542 memset((void *)dbri->dma, 0, sizeof(struct dbri_dma));
2543
2544 dprintk(D_GEN, "DMA Cmd Block 0x%p (0x%08x)\n",
2545 dbri->dma, dbri->dma_dvma);
2546
2547
2548 dbri->regs_size = resource_size(&op->resource[0]);
2549 dbri->regs = of_ioremap(&op->resource[0], 0,
2550 dbri->regs_size, "DBRI Registers");
2551 if (!dbri->regs) {
2552 printk(KERN_ERR "DBRI: could not allocate registers\n");
2553 dma_free_coherent(&op->dev, sizeof(struct dbri_dma),
2554 (void *)dbri->dma, dbri->dma_dvma);
2555 return -EIO;
2556 }
2557
2558 err = request_irq(dbri->irq, snd_dbri_interrupt, IRQF_SHARED,
2559 "DBRI audio", dbri);
2560 if (err) {
2561 printk(KERN_ERR "DBRI: Can't get irq %d\n", dbri->irq);
2562 of_iounmap(&op->resource[0], dbri->regs, dbri->regs_size);
2563 dma_free_coherent(&op->dev, sizeof(struct dbri_dma),
2564 (void *)dbri->dma, dbri->dma_dvma);
2565 return err;
2566 }
2567
2568
2569 dbri_initialize(dbri);
2570 err = cs4215_init(dbri);
2571 if (err) {
2572 snd_dbri_free(dbri);
2573 return err;
2574 }
2575
2576 return 0;
2577}
2578
2579static void snd_dbri_free(struct snd_dbri *dbri)
2580{
2581 dprintk(D_GEN, "snd_dbri_free\n");
2582 dbri_reset(dbri);
2583
2584 if (dbri->irq)
2585 free_irq(dbri->irq, dbri);
2586
2587 if (dbri->regs)
2588 of_iounmap(&dbri->op->resource[0], dbri->regs, dbri->regs_size);
2589
2590 if (dbri->dma)
2591 dma_free_coherent(&dbri->op->dev,
2592 sizeof(struct dbri_dma),
2593 (void *)dbri->dma, dbri->dma_dvma);
2594}
2595
2596static int __devinit dbri_probe(struct platform_device *op)
2597{
2598 struct snd_dbri *dbri;
2599 struct resource *rp;
2600 struct snd_card *card;
2601 static int dev = 0;
2602 int irq;
2603 int err;
2604
2605 if (dev >= SNDRV_CARDS)
2606 return -ENODEV;
2607 if (!enable[dev]) {
2608 dev++;
2609 return -ENOENT;
2610 }
2611
2612 irq = op->archdata.irqs[0];
2613 if (irq <= 0) {
2614 printk(KERN_ERR "DBRI-%d: No IRQ.\n", dev);
2615 return -ENODEV;
2616 }
2617
2618 err = snd_card_create(index[dev], id[dev], THIS_MODULE,
2619 sizeof(struct snd_dbri), &card);
2620 if (err < 0)
2621 return err;
2622
2623 strcpy(card->driver, "DBRI");
2624 strcpy(card->shortname, "Sun DBRI");
2625 rp = &op->resource[0];
2626 sprintf(card->longname, "%s at 0x%02lx:0x%016Lx, irq %d",
2627 card->shortname,
2628 rp->flags & 0xffL, (unsigned long long)rp->start, irq);
2629
2630 err = snd_dbri_create(card, op, irq, dev);
2631 if (err < 0) {
2632 snd_card_free(card);
2633 return err;
2634 }
2635
2636 dbri = card->private_data;
2637 err = snd_dbri_pcm(card);
2638 if (err < 0)
2639 goto _err;
2640
2641 err = snd_dbri_mixer(card);
2642 if (err < 0)
2643 goto _err;
2644
2645
2646 snd_dbri_proc(card);
2647 dev_set_drvdata(&op->dev, card);
2648
2649 err = snd_card_register(card);
2650 if (err < 0)
2651 goto _err;
2652
2653 printk(KERN_INFO "audio%d at %p (irq %d) is DBRI(%c)+CS4215(%d)\n",
2654 dev, dbri->regs,
2655 dbri->irq, op->dev.of_node->name[9], dbri->mm.version);
2656 dev++;
2657
2658 return 0;
2659
2660_err:
2661 snd_dbri_free(dbri);
2662 snd_card_free(card);
2663 return err;
2664}
2665
2666static int __devexit dbri_remove(struct platform_device *op)
2667{
2668 struct snd_card *card = dev_get_drvdata(&op->dev);
2669
2670 snd_dbri_free(card->private_data);
2671 snd_card_free(card);
2672
2673 dev_set_drvdata(&op->dev, NULL);
2674
2675 return 0;
2676}
2677
2678static const struct of_device_id dbri_match[] = {
2679 {
2680 .name = "SUNW,DBRIe",
2681 },
2682 {
2683 .name = "SUNW,DBRIf",
2684 },
2685 {},
2686};
2687
2688MODULE_DEVICE_TABLE(of, dbri_match);
2689
2690static struct platform_driver dbri_sbus_driver = {
2691 .driver = {
2692 .name = "dbri",
2693 .owner = THIS_MODULE,
2694 .of_match_table = dbri_match,
2695 },
2696 .probe = dbri_probe,
2697 .remove = __devexit_p(dbri_remove),
2698};
2699
2700module_platform_driver(dbri_sbus_driver);
2701