Linux Audio

Check our new training course

Loading...
v5.14.15
  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>");
v4.17
 
  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/atmel_pdc.h>
 15#include <linux/gpio/consumer.h>
 16#include <linux/init.h>
 17#include <linux/interrupt.h>
 18#include <linux/module.h>
 19#include <linux/platform_device.h>
 20#include <linux/mutex.h>
 21#include <linux/types.h>
 22#include <linux/io.h>
 23#include <linux/of.h>
 24#include <linux/of_device.h>
 25
 26#include <sound/core.h>
 27#include <sound/initval.h>
 28#include <sound/pcm.h>
 29#include <sound/pcm_params.h>
 30#include <sound/ac97_codec.h>
 31#include <sound/memalloc.h>
 32
 33#include "ac97c.h"
 34
 35/* Serialize access to opened variable */
 36static DEFINE_MUTEX(opened_mutex);
 37
 38struct atmel_ac97c {
 39	struct clk			*pclk;
 40	struct platform_device		*pdev;
 41
 42	struct snd_pcm_substream	*playback_substream;
 43	struct snd_pcm_substream	*capture_substream;
 44	struct snd_card			*card;
 45	struct snd_pcm			*pcm;
 46	struct snd_ac97			*ac97;
 47	struct snd_ac97_bus		*ac97_bus;
 48
 49	u64				cur_format;
 50	unsigned int			cur_rate;
 51	int				playback_period, capture_period;
 52	/* Serialize access to opened variable */
 53	spinlock_t			lock;
 54	void __iomem			*regs;
 55	int				irq;
 56	int				opened;
 57	struct gpio_desc		*reset_pin;
 58};
 59
 60#define get_chip(card) ((struct atmel_ac97c *)(card)->private_data)
 61
 62#define ac97c_writel(chip, reg, val)			\
 63	__raw_writel((val), (chip)->regs + AC97C_##reg)
 64#define ac97c_readl(chip, reg)				\
 65	__raw_readl((chip)->regs + AC97C_##reg)
 66
 67static const struct snd_pcm_hardware atmel_ac97c_hw = {
 68	.info			= (SNDRV_PCM_INFO_MMAP
 69				  | SNDRV_PCM_INFO_MMAP_VALID
 70				  | SNDRV_PCM_INFO_INTERLEAVED
 71				  | SNDRV_PCM_INFO_BLOCK_TRANSFER
 72				  | SNDRV_PCM_INFO_JOINT_DUPLEX
 73				  | SNDRV_PCM_INFO_RESUME
 74				  | SNDRV_PCM_INFO_PAUSE),
 75	.formats		= (SNDRV_PCM_FMTBIT_S16_BE
 76				  | SNDRV_PCM_FMTBIT_S16_LE),
 77	.rates			= (SNDRV_PCM_RATE_CONTINUOUS),
 78	.rate_min		= 4000,
 79	.rate_max		= 48000,
 80	.channels_min		= 1,
 81	.channels_max		= 2,
 82	.buffer_bytes_max	= 2 * 2 * 64 * 2048,
 83	.period_bytes_min	= 4096,
 84	.period_bytes_max	= 4096,
 85	.periods_min		= 6,
 86	.periods_max		= 64,
 87};
 88
 89static int atmel_ac97c_playback_open(struct snd_pcm_substream *substream)
 90{
 91	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
 92	struct snd_pcm_runtime *runtime = substream->runtime;
 93
 94	mutex_lock(&opened_mutex);
 95	chip->opened++;
 96	runtime->hw = atmel_ac97c_hw;
 97	if (chip->cur_rate) {
 98		runtime->hw.rate_min = chip->cur_rate;
 99		runtime->hw.rate_max = chip->cur_rate;
100	}
101	if (chip->cur_format)
102		runtime->hw.formats = pcm_format_to_bits(chip->cur_format);
103	mutex_unlock(&opened_mutex);
104	chip->playback_substream = substream;
105	return 0;
106}
107
108static int atmel_ac97c_capture_open(struct snd_pcm_substream *substream)
109{
110	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
111	struct snd_pcm_runtime *runtime = substream->runtime;
112
113	mutex_lock(&opened_mutex);
114	chip->opened++;
115	runtime->hw = atmel_ac97c_hw;
116	if (chip->cur_rate) {
117		runtime->hw.rate_min = chip->cur_rate;
118		runtime->hw.rate_max = chip->cur_rate;
119	}
120	if (chip->cur_format)
121		runtime->hw.formats = pcm_format_to_bits(chip->cur_format);
122	mutex_unlock(&opened_mutex);
123	chip->capture_substream = substream;
124	return 0;
125}
126
127static int atmel_ac97c_playback_close(struct snd_pcm_substream *substream)
128{
129	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
130
131	mutex_lock(&opened_mutex);
132	chip->opened--;
133	if (!chip->opened) {
134		chip->cur_rate = 0;
135		chip->cur_format = 0;
136	}
137	mutex_unlock(&opened_mutex);
138
139	chip->playback_substream = NULL;
140
141	return 0;
142}
143
144static int atmel_ac97c_capture_close(struct snd_pcm_substream *substream)
145{
146	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
147
148	mutex_lock(&opened_mutex);
149	chip->opened--;
150	if (!chip->opened) {
151		chip->cur_rate = 0;
152		chip->cur_format = 0;
153	}
154	mutex_unlock(&opened_mutex);
155
156	chip->capture_substream = NULL;
157
158	return 0;
159}
160
161static int atmel_ac97c_playback_hw_params(struct snd_pcm_substream *substream,
162		struct snd_pcm_hw_params *hw_params)
163{
164	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
165	int retval;
166
167	retval = snd_pcm_lib_malloc_pages(substream,
168					params_buffer_bytes(hw_params));
169	if (retval < 0)
170		return retval;
171
172	/* Set restrictions to params. */
173	mutex_lock(&opened_mutex);
174	chip->cur_rate = params_rate(hw_params);
175	chip->cur_format = params_format(hw_params);
176	mutex_unlock(&opened_mutex);
177
178	return retval;
179}
180
181static int atmel_ac97c_capture_hw_params(struct snd_pcm_substream *substream,
182		struct snd_pcm_hw_params *hw_params)
183{
184	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
185	int retval;
186
187	retval = snd_pcm_lib_malloc_pages(substream,
188					params_buffer_bytes(hw_params));
189	if (retval < 0)
190		return retval;
191
192	/* Set restrictions to params. */
193	mutex_lock(&opened_mutex);
194	chip->cur_rate = params_rate(hw_params);
195	chip->cur_format = params_format(hw_params);
196	mutex_unlock(&opened_mutex);
197
198	return retval;
199}
200
201static int atmel_ac97c_playback_prepare(struct snd_pcm_substream *substream)
202{
203	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
204	struct snd_pcm_runtime *runtime = substream->runtime;
205	int block_size = frames_to_bytes(runtime, runtime->period_size);
206	unsigned long word = ac97c_readl(chip, OCA);
207	int retval;
208
209	chip->playback_period = 0;
210	word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
211
212	/* assign channels to AC97C channel A */
213	switch (runtime->channels) {
214	case 1:
215		word |= AC97C_CH_ASSIGN(PCM_LEFT, A);
216		break;
217	case 2:
218		word |= AC97C_CH_ASSIGN(PCM_LEFT, A)
219			| AC97C_CH_ASSIGN(PCM_RIGHT, A);
220		break;
221	default:
222		/* TODO: support more than two channels */
223		return -EINVAL;
224	}
225	ac97c_writel(chip, OCA, word);
226
227	/* configure sample format and size */
228	word = ac97c_readl(chip, CAMR);
229	if (chip->opened <= 1)
230		word = AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
231	else
232		word |= AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
233
234	switch (runtime->format) {
235	case SNDRV_PCM_FORMAT_S16_LE:
236		break;
237	case SNDRV_PCM_FORMAT_S16_BE: /* fall through */
238		word &= ~(AC97C_CMR_CEM_LITTLE);
239		break;
240	default:
241		word = ac97c_readl(chip, OCA);
242		word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
243		ac97c_writel(chip, OCA, word);
244		return -EINVAL;
245	}
246
247	/* Enable underrun interrupt on channel A */
248	word |= AC97C_CSR_UNRUN;
249
250	ac97c_writel(chip, CAMR, word);
251
252	/* Enable channel A event interrupt */
253	word = ac97c_readl(chip, IMR);
254	word |= AC97C_SR_CAEVT;
255	ac97c_writel(chip, IER, word);
256
257	/* set variable rate if needed */
258	if (runtime->rate != 48000) {
259		word = ac97c_readl(chip, MR);
260		word |= AC97C_MR_VRA;
261		ac97c_writel(chip, MR, word);
262	} else {
263		word = ac97c_readl(chip, MR);
264		word &= ~(AC97C_MR_VRA);
265		ac97c_writel(chip, MR, word);
266	}
267
268	retval = snd_ac97_set_rate(chip->ac97, AC97_PCM_FRONT_DAC_RATE,
269			runtime->rate);
270	if (retval)
271		dev_dbg(&chip->pdev->dev, "could not set rate %d Hz\n",
272				runtime->rate);
273
274	/* Initialize and start the PDC */
275	writel(runtime->dma_addr, chip->regs + ATMEL_PDC_TPR);
276	writel(block_size / 2, chip->regs + ATMEL_PDC_TCR);
277	writel(runtime->dma_addr + block_size, chip->regs + ATMEL_PDC_TNPR);
278	writel(block_size / 2, chip->regs + ATMEL_PDC_TNCR);
279
280	return retval;
281}
282
283static int atmel_ac97c_capture_prepare(struct snd_pcm_substream *substream)
284{
285	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
286	struct snd_pcm_runtime *runtime = substream->runtime;
287	int block_size = frames_to_bytes(runtime, runtime->period_size);
288	unsigned long word = ac97c_readl(chip, ICA);
289	int retval;
290
291	chip->capture_period = 0;
292	word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
293
294	/* assign channels to AC97C channel A */
295	switch (runtime->channels) {
296	case 1:
297		word |= AC97C_CH_ASSIGN(PCM_LEFT, A);
298		break;
299	case 2:
300		word |= AC97C_CH_ASSIGN(PCM_LEFT, A)
301			| AC97C_CH_ASSIGN(PCM_RIGHT, A);
302		break;
303	default:
304		/* TODO: support more than two channels */
305		return -EINVAL;
306	}
307	ac97c_writel(chip, ICA, word);
308
309	/* configure sample format and size */
310	word = ac97c_readl(chip, CAMR);
311	if (chip->opened <= 1)
312		word = AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
313	else
314		word |= AC97C_CMR_DMAEN | AC97C_CMR_SIZE_16;
315
316	switch (runtime->format) {
317	case SNDRV_PCM_FORMAT_S16_LE:
318		break;
319	case SNDRV_PCM_FORMAT_S16_BE: /* fall through */
320		word &= ~(AC97C_CMR_CEM_LITTLE);
321		break;
322	default:
323		word = ac97c_readl(chip, ICA);
324		word &= ~(AC97C_CH_MASK(PCM_LEFT) | AC97C_CH_MASK(PCM_RIGHT));
325		ac97c_writel(chip, ICA, word);
326		return -EINVAL;
327	}
328
329	/* Enable overrun interrupt on channel A */
330	word |= AC97C_CSR_OVRUN;
331
332	ac97c_writel(chip, CAMR, word);
333
334	/* Enable channel A event interrupt */
335	word = ac97c_readl(chip, IMR);
336	word |= AC97C_SR_CAEVT;
337	ac97c_writel(chip, IER, word);
338
339	/* set variable rate if needed */
340	if (runtime->rate != 48000) {
341		word = ac97c_readl(chip, MR);
342		word |= AC97C_MR_VRA;
343		ac97c_writel(chip, MR, word);
344	} else {
345		word = ac97c_readl(chip, MR);
346		word &= ~(AC97C_MR_VRA);
347		ac97c_writel(chip, MR, word);
348	}
349
350	retval = snd_ac97_set_rate(chip->ac97, AC97_PCM_LR_ADC_RATE,
351			runtime->rate);
352	if (retval)
353		dev_dbg(&chip->pdev->dev, "could not set rate %d Hz\n",
354				runtime->rate);
355
356	/* Initialize and start the PDC */
357	writel(runtime->dma_addr, chip->regs + ATMEL_PDC_RPR);
358	writel(block_size / 2, chip->regs + ATMEL_PDC_RCR);
359	writel(runtime->dma_addr + block_size, chip->regs + ATMEL_PDC_RNPR);
360	writel(block_size / 2, chip->regs + ATMEL_PDC_RNCR);
361
362	return retval;
363}
364
365static int
366atmel_ac97c_playback_trigger(struct snd_pcm_substream *substream, int cmd)
367{
368	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
369	unsigned long camr, ptcr = 0;
370
371	camr = ac97c_readl(chip, CAMR);
372
373	switch (cmd) {
374	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: /* fall through */
375	case SNDRV_PCM_TRIGGER_RESUME: /* fall through */
376	case SNDRV_PCM_TRIGGER_START:
377		ptcr = ATMEL_PDC_TXTEN;
378		camr |= AC97C_CMR_CENA | AC97C_CSR_ENDTX;
379		break;
380	case SNDRV_PCM_TRIGGER_PAUSE_PUSH: /* fall through */
381	case SNDRV_PCM_TRIGGER_SUSPEND: /* fall through */
382	case SNDRV_PCM_TRIGGER_STOP:
383		ptcr |= ATMEL_PDC_TXTDIS;
384		if (chip->opened <= 1)
385			camr &= ~AC97C_CMR_CENA;
386		break;
387	default:
388		return -EINVAL;
389	}
390
391	ac97c_writel(chip, CAMR, camr);
392	writel(ptcr, chip->regs + ATMEL_PDC_PTCR);
393	return 0;
394}
395
396static int
397atmel_ac97c_capture_trigger(struct snd_pcm_substream *substream, int cmd)
398{
399	struct atmel_ac97c *chip = snd_pcm_substream_chip(substream);
400	unsigned long camr, ptcr = 0;
401
402	camr = ac97c_readl(chip, CAMR);
403	ptcr = readl(chip->regs + ATMEL_PDC_PTSR);
404
405	switch (cmd) {
406	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE: /* fall through */
407	case SNDRV_PCM_TRIGGER_RESUME: /* fall through */
408	case SNDRV_PCM_TRIGGER_START:
409		ptcr = ATMEL_PDC_RXTEN;
410		camr |= AC97C_CMR_CENA | AC97C_CSR_ENDRX;
411		break;
412	case SNDRV_PCM_TRIGGER_PAUSE_PUSH: /* fall through */
413	case SNDRV_PCM_TRIGGER_SUSPEND: /* fall through */
414	case SNDRV_PCM_TRIGGER_STOP:
415		ptcr |= ATMEL_PDC_RXTDIS;
416		if (chip->opened <= 1)
417			camr &= ~AC97C_CMR_CENA;
418		break;
419	default:
420		return -EINVAL;
421	}
422
423	ac97c_writel(chip, CAMR, camr);
424	writel(ptcr, chip->regs + ATMEL_PDC_PTCR);
425	return 0;
426}
427
428static snd_pcm_uframes_t
429atmel_ac97c_playback_pointer(struct snd_pcm_substream *substream)
430{
431	struct atmel_ac97c	*chip = snd_pcm_substream_chip(substream);
432	struct snd_pcm_runtime	*runtime = substream->runtime;
433	snd_pcm_uframes_t	frames;
434	unsigned long		bytes;
435
436	bytes = readl(chip->regs + ATMEL_PDC_TPR);
437	bytes -= runtime->dma_addr;
438
439	frames = bytes_to_frames(runtime, bytes);
440	if (frames >= runtime->buffer_size)
441		frames -= runtime->buffer_size;
442	return frames;
443}
444
445static snd_pcm_uframes_t
446atmel_ac97c_capture_pointer(struct snd_pcm_substream *substream)
447{
448	struct atmel_ac97c	*chip = snd_pcm_substream_chip(substream);
449	struct snd_pcm_runtime	*runtime = substream->runtime;
450	snd_pcm_uframes_t	frames;
451	unsigned long		bytes;
452
453	bytes = readl(chip->regs + ATMEL_PDC_RPR);
454	bytes -= runtime->dma_addr;
455
456	frames = bytes_to_frames(runtime, bytes);
457	if (frames >= runtime->buffer_size)
458		frames -= runtime->buffer_size;
459	return frames;
460}
461
462static const struct snd_pcm_ops atmel_ac97_playback_ops = {
463	.open		= atmel_ac97c_playback_open,
464	.close		= atmel_ac97c_playback_close,
465	.ioctl		= snd_pcm_lib_ioctl,
466	.hw_params	= atmel_ac97c_playback_hw_params,
467	.hw_free	= snd_pcm_lib_free_pages,
468	.prepare	= atmel_ac97c_playback_prepare,
469	.trigger	= atmel_ac97c_playback_trigger,
470	.pointer	= atmel_ac97c_playback_pointer,
471};
472
473static const struct snd_pcm_ops atmel_ac97_capture_ops = {
474	.open		= atmel_ac97c_capture_open,
475	.close		= atmel_ac97c_capture_close,
476	.ioctl		= snd_pcm_lib_ioctl,
477	.hw_params	= atmel_ac97c_capture_hw_params,
478	.hw_free	= snd_pcm_lib_free_pages,
479	.prepare	= atmel_ac97c_capture_prepare,
480	.trigger	= atmel_ac97c_capture_trigger,
481	.pointer	= atmel_ac97c_capture_pointer,
482};
483
484static irqreturn_t atmel_ac97c_interrupt(int irq, void *dev)
485{
486	struct atmel_ac97c	*chip  = (struct atmel_ac97c *)dev;
487	irqreturn_t		retval = IRQ_NONE;
488	u32			sr     = ac97c_readl(chip, SR);
489	u32			casr   = ac97c_readl(chip, CASR);
490	u32			cosr   = ac97c_readl(chip, COSR);
491	u32			camr   = ac97c_readl(chip, CAMR);
492
493	if (sr & AC97C_SR_CAEVT) {
494		struct snd_pcm_runtime *runtime;
495		int offset, next_period, block_size;
496		dev_dbg(&chip->pdev->dev, "channel A event%s%s%s%s%s%s\n",
497				casr & AC97C_CSR_OVRUN   ? " OVRUN"   : "",
498				casr & AC97C_CSR_RXRDY   ? " RXRDY"   : "",
499				casr & AC97C_CSR_UNRUN   ? " UNRUN"   : "",
500				casr & AC97C_CSR_TXEMPTY ? " TXEMPTY" : "",
501				casr & AC97C_CSR_TXRDY   ? " TXRDY"   : "",
502				!casr                    ? " NONE"    : "");
503		if ((casr & camr) & AC97C_CSR_ENDTX) {
504			runtime = chip->playback_substream->runtime;
505			block_size = frames_to_bytes(runtime, runtime->period_size);
506			chip->playback_period++;
507
508			if (chip->playback_period == runtime->periods)
509				chip->playback_period = 0;
510			next_period = chip->playback_period + 1;
511			if (next_period == runtime->periods)
512				next_period = 0;
513
514			offset = block_size * next_period;
515
516			writel(runtime->dma_addr + offset, chip->regs + ATMEL_PDC_TNPR);
517			writel(block_size / 2, chip->regs + ATMEL_PDC_TNCR);
518
519			snd_pcm_period_elapsed(chip->playback_substream);
520		}
521		if ((casr & camr) & AC97C_CSR_ENDRX) {
522			runtime = chip->capture_substream->runtime;
523			block_size = frames_to_bytes(runtime, runtime->period_size);
524			chip->capture_period++;
525
526			if (chip->capture_period == runtime->periods)
527				chip->capture_period = 0;
528			next_period = chip->capture_period + 1;
529			if (next_period == runtime->periods)
530				next_period = 0;
531
532			offset = block_size * next_period;
533
534			writel(runtime->dma_addr + offset, chip->regs + ATMEL_PDC_RNPR);
535			writel(block_size / 2, chip->regs + ATMEL_PDC_RNCR);
536			snd_pcm_period_elapsed(chip->capture_substream);
537		}
538		retval = IRQ_HANDLED;
539	}
540
541	if (sr & AC97C_SR_COEVT) {
542		dev_info(&chip->pdev->dev, "codec channel event%s%s%s%s%s\n",
543				cosr & AC97C_CSR_OVRUN   ? " OVRUN"   : "",
544				cosr & AC97C_CSR_RXRDY   ? " RXRDY"   : "",
545				cosr & AC97C_CSR_TXEMPTY ? " TXEMPTY" : "",
546				cosr & AC97C_CSR_TXRDY   ? " TXRDY"   : "",
547				!cosr                    ? " NONE"    : "");
548		retval = IRQ_HANDLED;
549	}
550
551	if (retval == IRQ_NONE) {
552		dev_err(&chip->pdev->dev, "spurious interrupt sr 0x%08x "
553				"casr 0x%08x cosr 0x%08x\n", sr, casr, cosr);
554	}
555
556	return retval;
557}
558
559static const struct ac97_pcm at91_ac97_pcm_defs[] = {
560	/* Playback */
561	{
562		.exclusive = 1,
563		.r = { {
564			.slots = ((1 << AC97_SLOT_PCM_LEFT)
565				  | (1 << AC97_SLOT_PCM_RIGHT)),
566		} },
567	},
568	/* PCM in */
569	{
570		.stream = 1,
571		.exclusive = 1,
572		.r = { {
573			.slots = ((1 << AC97_SLOT_PCM_LEFT)
574					| (1 << AC97_SLOT_PCM_RIGHT)),
575		} }
576	},
577	/* Mic in */
578	{
579		.stream = 1,
580		.exclusive = 1,
581		.r = { {
582			.slots = (1<<AC97_SLOT_MIC),
583		} }
584	},
585};
586
587static int atmel_ac97c_pcm_new(struct atmel_ac97c *chip)
588{
589	struct snd_pcm		*pcm;
590	struct snd_pcm_hardware	hw = atmel_ac97c_hw;
591	int			retval;
592
593	retval = snd_ac97_pcm_assign(chip->ac97_bus,
594				     ARRAY_SIZE(at91_ac97_pcm_defs),
595				     at91_ac97_pcm_defs);
596	if (retval)
597		return retval;
598
599	retval = snd_pcm_new(chip->card, chip->card->shortname, 0, 1, 1, &pcm);
600	if (retval)
601		return retval;
602
603	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &atmel_ac97_capture_ops);
604	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &atmel_ac97_playback_ops);
605
606	retval = snd_pcm_lib_preallocate_pages_for_all(pcm, SNDRV_DMA_TYPE_DEV,
607			&chip->pdev->dev, hw.periods_min * hw.period_bytes_min,
608			hw.buffer_bytes_max);
609	if (retval)
610		return retval;
611
612	pcm->private_data = chip;
613	pcm->info_flags = 0;
614	strcpy(pcm->name, chip->card->shortname);
615	chip->pcm = pcm;
616
617	return 0;
618}
619
620static int atmel_ac97c_mixer_new(struct atmel_ac97c *chip)
621{
622	struct snd_ac97_template template;
623	memset(&template, 0, sizeof(template));
624	template.private_data = chip;
625	return snd_ac97_mixer(chip->ac97_bus, &template, &chip->ac97);
626}
627
628static void atmel_ac97c_write(struct snd_ac97 *ac97, unsigned short reg,
629		unsigned short val)
630{
631	struct atmel_ac97c *chip = get_chip(ac97);
632	unsigned long word;
633	int timeout = 40;
634
635	word = (reg & 0x7f) << 16 | val;
636
637	do {
638		if (ac97c_readl(chip, COSR) & AC97C_CSR_TXRDY) {
639			ac97c_writel(chip, COTHR, word);
640			return;
641		}
642		udelay(1);
643	} while (--timeout);
644
645	dev_dbg(&chip->pdev->dev, "codec write timeout\n");
646}
647
648static unsigned short atmel_ac97c_read(struct snd_ac97 *ac97,
649		unsigned short reg)
650{
651	struct atmel_ac97c *chip = get_chip(ac97);
652	unsigned long word;
653	int timeout = 40;
654	int write = 10;
655
656	word = (0x80 | (reg & 0x7f)) << 16;
657
658	if ((ac97c_readl(chip, COSR) & AC97C_CSR_RXRDY) != 0)
659		ac97c_readl(chip, CORHR);
660
661retry_write:
662	timeout = 40;
663
664	do {
665		if ((ac97c_readl(chip, COSR) & AC97C_CSR_TXRDY) != 0) {
666			ac97c_writel(chip, COTHR, word);
667			goto read_reg;
668		}
669		udelay(10);
670	} while (--timeout);
671
672	if (!--write)
673		goto timed_out;
674	goto retry_write;
675
676read_reg:
677	do {
678		if ((ac97c_readl(chip, COSR) & AC97C_CSR_RXRDY) != 0) {
679			unsigned short val = ac97c_readl(chip, CORHR);
680			return val;
681		}
682		udelay(10);
683	} while (--timeout);
684
685	if (!--write)
686		goto timed_out;
687	goto retry_write;
688
689timed_out:
690	dev_dbg(&chip->pdev->dev, "codec read timeout\n");
691	return 0xffff;
692}
693
694static void atmel_ac97c_reset(struct atmel_ac97c *chip)
695{
696	ac97c_writel(chip, MR,   0);
697	ac97c_writel(chip, MR,   AC97C_MR_ENA);
698	ac97c_writel(chip, CAMR, 0);
699	ac97c_writel(chip, COMR, 0);
700
701	if (!IS_ERR(chip->reset_pin)) {
702		gpiod_set_value(chip->reset_pin, 0);
703		/* AC97 v2.2 specifications says minimum 1 us. */
704		udelay(2);
705		gpiod_set_value(chip->reset_pin, 1);
706	} else {
707		ac97c_writel(chip, MR, AC97C_MR_WRST | AC97C_MR_ENA);
708		udelay(2);
709		ac97c_writel(chip, MR, AC97C_MR_ENA);
710	}
711}
712
713static const struct of_device_id atmel_ac97c_dt_ids[] = {
714	{ .compatible = "atmel,at91sam9263-ac97c", },
715	{ }
716};
717MODULE_DEVICE_TABLE(of, atmel_ac97c_dt_ids);
718
719static int atmel_ac97c_probe(struct platform_device *pdev)
720{
721	struct device			*dev = &pdev->dev;
722	struct snd_card			*card;
723	struct atmel_ac97c		*chip;
724	struct resource			*regs;
725	struct clk			*pclk;
726	static struct snd_ac97_bus_ops	ops = {
727		.write	= atmel_ac97c_write,
728		.read	= atmel_ac97c_read,
729	};
730	int				retval;
731	int				irq;
732
733	regs = platform_get_resource(pdev, IORESOURCE_MEM, 0);
734	if (!regs) {
735		dev_dbg(&pdev->dev, "no memory resource\n");
736		return -ENXIO;
737	}
738
739	irq = platform_get_irq(pdev, 0);
740	if (irq < 0) {
741		dev_dbg(&pdev->dev, "could not get irq: %d\n", irq);
742		return irq;
743	}
744
745	pclk = clk_get(&pdev->dev, "ac97_clk");
746	if (IS_ERR(pclk)) {
747		dev_dbg(&pdev->dev, "no peripheral clock\n");
748		return PTR_ERR(pclk);
749	}
750	retval = clk_prepare_enable(pclk);
751	if (retval)
752		goto err_prepare_enable;
753
754	retval = snd_card_new(&pdev->dev, SNDRV_DEFAULT_IDX1,
755			      SNDRV_DEFAULT_STR1, THIS_MODULE,
756			      sizeof(struct atmel_ac97c), &card);
757	if (retval) {
758		dev_dbg(&pdev->dev, "could not create sound card device\n");
759		goto err_snd_card_new;
760	}
761
762	chip = get_chip(card);
763
764	retval = request_irq(irq, atmel_ac97c_interrupt, 0, "AC97C", chip);
765	if (retval) {
766		dev_dbg(&pdev->dev, "unable to request irq %d\n", irq);
767		goto err_request_irq;
768	}
769	chip->irq = irq;
770
771	spin_lock_init(&chip->lock);
772
773	strcpy(card->driver, "Atmel AC97C");
774	strcpy(card->shortname, "Atmel AC97C");
775	sprintf(card->longname, "Atmel AC97 controller");
776
777	chip->card = card;
778	chip->pclk = pclk;
779	chip->pdev = pdev;
780	chip->regs = ioremap(regs->start, resource_size(regs));
781
782	if (!chip->regs) {
783		dev_dbg(&pdev->dev, "could not remap register memory\n");
784		retval = -ENOMEM;
785		goto err_ioremap;
786	}
787
788	chip->reset_pin = devm_gpiod_get_index(dev, "ac97", 2, GPIOD_OUT_HIGH);
789	if (IS_ERR(chip->reset_pin))
790		dev_dbg(dev, "reset pin not available\n");
791
792	atmel_ac97c_reset(chip);
793
794	/* Enable overrun interrupt from codec channel */
795	ac97c_writel(chip, COMR, AC97C_CSR_OVRUN);
796	ac97c_writel(chip, IER, ac97c_readl(chip, IMR) | AC97C_SR_COEVT);
797
798	retval = snd_ac97_bus(card, 0, &ops, chip, &chip->ac97_bus);
799	if (retval) {
800		dev_dbg(&pdev->dev, "could not register on ac97 bus\n");
801		goto err_ac97_bus;
802	}
803
804	retval = atmel_ac97c_mixer_new(chip);
805	if (retval) {
806		dev_dbg(&pdev->dev, "could not register ac97 mixer\n");
807		goto err_ac97_bus;
808	}
809
810	retval = atmel_ac97c_pcm_new(chip);
811	if (retval) {
812		dev_dbg(&pdev->dev, "could not register ac97 pcm device\n");
813		goto err_ac97_bus;
814	}
815
816	retval = snd_card_register(card);
817	if (retval) {
818		dev_dbg(&pdev->dev, "could not register sound card\n");
819		goto err_ac97_bus;
820	}
821
822	platform_set_drvdata(pdev, card);
823
824	dev_info(&pdev->dev, "Atmel AC97 controller at 0x%p, irq = %d\n",
825			chip->regs, irq);
826
827	return 0;
828
829err_ac97_bus:
830	iounmap(chip->regs);
831err_ioremap:
832	free_irq(irq, chip);
833err_request_irq:
834	snd_card_free(card);
835err_snd_card_new:
836	clk_disable_unprepare(pclk);
837err_prepare_enable:
838	clk_put(pclk);
839	return retval;
840}
841
842#ifdef CONFIG_PM_SLEEP
843static int atmel_ac97c_suspend(struct device *pdev)
844{
845	struct snd_card *card = dev_get_drvdata(pdev);
846	struct atmel_ac97c *chip = card->private_data;
847
848	clk_disable_unprepare(chip->pclk);
849	return 0;
850}
851
852static int atmel_ac97c_resume(struct device *pdev)
853{
854	struct snd_card *card = dev_get_drvdata(pdev);
855	struct atmel_ac97c *chip = card->private_data;
856	int ret = clk_prepare_enable(chip->pclk);
857
858	return ret;
859}
860
861static SIMPLE_DEV_PM_OPS(atmel_ac97c_pm, atmel_ac97c_suspend, atmel_ac97c_resume);
862#define ATMEL_AC97C_PM_OPS	&atmel_ac97c_pm
863#else
864#define ATMEL_AC97C_PM_OPS	NULL
865#endif
866
867static int atmel_ac97c_remove(struct platform_device *pdev)
868{
869	struct snd_card *card = platform_get_drvdata(pdev);
870	struct atmel_ac97c *chip = get_chip(card);
871
872	ac97c_writel(chip, CAMR, 0);
873	ac97c_writel(chip, COMR, 0);
874	ac97c_writel(chip, MR,   0);
875
876	clk_disable_unprepare(chip->pclk);
877	clk_put(chip->pclk);
878	iounmap(chip->regs);
879	free_irq(chip->irq, chip);
880
881	snd_card_free(card);
882
883	return 0;
884}
885
886static struct platform_driver atmel_ac97c_driver = {
887	.probe		= atmel_ac97c_probe,
888	.remove		= atmel_ac97c_remove,
889	.driver		= {
890		.name	= "atmel_ac97c",
891		.pm	= ATMEL_AC97C_PM_OPS,
892		.of_match_table = atmel_ac97c_dt_ids,
893	},
894};
895module_platform_driver(atmel_ac97c_driver);
896
897MODULE_LICENSE("GPL");
898MODULE_DESCRIPTION("Driver for Atmel AC97 controller");
899MODULE_AUTHOR("Hans-Christian Egtvedt <egtvedt@samfundet.no>");