ath9k: Fix bug in validating received data length for edma
[linux-2.6/next.git] / sound / sparc / cs4231.c
blob7dcc06512e8684c60c738f6eb7fe9eeeff499070
1 /*
2 * Driver for CS4231 sound chips found on Sparcs.
3 * Copyright (C) 2002, 2008 David S. Miller <davem@davemloft.net>
5 * Based entirely upon drivers/sbus/audio/cs4231.c which is:
6 * Copyright (C) 1996, 1997, 1998 Derrick J Brashear (shadow@andrew.cmu.edu)
7 * and also sound/isa/cs423x/cs4231_lib.c which is:
8 * Copyright (c) by Jaroslav Kysela <perex@perex.cz>
9 */
11 #include <linux/module.h>
12 #include <linux/kernel.h>
13 #include <linux/delay.h>
14 #include <linux/init.h>
15 #include <linux/interrupt.h>
16 #include <linux/moduleparam.h>
17 #include <linux/irq.h>
18 #include <linux/io.h>
19 #include <linux/of.h>
20 #include <linux/of_device.h>
22 #include <sound/core.h>
23 #include <sound/pcm.h>
24 #include <sound/info.h>
25 #include <sound/control.h>
26 #include <sound/timer.h>
27 #include <sound/initval.h>
28 #include <sound/pcm_params.h>
30 #ifdef CONFIG_SBUS
31 #define SBUS_SUPPORT
32 #endif
34 #if defined(CONFIG_PCI) && defined(CONFIG_SPARC64)
35 #define EBUS_SUPPORT
36 #include <linux/pci.h>
37 #include <asm/ebus_dma.h>
38 #endif
40 static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX; /* Index 0-MAX */
41 static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR; /* ID for this card */
42 /* Enable this card */
43 static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
45 module_param_array(index, int, NULL, 0444);
46 MODULE_PARM_DESC(index, "Index value for Sun CS4231 soundcard.");
47 module_param_array(id, charp, NULL, 0444);
48 MODULE_PARM_DESC(id, "ID string for Sun CS4231 soundcard.");
49 module_param_array(enable, bool, NULL, 0444);
50 MODULE_PARM_DESC(enable, "Enable Sun CS4231 soundcard.");
51 MODULE_AUTHOR("Jaroslav Kysela, Derrick J. Brashear and David S. Miller");
52 MODULE_DESCRIPTION("Sun CS4231");
53 MODULE_LICENSE("GPL");
54 MODULE_SUPPORTED_DEVICE("{{Sun,CS4231}}");
56 #ifdef SBUS_SUPPORT
57 struct sbus_dma_info {
58 spinlock_t lock; /* DMA access lock */
59 int dir;
60 void __iomem *regs;
62 #endif
64 struct snd_cs4231;
65 struct cs4231_dma_control {
66 void (*prepare)(struct cs4231_dma_control *dma_cont,
67 int dir);
68 void (*enable)(struct cs4231_dma_control *dma_cont, int on);
69 int (*request)(struct cs4231_dma_control *dma_cont,
70 dma_addr_t bus_addr, size_t len);
71 unsigned int (*address)(struct cs4231_dma_control *dma_cont);
72 #ifdef EBUS_SUPPORT
73 struct ebus_dma_info ebus_info;
74 #endif
75 #ifdef SBUS_SUPPORT
76 struct sbus_dma_info sbus_info;
77 #endif
80 struct snd_cs4231 {
81 spinlock_t lock; /* registers access lock */
82 void __iomem *port;
84 struct cs4231_dma_control p_dma;
85 struct cs4231_dma_control c_dma;
87 u32 flags;
88 #define CS4231_FLAG_EBUS 0x00000001
89 #define CS4231_FLAG_PLAYBACK 0x00000002
90 #define CS4231_FLAG_CAPTURE 0x00000004
92 struct snd_card *card;
93 struct snd_pcm *pcm;
94 struct snd_pcm_substream *playback_substream;
95 unsigned int p_periods_sent;
96 struct snd_pcm_substream *capture_substream;
97 unsigned int c_periods_sent;
98 struct snd_timer *timer;
100 unsigned short mode;
101 #define CS4231_MODE_NONE 0x0000
102 #define CS4231_MODE_PLAY 0x0001
103 #define CS4231_MODE_RECORD 0x0002
104 #define CS4231_MODE_TIMER 0x0004
105 #define CS4231_MODE_OPEN (CS4231_MODE_PLAY | CS4231_MODE_RECORD | \
106 CS4231_MODE_TIMER)
108 unsigned char image[32]; /* registers image */
109 int mce_bit;
110 int calibrate_mute;
111 struct mutex mce_mutex; /* mutex for mce register */
112 struct mutex open_mutex; /* mutex for ALSA open/close */
114 struct of_device *op;
115 unsigned int irq[2];
116 unsigned int regs_size;
117 struct snd_cs4231 *next;
120 /* Eventually we can use sound/isa/cs423x/cs4231_lib.c directly, but for
121 * now.... -DaveM
124 /* IO ports */
125 #include <sound/cs4231-regs.h>
127 /* XXX offsets are different than PC ISA chips... */
128 #define CS4231U(chip, x) ((chip)->port + ((c_d_c_CS4231##x) << 2))
130 /* SBUS DMA register defines. */
132 #define APCCSR 0x10UL /* APC DMA CSR */
133 #define APCCVA 0x20UL /* APC Capture DMA Address */
134 #define APCCC 0x24UL /* APC Capture Count */
135 #define APCCNVA 0x28UL /* APC Capture DMA Next Address */
136 #define APCCNC 0x2cUL /* APC Capture Next Count */
137 #define APCPVA 0x30UL /* APC Play DMA Address */
138 #define APCPC 0x34UL /* APC Play Count */
139 #define APCPNVA 0x38UL /* APC Play DMA Next Address */
140 #define APCPNC 0x3cUL /* APC Play Next Count */
142 /* Defines for SBUS DMA-routines */
144 #define APCVA 0x0UL /* APC DMA Address */
145 #define APCC 0x4UL /* APC Count */
146 #define APCNVA 0x8UL /* APC DMA Next Address */
147 #define APCNC 0xcUL /* APC Next Count */
148 #define APC_PLAY 0x30UL /* Play registers start at 0x30 */
149 #define APC_RECORD 0x20UL /* Record registers start at 0x20 */
151 /* APCCSR bits */
153 #define APC_INT_PENDING 0x800000 /* Interrupt Pending */
154 #define APC_PLAY_INT 0x400000 /* Playback interrupt */
155 #define APC_CAPT_INT 0x200000 /* Capture interrupt */
156 #define APC_GENL_INT 0x100000 /* General interrupt */
157 #define APC_XINT_ENA 0x80000 /* General ext int. enable */
158 #define APC_XINT_PLAY 0x40000 /* Playback ext intr */
159 #define APC_XINT_CAPT 0x20000 /* Capture ext intr */
160 #define APC_XINT_GENL 0x10000 /* Error ext intr */
161 #define APC_XINT_EMPT 0x8000 /* Pipe empty interrupt (0 write to pva) */
162 #define APC_XINT_PEMP 0x4000 /* Play pipe empty (pva and pnva not set) */
163 #define APC_XINT_PNVA 0x2000 /* Playback NVA dirty */
164 #define APC_XINT_PENA 0x1000 /* play pipe empty Int enable */
165 #define APC_XINT_COVF 0x800 /* Cap data dropped on floor */
166 #define APC_XINT_CNVA 0x400 /* Capture NVA dirty */
167 #define APC_XINT_CEMP 0x200 /* Capture pipe empty (cva and cnva not set) */
168 #define APC_XINT_CENA 0x100 /* Cap. pipe empty int enable */
169 #define APC_PPAUSE 0x80 /* Pause the play DMA */
170 #define APC_CPAUSE 0x40 /* Pause the capture DMA */
171 #define APC_CDC_RESET 0x20 /* CODEC RESET */
172 #define APC_PDMA_READY 0x08 /* Play DMA Go */
173 #define APC_CDMA_READY 0x04 /* Capture DMA Go */
174 #define APC_CHIP_RESET 0x01 /* Reset the chip */
176 /* EBUS DMA register offsets */
178 #define EBDMA_CSR 0x00UL /* Control/Status */
179 #define EBDMA_ADDR 0x04UL /* DMA Address */
180 #define EBDMA_COUNT 0x08UL /* DMA Count */
183 * Some variables
186 static unsigned char freq_bits[14] = {
187 /* 5510 */ 0x00 | CS4231_XTAL2,
188 /* 6620 */ 0x0E | CS4231_XTAL2,
189 /* 8000 */ 0x00 | CS4231_XTAL1,
190 /* 9600 */ 0x0E | CS4231_XTAL1,
191 /* 11025 */ 0x02 | CS4231_XTAL2,
192 /* 16000 */ 0x02 | CS4231_XTAL1,
193 /* 18900 */ 0x04 | CS4231_XTAL2,
194 /* 22050 */ 0x06 | CS4231_XTAL2,
195 /* 27042 */ 0x04 | CS4231_XTAL1,
196 /* 32000 */ 0x06 | CS4231_XTAL1,
197 /* 33075 */ 0x0C | CS4231_XTAL2,
198 /* 37800 */ 0x08 | CS4231_XTAL2,
199 /* 44100 */ 0x0A | CS4231_XTAL2,
200 /* 48000 */ 0x0C | CS4231_XTAL1
203 static unsigned int rates[14] = {
204 5510, 6620, 8000, 9600, 11025, 16000, 18900, 22050,
205 27042, 32000, 33075, 37800, 44100, 48000
208 static struct snd_pcm_hw_constraint_list hw_constraints_rates = {
209 .count = ARRAY_SIZE(rates),
210 .list = rates,
213 static int snd_cs4231_xrate(struct snd_pcm_runtime *runtime)
215 return snd_pcm_hw_constraint_list(runtime, 0,
216 SNDRV_PCM_HW_PARAM_RATE,
217 &hw_constraints_rates);
220 static unsigned char snd_cs4231_original_image[32] =
222 0x00, /* 00/00 - lic */
223 0x00, /* 01/01 - ric */
224 0x9f, /* 02/02 - la1ic */
225 0x9f, /* 03/03 - ra1ic */
226 0x9f, /* 04/04 - la2ic */
227 0x9f, /* 05/05 - ra2ic */
228 0xbf, /* 06/06 - loc */
229 0xbf, /* 07/07 - roc */
230 0x20, /* 08/08 - pdfr */
231 CS4231_AUTOCALIB, /* 09/09 - ic */
232 0x00, /* 0a/10 - pc */
233 0x00, /* 0b/11 - ti */
234 CS4231_MODE2, /* 0c/12 - mi */
235 0x00, /* 0d/13 - lbc */
236 0x00, /* 0e/14 - pbru */
237 0x00, /* 0f/15 - pbrl */
238 0x80, /* 10/16 - afei */
239 0x01, /* 11/17 - afeii */
240 0x9f, /* 12/18 - llic */
241 0x9f, /* 13/19 - rlic */
242 0x00, /* 14/20 - tlb */
243 0x00, /* 15/21 - thb */
244 0x00, /* 16/22 - la3mic/reserved */
245 0x00, /* 17/23 - ra3mic/reserved */
246 0x00, /* 18/24 - afs */
247 0x00, /* 19/25 - lamoc/version */
248 0x00, /* 1a/26 - mioc */
249 0x00, /* 1b/27 - ramoc/reserved */
250 0x20, /* 1c/28 - cdfr */
251 0x00, /* 1d/29 - res4 */
252 0x00, /* 1e/30 - cbru */
253 0x00, /* 1f/31 - cbrl */
256 static u8 __cs4231_readb(struct snd_cs4231 *cp, void __iomem *reg_addr)
258 if (cp->flags & CS4231_FLAG_EBUS)
259 return readb(reg_addr);
260 else
261 return sbus_readb(reg_addr);
264 static void __cs4231_writeb(struct snd_cs4231 *cp, u8 val,
265 void __iomem *reg_addr)
267 if (cp->flags & CS4231_FLAG_EBUS)
268 return writeb(val, reg_addr);
269 else
270 return sbus_writeb(val, reg_addr);
274 * Basic I/O functions
277 static void snd_cs4231_ready(struct snd_cs4231 *chip)
279 int timeout;
281 for (timeout = 250; timeout > 0; timeout--) {
282 int val = __cs4231_readb(chip, CS4231U(chip, REGSEL));
283 if ((val & CS4231_INIT) == 0)
284 break;
285 udelay(100);
289 static void snd_cs4231_dout(struct snd_cs4231 *chip, unsigned char reg,
290 unsigned char value)
292 snd_cs4231_ready(chip);
293 #ifdef CONFIG_SND_DEBUG
294 if (__cs4231_readb(chip, CS4231U(chip, REGSEL)) & CS4231_INIT)
295 snd_printdd("out: auto calibration time out - reg = 0x%x, "
296 "value = 0x%x\n",
297 reg, value);
298 #endif
299 __cs4231_writeb(chip, chip->mce_bit | reg, CS4231U(chip, REGSEL));
300 wmb();
301 __cs4231_writeb(chip, value, CS4231U(chip, REG));
302 mb();
305 static inline void snd_cs4231_outm(struct snd_cs4231 *chip, unsigned char reg,
306 unsigned char mask, unsigned char value)
308 unsigned char tmp = (chip->image[reg] & mask) | value;
310 chip->image[reg] = tmp;
311 if (!chip->calibrate_mute)
312 snd_cs4231_dout(chip, reg, tmp);
315 static void snd_cs4231_out(struct snd_cs4231 *chip, unsigned char reg,
316 unsigned char value)
318 snd_cs4231_dout(chip, reg, value);
319 chip->image[reg] = value;
320 mb();
323 static unsigned char snd_cs4231_in(struct snd_cs4231 *chip, unsigned char reg)
325 snd_cs4231_ready(chip);
326 #ifdef CONFIG_SND_DEBUG
327 if (__cs4231_readb(chip, CS4231U(chip, REGSEL)) & CS4231_INIT)
328 snd_printdd("in: auto calibration time out - reg = 0x%x\n",
329 reg);
330 #endif
331 __cs4231_writeb(chip, chip->mce_bit | reg, CS4231U(chip, REGSEL));
332 mb();
333 return __cs4231_readb(chip, CS4231U(chip, REG));
337 * CS4231 detection / MCE routines
340 static void snd_cs4231_busy_wait(struct snd_cs4231 *chip)
342 int timeout;
344 /* looks like this sequence is proper for CS4231A chip (GUS MAX) */
345 for (timeout = 5; timeout > 0; timeout--)
346 __cs4231_readb(chip, CS4231U(chip, REGSEL));
348 /* end of cleanup sequence */
349 for (timeout = 500; timeout > 0; timeout--) {
350 int val = __cs4231_readb(chip, CS4231U(chip, REGSEL));
351 if ((val & CS4231_INIT) == 0)
352 break;
353 msleep(1);
357 static void snd_cs4231_mce_up(struct snd_cs4231 *chip)
359 unsigned long flags;
360 int timeout;
362 spin_lock_irqsave(&chip->lock, flags);
363 snd_cs4231_ready(chip);
364 #ifdef CONFIG_SND_DEBUG
365 if (__cs4231_readb(chip, CS4231U(chip, REGSEL)) & CS4231_INIT)
366 snd_printdd("mce_up - auto calibration time out (0)\n");
367 #endif
368 chip->mce_bit |= CS4231_MCE;
369 timeout = __cs4231_readb(chip, CS4231U(chip, REGSEL));
370 if (timeout == 0x80)
371 snd_printdd("mce_up [%p]: serious init problem - "
372 "codec still busy\n",
373 chip->port);
374 if (!(timeout & CS4231_MCE))
375 __cs4231_writeb(chip, chip->mce_bit | (timeout & 0x1f),
376 CS4231U(chip, REGSEL));
377 spin_unlock_irqrestore(&chip->lock, flags);
380 static void snd_cs4231_mce_down(struct snd_cs4231 *chip)
382 unsigned long flags, timeout;
383 int reg;
385 snd_cs4231_busy_wait(chip);
386 spin_lock_irqsave(&chip->lock, flags);
387 #ifdef CONFIG_SND_DEBUG
388 if (__cs4231_readb(chip, CS4231U(chip, REGSEL)) & CS4231_INIT)
389 snd_printdd("mce_down [%p] - auto calibration time out (0)\n",
390 CS4231U(chip, REGSEL));
391 #endif
392 chip->mce_bit &= ~CS4231_MCE;
393 reg = __cs4231_readb(chip, CS4231U(chip, REGSEL));
394 __cs4231_writeb(chip, chip->mce_bit | (reg & 0x1f),
395 CS4231U(chip, REGSEL));
396 if (reg == 0x80)
397 snd_printdd("mce_down [%p]: serious init problem "
398 "- codec still busy\n", chip->port);
399 if ((reg & CS4231_MCE) == 0) {
400 spin_unlock_irqrestore(&chip->lock, flags);
401 return;
405 * Wait for auto-calibration (AC) process to finish, i.e. ACI to go low.
407 timeout = jiffies + msecs_to_jiffies(250);
408 do {
409 spin_unlock_irqrestore(&chip->lock, flags);
410 msleep(1);
411 spin_lock_irqsave(&chip->lock, flags);
412 reg = snd_cs4231_in(chip, CS4231_TEST_INIT);
413 reg &= CS4231_CALIB_IN_PROGRESS;
414 } while (reg && time_before(jiffies, timeout));
415 spin_unlock_irqrestore(&chip->lock, flags);
417 if (reg)
418 snd_printk(KERN_ERR
419 "mce_down - auto calibration time out (2)\n");
422 static void snd_cs4231_advance_dma(struct cs4231_dma_control *dma_cont,
423 struct snd_pcm_substream *substream,
424 unsigned int *periods_sent)
426 struct snd_pcm_runtime *runtime = substream->runtime;
428 while (1) {
429 unsigned int period_size = snd_pcm_lib_period_bytes(substream);
430 unsigned int offset = period_size * (*periods_sent);
432 BUG_ON(period_size >= (1 << 24));
434 if (dma_cont->request(dma_cont,
435 runtime->dma_addr + offset, period_size))
436 return;
437 (*periods_sent) = ((*periods_sent) + 1) % runtime->periods;
441 static void cs4231_dma_trigger(struct snd_pcm_substream *substream,
442 unsigned int what, int on)
444 struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
445 struct cs4231_dma_control *dma_cont;
447 if (what & CS4231_PLAYBACK_ENABLE) {
448 dma_cont = &chip->p_dma;
449 if (on) {
450 dma_cont->prepare(dma_cont, 0);
451 dma_cont->enable(dma_cont, 1);
452 snd_cs4231_advance_dma(dma_cont,
453 chip->playback_substream,
454 &chip->p_periods_sent);
455 } else {
456 dma_cont->enable(dma_cont, 0);
459 if (what & CS4231_RECORD_ENABLE) {
460 dma_cont = &chip->c_dma;
461 if (on) {
462 dma_cont->prepare(dma_cont, 1);
463 dma_cont->enable(dma_cont, 1);
464 snd_cs4231_advance_dma(dma_cont,
465 chip->capture_substream,
466 &chip->c_periods_sent);
467 } else {
468 dma_cont->enable(dma_cont, 0);
473 static int snd_cs4231_trigger(struct snd_pcm_substream *substream, int cmd)
475 struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
476 int result = 0;
478 switch (cmd) {
479 case SNDRV_PCM_TRIGGER_START:
480 case SNDRV_PCM_TRIGGER_STOP:
482 unsigned int what = 0;
483 struct snd_pcm_substream *s;
484 unsigned long flags;
486 snd_pcm_group_for_each_entry(s, substream) {
487 if (s == chip->playback_substream) {
488 what |= CS4231_PLAYBACK_ENABLE;
489 snd_pcm_trigger_done(s, substream);
490 } else if (s == chip->capture_substream) {
491 what |= CS4231_RECORD_ENABLE;
492 snd_pcm_trigger_done(s, substream);
496 spin_lock_irqsave(&chip->lock, flags);
497 if (cmd == SNDRV_PCM_TRIGGER_START) {
498 cs4231_dma_trigger(substream, what, 1);
499 chip->image[CS4231_IFACE_CTRL] |= what;
500 } else {
501 cs4231_dma_trigger(substream, what, 0);
502 chip->image[CS4231_IFACE_CTRL] &= ~what;
504 snd_cs4231_out(chip, CS4231_IFACE_CTRL,
505 chip->image[CS4231_IFACE_CTRL]);
506 spin_unlock_irqrestore(&chip->lock, flags);
507 break;
509 default:
510 result = -EINVAL;
511 break;
514 return result;
518 * CODEC I/O
521 static unsigned char snd_cs4231_get_rate(unsigned int rate)
523 int i;
525 for (i = 0; i < 14; i++)
526 if (rate == rates[i])
527 return freq_bits[i];
529 return freq_bits[13];
532 static unsigned char snd_cs4231_get_format(struct snd_cs4231 *chip, int format,
533 int channels)
535 unsigned char rformat;
537 rformat = CS4231_LINEAR_8;
538 switch (format) {
539 case SNDRV_PCM_FORMAT_MU_LAW:
540 rformat = CS4231_ULAW_8;
541 break;
542 case SNDRV_PCM_FORMAT_A_LAW:
543 rformat = CS4231_ALAW_8;
544 break;
545 case SNDRV_PCM_FORMAT_S16_LE:
546 rformat = CS4231_LINEAR_16;
547 break;
548 case SNDRV_PCM_FORMAT_S16_BE:
549 rformat = CS4231_LINEAR_16_BIG;
550 break;
551 case SNDRV_PCM_FORMAT_IMA_ADPCM:
552 rformat = CS4231_ADPCM_16;
553 break;
555 if (channels > 1)
556 rformat |= CS4231_STEREO;
557 return rformat;
560 static void snd_cs4231_calibrate_mute(struct snd_cs4231 *chip, int mute)
562 unsigned long flags;
564 mute = mute ? 1 : 0;
565 spin_lock_irqsave(&chip->lock, flags);
566 if (chip->calibrate_mute == mute) {
567 spin_unlock_irqrestore(&chip->lock, flags);
568 return;
570 if (!mute) {
571 snd_cs4231_dout(chip, CS4231_LEFT_INPUT,
572 chip->image[CS4231_LEFT_INPUT]);
573 snd_cs4231_dout(chip, CS4231_RIGHT_INPUT,
574 chip->image[CS4231_RIGHT_INPUT]);
575 snd_cs4231_dout(chip, CS4231_LOOPBACK,
576 chip->image[CS4231_LOOPBACK]);
578 snd_cs4231_dout(chip, CS4231_AUX1_LEFT_INPUT,
579 mute ? 0x80 : chip->image[CS4231_AUX1_LEFT_INPUT]);
580 snd_cs4231_dout(chip, CS4231_AUX1_RIGHT_INPUT,
581 mute ? 0x80 : chip->image[CS4231_AUX1_RIGHT_INPUT]);
582 snd_cs4231_dout(chip, CS4231_AUX2_LEFT_INPUT,
583 mute ? 0x80 : chip->image[CS4231_AUX2_LEFT_INPUT]);
584 snd_cs4231_dout(chip, CS4231_AUX2_RIGHT_INPUT,
585 mute ? 0x80 : chip->image[CS4231_AUX2_RIGHT_INPUT]);
586 snd_cs4231_dout(chip, CS4231_LEFT_OUTPUT,
587 mute ? 0x80 : chip->image[CS4231_LEFT_OUTPUT]);
588 snd_cs4231_dout(chip, CS4231_RIGHT_OUTPUT,
589 mute ? 0x80 : chip->image[CS4231_RIGHT_OUTPUT]);
590 snd_cs4231_dout(chip, CS4231_LEFT_LINE_IN,
591 mute ? 0x80 : chip->image[CS4231_LEFT_LINE_IN]);
592 snd_cs4231_dout(chip, CS4231_RIGHT_LINE_IN,
593 mute ? 0x80 : chip->image[CS4231_RIGHT_LINE_IN]);
594 snd_cs4231_dout(chip, CS4231_MONO_CTRL,
595 mute ? 0xc0 : chip->image[CS4231_MONO_CTRL]);
596 chip->calibrate_mute = mute;
597 spin_unlock_irqrestore(&chip->lock, flags);
600 static void snd_cs4231_playback_format(struct snd_cs4231 *chip,
601 struct snd_pcm_hw_params *params,
602 unsigned char pdfr)
604 unsigned long flags;
606 mutex_lock(&chip->mce_mutex);
607 snd_cs4231_calibrate_mute(chip, 1);
609 snd_cs4231_mce_up(chip);
611 spin_lock_irqsave(&chip->lock, flags);
612 snd_cs4231_out(chip, CS4231_PLAYBK_FORMAT,
613 (chip->image[CS4231_IFACE_CTRL] & CS4231_RECORD_ENABLE) ?
614 (pdfr & 0xf0) | (chip->image[CS4231_REC_FORMAT] & 0x0f) :
615 pdfr);
616 spin_unlock_irqrestore(&chip->lock, flags);
618 snd_cs4231_mce_down(chip);
620 snd_cs4231_calibrate_mute(chip, 0);
621 mutex_unlock(&chip->mce_mutex);
624 static void snd_cs4231_capture_format(struct snd_cs4231 *chip,
625 struct snd_pcm_hw_params *params,
626 unsigned char cdfr)
628 unsigned long flags;
630 mutex_lock(&chip->mce_mutex);
631 snd_cs4231_calibrate_mute(chip, 1);
633 snd_cs4231_mce_up(chip);
635 spin_lock_irqsave(&chip->lock, flags);
636 if (!(chip->image[CS4231_IFACE_CTRL] & CS4231_PLAYBACK_ENABLE)) {
637 snd_cs4231_out(chip, CS4231_PLAYBK_FORMAT,
638 ((chip->image[CS4231_PLAYBK_FORMAT]) & 0xf0) |
639 (cdfr & 0x0f));
640 spin_unlock_irqrestore(&chip->lock, flags);
641 snd_cs4231_mce_down(chip);
642 snd_cs4231_mce_up(chip);
643 spin_lock_irqsave(&chip->lock, flags);
645 snd_cs4231_out(chip, CS4231_REC_FORMAT, cdfr);
646 spin_unlock_irqrestore(&chip->lock, flags);
648 snd_cs4231_mce_down(chip);
650 snd_cs4231_calibrate_mute(chip, 0);
651 mutex_unlock(&chip->mce_mutex);
655 * Timer interface
658 static unsigned long snd_cs4231_timer_resolution(struct snd_timer *timer)
660 struct snd_cs4231 *chip = snd_timer_chip(timer);
662 return chip->image[CS4231_PLAYBK_FORMAT] & 1 ? 9969 : 9920;
665 static int snd_cs4231_timer_start(struct snd_timer *timer)
667 unsigned long flags;
668 unsigned int ticks;
669 struct snd_cs4231 *chip = snd_timer_chip(timer);
671 spin_lock_irqsave(&chip->lock, flags);
672 ticks = timer->sticks;
673 if ((chip->image[CS4231_ALT_FEATURE_1] & CS4231_TIMER_ENABLE) == 0 ||
674 (unsigned char)(ticks >> 8) != chip->image[CS4231_TIMER_HIGH] ||
675 (unsigned char)ticks != chip->image[CS4231_TIMER_LOW]) {
676 snd_cs4231_out(chip, CS4231_TIMER_HIGH,
677 chip->image[CS4231_TIMER_HIGH] =
678 (unsigned char) (ticks >> 8));
679 snd_cs4231_out(chip, CS4231_TIMER_LOW,
680 chip->image[CS4231_TIMER_LOW] =
681 (unsigned char) ticks);
682 snd_cs4231_out(chip, CS4231_ALT_FEATURE_1,
683 chip->image[CS4231_ALT_FEATURE_1] |
684 CS4231_TIMER_ENABLE);
686 spin_unlock_irqrestore(&chip->lock, flags);
688 return 0;
691 static int snd_cs4231_timer_stop(struct snd_timer *timer)
693 unsigned long flags;
694 struct snd_cs4231 *chip = snd_timer_chip(timer);
696 spin_lock_irqsave(&chip->lock, flags);
697 chip->image[CS4231_ALT_FEATURE_1] &= ~CS4231_TIMER_ENABLE;
698 snd_cs4231_out(chip, CS4231_ALT_FEATURE_1,
699 chip->image[CS4231_ALT_FEATURE_1]);
700 spin_unlock_irqrestore(&chip->lock, flags);
702 return 0;
705 static void __devinit snd_cs4231_init(struct snd_cs4231 *chip)
707 unsigned long flags;
709 snd_cs4231_mce_down(chip);
711 #ifdef SNDRV_DEBUG_MCE
712 snd_printdd("init: (1)\n");
713 #endif
714 snd_cs4231_mce_up(chip);
715 spin_lock_irqsave(&chip->lock, flags);
716 chip->image[CS4231_IFACE_CTRL] &= ~(CS4231_PLAYBACK_ENABLE |
717 CS4231_PLAYBACK_PIO |
718 CS4231_RECORD_ENABLE |
719 CS4231_RECORD_PIO |
720 CS4231_CALIB_MODE);
721 chip->image[CS4231_IFACE_CTRL] |= CS4231_AUTOCALIB;
722 snd_cs4231_out(chip, CS4231_IFACE_CTRL, chip->image[CS4231_IFACE_CTRL]);
723 spin_unlock_irqrestore(&chip->lock, flags);
724 snd_cs4231_mce_down(chip);
726 #ifdef SNDRV_DEBUG_MCE
727 snd_printdd("init: (2)\n");
728 #endif
730 snd_cs4231_mce_up(chip);
731 spin_lock_irqsave(&chip->lock, flags);
732 snd_cs4231_out(chip, CS4231_ALT_FEATURE_1,
733 chip->image[CS4231_ALT_FEATURE_1]);
734 spin_unlock_irqrestore(&chip->lock, flags);
735 snd_cs4231_mce_down(chip);
737 #ifdef SNDRV_DEBUG_MCE
738 snd_printdd("init: (3) - afei = 0x%x\n",
739 chip->image[CS4231_ALT_FEATURE_1]);
740 #endif
742 spin_lock_irqsave(&chip->lock, flags);
743 snd_cs4231_out(chip, CS4231_ALT_FEATURE_2,
744 chip->image[CS4231_ALT_FEATURE_2]);
745 spin_unlock_irqrestore(&chip->lock, flags);
747 snd_cs4231_mce_up(chip);
748 spin_lock_irqsave(&chip->lock, flags);
749 snd_cs4231_out(chip, CS4231_PLAYBK_FORMAT,
750 chip->image[CS4231_PLAYBK_FORMAT]);
751 spin_unlock_irqrestore(&chip->lock, flags);
752 snd_cs4231_mce_down(chip);
754 #ifdef SNDRV_DEBUG_MCE
755 snd_printdd("init: (4)\n");
756 #endif
758 snd_cs4231_mce_up(chip);
759 spin_lock_irqsave(&chip->lock, flags);
760 snd_cs4231_out(chip, CS4231_REC_FORMAT, chip->image[CS4231_REC_FORMAT]);
761 spin_unlock_irqrestore(&chip->lock, flags);
762 snd_cs4231_mce_down(chip);
764 #ifdef SNDRV_DEBUG_MCE
765 snd_printdd("init: (5)\n");
766 #endif
769 static int snd_cs4231_open(struct snd_cs4231 *chip, unsigned int mode)
771 unsigned long flags;
773 mutex_lock(&chip->open_mutex);
774 if ((chip->mode & mode)) {
775 mutex_unlock(&chip->open_mutex);
776 return -EAGAIN;
778 if (chip->mode & CS4231_MODE_OPEN) {
779 chip->mode |= mode;
780 mutex_unlock(&chip->open_mutex);
781 return 0;
783 /* ok. now enable and ack CODEC IRQ */
784 spin_lock_irqsave(&chip->lock, flags);
785 snd_cs4231_out(chip, CS4231_IRQ_STATUS, CS4231_PLAYBACK_IRQ |
786 CS4231_RECORD_IRQ |
787 CS4231_TIMER_IRQ);
788 snd_cs4231_out(chip, CS4231_IRQ_STATUS, 0);
789 __cs4231_writeb(chip, 0, CS4231U(chip, STATUS)); /* clear IRQ */
790 __cs4231_writeb(chip, 0, CS4231U(chip, STATUS)); /* clear IRQ */
792 snd_cs4231_out(chip, CS4231_IRQ_STATUS, CS4231_PLAYBACK_IRQ |
793 CS4231_RECORD_IRQ |
794 CS4231_TIMER_IRQ);
795 snd_cs4231_out(chip, CS4231_IRQ_STATUS, 0);
797 spin_unlock_irqrestore(&chip->lock, flags);
799 chip->mode = mode;
800 mutex_unlock(&chip->open_mutex);
801 return 0;
804 static void snd_cs4231_close(struct snd_cs4231 *chip, unsigned int mode)
806 unsigned long flags;
808 mutex_lock(&chip->open_mutex);
809 chip->mode &= ~mode;
810 if (chip->mode & CS4231_MODE_OPEN) {
811 mutex_unlock(&chip->open_mutex);
812 return;
814 snd_cs4231_calibrate_mute(chip, 1);
816 /* disable IRQ */
817 spin_lock_irqsave(&chip->lock, flags);
818 snd_cs4231_out(chip, CS4231_IRQ_STATUS, 0);
819 __cs4231_writeb(chip, 0, CS4231U(chip, STATUS)); /* clear IRQ */
820 __cs4231_writeb(chip, 0, CS4231U(chip, STATUS)); /* clear IRQ */
822 /* now disable record & playback */
824 if (chip->image[CS4231_IFACE_CTRL] &
825 (CS4231_PLAYBACK_ENABLE | CS4231_PLAYBACK_PIO |
826 CS4231_RECORD_ENABLE | CS4231_RECORD_PIO)) {
827 spin_unlock_irqrestore(&chip->lock, flags);
828 snd_cs4231_mce_up(chip);
829 spin_lock_irqsave(&chip->lock, flags);
830 chip->image[CS4231_IFACE_CTRL] &=
831 ~(CS4231_PLAYBACK_ENABLE | CS4231_PLAYBACK_PIO |
832 CS4231_RECORD_ENABLE | CS4231_RECORD_PIO);
833 snd_cs4231_out(chip, CS4231_IFACE_CTRL,
834 chip->image[CS4231_IFACE_CTRL]);
835 spin_unlock_irqrestore(&chip->lock, flags);
836 snd_cs4231_mce_down(chip);
837 spin_lock_irqsave(&chip->lock, flags);
840 /* clear IRQ again */
841 snd_cs4231_out(chip, CS4231_IRQ_STATUS, 0);
842 __cs4231_writeb(chip, 0, CS4231U(chip, STATUS)); /* clear IRQ */
843 __cs4231_writeb(chip, 0, CS4231U(chip, STATUS)); /* clear IRQ */
844 spin_unlock_irqrestore(&chip->lock, flags);
846 snd_cs4231_calibrate_mute(chip, 0);
848 chip->mode = 0;
849 mutex_unlock(&chip->open_mutex);
853 * timer open/close
856 static int snd_cs4231_timer_open(struct snd_timer *timer)
858 struct snd_cs4231 *chip = snd_timer_chip(timer);
859 snd_cs4231_open(chip, CS4231_MODE_TIMER);
860 return 0;
863 static int snd_cs4231_timer_close(struct snd_timer *timer)
865 struct snd_cs4231 *chip = snd_timer_chip(timer);
866 snd_cs4231_close(chip, CS4231_MODE_TIMER);
867 return 0;
870 static struct snd_timer_hardware snd_cs4231_timer_table = {
871 .flags = SNDRV_TIMER_HW_AUTO,
872 .resolution = 9945,
873 .ticks = 65535,
874 .open = snd_cs4231_timer_open,
875 .close = snd_cs4231_timer_close,
876 .c_resolution = snd_cs4231_timer_resolution,
877 .start = snd_cs4231_timer_start,
878 .stop = snd_cs4231_timer_stop,
882 * ok.. exported functions..
885 static int snd_cs4231_playback_hw_params(struct snd_pcm_substream *substream,
886 struct snd_pcm_hw_params *hw_params)
888 struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
889 unsigned char new_pdfr;
890 int err;
892 err = snd_pcm_lib_malloc_pages(substream,
893 params_buffer_bytes(hw_params));
894 if (err < 0)
895 return err;
896 new_pdfr = snd_cs4231_get_format(chip, params_format(hw_params),
897 params_channels(hw_params)) |
898 snd_cs4231_get_rate(params_rate(hw_params));
899 snd_cs4231_playback_format(chip, hw_params, new_pdfr);
901 return 0;
904 static int snd_cs4231_playback_prepare(struct snd_pcm_substream *substream)
906 struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
907 struct snd_pcm_runtime *runtime = substream->runtime;
908 unsigned long flags;
910 spin_lock_irqsave(&chip->lock, flags);
912 chip->image[CS4231_IFACE_CTRL] &= ~(CS4231_PLAYBACK_ENABLE |
913 CS4231_PLAYBACK_PIO);
915 BUG_ON(runtime->period_size > 0xffff + 1);
917 chip->p_periods_sent = 0;
918 spin_unlock_irqrestore(&chip->lock, flags);
920 return 0;
923 static int snd_cs4231_capture_hw_params(struct snd_pcm_substream *substream,
924 struct snd_pcm_hw_params *hw_params)
926 struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
927 unsigned char new_cdfr;
928 int err;
930 err = snd_pcm_lib_malloc_pages(substream,
931 params_buffer_bytes(hw_params));
932 if (err < 0)
933 return err;
934 new_cdfr = snd_cs4231_get_format(chip, params_format(hw_params),
935 params_channels(hw_params)) |
936 snd_cs4231_get_rate(params_rate(hw_params));
937 snd_cs4231_capture_format(chip, hw_params, new_cdfr);
939 return 0;
942 static int snd_cs4231_capture_prepare(struct snd_pcm_substream *substream)
944 struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
945 unsigned long flags;
947 spin_lock_irqsave(&chip->lock, flags);
948 chip->image[CS4231_IFACE_CTRL] &= ~(CS4231_RECORD_ENABLE |
949 CS4231_RECORD_PIO);
952 chip->c_periods_sent = 0;
953 spin_unlock_irqrestore(&chip->lock, flags);
955 return 0;
958 static void snd_cs4231_overrange(struct snd_cs4231 *chip)
960 unsigned long flags;
961 unsigned char res;
963 spin_lock_irqsave(&chip->lock, flags);
964 res = snd_cs4231_in(chip, CS4231_TEST_INIT);
965 spin_unlock_irqrestore(&chip->lock, flags);
967 /* detect overrange only above 0dB; may be user selectable? */
968 if (res & (0x08 | 0x02))
969 chip->capture_substream->runtime->overrange++;
972 static void snd_cs4231_play_callback(struct snd_cs4231 *chip)
974 if (chip->image[CS4231_IFACE_CTRL] & CS4231_PLAYBACK_ENABLE) {
975 snd_pcm_period_elapsed(chip->playback_substream);
976 snd_cs4231_advance_dma(&chip->p_dma, chip->playback_substream,
977 &chip->p_periods_sent);
981 static void snd_cs4231_capture_callback(struct snd_cs4231 *chip)
983 if (chip->image[CS4231_IFACE_CTRL] & CS4231_RECORD_ENABLE) {
984 snd_pcm_period_elapsed(chip->capture_substream);
985 snd_cs4231_advance_dma(&chip->c_dma, chip->capture_substream,
986 &chip->c_periods_sent);
990 static snd_pcm_uframes_t snd_cs4231_playback_pointer(
991 struct snd_pcm_substream *substream)
993 struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
994 struct cs4231_dma_control *dma_cont = &chip->p_dma;
995 size_t ptr;
997 if (!(chip->image[CS4231_IFACE_CTRL] & CS4231_PLAYBACK_ENABLE))
998 return 0;
999 ptr = dma_cont->address(dma_cont);
1000 if (ptr != 0)
1001 ptr -= substream->runtime->dma_addr;
1003 return bytes_to_frames(substream->runtime, ptr);
1006 static snd_pcm_uframes_t snd_cs4231_capture_pointer(
1007 struct snd_pcm_substream *substream)
1009 struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
1010 struct cs4231_dma_control *dma_cont = &chip->c_dma;
1011 size_t ptr;
1013 if (!(chip->image[CS4231_IFACE_CTRL] & CS4231_RECORD_ENABLE))
1014 return 0;
1015 ptr = dma_cont->address(dma_cont);
1016 if (ptr != 0)
1017 ptr -= substream->runtime->dma_addr;
1019 return bytes_to_frames(substream->runtime, ptr);
1022 static int __devinit snd_cs4231_probe(struct snd_cs4231 *chip)
1024 unsigned long flags;
1025 int i;
1026 int id = 0;
1027 int vers = 0;
1028 unsigned char *ptr;
1030 for (i = 0; i < 50; i++) {
1031 mb();
1032 if (__cs4231_readb(chip, CS4231U(chip, REGSEL)) & CS4231_INIT)
1033 msleep(2);
1034 else {
1035 spin_lock_irqsave(&chip->lock, flags);
1036 snd_cs4231_out(chip, CS4231_MISC_INFO, CS4231_MODE2);
1037 id = snd_cs4231_in(chip, CS4231_MISC_INFO) & 0x0f;
1038 vers = snd_cs4231_in(chip, CS4231_VERSION);
1039 spin_unlock_irqrestore(&chip->lock, flags);
1040 if (id == 0x0a)
1041 break; /* this is valid value */
1044 snd_printdd("cs4231: port = %p, id = 0x%x\n", chip->port, id);
1045 if (id != 0x0a)
1046 return -ENODEV; /* no valid device found */
1048 spin_lock_irqsave(&chip->lock, flags);
1050 /* clear any pendings IRQ */
1051 __cs4231_readb(chip, CS4231U(chip, STATUS));
1052 __cs4231_writeb(chip, 0, CS4231U(chip, STATUS));
1053 mb();
1055 spin_unlock_irqrestore(&chip->lock, flags);
1057 chip->image[CS4231_MISC_INFO] = CS4231_MODE2;
1058 chip->image[CS4231_IFACE_CTRL] =
1059 chip->image[CS4231_IFACE_CTRL] & ~CS4231_SINGLE_DMA;
1060 chip->image[CS4231_ALT_FEATURE_1] = 0x80;
1061 chip->image[CS4231_ALT_FEATURE_2] = 0x01;
1062 if (vers & 0x20)
1063 chip->image[CS4231_ALT_FEATURE_2] |= 0x02;
1065 ptr = (unsigned char *) &chip->image;
1067 snd_cs4231_mce_down(chip);
1069 spin_lock_irqsave(&chip->lock, flags);
1071 for (i = 0; i < 32; i++) /* ok.. fill all CS4231 registers */
1072 snd_cs4231_out(chip, i, *ptr++);
1074 spin_unlock_irqrestore(&chip->lock, flags);
1076 snd_cs4231_mce_up(chip);
1078 snd_cs4231_mce_down(chip);
1080 mdelay(2);
1082 return 0; /* all things are ok.. */
1085 static struct snd_pcm_hardware snd_cs4231_playback = {
1086 .info = SNDRV_PCM_INFO_MMAP |
1087 SNDRV_PCM_INFO_INTERLEAVED |
1088 SNDRV_PCM_INFO_MMAP_VALID |
1089 SNDRV_PCM_INFO_SYNC_START,
1090 .formats = SNDRV_PCM_FMTBIT_MU_LAW |
1091 SNDRV_PCM_FMTBIT_A_LAW |
1092 SNDRV_PCM_FMTBIT_IMA_ADPCM |
1093 SNDRV_PCM_FMTBIT_U8 |
1094 SNDRV_PCM_FMTBIT_S16_LE |
1095 SNDRV_PCM_FMTBIT_S16_BE,
1096 .rates = SNDRV_PCM_RATE_KNOT |
1097 SNDRV_PCM_RATE_8000_48000,
1098 .rate_min = 5510,
1099 .rate_max = 48000,
1100 .channels_min = 1,
1101 .channels_max = 2,
1102 .buffer_bytes_max = 32 * 1024,
1103 .period_bytes_min = 64,
1104 .period_bytes_max = 32 * 1024,
1105 .periods_min = 1,
1106 .periods_max = 1024,
1109 static struct snd_pcm_hardware snd_cs4231_capture = {
1110 .info = SNDRV_PCM_INFO_MMAP |
1111 SNDRV_PCM_INFO_INTERLEAVED |
1112 SNDRV_PCM_INFO_MMAP_VALID |
1113 SNDRV_PCM_INFO_SYNC_START,
1114 .formats = SNDRV_PCM_FMTBIT_MU_LAW |
1115 SNDRV_PCM_FMTBIT_A_LAW |
1116 SNDRV_PCM_FMTBIT_IMA_ADPCM |
1117 SNDRV_PCM_FMTBIT_U8 |
1118 SNDRV_PCM_FMTBIT_S16_LE |
1119 SNDRV_PCM_FMTBIT_S16_BE,
1120 .rates = SNDRV_PCM_RATE_KNOT |
1121 SNDRV_PCM_RATE_8000_48000,
1122 .rate_min = 5510,
1123 .rate_max = 48000,
1124 .channels_min = 1,
1125 .channels_max = 2,
1126 .buffer_bytes_max = 32 * 1024,
1127 .period_bytes_min = 64,
1128 .period_bytes_max = 32 * 1024,
1129 .periods_min = 1,
1130 .periods_max = 1024,
1133 static int snd_cs4231_playback_open(struct snd_pcm_substream *substream)
1135 struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
1136 struct snd_pcm_runtime *runtime = substream->runtime;
1137 int err;
1139 runtime->hw = snd_cs4231_playback;
1141 err = snd_cs4231_open(chip, CS4231_MODE_PLAY);
1142 if (err < 0) {
1143 snd_free_pages(runtime->dma_area, runtime->dma_bytes);
1144 return err;
1146 chip->playback_substream = substream;
1147 chip->p_periods_sent = 0;
1148 snd_pcm_set_sync(substream);
1149 snd_cs4231_xrate(runtime);
1151 return 0;
1154 static int snd_cs4231_capture_open(struct snd_pcm_substream *substream)
1156 struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
1157 struct snd_pcm_runtime *runtime = substream->runtime;
1158 int err;
1160 runtime->hw = snd_cs4231_capture;
1162 err = snd_cs4231_open(chip, CS4231_MODE_RECORD);
1163 if (err < 0) {
1164 snd_free_pages(runtime->dma_area, runtime->dma_bytes);
1165 return err;
1167 chip->capture_substream = substream;
1168 chip->c_periods_sent = 0;
1169 snd_pcm_set_sync(substream);
1170 snd_cs4231_xrate(runtime);
1172 return 0;
1175 static int snd_cs4231_playback_close(struct snd_pcm_substream *substream)
1177 struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
1179 snd_cs4231_close(chip, CS4231_MODE_PLAY);
1180 chip->playback_substream = NULL;
1182 return 0;
1185 static int snd_cs4231_capture_close(struct snd_pcm_substream *substream)
1187 struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
1189 snd_cs4231_close(chip, CS4231_MODE_RECORD);
1190 chip->capture_substream = NULL;
1192 return 0;
1195 /* XXX We can do some power-management, in particular on EBUS using
1196 * XXX the audio AUXIO register...
1199 static struct snd_pcm_ops snd_cs4231_playback_ops = {
1200 .open = snd_cs4231_playback_open,
1201 .close = snd_cs4231_playback_close,
1202 .ioctl = snd_pcm_lib_ioctl,
1203 .hw_params = snd_cs4231_playback_hw_params,
1204 .hw_free = snd_pcm_lib_free_pages,
1205 .prepare = snd_cs4231_playback_prepare,
1206 .trigger = snd_cs4231_trigger,
1207 .pointer = snd_cs4231_playback_pointer,
1210 static struct snd_pcm_ops snd_cs4231_capture_ops = {
1211 .open = snd_cs4231_capture_open,
1212 .close = snd_cs4231_capture_close,
1213 .ioctl = snd_pcm_lib_ioctl,
1214 .hw_params = snd_cs4231_capture_hw_params,
1215 .hw_free = snd_pcm_lib_free_pages,
1216 .prepare = snd_cs4231_capture_prepare,
1217 .trigger = snd_cs4231_trigger,
1218 .pointer = snd_cs4231_capture_pointer,
1221 static int __devinit snd_cs4231_pcm(struct snd_card *card)
1223 struct snd_cs4231 *chip = card->private_data;
1224 struct snd_pcm *pcm;
1225 int err;
1227 err = snd_pcm_new(card, "CS4231", 0, 1, 1, &pcm);
1228 if (err < 0)
1229 return err;
1231 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK,
1232 &snd_cs4231_playback_ops);
1233 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE,
1234 &snd_cs4231_capture_ops);
1236 /* global setup */
1237 pcm->private_data = chip;
1238 pcm->info_flags = SNDRV_PCM_INFO_JOINT_DUPLEX;
1239 strcpy(pcm->name, "CS4231");
1241 snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
1242 &chip->op->dev,
1243 64 * 1024, 128 * 1024);
1245 chip->pcm = pcm;
1247 return 0;
1250 static int __devinit snd_cs4231_timer(struct snd_card *card)
1252 struct snd_cs4231 *chip = card->private_data;
1253 struct snd_timer *timer;
1254 struct snd_timer_id tid;
1255 int err;
1257 /* Timer initialization */
1258 tid.dev_class = SNDRV_TIMER_CLASS_CARD;
1259 tid.dev_sclass = SNDRV_TIMER_SCLASS_NONE;
1260 tid.card = card->number;
1261 tid.device = 0;
1262 tid.subdevice = 0;
1263 err = snd_timer_new(card, "CS4231", &tid, &timer);
1264 if (err < 0)
1265 return err;
1266 strcpy(timer->name, "CS4231");
1267 timer->private_data = chip;
1268 timer->hw = snd_cs4231_timer_table;
1269 chip->timer = timer;
1271 return 0;
1275 * MIXER part
1278 static int snd_cs4231_info_mux(struct snd_kcontrol *kcontrol,
1279 struct snd_ctl_elem_info *uinfo)
1281 static char *texts[4] = {
1282 "Line", "CD", "Mic", "Mix"
1285 uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
1286 uinfo->count = 2;
1287 uinfo->value.enumerated.items = 4;
1288 if (uinfo->value.enumerated.item > 3)
1289 uinfo->value.enumerated.item = 3;
1290 strcpy(uinfo->value.enumerated.name,
1291 texts[uinfo->value.enumerated.item]);
1293 return 0;
1296 static int snd_cs4231_get_mux(struct snd_kcontrol *kcontrol,
1297 struct snd_ctl_elem_value *ucontrol)
1299 struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
1300 unsigned long flags;
1302 spin_lock_irqsave(&chip->lock, flags);
1303 ucontrol->value.enumerated.item[0] =
1304 (chip->image[CS4231_LEFT_INPUT] & CS4231_MIXS_ALL) >> 6;
1305 ucontrol->value.enumerated.item[1] =
1306 (chip->image[CS4231_RIGHT_INPUT] & CS4231_MIXS_ALL) >> 6;
1307 spin_unlock_irqrestore(&chip->lock, flags);
1309 return 0;
1312 static int snd_cs4231_put_mux(struct snd_kcontrol *kcontrol,
1313 struct snd_ctl_elem_value *ucontrol)
1315 struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
1316 unsigned long flags;
1317 unsigned short left, right;
1318 int change;
1320 if (ucontrol->value.enumerated.item[0] > 3 ||
1321 ucontrol->value.enumerated.item[1] > 3)
1322 return -EINVAL;
1323 left = ucontrol->value.enumerated.item[0] << 6;
1324 right = ucontrol->value.enumerated.item[1] << 6;
1326 spin_lock_irqsave(&chip->lock, flags);
1328 left = (chip->image[CS4231_LEFT_INPUT] & ~CS4231_MIXS_ALL) | left;
1329 right = (chip->image[CS4231_RIGHT_INPUT] & ~CS4231_MIXS_ALL) | right;
1330 change = left != chip->image[CS4231_LEFT_INPUT] ||
1331 right != chip->image[CS4231_RIGHT_INPUT];
1332 snd_cs4231_out(chip, CS4231_LEFT_INPUT, left);
1333 snd_cs4231_out(chip, CS4231_RIGHT_INPUT, right);
1335 spin_unlock_irqrestore(&chip->lock, flags);
1337 return change;
1340 static int snd_cs4231_info_single(struct snd_kcontrol *kcontrol,
1341 struct snd_ctl_elem_info *uinfo)
1343 int mask = (kcontrol->private_value >> 16) & 0xff;
1345 uinfo->type = (mask == 1) ?
1346 SNDRV_CTL_ELEM_TYPE_BOOLEAN : SNDRV_CTL_ELEM_TYPE_INTEGER;
1347 uinfo->count = 1;
1348 uinfo->value.integer.min = 0;
1349 uinfo->value.integer.max = mask;
1351 return 0;
1354 static int snd_cs4231_get_single(struct snd_kcontrol *kcontrol,
1355 struct snd_ctl_elem_value *ucontrol)
1357 struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
1358 unsigned long flags;
1359 int reg = kcontrol->private_value & 0xff;
1360 int shift = (kcontrol->private_value >> 8) & 0xff;
1361 int mask = (kcontrol->private_value >> 16) & 0xff;
1362 int invert = (kcontrol->private_value >> 24) & 0xff;
1364 spin_lock_irqsave(&chip->lock, flags);
1366 ucontrol->value.integer.value[0] = (chip->image[reg] >> shift) & mask;
1368 spin_unlock_irqrestore(&chip->lock, flags);
1370 if (invert)
1371 ucontrol->value.integer.value[0] =
1372 (mask - ucontrol->value.integer.value[0]);
1374 return 0;
1377 static int snd_cs4231_put_single(struct snd_kcontrol *kcontrol,
1378 struct snd_ctl_elem_value *ucontrol)
1380 struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
1381 unsigned long flags;
1382 int reg = kcontrol->private_value & 0xff;
1383 int shift = (kcontrol->private_value >> 8) & 0xff;
1384 int mask = (kcontrol->private_value >> 16) & 0xff;
1385 int invert = (kcontrol->private_value >> 24) & 0xff;
1386 int change;
1387 unsigned short val;
1389 val = (ucontrol->value.integer.value[0] & mask);
1390 if (invert)
1391 val = mask - val;
1392 val <<= shift;
1394 spin_lock_irqsave(&chip->lock, flags);
1396 val = (chip->image[reg] & ~(mask << shift)) | val;
1397 change = val != chip->image[reg];
1398 snd_cs4231_out(chip, reg, val);
1400 spin_unlock_irqrestore(&chip->lock, flags);
1402 return change;
1405 static int snd_cs4231_info_double(struct snd_kcontrol *kcontrol,
1406 struct snd_ctl_elem_info *uinfo)
1408 int mask = (kcontrol->private_value >> 24) & 0xff;
1410 uinfo->type = mask == 1 ?
1411 SNDRV_CTL_ELEM_TYPE_BOOLEAN : SNDRV_CTL_ELEM_TYPE_INTEGER;
1412 uinfo->count = 2;
1413 uinfo->value.integer.min = 0;
1414 uinfo->value.integer.max = mask;
1416 return 0;
1419 static int snd_cs4231_get_double(struct snd_kcontrol *kcontrol,
1420 struct snd_ctl_elem_value *ucontrol)
1422 struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
1423 unsigned long flags;
1424 int left_reg = kcontrol->private_value & 0xff;
1425 int right_reg = (kcontrol->private_value >> 8) & 0xff;
1426 int shift_left = (kcontrol->private_value >> 16) & 0x07;
1427 int shift_right = (kcontrol->private_value >> 19) & 0x07;
1428 int mask = (kcontrol->private_value >> 24) & 0xff;
1429 int invert = (kcontrol->private_value >> 22) & 1;
1431 spin_lock_irqsave(&chip->lock, flags);
1433 ucontrol->value.integer.value[0] =
1434 (chip->image[left_reg] >> shift_left) & mask;
1435 ucontrol->value.integer.value[1] =
1436 (chip->image[right_reg] >> shift_right) & mask;
1438 spin_unlock_irqrestore(&chip->lock, flags);
1440 if (invert) {
1441 ucontrol->value.integer.value[0] =
1442 (mask - ucontrol->value.integer.value[0]);
1443 ucontrol->value.integer.value[1] =
1444 (mask - ucontrol->value.integer.value[1]);
1447 return 0;
1450 static int snd_cs4231_put_double(struct snd_kcontrol *kcontrol,
1451 struct snd_ctl_elem_value *ucontrol)
1453 struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
1454 unsigned long flags;
1455 int left_reg = kcontrol->private_value & 0xff;
1456 int right_reg = (kcontrol->private_value >> 8) & 0xff;
1457 int shift_left = (kcontrol->private_value >> 16) & 0x07;
1458 int shift_right = (kcontrol->private_value >> 19) & 0x07;
1459 int mask = (kcontrol->private_value >> 24) & 0xff;
1460 int invert = (kcontrol->private_value >> 22) & 1;
1461 int change;
1462 unsigned short val1, val2;
1464 val1 = ucontrol->value.integer.value[0] & mask;
1465 val2 = ucontrol->value.integer.value[1] & mask;
1466 if (invert) {
1467 val1 = mask - val1;
1468 val2 = mask - val2;
1470 val1 <<= shift_left;
1471 val2 <<= shift_right;
1473 spin_lock_irqsave(&chip->lock, flags);
1475 val1 = (chip->image[left_reg] & ~(mask << shift_left)) | val1;
1476 val2 = (chip->image[right_reg] & ~(mask << shift_right)) | val2;
1477 change = val1 != chip->image[left_reg];
1478 change |= val2 != chip->image[right_reg];
1479 snd_cs4231_out(chip, left_reg, val1);
1480 snd_cs4231_out(chip, right_reg, val2);
1482 spin_unlock_irqrestore(&chip->lock, flags);
1484 return change;
1487 #define CS4231_SINGLE(xname, xindex, reg, shift, mask, invert) \
1488 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname), .index = (xindex), \
1489 .info = snd_cs4231_info_single, \
1490 .get = snd_cs4231_get_single, .put = snd_cs4231_put_single, \
1491 .private_value = (reg) | ((shift) << 8) | ((mask) << 16) | ((invert) << 24) }
1493 #define CS4231_DOUBLE(xname, xindex, left_reg, right_reg, shift_left, \
1494 shift_right, mask, invert) \
1495 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname), .index = (xindex), \
1496 .info = snd_cs4231_info_double, \
1497 .get = snd_cs4231_get_double, .put = snd_cs4231_put_double, \
1498 .private_value = (left_reg) | ((right_reg) << 8) | ((shift_left) << 16) | \
1499 ((shift_right) << 19) | ((mask) << 24) | ((invert) << 22) }
1501 static struct snd_kcontrol_new snd_cs4231_controls[] __devinitdata = {
1502 CS4231_DOUBLE("PCM Playback Switch", 0, CS4231_LEFT_OUTPUT,
1503 CS4231_RIGHT_OUTPUT, 7, 7, 1, 1),
1504 CS4231_DOUBLE("PCM Playback Volume", 0, CS4231_LEFT_OUTPUT,
1505 CS4231_RIGHT_OUTPUT, 0, 0, 63, 1),
1506 CS4231_DOUBLE("Line Playback Switch", 0, CS4231_LEFT_LINE_IN,
1507 CS4231_RIGHT_LINE_IN, 7, 7, 1, 1),
1508 CS4231_DOUBLE("Line Playback Volume", 0, CS4231_LEFT_LINE_IN,
1509 CS4231_RIGHT_LINE_IN, 0, 0, 31, 1),
1510 CS4231_DOUBLE("Aux Playback Switch", 0, CS4231_AUX1_LEFT_INPUT,
1511 CS4231_AUX1_RIGHT_INPUT, 7, 7, 1, 1),
1512 CS4231_DOUBLE("Aux Playback Volume", 0, CS4231_AUX1_LEFT_INPUT,
1513 CS4231_AUX1_RIGHT_INPUT, 0, 0, 31, 1),
1514 CS4231_DOUBLE("Aux Playback Switch", 1, CS4231_AUX2_LEFT_INPUT,
1515 CS4231_AUX2_RIGHT_INPUT, 7, 7, 1, 1),
1516 CS4231_DOUBLE("Aux Playback Volume", 1, CS4231_AUX2_LEFT_INPUT,
1517 CS4231_AUX2_RIGHT_INPUT, 0, 0, 31, 1),
1518 CS4231_SINGLE("Mono Playback Switch", 0, CS4231_MONO_CTRL, 7, 1, 1),
1519 CS4231_SINGLE("Mono Playback Volume", 0, CS4231_MONO_CTRL, 0, 15, 1),
1520 CS4231_SINGLE("Mono Output Playback Switch", 0, CS4231_MONO_CTRL, 6, 1, 1),
1521 CS4231_SINGLE("Mono Output Playback Bypass", 0, CS4231_MONO_CTRL, 5, 1, 0),
1522 CS4231_DOUBLE("Capture Volume", 0, CS4231_LEFT_INPUT, CS4231_RIGHT_INPUT, 0, 0,
1523 15, 0),
1525 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
1526 .name = "Capture Source",
1527 .info = snd_cs4231_info_mux,
1528 .get = snd_cs4231_get_mux,
1529 .put = snd_cs4231_put_mux,
1531 CS4231_DOUBLE("Mic Boost", 0, CS4231_LEFT_INPUT, CS4231_RIGHT_INPUT, 5, 5,
1532 1, 0),
1533 CS4231_SINGLE("Loopback Capture Switch", 0, CS4231_LOOPBACK, 0, 1, 0),
1534 CS4231_SINGLE("Loopback Capture Volume", 0, CS4231_LOOPBACK, 2, 63, 1),
1535 /* SPARC specific uses of XCTL{0,1} general purpose outputs. */
1536 CS4231_SINGLE("Line Out Switch", 0, CS4231_PIN_CTRL, 6, 1, 1),
1537 CS4231_SINGLE("Headphone Out Switch", 0, CS4231_PIN_CTRL, 7, 1, 1)
1540 static int __devinit snd_cs4231_mixer(struct snd_card *card)
1542 struct snd_cs4231 *chip = card->private_data;
1543 int err, idx;
1545 if (snd_BUG_ON(!chip || !chip->pcm))
1546 return -EINVAL;
1548 strcpy(card->mixername, chip->pcm->name);
1550 for (idx = 0; idx < ARRAY_SIZE(snd_cs4231_controls); idx++) {
1551 err = snd_ctl_add(card,
1552 snd_ctl_new1(&snd_cs4231_controls[idx], chip));
1553 if (err < 0)
1554 return err;
1556 return 0;
1559 static int dev;
1561 static int __devinit cs4231_attach_begin(struct snd_card **rcard)
1563 struct snd_card *card;
1564 struct snd_cs4231 *chip;
1565 int err;
1567 *rcard = NULL;
1569 if (dev >= SNDRV_CARDS)
1570 return -ENODEV;
1572 if (!enable[dev]) {
1573 dev++;
1574 return -ENOENT;
1577 err = snd_card_create(index[dev], id[dev], THIS_MODULE,
1578 sizeof(struct snd_cs4231), &card);
1579 if (err < 0)
1580 return err;
1582 strcpy(card->driver, "CS4231");
1583 strcpy(card->shortname, "Sun CS4231");
1585 chip = card->private_data;
1586 chip->card = card;
1588 *rcard = card;
1589 return 0;
1592 static int __devinit cs4231_attach_finish(struct snd_card *card)
1594 struct snd_cs4231 *chip = card->private_data;
1595 int err;
1597 err = snd_cs4231_pcm(card);
1598 if (err < 0)
1599 goto out_err;
1601 err = snd_cs4231_mixer(card);
1602 if (err < 0)
1603 goto out_err;
1605 err = snd_cs4231_timer(card);
1606 if (err < 0)
1607 goto out_err;
1609 err = snd_card_register(card);
1610 if (err < 0)
1611 goto out_err;
1613 dev_set_drvdata(&chip->op->dev, chip);
1615 dev++;
1616 return 0;
1618 out_err:
1619 snd_card_free(card);
1620 return err;
1623 #ifdef SBUS_SUPPORT
1625 static irqreturn_t snd_cs4231_sbus_interrupt(int irq, void *dev_id)
1627 unsigned long flags;
1628 unsigned char status;
1629 u32 csr;
1630 struct snd_cs4231 *chip = dev_id;
1632 /*This is IRQ is not raised by the cs4231*/
1633 if (!(__cs4231_readb(chip, CS4231U(chip, STATUS)) & CS4231_GLOBALIRQ))
1634 return IRQ_NONE;
1636 /* ACK the APC interrupt. */
1637 csr = sbus_readl(chip->port + APCCSR);
1639 sbus_writel(csr, chip->port + APCCSR);
1641 if ((csr & APC_PDMA_READY) &&
1642 (csr & APC_PLAY_INT) &&
1643 (csr & APC_XINT_PNVA) &&
1644 !(csr & APC_XINT_EMPT))
1645 snd_cs4231_play_callback(chip);
1647 if ((csr & APC_CDMA_READY) &&
1648 (csr & APC_CAPT_INT) &&
1649 (csr & APC_XINT_CNVA) &&
1650 !(csr & APC_XINT_EMPT))
1651 snd_cs4231_capture_callback(chip);
1653 status = snd_cs4231_in(chip, CS4231_IRQ_STATUS);
1655 if (status & CS4231_TIMER_IRQ) {
1656 if (chip->timer)
1657 snd_timer_interrupt(chip->timer, chip->timer->sticks);
1660 if ((status & CS4231_RECORD_IRQ) && (csr & APC_CDMA_READY))
1661 snd_cs4231_overrange(chip);
1663 /* ACK the CS4231 interrupt. */
1664 spin_lock_irqsave(&chip->lock, flags);
1665 snd_cs4231_outm(chip, CS4231_IRQ_STATUS, ~CS4231_ALL_IRQS | ~status, 0);
1666 spin_unlock_irqrestore(&chip->lock, flags);
1668 return IRQ_HANDLED;
1672 * SBUS DMA routines
1675 static int sbus_dma_request(struct cs4231_dma_control *dma_cont,
1676 dma_addr_t bus_addr, size_t len)
1678 unsigned long flags;
1679 u32 test, csr;
1680 int err;
1681 struct sbus_dma_info *base = &dma_cont->sbus_info;
1683 if (len >= (1 << 24))
1684 return -EINVAL;
1685 spin_lock_irqsave(&base->lock, flags);
1686 csr = sbus_readl(base->regs + APCCSR);
1687 err = -EINVAL;
1688 test = APC_CDMA_READY;
1689 if (base->dir == APC_PLAY)
1690 test = APC_PDMA_READY;
1691 if (!(csr & test))
1692 goto out;
1693 err = -EBUSY;
1694 test = APC_XINT_CNVA;
1695 if (base->dir == APC_PLAY)
1696 test = APC_XINT_PNVA;
1697 if (!(csr & test))
1698 goto out;
1699 err = 0;
1700 sbus_writel(bus_addr, base->regs + base->dir + APCNVA);
1701 sbus_writel(len, base->regs + base->dir + APCNC);
1702 out:
1703 spin_unlock_irqrestore(&base->lock, flags);
1704 return err;
1707 static void sbus_dma_prepare(struct cs4231_dma_control *dma_cont, int d)
1709 unsigned long flags;
1710 u32 csr, test;
1711 struct sbus_dma_info *base = &dma_cont->sbus_info;
1713 spin_lock_irqsave(&base->lock, flags);
1714 csr = sbus_readl(base->regs + APCCSR);
1715 test = APC_GENL_INT | APC_PLAY_INT | APC_XINT_ENA |
1716 APC_XINT_PLAY | APC_XINT_PEMP | APC_XINT_GENL |
1717 APC_XINT_PENA;
1718 if (base->dir == APC_RECORD)
1719 test = APC_GENL_INT | APC_CAPT_INT | APC_XINT_ENA |
1720 APC_XINT_CAPT | APC_XINT_CEMP | APC_XINT_GENL;
1721 csr |= test;
1722 sbus_writel(csr, base->regs + APCCSR);
1723 spin_unlock_irqrestore(&base->lock, flags);
1726 static void sbus_dma_enable(struct cs4231_dma_control *dma_cont, int on)
1728 unsigned long flags;
1729 u32 csr, shift;
1730 struct sbus_dma_info *base = &dma_cont->sbus_info;
1732 spin_lock_irqsave(&base->lock, flags);
1733 if (!on) {
1734 sbus_writel(0, base->regs + base->dir + APCNC);
1735 sbus_writel(0, base->regs + base->dir + APCNVA);
1736 if (base->dir == APC_PLAY) {
1737 sbus_writel(0, base->regs + base->dir + APCC);
1738 sbus_writel(0, base->regs + base->dir + APCVA);
1741 udelay(1200);
1743 csr = sbus_readl(base->regs + APCCSR);
1744 shift = 0;
1745 if (base->dir == APC_PLAY)
1746 shift = 1;
1747 if (on)
1748 csr &= ~(APC_CPAUSE << shift);
1749 else
1750 csr |= (APC_CPAUSE << shift);
1751 sbus_writel(csr, base->regs + APCCSR);
1752 if (on)
1753 csr |= (APC_CDMA_READY << shift);
1754 else
1755 csr &= ~(APC_CDMA_READY << shift);
1756 sbus_writel(csr, base->regs + APCCSR);
1758 spin_unlock_irqrestore(&base->lock, flags);
1761 static unsigned int sbus_dma_addr(struct cs4231_dma_control *dma_cont)
1763 struct sbus_dma_info *base = &dma_cont->sbus_info;
1765 return sbus_readl(base->regs + base->dir + APCVA);
1769 * Init and exit routines
1772 static int snd_cs4231_sbus_free(struct snd_cs4231 *chip)
1774 struct of_device *op = chip->op;
1776 if (chip->irq[0])
1777 free_irq(chip->irq[0], chip);
1779 if (chip->port)
1780 of_iounmap(&op->resource[0], chip->port, chip->regs_size);
1782 return 0;
1785 static int snd_cs4231_sbus_dev_free(struct snd_device *device)
1787 struct snd_cs4231 *cp = device->device_data;
1789 return snd_cs4231_sbus_free(cp);
1792 static struct snd_device_ops snd_cs4231_sbus_dev_ops = {
1793 .dev_free = snd_cs4231_sbus_dev_free,
1796 static int __devinit snd_cs4231_sbus_create(struct snd_card *card,
1797 struct of_device *op,
1798 int dev)
1800 struct snd_cs4231 *chip = card->private_data;
1801 int err;
1803 spin_lock_init(&chip->lock);
1804 spin_lock_init(&chip->c_dma.sbus_info.lock);
1805 spin_lock_init(&chip->p_dma.sbus_info.lock);
1806 mutex_init(&chip->mce_mutex);
1807 mutex_init(&chip->open_mutex);
1808 chip->op = op;
1809 chip->regs_size = resource_size(&op->resource[0]);
1810 memcpy(&chip->image, &snd_cs4231_original_image,
1811 sizeof(snd_cs4231_original_image));
1813 chip->port = of_ioremap(&op->resource[0], 0,
1814 chip->regs_size, "cs4231");
1815 if (!chip->port) {
1816 snd_printdd("cs4231-%d: Unable to map chip registers.\n", dev);
1817 return -EIO;
1820 chip->c_dma.sbus_info.regs = chip->port;
1821 chip->p_dma.sbus_info.regs = chip->port;
1822 chip->c_dma.sbus_info.dir = APC_RECORD;
1823 chip->p_dma.sbus_info.dir = APC_PLAY;
1825 chip->p_dma.prepare = sbus_dma_prepare;
1826 chip->p_dma.enable = sbus_dma_enable;
1827 chip->p_dma.request = sbus_dma_request;
1828 chip->p_dma.address = sbus_dma_addr;
1830 chip->c_dma.prepare = sbus_dma_prepare;
1831 chip->c_dma.enable = sbus_dma_enable;
1832 chip->c_dma.request = sbus_dma_request;
1833 chip->c_dma.address = sbus_dma_addr;
1835 if (request_irq(op->irqs[0], snd_cs4231_sbus_interrupt,
1836 IRQF_SHARED, "cs4231", chip)) {
1837 snd_printdd("cs4231-%d: Unable to grab SBUS IRQ %d\n",
1838 dev, op->irqs[0]);
1839 snd_cs4231_sbus_free(chip);
1840 return -EBUSY;
1842 chip->irq[0] = op->irqs[0];
1844 if (snd_cs4231_probe(chip) < 0) {
1845 snd_cs4231_sbus_free(chip);
1846 return -ENODEV;
1848 snd_cs4231_init(chip);
1850 if ((err = snd_device_new(card, SNDRV_DEV_LOWLEVEL,
1851 chip, &snd_cs4231_sbus_dev_ops)) < 0) {
1852 snd_cs4231_sbus_free(chip);
1853 return err;
1856 return 0;
1859 static int __devinit cs4231_sbus_probe(struct of_device *op, const struct of_device_id *match)
1861 struct resource *rp = &op->resource[0];
1862 struct snd_card *card;
1863 int err;
1865 err = cs4231_attach_begin(&card);
1866 if (err)
1867 return err;
1869 sprintf(card->longname, "%s at 0x%02lx:0x%016Lx, irq %d",
1870 card->shortname,
1871 rp->flags & 0xffL,
1872 (unsigned long long)rp->start,
1873 op->irqs[0]);
1875 err = snd_cs4231_sbus_create(card, op, dev);
1876 if (err < 0) {
1877 snd_card_free(card);
1878 return err;
1881 return cs4231_attach_finish(card);
1883 #endif
1885 #ifdef EBUS_SUPPORT
1887 static void snd_cs4231_ebus_play_callback(struct ebus_dma_info *p, int event,
1888 void *cookie)
1890 struct snd_cs4231 *chip = cookie;
1892 snd_cs4231_play_callback(chip);
1895 static void snd_cs4231_ebus_capture_callback(struct ebus_dma_info *p,
1896 int event, void *cookie)
1898 struct snd_cs4231 *chip = cookie;
1900 snd_cs4231_capture_callback(chip);
1904 * EBUS DMA wrappers
1907 static int _ebus_dma_request(struct cs4231_dma_control *dma_cont,
1908 dma_addr_t bus_addr, size_t len)
1910 return ebus_dma_request(&dma_cont->ebus_info, bus_addr, len);
1913 static void _ebus_dma_enable(struct cs4231_dma_control *dma_cont, int on)
1915 ebus_dma_enable(&dma_cont->ebus_info, on);
1918 static void _ebus_dma_prepare(struct cs4231_dma_control *dma_cont, int dir)
1920 ebus_dma_prepare(&dma_cont->ebus_info, dir);
1923 static unsigned int _ebus_dma_addr(struct cs4231_dma_control *dma_cont)
1925 return ebus_dma_addr(&dma_cont->ebus_info);
1929 * Init and exit routines
1932 static int snd_cs4231_ebus_free(struct snd_cs4231 *chip)
1934 struct of_device *op = chip->op;
1936 if (chip->c_dma.ebus_info.regs) {
1937 ebus_dma_unregister(&chip->c_dma.ebus_info);
1938 of_iounmap(&op->resource[2], chip->c_dma.ebus_info.regs, 0x10);
1940 if (chip->p_dma.ebus_info.regs) {
1941 ebus_dma_unregister(&chip->p_dma.ebus_info);
1942 of_iounmap(&op->resource[1], chip->p_dma.ebus_info.regs, 0x10);
1945 if (chip->port)
1946 of_iounmap(&op->resource[0], chip->port, 0x10);
1948 return 0;
1951 static int snd_cs4231_ebus_dev_free(struct snd_device *device)
1953 struct snd_cs4231 *cp = device->device_data;
1955 return snd_cs4231_ebus_free(cp);
1958 static struct snd_device_ops snd_cs4231_ebus_dev_ops = {
1959 .dev_free = snd_cs4231_ebus_dev_free,
1962 static int __devinit snd_cs4231_ebus_create(struct snd_card *card,
1963 struct of_device *op,
1964 int dev)
1966 struct snd_cs4231 *chip = card->private_data;
1967 int err;
1969 spin_lock_init(&chip->lock);
1970 spin_lock_init(&chip->c_dma.ebus_info.lock);
1971 spin_lock_init(&chip->p_dma.ebus_info.lock);
1972 mutex_init(&chip->mce_mutex);
1973 mutex_init(&chip->open_mutex);
1974 chip->flags |= CS4231_FLAG_EBUS;
1975 chip->op = op;
1976 memcpy(&chip->image, &snd_cs4231_original_image,
1977 sizeof(snd_cs4231_original_image));
1978 strcpy(chip->c_dma.ebus_info.name, "cs4231(capture)");
1979 chip->c_dma.ebus_info.flags = EBUS_DMA_FLAG_USE_EBDMA_HANDLER;
1980 chip->c_dma.ebus_info.callback = snd_cs4231_ebus_capture_callback;
1981 chip->c_dma.ebus_info.client_cookie = chip;
1982 chip->c_dma.ebus_info.irq = op->irqs[0];
1983 strcpy(chip->p_dma.ebus_info.name, "cs4231(play)");
1984 chip->p_dma.ebus_info.flags = EBUS_DMA_FLAG_USE_EBDMA_HANDLER;
1985 chip->p_dma.ebus_info.callback = snd_cs4231_ebus_play_callback;
1986 chip->p_dma.ebus_info.client_cookie = chip;
1987 chip->p_dma.ebus_info.irq = op->irqs[1];
1989 chip->p_dma.prepare = _ebus_dma_prepare;
1990 chip->p_dma.enable = _ebus_dma_enable;
1991 chip->p_dma.request = _ebus_dma_request;
1992 chip->p_dma.address = _ebus_dma_addr;
1994 chip->c_dma.prepare = _ebus_dma_prepare;
1995 chip->c_dma.enable = _ebus_dma_enable;
1996 chip->c_dma.request = _ebus_dma_request;
1997 chip->c_dma.address = _ebus_dma_addr;
1999 chip->port = of_ioremap(&op->resource[0], 0, 0x10, "cs4231");
2000 chip->p_dma.ebus_info.regs =
2001 of_ioremap(&op->resource[1], 0, 0x10, "cs4231_pdma");
2002 chip->c_dma.ebus_info.regs =
2003 of_ioremap(&op->resource[2], 0, 0x10, "cs4231_cdma");
2004 if (!chip->port || !chip->p_dma.ebus_info.regs ||
2005 !chip->c_dma.ebus_info.regs) {
2006 snd_cs4231_ebus_free(chip);
2007 snd_printdd("cs4231-%d: Unable to map chip registers.\n", dev);
2008 return -EIO;
2011 if (ebus_dma_register(&chip->c_dma.ebus_info)) {
2012 snd_cs4231_ebus_free(chip);
2013 snd_printdd("cs4231-%d: Unable to register EBUS capture DMA\n",
2014 dev);
2015 return -EBUSY;
2017 if (ebus_dma_irq_enable(&chip->c_dma.ebus_info, 1)) {
2018 snd_cs4231_ebus_free(chip);
2019 snd_printdd("cs4231-%d: Unable to enable EBUS capture IRQ\n",
2020 dev);
2021 return -EBUSY;
2024 if (ebus_dma_register(&chip->p_dma.ebus_info)) {
2025 snd_cs4231_ebus_free(chip);
2026 snd_printdd("cs4231-%d: Unable to register EBUS play DMA\n",
2027 dev);
2028 return -EBUSY;
2030 if (ebus_dma_irq_enable(&chip->p_dma.ebus_info, 1)) {
2031 snd_cs4231_ebus_free(chip);
2032 snd_printdd("cs4231-%d: Unable to enable EBUS play IRQ\n", dev);
2033 return -EBUSY;
2036 if (snd_cs4231_probe(chip) < 0) {
2037 snd_cs4231_ebus_free(chip);
2038 return -ENODEV;
2040 snd_cs4231_init(chip);
2042 if ((err = snd_device_new(card, SNDRV_DEV_LOWLEVEL,
2043 chip, &snd_cs4231_ebus_dev_ops)) < 0) {
2044 snd_cs4231_ebus_free(chip);
2045 return err;
2048 return 0;
2051 static int __devinit cs4231_ebus_probe(struct of_device *op, const struct of_device_id *match)
2053 struct snd_card *card;
2054 int err;
2056 err = cs4231_attach_begin(&card);
2057 if (err)
2058 return err;
2060 sprintf(card->longname, "%s at 0x%llx, irq %d",
2061 card->shortname,
2062 op->resource[0].start,
2063 op->irqs[0]);
2065 err = snd_cs4231_ebus_create(card, op, dev);
2066 if (err < 0) {
2067 snd_card_free(card);
2068 return err;
2071 return cs4231_attach_finish(card);
2073 #endif
2075 static int __devinit cs4231_probe(struct of_device *op, const struct of_device_id *match)
2077 #ifdef EBUS_SUPPORT
2078 if (!strcmp(op->node->parent->name, "ebus"))
2079 return cs4231_ebus_probe(op, match);
2080 #endif
2081 #ifdef SBUS_SUPPORT
2082 if (!strcmp(op->node->parent->name, "sbus") ||
2083 !strcmp(op->node->parent->name, "sbi"))
2084 return cs4231_sbus_probe(op, match);
2085 #endif
2086 return -ENODEV;
2089 static int __devexit cs4231_remove(struct of_device *op)
2091 struct snd_cs4231 *chip = dev_get_drvdata(&op->dev);
2093 snd_card_free(chip->card);
2095 return 0;
2098 static const struct of_device_id cs4231_match[] = {
2100 .name = "SUNW,CS4231",
2103 .name = "audio",
2104 .compatible = "SUNW,CS4231",
2109 MODULE_DEVICE_TABLE(of, cs4231_match);
2111 static struct of_platform_driver cs4231_driver = {
2112 .name = "audio",
2113 .match_table = cs4231_match,
2114 .probe = cs4231_probe,
2115 .remove = __devexit_p(cs4231_remove),
2118 static int __init cs4231_init(void)
2120 return of_register_driver(&cs4231_driver, &of_bus_type);
2123 static void __exit cs4231_exit(void)
2125 of_unregister_driver(&cs4231_driver);
2128 module_init(cs4231_init);
2129 module_exit(cs4231_exit);