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 */ 33 static DEFINE_MUTEX(opened_mutex); 34 35 struct 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 64 static 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 86 static 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 105 static 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 124 static 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 141 static 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 158 static 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 172 static 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 186 static 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: /* fall through */ 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 268 static 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: /* fall through */ 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 350 static int 351 atmel_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: /* fall through */ 360 case SNDRV_PCM_TRIGGER_RESUME: /* fall through */ 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: /* fall through */ 366 case SNDRV_PCM_TRIGGER_SUSPEND: /* fall through */ 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 381 static int 382 atmel_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: /* fall through */ 392 case SNDRV_PCM_TRIGGER_RESUME: /* fall through */ 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: /* fall through */ 398 case SNDRV_PCM_TRIGGER_SUSPEND: /* fall through */ 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 413 static snd_pcm_uframes_t 414 atmel_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 430 static snd_pcm_uframes_t 431 atmel_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 447 static const struct snd_pcm_ops atmel_ac97_playback_ops = { 448 .open = atmel_ac97c_playback_open, 449 .close = atmel_ac97c_playback_close, 450 .ioctl = snd_pcm_lib_ioctl, 451 .hw_params = atmel_ac97c_playback_hw_params, 452 .prepare = atmel_ac97c_playback_prepare, 453 .trigger = atmel_ac97c_playback_trigger, 454 .pointer = atmel_ac97c_playback_pointer, 455 }; 456 457 static const struct snd_pcm_ops atmel_ac97_capture_ops = { 458 .open = atmel_ac97c_capture_open, 459 .close = atmel_ac97c_capture_close, 460 .ioctl = snd_pcm_lib_ioctl, 461 .hw_params = atmel_ac97c_capture_hw_params, 462 .prepare = atmel_ac97c_capture_prepare, 463 .trigger = atmel_ac97c_capture_trigger, 464 .pointer = atmel_ac97c_capture_pointer, 465 }; 466 467 static irqreturn_t atmel_ac97c_interrupt(int irq, void *dev) 468 { 469 struct atmel_ac97c *chip = (struct atmel_ac97c *)dev; 470 irqreturn_t retval = IRQ_NONE; 471 u32 sr = ac97c_readl(chip, SR); 472 u32 casr = ac97c_readl(chip, CASR); 473 u32 cosr = ac97c_readl(chip, COSR); 474 u32 camr = ac97c_readl(chip, CAMR); 475 476 if (sr & AC97C_SR_CAEVT) { 477 struct snd_pcm_runtime *runtime; 478 int offset, next_period, block_size; 479 dev_dbg(&chip->pdev->dev, "channel A event%s%s%s%s%s%s\n", 480 casr & AC97C_CSR_OVRUN ? " OVRUN" : "", 481 casr & AC97C_CSR_RXRDY ? " RXRDY" : "", 482 casr & AC97C_CSR_UNRUN ? " UNRUN" : "", 483 casr & AC97C_CSR_TXEMPTY ? " TXEMPTY" : "", 484 casr & AC97C_CSR_TXRDY ? " TXRDY" : "", 485 !casr ? " NONE" : ""); 486 if ((casr & camr) & AC97C_CSR_ENDTX) { 487 runtime = chip->playback_substream->runtime; 488 block_size = frames_to_bytes(runtime, runtime->period_size); 489 chip->playback_period++; 490 491 if (chip->playback_period == runtime->periods) 492 chip->playback_period = 0; 493 next_period = chip->playback_period + 1; 494 if (next_period == runtime->periods) 495 next_period = 0; 496 497 offset = block_size * next_period; 498 499 writel(runtime->dma_addr + offset, chip->regs + ATMEL_PDC_TNPR); 500 writel(block_size / 2, chip->regs + ATMEL_PDC_TNCR); 501 502 snd_pcm_period_elapsed(chip->playback_substream); 503 } 504 if ((casr & camr) & AC97C_CSR_ENDRX) { 505 runtime = chip->capture_substream->runtime; 506 block_size = frames_to_bytes(runtime, runtime->period_size); 507 chip->capture_period++; 508 509 if (chip->capture_period == runtime->periods) 510 chip->capture_period = 0; 511 next_period = chip->capture_period + 1; 512 if (next_period == runtime->periods) 513 next_period = 0; 514 515 offset = block_size * next_period; 516 517 writel(runtime->dma_addr + offset, chip->regs + ATMEL_PDC_RNPR); 518 writel(block_size / 2, chip->regs + ATMEL_PDC_RNCR); 519 snd_pcm_period_elapsed(chip->capture_substream); 520 } 521 retval = IRQ_HANDLED; 522 } 523 524 if (sr & AC97C_SR_COEVT) { 525 dev_info(&chip->pdev->dev, "codec channel event%s%s%s%s%s\n", 526 cosr & AC97C_CSR_OVRUN ? " OVRUN" : "", 527 cosr & AC97C_CSR_RXRDY ? " RXRDY" : "", 528 cosr & AC97C_CSR_TXEMPTY ? " TXEMPTY" : "", 529 cosr & AC97C_CSR_TXRDY ? " TXRDY" : "", 530 !cosr ? " NONE" : ""); 531 retval = IRQ_HANDLED; 532 } 533 534 if (retval == IRQ_NONE) { 535 dev_err(&chip->pdev->dev, "spurious interrupt sr 0x%08x " 536 "casr 0x%08x cosr 0x%08x\n", sr, casr, cosr); 537 } 538 539 return retval; 540 } 541 542 static const struct ac97_pcm at91_ac97_pcm_defs[] = { 543 /* Playback */ 544 { 545 .exclusive = 1, 546 .r = { { 547 .slots = ((1 << AC97_SLOT_PCM_LEFT) 548 | (1 << AC97_SLOT_PCM_RIGHT)), 549 } }, 550 }, 551 /* PCM in */ 552 { 553 .stream = 1, 554 .exclusive = 1, 555 .r = { { 556 .slots = ((1 << AC97_SLOT_PCM_LEFT) 557 | (1 << AC97_SLOT_PCM_RIGHT)), 558 } } 559 }, 560 /* Mic in */ 561 { 562 .stream = 1, 563 .exclusive = 1, 564 .r = { { 565 .slots = (1<<AC97_SLOT_MIC), 566 } } 567 }, 568 }; 569 570 static int atmel_ac97c_pcm_new(struct atmel_ac97c *chip) 571 { 572 struct snd_pcm *pcm; 573 struct snd_pcm_hardware hw = atmel_ac97c_hw; 574 int retval; 575 576 retval = snd_ac97_pcm_assign(chip->ac97_bus, 577 ARRAY_SIZE(at91_ac97_pcm_defs), 578 at91_ac97_pcm_defs); 579 if (retval) 580 return retval; 581 582 retval = snd_pcm_new(chip->card, chip->card->shortname, 0, 1, 1, &pcm); 583 if (retval) 584 return retval; 585 586 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &atmel_ac97_capture_ops); 587 snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &atmel_ac97_playback_ops); 588 589 snd_pcm_set_managed_buffer_all(pcm, SNDRV_DMA_TYPE_DEV, 590 &chip->pdev->dev, hw.periods_min * hw.period_bytes_min, 591 hw.buffer_bytes_max); 592 593 pcm->private_data = chip; 594 pcm->info_flags = 0; 595 strcpy(pcm->name, chip->card->shortname); 596 chip->pcm = pcm; 597 598 return 0; 599 } 600 601 static int atmel_ac97c_mixer_new(struct atmel_ac97c *chip) 602 { 603 struct snd_ac97_template template; 604 memset(&template, 0, sizeof(template)); 605 template.private_data = chip; 606 return snd_ac97_mixer(chip->ac97_bus, &template, &chip->ac97); 607 } 608 609 static void atmel_ac97c_write(struct snd_ac97 *ac97, unsigned short reg, 610 unsigned short val) 611 { 612 struct atmel_ac97c *chip = get_chip(ac97); 613 unsigned long word; 614 int timeout = 40; 615 616 word = (reg & 0x7f) << 16 | val; 617 618 do { 619 if (ac97c_readl(chip, COSR) & AC97C_CSR_TXRDY) { 620 ac97c_writel(chip, COTHR, word); 621 return; 622 } 623 udelay(1); 624 } while (--timeout); 625 626 dev_dbg(&chip->pdev->dev, "codec write timeout\n"); 627 } 628 629 static unsigned short atmel_ac97c_read(struct snd_ac97 *ac97, 630 unsigned short reg) 631 { 632 struct atmel_ac97c *chip = get_chip(ac97); 633 unsigned long word; 634 int timeout = 40; 635 int write = 10; 636 637 word = (0x80 | (reg & 0x7f)) << 16; 638 639 if ((ac97c_readl(chip, COSR) & AC97C_CSR_RXRDY) != 0) 640 ac97c_readl(chip, CORHR); 641 642 retry_write: 643 timeout = 40; 644 645 do { 646 if ((ac97c_readl(chip, COSR) & AC97C_CSR_TXRDY) != 0) { 647 ac97c_writel(chip, COTHR, word); 648 goto read_reg; 649 } 650 udelay(10); 651 } while (--timeout); 652 653 if (!--write) 654 goto timed_out; 655 goto retry_write; 656 657 read_reg: 658 do { 659 if ((ac97c_readl(chip, COSR) & AC97C_CSR_RXRDY) != 0) { 660 unsigned short val = ac97c_readl(chip, CORHR); 661 return val; 662 } 663 udelay(10); 664 } while (--timeout); 665 666 if (!--write) 667 goto timed_out; 668 goto retry_write; 669 670 timed_out: 671 dev_dbg(&chip->pdev->dev, "codec read timeout\n"); 672 return 0xffff; 673 } 674 675 static void atmel_ac97c_reset(struct atmel_ac97c *chip) 676 { 677 ac97c_writel(chip, MR, 0); 678 ac97c_writel(chip, MR, AC97C_MR_ENA); 679 ac97c_writel(chip, CAMR, 0); 680 ac97c_writel(chip, COMR, 0); 681 682 if (!IS_ERR(chip->reset_pin)) { 683 gpiod_set_value(chip->reset_pin, 0); 684 /* AC97 v2.2 specifications says minimum 1 us. */ 685 udelay(2); 686 gpiod_set_value(chip->reset_pin, 1); 687 } else { 688 ac97c_writel(chip, MR, AC97C_MR_WRST | AC97C_MR_ENA); 689 udelay(2); 690 ac97c_writel(chip, MR, AC97C_MR_ENA); 691 } 692 } 693 694 static const struct of_device_id atmel_ac97c_dt_ids[] = { 695 { .compatible = "atmel,at91sam9263-ac97c", }, 696 { } 697 }; 698 MODULE_DEVICE_TABLE(of, atmel_ac97c_dt_ids); 699 700 static int atmel_ac97c_probe(struct platform_device *pdev) 701 { 702 struct device *dev = &pdev->dev; 703 struct snd_card *card; 704 struct atmel_ac97c *chip; 705 struct resource *regs; 706 struct clk *pclk; 707 static struct snd_ac97_bus_ops ops = { 708 .write = atmel_ac97c_write, 709 .read = atmel_ac97c_read, 710 }; 711 int retval; 712 int irq; 713 714 regs = platform_get_resource(pdev, IORESOURCE_MEM, 0); 715 if (!regs) { 716 dev_dbg(&pdev->dev, "no memory resource\n"); 717 return -ENXIO; 718 } 719 720 irq = platform_get_irq(pdev, 0); 721 if (irq < 0) { 722 dev_dbg(&pdev->dev, "could not get irq: %d\n", irq); 723 return irq; 724 } 725 726 pclk = clk_get(&pdev->dev, "ac97_clk"); 727 if (IS_ERR(pclk)) { 728 dev_dbg(&pdev->dev, "no peripheral clock\n"); 729 return PTR_ERR(pclk); 730 } 731 retval = clk_prepare_enable(pclk); 732 if (retval) 733 goto err_prepare_enable; 734 735 retval = snd_card_new(&pdev->dev, SNDRV_DEFAULT_IDX1, 736 SNDRV_DEFAULT_STR1, THIS_MODULE, 737 sizeof(struct atmel_ac97c), &card); 738 if (retval) { 739 dev_dbg(&pdev->dev, "could not create sound card device\n"); 740 goto err_snd_card_new; 741 } 742 743 chip = get_chip(card); 744 745 retval = request_irq(irq, atmel_ac97c_interrupt, 0, "AC97C", chip); 746 if (retval) { 747 dev_dbg(&pdev->dev, "unable to request irq %d\n", irq); 748 goto err_request_irq; 749 } 750 chip->irq = irq; 751 752 spin_lock_init(&chip->lock); 753 754 strcpy(card->driver, "Atmel AC97C"); 755 strcpy(card->shortname, "Atmel AC97C"); 756 sprintf(card->longname, "Atmel AC97 controller"); 757 758 chip->card = card; 759 chip->pclk = pclk; 760 chip->pdev = pdev; 761 chip->regs = ioremap(regs->start, resource_size(regs)); 762 763 if (!chip->regs) { 764 dev_dbg(&pdev->dev, "could not remap register memory\n"); 765 retval = -ENOMEM; 766 goto err_ioremap; 767 } 768 769 chip->reset_pin = devm_gpiod_get_index(dev, "ac97", 2, GPIOD_OUT_HIGH); 770 if (IS_ERR(chip->reset_pin)) 771 dev_dbg(dev, "reset pin not available\n"); 772 773 atmel_ac97c_reset(chip); 774 775 /* Enable overrun interrupt from codec channel */ 776 ac97c_writel(chip, COMR, AC97C_CSR_OVRUN); 777 ac97c_writel(chip, IER, ac97c_readl(chip, IMR) | AC97C_SR_COEVT); 778 779 retval = snd_ac97_bus(card, 0, &ops, chip, &chip->ac97_bus); 780 if (retval) { 781 dev_dbg(&pdev->dev, "could not register on ac97 bus\n"); 782 goto err_ac97_bus; 783 } 784 785 retval = atmel_ac97c_mixer_new(chip); 786 if (retval) { 787 dev_dbg(&pdev->dev, "could not register ac97 mixer\n"); 788 goto err_ac97_bus; 789 } 790 791 retval = atmel_ac97c_pcm_new(chip); 792 if (retval) { 793 dev_dbg(&pdev->dev, "could not register ac97 pcm device\n"); 794 goto err_ac97_bus; 795 } 796 797 retval = snd_card_register(card); 798 if (retval) { 799 dev_dbg(&pdev->dev, "could not register sound card\n"); 800 goto err_ac97_bus; 801 } 802 803 platform_set_drvdata(pdev, card); 804 805 dev_info(&pdev->dev, "Atmel AC97 controller at 0x%p, irq = %d\n", 806 chip->regs, irq); 807 808 return 0; 809 810 err_ac97_bus: 811 iounmap(chip->regs); 812 err_ioremap: 813 free_irq(irq, chip); 814 err_request_irq: 815 snd_card_free(card); 816 err_snd_card_new: 817 clk_disable_unprepare(pclk); 818 err_prepare_enable: 819 clk_put(pclk); 820 return retval; 821 } 822 823 #ifdef CONFIG_PM_SLEEP 824 static int atmel_ac97c_suspend(struct device *pdev) 825 { 826 struct snd_card *card = dev_get_drvdata(pdev); 827 struct atmel_ac97c *chip = card->private_data; 828 829 clk_disable_unprepare(chip->pclk); 830 return 0; 831 } 832 833 static int atmel_ac97c_resume(struct device *pdev) 834 { 835 struct snd_card *card = dev_get_drvdata(pdev); 836 struct atmel_ac97c *chip = card->private_data; 837 int ret = clk_prepare_enable(chip->pclk); 838 839 return ret; 840 } 841 842 static SIMPLE_DEV_PM_OPS(atmel_ac97c_pm, atmel_ac97c_suspend, atmel_ac97c_resume); 843 #define ATMEL_AC97C_PM_OPS &atmel_ac97c_pm 844 #else 845 #define ATMEL_AC97C_PM_OPS NULL 846 #endif 847 848 static int atmel_ac97c_remove(struct platform_device *pdev) 849 { 850 struct snd_card *card = platform_get_drvdata(pdev); 851 struct atmel_ac97c *chip = get_chip(card); 852 853 ac97c_writel(chip, CAMR, 0); 854 ac97c_writel(chip, COMR, 0); 855 ac97c_writel(chip, MR, 0); 856 857 clk_disable_unprepare(chip->pclk); 858 clk_put(chip->pclk); 859 iounmap(chip->regs); 860 free_irq(chip->irq, chip); 861 862 snd_card_free(card); 863 864 return 0; 865 } 866 867 static struct platform_driver atmel_ac97c_driver = { 868 .probe = atmel_ac97c_probe, 869 .remove = atmel_ac97c_remove, 870 .driver = { 871 .name = "atmel_ac97c", 872 .pm = ATMEL_AC97C_PM_OPS, 873 .of_match_table = atmel_ac97c_dt_ids, 874 }, 875 }; 876 module_platform_driver(atmel_ac97c_driver); 877 878 MODULE_LICENSE("GPL"); 879 MODULE_DESCRIPTION("Driver for Atmel AC97 controller"); 880 MODULE_AUTHOR("Hans-Christian Egtvedt <egtvedt@samfundet.no>"); 881