Linux Audio

Check our new training course

Loading...
v3.1
 
   1/*
   2 * Driver for Atmel AC97C
   3 *
   4 * Copyright (C) 2005-2009 Atmel Corporation
   5 *
   6 * This program is free software; you can redistribute it and/or modify it
   7 * under the terms of the GNU General Public License version 2 as published by
   8 * the Free Software Foundation.
   9 */
  10#include <linux/clk.h>
  11#include <linux/delay.h>
  12#include <linux/bitmap.h>
  13#include <linux/device.h>
  14#include <linux/dmaengine.h>
  15#include <linux/dma-mapping.h>
  16#include <linux/atmel_pdc.h>
 
  17#include <linux/init.h>
  18#include <linux/interrupt.h>
  19#include <linux/module.h>
  20#include <linux/platform_device.h>
  21#include <linux/mutex.h>
  22#include <linux/gpio.h>
  23#include <linux/io.h>
 
 
  24
  25#include <sound/core.h>
  26#include <sound/initval.h>
  27#include <sound/pcm.h>
  28#include <sound/pcm_params.h>
  29#include <sound/ac97_codec.h>
  30#include <sound/atmel-ac97c.h>
  31#include <sound/memalloc.h>
  32
  33#include <linux/dw_dmac.h>
  34
  35#include <mach/cpu.h>
  36#include <mach/gpio.h>
  37
  38#ifdef CONFIG_ARCH_AT91
  39#include <mach/hardware.h>
  40#endif
  41
  42#include "ac97c.h"
  43
  44enum {
  45	DMA_TX_READY = 0,
  46	DMA_RX_READY,
  47	DMA_TX_CHAN_PRESENT,
  48	DMA_RX_CHAN_PRESENT,
  49};
  50
  51/* Serialize access to opened variable */
  52static DEFINE_MUTEX(opened_mutex);
  53
  54struct atmel_ac97c_dma {
  55	struct dma_chan			*rx_chan;
  56	struct dma_chan			*tx_chan;
  57};
  58
  59struct atmel_ac97c {
  60	struct clk			*pclk;
  61	struct platform_device		*pdev;
  62	struct atmel_ac97c_dma		dma;
  63
  64	struct snd_pcm_substream	*playback_substream;
  65	struct snd_pcm_substream	*capture_substream;
  66	struct snd_card			*card;
  67	struct snd_pcm			*pcm;
  68	struct snd_ac97			*ac97;
  69	struct snd_ac97_bus		*ac97_bus;
  70
  71	u64				cur_format;
  72	unsigned int			cur_rate;
  73	unsigned long			flags;
  74	int				playback_period, capture_period;
  75	/* Serialize access to opened variable */
  76	spinlock_t			lock;
  77	void __iomem			*regs;
  78	int				irq;
  79	int				opened;
  80	int				reset_pin;
  81};
  82
  83#define get_chip(card) ((struct atmel_ac97c *)(card)->private_data)
  84
  85#define ac97c_writel(chip, reg, val)			\
  86	__raw_writel((val), (chip)->regs + AC97C_##reg)
  87#define ac97c_readl(chip, reg)				\
  88	__raw_readl((chip)->regs + AC97C_##reg)
  89
  90/* This function is called by the DMA driver. */
  91static void atmel_ac97c_dma_playback_period_done(void *arg)
  92{
  93	struct atmel_ac97c *chip = arg;
  94	snd_pcm_period_elapsed(chip->playback_substream);
  95}
  96
  97static void atmel_ac97c_dma_capture_period_done(void *arg)
  98{
  99	struct atmel_ac97c *chip = arg;
 100	snd_pcm_period_elapsed(chip->capture_substream);
 101}
 102
 103static int atmel_ac97c_prepare_dma(struct atmel_ac97c *chip,
 104		struct snd_pcm_substream *substream,
 105		enum dma_data_direction direction)
 106{
 107	struct dma_chan			*chan;
 108	struct dw_cyclic_desc		*cdesc;
 109	struct snd_pcm_runtime		*runtime = substream->runtime;
 110	unsigned long			buffer_len, period_len;
 111
 112	/*
 113	 * We don't do DMA on "complex" transfers, i.e. with
 114	 * non-halfword-aligned buffers or lengths.
 115	 */
 116	if (runtime->dma_addr & 1 || runtime->buffer_size & 1) {
 117		dev_dbg(&chip->pdev->dev, "too complex transfer\n");
 118		return -EINVAL;
 119	}
 120
 121	if (direction == DMA_TO_DEVICE)
 122		chan = chip->dma.tx_chan;
 123	else
 124		chan = chip->dma.rx_chan;
 125
 126	buffer_len = frames_to_bytes(runtime, runtime->buffer_size);
 127	period_len = frames_to_bytes(runtime, runtime->period_size);
 128
 129	cdesc = dw_dma_cyclic_prep(chan, runtime->dma_addr, buffer_len,
 130			period_len, direction);
 131	if (IS_ERR(cdesc)) {
 132		dev_dbg(&chip->pdev->dev, "could not prepare cyclic DMA\n");
 133		return PTR_ERR(cdesc);
 134	}
 135
 136	if (direction == DMA_TO_DEVICE) {
 137		cdesc->period_callback = atmel_ac97c_dma_playback_period_done;
 138		set_bit(DMA_TX_READY, &chip->flags);
 139	} else {
 140		cdesc->period_callback = atmel_ac97c_dma_capture_period_done;
 141		set_bit(DMA_RX_READY, &chip->flags);
 142	}
 143
 144	cdesc->period_callback_param = chip;
 145
 146	return 0;
 147}
 148
 149static struct snd_pcm_hardware atmel_ac97c_hw = {
 150	.info			= (SNDRV_PCM_INFO_MMAP
 151				  | SNDRV_PCM_INFO_MMAP_VALID
 152				  | SNDRV_PCM_INFO_INTERLEAVED
 153				  | SNDRV_PCM_INFO_BLOCK_TRANSFER
 154				  | SNDRV_PCM_INFO_JOINT_DUPLEX
 155				  | SNDRV_PCM_INFO_RESUME
 156				  | SNDRV_PCM_INFO_PAUSE),
 157	.formats		= (SNDRV_PCM_FMTBIT_S16_BE
 158				  | SNDRV_PCM_FMTBIT_S16_LE),
 159	.rates			= (SNDRV_PCM_RATE_CONTINUOUS),
 160	.rate_min		= 4000,
 161	.rate_max		= 48000,
 162	.channels_min		= 1,
 163	.channels_max		= 2,
 164	.buffer_bytes_max	= 2 * 2 * 64 * 2048,
 165	.period_bytes_min	= 4096,
 166	.period_bytes_max	= 4096,
 167	.periods_min		= 6,
 168	.periods_max		= 64,
 169};
 170
 171static int atmel_ac97c_playback_open(struct snd_pcm_substream *substream)
 172{
 173	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 174	struct snd_pcm_runtime *runtime = substream->runtime;
 175
 176	mutex_lock(&opened_mutex);
 177	chip->opened++;
 178	runtime->hw = atmel_ac97c_hw;
 179	if (chip->cur_rate) {
 180		runtime->hw.rate_min = chip->cur_rate;
 181		runtime->hw.rate_max = chip->cur_rate;
 182	}
 183	if (chip->cur_format)
 184		runtime->hw.formats = (1ULL << chip->cur_format);
 185	mutex_unlock(&opened_mutex);
 186	chip->playback_substream = substream;
 187	return 0;
 188}
 189
 190static int atmel_ac97c_capture_open(struct snd_pcm_substream *substream)
 191{
 192	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 193	struct snd_pcm_runtime *runtime = substream->runtime;
 194
 195	mutex_lock(&opened_mutex);
 196	chip->opened++;
 197	runtime->hw = atmel_ac97c_hw;
 198	if (chip->cur_rate) {
 199		runtime->hw.rate_min = chip->cur_rate;
 200		runtime->hw.rate_max = chip->cur_rate;
 201	}
 202	if (chip->cur_format)
 203		runtime->hw.formats = (1ULL << chip->cur_format);
 204	mutex_unlock(&opened_mutex);
 205	chip->capture_substream = substream;
 206	return 0;
 207}
 208
 209static int atmel_ac97c_playback_close(struct snd_pcm_substream *substream)
 210{
 211	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 212
 213	mutex_lock(&opened_mutex);
 214	chip->opened--;
 215	if (!chip->opened) {
 216		chip->cur_rate = 0;
 217		chip->cur_format = 0;
 218	}
 219	mutex_unlock(&opened_mutex);
 220
 221	chip->playback_substream = NULL;
 222
 223	return 0;
 224}
 225
 226static int atmel_ac97c_capture_close(struct snd_pcm_substream *substream)
 227{
 228	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 229
 230	mutex_lock(&opened_mutex);
 231	chip->opened--;
 232	if (!chip->opened) {
 233		chip->cur_rate = 0;
 234		chip->cur_format = 0;
 235	}
 236	mutex_unlock(&opened_mutex);
 237
 238	chip->capture_substream = NULL;
 239
 240	return 0;
 241}
 242
 243static int atmel_ac97c_playback_hw_params(struct snd_pcm_substream *substream,
 244		struct snd_pcm_hw_params *hw_params)
 245{
 246	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 247	int retval;
 248
 249	retval = snd_pcm_lib_malloc_pages(substream,
 250					params_buffer_bytes(hw_params));
 251	if (retval < 0)
 252		return retval;
 253	/* snd_pcm_lib_malloc_pages returns 1 if buffer is changed. */
 254	if (cpu_is_at32ap7000()) {
 255		/* snd_pcm_lib_malloc_pages returns 1 if buffer is changed. */
 256		if (retval == 1)
 257			if (test_and_clear_bit(DMA_TX_READY, &chip->flags))
 258				dw_dma_cyclic_free(chip->dma.tx_chan);
 259	}
 260	/* Set restrictions to params. */
 261	mutex_lock(&opened_mutex);
 262	chip->cur_rate = params_rate(hw_params);
 263	chip->cur_format = params_format(hw_params);
 264	mutex_unlock(&opened_mutex);
 265
 266	return retval;
 267}
 268
 269static int atmel_ac97c_capture_hw_params(struct snd_pcm_substream *substream,
 270		struct snd_pcm_hw_params *hw_params)
 271{
 272	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 273	int retval;
 274
 275	retval = snd_pcm_lib_malloc_pages(substream,
 276					params_buffer_bytes(hw_params));
 277	if (retval < 0)
 278		return retval;
 279	/* snd_pcm_lib_malloc_pages returns 1 if buffer is changed. */
 280	if (cpu_is_at32ap7000()) {
 281		if (retval < 0)
 282			return retval;
 283		/* snd_pcm_lib_malloc_pages returns 1 if buffer is changed. */
 284		if (retval == 1)
 285			if (test_and_clear_bit(DMA_RX_READY, &chip->flags))
 286				dw_dma_cyclic_free(chip->dma.rx_chan);
 287	}
 288
 289	/* Set restrictions to params. */
 290	mutex_lock(&opened_mutex);
 291	chip->cur_rate = params_rate(hw_params);
 292	chip->cur_format = params_format(hw_params);
 293	mutex_unlock(&opened_mutex);
 294
 295	return retval;
 296}
 297
 298static int atmel_ac97c_playback_hw_free(struct snd_pcm_substream *substream)
 299{
 300	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 301	if (cpu_is_at32ap7000()) {
 302		if (test_and_clear_bit(DMA_TX_READY, &chip->flags))
 303			dw_dma_cyclic_free(chip->dma.tx_chan);
 304	}
 305	return snd_pcm_lib_free_pages(substream);
 306}
 307
 308static int atmel_ac97c_capture_hw_free(struct snd_pcm_substream *substream)
 309{
 310	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 311	if (cpu_is_at32ap7000()) {
 312		if (test_and_clear_bit(DMA_RX_READY, &chip->flags))
 313			dw_dma_cyclic_free(chip->dma.rx_chan);
 314	}
 315	return snd_pcm_lib_free_pages(substream);
 316}
 317
 318static int atmel_ac97c_playback_prepare(struct snd_pcm_substream *substream)
 319{
 320	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 321	struct snd_pcm_runtime *runtime = substream->runtime;
 322	int block_size = frames_to_bytes(runtime, runtime->period_size);
 323	unsigned long word = ac97c_readl(chip, OCA);
 324	int retval;
 325
 326	chip->playback_period = 0;
 327	word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
 328
 329	/* assign channels to AC97C channel A */
 330	switch (runtime->channels) {
 331	case 1:
 332		word |= AC97C_CH_ASSIGN(PCM_LEFT, A);
 333		break;
 334	case 2:
 335		word |= AC97C_CH_ASSIGN(PCM_LEFT, A)
 336			| AC97C_CH_ASSIGN(PCM_RIGHT, A);
 337		break;
 338	default:
 339		/* TODO: support more than two channels */
 340		return -EINVAL;
 341	}
 342	ac97c_writel(chip, OCA, word);
 343
 344	/* configure sample format and size */
 345	word = ac97c_readl(chip, CAMR);
 346	if (chip->opened <= 1)
 347		word = AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
 348	else
 349		word |= AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
 350
 351	switch (runtime->format) {
 352	case SNDRV_PCM_FORMAT_S16_LE:
 353		if (cpu_is_at32ap7000())
 354			word |= AC97C_CMR_CEM_LITTLE;
 355		break;
 356	case SNDRV_PCM_FORMAT_S16_BE: /* fall through */
 357		word &= ~(AC97C_CMR_CEM_LITTLE);
 358		break;
 359	default:
 360		word = ac97c_readl(chip, OCA);
 361		word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
 362		ac97c_writel(chip, OCA, word);
 363		return -EINVAL;
 364	}
 365
 366	/* Enable underrun interrupt on channel A */
 367	word |= AC97C_CSR_UNRUN;
 368
 369	ac97c_writel(chip, CAMR, word);
 370
 371	/* Enable channel A event interrupt */
 372	word = ac97c_readl(chip, IMR);
 373	word |= AC97C_SR_CAEVT;
 374	ac97c_writel(chip, IER, word);
 375
 376	/* set variable rate if needed */
 377	if (runtime->rate != 48000) {
 378		word = ac97c_readl(chip, MR);
 379		word |= AC97C_MR_VRA;
 380		ac97c_writel(chip, MR, word);
 381	} else {
 382		word = ac97c_readl(chip, MR);
 383		word &= ~(AC97C_MR_VRA);
 384		ac97c_writel(chip, MR, word);
 385	}
 386
 387	retval = snd_ac97_set_rate(chip->ac97, AC97_PCM_FRONT_DAC_RATE,
 388			runtime->rate);
 389	if (retval)
 390		dev_dbg(&chip->pdev->dev, "could not set rate %d Hz\n",
 391				runtime->rate);
 392
 393	if (cpu_is_at32ap7000()) {
 394		if (!test_bit(DMA_TX_READY, &chip->flags))
 395			retval = atmel_ac97c_prepare_dma(chip, substream,
 396					DMA_TO_DEVICE);
 397	} else {
 398		/* Initialize and start the PDC */
 399		writel(runtime->dma_addr, chip->regs + ATMEL_PDC_TPR);
 400		writel(block_size / 2, chip->regs + ATMEL_PDC_TCR);
 401		writel(runtime->dma_addr + block_size,
 402				chip->regs + ATMEL_PDC_TNPR);
 403		writel(block_size / 2, chip->regs + ATMEL_PDC_TNCR);
 404	}
 405
 406	return retval;
 407}
 408
 409static int atmel_ac97c_capture_prepare(struct snd_pcm_substream *substream)
 410{
 411	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 412	struct snd_pcm_runtime *runtime = substream->runtime;
 413	int block_size = frames_to_bytes(runtime, runtime->period_size);
 414	unsigned long word = ac97c_readl(chip, ICA);
 415	int retval;
 416
 417	chip->capture_period = 0;
 418	word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
 419
 420	/* assign channels to AC97C channel A */
 421	switch (runtime->channels) {
 422	case 1:
 423		word |= AC97C_CH_ASSIGN(PCM_LEFT, A);
 424		break;
 425	case 2:
 426		word |= AC97C_CH_ASSIGN(PCM_LEFT, A)
 427			| AC97C_CH_ASSIGN(PCM_RIGHT, A);
 428		break;
 429	default:
 430		/* TODO: support more than two channels */
 431		return -EINVAL;
 432	}
 433	ac97c_writel(chip, ICA, word);
 434
 435	/* configure sample format and size */
 436	word = ac97c_readl(chip, CAMR);
 437	if (chip->opened <= 1)
 438		word = AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
 439	else
 440		word |= AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
 441
 442	switch (runtime->format) {
 443	case SNDRV_PCM_FORMAT_S16_LE:
 444		if (cpu_is_at32ap7000())
 445			word |= AC97C_CMR_CEM_LITTLE;
 446		break;
 447	case SNDRV_PCM_FORMAT_S16_BE: /* fall through */
 448		word &= ~(AC97C_CMR_CEM_LITTLE);
 449		break;
 450	default:
 451		word = ac97c_readl(chip, ICA);
 452		word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
 453		ac97c_writel(chip, ICA, word);
 454		return -EINVAL;
 455	}
 456
 457	/* Enable overrun interrupt on channel A */
 458	word |= AC97C_CSR_OVRUN;
 459
 460	ac97c_writel(chip, CAMR, word);
 461
 462	/* Enable channel A event interrupt */
 463	word = ac97c_readl(chip, IMR);
 464	word |= AC97C_SR_CAEVT;
 465	ac97c_writel(chip, IER, word);
 466
 467	/* set variable rate if needed */
 468	if (runtime->rate != 48000) {
 469		word = ac97c_readl(chip, MR);
 470		word |= AC97C_MR_VRA;
 471		ac97c_writel(chip, MR, word);
 472	} else {
 473		word = ac97c_readl(chip, MR);
 474		word &= ~(AC97C_MR_VRA);
 475		ac97c_writel(chip, MR, word);
 476	}
 477
 478	retval = snd_ac97_set_rate(chip->ac97, AC97_PCM_LR_ADC_RATE,
 479			runtime->rate);
 480	if (retval)
 481		dev_dbg(&chip->pdev->dev, "could not set rate %d Hz\n",
 482				runtime->rate);
 483
 484	if (cpu_is_at32ap7000()) {
 485		if (!test_bit(DMA_RX_READY, &chip->flags))
 486			retval = atmel_ac97c_prepare_dma(chip, substream,
 487					DMA_FROM_DEVICE);
 488	} else {
 489		/* Initialize and start the PDC */
 490		writel(runtime->dma_addr, chip->regs + ATMEL_PDC_RPR);
 491		writel(block_size / 2, chip->regs + ATMEL_PDC_RCR);
 492		writel(runtime->dma_addr + block_size,
 493				chip->regs + ATMEL_PDC_RNPR);
 494		writel(block_size / 2, chip->regs + ATMEL_PDC_RNCR);
 495	}
 496
 497	return retval;
 498}
 499
 500static int
 501atmel_ac97c_playback_trigger(struct snd_pcm_substream *substream, int cmd)
 502{
 503	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 504	unsigned long camr, ptcr = 0;
 505	int retval = 0;
 506
 507	camr = ac97c_readl(chip, CAMR);
 508
 509	switch (cmd) {
 510	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: /* fall through */
 511	case SNDRV_PCM_TRIGGER_RESUME: /* fall through */
 512	case SNDRV_PCM_TRIGGER_START:
 513		if (cpu_is_at32ap7000()) {
 514			retval = dw_dma_cyclic_start(chip->dma.tx_chan);
 515			if (retval)
 516				goto out;
 517		} else {
 518			ptcr = ATMEL_PDC_TXTEN;
 519		}
 520		camr |= AC97C_CMR_CENA | AC97C_CSR_ENDTX;
 521		break;
 522	case SNDRV_PCM_TRIGGER_PAUSE_PUSH: /* fall through */
 523	case SNDRV_PCM_TRIGGER_SUSPEND: /* fall through */
 524	case SNDRV_PCM_TRIGGER_STOP:
 525		if (cpu_is_at32ap7000())
 526			dw_dma_cyclic_stop(chip->dma.tx_chan);
 527		else
 528			ptcr |= ATMEL_PDC_TXTDIS;
 529		if (chip->opened <= 1)
 530			camr &= ~AC97C_CMR_CENA;
 531		break;
 532	default:
 533		retval = -EINVAL;
 534		goto out;
 535	}
 536
 537	ac97c_writel(chip, CAMR, camr);
 538	if (!cpu_is_at32ap7000())
 539		writel(ptcr, chip->regs + ATMEL_PDC_PTCR);
 540out:
 541	return retval;
 542}
 543
 544static int
 545atmel_ac97c_capture_trigger(struct snd_pcm_substream *substream, int cmd)
 546{
 547	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 548	unsigned long camr, ptcr = 0;
 549	int retval = 0;
 550
 551	camr = ac97c_readl(chip, CAMR);
 552	ptcr = readl(chip->regs + ATMEL_PDC_PTSR);
 553
 554	switch (cmd) {
 555	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: /* fall through */
 556	case SNDRV_PCM_TRIGGER_RESUME: /* fall through */
 557	case SNDRV_PCM_TRIGGER_START:
 558		if (cpu_is_at32ap7000()) {
 559			retval = dw_dma_cyclic_start(chip->dma.rx_chan);
 560			if (retval)
 561				goto out;
 562		} else {
 563			ptcr = ATMEL_PDC_RXTEN;
 564		}
 565		camr |= AC97C_CMR_CENA | AC97C_CSR_ENDRX;
 566		break;
 567	case SNDRV_PCM_TRIGGER_PAUSE_PUSH: /* fall through */
 568	case SNDRV_PCM_TRIGGER_SUSPEND: /* fall through */
 569	case SNDRV_PCM_TRIGGER_STOP:
 570		if (cpu_is_at32ap7000())
 571			dw_dma_cyclic_stop(chip->dma.rx_chan);
 572		else
 573			ptcr |= (ATMEL_PDC_RXTDIS);
 574		if (chip->opened <= 1)
 575			camr &= ~AC97C_CMR_CENA;
 576		break;
 577	default:
 578		retval = -EINVAL;
 579		break;
 580	}
 581
 582	ac97c_writel(chip, CAMR, camr);
 583	if (!cpu_is_at32ap7000())
 584		writel(ptcr, chip->regs + ATMEL_PDC_PTCR);
 585out:
 586	return retval;
 587}
 588
 589static snd_pcm_uframes_t
 590atmel_ac97c_playback_pointer(struct snd_pcm_substream *substream)
 591{
 592	struct atmel_ac97c	*chip = snd_pcm_substream_chip(substream);
 593	struct snd_pcm_runtime	*runtime = substream->runtime;
 594	snd_pcm_uframes_t	frames;
 595	unsigned long		bytes;
 596
 597	if (cpu_is_at32ap7000())
 598		bytes = dw_dma_get_src_addr(chip->dma.tx_chan);
 599	else
 600		bytes = readl(chip->regs + ATMEL_PDC_TPR);
 601	bytes -= runtime->dma_addr;
 602
 603	frames = bytes_to_frames(runtime, bytes);
 604	if (frames >= runtime->buffer_size)
 605		frames -= runtime->buffer_size;
 606	return frames;
 607}
 608
 609static snd_pcm_uframes_t
 610atmel_ac97c_capture_pointer(struct snd_pcm_substream *substream)
 611{
 612	struct atmel_ac97c	*chip = snd_pcm_substream_chip(substream);
 613	struct snd_pcm_runtime	*runtime = substream->runtime;
 614	snd_pcm_uframes_t	frames;
 615	unsigned long		bytes;
 616
 617	if (cpu_is_at32ap7000())
 618		bytes = dw_dma_get_dst_addr(chip->dma.rx_chan);
 619	else
 620		bytes = readl(chip->regs + ATMEL_PDC_RPR);
 621	bytes -= runtime->dma_addr;
 622
 623	frames = bytes_to_frames(runtime, bytes);
 624	if (frames >= runtime->buffer_size)
 625		frames -= runtime->buffer_size;
 626	return frames;
 627}
 628
 629static struct snd_pcm_ops atmel_ac97_playback_ops = {
 630	.open		= atmel_ac97c_playback_open,
 631	.close		= atmel_ac97c_playback_close,
 632	.ioctl		= snd_pcm_lib_ioctl,
 633	.hw_params	= atmel_ac97c_playback_hw_params,
 634	.hw_free	= atmel_ac97c_playback_hw_free,
 635	.prepare	= atmel_ac97c_playback_prepare,
 636	.trigger	= atmel_ac97c_playback_trigger,
 637	.pointer	= atmel_ac97c_playback_pointer,
 638};
 639
 640static struct snd_pcm_ops atmel_ac97_capture_ops = {
 641	.open		= atmel_ac97c_capture_open,
 642	.close		= atmel_ac97c_capture_close,
 643	.ioctl		= snd_pcm_lib_ioctl,
 644	.hw_params	= atmel_ac97c_capture_hw_params,
 645	.hw_free	= atmel_ac97c_capture_hw_free,
 646	.prepare	= atmel_ac97c_capture_prepare,
 647	.trigger	= atmel_ac97c_capture_trigger,
 648	.pointer	= atmel_ac97c_capture_pointer,
 649};
 650
 651static irqreturn_t atmel_ac97c_interrupt(int irq, void *dev)
 652{
 653	struct atmel_ac97c	*chip  = (struct atmel_ac97c *)dev;
 654	irqreturn_t		retval = IRQ_NONE;
 655	u32			sr     = ac97c_readl(chip, SR);
 656	u32			casr   = ac97c_readl(chip, CASR);
 657	u32			cosr   = ac97c_readl(chip, COSR);
 658	u32			camr   = ac97c_readl(chip, CAMR);
 659
 660	if (sr & AC97C_SR_CAEVT) {
 661		struct snd_pcm_runtime *runtime;
 662		int offset, next_period, block_size;
 663		dev_dbg(&chip->pdev->dev, "channel A event%s%s%s%s%s%s\n",
 664				casr & AC97C_CSR_OVRUN   ? " OVRUN"   : "",
 665				casr & AC97C_CSR_RXRDY   ? " RXRDY"   : "",
 666				casr & AC97C_CSR_UNRUN   ? " UNRUN"   : "",
 667				casr & AC97C_CSR_TXEMPTY ? " TXEMPTY" : "",
 668				casr & AC97C_CSR_TXRDY   ? " TXRDY"   : "",
 669				!casr                    ? " NONE"    : "");
 670		if (!cpu_is_at32ap7000()) {
 671			if ((casr & camr) & AC97C_CSR_ENDTX) {
 672				runtime = chip->playback_substream->runtime;
 673				block_size = frames_to_bytes(runtime,
 674						runtime->period_size);
 675				chip->playback_period++;
 676
 677				if (chip->playback_period == runtime->periods)
 678					chip->playback_period = 0;
 679				next_period = chip->playback_period + 1;
 680				if (next_period == runtime->periods)
 681					next_period = 0;
 682
 683				offset = block_size * next_period;
 684
 685				writel(runtime->dma_addr + offset,
 686						chip->regs + ATMEL_PDC_TNPR);
 687				writel(block_size / 2,
 688						chip->regs + ATMEL_PDC_TNCR);
 689
 690				snd_pcm_period_elapsed(
 691						chip->playback_substream);
 692			}
 693			if ((casr & camr) & AC97C_CSR_ENDRX) {
 694				runtime = chip->capture_substream->runtime;
 695				block_size = frames_to_bytes(runtime,
 696						runtime->period_size);
 697				chip->capture_period++;
 698
 699				if (chip->capture_period == runtime->periods)
 700					chip->capture_period = 0;
 701				next_period = chip->capture_period + 1;
 702				if (next_period == runtime->periods)
 703					next_period = 0;
 704
 705				offset = block_size * next_period;
 706
 707				writel(runtime->dma_addr + offset,
 708						chip->regs + ATMEL_PDC_RNPR);
 709				writel(block_size / 2,
 710						chip->regs + ATMEL_PDC_RNCR);
 711				snd_pcm_period_elapsed(chip->capture_substream);
 712			}
 713		}
 714		retval = IRQ_HANDLED;
 715	}
 716
 717	if (sr & AC97C_SR_COEVT) {
 718		dev_info(&chip->pdev->dev, "codec channel event%s%s%s%s%s\n",
 719				cosr & AC97C_CSR_OVRUN   ? " OVRUN"   : "",
 720				cosr & AC97C_CSR_RXRDY   ? " RXRDY"   : "",
 721				cosr & AC97C_CSR_TXEMPTY ? " TXEMPTY" : "",
 722				cosr & AC97C_CSR_TXRDY   ? " TXRDY"   : "",
 723				!cosr                    ? " NONE"    : "");
 724		retval = IRQ_HANDLED;
 725	}
 726
 727	if (retval == IRQ_NONE) {
 728		dev_err(&chip->pdev->dev, "spurious interrupt sr 0x%08x "
 729				"casr 0x%08x cosr 0x%08x\n", sr, casr, cosr);
 730	}
 731
 732	return retval;
 733}
 734
 735static struct ac97_pcm at91_ac97_pcm_defs[] __devinitdata = {
 736	/* Playback */
 737	{
 738		.exclusive = 1,
 739		.r = { {
 740			.slots = ((1 << AC97_SLOT_PCM_LEFT)
 741				  | (1 << AC97_SLOT_PCM_RIGHT)),
 742		} },
 743	},
 744	/* PCM in */
 745	{
 746		.stream = 1,
 747		.exclusive = 1,
 748		.r = { {
 749			.slots = ((1 << AC97_SLOT_PCM_LEFT)
 750					| (1 << AC97_SLOT_PCM_RIGHT)),
 751		} }
 752	},
 753	/* Mic in */
 754	{
 755		.stream = 1,
 756		.exclusive = 1,
 757		.r = { {
 758			.slots = (1<<AC97_SLOT_MIC),
 759		} }
 760	},
 761};
 762
 763static int __devinit atmel_ac97c_pcm_new(struct atmel_ac97c *chip)
 764{
 765	struct snd_pcm		*pcm;
 766	struct snd_pcm_hardware	hw = atmel_ac97c_hw;
 767	int			capture, playback, retval, err;
 768
 769	capture = test_bit(DMA_RX_CHAN_PRESENT, &chip->flags);
 770	playback = test_bit(DMA_TX_CHAN_PRESENT, &chip->flags);
 
 
 
 771
 772	if (!cpu_is_at32ap7000()) {
 773		err = snd_ac97_pcm_assign(chip->ac97_bus,
 774				ARRAY_SIZE(at91_ac97_pcm_defs),
 775				at91_ac97_pcm_defs);
 776		if (err)
 777			return err;
 778	}
 779	retval = snd_pcm_new(chip->card, chip->card->shortname,
 780			chip->pdev->id, playback, capture, &pcm);
 781	if (retval)
 782		return retval;
 783
 784	if (capture)
 785		snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE,
 786				&atmel_ac97_capture_ops);
 787	if (playback)
 788		snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK,
 789				&atmel_ac97_playback_ops);
 790
 791	retval = snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
 792			&chip->pdev->dev, hw.periods_min * hw.period_bytes_min,
 793			hw.buffer_bytes_max);
 794	if (retval)
 795		return retval;
 796
 797	pcm->private_data = chip;
 798	pcm->info_flags = 0;
 799	strcpy(pcm->name, chip->card->shortname);
 800	chip->pcm = pcm;
 801
 802	return 0;
 803}
 804
 805static int atmel_ac97c_mixer_new(struct atmel_ac97c *chip)
 806{
 807	struct snd_ac97_template template;
 808	memset(&template, 0, sizeof(template));
 809	template.private_data = chip;
 810	return snd_ac97_mixer(chip->ac97_bus, &template, &chip->ac97);
 811}
 812
 813static void atmel_ac97c_write(struct snd_ac97 *ac97, unsigned short reg,
 814		unsigned short val)
 815{
 816	struct atmel_ac97c *chip = get_chip(ac97);
 817	unsigned long word;
 818	int timeout = 40;
 819
 820	word = (reg & 0x7f) << 16 | val;
 821
 822	do {
 823		if (ac97c_readl(chip, COSR) & AC97C_CSR_TXRDY) {
 824			ac97c_writel(chip, COTHR, word);
 825			return;
 826		}
 827		udelay(1);
 828	} while (--timeout);
 829
 830	dev_dbg(&chip->pdev->dev, "codec write timeout\n");
 831}
 832
 833static unsigned short atmel_ac97c_read(struct snd_ac97 *ac97,
 834		unsigned short reg)
 835{
 836	struct atmel_ac97c *chip = get_chip(ac97);
 837	unsigned long word;
 838	int timeout = 40;
 839	int write = 10;
 840
 841	word = (0x80 | (reg & 0x7f)) << 16;
 842
 843	if ((ac97c_readl(chip, COSR) & AC97C_CSR_RXRDY) != 0)
 844		ac97c_readl(chip, CORHR);
 845
 846retry_write:
 847	timeout = 40;
 848
 849	do {
 850		if ((ac97c_readl(chip, COSR) & AC97C_CSR_TXRDY) != 0) {
 851			ac97c_writel(chip, COTHR, word);
 852			goto read_reg;
 853		}
 854		udelay(10);
 855	} while (--timeout);
 856
 857	if (!--write)
 858		goto timed_out;
 859	goto retry_write;
 860
 861read_reg:
 862	do {
 863		if ((ac97c_readl(chip, COSR) & AC97C_CSR_RXRDY) != 0) {
 864			unsigned short val = ac97c_readl(chip, CORHR);
 865			return val;
 866		}
 867		udelay(10);
 868	} while (--timeout);
 869
 870	if (!--write)
 871		goto timed_out;
 872	goto retry_write;
 873
 874timed_out:
 875	dev_dbg(&chip->pdev->dev, "codec read timeout\n");
 876	return 0xffff;
 877}
 878
 879static bool filter(struct dma_chan *chan, void *slave)
 880{
 881	struct dw_dma_slave *dws = slave;
 882
 883	if (dws->dma_dev == chan->device->dev) {
 884		chan->private = dws;
 885		return true;
 886	} else
 887		return false;
 888}
 889
 890static void atmel_ac97c_reset(struct atmel_ac97c *chip)
 891{
 892	ac97c_writel(chip, MR,   0);
 893	ac97c_writel(chip, MR,   AC97C_MR_ENA);
 894	ac97c_writel(chip, CAMR, 0);
 895	ac97c_writel(chip, COMR, 0);
 896
 897	if (gpio_is_valid(chip->reset_pin)) {
 898		gpio_set_value(chip->reset_pin, 0);
 899		/* AC97 v2.2 specifications says minimum 1 us. */
 900		udelay(2);
 901		gpio_set_value(chip->reset_pin, 1);
 
 
 
 
 902	}
 903}
 904
 905static int __devinit atmel_ac97c_probe(struct platform_device *pdev)
 
 
 
 
 
 
 906{
 
 907	struct snd_card			*card;
 908	struct atmel_ac97c		*chip;
 909	struct resource			*regs;
 910	struct ac97c_platform_data	*pdata;
 911	struct clk			*pclk;
 912	static struct snd_ac97_bus_ops	ops = {
 913		.write	= atmel_ac97c_write,
 914		.read	= atmel_ac97c_read,
 915	};
 916	int				retval;
 917	int				irq;
 918
 919	regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 920	if (!regs) {
 921		dev_dbg(&pdev->dev, "no memory resource\n");
 922		return -ENXIO;
 923	}
 924
 925	pdata = pdev->dev.platform_data;
 926	if (!pdata) {
 927		dev_dbg(&pdev->dev, "no platform data\n");
 928		return -ENXIO;
 929	}
 930
 931	irq = platform_get_irq(pdev, 0);
 932	if (irq < 0) {
 933		dev_dbg(&pdev->dev, "could not get irq\n");
 934		return -ENXIO;
 935	}
 936
 937	if (cpu_is_at32ap7000()) {
 938		pclk = clk_get(&pdev->dev, "pclk");
 939	} else {
 940		pclk = clk_get(&pdev->dev, "ac97_clk");
 941	}
 942
 
 943	if (IS_ERR(pclk)) {
 944		dev_dbg(&pdev->dev, "no peripheral clock\n");
 945		return PTR_ERR(pclk);
 946	}
 947	clk_enable(pclk);
 
 
 948
 949	retval = snd_card_create(SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1,
 950			THIS_MODULE, sizeof(struct atmel_ac97c), &card);
 
 951	if (retval) {
 952		dev_dbg(&pdev->dev, "could not create sound card device\n");
 953		goto err_snd_card_new;
 954	}
 955
 956	chip = get_chip(card);
 957
 958	retval = request_irq(irq, atmel_ac97c_interrupt, 0, "AC97C", chip);
 959	if (retval) {
 960		dev_dbg(&pdev->dev, "unable to request irq %d\n", irq);
 961		goto err_request_irq;
 962	}
 963	chip->irq = irq;
 964
 965	spin_lock_init(&chip->lock);
 966
 967	strcpy(card->driver, "Atmel AC97C");
 968	strcpy(card->shortname, "Atmel AC97C");
 969	sprintf(card->longname, "Atmel AC97 controller");
 970
 971	chip->card = card;
 972	chip->pclk = pclk;
 973	chip->pdev = pdev;
 974	chip->regs = ioremap(regs->start, resource_size(regs));
 975
 976	if (!chip->regs) {
 977		dev_dbg(&pdev->dev, "could not remap register memory\n");
 
 978		goto err_ioremap;
 979	}
 980
 981	if (gpio_is_valid(pdata->reset_pin)) {
 982		if (gpio_request(pdata->reset_pin, "reset_pin")) {
 983			dev_dbg(&pdev->dev, "reset pin not available\n");
 984			chip->reset_pin = -ENODEV;
 985		} else {
 986			gpio_direction_output(pdata->reset_pin, 1);
 987			chip->reset_pin = pdata->reset_pin;
 988		}
 989	}
 990
 991	snd_card_set_dev(card, &pdev->dev);
 992
 993	atmel_ac97c_reset(chip);
 994
 995	/* Enable overrun interrupt from codec channel */
 996	ac97c_writel(chip, COMR, AC97C_CSR_OVRUN);
 997	ac97c_writel(chip, IER, ac97c_readl(chip, IMR) | AC97C_SR_COEVT);
 998
 999	retval = snd_ac97_bus(card, 0, &ops, chip, &chip->ac97_bus);
1000	if (retval) {
1001		dev_dbg(&pdev->dev, "could not register on ac97 bus\n");
1002		goto err_ac97_bus;
1003	}
1004
1005	retval = atmel_ac97c_mixer_new(chip);
1006	if (retval) {
1007		dev_dbg(&pdev->dev, "could not register ac97 mixer\n");
1008		goto err_ac97_bus;
1009	}
1010
1011	if (cpu_is_at32ap7000()) {
1012		if (pdata->rx_dws.dma_dev) {
1013			struct dw_dma_slave *dws = &pdata->rx_dws;
1014			dma_cap_mask_t mask;
1015
1016			dws->rx_reg = regs->start + AC97C_CARHR + 2;
1017
1018			dma_cap_zero(mask);
1019			dma_cap_set(DMA_SLAVE, mask);
1020
1021			chip->dma.rx_chan = dma_request_channel(mask, filter,
1022								dws);
1023
1024			dev_info(&chip->pdev->dev, "using %s for DMA RX\n",
1025				dev_name(&chip->dma.rx_chan->dev->device));
1026			set_bit(DMA_RX_CHAN_PRESENT, &chip->flags);
1027		}
1028
1029		if (pdata->tx_dws.dma_dev) {
1030			struct dw_dma_slave *dws = &pdata->tx_dws;
1031			dma_cap_mask_t mask;
1032
1033			dws->tx_reg = regs->start + AC97C_CATHR + 2;
1034
1035			dma_cap_zero(mask);
1036			dma_cap_set(DMA_SLAVE, mask);
1037
1038			chip->dma.tx_chan = dma_request_channel(mask, filter,
1039								dws);
1040
1041			dev_info(&chip->pdev->dev, "using %s for DMA TX\n",
1042				dev_name(&chip->dma.tx_chan->dev->device));
1043			set_bit(DMA_TX_CHAN_PRESENT, &chip->flags);
1044		}
1045
1046		if (!test_bit(DMA_RX_CHAN_PRESENT, &chip->flags) &&
1047				!test_bit(DMA_TX_CHAN_PRESENT, &chip->flags)) {
1048			dev_dbg(&pdev->dev, "DMA not available\n");
1049			retval = -ENODEV;
1050			goto err_dma;
1051		}
1052	} else {
1053		/* Just pretend that we have DMA channel(for at91 i is actually
1054		 * the PDC) */
1055		set_bit(DMA_RX_CHAN_PRESENT, &chip->flags);
1056		set_bit(DMA_TX_CHAN_PRESENT, &chip->flags);
1057	}
1058
1059	retval = atmel_ac97c_pcm_new(chip);
1060	if (retval) {
1061		dev_dbg(&pdev->dev, "could not register ac97 pcm device\n");
1062		goto err_dma;
1063	}
1064
1065	retval = snd_card_register(card);
1066	if (retval) {
1067		dev_dbg(&pdev->dev, "could not register sound card\n");
1068		goto err_dma;
1069	}
1070
1071	platform_set_drvdata(pdev, card);
1072
1073	dev_info(&pdev->dev, "Atmel AC97 controller at 0x%p, irq = %d\n",
1074			chip->regs, irq);
1075
1076	return 0;
1077
1078err_dma:
1079	if (cpu_is_at32ap7000()) {
1080		if (test_bit(DMA_RX_CHAN_PRESENT, &chip->flags))
1081			dma_release_channel(chip->dma.rx_chan);
1082		if (test_bit(DMA_TX_CHAN_PRESENT, &chip->flags))
1083			dma_release_channel(chip->dma.tx_chan);
1084		clear_bit(DMA_RX_CHAN_PRESENT, &chip->flags);
1085		clear_bit(DMA_TX_CHAN_PRESENT, &chip->flags);
1086		chip->dma.rx_chan = NULL;
1087		chip->dma.tx_chan = NULL;
1088	}
1089err_ac97_bus:
1090	snd_card_set_dev(card, NULL);
1091
1092	if (gpio_is_valid(chip->reset_pin))
1093		gpio_free(chip->reset_pin);
1094
1095	iounmap(chip->regs);
1096err_ioremap:
1097	free_irq(irq, chip);
1098err_request_irq:
1099	snd_card_free(card);
1100err_snd_card_new:
1101	clk_disable(pclk);
 
1102	clk_put(pclk);
1103	return retval;
1104}
1105
1106#ifdef CONFIG_PM
1107static int atmel_ac97c_suspend(struct platform_device *pdev, pm_message_t msg)
1108{
1109	struct snd_card *card = platform_get_drvdata(pdev);
1110	struct atmel_ac97c *chip = card->private_data;
1111
1112	if (cpu_is_at32ap7000()) {
1113		if (test_bit(DMA_RX_READY, &chip->flags))
1114			dw_dma_cyclic_stop(chip->dma.rx_chan);
1115		if (test_bit(DMA_TX_READY, &chip->flags))
1116			dw_dma_cyclic_stop(chip->dma.tx_chan);
1117	}
1118	clk_disable(chip->pclk);
1119
1120	return 0;
1121}
1122
1123static int atmel_ac97c_resume(struct platform_device *pdev)
1124{
1125	struct snd_card *card = platform_get_drvdata(pdev);
1126	struct atmel_ac97c *chip = card->private_data;
 
1127
1128	clk_enable(chip->pclk);
1129	if (cpu_is_at32ap7000()) {
1130		if (test_bit(DMA_RX_READY, &chip->flags))
1131			dw_dma_cyclic_start(chip->dma.rx_chan);
1132		if (test_bit(DMA_TX_READY, &chip->flags))
1133			dw_dma_cyclic_start(chip->dma.tx_chan);
1134	}
1135	return 0;
1136}
 
 
 
1137#else
1138#define atmel_ac97c_suspend NULL
1139#define atmel_ac97c_resume NULL
1140#endif
1141
1142static int __devexit atmel_ac97c_remove(struct platform_device *pdev)
1143{
1144	struct snd_card *card = platform_get_drvdata(pdev);
1145	struct atmel_ac97c *chip = get_chip(card);
1146
1147	if (gpio_is_valid(chip->reset_pin))
1148		gpio_free(chip->reset_pin);
1149
1150	ac97c_writel(chip, CAMR, 0);
1151	ac97c_writel(chip, COMR, 0);
1152	ac97c_writel(chip, MR,   0);
1153
1154	clk_disable(chip->pclk);
1155	clk_put(chip->pclk);
1156	iounmap(chip->regs);
1157	free_irq(chip->irq, chip);
1158
1159	if (cpu_is_at32ap7000()) {
1160		if (test_bit(DMA_RX_CHAN_PRESENT, &chip->flags))
1161			dma_release_channel(chip->dma.rx_chan);
1162		if (test_bit(DMA_TX_CHAN_PRESENT, &chip->flags))
1163			dma_release_channel(chip->dma.tx_chan);
1164		clear_bit(DMA_RX_CHAN_PRESENT, &chip->flags);
1165		clear_bit(DMA_TX_CHAN_PRESENT, &chip->flags);
1166		chip->dma.rx_chan = NULL;
1167		chip->dma.tx_chan = NULL;
1168	}
1169
1170	snd_card_set_dev(card, NULL);
1171	snd_card_free(card);
1172
1173	platform_set_drvdata(pdev, NULL);
1174
1175	return 0;
1176}
1177
1178static struct platform_driver atmel_ac97c_driver = {
1179	.remove		= __devexit_p(atmel_ac97c_remove),
 
1180	.driver		= {
1181		.name	= "atmel_ac97c",
 
 
1182	},
1183	.suspend	= atmel_ac97c_suspend,
1184	.resume		= atmel_ac97c_resume,
1185};
1186
1187static int __init atmel_ac97c_init(void)
1188{
1189	return platform_driver_probe(&atmel_ac97c_driver,
1190			atmel_ac97c_probe);
1191}
1192module_init(atmel_ac97c_init);
1193
1194static void __exit atmel_ac97c_exit(void)
1195{
1196	platform_driver_unregister(&atmel_ac97c_driver);
1197}
1198module_exit(atmel_ac97c_exit);
1199
1200MODULE_LICENSE("GPL");
1201MODULE_DESCRIPTION("Driver for Atmel AC97 controller");
1202MODULE_AUTHOR("Hans-Christian Egtvedt <egtvedt@samfundet.no>");
v5.9
  1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * Driver for Atmel AC97C
  4 *
  5 * Copyright (C) 2005-2009 Atmel Corporation
 
 
 
 
  6 */
  7#include <linux/clk.h>
  8#include <linux/delay.h>
  9#include <linux/bitmap.h>
 10#include <linux/device.h>
 
 
 11#include <linux/atmel_pdc.h>
 12#include <linux/gpio/consumer.h>
 13#include <linux/init.h>
 14#include <linux/interrupt.h>
 15#include <linux/module.h>
 16#include <linux/platform_device.h>
 17#include <linux/mutex.h>
 18#include <linux/types.h>
 19#include <linux/io.h>
 20#include <linux/of.h>
 21#include <linux/of_device.h>
 22
 23#include <sound/core.h>
 24#include <sound/initval.h>
 25#include <sound/pcm.h>
 26#include <sound/pcm_params.h>
 27#include <sound/ac97_codec.h>
 
 28#include <sound/memalloc.h>
 29
 
 
 
 
 
 
 
 
 
 30#include "ac97c.h"
 31
 
 
 
 
 
 
 
 32/* Serialize access to opened variable */
 33static DEFINE_MUTEX(opened_mutex);
 34
 
 
 
 
 
 35struct atmel_ac97c {
 36	struct clk			*pclk;
 37	struct platform_device		*pdev;
 
 38
 39	struct snd_pcm_substream	*playback_substream;
 40	struct snd_pcm_substream	*capture_substream;
 41	struct snd_card			*card;
 42	struct snd_pcm			*pcm;
 43	struct snd_ac97			*ac97;
 44	struct snd_ac97_bus		*ac97_bus;
 45
 46	u64				cur_format;
 47	unsigned int			cur_rate;
 
 48	int				playback_period, capture_period;
 49	/* Serialize access to opened variable */
 50	spinlock_t			lock;
 51	void __iomem			*regs;
 52	int				irq;
 53	int				opened;
 54	struct gpio_desc		*reset_pin;
 55};
 56
 57#define get_chip(card) ((struct atmel_ac97c *)(card)->private_data)
 58
 59#define ac97c_writel(chip, reg, val)			\
 60	__raw_writel((val), (chip)->regs + AC97C_##reg)
 61#define ac97c_readl(chip, reg)				\
 62	__raw_readl((chip)->regs + AC97C_##reg)
 63
 64static const struct snd_pcm_hardware atmel_ac97c_hw = {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 65	.info			= (SNDRV_PCM_INFO_MMAP
 66				  | SNDRV_PCM_INFO_MMAP_VALID
 67				  | SNDRV_PCM_INFO_INTERLEAVED
 68				  | SNDRV_PCM_INFO_BLOCK_TRANSFER
 69				  | SNDRV_PCM_INFO_JOINT_DUPLEX
 70				  | SNDRV_PCM_INFO_RESUME
 71				  | SNDRV_PCM_INFO_PAUSE),
 72	.formats		= (SNDRV_PCM_FMTBIT_S16_BE
 73				  | SNDRV_PCM_FMTBIT_S16_LE),
 74	.rates			= (SNDRV_PCM_RATE_CONTINUOUS),
 75	.rate_min		= 4000,
 76	.rate_max		= 48000,
 77	.channels_min		= 1,
 78	.channels_max		= 2,
 79	.buffer_bytes_max	= 2 * 2 * 64 * 2048,
 80	.period_bytes_min	= 4096,
 81	.period_bytes_max	= 4096,
 82	.periods_min		= 6,
 83	.periods_max		= 64,
 84};
 85
 86static int atmel_ac97c_playback_open(struct snd_pcm_substream *substream)
 87{
 88	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 89	struct snd_pcm_runtime *runtime = substream->runtime;
 90
 91	mutex_lock(&opened_mutex);
 92	chip->opened++;
 93	runtime->hw = atmel_ac97c_hw;
 94	if (chip->cur_rate) {
 95		runtime->hw.rate_min = chip->cur_rate;
 96		runtime->hw.rate_max = chip->cur_rate;
 97	}
 98	if (chip->cur_format)
 99		runtime->hw.formats = pcm_format_to_bits(chip->cur_format);
100	mutex_unlock(&opened_mutex);
101	chip->playback_substream = substream;
102	return 0;
103}
104
105static int atmel_ac97c_capture_open(struct snd_pcm_substream *substream)
106{
107	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
108	struct snd_pcm_runtime *runtime = substream->runtime;
109
110	mutex_lock(&opened_mutex);
111	chip->opened++;
112	runtime->hw = atmel_ac97c_hw;
113	if (chip->cur_rate) {
114		runtime->hw.rate_min = chip->cur_rate;
115		runtime->hw.rate_max = chip->cur_rate;
116	}
117	if (chip->cur_format)
118		runtime->hw.formats = pcm_format_to_bits(chip->cur_format);
119	mutex_unlock(&opened_mutex);
120	chip->capture_substream = substream;
121	return 0;
122}
123
124static int atmel_ac97c_playback_close(struct snd_pcm_substream *substream)
125{
126	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
127
128	mutex_lock(&opened_mutex);
129	chip->opened--;
130	if (!chip->opened) {
131		chip->cur_rate = 0;
132		chip->cur_format = 0;
133	}
134	mutex_unlock(&opened_mutex);
135
136	chip->playback_substream = NULL;
137
138	return 0;
139}
140
141static int atmel_ac97c_capture_close(struct snd_pcm_substream *substream)
142{
143	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
144
145	mutex_lock(&opened_mutex);
146	chip->opened--;
147	if (!chip->opened) {
148		chip->cur_rate = 0;
149		chip->cur_format = 0;
150	}
151	mutex_unlock(&opened_mutex);
152
153	chip->capture_substream = NULL;
154
155	return 0;
156}
157
158static int atmel_ac97c_playback_hw_params(struct snd_pcm_substream *substream,
159		struct snd_pcm_hw_params *hw_params)
160{
161	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 
162
 
 
 
 
 
 
 
 
 
 
 
163	/* Set restrictions to params. */
164	mutex_lock(&opened_mutex);
165	chip->cur_rate = params_rate(hw_params);
166	chip->cur_format = params_format(hw_params);
167	mutex_unlock(&opened_mutex);
168
169	return 0;
170}
171
172static int atmel_ac97c_capture_hw_params(struct snd_pcm_substream *substream,
173		struct snd_pcm_hw_params *hw_params)
174{
175	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
176
177	/* Set restrictions to params. */
178	mutex_lock(&opened_mutex);
179	chip->cur_rate = params_rate(hw_params);
180	chip->cur_format = params_format(hw_params);
181	mutex_unlock(&opened_mutex);
182
183	return 0;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
184}
185
186static int atmel_ac97c_playback_prepare(struct snd_pcm_substream *substream)
187{
188	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
189	struct snd_pcm_runtime *runtime = substream->runtime;
190	int block_size = frames_to_bytes(runtime, runtime->period_size);
191	unsigned long word = ac97c_readl(chip, OCA);
192	int retval;
193
194	chip->playback_period = 0;
195	word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
196
197	/* assign channels to AC97C channel A */
198	switch (runtime->channels) {
199	case 1:
200		word |= AC97C_CH_ASSIGN(PCM_LEFT, A);
201		break;
202	case 2:
203		word |= AC97C_CH_ASSIGN(PCM_LEFT, A)
204			| AC97C_CH_ASSIGN(PCM_RIGHT, A);
205		break;
206	default:
207		/* TODO: support more than two channels */
208		return -EINVAL;
209	}
210	ac97c_writel(chip, OCA, word);
211
212	/* configure sample format and size */
213	word = ac97c_readl(chip, CAMR);
214	if (chip->opened <= 1)
215		word = AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
216	else
217		word |= AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
218
219	switch (runtime->format) {
220	case SNDRV_PCM_FORMAT_S16_LE:
 
 
221		break;
222	case SNDRV_PCM_FORMAT_S16_BE:
223		word &= ~(AC97C_CMR_CEM_LITTLE);
224		break;
225	default:
226		word = ac97c_readl(chip, OCA);
227		word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
228		ac97c_writel(chip, OCA, word);
229		return -EINVAL;
230	}
231
232	/* Enable underrun interrupt on channel A */
233	word |= AC97C_CSR_UNRUN;
234
235	ac97c_writel(chip, CAMR, word);
236
237	/* Enable channel A event interrupt */
238	word = ac97c_readl(chip, IMR);
239	word |= AC97C_SR_CAEVT;
240	ac97c_writel(chip, IER, word);
241
242	/* set variable rate if needed */
243	if (runtime->rate != 48000) {
244		word = ac97c_readl(chip, MR);
245		word |= AC97C_MR_VRA;
246		ac97c_writel(chip, MR, word);
247	} else {
248		word = ac97c_readl(chip, MR);
249		word &= ~(AC97C_MR_VRA);
250		ac97c_writel(chip, MR, word);
251	}
252
253	retval = snd_ac97_set_rate(chip->ac97, AC97_PCM_FRONT_DAC_RATE,
254			runtime->rate);
255	if (retval)
256		dev_dbg(&chip->pdev->dev, "could not set rate %d Hz\n",
257				runtime->rate);
258
259	/* Initialize and start the PDC */
260	writel(runtime->dma_addr, chip->regs + ATMEL_PDC_TPR);
261	writel(block_size / 2, chip->regs + ATMEL_PDC_TCR);
262	writel(runtime->dma_addr + block_size, chip->regs + ATMEL_PDC_TNPR);
263	writel(block_size / 2, chip->regs + ATMEL_PDC_TNCR);
 
 
 
 
 
 
 
264
265	return retval;
266}
267
268static int atmel_ac97c_capture_prepare(struct snd_pcm_substream *substream)
269{
270	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
271	struct snd_pcm_runtime *runtime = substream->runtime;
272	int block_size = frames_to_bytes(runtime, runtime->period_size);
273	unsigned long word = ac97c_readl(chip, ICA);
274	int retval;
275
276	chip->capture_period = 0;
277	word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
278
279	/* assign channels to AC97C channel A */
280	switch (runtime->channels) {
281	case 1:
282		word |= AC97C_CH_ASSIGN(PCM_LEFT, A);
283		break;
284	case 2:
285		word |= AC97C_CH_ASSIGN(PCM_LEFT, A)
286			| AC97C_CH_ASSIGN(PCM_RIGHT, A);
287		break;
288	default:
289		/* TODO: support more than two channels */
290		return -EINVAL;
291	}
292	ac97c_writel(chip, ICA, word);
293
294	/* configure sample format and size */
295	word = ac97c_readl(chip, CAMR);
296	if (chip->opened <= 1)
297		word = AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
298	else
299		word |= AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
300
301	switch (runtime->format) {
302	case SNDRV_PCM_FORMAT_S16_LE:
 
 
303		break;
304	case SNDRV_PCM_FORMAT_S16_BE:
305		word &= ~(AC97C_CMR_CEM_LITTLE);
306		break;
307	default:
308		word = ac97c_readl(chip, ICA);
309		word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
310		ac97c_writel(chip, ICA, word);
311		return -EINVAL;
312	}
313
314	/* Enable overrun interrupt on channel A */
315	word |= AC97C_CSR_OVRUN;
316
317	ac97c_writel(chip, CAMR, word);
318
319	/* Enable channel A event interrupt */
320	word = ac97c_readl(chip, IMR);
321	word |= AC97C_SR_CAEVT;
322	ac97c_writel(chip, IER, word);
323
324	/* set variable rate if needed */
325	if (runtime->rate != 48000) {
326		word = ac97c_readl(chip, MR);
327		word |= AC97C_MR_VRA;
328		ac97c_writel(chip, MR, word);
329	} else {
330		word = ac97c_readl(chip, MR);
331		word &= ~(AC97C_MR_VRA);
332		ac97c_writel(chip, MR, word);
333	}
334
335	retval = snd_ac97_set_rate(chip->ac97, AC97_PCM_LR_ADC_RATE,
336			runtime->rate);
337	if (retval)
338		dev_dbg(&chip->pdev->dev, "could not set rate %d Hz\n",
339				runtime->rate);
340
341	/* Initialize and start the PDC */
342	writel(runtime->dma_addr, chip->regs + ATMEL_PDC_RPR);
343	writel(block_size / 2, chip->regs + ATMEL_PDC_RCR);
344	writel(runtime->dma_addr + block_size, chip->regs + ATMEL_PDC_RNPR);
345	writel(block_size / 2, chip->regs + ATMEL_PDC_RNCR);
 
 
 
 
 
 
 
346
347	return retval;
348}
349
350static int
351atmel_ac97c_playback_trigger(struct snd_pcm_substream *substream, int cmd)
352{
353	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
354	unsigned long camr, ptcr = 0;
 
355
356	camr = ac97c_readl(chip, CAMR);
357
358	switch (cmd) {
359	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
360	case SNDRV_PCM_TRIGGER_RESUME:
361	case SNDRV_PCM_TRIGGER_START:
362		ptcr = ATMEL_PDC_TXTEN;
 
 
 
 
 
 
363		camr |= AC97C_CMR_CENA | AC97C_CSR_ENDTX;
364		break;
365	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
366	case SNDRV_PCM_TRIGGER_SUSPEND:
367	case SNDRV_PCM_TRIGGER_STOP:
368		ptcr |= ATMEL_PDC_TXTDIS;
 
 
 
369		if (chip->opened <= 1)
370			camr &= ~AC97C_CMR_CENA;
371		break;
372	default:
373		return -EINVAL;
 
374	}
375
376	ac97c_writel(chip, CAMR, camr);
377	writel(ptcr, chip->regs + ATMEL_PDC_PTCR);
378	return 0;
 
 
379}
380
381static int
382atmel_ac97c_capture_trigger(struct snd_pcm_substream *substream, int cmd)
383{
384	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
385	unsigned long camr, ptcr = 0;
 
386
387	camr = ac97c_readl(chip, CAMR);
388	ptcr = readl(chip->regs + ATMEL_PDC_PTSR);
389
390	switch (cmd) {
391	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
392	case SNDRV_PCM_TRIGGER_RESUME:
393	case SNDRV_PCM_TRIGGER_START:
394		ptcr = ATMEL_PDC_RXTEN;
 
 
 
 
 
 
395		camr |= AC97C_CMR_CENA | AC97C_CSR_ENDRX;
396		break;
397	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
398	case SNDRV_PCM_TRIGGER_SUSPEND:
399	case SNDRV_PCM_TRIGGER_STOP:
400		ptcr |= ATMEL_PDC_RXTDIS;
 
 
 
401		if (chip->opened <= 1)
402			camr &= ~AC97C_CMR_CENA;
403		break;
404	default:
405		return -EINVAL;
 
406	}
407
408	ac97c_writel(chip, CAMR, camr);
409	writel(ptcr, chip->regs + ATMEL_PDC_PTCR);
410	return 0;
 
 
411}
412
413static snd_pcm_uframes_t
414atmel_ac97c_playback_pointer(struct snd_pcm_substream *substream)
415{
416	struct atmel_ac97c	*chip = snd_pcm_substream_chip(substream);
417	struct snd_pcm_runtime	*runtime = substream->runtime;
418	snd_pcm_uframes_t	frames;
419	unsigned long		bytes;
420
421	bytes = readl(chip->regs + ATMEL_PDC_TPR);
 
 
 
422	bytes -= runtime->dma_addr;
423
424	frames = bytes_to_frames(runtime, bytes);
425	if (frames >= runtime->buffer_size)
426		frames -= runtime->buffer_size;
427	return frames;
428}
429
430static snd_pcm_uframes_t
431atmel_ac97c_capture_pointer(struct snd_pcm_substream *substream)
432{
433	struct atmel_ac97c	*chip = snd_pcm_substream_chip(substream);
434	struct snd_pcm_runtime	*runtime = substream->runtime;
435	snd_pcm_uframes_t	frames;
436	unsigned long		bytes;
437
438	bytes = readl(chip->regs + ATMEL_PDC_RPR);
 
 
 
439	bytes -= runtime->dma_addr;
440
441	frames = bytes_to_frames(runtime, bytes);
442	if (frames >= runtime->buffer_size)
443		frames -= runtime->buffer_size;
444	return frames;
445}
446
447static const struct snd_pcm_ops atmel_ac97_playback_ops = {
448	.open		= atmel_ac97c_playback_open,
449	.close		= atmel_ac97c_playback_close,
 
450	.hw_params	= atmel_ac97c_playback_hw_params,
 
451	.prepare	= atmel_ac97c_playback_prepare,
452	.trigger	= atmel_ac97c_playback_trigger,
453	.pointer	= atmel_ac97c_playback_pointer,
454};
455
456static const struct snd_pcm_ops atmel_ac97_capture_ops = {
457	.open		= atmel_ac97c_capture_open,
458	.close		= atmel_ac97c_capture_close,
 
459	.hw_params	= atmel_ac97c_capture_hw_params,
 
460	.prepare	= atmel_ac97c_capture_prepare,
461	.trigger	= atmel_ac97c_capture_trigger,
462	.pointer	= atmel_ac97c_capture_pointer,
463};
464
465static irqreturn_t atmel_ac97c_interrupt(int irq, void *dev)
466{
467	struct atmel_ac97c	*chip  = (struct atmel_ac97c *)dev;
468	irqreturn_t		retval = IRQ_NONE;
469	u32			sr     = ac97c_readl(chip, SR);
470	u32			casr   = ac97c_readl(chip, CASR);
471	u32			cosr   = ac97c_readl(chip, COSR);
472	u32			camr   = ac97c_readl(chip, CAMR);
473
474	if (sr & AC97C_SR_CAEVT) {
475		struct snd_pcm_runtime *runtime;
476		int offset, next_period, block_size;
477		dev_dbg(&chip->pdev->dev, "channel A event%s%s%s%s%s%s\n",
478				casr & AC97C_CSR_OVRUN   ? " OVRUN"   : "",
479				casr & AC97C_CSR_RXRDY   ? " RXRDY"   : "",
480				casr & AC97C_CSR_UNRUN   ? " UNRUN"   : "",
481				casr & AC97C_CSR_TXEMPTY ? " TXEMPTY" : "",
482				casr & AC97C_CSR_TXRDY   ? " TXRDY"   : "",
483				!casr                    ? " NONE"    : "");
484		if ((casr & camr) & AC97C_CSR_ENDTX) {
485			runtime = chip->playback_substream->runtime;
486			block_size = frames_to_bytes(runtime, runtime->period_size);
487			chip->playback_period++;
488
489			if (chip->playback_period == runtime->periods)
490				chip->playback_period = 0;
491			next_period = chip->playback_period + 1;
492			if (next_period == runtime->periods)
493				next_period = 0;
494
495			offset = block_size * next_period;
496
497			writel(runtime->dma_addr + offset, chip->regs + ATMEL_PDC_TNPR);
498			writel(block_size / 2, chip->regs + ATMEL_PDC_TNCR);
499
500			snd_pcm_period_elapsed(chip->playback_substream);
501		}
502		if ((casr & camr) & AC97C_CSR_ENDRX) {
503			runtime = chip->capture_substream->runtime;
504			block_size = frames_to_bytes(runtime, runtime->period_size);
505			chip->capture_period++;
506
507			if (chip->capture_period == runtime->periods)
508				chip->capture_period = 0;
509			next_period = chip->capture_period + 1;
510			if (next_period == runtime->periods)
511				next_period = 0;
512
513			offset = block_size * next_period;
514
515			writel(runtime->dma_addr + offset, chip->regs + ATMEL_PDC_RNPR);
516			writel(block_size / 2, chip->regs + ATMEL_PDC_RNCR);
517			snd_pcm_period_elapsed(chip->capture_substream);
 
 
 
 
 
 
 
 
 
518		}
519		retval = IRQ_HANDLED;
520	}
521
522	if (sr & AC97C_SR_COEVT) {
523		dev_info(&chip->pdev->dev, "codec channel event%s%s%s%s%s\n",
524				cosr & AC97C_CSR_OVRUN   ? " OVRUN"   : "",
525				cosr & AC97C_CSR_RXRDY   ? " RXRDY"   : "",
526				cosr & AC97C_CSR_TXEMPTY ? " TXEMPTY" : "",
527				cosr & AC97C_CSR_TXRDY   ? " TXRDY"   : "",
528				!cosr                    ? " NONE"    : "");
529		retval = IRQ_HANDLED;
530	}
531
532	if (retval == IRQ_NONE) {
533		dev_err(&chip->pdev->dev, "spurious interrupt sr 0x%08x "
534				"casr 0x%08x cosr 0x%08x\n", sr, casr, cosr);
535	}
536
537	return retval;
538}
539
540static const struct ac97_pcm at91_ac97_pcm_defs[] = {
541	/* Playback */
542	{
543		.exclusive = 1,
544		.r = { {
545			.slots = ((1 << AC97_SLOT_PCM_LEFT)
546				  | (1 << AC97_SLOT_PCM_RIGHT)),
547		} },
548	},
549	/* PCM in */
550	{
551		.stream = 1,
552		.exclusive = 1,
553		.r = { {
554			.slots = ((1 << AC97_SLOT_PCM_LEFT)
555					| (1 << AC97_SLOT_PCM_RIGHT)),
556		} }
557	},
558	/* Mic in */
559	{
560		.stream = 1,
561		.exclusive = 1,
562		.r = { {
563			.slots = (1<<AC97_SLOT_MIC),
564		} }
565	},
566};
567
568static int atmel_ac97c_pcm_new(struct atmel_ac97c *chip)
569{
570	struct snd_pcm		*pcm;
571	struct snd_pcm_hardware	hw = atmel_ac97c_hw;
572	int			retval;
573
574	retval = snd_ac97_pcm_assign(chip->ac97_bus,
575				     ARRAY_SIZE(at91_ac97_pcm_defs),
576				     at91_ac97_pcm_defs);
577	if (retval)
578		return retval;
579
580	retval = snd_pcm_new(chip->card, chip->card->shortname, 0, 1, 1, &pcm);
 
 
 
 
 
 
 
 
581	if (retval)
582		return retval;
583
584	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &atmel_ac97_capture_ops);
585	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &atmel_ac97_playback_ops);
 
 
 
 
586
587	snd_pcm_set_managed_buffer_all(pcm, SNDRV_DMA_TYPE_DEV,
588			&chip->pdev->dev, hw.periods_min * hw.period_bytes_min,
589			hw.buffer_bytes_max);
 
 
590
591	pcm->private_data = chip;
592	pcm->info_flags = 0;
593	strcpy(pcm->name, chip->card->shortname);
594	chip->pcm = pcm;
595
596	return 0;
597}
598
599static int atmel_ac97c_mixer_new(struct atmel_ac97c *chip)
600{
601	struct snd_ac97_template template;
602	memset(&template, 0, sizeof(template));
603	template.private_data = chip;
604	return snd_ac97_mixer(chip->ac97_bus, &template, &chip->ac97);
605}
606
607static void atmel_ac97c_write(struct snd_ac97 *ac97, unsigned short reg,
608		unsigned short val)
609{
610	struct atmel_ac97c *chip = get_chip(ac97);
611	unsigned long word;
612	int timeout = 40;
613
614	word = (reg & 0x7f) << 16 | val;
615
616	do {
617		if (ac97c_readl(chip, COSR) & AC97C_CSR_TXRDY) {
618			ac97c_writel(chip, COTHR, word);
619			return;
620		}
621		udelay(1);
622	} while (--timeout);
623
624	dev_dbg(&chip->pdev->dev, "codec write timeout\n");
625}
626
627static unsigned short atmel_ac97c_read(struct snd_ac97 *ac97,
628		unsigned short reg)
629{
630	struct atmel_ac97c *chip = get_chip(ac97);
631	unsigned long word;
632	int timeout = 40;
633	int write = 10;
634
635	word = (0x80 | (reg & 0x7f)) << 16;
636
637	if ((ac97c_readl(chip, COSR) & AC97C_CSR_RXRDY) != 0)
638		ac97c_readl(chip, CORHR);
639
640retry_write:
641	timeout = 40;
642
643	do {
644		if ((ac97c_readl(chip, COSR) & AC97C_CSR_TXRDY) != 0) {
645			ac97c_writel(chip, COTHR, word);
646			goto read_reg;
647		}
648		udelay(10);
649	} while (--timeout);
650
651	if (!--write)
652		goto timed_out;
653	goto retry_write;
654
655read_reg:
656	do {
657		if ((ac97c_readl(chip, COSR) & AC97C_CSR_RXRDY) != 0) {
658			unsigned short val = ac97c_readl(chip, CORHR);
659			return val;
660		}
661		udelay(10);
662	} while (--timeout);
663
664	if (!--write)
665		goto timed_out;
666	goto retry_write;
667
668timed_out:
669	dev_dbg(&chip->pdev->dev, "codec read timeout\n");
670	return 0xffff;
671}
672
 
 
 
 
 
 
 
 
 
 
 
673static void atmel_ac97c_reset(struct atmel_ac97c *chip)
674{
675	ac97c_writel(chip, MR,   0);
676	ac97c_writel(chip, MR,   AC97C_MR_ENA);
677	ac97c_writel(chip, CAMR, 0);
678	ac97c_writel(chip, COMR, 0);
679
680	if (!IS_ERR(chip->reset_pin)) {
681		gpiod_set_value(chip->reset_pin, 0);
682		/* AC97 v2.2 specifications says minimum 1 us. */
683		udelay(2);
684		gpiod_set_value(chip->reset_pin, 1);
685	} else {
686		ac97c_writel(chip, MR, AC97C_MR_WRST | AC97C_MR_ENA);
687		udelay(2);
688		ac97c_writel(chip, MR, AC97C_MR_ENA);
689	}
690}
691
692static const struct of_device_id atmel_ac97c_dt_ids[] = {
693	{ .compatible = "atmel,at91sam9263-ac97c", },
694	{ }
695};
696MODULE_DEVICE_TABLE(of, atmel_ac97c_dt_ids);
697
698static int atmel_ac97c_probe(struct platform_device *pdev)
699{
700	struct device			*dev = &pdev->dev;
701	struct snd_card			*card;
702	struct atmel_ac97c		*chip;
703	struct resource			*regs;
 
704	struct clk			*pclk;
705	static const struct snd_ac97_bus_ops	ops = {
706		.write	= atmel_ac97c_write,
707		.read	= atmel_ac97c_read,
708	};
709	int				retval;
710	int				irq;
711
712	regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
713	if (!regs) {
714		dev_dbg(&pdev->dev, "no memory resource\n");
715		return -ENXIO;
716	}
717
 
 
 
 
 
 
718	irq = platform_get_irq(pdev, 0);
719	if (irq < 0) {
720		dev_dbg(&pdev->dev, "could not get irq: %d\n", irq);
721		return irq;
 
 
 
 
 
 
722	}
723
724	pclk = clk_get(&pdev->dev, "ac97_clk");
725	if (IS_ERR(pclk)) {
726		dev_dbg(&pdev->dev, "no peripheral clock\n");
727		return PTR_ERR(pclk);
728	}
729	retval = clk_prepare_enable(pclk);
730	if (retval)
731		goto err_prepare_enable;
732
733	retval = snd_card_new(&pdev->dev, SNDRV_DEFAULT_IDX1,
734			      SNDRV_DEFAULT_STR1, THIS_MODULE,
735			      sizeof(struct atmel_ac97c), &card);
736	if (retval) {
737		dev_dbg(&pdev->dev, "could not create sound card device\n");
738		goto err_snd_card_new;
739	}
740
741	chip = get_chip(card);
742
743	retval = request_irq(irq, atmel_ac97c_interrupt, 0, "AC97C", chip);
744	if (retval) {
745		dev_dbg(&pdev->dev, "unable to request irq %d\n", irq);
746		goto err_request_irq;
747	}
748	chip->irq = irq;
749
750	spin_lock_init(&chip->lock);
751
752	strcpy(card->driver, "Atmel AC97C");
753	strcpy(card->shortname, "Atmel AC97C");
754	sprintf(card->longname, "Atmel AC97 controller");
755
756	chip->card = card;
757	chip->pclk = pclk;
758	chip->pdev = pdev;
759	chip->regs = ioremap(regs->start, resource_size(regs));
760
761	if (!chip->regs) {
762		dev_dbg(&pdev->dev, "could not remap register memory\n");
763		retval = -ENOMEM;
764		goto err_ioremap;
765	}
766
767	chip->reset_pin = devm_gpiod_get_index(dev, "ac97", 2, GPIOD_OUT_HIGH);
768	if (IS_ERR(chip->reset_pin))
769		dev_dbg(dev, "reset pin not available\n");
 
 
 
 
 
 
 
 
770
771	atmel_ac97c_reset(chip);
772
773	/* Enable overrun interrupt from codec channel */
774	ac97c_writel(chip, COMR, AC97C_CSR_OVRUN);
775	ac97c_writel(chip, IER, ac97c_readl(chip, IMR) | AC97C_SR_COEVT);
776
777	retval = snd_ac97_bus(card, 0, &ops, chip, &chip->ac97_bus);
778	if (retval) {
779		dev_dbg(&pdev->dev, "could not register on ac97 bus\n");
780		goto err_ac97_bus;
781	}
782
783	retval = atmel_ac97c_mixer_new(chip);
784	if (retval) {
785		dev_dbg(&pdev->dev, "could not register ac97 mixer\n");
786		goto err_ac97_bus;
787	}
788
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
789	retval = atmel_ac97c_pcm_new(chip);
790	if (retval) {
791		dev_dbg(&pdev->dev, "could not register ac97 pcm device\n");
792		goto err_ac97_bus;
793	}
794
795	retval = snd_card_register(card);
796	if (retval) {
797		dev_dbg(&pdev->dev, "could not register sound card\n");
798		goto err_ac97_bus;
799	}
800
801	platform_set_drvdata(pdev, card);
802
803	dev_info(&pdev->dev, "Atmel AC97 controller at 0x%p, irq = %d\n",
804			chip->regs, irq);
805
806	return 0;
807
 
 
 
 
 
 
 
 
 
 
 
808err_ac97_bus:
 
 
 
 
 
809	iounmap(chip->regs);
810err_ioremap:
811	free_irq(irq, chip);
812err_request_irq:
813	snd_card_free(card);
814err_snd_card_new:
815	clk_disable_unprepare(pclk);
816err_prepare_enable:
817	clk_put(pclk);
818	return retval;
819}
820
821#ifdef CONFIG_PM_SLEEP
822static int atmel_ac97c_suspend(struct device *pdev)
823{
824	struct snd_card *card = dev_get_drvdata(pdev);
825	struct atmel_ac97c *chip = card->private_data;
826
827	clk_disable_unprepare(chip->pclk);
 
 
 
 
 
 
 
828	return 0;
829}
830
831static int atmel_ac97c_resume(struct device *pdev)
832{
833	struct snd_card *card = dev_get_drvdata(pdev);
834	struct atmel_ac97c *chip = card->private_data;
835	int ret = clk_prepare_enable(chip->pclk);
836
837	return ret;
 
 
 
 
 
 
 
838}
839
840static SIMPLE_DEV_PM_OPS(atmel_ac97c_pm, atmel_ac97c_suspend, atmel_ac97c_resume);
841#define ATMEL_AC97C_PM_OPS	&atmel_ac97c_pm
842#else
843#define ATMEL_AC97C_PM_OPS	NULL
 
844#endif
845
846static int atmel_ac97c_remove(struct platform_device *pdev)
847{
848	struct snd_card *card = platform_get_drvdata(pdev);
849	struct atmel_ac97c *chip = get_chip(card);
850
 
 
 
851	ac97c_writel(chip, CAMR, 0);
852	ac97c_writel(chip, COMR, 0);
853	ac97c_writel(chip, MR,   0);
854
855	clk_disable_unprepare(chip->pclk);
856	clk_put(chip->pclk);
857	iounmap(chip->regs);
858	free_irq(chip->irq, chip);
859
 
 
 
 
 
 
 
 
 
 
 
 
860	snd_card_free(card);
861
 
 
862	return 0;
863}
864
865static struct platform_driver atmel_ac97c_driver = {
866	.probe		= atmel_ac97c_probe,
867	.remove		= atmel_ac97c_remove,
868	.driver		= {
869		.name	= "atmel_ac97c",
870		.pm	= ATMEL_AC97C_PM_OPS,
871		.of_match_table = atmel_ac97c_dt_ids,
872	},
 
 
873};
874module_platform_driver(atmel_ac97c_driver);
 
 
 
 
 
 
 
 
 
 
 
 
875
876MODULE_LICENSE("GPL");
877MODULE_DESCRIPTION("Driver for Atmel AC97 controller");
878MODULE_AUTHOR("Hans-Christian Egtvedt <egtvedt@samfundet.no>");