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