0001
0002
0003
0004
0005
0006
0007
0008
0009
0010
0011
0012
0013
0014
0015
0016
0017
0018
0019
0020
0021
0022
0023
0024
0025
0026
0027
0028
0029
0030
0031
0032
0033
0034
0035
0036
0037
0038
0039
0040
0041
0042
0043
0044
0045
0046
0047
0048
0049
0050
0051
0052
0053
0054
0055
0056
0057 #include <linux/interrupt.h>
0058 #include <linux/delay.h>
0059 #include <linux/irq.h>
0060 #include <linux/io.h>
0061 #include <linux/dma-mapping.h>
0062 #include <linux/gfp.h>
0063
0064 #include <sound/core.h>
0065 #include <sound/pcm.h>
0066 #include <sound/pcm_params.h>
0067 #include <sound/info.h>
0068 #include <sound/control.h>
0069 #include <sound/initval.h>
0070
0071 #include <linux/of.h>
0072 #include <linux/of_device.h>
0073 #include <linux/atomic.h>
0074 #include <linux/module.h>
0075
0076 MODULE_AUTHOR("Rudolf Koenig, Brent Baccala and Martin Habets");
0077 MODULE_DESCRIPTION("Sun DBRI");
0078 MODULE_LICENSE("GPL");
0079
0080 static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;
0081 static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;
0082
0083 static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
0084
0085 module_param_array(index, int, NULL, 0444);
0086 MODULE_PARM_DESC(index, "Index value for Sun DBRI soundcard.");
0087 module_param_array(id, charp, NULL, 0444);
0088 MODULE_PARM_DESC(id, "ID string for Sun DBRI soundcard.");
0089 module_param_array(enable, bool, NULL, 0444);
0090 MODULE_PARM_DESC(enable, "Enable Sun DBRI soundcard.");
0091
0092 #undef DBRI_DEBUG
0093
0094 #define D_INT (1<<0)
0095 #define D_GEN (1<<1)
0096 #define D_CMD (1<<2)
0097 #define D_MM (1<<3)
0098 #define D_USR (1<<4)
0099 #define D_DESC (1<<5)
0100
0101 static int dbri_debug;
0102 module_param(dbri_debug, int, 0644);
0103 MODULE_PARM_DESC(dbri_debug, "Debug value for Sun DBRI soundcard.");
0104
0105 #ifdef DBRI_DEBUG
0106 static const char * const cmds[] = {
0107 "WAIT", "PAUSE", "JUMP", "IIQ", "REX", "SDP", "CDP", "DTS",
0108 "SSP", "CHI", "NT", "TE", "CDEC", "TEST", "CDM", "RESRV"
0109 };
0110
0111 #define dprintk(a, x...) if (dbri_debug & a) printk(KERN_DEBUG x)
0112
0113 #else
0114 #define dprintk(a, x...) do { } while (0)
0115
0116 #endif
0117
0118 #define DBRI_CMD(cmd, intr, value) ((cmd << 28) | \
0119 (intr << 27) | \
0120 value)
0121
0122
0123
0124
0125
0126 struct cs4215 {
0127 __u8 data[4];
0128 __u8 ctrl[4];
0129 __u8 onboard;
0130 __u8 offset;
0131 volatile __u32 status;
0132 volatile __u32 version;
0133 __u8 precision;
0134 __u8 channels;
0135 };
0136
0137
0138
0139
0140
0141
0142 #define CS4215_CLB (1<<2)
0143 #define CS4215_OLB (1<<3)
0144
0145 #define CS4215_MLB (1<<4)
0146 #define CS4215_RSRVD_1 (1<<5)
0147
0148
0149 #define CS4215_DFR_LINEAR16 0
0150 #define CS4215_DFR_ULAW 1
0151 #define CS4215_DFR_ALAW 2
0152 #define CS4215_DFR_LINEAR8 3
0153 #define CS4215_DFR_STEREO (1<<2)
0154 static struct {
0155 unsigned short freq;
0156 unsigned char xtal;
0157 unsigned char csval;
0158 } CS4215_FREQ[] = {
0159 { 8000, (1 << 4), (0 << 3) },
0160 { 16000, (1 << 4), (1 << 3) },
0161 { 27429, (1 << 4), (2 << 3) },
0162 { 32000, (1 << 4), (3 << 3) },
0163
0164
0165 { 48000, (1 << 4), (6 << 3) },
0166 { 9600, (1 << 4), (7 << 3) },
0167 { 5512, (2 << 4), (0 << 3) },
0168 { 11025, (2 << 4), (1 << 3) },
0169 { 18900, (2 << 4), (2 << 3) },
0170 { 22050, (2 << 4), (3 << 3) },
0171 { 37800, (2 << 4), (4 << 3) },
0172 { 44100, (2 << 4), (5 << 3) },
0173 { 33075, (2 << 4), (6 << 3) },
0174 { 6615, (2 << 4), (7 << 3) },
0175 { 0, 0, 0}
0176 };
0177
0178 #define CS4215_HPF (1<<7)
0179
0180 #define CS4215_12_MASK 0xfcbf
0181
0182
0183 #define CS4215_XEN (1<<0)
0184 #define CS4215_XCLK (1<<1)
0185 #define CS4215_BSEL_64 (0<<2)
0186 #define CS4215_BSEL_128 (1<<2)
0187 #define CS4215_BSEL_256 (2<<2)
0188 #define CS4215_MCK_MAST (0<<4)
0189 #define CS4215_MCK_XTL1 (1<<4)
0190 #define CS4215_MCK_XTL2 (2<<4)
0191 #define CS4215_MCK_CLK1 (3<<4)
0192 #define CS4215_MCK_CLK2 (4<<4)
0193
0194
0195 #define CS4215_DAD (1<<0)
0196 #define CS4215_ENL (1<<1)
0197
0198
0199
0200
0201
0202
0203
0204 #define CS4215_VERSION_MASK 0xf
0205
0206
0207
0208
0209
0210
0211
0212
0213
0214 #define CS4215_LO(v) v
0215 #define CS4215_LE (1<<6)
0216 #define CS4215_HE (1<<7)
0217
0218
0219 #define CS4215_RO(v) v
0220 #define CS4215_SE (1<<6)
0221 #define CS4215_ADI (1<<7)
0222
0223
0224 #define CS4215_LG(v) v
0225 #define CS4215_IS (1<<4)
0226 #define CS4215_OVR (1<<5)
0227 #define CS4215_PIO0 (1<<6)
0228 #define CS4215_PIO1 (1<<7)
0229
0230
0231 #define CS4215_RG(v) v
0232 #define CS4215_MA(v) (v<<4)
0233
0234
0235
0236
0237
0238
0239 #define REG0 0x00
0240 #define REG1 0x04
0241 #define REG2 0x08
0242 #define REG3 0x0c
0243 #define REG8 0x20
0244 #define REG9 0x24
0245
0246 #define DBRI_NO_CMDS 64
0247 #define DBRI_INT_BLK 64
0248 #define DBRI_NO_DESCS 64
0249 #define DBRI_NO_PIPES 32
0250 #define DBRI_MAX_PIPE (DBRI_NO_PIPES - 1)
0251
0252 #define DBRI_REC 0
0253 #define DBRI_PLAY 1
0254 #define DBRI_NO_STREAMS 2
0255
0256
0257
0258 struct dbri_mem {
0259 volatile __u32 word1;
0260 __u32 ba;
0261 __u32 nda;
0262 volatile __u32 word4;
0263 };
0264
0265
0266
0267
0268 struct dbri_dma {
0269 s32 cmd[DBRI_NO_CMDS];
0270 volatile s32 intr[DBRI_INT_BLK];
0271 struct dbri_mem desc[DBRI_NO_DESCS];
0272 };
0273
0274 #define dbri_dma_off(member, elem) \
0275 ((u32)(unsigned long) \
0276 (&(((struct dbri_dma *)0)->member[elem])))
0277
0278 enum in_or_out { PIPEinput, PIPEoutput };
0279
0280 struct dbri_pipe {
0281 u32 sdp;
0282 int nextpipe;
0283 int length;
0284 int first_desc;
0285 int desc;
0286 volatile __u32 *recv_fixed_ptr;
0287 };
0288
0289
0290 struct dbri_streaminfo {
0291 struct snd_pcm_substream *substream;
0292 u32 dvma_buffer;
0293 int size;
0294 size_t offset;
0295 int pipe;
0296 int left_gain;
0297 int right_gain;
0298 };
0299
0300
0301 struct snd_dbri {
0302 int regs_size, irq;
0303 struct platform_device *op;
0304 spinlock_t lock;
0305
0306 struct dbri_dma *dma;
0307 dma_addr_t dma_dvma;
0308
0309 void __iomem *regs;
0310 int dbri_irqp;
0311
0312 struct dbri_pipe pipes[DBRI_NO_PIPES];
0313 int next_desc[DBRI_NO_DESCS];
0314 spinlock_t cmdlock;
0315 s32 *cmdptr;
0316
0317 int chi_bpf;
0318
0319 struct cs4215 mm;
0320
0321 struct dbri_streaminfo stream_info[DBRI_NO_STREAMS];
0322 };
0323
0324 #define DBRI_MAX_VOLUME 63
0325 #define DBRI_MAX_GAIN 15
0326
0327
0328 #define D_P (1<<15)
0329 #define D_G (1<<14)
0330 #define D_S (1<<13)
0331 #define D_E (1<<12)
0332 #define D_X (1<<7)
0333 #define D_T (1<<6)
0334 #define D_N (1<<5)
0335 #define D_C (1<<4)
0336 #define D_F (1<<3)
0337 #define D_D (1<<2)
0338 #define D_H (1<<1)
0339 #define D_R (1<<0)
0340
0341
0342 #define D_LITTLE_END (1<<8)
0343 #define D_BIG_END (0<<8)
0344 #define D_MRR (1<<4)
0345 #define D_MLE (1<<3)
0346 #define D_LBG (1<<2)
0347 #define D_MBE (1<<1)
0348 #define D_IR (1<<0)
0349
0350
0351 #define D_ENPIO3 (1<<7)
0352 #define D_ENPIO2 (1<<6)
0353 #define D_ENPIO1 (1<<5)
0354 #define D_ENPIO0 (1<<4)
0355 #define D_ENPIO (0xf0)
0356 #define D_PIO3 (1<<3)
0357 #define D_PIO2 (1<<2)
0358 #define D_PIO1 (1<<1)
0359 #define D_PIO0 (1<<0)
0360
0361
0362 #define D_WAIT 0x0
0363 #define D_PAUSE 0x1
0364 #define D_JUMP 0x2
0365 #define D_IIQ 0x3
0366 #define D_REX 0x4
0367 #define D_SDP 0x5
0368 #define D_CDP 0x6
0369 #define D_DTS 0x7
0370 #define D_SSP 0x8
0371 #define D_CHI 0x9
0372 #define D_NT 0xa
0373 #define D_TE 0xb
0374 #define D_CDEC 0xc
0375 #define D_TEST 0xd
0376 #define D_CDM 0xe
0377
0378
0379 #define D_PIPE(v) ((v)<<0)
0380
0381
0382
0383 #define D_SDP_2SAME (1<<18)
0384 #define D_SDP_CHANGE (2<<18)
0385 #define D_SDP_EVERY (3<<18)
0386 #define D_SDP_EOL (1<<17)
0387 #define D_SDP_IDLE (1<<16)
0388
0389
0390 #define D_SDP_MEM (0<<13)
0391 #define D_SDP_HDLC (2<<13)
0392 #define D_SDP_HDLC_D (3<<13)
0393 #define D_SDP_SER (4<<13)
0394 #define D_SDP_FIXED (6<<13)
0395 #define D_SDP_MODE(v) ((v)&(7<<13))
0396
0397 #define D_SDP_TO_SER (1<<12)
0398 #define D_SDP_FROM_SER (0<<12)
0399 #define D_SDP_MSB (1<<11)
0400 #define D_SDP_LSB (0<<11)
0401 #define D_SDP_P (1<<10)
0402 #define D_SDP_A (1<<8)
0403 #define D_SDP_C (1<<7)
0404
0405
0406 #define D_DTS_VI (1<<17)
0407 #define D_DTS_VO (1<<16)
0408 #define D_DTS_INS (1<<15)
0409 #define D_DTS_DEL (0<<15)
0410 #define D_DTS_PRVIN(v) ((v)<<10)
0411 #define D_DTS_PRVOUT(v) ((v)<<5)
0412
0413
0414 #define D_TS_LEN(v) ((v)<<24)
0415 #define D_TS_CYCLE(v) ((v)<<14)
0416 #define D_TS_DI (1<<13)
0417 #define D_TS_1CHANNEL (0<<10)
0418 #define D_TS_MONITOR (2<<10)
0419 #define D_TS_NONCONTIG (3<<10)
0420 #define D_TS_ANCHOR (7<<10)
0421 #define D_TS_MON(v) ((v)<<5)
0422 #define D_TS_NEXT(v) ((v)<<0)
0423
0424
0425 #define D_CHI_CHICM(v) ((v)<<16)
0426 #define D_CHI_IR (1<<15)
0427 #define D_CHI_EN (1<<14)
0428 #define D_CHI_OD (1<<13)
0429 #define D_CHI_FE (1<<12)
0430 #define D_CHI_FD (1<<11)
0431 #define D_CHI_BPF(v) ((v)<<0)
0432
0433
0434 #define D_NT_FBIT (1<<17)
0435 #define D_NT_NBF (1<<16)
0436 #define D_NT_IRM_IMM (1<<15)
0437 #define D_NT_IRM_EN (1<<14)
0438 #define D_NT_ISNT (1<<13)
0439 #define D_NT_FT (1<<12)
0440 #define D_NT_EZ (1<<11)
0441 #define D_NT_IFA (1<<10)
0442 #define D_NT_ACT (1<<9)
0443 #define D_NT_MFE (1<<8)
0444 #define D_NT_RLB(v) ((v)<<5)
0445 #define D_NT_LLB(v) ((v)<<2)
0446 #define D_NT_FACT (1<<1)
0447 #define D_NT_ABV (1<<0)
0448
0449
0450 #define D_CDEC_CK(v) ((v)<<24)
0451 #define D_CDEC_FED(v) ((v)<<12)
0452 #define D_CDEC_RED(v) ((v)<<0)
0453
0454
0455 #define D_TEST_RAM(v) ((v)<<16)
0456 #define D_TEST_SIZE(v) ((v)<<11)
0457 #define D_TEST_ROMONOFF 0x5
0458 #define D_TEST_PROC 0x6
0459 #define D_TEST_SER 0x7
0460 #define D_TEST_RAMREAD 0x8
0461 #define D_TEST_RAMWRITE 0x9
0462 #define D_TEST_RAMBIST 0xa
0463 #define D_TEST_MCBIST 0xb
0464 #define D_TEST_DUMP 0xe
0465
0466
0467 #define D_CDM_THI (1 << 8)
0468 #define D_CDM_RHI (1 << 7)
0469 #define D_CDM_RCE (1 << 6)
0470 #define D_CDM_XCE (1 << 2)
0471 #define D_CDM_XEN (1 << 1)
0472 #define D_CDM_REN (1 << 0)
0473
0474
0475 #define D_INTR_BRDY 1
0476 #define D_INTR_MINT 2
0477 #define D_INTR_IBEG 3
0478 #define D_INTR_IEND 4
0479 #define D_INTR_EOL 5
0480 #define D_INTR_CMDI 6
0481 #define D_INTR_XCMP 8
0482 #define D_INTR_SBRI 9
0483 #define D_INTR_FXDT 10
0484 #define D_INTR_CHIL 11
0485 #define D_INTR_COLL 11
0486 #define D_INTR_DBYT 12
0487 #define D_INTR_RBYT 13
0488 #define D_INTR_LINT 14
0489 #define D_INTR_UNDR 15
0490
0491 #define D_INTR_TE 32
0492 #define D_INTR_NT 34
0493 #define D_INTR_CHI 36
0494 #define D_INTR_CMD 38
0495
0496 #define D_INTR_GETCHAN(v) (((v) >> 24) & 0x3f)
0497 #define D_INTR_GETCODE(v) (((v) >> 20) & 0xf)
0498 #define D_INTR_GETCMD(v) (((v) >> 16) & 0xf)
0499 #define D_INTR_GETVAL(v) ((v) & 0xffff)
0500 #define D_INTR_GETRVAL(v) ((v) & 0xfffff)
0501
0502 #define D_P_0 0
0503 #define D_P_1 1
0504 #define D_P_2 2
0505 #define D_P_3 3
0506 #define D_P_4 4
0507 #define D_P_5 5
0508 #define D_P_6 6
0509 #define D_P_7 7
0510 #define D_P_8 8
0511 #define D_P_9 9
0512 #define D_P_10 10
0513 #define D_P_11 11
0514 #define D_P_12 12
0515 #define D_P_13 13
0516 #define D_P_14 14
0517 #define D_P_15 15
0518 #define D_P_16 16
0519 #define D_P_17 17
0520 #define D_P_18 18
0521 #define D_P_19 19
0522 #define D_P_20 20
0523 #define D_P_21 21
0524 #define D_P_22 22
0525 #define D_P_23 23
0526 #define D_P_24 24
0527 #define D_P_25 25
0528 #define D_P_26 26
0529 #define D_P_27 27
0530 #define D_P_28 28
0531 #define D_P_29 29
0532 #define D_P_30 30
0533 #define D_P_31 31
0534
0535
0536 #define DBRI_TD_F (1 << 31)
0537 #define DBRI_TD_D (1 << 30)
0538 #define DBRI_TD_CNT(v) ((v) << 16)
0539 #define DBRI_TD_B (1 << 15)
0540 #define DBRI_TD_M (1 << 14)
0541 #define DBRI_TD_I (1 << 13)
0542 #define DBRI_TD_FCNT(v) (v)
0543 #define DBRI_TD_UNR (1 << 3)
0544 #define DBRI_TD_ABT (1 << 2)
0545 #define DBRI_TD_TBC (1 << 0)
0546 #define DBRI_TD_STATUS(v) ((v) & 0xff)
0547
0548 #define DBRI_TD_MAXCNT ((1 << 13) - 4)
0549
0550
0551 #define DBRI_RD_F (1 << 31)
0552 #define DBRI_RD_C (1 << 30)
0553 #define DBRI_RD_B (1 << 15)
0554 #define DBRI_RD_M (1 << 14)
0555 #define DBRI_RD_BCNT(v) (v)
0556 #define DBRI_RD_CRC (1 << 7)
0557 #define DBRI_RD_BBC (1 << 6)
0558 #define DBRI_RD_ABT (1 << 5)
0559 #define DBRI_RD_OVRN (1 << 3)
0560 #define DBRI_RD_STATUS(v) ((v) & 0xff)
0561 #define DBRI_RD_CNT(v) (((v) >> 16) & 0x1fff)
0562
0563
0564
0565 #define DBRI_STREAMNO(substream) \
0566 (substream->stream == \
0567 SNDRV_PCM_STREAM_PLAYBACK ? DBRI_PLAY: DBRI_REC)
0568
0569
0570 #define DBRI_STREAM(dbri, substream) \
0571 &dbri->stream_info[DBRI_STREAMNO(substream)]
0572
0573
0574
0575
0576
0577 static __u32 reverse_bytes(__u32 b, int len)
0578 {
0579 switch (len) {
0580 case 32:
0581 b = ((b & 0xffff0000) >> 16) | ((b & 0x0000ffff) << 16);
0582 fallthrough;
0583 case 16:
0584 b = ((b & 0xff00ff00) >> 8) | ((b & 0x00ff00ff) << 8);
0585 fallthrough;
0586 case 8:
0587 b = ((b & 0xf0f0f0f0) >> 4) | ((b & 0x0f0f0f0f) << 4);
0588 fallthrough;
0589 case 4:
0590 b = ((b & 0xcccccccc) >> 2) | ((b & 0x33333333) << 2);
0591 fallthrough;
0592 case 2:
0593 b = ((b & 0xaaaaaaaa) >> 1) | ((b & 0x55555555) << 1);
0594 case 1:
0595 case 0:
0596 break;
0597 default:
0598 printk(KERN_ERR "DBRI reverse_bytes: unsupported length\n");
0599 }
0600
0601 return b;
0602 }
0603
0604
0605
0606
0607
0608
0609
0610
0611
0612
0613
0614
0615
0616
0617
0618
0619
0620
0621
0622
0623
0624
0625
0626
0627
0628
0629
0630
0631
0632
0633
0634 #define MAXLOOPS 20
0635
0636
0637
0638 static void dbri_cmdwait(struct snd_dbri *dbri)
0639 {
0640 int maxloops = MAXLOOPS;
0641 unsigned long flags;
0642
0643
0644 spin_lock_irqsave(&dbri->lock, flags);
0645 while ((--maxloops) > 0 && (sbus_readl(dbri->regs + REG0) & D_P)) {
0646 spin_unlock_irqrestore(&dbri->lock, flags);
0647 msleep_interruptible(1);
0648 spin_lock_irqsave(&dbri->lock, flags);
0649 }
0650 spin_unlock_irqrestore(&dbri->lock, flags);
0651
0652 if (maxloops == 0)
0653 printk(KERN_ERR "DBRI: Chip never completed command buffer\n");
0654 else
0655 dprintk(D_CMD, "Chip completed command buffer (%d)\n",
0656 MAXLOOPS - maxloops - 1);
0657 }
0658
0659
0660
0661
0662 static s32 *dbri_cmdlock(struct snd_dbri *dbri, int len)
0663 {
0664 u32 dvma_addr = (u32)dbri->dma_dvma;
0665
0666
0667 len += 2;
0668 spin_lock(&dbri->cmdlock);
0669 if (dbri->cmdptr - dbri->dma->cmd + len < DBRI_NO_CMDS - 2)
0670 return dbri->cmdptr + 2;
0671 else if (len < sbus_readl(dbri->regs + REG8) - dvma_addr)
0672 return dbri->dma->cmd;
0673 else
0674 printk(KERN_ERR "DBRI: no space for commands.");
0675
0676 return NULL;
0677 }
0678
0679
0680
0681
0682
0683
0684
0685
0686
0687 static void dbri_cmdsend(struct snd_dbri *dbri, s32 *cmd, int len)
0688 {
0689 u32 dvma_addr = (u32)dbri->dma_dvma;
0690 s32 tmp, addr;
0691 static int wait_id;
0692
0693 wait_id++;
0694 wait_id &= 0xffff;
0695 *(cmd) = DBRI_CMD(D_WAIT, 1, wait_id);
0696 *(cmd+1) = DBRI_CMD(D_WAIT, 1, wait_id);
0697
0698
0699 addr = dvma_addr + (cmd - len - dbri->dma->cmd) * sizeof(s32);
0700 *(dbri->cmdptr+1) = addr;
0701 *(dbri->cmdptr) = DBRI_CMD(D_JUMP, 0, 0);
0702
0703 #ifdef DBRI_DEBUG
0704 if (cmd > dbri->cmdptr) {
0705 s32 *ptr;
0706
0707 for (ptr = dbri->cmdptr; ptr < cmd+2; ptr++)
0708 dprintk(D_CMD, "cmd: %lx:%08x\n",
0709 (unsigned long)ptr, *ptr);
0710 } else {
0711 s32 *ptr = dbri->cmdptr;
0712
0713 dprintk(D_CMD, "cmd: %lx:%08x\n", (unsigned long)ptr, *ptr);
0714 ptr++;
0715 dprintk(D_CMD, "cmd: %lx:%08x\n", (unsigned long)ptr, *ptr);
0716 for (ptr = dbri->dma->cmd; ptr < cmd+2; ptr++)
0717 dprintk(D_CMD, "cmd: %lx:%08x\n",
0718 (unsigned long)ptr, *ptr);
0719 }
0720 #endif
0721
0722
0723 tmp = sbus_readl(dbri->regs + REG0);
0724 tmp |= D_P;
0725 sbus_writel(tmp, dbri->regs + REG0);
0726
0727 dbri->cmdptr = cmd;
0728 spin_unlock(&dbri->cmdlock);
0729 }
0730
0731
0732 static void dbri_reset(struct snd_dbri *dbri)
0733 {
0734 int i;
0735 u32 tmp;
0736
0737 dprintk(D_GEN, "reset 0:%x 2:%x 8:%x 9:%x\n",
0738 sbus_readl(dbri->regs + REG0),
0739 sbus_readl(dbri->regs + REG2),
0740 sbus_readl(dbri->regs + REG8), sbus_readl(dbri->regs + REG9));
0741
0742 sbus_writel(D_R, dbri->regs + REG0);
0743 for (i = 0; (sbus_readl(dbri->regs + REG0) & D_R) && i < 64; i++)
0744 udelay(10);
0745
0746
0747
0748 tmp = sbus_readl(dbri->regs + REG0);
0749 tmp |= D_G | D_E;
0750 tmp &= ~D_S;
0751 sbus_writel(tmp, dbri->regs + REG0);
0752 }
0753
0754
0755 static void dbri_initialize(struct snd_dbri *dbri)
0756 {
0757 u32 dvma_addr = (u32)dbri->dma_dvma;
0758 s32 *cmd;
0759 u32 dma_addr;
0760 unsigned long flags;
0761 int n;
0762
0763 spin_lock_irqsave(&dbri->lock, flags);
0764
0765 dbri_reset(dbri);
0766
0767
0768 for (n = 0; n < DBRI_NO_PIPES; n++)
0769 dbri->pipes[n].desc = dbri->pipes[n].first_desc = -1;
0770
0771 spin_lock_init(&dbri->cmdlock);
0772
0773
0774
0775 dma_addr = dvma_addr + dbri_dma_off(intr, 0);
0776 dbri->dma->intr[0] = dma_addr;
0777 dbri->dbri_irqp = 1;
0778
0779
0780
0781 spin_lock(&dbri->cmdlock);
0782 cmd = dbri->cmdptr = dbri->dma->cmd;
0783 *(cmd++) = DBRI_CMD(D_IIQ, 0, 0);
0784 *(cmd++) = dma_addr;
0785 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
0786 dbri->cmdptr = cmd;
0787 *(cmd++) = DBRI_CMD(D_WAIT, 1, 0);
0788 *(cmd++) = DBRI_CMD(D_WAIT, 1, 0);
0789 dma_addr = dvma_addr + dbri_dma_off(cmd, 0);
0790 sbus_writel(dma_addr, dbri->regs + REG8);
0791 spin_unlock(&dbri->cmdlock);
0792
0793 spin_unlock_irqrestore(&dbri->lock, flags);
0794 dbri_cmdwait(dbri);
0795 }
0796
0797
0798
0799
0800
0801
0802
0803
0804
0805
0806
0807
0808
0809
0810
0811 static inline int pipe_active(struct snd_dbri *dbri, int pipe)
0812 {
0813 return ((pipe >= 0) && (dbri->pipes[pipe].desc != -1));
0814 }
0815
0816
0817
0818
0819
0820
0821 static void reset_pipe(struct snd_dbri *dbri, int pipe)
0822 {
0823 int sdp;
0824 int desc;
0825 s32 *cmd;
0826
0827 if (pipe < 0 || pipe > DBRI_MAX_PIPE) {
0828 printk(KERN_ERR "DBRI: reset_pipe called with "
0829 "illegal pipe number\n");
0830 return;
0831 }
0832
0833 sdp = dbri->pipes[pipe].sdp;
0834 if (sdp == 0) {
0835 printk(KERN_ERR "DBRI: reset_pipe called "
0836 "on uninitialized pipe\n");
0837 return;
0838 }
0839
0840 cmd = dbri_cmdlock(dbri, 3);
0841 *(cmd++) = DBRI_CMD(D_SDP, 0, sdp | D_SDP_C | D_SDP_P);
0842 *(cmd++) = 0;
0843 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
0844 dbri_cmdsend(dbri, cmd, 3);
0845
0846 desc = dbri->pipes[pipe].first_desc;
0847 if (desc >= 0)
0848 do {
0849 dbri->dma->desc[desc].ba = 0;
0850 dbri->dma->desc[desc].nda = 0;
0851 desc = dbri->next_desc[desc];
0852 } while (desc != -1 && desc != dbri->pipes[pipe].first_desc);
0853
0854 dbri->pipes[pipe].desc = -1;
0855 dbri->pipes[pipe].first_desc = -1;
0856 }
0857
0858
0859
0860
0861 static void setup_pipe(struct snd_dbri *dbri, int pipe, int sdp)
0862 {
0863 if (pipe < 0 || pipe > DBRI_MAX_PIPE) {
0864 printk(KERN_ERR "DBRI: setup_pipe called "
0865 "with illegal pipe number\n");
0866 return;
0867 }
0868
0869 if ((sdp & 0xf800) != sdp) {
0870 printk(KERN_ERR "DBRI: setup_pipe called "
0871 "with strange SDP value\n");
0872
0873 }
0874
0875
0876
0877
0878 if (D_SDP_MODE(sdp) == D_SDP_FIXED && !(sdp & D_SDP_TO_SER))
0879 sdp |= D_SDP_CHANGE;
0880
0881 sdp |= D_PIPE(pipe);
0882 dbri->pipes[pipe].sdp = sdp;
0883 dbri->pipes[pipe].desc = -1;
0884 dbri->pipes[pipe].first_desc = -1;
0885
0886 reset_pipe(dbri, pipe);
0887 }
0888
0889
0890
0891
0892 static void link_time_slot(struct snd_dbri *dbri, int pipe,
0893 int prevpipe, int nextpipe,
0894 int length, int cycle)
0895 {
0896 s32 *cmd;
0897 int val;
0898
0899 if (pipe < 0 || pipe > DBRI_MAX_PIPE
0900 || prevpipe < 0 || prevpipe > DBRI_MAX_PIPE
0901 || nextpipe < 0 || nextpipe > DBRI_MAX_PIPE) {
0902 printk(KERN_ERR
0903 "DBRI: link_time_slot called with illegal pipe number\n");
0904 return;
0905 }
0906
0907 if (dbri->pipes[pipe].sdp == 0
0908 || dbri->pipes[prevpipe].sdp == 0
0909 || dbri->pipes[nextpipe].sdp == 0) {
0910 printk(KERN_ERR "DBRI: link_time_slot called "
0911 "on uninitialized pipe\n");
0912 return;
0913 }
0914
0915 dbri->pipes[prevpipe].nextpipe = pipe;
0916 dbri->pipes[pipe].nextpipe = nextpipe;
0917 dbri->pipes[pipe].length = length;
0918
0919 cmd = dbri_cmdlock(dbri, 4);
0920
0921 if (dbri->pipes[pipe].sdp & D_SDP_TO_SER) {
0922
0923
0924
0925
0926
0927 if (prevpipe == 16 && cycle == 0)
0928 cycle = dbri->chi_bpf;
0929
0930 val = D_DTS_VO | D_DTS_INS | D_DTS_PRVOUT(prevpipe) | pipe;
0931 *(cmd++) = DBRI_CMD(D_DTS, 0, val);
0932 *(cmd++) = 0;
0933 *(cmd++) =
0934 D_TS_LEN(length) | D_TS_CYCLE(cycle) | D_TS_NEXT(nextpipe);
0935 } else {
0936 val = D_DTS_VI | D_DTS_INS | D_DTS_PRVIN(prevpipe) | pipe;
0937 *(cmd++) = DBRI_CMD(D_DTS, 0, val);
0938 *(cmd++) =
0939 D_TS_LEN(length) | D_TS_CYCLE(cycle) | D_TS_NEXT(nextpipe);
0940 *(cmd++) = 0;
0941 }
0942 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
0943
0944 dbri_cmdsend(dbri, cmd, 4);
0945 }
0946
0947 #if 0
0948
0949
0950
0951 static void unlink_time_slot(struct snd_dbri *dbri, int pipe,
0952 enum in_or_out direction, int prevpipe,
0953 int nextpipe)
0954 {
0955 s32 *cmd;
0956 int val;
0957
0958 if (pipe < 0 || pipe > DBRI_MAX_PIPE
0959 || prevpipe < 0 || prevpipe > DBRI_MAX_PIPE
0960 || nextpipe < 0 || nextpipe > DBRI_MAX_PIPE) {
0961 printk(KERN_ERR
0962 "DBRI: unlink_time_slot called with illegal pipe number\n");
0963 return;
0964 }
0965
0966 cmd = dbri_cmdlock(dbri, 4);
0967
0968 if (direction == PIPEinput) {
0969 val = D_DTS_VI | D_DTS_DEL | D_DTS_PRVIN(prevpipe) | pipe;
0970 *(cmd++) = DBRI_CMD(D_DTS, 0, val);
0971 *(cmd++) = D_TS_NEXT(nextpipe);
0972 *(cmd++) = 0;
0973 } else {
0974 val = D_DTS_VO | D_DTS_DEL | D_DTS_PRVOUT(prevpipe) | pipe;
0975 *(cmd++) = DBRI_CMD(D_DTS, 0, val);
0976 *(cmd++) = 0;
0977 *(cmd++) = D_TS_NEXT(nextpipe);
0978 }
0979 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
0980
0981 dbri_cmdsend(dbri, cmd, 4);
0982 }
0983 #endif
0984
0985
0986
0987
0988
0989
0990
0991
0992
0993
0994
0995
0996
0997
0998
0999
1000
1001 static void xmit_fixed(struct snd_dbri *dbri, int pipe, unsigned int data)
1002 {
1003 s32 *cmd;
1004 unsigned long flags;
1005
1006 if (pipe < 16 || pipe > DBRI_MAX_PIPE) {
1007 printk(KERN_ERR "DBRI: xmit_fixed: Illegal pipe number\n");
1008 return;
1009 }
1010
1011 if (D_SDP_MODE(dbri->pipes[pipe].sdp) == 0) {
1012 printk(KERN_ERR "DBRI: xmit_fixed: "
1013 "Uninitialized pipe %d\n", pipe);
1014 return;
1015 }
1016
1017 if (D_SDP_MODE(dbri->pipes[pipe].sdp) != D_SDP_FIXED) {
1018 printk(KERN_ERR "DBRI: xmit_fixed: Non-fixed pipe %d\n", pipe);
1019 return;
1020 }
1021
1022 if (!(dbri->pipes[pipe].sdp & D_SDP_TO_SER)) {
1023 printk(KERN_ERR "DBRI: xmit_fixed: Called on receive pipe %d\n",
1024 pipe);
1025 return;
1026 }
1027
1028
1029
1030 if (dbri->pipes[pipe].sdp & D_SDP_MSB)
1031 data = reverse_bytes(data, dbri->pipes[pipe].length);
1032
1033 cmd = dbri_cmdlock(dbri, 3);
1034
1035 *(cmd++) = DBRI_CMD(D_SSP, 0, pipe);
1036 *(cmd++) = data;
1037 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
1038
1039 spin_lock_irqsave(&dbri->lock, flags);
1040 dbri_cmdsend(dbri, cmd, 3);
1041 spin_unlock_irqrestore(&dbri->lock, flags);
1042 dbri_cmdwait(dbri);
1043
1044 }
1045
1046 static void recv_fixed(struct snd_dbri *dbri, int pipe, volatile __u32 *ptr)
1047 {
1048 if (pipe < 16 || pipe > DBRI_MAX_PIPE) {
1049 printk(KERN_ERR "DBRI: recv_fixed called with "
1050 "illegal pipe number\n");
1051 return;
1052 }
1053
1054 if (D_SDP_MODE(dbri->pipes[pipe].sdp) != D_SDP_FIXED) {
1055 printk(KERN_ERR "DBRI: recv_fixed called on "
1056 "non-fixed pipe %d\n", pipe);
1057 return;
1058 }
1059
1060 if (dbri->pipes[pipe].sdp & D_SDP_TO_SER) {
1061 printk(KERN_ERR "DBRI: recv_fixed called on "
1062 "transmit pipe %d\n", pipe);
1063 return;
1064 }
1065
1066 dbri->pipes[pipe].recv_fixed_ptr = ptr;
1067 }
1068
1069
1070
1071
1072
1073
1074
1075
1076
1077
1078
1079
1080
1081
1082
1083
1084
1085 static int setup_descs(struct snd_dbri *dbri, int streamno, unsigned int period)
1086 {
1087 struct dbri_streaminfo *info = &dbri->stream_info[streamno];
1088 u32 dvma_addr = (u32)dbri->dma_dvma;
1089 __u32 dvma_buffer;
1090 int desc;
1091 int len;
1092 int first_desc = -1;
1093 int last_desc = -1;
1094
1095 if (info->pipe < 0 || info->pipe > 15) {
1096 printk(KERN_ERR "DBRI: setup_descs: Illegal pipe number\n");
1097 return -2;
1098 }
1099
1100 if (dbri->pipes[info->pipe].sdp == 0) {
1101 printk(KERN_ERR "DBRI: setup_descs: Uninitialized pipe %d\n",
1102 info->pipe);
1103 return -2;
1104 }
1105
1106 dvma_buffer = info->dvma_buffer;
1107 len = info->size;
1108
1109 if (streamno == DBRI_PLAY) {
1110 if (!(dbri->pipes[info->pipe].sdp & D_SDP_TO_SER)) {
1111 printk(KERN_ERR "DBRI: setup_descs: "
1112 "Called on receive pipe %d\n", info->pipe);
1113 return -2;
1114 }
1115 } else {
1116 if (dbri->pipes[info->pipe].sdp & D_SDP_TO_SER) {
1117 printk(KERN_ERR
1118 "DBRI: setup_descs: Called on transmit pipe %d\n",
1119 info->pipe);
1120 return -2;
1121 }
1122
1123
1124
1125 if (pipe_active(dbri, info->pipe)) {
1126 printk(KERN_ERR "DBRI: recv_on_pipe: "
1127 "Called on active pipe %d\n", info->pipe);
1128 return -2;
1129 }
1130
1131
1132 len &= ~3;
1133 }
1134
1135
1136 desc = dbri->pipes[info->pipe].first_desc;
1137 if (desc >= 0)
1138 do {
1139 dbri->dma->desc[desc].ba = 0;
1140 dbri->dma->desc[desc].nda = 0;
1141 desc = dbri->next_desc[desc];
1142 } while (desc != -1 &&
1143 desc != dbri->pipes[info->pipe].first_desc);
1144
1145 dbri->pipes[info->pipe].desc = -1;
1146 dbri->pipes[info->pipe].first_desc = -1;
1147
1148 desc = 0;
1149 while (len > 0) {
1150 int mylen;
1151
1152 for (; desc < DBRI_NO_DESCS; desc++) {
1153 if (!dbri->dma->desc[desc].ba)
1154 break;
1155 }
1156
1157 if (desc == DBRI_NO_DESCS) {
1158 printk(KERN_ERR "DBRI: setup_descs: No descriptors\n");
1159 return -1;
1160 }
1161
1162 if (len > DBRI_TD_MAXCNT)
1163 mylen = DBRI_TD_MAXCNT;
1164 else
1165 mylen = len;
1166
1167 if (mylen > period)
1168 mylen = period;
1169
1170 dbri->next_desc[desc] = -1;
1171 dbri->dma->desc[desc].ba = dvma_buffer;
1172 dbri->dma->desc[desc].nda = 0;
1173
1174 if (streamno == DBRI_PLAY) {
1175 dbri->dma->desc[desc].word1 = DBRI_TD_CNT(mylen);
1176 dbri->dma->desc[desc].word4 = 0;
1177 dbri->dma->desc[desc].word1 |= DBRI_TD_F | DBRI_TD_B;
1178 } else {
1179 dbri->dma->desc[desc].word1 = 0;
1180 dbri->dma->desc[desc].word4 =
1181 DBRI_RD_B | DBRI_RD_BCNT(mylen);
1182 }
1183
1184 if (first_desc == -1)
1185 first_desc = desc;
1186 else {
1187 dbri->next_desc[last_desc] = desc;
1188 dbri->dma->desc[last_desc].nda =
1189 dvma_addr + dbri_dma_off(desc, desc);
1190 }
1191
1192 last_desc = desc;
1193 dvma_buffer += mylen;
1194 len -= mylen;
1195 }
1196
1197 if (first_desc == -1 || last_desc == -1) {
1198 printk(KERN_ERR "DBRI: setup_descs: "
1199 " Not enough descriptors available\n");
1200 return -1;
1201 }
1202
1203 dbri->dma->desc[last_desc].nda =
1204 dvma_addr + dbri_dma_off(desc, first_desc);
1205 dbri->next_desc[last_desc] = first_desc;
1206 dbri->pipes[info->pipe].first_desc = first_desc;
1207 dbri->pipes[info->pipe].desc = first_desc;
1208
1209 #ifdef DBRI_DEBUG
1210 for (desc = first_desc; desc != -1;) {
1211 dprintk(D_DESC, "DESC %d: %08x %08x %08x %08x\n",
1212 desc,
1213 dbri->dma->desc[desc].word1,
1214 dbri->dma->desc[desc].ba,
1215 dbri->dma->desc[desc].nda, dbri->dma->desc[desc].word4);
1216 desc = dbri->next_desc[desc];
1217 if (desc == first_desc)
1218 break;
1219 }
1220 #endif
1221 return 0;
1222 }
1223
1224
1225
1226
1227
1228
1229
1230
1231
1232
1233
1234
1235 enum master_or_slave { CHImaster, CHIslave };
1236
1237
1238
1239
1240 static void reset_chi(struct snd_dbri *dbri,
1241 enum master_or_slave master_or_slave,
1242 int bits_per_frame)
1243 {
1244 s32 *cmd;
1245 int val;
1246
1247
1248
1249 cmd = dbri_cmdlock(dbri, 4);
1250 val = D_DTS_VO | D_DTS_VI | D_DTS_INS
1251 | D_DTS_PRVIN(16) | D_PIPE(16) | D_DTS_PRVOUT(16);
1252 *(cmd++) = DBRI_CMD(D_DTS, 0, val);
1253 *(cmd++) = D_TS_ANCHOR | D_TS_NEXT(16);
1254 *(cmd++) = D_TS_ANCHOR | D_TS_NEXT(16);
1255 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
1256 dbri_cmdsend(dbri, cmd, 4);
1257
1258 dbri->pipes[16].sdp = 1;
1259 dbri->pipes[16].nextpipe = 16;
1260
1261 cmd = dbri_cmdlock(dbri, 4);
1262
1263 if (master_or_slave == CHIslave) {
1264
1265
1266
1267
1268
1269
1270 *(cmd++) = DBRI_CMD(D_CHI, 0, D_CHI_CHICM(0));
1271 } else {
1272
1273
1274
1275
1276
1277
1278 int clockrate = bits_per_frame * 8;
1279 int divisor = 12288 / clockrate;
1280
1281 if (divisor > 255 || divisor * clockrate != 12288)
1282 printk(KERN_ERR "DBRI: illegal bits_per_frame "
1283 "in setup_chi\n");
1284
1285 *(cmd++) = DBRI_CMD(D_CHI, 0, D_CHI_CHICM(divisor) | D_CHI_FD
1286 | D_CHI_BPF(bits_per_frame));
1287 }
1288
1289 dbri->chi_bpf = bits_per_frame;
1290
1291
1292
1293
1294
1295
1296
1297
1298
1299 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
1300 *(cmd++) = DBRI_CMD(D_CDM, 0, D_CDM_XCE | D_CDM_XEN | D_CDM_REN);
1301 *(cmd++) = DBRI_CMD(D_PAUSE, 0, 0);
1302
1303 dbri_cmdsend(dbri, cmd, 4);
1304 }
1305
1306
1307
1308
1309
1310
1311
1312
1313
1314
1315
1316
1317 static void cs4215_setup_pipes(struct snd_dbri *dbri)
1318 {
1319 unsigned long flags;
1320
1321 spin_lock_irqsave(&dbri->lock, flags);
1322
1323
1324
1325
1326
1327
1328
1329
1330
1331
1332
1333
1334
1335
1336
1337 setup_pipe(dbri, 4, D_SDP_MEM | D_SDP_TO_SER | D_SDP_MSB);
1338 setup_pipe(dbri, 20, D_SDP_FIXED | D_SDP_TO_SER | D_SDP_MSB);
1339 setup_pipe(dbri, 6, D_SDP_MEM | D_SDP_FROM_SER | D_SDP_MSB);
1340 setup_pipe(dbri, 21, D_SDP_FIXED | D_SDP_FROM_SER | D_SDP_MSB);
1341
1342 setup_pipe(dbri, 17, D_SDP_FIXED | D_SDP_TO_SER | D_SDP_MSB);
1343 setup_pipe(dbri, 18, D_SDP_FIXED | D_SDP_FROM_SER | D_SDP_MSB);
1344 setup_pipe(dbri, 19, D_SDP_FIXED | D_SDP_FROM_SER | D_SDP_MSB);
1345 spin_unlock_irqrestore(&dbri->lock, flags);
1346
1347 dbri_cmdwait(dbri);
1348 }
1349
1350 static int cs4215_init_data(struct cs4215 *mm)
1351 {
1352
1353
1354
1355
1356
1357
1358
1359 mm->data[0] = CS4215_LO(0x20) | CS4215_HE | CS4215_LE;
1360 mm->data[1] = CS4215_RO(0x20) | CS4215_SE;
1361 mm->data[2] = CS4215_LG(0x8) | CS4215_IS | CS4215_PIO0 | CS4215_PIO1;
1362 mm->data[3] = CS4215_RG(0x8) | CS4215_MA(0xf);
1363
1364
1365
1366
1367
1368
1369
1370
1371 mm->ctrl[0] = CS4215_RSRVD_1 | CS4215_MLB;
1372 mm->ctrl[1] = CS4215_DFR_ULAW | CS4215_FREQ[0].csval;
1373 mm->ctrl[2] = CS4215_XCLK | CS4215_BSEL_128 | CS4215_FREQ[0].xtal;
1374 mm->ctrl[3] = 0;
1375
1376 mm->status = 0;
1377 mm->version = 0xff;
1378 mm->precision = 8;
1379 mm->channels = 1;
1380
1381 return 0;
1382 }
1383
1384 static void cs4215_setdata(struct snd_dbri *dbri, int muted)
1385 {
1386 if (muted) {
1387 dbri->mm.data[0] |= 63;
1388 dbri->mm.data[1] |= 63;
1389 dbri->mm.data[2] &= ~15;
1390 dbri->mm.data[3] &= ~15;
1391 } else {
1392
1393 struct dbri_streaminfo *info = &dbri->stream_info[DBRI_PLAY];
1394 int left_gain = info->left_gain & 0x3f;
1395 int right_gain = info->right_gain & 0x3f;
1396
1397 dbri->mm.data[0] &= ~0x3f;
1398 dbri->mm.data[1] &= ~0x3f;
1399 dbri->mm.data[0] |= (DBRI_MAX_VOLUME - left_gain);
1400 dbri->mm.data[1] |= (DBRI_MAX_VOLUME - right_gain);
1401
1402
1403 info = &dbri->stream_info[DBRI_REC];
1404 left_gain = info->left_gain & 0xf;
1405 right_gain = info->right_gain & 0xf;
1406 dbri->mm.data[2] |= CS4215_LG(left_gain);
1407 dbri->mm.data[3] |= CS4215_RG(right_gain);
1408 }
1409
1410 xmit_fixed(dbri, 20, *(int *)dbri->mm.data);
1411 }
1412
1413
1414
1415
1416 static void cs4215_open(struct snd_dbri *dbri)
1417 {
1418 int data_width;
1419 u32 tmp;
1420 unsigned long flags;
1421
1422 dprintk(D_MM, "cs4215_open: %d channels, %d bits\n",
1423 dbri->mm.channels, dbri->mm.precision);
1424
1425
1426
1427
1428
1429 cs4215_setdata(dbri, 1);
1430 udelay(125);
1431
1432
1433
1434
1435
1436
1437
1438
1439
1440
1441
1442
1443
1444
1445 spin_lock_irqsave(&dbri->lock, flags);
1446 tmp = sbus_readl(dbri->regs + REG0);
1447 tmp &= ~(D_C);
1448 sbus_writel(tmp, dbri->regs + REG0);
1449
1450
1451 sbus_writel(D_ENPIO | D_PIO1 | D_PIO3 |
1452 (dbri->mm.onboard ? D_PIO0 : D_PIO2), dbri->regs + REG2);
1453
1454 reset_chi(dbri, CHIslave, 128);
1455
1456
1457
1458
1459
1460
1461
1462 data_width = dbri->mm.channels * dbri->mm.precision;
1463
1464 link_time_slot(dbri, 4, 16, 16, data_width, dbri->mm.offset);
1465 link_time_slot(dbri, 20, 4, 16, 32, dbri->mm.offset + 32);
1466 link_time_slot(dbri, 6, 16, 16, data_width, dbri->mm.offset);
1467 link_time_slot(dbri, 21, 6, 16, 16, dbri->mm.offset + 40);
1468
1469
1470 tmp = sbus_readl(dbri->regs + REG0);
1471 tmp |= D_C;
1472 sbus_writel(tmp, dbri->regs + REG0);
1473 spin_unlock_irqrestore(&dbri->lock, flags);
1474
1475 cs4215_setdata(dbri, 0);
1476 }
1477
1478
1479
1480
1481 static int cs4215_setctrl(struct snd_dbri *dbri)
1482 {
1483 int i, val;
1484 u32 tmp;
1485 unsigned long flags;
1486
1487
1488
1489
1490
1491
1492 cs4215_setdata(dbri, 1);
1493 udelay(125);
1494
1495
1496
1497
1498
1499 val = D_ENPIO | D_PIO1 | (dbri->mm.onboard ? D_PIO0 : D_PIO2);
1500 sbus_writel(val, dbri->regs + REG2);
1501 dprintk(D_MM, "cs4215_setctrl: reg2=0x%x\n", val);
1502 udelay(34);
1503
1504
1505
1506
1507
1508
1509
1510
1511
1512
1513
1514
1515
1516
1517
1518
1519
1520
1521
1522 spin_lock_irqsave(&dbri->lock, flags);
1523 tmp = sbus_readl(dbri->regs + REG0);
1524 tmp &= ~D_C;
1525 sbus_writel(tmp, dbri->regs + REG0);
1526
1527 reset_chi(dbri, CHImaster, 128);
1528
1529
1530
1531
1532
1533
1534
1535
1536 link_time_slot(dbri, 17, 16, 16, 32, dbri->mm.offset);
1537 link_time_slot(dbri, 18, 16, 16, 8, dbri->mm.offset);
1538 link_time_slot(dbri, 19, 18, 16, 8, dbri->mm.offset + 48);
1539 spin_unlock_irqrestore(&dbri->lock, flags);
1540
1541
1542 dbri->mm.ctrl[0] &= ~CS4215_CLB;
1543 xmit_fixed(dbri, 17, *(int *)dbri->mm.ctrl);
1544
1545 spin_lock_irqsave(&dbri->lock, flags);
1546 tmp = sbus_readl(dbri->regs + REG0);
1547 tmp |= D_C;
1548 sbus_writel(tmp, dbri->regs + REG0);
1549 spin_unlock_irqrestore(&dbri->lock, flags);
1550
1551 for (i = 10; ((dbri->mm.status & 0xe4) != 0x20); --i)
1552 msleep_interruptible(1);
1553
1554 if (i == 0) {
1555 dprintk(D_MM, "CS4215 didn't respond to CLB (0x%02x)\n",
1556 dbri->mm.status);
1557 return -1;
1558 }
1559
1560
1561
1562
1563 recv_fixed(dbri, 19, NULL);
1564
1565
1566
1567
1568 dbri->mm.ctrl[0] |= CS4215_CLB;
1569 xmit_fixed(dbri, 17, *(int *)dbri->mm.ctrl);
1570
1571
1572 udelay(250);
1573
1574 cs4215_setdata(dbri, 0);
1575
1576 return 0;
1577 }
1578
1579
1580
1581
1582
1583
1584
1585 static int cs4215_prepare(struct snd_dbri *dbri, unsigned int rate,
1586 snd_pcm_format_t format, unsigned int channels)
1587 {
1588 int freq_idx;
1589 int ret = 0;
1590
1591
1592 for (freq_idx = 0; CS4215_FREQ[freq_idx].freq != 0; freq_idx++) {
1593 if (CS4215_FREQ[freq_idx].freq == rate)
1594 break;
1595 }
1596 if (CS4215_FREQ[freq_idx].freq != rate) {
1597 printk(KERN_WARNING "DBRI: Unsupported rate %d Hz\n", rate);
1598 return -1;
1599 }
1600
1601 switch (format) {
1602 case SNDRV_PCM_FORMAT_MU_LAW:
1603 dbri->mm.ctrl[1] = CS4215_DFR_ULAW;
1604 dbri->mm.precision = 8;
1605 break;
1606 case SNDRV_PCM_FORMAT_A_LAW:
1607 dbri->mm.ctrl[1] = CS4215_DFR_ALAW;
1608 dbri->mm.precision = 8;
1609 break;
1610 case SNDRV_PCM_FORMAT_U8:
1611 dbri->mm.ctrl[1] = CS4215_DFR_LINEAR8;
1612 dbri->mm.precision = 8;
1613 break;
1614 case SNDRV_PCM_FORMAT_S16_BE:
1615 dbri->mm.ctrl[1] = CS4215_DFR_LINEAR16;
1616 dbri->mm.precision = 16;
1617 break;
1618 default:
1619 printk(KERN_WARNING "DBRI: Unsupported format %d\n", format);
1620 return -1;
1621 }
1622
1623
1624 dbri->mm.ctrl[1] |= CS4215_FREQ[freq_idx].csval;
1625 dbri->mm.ctrl[2] = CS4215_XCLK |
1626 CS4215_BSEL_128 | CS4215_FREQ[freq_idx].xtal;
1627
1628 dbri->mm.channels = channels;
1629 if (channels == 2)
1630 dbri->mm.ctrl[1] |= CS4215_DFR_STEREO;
1631
1632 ret = cs4215_setctrl(dbri);
1633 if (ret == 0)
1634 cs4215_open(dbri);
1635
1636 return ret;
1637 }
1638
1639
1640
1641
1642 static int cs4215_init(struct snd_dbri *dbri)
1643 {
1644 u32 reg2 = sbus_readl(dbri->regs + REG2);
1645 dprintk(D_MM, "cs4215_init: reg2=0x%x\n", reg2);
1646
1647
1648 if (reg2 & D_PIO2) {
1649 dprintk(D_MM, "Onboard CS4215 detected\n");
1650 dbri->mm.onboard = 1;
1651 }
1652 if (reg2 & D_PIO0) {
1653 dprintk(D_MM, "Speakerbox detected\n");
1654 dbri->mm.onboard = 0;
1655
1656 if (reg2 & D_PIO2) {
1657 printk(KERN_INFO "DBRI: Using speakerbox / "
1658 "ignoring onboard mmcodec.\n");
1659 sbus_writel(D_ENPIO2, dbri->regs + REG2);
1660 }
1661 }
1662
1663 if (!(reg2 & (D_PIO0 | D_PIO2))) {
1664 printk(KERN_ERR "DBRI: no mmcodec found.\n");
1665 return -EIO;
1666 }
1667
1668 cs4215_setup_pipes(dbri);
1669 cs4215_init_data(&dbri->mm);
1670
1671
1672 recv_fixed(dbri, 18, &dbri->mm.status);
1673 recv_fixed(dbri, 19, &dbri->mm.version);
1674
1675 dbri->mm.offset = dbri->mm.onboard ? 0 : 8;
1676 if (cs4215_setctrl(dbri) == -1 || dbri->mm.version == 0xff) {
1677 dprintk(D_MM, "CS4215 failed probe at offset %d\n",
1678 dbri->mm.offset);
1679 return -EIO;
1680 }
1681 dprintk(D_MM, "Found CS4215 at offset %d\n", dbri->mm.offset);
1682
1683 return 0;
1684 }
1685
1686
1687
1688
1689
1690
1691
1692
1693
1694
1695
1696
1697
1698
1699
1700
1701
1702
1703
1704
1705
1706 static void xmit_descs(struct snd_dbri *dbri)
1707 {
1708 struct dbri_streaminfo *info;
1709 u32 dvma_addr;
1710 s32 *cmd;
1711 unsigned long flags;
1712 int first_td;
1713
1714 if (dbri == NULL)
1715 return;
1716
1717 dvma_addr = (u32)dbri->dma_dvma;
1718 info = &dbri->stream_info[DBRI_REC];
1719 spin_lock_irqsave(&dbri->lock, flags);
1720
1721 if (info->pipe >= 0) {
1722 first_td = dbri->pipes[info->pipe].first_desc;
1723
1724 dprintk(D_DESC, "xmit_descs rec @ TD %d\n", first_td);
1725
1726
1727 if (first_td >= 0) {
1728 cmd = dbri_cmdlock(dbri, 2);
1729 *(cmd++) = DBRI_CMD(D_SDP, 0,
1730 dbri->pipes[info->pipe].sdp
1731 | D_SDP_P | D_SDP_EVERY | D_SDP_C);
1732 *(cmd++) = dvma_addr +
1733 dbri_dma_off(desc, first_td);
1734 dbri_cmdsend(dbri, cmd, 2);
1735
1736
1737 dbri->pipes[info->pipe].desc = first_td;
1738 }
1739 }
1740
1741 info = &dbri->stream_info[DBRI_PLAY];
1742
1743 if (info->pipe >= 0) {
1744 first_td = dbri->pipes[info->pipe].first_desc;
1745
1746 dprintk(D_DESC, "xmit_descs play @ TD %d\n", first_td);
1747
1748
1749 if (first_td >= 0) {
1750 cmd = dbri_cmdlock(dbri, 2);
1751 *(cmd++) = DBRI_CMD(D_SDP, 0,
1752 dbri->pipes[info->pipe].sdp
1753 | D_SDP_P | D_SDP_EVERY | D_SDP_C);
1754 *(cmd++) = dvma_addr +
1755 dbri_dma_off(desc, first_td);
1756 dbri_cmdsend(dbri, cmd, 2);
1757
1758
1759 dbri->pipes[info->pipe].desc = first_td;
1760 }
1761 }
1762
1763 spin_unlock_irqrestore(&dbri->lock, flags);
1764 }
1765
1766
1767
1768
1769
1770
1771
1772
1773
1774
1775
1776
1777
1778
1779
1780 static void transmission_complete_intr(struct snd_dbri *dbri, int pipe)
1781 {
1782 struct dbri_streaminfo *info = &dbri->stream_info[DBRI_PLAY];
1783 int td = dbri->pipes[pipe].desc;
1784 int status;
1785
1786 while (td >= 0) {
1787 if (td >= DBRI_NO_DESCS) {
1788 printk(KERN_ERR "DBRI: invalid td on pipe %d\n", pipe);
1789 return;
1790 }
1791
1792 status = DBRI_TD_STATUS(dbri->dma->desc[td].word4);
1793 if (!(status & DBRI_TD_TBC))
1794 break;
1795
1796 dprintk(D_INT, "TD %d, status 0x%02x\n", td, status);
1797
1798 dbri->dma->desc[td].word4 = 0;
1799 info->offset += DBRI_RD_CNT(dbri->dma->desc[td].word1);
1800
1801 td = dbri->next_desc[td];
1802 dbri->pipes[pipe].desc = td;
1803 }
1804
1805
1806 spin_unlock(&dbri->lock);
1807 snd_pcm_period_elapsed(info->substream);
1808 spin_lock(&dbri->lock);
1809 }
1810
1811 static void reception_complete_intr(struct snd_dbri *dbri, int pipe)
1812 {
1813 struct dbri_streaminfo *info;
1814 int rd = dbri->pipes[pipe].desc;
1815 s32 status;
1816
1817 if (rd < 0 || rd >= DBRI_NO_DESCS) {
1818 printk(KERN_ERR "DBRI: invalid rd on pipe %d\n", pipe);
1819 return;
1820 }
1821
1822 dbri->pipes[pipe].desc = dbri->next_desc[rd];
1823 status = dbri->dma->desc[rd].word1;
1824 dbri->dma->desc[rd].word1 = 0;
1825
1826 info = &dbri->stream_info[DBRI_REC];
1827 info->offset += DBRI_RD_CNT(status);
1828
1829
1830
1831 dprintk(D_INT, "Recv RD %d, status 0x%02x, len %d\n",
1832 rd, DBRI_RD_STATUS(status), DBRI_RD_CNT(status));
1833
1834
1835 spin_unlock(&dbri->lock);
1836 snd_pcm_period_elapsed(info->substream);
1837 spin_lock(&dbri->lock);
1838 }
1839
1840 static void dbri_process_one_interrupt(struct snd_dbri *dbri, int x)
1841 {
1842 int val = D_INTR_GETVAL(x);
1843 int channel = D_INTR_GETCHAN(x);
1844 int command = D_INTR_GETCMD(x);
1845 int code = D_INTR_GETCODE(x);
1846 #ifdef DBRI_DEBUG
1847 int rval = D_INTR_GETRVAL(x);
1848 #endif
1849
1850 if (channel == D_INTR_CMD) {
1851 dprintk(D_CMD, "INTR: Command: %-5s Value:%d\n",
1852 cmds[command], val);
1853 } else {
1854 dprintk(D_INT, "INTR: Chan:%d Code:%d Val:%#x\n",
1855 channel, code, rval);
1856 }
1857
1858 switch (code) {
1859 case D_INTR_CMDI:
1860 if (command != D_WAIT)
1861 printk(KERN_ERR "DBRI: Command read interrupt\n");
1862 break;
1863 case D_INTR_BRDY:
1864 reception_complete_intr(dbri, channel);
1865 break;
1866 case D_INTR_XCMP:
1867 case D_INTR_MINT:
1868 transmission_complete_intr(dbri, channel);
1869 break;
1870 case D_INTR_UNDR:
1871
1872
1873
1874 {
1875
1876 printk(KERN_ERR "DBRI: Underrun error\n");
1877 #if 0
1878 s32 *cmd;
1879 int pipe = channel;
1880 int td = dbri->pipes[pipe].desc;
1881
1882 dbri->dma->desc[td].word4 = 0;
1883 cmd = dbri_cmdlock(dbri, NoGetLock);
1884 *(cmd++) = DBRI_CMD(D_SDP, 0,
1885 dbri->pipes[pipe].sdp
1886 | D_SDP_P | D_SDP_C | D_SDP_2SAME);
1887 *(cmd++) = dbri->dma_dvma + dbri_dma_off(desc, td);
1888 dbri_cmdsend(dbri, cmd);
1889 #endif
1890 }
1891 break;
1892 case D_INTR_FXDT:
1893
1894 if (dbri->pipes[channel].sdp & D_SDP_MSB)
1895 val = reverse_bytes(val, dbri->pipes[channel].length);
1896
1897 if (dbri->pipes[channel].recv_fixed_ptr)
1898 *(dbri->pipes[channel].recv_fixed_ptr) = val;
1899 break;
1900 default:
1901 if (channel != D_INTR_CMD)
1902 printk(KERN_WARNING
1903 "DBRI: Ignored Interrupt: %d (0x%x)\n", code, x);
1904 }
1905 }
1906
1907
1908
1909
1910
1911
1912 static void dbri_process_interrupt_buffer(struct snd_dbri *dbri)
1913 {
1914 s32 x;
1915
1916 while ((x = dbri->dma->intr[dbri->dbri_irqp]) != 0) {
1917 dbri->dma->intr[dbri->dbri_irqp] = 0;
1918 dbri->dbri_irqp++;
1919 if (dbri->dbri_irqp == DBRI_INT_BLK)
1920 dbri->dbri_irqp = 1;
1921
1922 dbri_process_one_interrupt(dbri, x);
1923 }
1924 }
1925
1926 static irqreturn_t snd_dbri_interrupt(int irq, void *dev_id)
1927 {
1928 struct snd_dbri *dbri = dev_id;
1929 static int errcnt;
1930 int x;
1931
1932 if (dbri == NULL)
1933 return IRQ_NONE;
1934 spin_lock(&dbri->lock);
1935
1936
1937
1938
1939 x = sbus_readl(dbri->regs + REG1);
1940
1941 if (x & (D_MRR | D_MLE | D_LBG | D_MBE)) {
1942 u32 tmp;
1943
1944 if (x & D_MRR)
1945 printk(KERN_ERR
1946 "DBRI: Multiple Error Ack on SBus reg1=0x%x\n",
1947 x);
1948 if (x & D_MLE)
1949 printk(KERN_ERR
1950 "DBRI: Multiple Late Error on SBus reg1=0x%x\n",
1951 x);
1952 if (x & D_LBG)
1953 printk(KERN_ERR
1954 "DBRI: Lost Bus Grant on SBus reg1=0x%x\n", x);
1955 if (x & D_MBE)
1956 printk(KERN_ERR
1957 "DBRI: Burst Error on SBus reg1=0x%x\n", x);
1958
1959
1960
1961
1962
1963
1964
1965
1966
1967 if ((++errcnt) % 10 == 0) {
1968 dprintk(D_INT, "Interrupt errors exceeded.\n");
1969 dbri_reset(dbri);
1970 } else {
1971 tmp = sbus_readl(dbri->regs + REG0);
1972 tmp &= ~(D_D);
1973 sbus_writel(tmp, dbri->regs + REG0);
1974 }
1975 }
1976
1977 dbri_process_interrupt_buffer(dbri);
1978
1979 spin_unlock(&dbri->lock);
1980
1981 return IRQ_HANDLED;
1982 }
1983
1984
1985
1986
1987 static const struct snd_pcm_hardware snd_dbri_pcm_hw = {
1988 .info = SNDRV_PCM_INFO_MMAP |
1989 SNDRV_PCM_INFO_INTERLEAVED |
1990 SNDRV_PCM_INFO_BLOCK_TRANSFER |
1991 SNDRV_PCM_INFO_MMAP_VALID |
1992 SNDRV_PCM_INFO_BATCH,
1993 .formats = SNDRV_PCM_FMTBIT_MU_LAW |
1994 SNDRV_PCM_FMTBIT_A_LAW |
1995 SNDRV_PCM_FMTBIT_U8 |
1996 SNDRV_PCM_FMTBIT_S16_BE,
1997 .rates = SNDRV_PCM_RATE_8000_48000 | SNDRV_PCM_RATE_5512,
1998 .rate_min = 5512,
1999 .rate_max = 48000,
2000 .channels_min = 1,
2001 .channels_max = 2,
2002 .buffer_bytes_max = 64 * 1024,
2003 .period_bytes_min = 1,
2004 .period_bytes_max = DBRI_TD_MAXCNT,
2005 .periods_min = 1,
2006 .periods_max = 1024,
2007 };
2008
2009 static int snd_hw_rule_format(struct snd_pcm_hw_params *params,
2010 struct snd_pcm_hw_rule *rule)
2011 {
2012 struct snd_interval *c = hw_param_interval(params,
2013 SNDRV_PCM_HW_PARAM_CHANNELS);
2014 struct snd_mask *f = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT);
2015 struct snd_mask fmt;
2016
2017 snd_mask_any(&fmt);
2018 if (c->min > 1) {
2019 fmt.bits[0] &= SNDRV_PCM_FMTBIT_S16_BE;
2020 return snd_mask_refine(f, &fmt);
2021 }
2022 return 0;
2023 }
2024
2025 static int snd_hw_rule_channels(struct snd_pcm_hw_params *params,
2026 struct snd_pcm_hw_rule *rule)
2027 {
2028 struct snd_interval *c = hw_param_interval(params,
2029 SNDRV_PCM_HW_PARAM_CHANNELS);
2030 struct snd_mask *f = hw_param_mask(params, SNDRV_PCM_HW_PARAM_FORMAT);
2031 struct snd_interval ch;
2032
2033 snd_interval_any(&ch);
2034 if (!(f->bits[0] & SNDRV_PCM_FMTBIT_S16_BE)) {
2035 ch.min = 1;
2036 ch.max = 1;
2037 ch.integer = 1;
2038 return snd_interval_refine(c, &ch);
2039 }
2040 return 0;
2041 }
2042
2043 static int snd_dbri_open(struct snd_pcm_substream *substream)
2044 {
2045 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2046 struct snd_pcm_runtime *runtime = substream->runtime;
2047 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2048 unsigned long flags;
2049
2050 dprintk(D_USR, "open audio output.\n");
2051 runtime->hw = snd_dbri_pcm_hw;
2052
2053 spin_lock_irqsave(&dbri->lock, flags);
2054 info->substream = substream;
2055 info->offset = 0;
2056 info->dvma_buffer = 0;
2057 info->pipe = -1;
2058 spin_unlock_irqrestore(&dbri->lock, flags);
2059
2060 snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_CHANNELS,
2061 snd_hw_rule_format, NULL, SNDRV_PCM_HW_PARAM_FORMAT,
2062 -1);
2063 snd_pcm_hw_rule_add(runtime, 0, SNDRV_PCM_HW_PARAM_FORMAT,
2064 snd_hw_rule_channels, NULL,
2065 SNDRV_PCM_HW_PARAM_CHANNELS,
2066 -1);
2067
2068 cs4215_open(dbri);
2069
2070 return 0;
2071 }
2072
2073 static int snd_dbri_close(struct snd_pcm_substream *substream)
2074 {
2075 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2076 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2077
2078 dprintk(D_USR, "close audio output.\n");
2079 info->substream = NULL;
2080 info->offset = 0;
2081
2082 return 0;
2083 }
2084
2085 static int snd_dbri_hw_params(struct snd_pcm_substream *substream,
2086 struct snd_pcm_hw_params *hw_params)
2087 {
2088 struct snd_pcm_runtime *runtime = substream->runtime;
2089 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2090 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2091 int direction;
2092 int ret;
2093
2094
2095 ret = cs4215_prepare(dbri, params_rate(hw_params),
2096 params_format(hw_params),
2097 params_channels(hw_params));
2098 if (ret != 0)
2099 return ret;
2100
2101
2102
2103 if (info->dvma_buffer == 0) {
2104 if (DBRI_STREAMNO(substream) == DBRI_PLAY)
2105 direction = DMA_TO_DEVICE;
2106 else
2107 direction = DMA_FROM_DEVICE;
2108
2109 info->dvma_buffer =
2110 dma_map_single(&dbri->op->dev,
2111 runtime->dma_area,
2112 params_buffer_bytes(hw_params),
2113 direction);
2114 }
2115
2116 direction = params_buffer_bytes(hw_params);
2117 dprintk(D_USR, "hw_params: %d bytes, dvma=%x\n",
2118 direction, info->dvma_buffer);
2119 return 0;
2120 }
2121
2122 static int snd_dbri_hw_free(struct snd_pcm_substream *substream)
2123 {
2124 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2125 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2126 int direction;
2127
2128 dprintk(D_USR, "hw_free.\n");
2129
2130
2131
2132 if (info->dvma_buffer) {
2133 if (DBRI_STREAMNO(substream) == DBRI_PLAY)
2134 direction = DMA_TO_DEVICE;
2135 else
2136 direction = DMA_FROM_DEVICE;
2137
2138 dma_unmap_single(&dbri->op->dev, info->dvma_buffer,
2139 substream->runtime->buffer_size, direction);
2140 info->dvma_buffer = 0;
2141 }
2142 if (info->pipe != -1) {
2143 reset_pipe(dbri, info->pipe);
2144 info->pipe = -1;
2145 }
2146
2147 return 0;
2148 }
2149
2150 static int snd_dbri_prepare(struct snd_pcm_substream *substream)
2151 {
2152 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2153 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2154 int ret;
2155
2156 info->size = snd_pcm_lib_buffer_bytes(substream);
2157 if (DBRI_STREAMNO(substream) == DBRI_PLAY)
2158 info->pipe = 4;
2159 else
2160 info->pipe = 6;
2161
2162 spin_lock_irq(&dbri->lock);
2163 info->offset = 0;
2164
2165
2166
2167
2168 ret = setup_descs(dbri, DBRI_STREAMNO(substream),
2169 snd_pcm_lib_period_bytes(substream));
2170
2171 spin_unlock_irq(&dbri->lock);
2172
2173 dprintk(D_USR, "prepare audio output. %d bytes\n", info->size);
2174 return ret;
2175 }
2176
2177 static int snd_dbri_trigger(struct snd_pcm_substream *substream, int cmd)
2178 {
2179 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2180 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2181 int ret = 0;
2182
2183 switch (cmd) {
2184 case SNDRV_PCM_TRIGGER_START:
2185 dprintk(D_USR, "start audio, period is %d bytes\n",
2186 (int)snd_pcm_lib_period_bytes(substream));
2187
2188 xmit_descs(dbri);
2189 break;
2190 case SNDRV_PCM_TRIGGER_STOP:
2191 dprintk(D_USR, "stop audio.\n");
2192 reset_pipe(dbri, info->pipe);
2193 break;
2194 default:
2195 ret = -EINVAL;
2196 }
2197
2198 return ret;
2199 }
2200
2201 static snd_pcm_uframes_t snd_dbri_pointer(struct snd_pcm_substream *substream)
2202 {
2203 struct snd_dbri *dbri = snd_pcm_substream_chip(substream);
2204 struct dbri_streaminfo *info = DBRI_STREAM(dbri, substream);
2205 snd_pcm_uframes_t ret;
2206
2207 ret = bytes_to_frames(substream->runtime, info->offset)
2208 % substream->runtime->buffer_size;
2209 dprintk(D_USR, "I/O pointer: %ld frames of %ld.\n",
2210 ret, substream->runtime->buffer_size);
2211 return ret;
2212 }
2213
2214 static const struct snd_pcm_ops snd_dbri_ops = {
2215 .open = snd_dbri_open,
2216 .close = snd_dbri_close,
2217 .hw_params = snd_dbri_hw_params,
2218 .hw_free = snd_dbri_hw_free,
2219 .prepare = snd_dbri_prepare,
2220 .trigger = snd_dbri_trigger,
2221 .pointer = snd_dbri_pointer,
2222 };
2223
2224 static int snd_dbri_pcm(struct snd_card *card)
2225 {
2226 struct snd_pcm *pcm;
2227 int err;
2228
2229 err = snd_pcm_new(card,
2230 "sun_dbri",
2231 0,
2232 1,
2233 1, &pcm);
2234 if (err < 0)
2235 return err;
2236
2237 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_dbri_ops);
2238 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_dbri_ops);
2239
2240 pcm->private_data = card->private_data;
2241 pcm->info_flags = 0;
2242 strcpy(pcm->name, card->shortname);
2243
2244 snd_pcm_set_managed_buffer_all(pcm, SNDRV_DMA_TYPE_CONTINUOUS,
2245 NULL, 64 * 1024, 64 * 1024);
2246 return 0;
2247 }
2248
2249
2250
2251
2252
2253 static int snd_cs4215_info_volume(struct snd_kcontrol *kcontrol,
2254 struct snd_ctl_elem_info *uinfo)
2255 {
2256 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
2257 uinfo->count = 2;
2258 uinfo->value.integer.min = 0;
2259 if (kcontrol->private_value == DBRI_PLAY)
2260 uinfo->value.integer.max = DBRI_MAX_VOLUME;
2261 else
2262 uinfo->value.integer.max = DBRI_MAX_GAIN;
2263 return 0;
2264 }
2265
2266 static int snd_cs4215_get_volume(struct snd_kcontrol *kcontrol,
2267 struct snd_ctl_elem_value *ucontrol)
2268 {
2269 struct snd_dbri *dbri = snd_kcontrol_chip(kcontrol);
2270 struct dbri_streaminfo *info;
2271
2272 if (snd_BUG_ON(!dbri))
2273 return -EINVAL;
2274 info = &dbri->stream_info[kcontrol->private_value];
2275
2276 ucontrol->value.integer.value[0] = info->left_gain;
2277 ucontrol->value.integer.value[1] = info->right_gain;
2278 return 0;
2279 }
2280
2281 static int snd_cs4215_put_volume(struct snd_kcontrol *kcontrol,
2282 struct snd_ctl_elem_value *ucontrol)
2283 {
2284 struct snd_dbri *dbri = snd_kcontrol_chip(kcontrol);
2285 struct dbri_streaminfo *info =
2286 &dbri->stream_info[kcontrol->private_value];
2287 unsigned int vol[2];
2288 int changed = 0;
2289
2290 vol[0] = ucontrol->value.integer.value[0];
2291 vol[1] = ucontrol->value.integer.value[1];
2292 if (kcontrol->private_value == DBRI_PLAY) {
2293 if (vol[0] > DBRI_MAX_VOLUME || vol[1] > DBRI_MAX_VOLUME)
2294 return -EINVAL;
2295 } else {
2296 if (vol[0] > DBRI_MAX_GAIN || vol[1] > DBRI_MAX_GAIN)
2297 return -EINVAL;
2298 }
2299
2300 if (info->left_gain != vol[0]) {
2301 info->left_gain = vol[0];
2302 changed = 1;
2303 }
2304 if (info->right_gain != vol[1]) {
2305 info->right_gain = vol[1];
2306 changed = 1;
2307 }
2308 if (changed) {
2309
2310
2311
2312 cs4215_setdata(dbri, 1);
2313 udelay(125);
2314 cs4215_setdata(dbri, 0);
2315 }
2316 return changed;
2317 }
2318
2319 static int snd_cs4215_info_single(struct snd_kcontrol *kcontrol,
2320 struct snd_ctl_elem_info *uinfo)
2321 {
2322 int mask = (kcontrol->private_value >> 16) & 0xff;
2323
2324 uinfo->type = (mask == 1) ?
2325 SNDRV_CTL_ELEM_TYPE_BOOLEAN : SNDRV_CTL_ELEM_TYPE_INTEGER;
2326 uinfo->count = 1;
2327 uinfo->value.integer.min = 0;
2328 uinfo->value.integer.max = mask;
2329 return 0;
2330 }
2331
2332 static int snd_cs4215_get_single(struct snd_kcontrol *kcontrol,
2333 struct snd_ctl_elem_value *ucontrol)
2334 {
2335 struct snd_dbri *dbri = snd_kcontrol_chip(kcontrol);
2336 int elem = kcontrol->private_value & 0xff;
2337 int shift = (kcontrol->private_value >> 8) & 0xff;
2338 int mask = (kcontrol->private_value >> 16) & 0xff;
2339 int invert = (kcontrol->private_value >> 24) & 1;
2340
2341 if (snd_BUG_ON(!dbri))
2342 return -EINVAL;
2343
2344 if (elem < 4)
2345 ucontrol->value.integer.value[0] =
2346 (dbri->mm.data[elem] >> shift) & mask;
2347 else
2348 ucontrol->value.integer.value[0] =
2349 (dbri->mm.ctrl[elem - 4] >> shift) & mask;
2350
2351 if (invert == 1)
2352 ucontrol->value.integer.value[0] =
2353 mask - ucontrol->value.integer.value[0];
2354 return 0;
2355 }
2356
2357 static int snd_cs4215_put_single(struct snd_kcontrol *kcontrol,
2358 struct snd_ctl_elem_value *ucontrol)
2359 {
2360 struct snd_dbri *dbri = snd_kcontrol_chip(kcontrol);
2361 int elem = kcontrol->private_value & 0xff;
2362 int shift = (kcontrol->private_value >> 8) & 0xff;
2363 int mask = (kcontrol->private_value >> 16) & 0xff;
2364 int invert = (kcontrol->private_value >> 24) & 1;
2365 int changed = 0;
2366 unsigned short val;
2367
2368 if (snd_BUG_ON(!dbri))
2369 return -EINVAL;
2370
2371 val = (ucontrol->value.integer.value[0] & mask);
2372 if (invert == 1)
2373 val = mask - val;
2374 val <<= shift;
2375
2376 if (elem < 4) {
2377 dbri->mm.data[elem] = (dbri->mm.data[elem] &
2378 ~(mask << shift)) | val;
2379 changed = (val != dbri->mm.data[elem]);
2380 } else {
2381 dbri->mm.ctrl[elem - 4] = (dbri->mm.ctrl[elem - 4] &
2382 ~(mask << shift)) | val;
2383 changed = (val != dbri->mm.ctrl[elem - 4]);
2384 }
2385
2386 dprintk(D_GEN, "put_single: mask=0x%x, changed=%d, "
2387 "mixer-value=%ld, mm-value=0x%x\n",
2388 mask, changed, ucontrol->value.integer.value[0],
2389 dbri->mm.data[elem & 3]);
2390
2391 if (changed) {
2392
2393
2394
2395 cs4215_setdata(dbri, 1);
2396 udelay(125);
2397 cs4215_setdata(dbri, 0);
2398 }
2399 return changed;
2400 }
2401
2402
2403
2404
2405
2406 #define CS4215_SINGLE(xname, entry, shift, mask, invert) \
2407 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname), \
2408 .info = snd_cs4215_info_single, \
2409 .get = snd_cs4215_get_single, .put = snd_cs4215_put_single, \
2410 .private_value = (entry) | ((shift) << 8) | ((mask) << 16) | \
2411 ((invert) << 24) },
2412
2413 static const struct snd_kcontrol_new dbri_controls[] = {
2414 {
2415 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2416 .name = "Playback Volume",
2417 .info = snd_cs4215_info_volume,
2418 .get = snd_cs4215_get_volume,
2419 .put = snd_cs4215_put_volume,
2420 .private_value = DBRI_PLAY,
2421 },
2422 CS4215_SINGLE("Headphone switch", 0, 7, 1, 0)
2423 CS4215_SINGLE("Line out switch", 0, 6, 1, 0)
2424 CS4215_SINGLE("Speaker switch", 1, 6, 1, 0)
2425 {
2426 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
2427 .name = "Capture Volume",
2428 .info = snd_cs4215_info_volume,
2429 .get = snd_cs4215_get_volume,
2430 .put = snd_cs4215_put_volume,
2431 .private_value = DBRI_REC,
2432 },
2433
2434 CS4215_SINGLE("Line in switch", 2, 4, 1, 0)
2435 CS4215_SINGLE("High Pass Filter switch", 5, 7, 1, 0)
2436 CS4215_SINGLE("Monitor Volume", 3, 4, 0xf, 1)
2437 CS4215_SINGLE("Mic boost", 4, 4, 1, 1)
2438 };
2439
2440 static int snd_dbri_mixer(struct snd_card *card)
2441 {
2442 int idx, err;
2443 struct snd_dbri *dbri;
2444
2445 if (snd_BUG_ON(!card || !card->private_data))
2446 return -EINVAL;
2447 dbri = card->private_data;
2448
2449 strcpy(card->mixername, card->shortname);
2450
2451 for (idx = 0; idx < ARRAY_SIZE(dbri_controls); idx++) {
2452 err = snd_ctl_add(card,
2453 snd_ctl_new1(&dbri_controls[idx], dbri));
2454 if (err < 0)
2455 return err;
2456 }
2457
2458 for (idx = DBRI_REC; idx < DBRI_NO_STREAMS; idx++) {
2459 dbri->stream_info[idx].left_gain = 0;
2460 dbri->stream_info[idx].right_gain = 0;
2461 }
2462
2463 return 0;
2464 }
2465
2466
2467
2468
2469 static void dbri_regs_read(struct snd_info_entry *entry,
2470 struct snd_info_buffer *buffer)
2471 {
2472 struct snd_dbri *dbri = entry->private_data;
2473
2474 snd_iprintf(buffer, "REG0: 0x%x\n", sbus_readl(dbri->regs + REG0));
2475 snd_iprintf(buffer, "REG2: 0x%x\n", sbus_readl(dbri->regs + REG2));
2476 snd_iprintf(buffer, "REG8: 0x%x\n", sbus_readl(dbri->regs + REG8));
2477 snd_iprintf(buffer, "REG9: 0x%x\n", sbus_readl(dbri->regs + REG9));
2478 }
2479
2480 #ifdef DBRI_DEBUG
2481 static void dbri_debug_read(struct snd_info_entry *entry,
2482 struct snd_info_buffer *buffer)
2483 {
2484 struct snd_dbri *dbri = entry->private_data;
2485 int pipe;
2486 snd_iprintf(buffer, "debug=%d\n", dbri_debug);
2487
2488 for (pipe = 0; pipe < 32; pipe++) {
2489 if (pipe_active(dbri, pipe)) {
2490 struct dbri_pipe *pptr = &dbri->pipes[pipe];
2491 snd_iprintf(buffer,
2492 "Pipe %d: %s SDP=0x%x desc=%d, "
2493 "len=%d next %d\n",
2494 pipe,
2495 (pptr->sdp & D_SDP_TO_SER) ? "output" :
2496 "input",
2497 pptr->sdp, pptr->desc,
2498 pptr->length, pptr->nextpipe);
2499 }
2500 }
2501 }
2502 #endif
2503
2504 static void snd_dbri_proc(struct snd_card *card)
2505 {
2506 struct snd_dbri *dbri = card->private_data;
2507
2508 snd_card_ro_proc_new(card, "regs", dbri, dbri_regs_read);
2509 #ifdef DBRI_DEBUG
2510 snd_card_ro_proc_new(card, "debug", dbri, dbri_debug_read);
2511 #endif
2512 }
2513
2514
2515
2516
2517
2518
2519 static void snd_dbri_free(struct snd_dbri *dbri);
2520
2521 static int snd_dbri_create(struct snd_card *card,
2522 struct platform_device *op,
2523 int irq, int dev)
2524 {
2525 struct snd_dbri *dbri = card->private_data;
2526 int err;
2527
2528 spin_lock_init(&dbri->lock);
2529 dbri->op = op;
2530 dbri->irq = irq;
2531
2532 dbri->dma = dma_alloc_coherent(&op->dev, sizeof(struct dbri_dma),
2533 &dbri->dma_dvma, GFP_KERNEL);
2534 if (!dbri->dma)
2535 return -ENOMEM;
2536
2537 dprintk(D_GEN, "DMA Cmd Block 0x%p (%pad)\n",
2538 dbri->dma, dbri->dma_dvma);
2539
2540
2541 dbri->regs_size = resource_size(&op->resource[0]);
2542 dbri->regs = of_ioremap(&op->resource[0], 0,
2543 dbri->regs_size, "DBRI Registers");
2544 if (!dbri->regs) {
2545 printk(KERN_ERR "DBRI: could not allocate registers\n");
2546 dma_free_coherent(&op->dev, sizeof(struct dbri_dma),
2547 (void *)dbri->dma, dbri->dma_dvma);
2548 return -EIO;
2549 }
2550
2551 err = request_irq(dbri->irq, snd_dbri_interrupt, IRQF_SHARED,
2552 "DBRI audio", dbri);
2553 if (err) {
2554 printk(KERN_ERR "DBRI: Can't get irq %d\n", dbri->irq);
2555 of_iounmap(&op->resource[0], dbri->regs, dbri->regs_size);
2556 dma_free_coherent(&op->dev, sizeof(struct dbri_dma),
2557 (void *)dbri->dma, dbri->dma_dvma);
2558 return err;
2559 }
2560
2561
2562 dbri_initialize(dbri);
2563 err = cs4215_init(dbri);
2564 if (err) {
2565 snd_dbri_free(dbri);
2566 return err;
2567 }
2568
2569 return 0;
2570 }
2571
2572 static void snd_dbri_free(struct snd_dbri *dbri)
2573 {
2574 dprintk(D_GEN, "snd_dbri_free\n");
2575 dbri_reset(dbri);
2576
2577 if (dbri->irq)
2578 free_irq(dbri->irq, dbri);
2579
2580 if (dbri->regs)
2581 of_iounmap(&dbri->op->resource[0], dbri->regs, dbri->regs_size);
2582
2583 if (dbri->dma)
2584 dma_free_coherent(&dbri->op->dev,
2585 sizeof(struct dbri_dma),
2586 (void *)dbri->dma, dbri->dma_dvma);
2587 }
2588
2589 static int dbri_probe(struct platform_device *op)
2590 {
2591 struct snd_dbri *dbri;
2592 struct resource *rp;
2593 struct snd_card *card;
2594 static int dev;
2595 int irq;
2596 int err;
2597
2598 if (dev >= SNDRV_CARDS)
2599 return -ENODEV;
2600 if (!enable[dev]) {
2601 dev++;
2602 return -ENOENT;
2603 }
2604
2605 irq = op->archdata.irqs[0];
2606 if (irq <= 0) {
2607 printk(KERN_ERR "DBRI-%d: No IRQ.\n", dev);
2608 return -ENODEV;
2609 }
2610
2611 err = snd_card_new(&op->dev, index[dev], id[dev], THIS_MODULE,
2612 sizeof(struct snd_dbri), &card);
2613 if (err < 0)
2614 return err;
2615
2616 strcpy(card->driver, "DBRI");
2617 strcpy(card->shortname, "Sun DBRI");
2618 rp = &op->resource[0];
2619 sprintf(card->longname, "%s at 0x%02lx:0x%016Lx, irq %d",
2620 card->shortname,
2621 rp->flags & 0xffL, (unsigned long long)rp->start, irq);
2622
2623 err = snd_dbri_create(card, op, irq, dev);
2624 if (err < 0) {
2625 snd_card_free(card);
2626 return err;
2627 }
2628
2629 dbri = card->private_data;
2630 err = snd_dbri_pcm(card);
2631 if (err < 0)
2632 goto _err;
2633
2634 err = snd_dbri_mixer(card);
2635 if (err < 0)
2636 goto _err;
2637
2638
2639 snd_dbri_proc(card);
2640 dev_set_drvdata(&op->dev, card);
2641
2642 err = snd_card_register(card);
2643 if (err < 0)
2644 goto _err;
2645
2646 printk(KERN_INFO "audio%d at %p (irq %d) is DBRI(%c)+CS4215(%d)\n",
2647 dev, dbri->regs,
2648 dbri->irq, op->dev.of_node->name[9], dbri->mm.version);
2649 dev++;
2650
2651 return 0;
2652
2653 _err:
2654 snd_dbri_free(dbri);
2655 snd_card_free(card);
2656 return err;
2657 }
2658
2659 static int dbri_remove(struct platform_device *op)
2660 {
2661 struct snd_card *card = dev_get_drvdata(&op->dev);
2662
2663 snd_dbri_free(card->private_data);
2664 snd_card_free(card);
2665
2666 return 0;
2667 }
2668
2669 static const struct of_device_id dbri_match[] = {
2670 {
2671 .name = "SUNW,DBRIe",
2672 },
2673 {
2674 .name = "SUNW,DBRIf",
2675 },
2676 {},
2677 };
2678
2679 MODULE_DEVICE_TABLE(of, dbri_match);
2680
2681 static struct platform_driver dbri_sbus_driver = {
2682 .driver = {
2683 .name = "dbri",
2684 .of_match_table = dbri_match,
2685 },
2686 .probe = dbri_probe,
2687 .remove = dbri_remove,
2688 };
2689
2690 module_platform_driver(dbri_sbus_driver);