cs4231.c 57.4 KB
Newer Older
L
Linus Torvalds 已提交
1 2
/*
 * Driver for CS4231 sound chips found on Sparcs.
3
 * Copyright (C) 2002, 2008 David S. Miller <davem@davemloft.net>
L
Linus Torvalds 已提交
4 5
 *
 * Based entirely upon drivers/sbus/audio/cs4231.c which is:
6
 * Copyright (C) 1996, 1997, 1998 Derrick J Brashear (shadow@andrew.cmu.edu)
L
Linus Torvalds 已提交
7
 * and also sound/isa/cs423x/cs4231_lib.c which is:
8
 * Copyright (c) by Jaroslav Kysela <perex@perex.cz>
L
Linus Torvalds 已提交
9 10 11 12 13 14 15 16 17
 */

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/slab.h>
#include <linux/delay.h>
#include <linux/init.h>
#include <linux/interrupt.h>
#include <linux/moduleparam.h>
18 19
#include <linux/irq.h>
#include <linux/io.h>
20 21
#include <linux/of.h>
#include <linux/of_device.h>
L
Linus Torvalds 已提交
22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42

#include <sound/core.h>
#include <sound/pcm.h>
#include <sound/info.h>
#include <sound/control.h>
#include <sound/timer.h>
#include <sound/initval.h>
#include <sound/pcm_params.h>

#ifdef CONFIG_SBUS
#define SBUS_SUPPORT
#endif

#if defined(CONFIG_PCI) && defined(CONFIG_SPARC64)
#define EBUS_SUPPORT
#include <linux/pci.h>
#include <asm/ebus.h>
#endif

static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;	/* Index 0-MAX */
static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;	/* ID for this card */
43 44
/* Enable this card */
static int enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;
L
Linus Torvalds 已提交
45 46 47 48 49 50 51 52 53 54 55 56

module_param_array(index, int, NULL, 0444);
MODULE_PARM_DESC(index, "Index value for Sun CS4231 soundcard.");
module_param_array(id, charp, NULL, 0444);
MODULE_PARM_DESC(id, "ID string for Sun CS4231 soundcard.");
module_param_array(enable, bool, NULL, 0444);
MODULE_PARM_DESC(enable, "Enable Sun CS4231 soundcard.");
MODULE_AUTHOR("Jaroslav Kysela, Derrick J. Brashear and David S. Miller");
MODULE_DESCRIPTION("Sun CS4231");
MODULE_LICENSE("GPL");
MODULE_SUPPORTED_DEVICE("{{Sun,CS4231}}");

57
#ifdef SBUS_SUPPORT
58
struct sbus_dma_info {
59 60 61
       spinlock_t	lock;	/* DMA access lock */
       int		dir;
       void __iomem	*regs;
62
};
63 64
#endif

65
struct snd_cs4231;
66
struct cs4231_dma_control {
67 68 69 70 71 72 73 74
	void		(*prepare)(struct cs4231_dma_control *dma_cont,
				   int dir);
	void		(*enable)(struct cs4231_dma_control *dma_cont, int on);
	int		(*request)(struct cs4231_dma_control *dma_cont,
				   dma_addr_t bus_addr, size_t len);
	unsigned int	(*address)(struct cs4231_dma_control *dma_cont);
	void		(*preallocate)(struct snd_cs4231 *chip,
				       struct snd_pcm *pcm);
L
Linus Torvalds 已提交
75
#ifdef EBUS_SUPPORT
76
	struct		ebus_dma_info	ebus_info;
L
Linus Torvalds 已提交
77
#endif
78
#ifdef SBUS_SUPPORT
79
	struct		sbus_dma_info	sbus_info;
80
#endif
81
};
82 83

struct snd_cs4231 {
84
	spinlock_t		lock;	/* registers access lock */
85 86
	void __iomem		*port;

87 88
	struct cs4231_dma_control	p_dma;
	struct cs4231_dma_control	c_dma;
89

L
Linus Torvalds 已提交
90 91 92 93 94
	u32			flags;
#define CS4231_FLAG_EBUS	0x00000001
#define CS4231_FLAG_PLAYBACK	0x00000002
#define CS4231_FLAG_CAPTURE	0x00000004

95 96 97
	struct snd_card		*card;
	struct snd_pcm		*pcm;
	struct snd_pcm_substream	*playback_substream;
L
Linus Torvalds 已提交
98
	unsigned int		p_periods_sent;
99
	struct snd_pcm_substream	*capture_substream;
L
Linus Torvalds 已提交
100
	unsigned int		c_periods_sent;
101
	struct snd_timer	*timer;
L
Linus Torvalds 已提交
102 103 104 105 106 107

	unsigned short mode;
#define CS4231_MODE_NONE	0x0000
#define CS4231_MODE_PLAY	0x0001
#define CS4231_MODE_RECORD	0x0002
#define CS4231_MODE_TIMER	0x0004
108 109
#define CS4231_MODE_OPEN	(CS4231_MODE_PLAY | CS4231_MODE_RECORD | \
				 CS4231_MODE_TIMER)
L
Linus Torvalds 已提交
110 111 112 113

	unsigned char		image[32];	/* registers image */
	int			mce_bit;
	int			calibrate_mute;
114 115
	struct mutex		mce_mutex;	/* mutex for mce register */
	struct mutex		open_mutex;	/* mutex for ALSA open/close */
L
Linus Torvalds 已提交
116 117 118

	union {
#ifdef SBUS_SUPPORT
119
		struct of_device	*op;
L
Linus Torvalds 已提交
120 121 122 123 124 125 126 127
#endif
#ifdef EBUS_SUPPORT
		struct pci_dev		*pdev;
#endif
	} dev_u;
	unsigned int		irq[2];
	unsigned int		regs_size;
	struct snd_cs4231	*next;
128
};
L
Linus Torvalds 已提交
129

130
static struct snd_cs4231 *cs4231_list;
L
Linus Torvalds 已提交
131 132 133 134 135 136

/* Eventually we can use sound/isa/cs423x/cs4231_lib.c directly, but for
 * now....  -DaveM
 */

/* IO ports */
137
#include <sound/cs4231-regs.h>
L
Linus Torvalds 已提交
138 139

/* XXX offsets are different than PC ISA chips... */
140
#define CS4231U(chip, x)	((chip)->port + ((c_d_c_CS4231##x) << 2))
L
Linus Torvalds 已提交
141 142 143 144 145 146 147 148 149 150 151 152 153

/* SBUS DMA register defines.  */

#define APCCSR	0x10UL	/* APC DMA CSR */
#define APCCVA	0x20UL	/* APC Capture DMA Address */
#define APCCC	0x24UL	/* APC Capture Count */
#define APCCNVA	0x28UL	/* APC Capture DMA Next Address */
#define APCCNC	0x2cUL	/* APC Capture Next Count */
#define APCPVA	0x30UL	/* APC Play DMA Address */
#define APCPC	0x34UL	/* APC Play Count */
#define APCPNVA	0x38UL	/* APC Play DMA Next Address */
#define APCPNC	0x3cUL	/* APC Play Next Count */

154 155 156 157 158 159 160 161 162
/* Defines for SBUS DMA-routines */

#define APCVA  0x0UL	/* APC DMA Address */
#define APCC   0x4UL	/* APC Count */
#define APCNVA 0x8UL	/* APC DMA Next Address */
#define APCNC  0xcUL	/* APC Next Count */
#define APC_PLAY 0x30UL	/* Play registers start at 0x30 */
#define APC_RECORD 0x20UL /* Record registers start at 0x20 */

L
Linus Torvalds 已提交
163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219
/* APCCSR bits */

#define APC_INT_PENDING 0x800000 /* Interrupt Pending */
#define APC_PLAY_INT    0x400000 /* Playback interrupt */
#define APC_CAPT_INT    0x200000 /* Capture interrupt */
#define APC_GENL_INT    0x100000 /* General interrupt */
#define APC_XINT_ENA    0x80000  /* General ext int. enable */
#define APC_XINT_PLAY   0x40000  /* Playback ext intr */
#define APC_XINT_CAPT   0x20000  /* Capture ext intr */
#define APC_XINT_GENL   0x10000  /* Error ext intr */
#define APC_XINT_EMPT   0x8000   /* Pipe empty interrupt (0 write to pva) */
#define APC_XINT_PEMP   0x4000   /* Play pipe empty (pva and pnva not set) */
#define APC_XINT_PNVA   0x2000   /* Playback NVA dirty */
#define APC_XINT_PENA   0x1000   /* play pipe empty Int enable */
#define APC_XINT_COVF   0x800    /* Cap data dropped on floor */
#define APC_XINT_CNVA   0x400    /* Capture NVA dirty */
#define APC_XINT_CEMP   0x200    /* Capture pipe empty (cva and cnva not set) */
#define APC_XINT_CENA   0x100    /* Cap. pipe empty int enable */
#define APC_PPAUSE      0x80     /* Pause the play DMA */
#define APC_CPAUSE      0x40     /* Pause the capture DMA */
#define APC_CDC_RESET   0x20     /* CODEC RESET */
#define APC_PDMA_READY  0x08     /* Play DMA Go */
#define APC_CDMA_READY  0x04     /* Capture DMA Go */
#define APC_CHIP_RESET  0x01     /* Reset the chip */

/* EBUS DMA register offsets  */

#define EBDMA_CSR	0x00UL	/* Control/Status */
#define EBDMA_ADDR	0x04UL	/* DMA Address */
#define EBDMA_COUNT	0x08UL	/* DMA Count */

/*
 *  Some variables
 */

static unsigned char freq_bits[14] = {
	/* 5510 */	0x00 | CS4231_XTAL2,
	/* 6620 */	0x0E | CS4231_XTAL2,
	/* 8000 */	0x00 | CS4231_XTAL1,
	/* 9600 */	0x0E | CS4231_XTAL1,
	/* 11025 */	0x02 | CS4231_XTAL2,
	/* 16000 */	0x02 | CS4231_XTAL1,
	/* 18900 */	0x04 | CS4231_XTAL2,
	/* 22050 */	0x06 | CS4231_XTAL2,
	/* 27042 */	0x04 | CS4231_XTAL1,
	/* 32000 */	0x06 | CS4231_XTAL1,
	/* 33075 */	0x0C | CS4231_XTAL2,
	/* 37800 */	0x08 | CS4231_XTAL2,
	/* 44100 */	0x0A | CS4231_XTAL2,
	/* 48000 */	0x0C | CS4231_XTAL1
};

static unsigned int rates[14] = {
	5510, 6620, 8000, 9600, 11025, 16000, 18900, 22050,
	27042, 32000, 33075, 37800, 44100, 48000
};

220
static struct snd_pcm_hw_constraint_list hw_constraints_rates = {
221
	.count	= ARRAY_SIZE(rates),
L
Linus Torvalds 已提交
222 223 224
	.list	= rates,
};

225
static int snd_cs4231_xrate(struct snd_pcm_runtime *runtime)
L
Linus Torvalds 已提交
226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267
{
	return snd_pcm_hw_constraint_list(runtime, 0,
					  SNDRV_PCM_HW_PARAM_RATE,
					  &hw_constraints_rates);
}

static unsigned char snd_cs4231_original_image[32] =
{
	0x00,			/* 00/00 - lic */
	0x00,			/* 01/01 - ric */
	0x9f,			/* 02/02 - la1ic */
	0x9f,			/* 03/03 - ra1ic */
	0x9f,			/* 04/04 - la2ic */
	0x9f,			/* 05/05 - ra2ic */
	0xbf,			/* 06/06 - loc */
	0xbf,			/* 07/07 - roc */
	0x20,			/* 08/08 - pdfr */
	CS4231_AUTOCALIB,	/* 09/09 - ic */
	0x00,			/* 0a/10 - pc */
	0x00,			/* 0b/11 - ti */
	CS4231_MODE2,		/* 0c/12 - mi */
	0x00,			/* 0d/13 - lbc */
	0x00,			/* 0e/14 - pbru */
	0x00,			/* 0f/15 - pbrl */
	0x80,			/* 10/16 - afei */
	0x01,			/* 11/17 - afeii */
	0x9f,			/* 12/18 - llic */
	0x9f,			/* 13/19 - rlic */
	0x00,			/* 14/20 - tlb */
	0x00,			/* 15/21 - thb */
	0x00,			/* 16/22 - la3mic/reserved */
	0x00,			/* 17/23 - ra3mic/reserved */
	0x00,			/* 18/24 - afs */
	0x00,			/* 19/25 - lamoc/version */
	0x00,			/* 1a/26 - mioc */
	0x00,			/* 1b/27 - ramoc/reserved */
	0x20,			/* 1c/28 - cdfr */
	0x00,			/* 1d/29 - res4 */
	0x00,			/* 1e/30 - cbru */
	0x00,			/* 1f/31 - cbrl */
};

268
static u8 __cs4231_readb(struct snd_cs4231 *cp, void __iomem *reg_addr)
L
Linus Torvalds 已提交
269 270
{
#ifdef EBUS_SUPPORT
271
	if (cp->flags & CS4231_FLAG_EBUS)
L
Linus Torvalds 已提交
272
		return readb(reg_addr);
273
	else
L
Linus Torvalds 已提交
274 275 276 277 278 279
#endif
#ifdef SBUS_SUPPORT
		return sbus_readb(reg_addr);
#endif
}

280 281
static void __cs4231_writeb(struct snd_cs4231 *cp, u8 val,
			    void __iomem *reg_addr)
L
Linus Torvalds 已提交
282 283
{
#ifdef EBUS_SUPPORT
284
	if (cp->flags & CS4231_FLAG_EBUS)
L
Linus Torvalds 已提交
285
		return writeb(val, reg_addr);
286
	else
L
Linus Torvalds 已提交
287 288 289 290 291 292 293 294 295 296
#endif
#ifdef SBUS_SUPPORT
		return sbus_writeb(val, reg_addr);
#endif
}

/*
 *  Basic I/O functions
 */

297
static void snd_cs4231_ready(struct snd_cs4231 *chip)
L
Linus Torvalds 已提交
298 299 300
{
	int timeout;

301 302 303 304 305 306
	for (timeout = 250; timeout > 0; timeout--) {
		int val = __cs4231_readb(chip, CS4231U(chip, REGSEL));
		if ((val & CS4231_INIT) == 0)
			break;
		udelay(100);
	}
L
Linus Torvalds 已提交
307 308
}

309 310
static void snd_cs4231_dout(struct snd_cs4231 *chip, unsigned char reg,
			    unsigned char value)
L
Linus Torvalds 已提交
311
{
312
	snd_cs4231_ready(chip);
313
#ifdef CONFIG_SND_DEBUG
314
	if (__cs4231_readb(chip, CS4231U(chip, REGSEL)) & CS4231_INIT)
315 316 317
		snd_printdd("out: auto calibration time out - reg = 0x%x, "
			    "value = 0x%x\n",
			    reg, value);
318
#endif
319
	__cs4231_writeb(chip, chip->mce_bit | reg, CS4231U(chip, REGSEL));
320
	wmb();
321
	__cs4231_writeb(chip, value, CS4231U(chip, REG));
L
Linus Torvalds 已提交
322 323 324
	mb();
}

325 326
static inline void snd_cs4231_outm(struct snd_cs4231 *chip, unsigned char reg,
		     unsigned char mask, unsigned char value)
L
Linus Torvalds 已提交
327
{
328
	unsigned char tmp = (chip->image[reg] & mask) | value;
L
Linus Torvalds 已提交
329

330 331 332 333 334 335 336 337 338
	chip->image[reg] = tmp;
	if (!chip->calibrate_mute)
		snd_cs4231_dout(chip, reg, tmp);
}

static void snd_cs4231_out(struct snd_cs4231 *chip, unsigned char reg,
			   unsigned char value)
{
	snd_cs4231_dout(chip, reg, value);
L
Linus Torvalds 已提交
339 340 341 342
	chip->image[reg] = value;
	mb();
}

343
static unsigned char snd_cs4231_in(struct snd_cs4231 *chip, unsigned char reg)
L
Linus Torvalds 已提交
344
{
345
	snd_cs4231_ready(chip);
L
Linus Torvalds 已提交
346
#ifdef CONFIG_SND_DEBUG
347
	if (__cs4231_readb(chip, CS4231U(chip, REGSEL)) & CS4231_INIT)
348 349
		snd_printdd("in: auto calibration time out - reg = 0x%x\n",
			    reg);
L
Linus Torvalds 已提交
350
#endif
351
	__cs4231_writeb(chip, chip->mce_bit | reg, CS4231U(chip, REGSEL));
L
Linus Torvalds 已提交
352
	mb();
353
	return __cs4231_readb(chip, CS4231U(chip, REG));
L
Linus Torvalds 已提交
354 355 356 357 358 359
}

/*
 *  CS4231 detection / MCE routines
 */

360
static void snd_cs4231_busy_wait(struct snd_cs4231 *chip)
L
Linus Torvalds 已提交
361 362 363
{
	int timeout;

364
	/* looks like this sequence is proper for CS4231A chip (GUS MAX) */
L
Linus Torvalds 已提交
365
	for (timeout = 5; timeout > 0; timeout--)
366
		__cs4231_readb(chip, CS4231U(chip, REGSEL));
367

L
Linus Torvalds 已提交
368
	/* end of cleanup sequence */
369 370 371 372
	for (timeout = 500; timeout > 0; timeout--) {
		int val = __cs4231_readb(chip, CS4231U(chip, REGSEL));
		if ((val & CS4231_INIT) == 0)
			break;
373
		msleep(1);
374
	}
L
Linus Torvalds 已提交
375 376
}

377
static void snd_cs4231_mce_up(struct snd_cs4231 *chip)
L
Linus Torvalds 已提交
378 379 380 381 382
{
	unsigned long flags;
	int timeout;

	spin_lock_irqsave(&chip->lock, flags);
383
	snd_cs4231_ready(chip);
L
Linus Torvalds 已提交
384
#ifdef CONFIG_SND_DEBUG
385
	if (__cs4231_readb(chip, CS4231U(chip, REGSEL)) & CS4231_INIT)
386
		snd_printdd("mce_up - auto calibration time out (0)\n");
L
Linus Torvalds 已提交
387 388
#endif
	chip->mce_bit |= CS4231_MCE;
389
	timeout = __cs4231_readb(chip, CS4231U(chip, REGSEL));
L
Linus Torvalds 已提交
390
	if (timeout == 0x80)
391 392 393
		snd_printdd("mce_up [%p]: serious init problem - "
			    "codec still busy\n",
			    chip->port);
L
Linus Torvalds 已提交
394
	if (!(timeout & CS4231_MCE))
395 396
		__cs4231_writeb(chip, chip->mce_bit | (timeout & 0x1f),
				CS4231U(chip, REGSEL));
L
Linus Torvalds 已提交
397 398 399
	spin_unlock_irqrestore(&chip->lock, flags);
}

400
static void snd_cs4231_mce_down(struct snd_cs4231 *chip)
L
Linus Torvalds 已提交
401
{
402 403
	unsigned long flags, timeout;
	int reg;
L
Linus Torvalds 已提交
404 405

	snd_cs4231_busy_wait(chip);
406
	spin_lock_irqsave(&chip->lock, flags);
L
Linus Torvalds 已提交
407
#ifdef CONFIG_SND_DEBUG
408 409 410
	if (__cs4231_readb(chip, CS4231U(chip, REGSEL)) & CS4231_INIT)
		snd_printdd("mce_down [%p] - auto calibration time out (0)\n",
			    CS4231U(chip, REGSEL));
L
Linus Torvalds 已提交
411 412
#endif
	chip->mce_bit &= ~CS4231_MCE;
413 414
	reg = __cs4231_readb(chip, CS4231U(chip, REGSEL));
	__cs4231_writeb(chip, chip->mce_bit | (reg & 0x1f),
415
			CS4231U(chip, REGSEL));
416 417 418 419
	if (reg == 0x80)
		snd_printdd("mce_down [%p]: serious init problem "
			    "- codec still busy\n", chip->port);
	if ((reg & CS4231_MCE) == 0) {
L
Linus Torvalds 已提交
420 421 422 423
		spin_unlock_irqrestore(&chip->lock, flags);
		return;
	}

424
	/*
425
	 * Wait for auto-calibration (AC) process to finish, i.e. ACI to go low.
426
	 */
427 428
	timeout = jiffies + msecs_to_jiffies(250);
	do {
L
Linus Torvalds 已提交
429
		spin_unlock_irqrestore(&chip->lock, flags);
430
		msleep(1);
L
Linus Torvalds 已提交
431
		spin_lock_irqsave(&chip->lock, flags);
432 433 434
		reg = snd_cs4231_in(chip, CS4231_TEST_INIT);
		reg &= CS4231_CALIB_IN_PROGRESS;
	} while (reg && time_before(jiffies, timeout));
L
Linus Torvalds 已提交
435
	spin_unlock_irqrestore(&chip->lock, flags);
436 437 438 439

	if (reg)
		snd_printk(KERN_ERR
			   "mce_down - auto calibration time out (2)\n");
L
Linus Torvalds 已提交
440 441
}

442 443 444
static void snd_cs4231_advance_dma(struct cs4231_dma_control *dma_cont,
				   struct snd_pcm_substream *substream,
				   unsigned int *periods_sent)
L
Linus Torvalds 已提交
445
{
446
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
447 448

	while (1) {
449 450
		unsigned int period_size = snd_pcm_lib_period_bytes(substream);
		unsigned int offset = period_size * (*periods_sent);
L
Linus Torvalds 已提交
451

452
		BUG_ON(period_size >= (1 << 24));
L
Linus Torvalds 已提交
453

454 455
		if (dma_cont->request(dma_cont,
				      runtime->dma_addr + offset, period_size))
L
Linus Torvalds 已提交
456 457 458 459
			return;
		(*periods_sent) = ((*periods_sent) + 1) % runtime->periods;
	}
}
460

461 462
static void cs4231_dma_trigger(struct snd_pcm_substream *substream,
			       unsigned int what, int on)
L
Linus Torvalds 已提交
463
{
464 465
	struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
	struct cs4231_dma_control *dma_cont;
466

467
	if (what & CS4231_PLAYBACK_ENABLE) {
468
		dma_cont = &chip->p_dma;
469
		if (on) {
470 471 472
			dma_cont->prepare(dma_cont, 0);
			dma_cont->enable(dma_cont, 1);
			snd_cs4231_advance_dma(dma_cont,
473 474
				chip->playback_substream,
				&chip->p_periods_sent);
475
		} else {
476
			dma_cont->enable(dma_cont, 0);
477
		}
478 479
	}
	if (what & CS4231_RECORD_ENABLE) {
480
		dma_cont = &chip->c_dma;
481
		if (on) {
482 483 484
			dma_cont->prepare(dma_cont, 1);
			dma_cont->enable(dma_cont, 1);
			snd_cs4231_advance_dma(dma_cont,
485 486
				chip->capture_substream,
				&chip->c_periods_sent);
487
		} else {
488
			dma_cont->enable(dma_cont, 0);
489 490
		}
	}
L
Linus Torvalds 已提交
491 492
}

493
static int snd_cs4231_trigger(struct snd_pcm_substream *substream, int cmd)
L
Linus Torvalds 已提交
494
{
495
	struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
L
Linus Torvalds 已提交
496 497 498 499 500 501 502
	int result = 0;

	switch (cmd) {
	case SNDRV_PCM_TRIGGER_START:
	case SNDRV_PCM_TRIGGER_STOP:
	{
		unsigned int what = 0;
503
		struct snd_pcm_substream *s;
L
Linus Torvalds 已提交
504 505
		unsigned long flags;

506
		snd_pcm_group_for_each_entry(s, substream) {
L
Linus Torvalds 已提交
507 508 509 510 511 512 513 514 515 516 517
			if (s == chip->playback_substream) {
				what |= CS4231_PLAYBACK_ENABLE;
				snd_pcm_trigger_done(s, substream);
			} else if (s == chip->capture_substream) {
				what |= CS4231_RECORD_ENABLE;
				snd_pcm_trigger_done(s, substream);
			}
		}

		spin_lock_irqsave(&chip->lock, flags);
		if (cmd == SNDRV_PCM_TRIGGER_START) {
518
			cs4231_dma_trigger(substream, what, 1);
L
Linus Torvalds 已提交
519 520
			chip->image[CS4231_IFACE_CTRL] |= what;
		} else {
521
			cs4231_dma_trigger(substream, what, 0);
L
Linus Torvalds 已提交
522 523 524 525 526 527 528 529 530 531 532
			chip->image[CS4231_IFACE_CTRL] &= ~what;
		}
		snd_cs4231_out(chip, CS4231_IFACE_CTRL,
			       chip->image[CS4231_IFACE_CTRL]);
		spin_unlock_irqrestore(&chip->lock, flags);
		break;
	}
	default:
		result = -EINVAL;
		break;
	}
533

L
Linus Torvalds 已提交
534 535 536 537 538 539 540 541 542 543 544 545 546 547
	return result;
}

/*
 *  CODEC I/O
 */

static unsigned char snd_cs4231_get_rate(unsigned int rate)
{
	int i;

	for (i = 0; i < 14; i++)
		if (rate == rates[i])
			return freq_bits[i];
548

L
Linus Torvalds 已提交
549 550 551
	return freq_bits[13];
}

552 553
static unsigned char snd_cs4231_get_format(struct snd_cs4231 *chip, int format,
					   int channels)
L
Linus Torvalds 已提交
554 555 556 557 558
{
	unsigned char rformat;

	rformat = CS4231_LINEAR_8;
	switch (format) {
559 560 561 562 563 564 565 566 567 568 569 570 571 572 573
	case SNDRV_PCM_FORMAT_MU_LAW:
		rformat = CS4231_ULAW_8;
		break;
	case SNDRV_PCM_FORMAT_A_LAW:
		rformat = CS4231_ALAW_8;
		break;
	case SNDRV_PCM_FORMAT_S16_LE:
		rformat = CS4231_LINEAR_16;
		break;
	case SNDRV_PCM_FORMAT_S16_BE:
		rformat = CS4231_LINEAR_16_BIG;
		break;
	case SNDRV_PCM_FORMAT_IMA_ADPCM:
		rformat = CS4231_ADPCM_16;
		break;
L
Linus Torvalds 已提交
574 575 576 577 578 579
	}
	if (channels > 1)
		rformat |= CS4231_STEREO;
	return rformat;
}

580
static void snd_cs4231_calibrate_mute(struct snd_cs4231 *chip, int mute)
L
Linus Torvalds 已提交
581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619
{
	unsigned long flags;

	mute = mute ? 1 : 0;
	spin_lock_irqsave(&chip->lock, flags);
	if (chip->calibrate_mute == mute) {
		spin_unlock_irqrestore(&chip->lock, flags);
		return;
	}
	if (!mute) {
		snd_cs4231_dout(chip, CS4231_LEFT_INPUT,
				chip->image[CS4231_LEFT_INPUT]);
		snd_cs4231_dout(chip, CS4231_RIGHT_INPUT,
				chip->image[CS4231_RIGHT_INPUT]);
		snd_cs4231_dout(chip, CS4231_LOOPBACK,
				chip->image[CS4231_LOOPBACK]);
	}
	snd_cs4231_dout(chip, CS4231_AUX1_LEFT_INPUT,
			mute ? 0x80 : chip->image[CS4231_AUX1_LEFT_INPUT]);
	snd_cs4231_dout(chip, CS4231_AUX1_RIGHT_INPUT,
			mute ? 0x80 : chip->image[CS4231_AUX1_RIGHT_INPUT]);
	snd_cs4231_dout(chip, CS4231_AUX2_LEFT_INPUT,
			mute ? 0x80 : chip->image[CS4231_AUX2_LEFT_INPUT]);
	snd_cs4231_dout(chip, CS4231_AUX2_RIGHT_INPUT,
			mute ? 0x80 : chip->image[CS4231_AUX2_RIGHT_INPUT]);
	snd_cs4231_dout(chip, CS4231_LEFT_OUTPUT,
			mute ? 0x80 : chip->image[CS4231_LEFT_OUTPUT]);
	snd_cs4231_dout(chip, CS4231_RIGHT_OUTPUT,
			mute ? 0x80 : chip->image[CS4231_RIGHT_OUTPUT]);
	snd_cs4231_dout(chip, CS4231_LEFT_LINE_IN,
			mute ? 0x80 : chip->image[CS4231_LEFT_LINE_IN]);
	snd_cs4231_dout(chip, CS4231_RIGHT_LINE_IN,
			mute ? 0x80 : chip->image[CS4231_RIGHT_LINE_IN]);
	snd_cs4231_dout(chip, CS4231_MONO_CTRL,
			mute ? 0xc0 : chip->image[CS4231_MONO_CTRL]);
	chip->calibrate_mute = mute;
	spin_unlock_irqrestore(&chip->lock, flags);
}

620 621
static void snd_cs4231_playback_format(struct snd_cs4231 *chip,
				       struct snd_pcm_hw_params *params,
L
Linus Torvalds 已提交
622 623 624 625
				       unsigned char pdfr)
{
	unsigned long flags;

626
	mutex_lock(&chip->mce_mutex);
L
Linus Torvalds 已提交
627 628 629 630 631 632 633 634 635 636 637 638 639 640
	snd_cs4231_calibrate_mute(chip, 1);

	snd_cs4231_mce_up(chip);

	spin_lock_irqsave(&chip->lock, flags);
	snd_cs4231_out(chip, CS4231_PLAYBK_FORMAT,
		       (chip->image[CS4231_IFACE_CTRL] & CS4231_RECORD_ENABLE) ?
		       (pdfr & 0xf0) | (chip->image[CS4231_REC_FORMAT] & 0x0f) :
		       pdfr);
	spin_unlock_irqrestore(&chip->lock, flags);

	snd_cs4231_mce_down(chip);

	snd_cs4231_calibrate_mute(chip, 0);
641
	mutex_unlock(&chip->mce_mutex);
L
Linus Torvalds 已提交
642 643
}

644 645 646
static void snd_cs4231_capture_format(struct snd_cs4231 *chip,
				      struct snd_pcm_hw_params *params,
				      unsigned char cdfr)
L
Linus Torvalds 已提交
647 648 649
{
	unsigned long flags;

650
	mutex_lock(&chip->mce_mutex);
L
Linus Torvalds 已提交
651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670
	snd_cs4231_calibrate_mute(chip, 1);

	snd_cs4231_mce_up(chip);

	spin_lock_irqsave(&chip->lock, flags);
	if (!(chip->image[CS4231_IFACE_CTRL] & CS4231_PLAYBACK_ENABLE)) {
		snd_cs4231_out(chip, CS4231_PLAYBK_FORMAT,
			       ((chip->image[CS4231_PLAYBK_FORMAT]) & 0xf0) |
			       (cdfr & 0x0f));
		spin_unlock_irqrestore(&chip->lock, flags);
		snd_cs4231_mce_down(chip);
		snd_cs4231_mce_up(chip);
		spin_lock_irqsave(&chip->lock, flags);
	}
	snd_cs4231_out(chip, CS4231_REC_FORMAT, cdfr);
	spin_unlock_irqrestore(&chip->lock, flags);

	snd_cs4231_mce_down(chip);

	snd_cs4231_calibrate_mute(chip, 0);
671
	mutex_unlock(&chip->mce_mutex);
L
Linus Torvalds 已提交
672 673 674 675 676 677
}

/*
 *  Timer interface
 */

678
static unsigned long snd_cs4231_timer_resolution(struct snd_timer *timer)
L
Linus Torvalds 已提交
679
{
680
	struct snd_cs4231 *chip = snd_timer_chip(timer);
L
Linus Torvalds 已提交
681 682 683 684

	return chip->image[CS4231_PLAYBK_FORMAT] & 1 ? 9969 : 9920;
}

685
static int snd_cs4231_timer_start(struct snd_timer *timer)
L
Linus Torvalds 已提交
686 687 688
{
	unsigned long flags;
	unsigned int ticks;
689
	struct snd_cs4231 *chip = snd_timer_chip(timer);
L
Linus Torvalds 已提交
690 691 692 693 694 695 696 697 698 699 700 701 702

	spin_lock_irqsave(&chip->lock, flags);
	ticks = timer->sticks;
	if ((chip->image[CS4231_ALT_FEATURE_1] & CS4231_TIMER_ENABLE) == 0 ||
	    (unsigned char)(ticks >> 8) != chip->image[CS4231_TIMER_HIGH] ||
	    (unsigned char)ticks != chip->image[CS4231_TIMER_LOW]) {
		snd_cs4231_out(chip, CS4231_TIMER_HIGH,
			       chip->image[CS4231_TIMER_HIGH] =
			       (unsigned char) (ticks >> 8));
		snd_cs4231_out(chip, CS4231_TIMER_LOW,
			       chip->image[CS4231_TIMER_LOW] =
			       (unsigned char) ticks);
		snd_cs4231_out(chip, CS4231_ALT_FEATURE_1,
703 704
			       chip->image[CS4231_ALT_FEATURE_1] |
					CS4231_TIMER_ENABLE);
L
Linus Torvalds 已提交
705 706 707 708 709 710
	}
	spin_unlock_irqrestore(&chip->lock, flags);

	return 0;
}

711
static int snd_cs4231_timer_stop(struct snd_timer *timer)
L
Linus Torvalds 已提交
712 713
{
	unsigned long flags;
714
	struct snd_cs4231 *chip = snd_timer_chip(timer);
L
Linus Torvalds 已提交
715 716

	spin_lock_irqsave(&chip->lock, flags);
717
	chip->image[CS4231_ALT_FEATURE_1] &= ~CS4231_TIMER_ENABLE;
L
Linus Torvalds 已提交
718
	snd_cs4231_out(chip, CS4231_ALT_FEATURE_1,
719
		       chip->image[CS4231_ALT_FEATURE_1]);
L
Linus Torvalds 已提交
720 721 722 723 724
	spin_unlock_irqrestore(&chip->lock, flags);

	return 0;
}

725
static void __init snd_cs4231_init(struct snd_cs4231 *chip)
L
Linus Torvalds 已提交
726 727 728 729 730 731
{
	unsigned long flags;

	snd_cs4231_mce_down(chip);

#ifdef SNDRV_DEBUG_MCE
732
	snd_printdd("init: (1)\n");
L
Linus Torvalds 已提交
733 734 735
#endif
	snd_cs4231_mce_up(chip);
	spin_lock_irqsave(&chip->lock, flags);
736 737 738 739
	chip->image[CS4231_IFACE_CTRL] &= ~(CS4231_PLAYBACK_ENABLE |
					    CS4231_PLAYBACK_PIO |
					    CS4231_RECORD_ENABLE |
					    CS4231_RECORD_PIO |
L
Linus Torvalds 已提交
740 741 742 743 744 745 746
					    CS4231_CALIB_MODE);
	chip->image[CS4231_IFACE_CTRL] |= CS4231_AUTOCALIB;
	snd_cs4231_out(chip, CS4231_IFACE_CTRL, chip->image[CS4231_IFACE_CTRL]);
	spin_unlock_irqrestore(&chip->lock, flags);
	snd_cs4231_mce_down(chip);

#ifdef SNDRV_DEBUG_MCE
747
	snd_printdd("init: (2)\n");
L
Linus Torvalds 已提交
748 749 750 751
#endif

	snd_cs4231_mce_up(chip);
	spin_lock_irqsave(&chip->lock, flags);
752 753
	snd_cs4231_out(chip, CS4231_ALT_FEATURE_1,
			chip->image[CS4231_ALT_FEATURE_1]);
L
Linus Torvalds 已提交
754 755 756 757
	spin_unlock_irqrestore(&chip->lock, flags);
	snd_cs4231_mce_down(chip);

#ifdef SNDRV_DEBUG_MCE
758 759
	snd_printdd("init: (3) - afei = 0x%x\n",
		    chip->image[CS4231_ALT_FEATURE_1]);
L
Linus Torvalds 已提交
760 761 762
#endif

	spin_lock_irqsave(&chip->lock, flags);
763 764
	snd_cs4231_out(chip, CS4231_ALT_FEATURE_2,
			chip->image[CS4231_ALT_FEATURE_2]);
L
Linus Torvalds 已提交
765 766 767 768
	spin_unlock_irqrestore(&chip->lock, flags);

	snd_cs4231_mce_up(chip);
	spin_lock_irqsave(&chip->lock, flags);
769 770
	snd_cs4231_out(chip, CS4231_PLAYBK_FORMAT,
			chip->image[CS4231_PLAYBK_FORMAT]);
L
Linus Torvalds 已提交
771 772 773 774
	spin_unlock_irqrestore(&chip->lock, flags);
	snd_cs4231_mce_down(chip);

#ifdef SNDRV_DEBUG_MCE
775
	snd_printdd("init: (4)\n");
L
Linus Torvalds 已提交
776 777 778 779 780 781 782 783 784
#endif

	snd_cs4231_mce_up(chip);
	spin_lock_irqsave(&chip->lock, flags);
	snd_cs4231_out(chip, CS4231_REC_FORMAT, chip->image[CS4231_REC_FORMAT]);
	spin_unlock_irqrestore(&chip->lock, flags);
	snd_cs4231_mce_down(chip);

#ifdef SNDRV_DEBUG_MCE
785
	snd_printdd("init: (5)\n");
L
Linus Torvalds 已提交
786 787 788
#endif
}

789
static int snd_cs4231_open(struct snd_cs4231 *chip, unsigned int mode)
L
Linus Torvalds 已提交
790 791 792
{
	unsigned long flags;

793
	mutex_lock(&chip->open_mutex);
L
Linus Torvalds 已提交
794
	if ((chip->mode & mode)) {
795
		mutex_unlock(&chip->open_mutex);
L
Linus Torvalds 已提交
796 797 798 799
		return -EAGAIN;
	}
	if (chip->mode & CS4231_MODE_OPEN) {
		chip->mode |= mode;
800
		mutex_unlock(&chip->open_mutex);
L
Linus Torvalds 已提交
801 802 803 804 805 806 807 808
		return 0;
	}
	/* ok. now enable and ack CODEC IRQ */
	spin_lock_irqsave(&chip->lock, flags);
	snd_cs4231_out(chip, CS4231_IRQ_STATUS, CS4231_PLAYBACK_IRQ |
		       CS4231_RECORD_IRQ |
		       CS4231_TIMER_IRQ);
	snd_cs4231_out(chip, CS4231_IRQ_STATUS, 0);
809 810
	__cs4231_writeb(chip, 0, CS4231U(chip, STATUS));	/* clear IRQ */
	__cs4231_writeb(chip, 0, CS4231U(chip, STATUS));	/* clear IRQ */
L
Linus Torvalds 已提交
811 812 813 814 815

	snd_cs4231_out(chip, CS4231_IRQ_STATUS, CS4231_PLAYBACK_IRQ |
		       CS4231_RECORD_IRQ |
		       CS4231_TIMER_IRQ);
	snd_cs4231_out(chip, CS4231_IRQ_STATUS, 0);
816

L
Linus Torvalds 已提交
817 818 819
	spin_unlock_irqrestore(&chip->lock, flags);

	chip->mode = mode;
820
	mutex_unlock(&chip->open_mutex);
L
Linus Torvalds 已提交
821 822 823
	return 0;
}

824
static void snd_cs4231_close(struct snd_cs4231 *chip, unsigned int mode)
L
Linus Torvalds 已提交
825 826 827
{
	unsigned long flags;

828
	mutex_lock(&chip->open_mutex);
L
Linus Torvalds 已提交
829 830
	chip->mode &= ~mode;
	if (chip->mode & CS4231_MODE_OPEN) {
831
		mutex_unlock(&chip->open_mutex);
L
Linus Torvalds 已提交
832 833 834 835 836 837 838
		return;
	}
	snd_cs4231_calibrate_mute(chip, 1);

	/* disable IRQ */
	spin_lock_irqsave(&chip->lock, flags);
	snd_cs4231_out(chip, CS4231_IRQ_STATUS, 0);
839 840
	__cs4231_writeb(chip, 0, CS4231U(chip, STATUS));	/* clear IRQ */
	__cs4231_writeb(chip, 0, CS4231U(chip, STATUS));	/* clear IRQ */
L
Linus Torvalds 已提交
841 842 843 844 845 846 847 848 849 850 851 852

	/* now disable record & playback */

	if (chip->image[CS4231_IFACE_CTRL] &
	    (CS4231_PLAYBACK_ENABLE | CS4231_PLAYBACK_PIO |
	     CS4231_RECORD_ENABLE | CS4231_RECORD_PIO)) {
		spin_unlock_irqrestore(&chip->lock, flags);
		snd_cs4231_mce_up(chip);
		spin_lock_irqsave(&chip->lock, flags);
		chip->image[CS4231_IFACE_CTRL] &=
			~(CS4231_PLAYBACK_ENABLE | CS4231_PLAYBACK_PIO |
			  CS4231_RECORD_ENABLE | CS4231_RECORD_PIO);
853 854
		snd_cs4231_out(chip, CS4231_IFACE_CTRL,
				chip->image[CS4231_IFACE_CTRL]);
L
Linus Torvalds 已提交
855 856 857 858 859 860 861
		spin_unlock_irqrestore(&chip->lock, flags);
		snd_cs4231_mce_down(chip);
		spin_lock_irqsave(&chip->lock, flags);
	}

	/* clear IRQ again */
	snd_cs4231_out(chip, CS4231_IRQ_STATUS, 0);
862 863
	__cs4231_writeb(chip, 0, CS4231U(chip, STATUS));	/* clear IRQ */
	__cs4231_writeb(chip, 0, CS4231U(chip, STATUS));	/* clear IRQ */
L
Linus Torvalds 已提交
864 865 866 867 868
	spin_unlock_irqrestore(&chip->lock, flags);

	snd_cs4231_calibrate_mute(chip, 0);

	chip->mode = 0;
869
	mutex_unlock(&chip->open_mutex);
L
Linus Torvalds 已提交
870 871 872 873 874 875
}

/*
 *  timer open/close
 */

876
static int snd_cs4231_timer_open(struct snd_timer *timer)
L
Linus Torvalds 已提交
877
{
878
	struct snd_cs4231 *chip = snd_timer_chip(timer);
L
Linus Torvalds 已提交
879 880 881 882
	snd_cs4231_open(chip, CS4231_MODE_TIMER);
	return 0;
}

883
static int snd_cs4231_timer_close(struct snd_timer *timer)
L
Linus Torvalds 已提交
884
{
885
	struct snd_cs4231 *chip = snd_timer_chip(timer);
L
Linus Torvalds 已提交
886 887 888 889
	snd_cs4231_close(chip, CS4231_MODE_TIMER);
	return 0;
}

890
static struct snd_timer_hardware snd_cs4231_timer_table = {
L
Linus Torvalds 已提交
891 892 893 894 895 896 897 898 899 900 901 902 903 904
	.flags		=	SNDRV_TIMER_HW_AUTO,
	.resolution	=	9945,
	.ticks		=	65535,
	.open		=	snd_cs4231_timer_open,
	.close		=	snd_cs4231_timer_close,
	.c_resolution	=	snd_cs4231_timer_resolution,
	.start		=	snd_cs4231_timer_start,
	.stop		=	snd_cs4231_timer_stop,
};

/*
 *  ok.. exported functions..
 */

905 906
static int snd_cs4231_playback_hw_params(struct snd_pcm_substream *substream,
					 struct snd_pcm_hw_params *hw_params)
L
Linus Torvalds 已提交
907
{
908
	struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
L
Linus Torvalds 已提交
909 910 911
	unsigned char new_pdfr;
	int err;

912 913 914
	err = snd_pcm_lib_malloc_pages(substream,
					params_buffer_bytes(hw_params));
	if (err < 0)
L
Linus Torvalds 已提交
915 916 917 918 919 920 921 922 923
		return err;
	new_pdfr = snd_cs4231_get_format(chip, params_format(hw_params),
					 params_channels(hw_params)) |
		snd_cs4231_get_rate(params_rate(hw_params));
	snd_cs4231_playback_format(chip, hw_params, new_pdfr);

	return 0;
}

924
static int snd_cs4231_playback_prepare(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
925
{
926 927
	struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
928 929 930
	unsigned long flags;

	spin_lock_irqsave(&chip->lock, flags);
931

L
Linus Torvalds 已提交
932 933
	chip->image[CS4231_IFACE_CTRL] &= ~(CS4231_PLAYBACK_ENABLE |
					    CS4231_PLAYBACK_PIO);
934

935
	BUG_ON(runtime->period_size > 0xffff + 1);
936 937

	chip->p_periods_sent = 0;
L
Linus Torvalds 已提交
938 939 940 941 942
	spin_unlock_irqrestore(&chip->lock, flags);

	return 0;
}

943 944
static int snd_cs4231_capture_hw_params(struct snd_pcm_substream *substream,
					struct snd_pcm_hw_params *hw_params)
L
Linus Torvalds 已提交
945
{
946
	struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
L
Linus Torvalds 已提交
947 948 949
	unsigned char new_cdfr;
	int err;

950 951 952
	err = snd_pcm_lib_malloc_pages(substream,
					params_buffer_bytes(hw_params));
	if (err < 0)
L
Linus Torvalds 已提交
953 954 955 956 957 958 959 960 961
		return err;
	new_cdfr = snd_cs4231_get_format(chip, params_format(hw_params),
					 params_channels(hw_params)) |
		snd_cs4231_get_rate(params_rate(hw_params));
	snd_cs4231_capture_format(chip, hw_params, new_cdfr);

	return 0;
}

962
static int snd_cs4231_capture_prepare(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
963
{
964
	struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
L
Linus Torvalds 已提交
965 966 967 968 969 970
	unsigned long flags;

	spin_lock_irqsave(&chip->lock, flags);
	chip->image[CS4231_IFACE_CTRL] &= ~(CS4231_RECORD_ENABLE |
					    CS4231_RECORD_PIO);

971

972
	chip->c_periods_sent = 0;
L
Linus Torvalds 已提交
973 974 975 976 977
	spin_unlock_irqrestore(&chip->lock, flags);

	return 0;
}

978
static void snd_cs4231_overrange(struct snd_cs4231 *chip)
L
Linus Torvalds 已提交
979 980 981 982 983 984 985 986
{
	unsigned long flags;
	unsigned char res;

	spin_lock_irqsave(&chip->lock, flags);
	res = snd_cs4231_in(chip, CS4231_TEST_INIT);
	spin_unlock_irqrestore(&chip->lock, flags);

987 988
	/* detect overrange only above 0dB; may be user selectable? */
	if (res & (0x08 | 0x02))
L
Linus Torvalds 已提交
989 990 991
		chip->capture_substream->runtime->overrange++;
}

992
static void snd_cs4231_play_callback(struct snd_cs4231 *chip)
L
Linus Torvalds 已提交
993 994 995
{
	if (chip->image[CS4231_IFACE_CTRL] & CS4231_PLAYBACK_ENABLE) {
		snd_pcm_period_elapsed(chip->playback_substream);
996
		snd_cs4231_advance_dma(&chip->p_dma, chip->playback_substream,
L
Linus Torvalds 已提交
997 998 999 1000
					    &chip->p_periods_sent);
	}
}

1001
static void snd_cs4231_capture_callback(struct snd_cs4231 *chip)
L
Linus Torvalds 已提交
1002 1003 1004
{
	if (chip->image[CS4231_IFACE_CTRL] & CS4231_RECORD_ENABLE) {
		snd_pcm_period_elapsed(chip->capture_substream);
1005
		snd_cs4231_advance_dma(&chip->c_dma, chip->capture_substream,
L
Linus Torvalds 已提交
1006 1007 1008 1009
					    &chip->c_periods_sent);
	}
}

1010 1011
static snd_pcm_uframes_t snd_cs4231_playback_pointer(
					struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
1012
{
1013 1014
	struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
	struct cs4231_dma_control *dma_cont = &chip->p_dma;
1015
	size_t ptr;
1016

L
Linus Torvalds 已提交
1017 1018
	if (!(chip->image[CS4231_IFACE_CTRL] & CS4231_PLAYBACK_ENABLE))
		return 0;
1019 1020 1021
	ptr = dma_cont->address(dma_cont);
	if (ptr != 0)
		ptr -= substream->runtime->dma_addr;
1022

L
Linus Torvalds 已提交
1023 1024 1025
	return bytes_to_frames(substream->runtime, ptr);
}

1026 1027
static snd_pcm_uframes_t snd_cs4231_capture_pointer(
					struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
1028
{
1029 1030
	struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
	struct cs4231_dma_control *dma_cont = &chip->c_dma;
1031
	size_t ptr;
1032

L
Linus Torvalds 已提交
1033 1034
	if (!(chip->image[CS4231_IFACE_CTRL] & CS4231_RECORD_ENABLE))
		return 0;
1035 1036 1037
	ptr = dma_cont->address(dma_cont);
	if (ptr != 0)
		ptr -= substream->runtime->dma_addr;
1038

L
Linus Torvalds 已提交
1039 1040 1041
	return bytes_to_frames(substream->runtime, ptr);
}

1042
static int __init snd_cs4231_probe(struct snd_cs4231 *chip)
L
Linus Torvalds 已提交
1043 1044
{
	unsigned long flags;
1045 1046 1047
	int i;
	int id = 0;
	int vers = 0;
L
Linus Torvalds 已提交
1048 1049 1050 1051
	unsigned char *ptr;

	for (i = 0; i < 50; i++) {
		mb();
1052
		if (__cs4231_readb(chip, CS4231U(chip, REGSEL)) & CS4231_INIT)
1053
			msleep(2);
L
Linus Torvalds 已提交
1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069
		else {
			spin_lock_irqsave(&chip->lock, flags);
			snd_cs4231_out(chip, CS4231_MISC_INFO, CS4231_MODE2);
			id = snd_cs4231_in(chip, CS4231_MISC_INFO) & 0x0f;
			vers = snd_cs4231_in(chip, CS4231_VERSION);
			spin_unlock_irqrestore(&chip->lock, flags);
			if (id == 0x0a)
				break;	/* this is valid value */
		}
	}
	snd_printdd("cs4231: port = %p, id = 0x%x\n", chip->port, id);
	if (id != 0x0a)
		return -ENODEV;	/* no valid device found */

	spin_lock_irqsave(&chip->lock, flags);

1070 1071 1072
	/* clear any pendings IRQ */
	__cs4231_readb(chip, CS4231U(chip, STATUS));
	__cs4231_writeb(chip, 0, CS4231U(chip, STATUS));
L
Linus Torvalds 已提交
1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104
	mb();

	spin_unlock_irqrestore(&chip->lock, flags);

	chip->image[CS4231_MISC_INFO] = CS4231_MODE2;
	chip->image[CS4231_IFACE_CTRL] =
		chip->image[CS4231_IFACE_CTRL] & ~CS4231_SINGLE_DMA;
	chip->image[CS4231_ALT_FEATURE_1] = 0x80;
	chip->image[CS4231_ALT_FEATURE_2] = 0x01;
	if (vers & 0x20)
		chip->image[CS4231_ALT_FEATURE_2] |= 0x02;

	ptr = (unsigned char *) &chip->image;

	snd_cs4231_mce_down(chip);

	spin_lock_irqsave(&chip->lock, flags);

	for (i = 0; i < 32; i++)	/* ok.. fill all CS4231 registers */
		snd_cs4231_out(chip, i, *ptr++);

	spin_unlock_irqrestore(&chip->lock, flags);

	snd_cs4231_mce_up(chip);

	snd_cs4231_mce_down(chip);

	mdelay(2);

	return 0;		/* all things are ok.. */
}

1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117
static struct snd_pcm_hardware snd_cs4231_playback = {
	.info			= SNDRV_PCM_INFO_MMAP |
				  SNDRV_PCM_INFO_INTERLEAVED |
				  SNDRV_PCM_INFO_MMAP_VALID |
				  SNDRV_PCM_INFO_SYNC_START,
	.formats		= SNDRV_PCM_FMTBIT_MU_LAW |
				  SNDRV_PCM_FMTBIT_A_LAW |
				  SNDRV_PCM_FMTBIT_IMA_ADPCM |
				  SNDRV_PCM_FMTBIT_U8 |
				  SNDRV_PCM_FMTBIT_S16_LE |
				  SNDRV_PCM_FMTBIT_S16_BE,
	.rates			= SNDRV_PCM_RATE_KNOT |
				  SNDRV_PCM_RATE_8000_48000,
L
Linus Torvalds 已提交
1118 1119 1120 1121
	.rate_min		= 5510,
	.rate_max		= 48000,
	.channels_min		= 1,
	.channels_max		= 2,
1122
	.buffer_bytes_max	= 32 * 1024,
1123
	.period_bytes_min	= 64,
1124
	.period_bytes_max	= 32 * 1024,
L
Linus Torvalds 已提交
1125 1126 1127 1128
	.periods_min		= 1,
	.periods_max		= 1024,
};

1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141
static struct snd_pcm_hardware snd_cs4231_capture = {
	.info			= SNDRV_PCM_INFO_MMAP |
				  SNDRV_PCM_INFO_INTERLEAVED |
				  SNDRV_PCM_INFO_MMAP_VALID |
				  SNDRV_PCM_INFO_SYNC_START,
	.formats		= SNDRV_PCM_FMTBIT_MU_LAW |
				  SNDRV_PCM_FMTBIT_A_LAW |
				  SNDRV_PCM_FMTBIT_IMA_ADPCM |
				  SNDRV_PCM_FMTBIT_U8 |
				  SNDRV_PCM_FMTBIT_S16_LE |
				  SNDRV_PCM_FMTBIT_S16_BE,
	.rates			= SNDRV_PCM_RATE_KNOT |
				  SNDRV_PCM_RATE_8000_48000,
L
Linus Torvalds 已提交
1142 1143 1144 1145
	.rate_min		= 5510,
	.rate_max		= 48000,
	.channels_min		= 1,
	.channels_max		= 2,
1146
	.buffer_bytes_max	= 32 * 1024,
1147
	.period_bytes_min	= 64,
1148
	.period_bytes_max	= 32 * 1024,
L
Linus Torvalds 已提交
1149 1150 1151 1152
	.periods_min		= 1,
	.periods_max		= 1024,
};

1153
static int snd_cs4231_playback_open(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
1154
{
1155 1156
	struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
1157 1158 1159 1160
	int err;

	runtime->hw = snd_cs4231_playback;

1161 1162
	err = snd_cs4231_open(chip, CS4231_MODE_PLAY);
	if (err < 0) {
L
Linus Torvalds 已提交
1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173
		snd_free_pages(runtime->dma_area, runtime->dma_bytes);
		return err;
	}
	chip->playback_substream = substream;
	chip->p_periods_sent = 0;
	snd_pcm_set_sync(substream);
	snd_cs4231_xrate(runtime);

	return 0;
}

1174
static int snd_cs4231_capture_open(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
1175
{
1176 1177
	struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
	struct snd_pcm_runtime *runtime = substream->runtime;
L
Linus Torvalds 已提交
1178 1179 1180 1181
	int err;

	runtime->hw = snd_cs4231_capture;

1182 1183
	err = snd_cs4231_open(chip, CS4231_MODE_RECORD);
	if (err < 0) {
L
Linus Torvalds 已提交
1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194
		snd_free_pages(runtime->dma_area, runtime->dma_bytes);
		return err;
	}
	chip->capture_substream = substream;
	chip->c_periods_sent = 0;
	snd_pcm_set_sync(substream);
	snd_cs4231_xrate(runtime);

	return 0;
}

1195
static int snd_cs4231_playback_close(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
1196
{
1197
	struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
L
Linus Torvalds 已提交
1198 1199

	snd_cs4231_close(chip, CS4231_MODE_PLAY);
1200
	chip->playback_substream = NULL;
L
Linus Torvalds 已提交
1201 1202 1203 1204

	return 0;
}

1205
static int snd_cs4231_capture_close(struct snd_pcm_substream *substream)
L
Linus Torvalds 已提交
1206
{
1207
	struct snd_cs4231 *chip = snd_pcm_substream_chip(substream);
L
Linus Torvalds 已提交
1208 1209

	snd_cs4231_close(chip, CS4231_MODE_RECORD);
1210
	chip->capture_substream = NULL;
L
Linus Torvalds 已提交
1211 1212 1213 1214 1215 1216 1217 1218

	return 0;
}

/* XXX We can do some power-management, in particular on EBUS using
 * XXX the audio AUXIO register...
 */

1219
static struct snd_pcm_ops snd_cs4231_playback_ops = {
L
Linus Torvalds 已提交
1220 1221 1222 1223
	.open		=	snd_cs4231_playback_open,
	.close		=	snd_cs4231_playback_close,
	.ioctl		=	snd_pcm_lib_ioctl,
	.hw_params	=	snd_cs4231_playback_hw_params,
1224
	.hw_free	=	snd_pcm_lib_free_pages,
L
Linus Torvalds 已提交
1225 1226 1227 1228 1229
	.prepare	=	snd_cs4231_playback_prepare,
	.trigger	=	snd_cs4231_trigger,
	.pointer	=	snd_cs4231_playback_pointer,
};

1230
static struct snd_pcm_ops snd_cs4231_capture_ops = {
L
Linus Torvalds 已提交
1231 1232 1233 1234
	.open		=	snd_cs4231_capture_open,
	.close		=	snd_cs4231_capture_close,
	.ioctl		=	snd_pcm_lib_ioctl,
	.hw_params	=	snd_cs4231_capture_hw_params,
1235
	.hw_free	=	snd_pcm_lib_free_pages,
L
Linus Torvalds 已提交
1236 1237 1238 1239 1240
	.prepare	=	snd_cs4231_capture_prepare,
	.trigger	=	snd_cs4231_trigger,
	.pointer	=	snd_cs4231_capture_pointer,
};

1241
static int __init snd_cs4231_pcm(struct snd_card *card)
L
Linus Torvalds 已提交
1242
{
1243
	struct snd_cs4231 *chip = card->private_data;
1244
	struct snd_pcm *pcm;
L
Linus Torvalds 已提交
1245 1246
	int err;

1247 1248
	err = snd_pcm_new(card, "CS4231", 0, 1, 1, &pcm);
	if (err < 0)
L
Linus Torvalds 已提交
1249 1250
		return err;

1251 1252 1253 1254 1255
	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK,
			&snd_cs4231_playback_ops);
	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE,
			&snd_cs4231_capture_ops);

L
Linus Torvalds 已提交
1256 1257 1258 1259 1260
	/* global setup */
	pcm->private_data = chip;
	pcm->info_flags = SNDRV_PCM_INFO_JOINT_DUPLEX;
	strcpy(pcm->name, "CS4231");

1261
	chip->p_dma.preallocate(chip, pcm);
L
Linus Torvalds 已提交
1262 1263 1264 1265 1266 1267

	chip->pcm = pcm;

	return 0;
}

1268
static int __init snd_cs4231_timer(struct snd_card *card)
L
Linus Torvalds 已提交
1269
{
1270
	struct snd_cs4231 *chip = card->private_data;
1271 1272
	struct snd_timer *timer;
	struct snd_timer_id tid;
L
Linus Torvalds 已提交
1273 1274 1275 1276 1277
	int err;

	/* Timer initialization */
	tid.dev_class = SNDRV_TIMER_CLASS_CARD;
	tid.dev_sclass = SNDRV_TIMER_SCLASS_NONE;
1278
	tid.card = card->number;
L
Linus Torvalds 已提交
1279 1280
	tid.device = 0;
	tid.subdevice = 0;
1281 1282
	err = snd_timer_new(card, "CS4231", &tid, &timer);
	if (err < 0)
L
Linus Torvalds 已提交
1283 1284 1285 1286 1287 1288 1289 1290
		return err;
	strcpy(timer->name, "CS4231");
	timer->private_data = chip;
	timer->hw = snd_cs4231_timer_table;
	chip->timer = timer;

	return 0;
}
1291

L
Linus Torvalds 已提交
1292 1293 1294 1295
/*
 *  MIXER part
 */

1296 1297
static int snd_cs4231_info_mux(struct snd_kcontrol *kcontrol,
			       struct snd_ctl_elem_info *uinfo)
L
Linus Torvalds 已提交
1298 1299 1300 1301 1302 1303 1304 1305 1306 1307
{
	static char *texts[4] = {
		"Line", "CD", "Mic", "Mix"
	};

	uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED;
	uinfo->count = 2;
	uinfo->value.enumerated.items = 4;
	if (uinfo->value.enumerated.item > 3)
		uinfo->value.enumerated.item = 3;
1308 1309
	strcpy(uinfo->value.enumerated.name,
		texts[uinfo->value.enumerated.item]);
L
Linus Torvalds 已提交
1310 1311 1312 1313

	return 0;
}

1314 1315
static int snd_cs4231_get_mux(struct snd_kcontrol *kcontrol,
			      struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
1316
{
1317
	struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
L
Linus Torvalds 已提交
1318
	unsigned long flags;
1319

L
Linus Torvalds 已提交
1320 1321 1322 1323 1324 1325 1326 1327 1328 1329
	spin_lock_irqsave(&chip->lock, flags);
	ucontrol->value.enumerated.item[0] =
		(chip->image[CS4231_LEFT_INPUT] & CS4231_MIXS_ALL) >> 6;
	ucontrol->value.enumerated.item[1] =
		(chip->image[CS4231_RIGHT_INPUT] & CS4231_MIXS_ALL) >> 6;
	spin_unlock_irqrestore(&chip->lock, flags);

	return 0;
}

1330 1331
static int snd_cs4231_put_mux(struct snd_kcontrol *kcontrol,
			      struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
1332
{
1333
	struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
L
Linus Torvalds 已提交
1334 1335 1336
	unsigned long flags;
	unsigned short left, right;
	int change;
1337

L
Linus Torvalds 已提交
1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348
	if (ucontrol->value.enumerated.item[0] > 3 ||
	    ucontrol->value.enumerated.item[1] > 3)
		return -EINVAL;
	left = ucontrol->value.enumerated.item[0] << 6;
	right = ucontrol->value.enumerated.item[1] << 6;

	spin_lock_irqsave(&chip->lock, flags);

	left = (chip->image[CS4231_LEFT_INPUT] & ~CS4231_MIXS_ALL) | left;
	right = (chip->image[CS4231_RIGHT_INPUT] & ~CS4231_MIXS_ALL) | right;
	change = left != chip->image[CS4231_LEFT_INPUT] ||
1349
		 right != chip->image[CS4231_RIGHT_INPUT];
L
Linus Torvalds 已提交
1350 1351 1352 1353 1354 1355 1356 1357
	snd_cs4231_out(chip, CS4231_LEFT_INPUT, left);
	snd_cs4231_out(chip, CS4231_RIGHT_INPUT, right);

	spin_unlock_irqrestore(&chip->lock, flags);

	return change;
}

1358 1359
static int snd_cs4231_info_single(struct snd_kcontrol *kcontrol,
				  struct snd_ctl_elem_info *uinfo)
L
Linus Torvalds 已提交
1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371
{
	int mask = (kcontrol->private_value >> 16) & 0xff;

	uinfo->type = (mask == 1) ?
		SNDRV_CTL_ELEM_TYPE_BOOLEAN : SNDRV_CTL_ELEM_TYPE_INTEGER;
	uinfo->count = 1;
	uinfo->value.integer.min = 0;
	uinfo->value.integer.max = mask;

	return 0;
}

1372 1373
static int snd_cs4231_get_single(struct snd_kcontrol *kcontrol,
				 struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
1374
{
1375
	struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
L
Linus Torvalds 已提交
1376 1377 1378 1379 1380
	unsigned long flags;
	int reg = kcontrol->private_value & 0xff;
	int shift = (kcontrol->private_value >> 8) & 0xff;
	int mask = (kcontrol->private_value >> 16) & 0xff;
	int invert = (kcontrol->private_value >> 24) & 0xff;
1381

L
Linus Torvalds 已提交
1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394
	spin_lock_irqsave(&chip->lock, flags);

	ucontrol->value.integer.value[0] = (chip->image[reg] >> shift) & mask;

	spin_unlock_irqrestore(&chip->lock, flags);

	if (invert)
		ucontrol->value.integer.value[0] =
			(mask - ucontrol->value.integer.value[0]);

	return 0;
}

1395 1396
static int snd_cs4231_put_single(struct snd_kcontrol *kcontrol,
				 struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
1397
{
1398
	struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
L
Linus Torvalds 已提交
1399 1400 1401 1402 1403 1404 1405
	unsigned long flags;
	int reg = kcontrol->private_value & 0xff;
	int shift = (kcontrol->private_value >> 8) & 0xff;
	int mask = (kcontrol->private_value >> 16) & 0xff;
	int invert = (kcontrol->private_value >> 24) & 0xff;
	int change;
	unsigned short val;
1406

L
Linus Torvalds 已提交
1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422
	val = (ucontrol->value.integer.value[0] & mask);
	if (invert)
		val = mask - val;
	val <<= shift;

	spin_lock_irqsave(&chip->lock, flags);

	val = (chip->image[reg] & ~(mask << shift)) | val;
	change = val != chip->image[reg];
	snd_cs4231_out(chip, reg, val);

	spin_unlock_irqrestore(&chip->lock, flags);

	return change;
}

1423 1424
static int snd_cs4231_info_double(struct snd_kcontrol *kcontrol,
				  struct snd_ctl_elem_info *uinfo)
L
Linus Torvalds 已提交
1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436
{
	int mask = (kcontrol->private_value >> 24) & 0xff;

	uinfo->type = mask == 1 ?
		SNDRV_CTL_ELEM_TYPE_BOOLEAN : SNDRV_CTL_ELEM_TYPE_INTEGER;
	uinfo->count = 2;
	uinfo->value.integer.min = 0;
	uinfo->value.integer.max = mask;

	return 0;
}

1437 1438
static int snd_cs4231_get_double(struct snd_kcontrol *kcontrol,
				 struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
1439
{
1440
	struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
L
Linus Torvalds 已提交
1441 1442 1443 1444 1445 1446 1447
	unsigned long flags;
	int left_reg = kcontrol->private_value & 0xff;
	int right_reg = (kcontrol->private_value >> 8) & 0xff;
	int shift_left = (kcontrol->private_value >> 16) & 0x07;
	int shift_right = (kcontrol->private_value >> 19) & 0x07;
	int mask = (kcontrol->private_value >> 24) & 0xff;
	int invert = (kcontrol->private_value >> 22) & 1;
1448

L
Linus Torvalds 已提交
1449 1450
	spin_lock_irqsave(&chip->lock, flags);

1451 1452 1453 1454
	ucontrol->value.integer.value[0] =
		(chip->image[left_reg] >> shift_left) & mask;
	ucontrol->value.integer.value[1] =
		(chip->image[right_reg] >> shift_right) & mask;
L
Linus Torvalds 已提交
1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467

	spin_unlock_irqrestore(&chip->lock, flags);

	if (invert) {
		ucontrol->value.integer.value[0] =
			(mask - ucontrol->value.integer.value[0]);
		ucontrol->value.integer.value[1] =
			(mask - ucontrol->value.integer.value[1]);
	}

	return 0;
}

1468 1469
static int snd_cs4231_put_double(struct snd_kcontrol *kcontrol,
				 struct snd_ctl_elem_value *ucontrol)
L
Linus Torvalds 已提交
1470
{
1471
	struct snd_cs4231 *chip = snd_kcontrol_chip(kcontrol);
L
Linus Torvalds 已提交
1472 1473 1474 1475 1476 1477 1478 1479 1480
	unsigned long flags;
	int left_reg = kcontrol->private_value & 0xff;
	int right_reg = (kcontrol->private_value >> 8) & 0xff;
	int shift_left = (kcontrol->private_value >> 16) & 0x07;
	int shift_right = (kcontrol->private_value >> 19) & 0x07;
	int mask = (kcontrol->private_value >> 24) & 0xff;
	int invert = (kcontrol->private_value >> 22) & 1;
	int change;
	unsigned short val1, val2;
1481

L
Linus Torvalds 已提交
1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494
	val1 = ucontrol->value.integer.value[0] & mask;
	val2 = ucontrol->value.integer.value[1] & mask;
	if (invert) {
		val1 = mask - val1;
		val2 = mask - val2;
	}
	val1 <<= shift_left;
	val2 <<= shift_right;

	spin_lock_irqsave(&chip->lock, flags);

	val1 = (chip->image[left_reg] & ~(mask << shift_left)) | val1;
	val2 = (chip->image[right_reg] & ~(mask << shift_right)) | val2;
1495 1496
	change = val1 != chip->image[left_reg];
	change |= val2 != chip->image[right_reg];
L
Linus Torvalds 已提交
1497 1498 1499 1500 1501 1502 1503 1504 1505
	snd_cs4231_out(chip, left_reg, val1);
	snd_cs4231_out(chip, right_reg, val2);

	spin_unlock_irqrestore(&chip->lock, flags);

	return change;
}

#define CS4231_SINGLE(xname, xindex, reg, shift, mask, invert) \
1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517
{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname), .index = (xindex), \
  .info = snd_cs4231_info_single,	\
  .get = snd_cs4231_get_single, .put = snd_cs4231_put_single,	\
  .private_value = (reg) | ((shift) << 8) | ((mask) << 16) | ((invert) << 24) }

#define CS4231_DOUBLE(xname, xindex, left_reg, right_reg, shift_left, \
			shift_right, mask, invert) \
{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname), .index = (xindex), \
  .info = snd_cs4231_info_double,	\
  .get = snd_cs4231_get_double, .put = snd_cs4231_put_double,	\
  .private_value = (left_reg) | ((right_reg) << 8) | ((shift_left) << 16) | \
		   ((shift_right) << 19) | ((mask) << 24) | ((invert) << 22) }
L
Linus Torvalds 已提交
1518

1519
static struct snd_kcontrol_new snd_cs4231_controls[] __initdata = {
1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535
CS4231_DOUBLE("PCM Playback Switch", 0, CS4231_LEFT_OUTPUT,
		CS4231_RIGHT_OUTPUT, 7, 7, 1, 1),
CS4231_DOUBLE("PCM Playback Volume", 0, CS4231_LEFT_OUTPUT,
		CS4231_RIGHT_OUTPUT, 0, 0, 63, 1),
CS4231_DOUBLE("Line Playback Switch", 0, CS4231_LEFT_LINE_IN,
		CS4231_RIGHT_LINE_IN, 7, 7, 1, 1),
CS4231_DOUBLE("Line Playback Volume", 0, CS4231_LEFT_LINE_IN,
		CS4231_RIGHT_LINE_IN, 0, 0, 31, 1),
CS4231_DOUBLE("Aux Playback Switch", 0, CS4231_AUX1_LEFT_INPUT,
		CS4231_AUX1_RIGHT_INPUT, 7, 7, 1, 1),
CS4231_DOUBLE("Aux Playback Volume", 0, CS4231_AUX1_LEFT_INPUT,
		CS4231_AUX1_RIGHT_INPUT, 0, 0, 31, 1),
CS4231_DOUBLE("Aux Playback Switch", 1, CS4231_AUX2_LEFT_INPUT,
		CS4231_AUX2_RIGHT_INPUT, 7, 7, 1, 1),
CS4231_DOUBLE("Aux Playback Volume", 1, CS4231_AUX2_LEFT_INPUT,
		CS4231_AUX2_RIGHT_INPUT, 0, 0, 31, 1),
L
Linus Torvalds 已提交
1536 1537 1538 1539
CS4231_SINGLE("Mono Playback Switch", 0, CS4231_MONO_CTRL, 7, 1, 1),
CS4231_SINGLE("Mono Playback Volume", 0, CS4231_MONO_CTRL, 0, 15, 1),
CS4231_SINGLE("Mono Output Playback Switch", 0, CS4231_MONO_CTRL, 6, 1, 1),
CS4231_SINGLE("Mono Output Playback Bypass", 0, CS4231_MONO_CTRL, 5, 1, 0),
1540 1541
CS4231_DOUBLE("Capture Volume", 0, CS4231_LEFT_INPUT, CS4231_RIGHT_INPUT, 0, 0,
		15, 0),
L
Linus Torvalds 已提交
1542 1543 1544 1545 1546 1547 1548
{
	.iface	= SNDRV_CTL_ELEM_IFACE_MIXER,
	.name	= "Capture Source",
	.info	= snd_cs4231_info_mux,
	.get	= snd_cs4231_get_mux,
	.put	= snd_cs4231_put_mux,
},
1549 1550
CS4231_DOUBLE("Mic Boost", 0, CS4231_LEFT_INPUT, CS4231_RIGHT_INPUT, 5, 5,
		1, 0),
L
Linus Torvalds 已提交
1551 1552 1553 1554 1555 1556
CS4231_SINGLE("Loopback Capture Switch", 0, CS4231_LOOPBACK, 0, 1, 0),
CS4231_SINGLE("Loopback Capture Volume", 0, CS4231_LOOPBACK, 2, 63, 1),
/* SPARC specific uses of XCTL{0,1} general purpose outputs.  */
CS4231_SINGLE("Line Out Switch", 0, CS4231_PIN_CTRL, 6, 1, 1),
CS4231_SINGLE("Headphone Out Switch", 0, CS4231_PIN_CTRL, 7, 1, 1)
};
1557

1558
static int __init snd_cs4231_mixer(struct snd_card *card)
L
Linus Torvalds 已提交
1559
{
1560
	struct snd_cs4231 *chip = card->private_data;
L
Linus Torvalds 已提交
1561 1562 1563 1564 1565 1566 1567
	int err, idx;

	snd_assert(chip != NULL && chip->pcm != NULL, return -EINVAL);

	strcpy(card->mixername, chip->pcm->name);

	for (idx = 0; idx < ARRAY_SIZE(snd_cs4231_controls); idx++) {
1568 1569 1570
		err = snd_ctl_add(card,
				 snd_ctl_new1(&snd_cs4231_controls[idx], chip));
		if (err < 0)
L
Linus Torvalds 已提交
1571 1572 1573 1574 1575 1576 1577
			return err;
	}
	return 0;
}

static int dev;

1578
static int __init cs4231_attach_begin(struct snd_card **rcard)
L
Linus Torvalds 已提交
1579
{
1580
	struct snd_card *card;
1581
	struct snd_cs4231 *chip;
L
Linus Torvalds 已提交
1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592

	*rcard = NULL;

	if (dev >= SNDRV_CARDS)
		return -ENODEV;

	if (!enable[dev]) {
		dev++;
		return -ENOENT;
	}

1593 1594
	card = snd_card_new(index[dev], id[dev], THIS_MODULE,
			    sizeof(struct snd_cs4231));
L
Linus Torvalds 已提交
1595 1596 1597 1598 1599 1600
	if (card == NULL)
		return -ENOMEM;

	strcpy(card->driver, "CS4231");
	strcpy(card->shortname, "Sun CS4231");

1601 1602 1603
	chip = card->private_data;
	chip->card = card;

L
Linus Torvalds 已提交
1604 1605 1606 1607
	*rcard = card;
	return 0;
}

1608
static int __init cs4231_attach_finish(struct snd_card *card)
L
Linus Torvalds 已提交
1609
{
1610
	struct snd_cs4231 *chip = card->private_data;
L
Linus Torvalds 已提交
1611 1612
	int err;

1613 1614
	err = snd_cs4231_pcm(card);
	if (err < 0)
L
Linus Torvalds 已提交
1615 1616
		goto out_err;

1617 1618
	err = snd_cs4231_mixer(card);
	if (err < 0)
L
Linus Torvalds 已提交
1619 1620
		goto out_err;

1621 1622
	err = snd_cs4231_timer(card);
	if (err < 0)
L
Linus Torvalds 已提交
1623 1624
		goto out_err;

1625 1626
	err = snd_card_register(card);
	if (err < 0)
L
Linus Torvalds 已提交
1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640
		goto out_err;

	chip->next = cs4231_list;
	cs4231_list = chip;

	dev++;
	return 0;

out_err:
	snd_card_free(card);
	return err;
}

#ifdef SBUS_SUPPORT
1641

1642
static irqreturn_t snd_cs4231_sbus_interrupt(int irq, void *dev_id)
1643 1644 1645 1646
{
	unsigned long flags;
	unsigned char status;
	u32 csr;
1647
	struct snd_cs4231 *chip = dev_id;
1648 1649

	/*This is IRQ is not raised by the cs4231*/
1650
	if (!(__cs4231_readb(chip, CS4231U(chip, STATUS)) & CS4231_GLOBALIRQ))
1651 1652 1653 1654 1655 1656 1657
		return IRQ_NONE;

	/* ACK the APC interrupt. */
	csr = sbus_readl(chip->port + APCCSR);

	sbus_writel(csr, chip->port + APCCSR);

1658 1659
	if ((csr & APC_PDMA_READY) &&
	    (csr & APC_PLAY_INT) &&
1660 1661 1662 1663
	    (csr & APC_XINT_PNVA) &&
	    !(csr & APC_XINT_EMPT))
			snd_cs4231_play_callback(chip);

1664 1665
	if ((csr & APC_CDMA_READY) &&
	    (csr & APC_CAPT_INT) &&
1666 1667 1668
	    (csr & APC_XINT_CNVA) &&
	    !(csr & APC_XINT_EMPT))
			snd_cs4231_capture_callback(chip);
1669

1670 1671 1672 1673 1674
	status = snd_cs4231_in(chip, CS4231_IRQ_STATUS);

	if (status & CS4231_TIMER_IRQ) {
		if (chip->timer)
			snd_timer_interrupt(chip->timer, chip->timer->sticks);
1675
	}
1676 1677 1678 1679 1680 1681 1682 1683 1684

	if ((status & CS4231_RECORD_IRQ) && (csr & APC_CDMA_READY))
		snd_cs4231_overrange(chip);

	/* ACK the CS4231 interrupt. */
	spin_lock_irqsave(&chip->lock, flags);
	snd_cs4231_outm(chip, CS4231_IRQ_STATUS, ~CS4231_ALL_IRQS | ~status, 0);
	spin_unlock_irqrestore(&chip->lock, flags);

1685
	return IRQ_HANDLED;
1686 1687 1688 1689 1690 1691
}

/*
 * SBUS DMA routines
 */

1692 1693
static int sbus_dma_request(struct cs4231_dma_control *dma_cont,
			    dma_addr_t bus_addr, size_t len)
1694 1695 1696 1697
{
	unsigned long flags;
	u32 test, csr;
	int err;
1698
	struct sbus_dma_info *base = &dma_cont->sbus_info;
1699

1700 1701 1702 1703 1704 1705
	if (len >= (1 << 24))
		return -EINVAL;
	spin_lock_irqsave(&base->lock, flags);
	csr = sbus_readl(base->regs + APCCSR);
	err = -EINVAL;
	test = APC_CDMA_READY;
1706
	if (base->dir == APC_PLAY)
1707 1708 1709 1710 1711
		test = APC_PDMA_READY;
	if (!(csr & test))
		goto out;
	err = -EBUSY;
	test = APC_XINT_CNVA;
1712
	if (base->dir == APC_PLAY)
1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723
		test = APC_XINT_PNVA;
	if (!(csr & test))
		goto out;
	err = 0;
	sbus_writel(bus_addr, base->regs + base->dir + APCNVA);
	sbus_writel(len, base->regs + base->dir + APCNC);
out:
	spin_unlock_irqrestore(&base->lock, flags);
	return err;
}

1724
static void sbus_dma_prepare(struct cs4231_dma_control *dma_cont, int d)
1725 1726 1727
{
	unsigned long flags;
	u32 csr, test;
1728
	struct sbus_dma_info *base = &dma_cont->sbus_info;
1729 1730 1731 1732 1733 1734

	spin_lock_irqsave(&base->lock, flags);
	csr = sbus_readl(base->regs + APCCSR);
	test =  APC_GENL_INT | APC_PLAY_INT | APC_XINT_ENA |
		APC_XINT_PLAY | APC_XINT_PEMP | APC_XINT_GENL |
		 APC_XINT_PENA;
1735
	if (base->dir == APC_RECORD)
1736 1737 1738 1739 1740 1741 1742
		test = APC_GENL_INT | APC_CAPT_INT | APC_XINT_ENA |
			APC_XINT_CAPT | APC_XINT_CEMP | APC_XINT_GENL;
	csr |= test;
	sbus_writel(csr, base->regs + APCCSR);
	spin_unlock_irqrestore(&base->lock, flags);
}

1743
static void sbus_dma_enable(struct cs4231_dma_control *dma_cont, int on)
1744 1745 1746
{
	unsigned long flags;
	u32 csr, shift;
1747
	struct sbus_dma_info *base = &dma_cont->sbus_info;
1748 1749 1750

	spin_lock_irqsave(&base->lock, flags);
	if (!on) {
1751 1752
		sbus_writel(0, base->regs + base->dir + APCNC);
		sbus_writel(0, base->regs + base->dir + APCNVA);
1753
		if (base->dir == APC_PLAY) {
G
Georg Chini 已提交
1754 1755 1756
			sbus_writel(0, base->regs + base->dir + APCC);
			sbus_writel(0, base->regs + base->dir + APCVA);
		}
1757

G
Georg Chini 已提交
1758
		udelay(1200);
1759
	}
1760 1761
	csr = sbus_readl(base->regs + APCCSR);
	shift = 0;
1762
	if (base->dir == APC_PLAY)
1763 1764 1765 1766
		shift = 1;
	if (on)
		csr &= ~(APC_CPAUSE << shift);
	else
1767
		csr |= (APC_CPAUSE << shift);
1768 1769 1770 1771 1772 1773
	sbus_writel(csr, base->regs + APCCSR);
	if (on)
		csr |= (APC_CDMA_READY << shift);
	else
		csr &= ~(APC_CDMA_READY << shift);
	sbus_writel(csr, base->regs + APCCSR);
1774

1775 1776 1777
	spin_unlock_irqrestore(&base->lock, flags);
}

1778
static unsigned int sbus_dma_addr(struct cs4231_dma_control *dma_cont)
1779
{
1780
	struct sbus_dma_info *base = &dma_cont->sbus_info;
1781

1782
	return sbus_readl(base->regs + base->dir + APCVA);
1783 1784
}

1785
static void sbus_dma_preallocate(struct snd_cs4231 *chip, struct snd_pcm *pcm)
1786
{
1787
	snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
1788
					      &chip->dev_u.op->dev,
1789
					      64 * 1024, 128 * 1024);
1790 1791 1792 1793 1794 1795
}

/*
 * Init and exit routines
 */

1796
static int snd_cs4231_sbus_free(struct snd_cs4231 *chip)
L
Linus Torvalds 已提交
1797
{
1798 1799
	struct of_device *op = chip->dev_u.op;

L
Linus Torvalds 已提交
1800 1801 1802 1803
	if (chip->irq[0])
		free_irq(chip->irq[0], chip);

	if (chip->port)
1804
		of_iounmap(&op->resource[0], chip->port, chip->regs_size);
L
Linus Torvalds 已提交
1805 1806 1807 1808

	return 0;
}

1809
static int snd_cs4231_sbus_dev_free(struct snd_device *device)
L
Linus Torvalds 已提交
1810
{
1811
	struct snd_cs4231 *cp = device->device_data;
L
Linus Torvalds 已提交
1812 1813 1814 1815

	return snd_cs4231_sbus_free(cp);
}

1816
static struct snd_device_ops snd_cs4231_sbus_dev_ops = {
L
Linus Torvalds 已提交
1817 1818 1819
	.dev_free	=	snd_cs4231_sbus_dev_free,
};

1820
static int __init snd_cs4231_sbus_create(struct snd_card *card,
1821
					 struct of_device *op,
1822
					 int dev)
L
Linus Torvalds 已提交
1823
{
1824
	struct snd_cs4231 *chip = card->private_data;
L
Linus Torvalds 已提交
1825 1826 1827
	int err;

	spin_lock_init(&chip->lock);
1828 1829
	spin_lock_init(&chip->c_dma.sbus_info.lock);
	spin_lock_init(&chip->p_dma.sbus_info.lock);
1830 1831
	mutex_init(&chip->mce_mutex);
	mutex_init(&chip->open_mutex);
1832 1833
	chip->dev_u.op = op;
	chip->regs_size = resource_size(&op->resource[0]);
L
Linus Torvalds 已提交
1834 1835 1836
	memcpy(&chip->image, &snd_cs4231_original_image,
	       sizeof(snd_cs4231_original_image));

1837 1838
	chip->port = of_ioremap(&op->resource[0], 0,
				chip->regs_size, "cs4231");
L
Linus Torvalds 已提交
1839
	if (!chip->port) {
1840
		snd_printdd("cs4231-%d: Unable to map chip registers.\n", dev);
L
Linus Torvalds 已提交
1841 1842 1843
		return -EIO;
	}

1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859
	chip->c_dma.sbus_info.regs = chip->port;
	chip->p_dma.sbus_info.regs = chip->port;
	chip->c_dma.sbus_info.dir = APC_RECORD;
	chip->p_dma.sbus_info.dir = APC_PLAY;

	chip->p_dma.prepare = sbus_dma_prepare;
	chip->p_dma.enable = sbus_dma_enable;
	chip->p_dma.request = sbus_dma_request;
	chip->p_dma.address = sbus_dma_addr;
	chip->p_dma.preallocate = sbus_dma_preallocate;

	chip->c_dma.prepare = sbus_dma_prepare;
	chip->c_dma.enable = sbus_dma_enable;
	chip->c_dma.request = sbus_dma_request;
	chip->c_dma.address = sbus_dma_addr;
	chip->c_dma.preallocate = sbus_dma_preallocate;
1860

1861
	if (request_irq(op->irqs[0], snd_cs4231_sbus_interrupt,
1862
			IRQF_SHARED, "cs4231", chip)) {
D
David S. Miller 已提交
1863
		snd_printdd("cs4231-%d: Unable to grab SBUS IRQ %d\n",
1864
			    dev, op->irqs[0]);
L
Linus Torvalds 已提交
1865 1866 1867
		snd_cs4231_sbus_free(chip);
		return -EBUSY;
	}
1868
	chip->irq[0] = op->irqs[0];
L
Linus Torvalds 已提交
1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884

	if (snd_cs4231_probe(chip) < 0) {
		snd_cs4231_sbus_free(chip);
		return -ENODEV;
	}
	snd_cs4231_init(chip);

	if ((err = snd_device_new(card, SNDRV_DEV_LOWLEVEL,
				  chip, &snd_cs4231_sbus_dev_ops)) < 0) {
		snd_cs4231_sbus_free(chip);
		return err;
	}

	return 0;
}

1885
static int __devinit cs4231_probe(struct of_device *op, const struct of_device_id *match)
L
Linus Torvalds 已提交
1886
{
1887
	struct resource *rp = &op->resource[0];
1888
	struct snd_card *card;
L
Linus Torvalds 已提交
1889 1890
	int err;

1891 1892 1893 1894
	if (strcmp(op->node->parent->name, "sbus") &&
	    strcmp(op->node->parent->name, "sbi"))
		return -ENODEV;

L
Linus Torvalds 已提交
1895 1896 1897 1898
	err = cs4231_attach_begin(&card);
	if (err)
		return err;

1899
	sprintf(card->longname, "%s at 0x%02lx:0x%016Lx, irq %d",
L
Linus Torvalds 已提交
1900 1901
		card->shortname,
		rp->flags & 0xffL,
1902
		(unsigned long long)rp->start,
1903
		op->irqs[0]);
L
Linus Torvalds 已提交
1904

1905
	err = snd_cs4231_sbus_create(card, op, dev);
1906
	if (err < 0) {
L
Linus Torvalds 已提交
1907 1908 1909 1910
		snd_card_free(card);
		return err;
	}

1911
	return cs4231_attach_finish(card);
L
Linus Torvalds 已提交
1912 1913 1914 1915
}
#endif

#ifdef EBUS_SUPPORT
1916

1917 1918
static void snd_cs4231_ebus_play_callback(struct ebus_dma_info *p, int event,
					  void *cookie)
1919
{
1920
	struct snd_cs4231 *chip = cookie;
1921

1922 1923 1924
	snd_cs4231_play_callback(chip);
}

1925 1926
static void snd_cs4231_ebus_capture_callback(struct ebus_dma_info *p,
					     int event, void *cookie)
1927
{
1928
	struct snd_cs4231 *chip = cookie;
1929 1930 1931 1932 1933 1934 1935 1936

	snd_cs4231_capture_callback(chip);
}

/*
 * EBUS DMA wrappers
 */

1937 1938
static int _ebus_dma_request(struct cs4231_dma_control *dma_cont,
			     dma_addr_t bus_addr, size_t len)
1939 1940 1941 1942
{
	return ebus_dma_request(&dma_cont->ebus_info, bus_addr, len);
}

1943
static void _ebus_dma_enable(struct cs4231_dma_control *dma_cont, int on)
1944 1945 1946 1947
{
	ebus_dma_enable(&dma_cont->ebus_info, on);
}

1948
static void _ebus_dma_prepare(struct cs4231_dma_control *dma_cont, int dir)
1949 1950 1951 1952
{
	ebus_dma_prepare(&dma_cont->ebus_info, dir);
}

1953
static unsigned int _ebus_dma_addr(struct cs4231_dma_control *dma_cont)
1954 1955 1956 1957
{
	return ebus_dma_addr(&dma_cont->ebus_info);
}

1958
static void _ebus_dma_preallocate(struct snd_cs4231 *chip, struct snd_pcm *pcm)
1959 1960 1961 1962 1963 1964 1965 1966 1967 1968
{
	snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
				      snd_dma_pci_data(chip->dev_u.pdev),
				      64*1024, 128*1024);
}

/*
 * Init and exit routines
 */

1969
static int snd_cs4231_ebus_free(struct snd_cs4231 *chip)
L
Linus Torvalds 已提交
1970
{
1971 1972 1973
	if (chip->c_dma.ebus_info.regs) {
		ebus_dma_unregister(&chip->c_dma.ebus_info);
		iounmap(chip->c_dma.ebus_info.regs);
L
Linus Torvalds 已提交
1974
	}
1975 1976 1977
	if (chip->p_dma.ebus_info.regs) {
		ebus_dma_unregister(&chip->p_dma.ebus_info);
		iounmap(chip->p_dma.ebus_info.regs);
L
Linus Torvalds 已提交
1978 1979 1980 1981 1982 1983 1984 1985
	}

	if (chip->port)
		iounmap(chip->port);

	return 0;
}

1986
static int snd_cs4231_ebus_dev_free(struct snd_device *device)
L
Linus Torvalds 已提交
1987
{
1988
	struct snd_cs4231 *cp = device->device_data;
L
Linus Torvalds 已提交
1989 1990 1991 1992

	return snd_cs4231_ebus_free(cp);
}

1993
static struct snd_device_ops snd_cs4231_ebus_dev_ops = {
L
Linus Torvalds 已提交
1994 1995 1996
	.dev_free	=	snd_cs4231_ebus_dev_free,
};

1997
static int __init snd_cs4231_ebus_create(struct snd_card *card,
L
Linus Torvalds 已提交
1998
					 struct linux_ebus_device *edev,
1999
					 int dev)
L
Linus Torvalds 已提交
2000
{
2001
	struct snd_cs4231 *chip = card->private_data;
L
Linus Torvalds 已提交
2002 2003 2004
	int err;

	spin_lock_init(&chip->lock);
2005 2006
	spin_lock_init(&chip->c_dma.ebus_info.lock);
	spin_lock_init(&chip->p_dma.ebus_info.lock);
2007 2008
	mutex_init(&chip->mce_mutex);
	mutex_init(&chip->open_mutex);
L
Linus Torvalds 已提交
2009 2010 2011 2012
	chip->flags |= CS4231_FLAG_EBUS;
	chip->dev_u.pdev = edev->bus->self;
	memcpy(&chip->image, &snd_cs4231_original_image,
	       sizeof(snd_cs4231_original_image));
2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034
	strcpy(chip->c_dma.ebus_info.name, "cs4231(capture)");
	chip->c_dma.ebus_info.flags = EBUS_DMA_FLAG_USE_EBDMA_HANDLER;
	chip->c_dma.ebus_info.callback = snd_cs4231_ebus_capture_callback;
	chip->c_dma.ebus_info.client_cookie = chip;
	chip->c_dma.ebus_info.irq = edev->irqs[0];
	strcpy(chip->p_dma.ebus_info.name, "cs4231(play)");
	chip->p_dma.ebus_info.flags = EBUS_DMA_FLAG_USE_EBDMA_HANDLER;
	chip->p_dma.ebus_info.callback = snd_cs4231_ebus_play_callback;
	chip->p_dma.ebus_info.client_cookie = chip;
	chip->p_dma.ebus_info.irq = edev->irqs[1];

	chip->p_dma.prepare = _ebus_dma_prepare;
	chip->p_dma.enable = _ebus_dma_enable;
	chip->p_dma.request = _ebus_dma_request;
	chip->p_dma.address = _ebus_dma_addr;
	chip->p_dma.preallocate = _ebus_dma_preallocate;

	chip->c_dma.prepare = _ebus_dma_prepare;
	chip->c_dma.enable = _ebus_dma_enable;
	chip->c_dma.request = _ebus_dma_request;
	chip->c_dma.address = _ebus_dma_addr;
	chip->c_dma.preallocate = _ebus_dma_preallocate;
L
Linus Torvalds 已提交
2035 2036

	chip->port = ioremap(edev->resource[0].start, 0x10);
2037 2038
	chip->p_dma.ebus_info.regs = ioremap(edev->resource[1].start, 0x10);
	chip->c_dma.ebus_info.regs = ioremap(edev->resource[2].start, 0x10);
2039 2040
	if (!chip->port || !chip->p_dma.ebus_info.regs ||
	    !chip->c_dma.ebus_info.regs) {
L
Linus Torvalds 已提交
2041
		snd_cs4231_ebus_free(chip);
2042
		snd_printdd("cs4231-%d: Unable to map chip registers.\n", dev);
L
Linus Torvalds 已提交
2043 2044 2045
		return -EIO;
	}

2046
	if (ebus_dma_register(&chip->c_dma.ebus_info)) {
L
Linus Torvalds 已提交
2047
		snd_cs4231_ebus_free(chip);
2048 2049
		snd_printdd("cs4231-%d: Unable to register EBUS capture DMA\n",
			    dev);
L
Linus Torvalds 已提交
2050 2051
		return -EBUSY;
	}
2052
	if (ebus_dma_irq_enable(&chip->c_dma.ebus_info, 1)) {
L
Linus Torvalds 已提交
2053
		snd_cs4231_ebus_free(chip);
2054 2055
		snd_printdd("cs4231-%d: Unable to enable EBUS capture IRQ\n",
			    dev);
L
Linus Torvalds 已提交
2056 2057 2058
		return -EBUSY;
	}

2059
	if (ebus_dma_register(&chip->p_dma.ebus_info)) {
L
Linus Torvalds 已提交
2060
		snd_cs4231_ebus_free(chip);
2061 2062
		snd_printdd("cs4231-%d: Unable to register EBUS play DMA\n",
			    dev);
L
Linus Torvalds 已提交
2063 2064
		return -EBUSY;
	}
2065
	if (ebus_dma_irq_enable(&chip->p_dma.ebus_info, 1)) {
L
Linus Torvalds 已提交
2066
		snd_cs4231_ebus_free(chip);
2067
		snd_printdd("cs4231-%d: Unable to enable EBUS play IRQ\n", dev);
L
Linus Torvalds 已提交
2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085
		return -EBUSY;
	}

	if (snd_cs4231_probe(chip) < 0) {
		snd_cs4231_ebus_free(chip);
		return -ENODEV;
	}
	snd_cs4231_init(chip);

	if ((err = snd_device_new(card, SNDRV_DEV_LOWLEVEL,
				  chip, &snd_cs4231_ebus_dev_ops)) < 0) {
		snd_cs4231_ebus_free(chip);
		return err;
	}

	return 0;
}

2086
static int __init cs4231_ebus_attach(struct linux_ebus_device *edev)
L
Linus Torvalds 已提交
2087
{
2088
	struct snd_card *card;
L
Linus Torvalds 已提交
2089 2090 2091 2092 2093 2094
	int err;

	err = cs4231_attach_begin(&card);
	if (err)
		return err;

D
David S. Miller 已提交
2095
	sprintf(card->longname, "%s at 0x%lx, irq %d",
L
Linus Torvalds 已提交
2096 2097
		card->shortname,
		edev->resource[0].start,
D
David S. Miller 已提交
2098
		edev->irqs[0]);
L
Linus Torvalds 已提交
2099

2100 2101
	err = snd_cs4231_ebus_create(card, edev, dev);
	if (err < 0) {
L
Linus Torvalds 已提交
2102 2103 2104 2105
		snd_card_free(card);
		return err;
	}

2106
	return cs4231_attach_finish(card);
L
Linus Torvalds 已提交
2107 2108 2109 2110
}
#endif

#ifdef SBUS_SUPPORT
2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124
static struct of_device_id cs4231_match[] = {
	{
		.name = "SUNW,CS4231",
	},
	{},
};

MODULE_DEVICE_TABLE(of, cs4231_match);

static struct of_platform_driver cs4231_driver = {
	.name		= "audio",
	.match_table	= cs4231_match,
	.probe		= cs4231_probe,
};
L
Linus Torvalds 已提交
2125
#endif
2126 2127 2128

static int __init cs4231_init(void)
{
L
Linus Torvalds 已提交
2129 2130 2131 2132 2133 2134 2135 2136 2137
#ifdef EBUS_SUPPORT
	struct linux_ebus *ebus;
	struct linux_ebus_device *edev;
#endif
	int found;

	found = 0;

#ifdef SBUS_SUPPORT
2138 2139 2140 2141
	{
		int err = of_register_driver(&cs4231_driver, &of_bus_type);
		if (err)
			return err;
L
Linus Torvalds 已提交
2142 2143 2144 2145 2146 2147 2148
	}
#endif
#ifdef EBUS_SUPPORT
	for_each_ebus(ebus) {
		for_each_ebusdev(edev, ebus) {
			int match = 0;

2149
			if (!strcmp(edev->prom_node->name, "SUNW,CS4231")) {
L
Linus Torvalds 已提交
2150
				match = 1;
2151
			} else if (!strcmp(edev->prom_node->name, "audio")) {
2152
				const char *compat;
L
Linus Torvalds 已提交
2153

2154 2155 2156
				compat = of_get_property(edev->prom_node,
							 "compatible", NULL);
				if (compat && !strcmp(compat, "SUNW,CS4231"))
L
Linus Torvalds 已提交
2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167
					match = 1;
			}

			if (match &&
			    cs4231_ebus_attach(edev) == 0)
				found++;
		}
	}
#endif


2168
	return 0;
L
Linus Torvalds 已提交
2169 2170 2171 2172
}

static void __exit cs4231_exit(void)
{
2173
	struct snd_cs4231 *p = cs4231_list;
L
Linus Torvalds 已提交
2174

2175 2176 2177 2178
#ifdef SBUS_SUPPORT
	of_unregister_driver(&cs4231_driver);
#endif

L
Linus Torvalds 已提交
2179
	while (p != NULL) {
2180
		struct snd_cs4231 *next = p->next;
L
Linus Torvalds 已提交
2181 2182 2183 2184 2185 2186 2187 2188 2189 2190 2191

		snd_card_free(p->card);

		p = next;
	}

	cs4231_list = NULL;
}

module_init(cs4231_init);
module_exit(cs4231_exit);