1 /* 2 * siu_dai.c - ALSA SoC driver for Renesas SH7343, SH7722 SIU peripheral. 3 * 4 * Copyright (C) 2009-2010 Guennadi Liakhovetski <g.liakhovetski@gmx.de> 5 * Copyright (C) 2006 Carlos Munoz <carlos@kenati.com> 6 * 7 * This program is free software; you can redistribute it and/or modify 8 * it under the terms of the GNU General Public License as published by 9 * the Free Software Foundation; either version 2 of the License, or 10 * (at your option) any later version. 11 * 12 * This program is distributed in the hope that it will be useful, 13 * but WITHOUT ANY WARRANTY; without even the implied warranty of 14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 15 * GNU General Public License for more details. 16 * 17 * You should have received a copy of the GNU General Public License 18 * along with this program; if not, write to the Free Software 19 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 20 */ 21 22 #include <linux/delay.h> 23 #include <linux/firmware.h> 24 #include <linux/pm_runtime.h> 25 #include <linux/slab.h> 26 #include <linux/module.h> 27 28 #include <asm/clock.h> 29 #include <asm/siu.h> 30 31 #include <sound/control.h> 32 #include <sound/soc.h> 33 34 #include "siu.h" 35 36 /* Board specifics */ 37 #if defined(CONFIG_CPU_SUBTYPE_SH7722) 38 # define SIU_MAX_VOLUME 0x1000 39 #else 40 # define SIU_MAX_VOLUME 0x7fff 41 #endif 42 43 #define PRAM_SIZE 0x2000 44 #define XRAM_SIZE 0x800 45 #define YRAM_SIZE 0x800 46 47 #define XRAM_OFFSET 0x4000 48 #define YRAM_OFFSET 0x6000 49 #define REG_OFFSET 0xc000 50 51 #define PLAYBACK_ENABLED 1 52 #define CAPTURE_ENABLED 2 53 54 #define VOLUME_CAPTURE 0 55 #define VOLUME_PLAYBACK 1 56 #define DFLT_VOLUME_LEVEL 0x08000800 57 58 /* 59 * SPDIF is only available on port A and on some SIU implementations it is only 60 * available for input. Due to the lack of hardware to test it, SPDIF is left 61 * disabled in this driver version 62 */ 63 struct format_flag { 64 u32 i2s; 65 u32 pcm; 66 u32 spdif; 67 u32 mask; 68 }; 69 70 struct port_flag { 71 struct format_flag playback; 72 struct format_flag capture; 73 }; 74 75 struct siu_info *siu_i2s_data; 76 77 static struct port_flag siu_flags[SIU_PORT_NUM] = { 78 [SIU_PORT_A] = { 79 .playback = { 80 .i2s = 0x50000000, 81 .pcm = 0x40000000, 82 .spdif = 0x80000000, /* not on all SIU versions */ 83 .mask = 0xd0000000, 84 }, 85 .capture = { 86 .i2s = 0x05000000, 87 .pcm = 0x04000000, 88 .spdif = 0x08000000, 89 .mask = 0x0d000000, 90 }, 91 }, 92 [SIU_PORT_B] = { 93 .playback = { 94 .i2s = 0x00500000, 95 .pcm = 0x00400000, 96 .spdif = 0, /* impossible - turn off */ 97 .mask = 0x00500000, 98 }, 99 .capture = { 100 .i2s = 0x00050000, 101 .pcm = 0x00040000, 102 .spdif = 0, /* impossible - turn off */ 103 .mask = 0x00050000, 104 }, 105 }, 106 }; 107 108 static void siu_dai_start(struct siu_port *port_info) 109 { 110 struct siu_info *info = siu_i2s_data; 111 u32 __iomem *base = info->reg; 112 113 dev_dbg(port_info->pcm->card->dev, "%s\n", __func__); 114 115 /* Turn on SIU clock */ 116 pm_runtime_get_sync(info->dev); 117 118 /* Issue software reset to siu */ 119 siu_write32(base + SIU_SRCTL, 0); 120 121 /* Wait for the reset to take effect */ 122 udelay(1); 123 124 port_info->stfifo = 0; 125 port_info->trdat = 0; 126 127 /* portA, portB, SIU operate */ 128 siu_write32(base + SIU_SRCTL, 0x301); 129 130 /* portA=256fs, portB=256fs */ 131 siu_write32(base + SIU_CKCTL, 0x40400000); 132 133 /* portA's BRG does not divide SIUCKA */ 134 siu_write32(base + SIU_BRGASEL, 0); 135 siu_write32(base + SIU_BRRA, 0); 136 137 /* portB's BRG divides SIUCKB by half */ 138 siu_write32(base + SIU_BRGBSEL, 1); 139 siu_write32(base + SIU_BRRB, 0); 140 141 siu_write32(base + SIU_IFCTL, 0x44440000); 142 143 /* portA: 32 bit/fs, master; portB: 32 bit/fs, master */ 144 siu_write32(base + SIU_SFORM, 0x0c0c0000); 145 146 /* 147 * Volume levels: looks like the DSP firmware implements volume controls 148 * differently from what's described in the datasheet 149 */ 150 siu_write32(base + SIU_SBDVCA, port_info->playback.volume); 151 siu_write32(base + SIU_SBDVCB, port_info->capture.volume); 152 } 153 154 static void siu_dai_stop(struct siu_port *port_info) 155 { 156 struct siu_info *info = siu_i2s_data; 157 u32 __iomem *base = info->reg; 158 159 /* SIU software reset */ 160 siu_write32(base + SIU_SRCTL, 0); 161 162 /* Turn off SIU clock */ 163 pm_runtime_put_sync(info->dev); 164 } 165 166 static void siu_dai_spbAselect(struct siu_port *port_info) 167 { 168 struct siu_info *info = siu_i2s_data; 169 struct siu_firmware *fw = &info->fw; 170 u32 *ydef = fw->yram0; 171 u32 idx; 172 173 /* path A use */ 174 if (!info->port_id) 175 idx = 1; /* portA */ 176 else 177 idx = 2; /* portB */ 178 179 ydef[0] = (fw->spbpar[idx].ab1a << 16) | 180 (fw->spbpar[idx].ab0a << 8) | 181 (fw->spbpar[idx].dir << 7) | 3; 182 ydef[1] = fw->yram0[1]; /* 0x03000300 */ 183 ydef[2] = (16 / 2) << 24; 184 ydef[3] = fw->yram0[3]; /* 0 */ 185 ydef[4] = fw->yram0[4]; /* 0 */ 186 ydef[7] = fw->spbpar[idx].event; 187 port_info->stfifo |= fw->spbpar[idx].stfifo; 188 port_info->trdat |= fw->spbpar[idx].trdat; 189 } 190 191 static void siu_dai_spbBselect(struct siu_port *port_info) 192 { 193 struct siu_info *info = siu_i2s_data; 194 struct siu_firmware *fw = &info->fw; 195 u32 *ydef = fw->yram0; 196 u32 idx; 197 198 /* path B use */ 199 if (!info->port_id) 200 idx = 7; /* portA */ 201 else 202 idx = 8; /* portB */ 203 204 ydef[5] = (fw->spbpar[idx].ab1a << 16) | 205 (fw->spbpar[idx].ab0a << 8) | 1; 206 ydef[6] = fw->spbpar[idx].event; 207 port_info->stfifo |= fw->spbpar[idx].stfifo; 208 port_info->trdat |= fw->spbpar[idx].trdat; 209 } 210 211 static void siu_dai_open(struct siu_stream *siu_stream) 212 { 213 struct siu_info *info = siu_i2s_data; 214 u32 __iomem *base = info->reg; 215 u32 srctl, ifctl; 216 217 srctl = siu_read32(base + SIU_SRCTL); 218 ifctl = siu_read32(base + SIU_IFCTL); 219 220 switch (info->port_id) { 221 case SIU_PORT_A: 222 /* portA operates */ 223 srctl |= 0x200; 224 ifctl &= ~0xc2; 225 break; 226 case SIU_PORT_B: 227 /* portB operates */ 228 srctl |= 0x100; 229 ifctl &= ~0x31; 230 break; 231 } 232 233 siu_write32(base + SIU_SRCTL, srctl); 234 /* Unmute and configure portA */ 235 siu_write32(base + SIU_IFCTL, ifctl); 236 } 237 238 /* 239 * At the moment only fixed Left-upper, Left-lower, Right-upper, Right-lower 240 * packing is supported 241 */ 242 static void siu_dai_pcmdatapack(struct siu_stream *siu_stream) 243 { 244 struct siu_info *info = siu_i2s_data; 245 u32 __iomem *base = info->reg; 246 u32 dpak; 247 248 dpak = siu_read32(base + SIU_DPAK); 249 250 switch (info->port_id) { 251 case SIU_PORT_A: 252 dpak &= ~0xc0000000; 253 break; 254 case SIU_PORT_B: 255 dpak &= ~0x00c00000; 256 break; 257 } 258 259 siu_write32(base + SIU_DPAK, dpak); 260 } 261 262 static int siu_dai_spbstart(struct siu_port *port_info) 263 { 264 struct siu_info *info = siu_i2s_data; 265 u32 __iomem *base = info->reg; 266 struct siu_firmware *fw = &info->fw; 267 u32 *ydef = fw->yram0; 268 int cnt; 269 u32 __iomem *add; 270 u32 *ptr; 271 272 /* Load SPB Program in PRAM */ 273 ptr = fw->pram0; 274 add = info->pram; 275 for (cnt = 0; cnt < PRAM0_SIZE; cnt++, add++, ptr++) 276 siu_write32(add, *ptr); 277 278 ptr = fw->pram1; 279 add = info->pram + (0x0100 / sizeof(u32)); 280 for (cnt = 0; cnt < PRAM1_SIZE; cnt++, add++, ptr++) 281 siu_write32(add, *ptr); 282 283 /* XRAM initialization */ 284 add = info->xram; 285 for (cnt = 0; cnt < XRAM0_SIZE + XRAM1_SIZE + XRAM2_SIZE; cnt++, add++) 286 siu_write32(add, 0); 287 288 /* YRAM variable area initialization */ 289 add = info->yram; 290 for (cnt = 0; cnt < YRAM_DEF_SIZE; cnt++, add++) 291 siu_write32(add, ydef[cnt]); 292 293 /* YRAM FIR coefficient area initialization */ 294 add = info->yram + (0x0200 / sizeof(u32)); 295 for (cnt = 0; cnt < YRAM_FIR_SIZE; cnt++, add++) 296 siu_write32(add, fw->yram_fir_coeff[cnt]); 297 298 /* YRAM IIR coefficient area initialization */ 299 add = info->yram + (0x0600 / sizeof(u32)); 300 for (cnt = 0; cnt < YRAM_IIR_SIZE; cnt++, add++) 301 siu_write32(add, 0); 302 303 siu_write32(base + SIU_TRDAT, port_info->trdat); 304 port_info->trdat = 0x0; 305 306 307 /* SPB start condition: software */ 308 siu_write32(base + SIU_SBACTIV, 0); 309 /* Start SPB */ 310 siu_write32(base + SIU_SBCTL, 0xc0000000); 311 /* Wait for program to halt */ 312 cnt = 0x10000; 313 while (--cnt && siu_read32(base + SIU_SBCTL) != 0x80000000) 314 cpu_relax(); 315 316 if (!cnt) 317 return -EBUSY; 318 319 /* SPB program start address setting */ 320 siu_write32(base + SIU_SBPSET, 0x00400000); 321 /* SPB hardware start(FIFOCTL source) */ 322 siu_write32(base + SIU_SBACTIV, 0xc0000000); 323 324 return 0; 325 } 326 327 static void siu_dai_spbstop(struct siu_port *port_info) 328 { 329 struct siu_info *info = siu_i2s_data; 330 u32 __iomem *base = info->reg; 331 332 siu_write32(base + SIU_SBACTIV, 0); 333 /* SPB stop */ 334 siu_write32(base + SIU_SBCTL, 0); 335 336 port_info->stfifo = 0; 337 } 338 339 /* API functions */ 340 341 /* Playback and capture hardware properties are identical */ 342 static struct snd_pcm_hardware siu_dai_pcm_hw = { 343 .info = SNDRV_PCM_INFO_INTERLEAVED, 344 .formats = SNDRV_PCM_FMTBIT_S16, 345 .rates = SNDRV_PCM_RATE_8000_48000, 346 .rate_min = 8000, 347 .rate_max = 48000, 348 .channels_min = 2, 349 .channels_max = 2, 350 .buffer_bytes_max = SIU_BUFFER_BYTES_MAX, 351 .period_bytes_min = SIU_PERIOD_BYTES_MIN, 352 .period_bytes_max = SIU_PERIOD_BYTES_MAX, 353 .periods_min = SIU_PERIODS_MIN, 354 .periods_max = SIU_PERIODS_MAX, 355 }; 356 357 static int siu_dai_info_volume(struct snd_kcontrol *kctrl, 358 struct snd_ctl_elem_info *uinfo) 359 { 360 struct siu_port *port_info = snd_kcontrol_chip(kctrl); 361 362 dev_dbg(port_info->pcm->card->dev, "%s\n", __func__); 363 364 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; 365 uinfo->count = 2; 366 uinfo->value.integer.min = 0; 367 uinfo->value.integer.max = SIU_MAX_VOLUME; 368 369 return 0; 370 } 371 372 static int siu_dai_get_volume(struct snd_kcontrol *kctrl, 373 struct snd_ctl_elem_value *ucontrol) 374 { 375 struct siu_port *port_info = snd_kcontrol_chip(kctrl); 376 struct device *dev = port_info->pcm->card->dev; 377 u32 vol; 378 379 dev_dbg(dev, "%s\n", __func__); 380 381 switch (kctrl->private_value) { 382 case VOLUME_PLAYBACK: 383 /* Playback is always on port 0 */ 384 vol = port_info->playback.volume; 385 ucontrol->value.integer.value[0] = vol & 0xffff; 386 ucontrol->value.integer.value[1] = vol >> 16 & 0xffff; 387 break; 388 case VOLUME_CAPTURE: 389 /* Capture is always on port 1 */ 390 vol = port_info->capture.volume; 391 ucontrol->value.integer.value[0] = vol & 0xffff; 392 ucontrol->value.integer.value[1] = vol >> 16 & 0xffff; 393 break; 394 default: 395 dev_err(dev, "%s() invalid private_value=%ld\n", 396 __func__, kctrl->private_value); 397 return -EINVAL; 398 } 399 400 return 0; 401 } 402 403 static int siu_dai_put_volume(struct snd_kcontrol *kctrl, 404 struct snd_ctl_elem_value *ucontrol) 405 { 406 struct siu_port *port_info = snd_kcontrol_chip(kctrl); 407 struct device *dev = port_info->pcm->card->dev; 408 struct siu_info *info = siu_i2s_data; 409 u32 __iomem *base = info->reg; 410 u32 new_vol; 411 u32 cur_vol; 412 413 dev_dbg(dev, "%s\n", __func__); 414 415 if (ucontrol->value.integer.value[0] < 0 || 416 ucontrol->value.integer.value[0] > SIU_MAX_VOLUME || 417 ucontrol->value.integer.value[1] < 0 || 418 ucontrol->value.integer.value[1] > SIU_MAX_VOLUME) 419 return -EINVAL; 420 421 new_vol = ucontrol->value.integer.value[0] | 422 ucontrol->value.integer.value[1] << 16; 423 424 /* See comment above - DSP firmware implementation */ 425 switch (kctrl->private_value) { 426 case VOLUME_PLAYBACK: 427 /* Playback is always on port 0 */ 428 cur_vol = port_info->playback.volume; 429 siu_write32(base + SIU_SBDVCA, new_vol); 430 port_info->playback.volume = new_vol; 431 break; 432 case VOLUME_CAPTURE: 433 /* Capture is always on port 1 */ 434 cur_vol = port_info->capture.volume; 435 siu_write32(base + SIU_SBDVCB, new_vol); 436 port_info->capture.volume = new_vol; 437 break; 438 default: 439 dev_err(dev, "%s() invalid private_value=%ld\n", 440 __func__, kctrl->private_value); 441 return -EINVAL; 442 } 443 444 if (cur_vol != new_vol) 445 return 1; 446 447 return 0; 448 } 449 450 static struct snd_kcontrol_new playback_controls = { 451 .iface = SNDRV_CTL_ELEM_IFACE_MIXER, 452 .name = "PCM Playback Volume", 453 .index = 0, 454 .info = siu_dai_info_volume, 455 .get = siu_dai_get_volume, 456 .put = siu_dai_put_volume, 457 .private_value = VOLUME_PLAYBACK, 458 }; 459 460 static struct snd_kcontrol_new capture_controls = { 461 .iface = SNDRV_CTL_ELEM_IFACE_MIXER, 462 .name = "PCM Capture Volume", 463 .index = 0, 464 .info = siu_dai_info_volume, 465 .get = siu_dai_get_volume, 466 .put = siu_dai_put_volume, 467 .private_value = VOLUME_CAPTURE, 468 }; 469 470 int siu_init_port(int port, struct siu_port **port_info, struct snd_card *card) 471 { 472 struct device *dev = card->dev; 473 struct snd_kcontrol *kctrl; 474 int ret; 475 476 *port_info = kzalloc(sizeof(**port_info), GFP_KERNEL); 477 if (!*port_info) 478 return -ENOMEM; 479 480 dev_dbg(dev, "%s: port #%d@%p\n", __func__, port, *port_info); 481 482 (*port_info)->playback.volume = DFLT_VOLUME_LEVEL; 483 (*port_info)->capture.volume = DFLT_VOLUME_LEVEL; 484 485 /* 486 * Add mixer support. The SPB is used to change the volume. Both 487 * ports use the same SPB. Therefore, we only register one 488 * control instance since it will be used by both channels. 489 * In error case we continue without controls. 490 */ 491 kctrl = snd_ctl_new1(&playback_controls, *port_info); 492 ret = snd_ctl_add(card, kctrl); 493 if (ret < 0) 494 dev_err(dev, 495 "failed to add playback controls %p port=%d err=%d\n", 496 kctrl, port, ret); 497 498 kctrl = snd_ctl_new1(&capture_controls, *port_info); 499 ret = snd_ctl_add(card, kctrl); 500 if (ret < 0) 501 dev_err(dev, 502 "failed to add capture controls %p port=%d err=%d\n", 503 kctrl, port, ret); 504 505 return 0; 506 } 507 508 void siu_free_port(struct siu_port *port_info) 509 { 510 kfree(port_info); 511 } 512 513 static int siu_dai_startup(struct snd_pcm_substream *substream, 514 struct snd_soc_dai *dai) 515 { 516 struct siu_info *info = snd_soc_dai_get_drvdata(dai); 517 struct snd_pcm_runtime *rt = substream->runtime; 518 struct siu_port *port_info = siu_port_info(substream); 519 int ret; 520 521 dev_dbg(substream->pcm->card->dev, "%s: port=%d@%p\n", __func__, 522 info->port_id, port_info); 523 524 snd_soc_set_runtime_hwparams(substream, &siu_dai_pcm_hw); 525 526 ret = snd_pcm_hw_constraint_integer(rt, SNDRV_PCM_HW_PARAM_PERIODS); 527 if (unlikely(ret < 0)) 528 return ret; 529 530 siu_dai_start(port_info); 531 532 return 0; 533 } 534 535 static void siu_dai_shutdown(struct snd_pcm_substream *substream, 536 struct snd_soc_dai *dai) 537 { 538 struct siu_info *info = snd_soc_dai_get_drvdata(dai); 539 struct siu_port *port_info = siu_port_info(substream); 540 541 dev_dbg(substream->pcm->card->dev, "%s: port=%d@%p\n", __func__, 542 info->port_id, port_info); 543 544 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 545 port_info->play_cap &= ~PLAYBACK_ENABLED; 546 else 547 port_info->play_cap &= ~CAPTURE_ENABLED; 548 549 /* Stop the siu if the other stream is not using it */ 550 if (!port_info->play_cap) { 551 /* during stmread or stmwrite ? */ 552 BUG_ON(port_info->playback.rw_flg || port_info->capture.rw_flg); 553 siu_dai_spbstop(port_info); 554 siu_dai_stop(port_info); 555 } 556 } 557 558 /* PCM part of siu_dai_playback_prepare() / siu_dai_capture_prepare() */ 559 static int siu_dai_prepare(struct snd_pcm_substream *substream, 560 struct snd_soc_dai *dai) 561 { 562 struct siu_info *info = snd_soc_dai_get_drvdata(dai); 563 struct snd_pcm_runtime *rt = substream->runtime; 564 struct siu_port *port_info = siu_port_info(substream); 565 struct siu_stream *siu_stream; 566 int self, ret; 567 568 dev_dbg(substream->pcm->card->dev, 569 "%s: port %d, active streams %lx, %d channels\n", 570 __func__, info->port_id, port_info->play_cap, rt->channels); 571 572 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 573 self = PLAYBACK_ENABLED; 574 siu_stream = &port_info->playback; 575 } else { 576 self = CAPTURE_ENABLED; 577 siu_stream = &port_info->capture; 578 } 579 580 /* Set up the siu if not already done */ 581 if (!port_info->play_cap) { 582 siu_stream->rw_flg = 0; /* stream-data transfer flag */ 583 584 siu_dai_spbAselect(port_info); 585 siu_dai_spbBselect(port_info); 586 587 siu_dai_open(siu_stream); 588 589 siu_dai_pcmdatapack(siu_stream); 590 591 ret = siu_dai_spbstart(port_info); 592 if (ret < 0) 593 goto fail; 594 } else { 595 ret = 0; 596 } 597 598 port_info->play_cap |= self; 599 600 fail: 601 return ret; 602 } 603 604 /* 605 * SIU can set bus format to I2S / PCM / SPDIF independently for playback and 606 * capture, however, the current API sets the bus format globally for a DAI. 607 */ 608 static int siu_dai_set_fmt(struct snd_soc_dai *dai, 609 unsigned int fmt) 610 { 611 struct siu_info *info = snd_soc_dai_get_drvdata(dai); 612 u32 __iomem *base = info->reg; 613 u32 ifctl; 614 615 dev_dbg(dai->dev, "%s: fmt 0x%x on port %d\n", 616 __func__, fmt, info->port_id); 617 618 if (info->port_id < 0) 619 return -ENODEV; 620 621 /* Here select between I2S / PCM / SPDIF */ 622 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { 623 case SND_SOC_DAIFMT_I2S: 624 ifctl = siu_flags[info->port_id].playback.i2s | 625 siu_flags[info->port_id].capture.i2s; 626 break; 627 case SND_SOC_DAIFMT_LEFT_J: 628 ifctl = siu_flags[info->port_id].playback.pcm | 629 siu_flags[info->port_id].capture.pcm; 630 break; 631 /* SPDIF disabled - see comment at the top */ 632 default: 633 return -EINVAL; 634 } 635 636 ifctl |= ~(siu_flags[info->port_id].playback.mask | 637 siu_flags[info->port_id].capture.mask) & 638 siu_read32(base + SIU_IFCTL); 639 siu_write32(base + SIU_IFCTL, ifctl); 640 641 return 0; 642 } 643 644 static int siu_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id, 645 unsigned int freq, int dir) 646 { 647 struct clk *siu_clk, *parent_clk; 648 char *siu_name, *parent_name; 649 int ret; 650 651 if (dir != SND_SOC_CLOCK_IN) 652 return -EINVAL; 653 654 dev_dbg(dai->dev, "%s: using clock %d\n", __func__, clk_id); 655 656 switch (clk_id) { 657 case SIU_CLKA_PLL: 658 siu_name = "siua_clk"; 659 parent_name = "pll_clk"; 660 break; 661 case SIU_CLKA_EXT: 662 siu_name = "siua_clk"; 663 parent_name = "siumcka_clk"; 664 break; 665 case SIU_CLKB_PLL: 666 siu_name = "siub_clk"; 667 parent_name = "pll_clk"; 668 break; 669 case SIU_CLKB_EXT: 670 siu_name = "siub_clk"; 671 parent_name = "siumckb_clk"; 672 break; 673 default: 674 return -EINVAL; 675 } 676 677 siu_clk = clk_get(dai->dev, siu_name); 678 if (IS_ERR(siu_clk)) { 679 dev_err(dai->dev, "%s: cannot get a SIU clock: %ld\n", __func__, 680 PTR_ERR(siu_clk)); 681 return PTR_ERR(siu_clk); 682 } 683 684 parent_clk = clk_get(dai->dev, parent_name); 685 if (IS_ERR(parent_clk)) { 686 ret = PTR_ERR(parent_clk); 687 dev_err(dai->dev, "cannot get a SIU clock parent: %d\n", ret); 688 goto epclkget; 689 } 690 691 ret = clk_set_parent(siu_clk, parent_clk); 692 if (ret < 0) { 693 dev_err(dai->dev, "cannot reparent the SIU clock: %d\n", ret); 694 goto eclksetp; 695 } 696 697 ret = clk_set_rate(siu_clk, freq); 698 if (ret < 0) 699 dev_err(dai->dev, "cannot set SIU clock rate: %d\n", ret); 700 701 /* TODO: when clkdev gets reference counting we'll move these to siu_dai_shutdown() */ 702 eclksetp: 703 clk_put(parent_clk); 704 epclkget: 705 clk_put(siu_clk); 706 707 return ret; 708 } 709 710 static struct snd_soc_dai_ops siu_dai_ops = { 711 .startup = siu_dai_startup, 712 .shutdown = siu_dai_shutdown, 713 .prepare = siu_dai_prepare, 714 .set_sysclk = siu_dai_set_sysclk, 715 .set_fmt = siu_dai_set_fmt, 716 }; 717 718 static struct snd_soc_dai_driver siu_i2s_dai = { 719 .name = "siu-i2s-dai", 720 .playback = { 721 .channels_min = 2, 722 .channels_max = 2, 723 .formats = SNDRV_PCM_FMTBIT_S16, 724 .rates = SNDRV_PCM_RATE_8000_48000, 725 }, 726 .capture = { 727 .channels_min = 2, 728 .channels_max = 2, 729 .formats = SNDRV_PCM_FMTBIT_S16, 730 .rates = SNDRV_PCM_RATE_8000_48000, 731 }, 732 .ops = &siu_dai_ops, 733 }; 734 735 static int __devinit siu_probe(struct platform_device *pdev) 736 { 737 const struct firmware *fw_entry; 738 struct resource *res, *region; 739 struct siu_info *info; 740 int ret; 741 742 info = kmalloc(sizeof(*info), GFP_KERNEL); 743 if (!info) 744 return -ENOMEM; 745 siu_i2s_data = info; 746 info->dev = &pdev->dev; 747 748 ret = request_firmware(&fw_entry, "siu_spb.bin", &pdev->dev); 749 if (ret) 750 goto ereqfw; 751 752 /* 753 * Loaded firmware is "const" - read only, but we have to modify it in 754 * snd_siu_sh7343_spbAselect() and snd_siu_sh7343_spbBselect() 755 */ 756 memcpy(&info->fw, fw_entry->data, fw_entry->size); 757 758 release_firmware(fw_entry); 759 760 res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 761 if (!res) { 762 ret = -ENODEV; 763 goto egetres; 764 } 765 766 region = request_mem_region(res->start, resource_size(res), 767 pdev->name); 768 if (!region) { 769 dev_err(&pdev->dev, "SIU region already claimed\n"); 770 ret = -EBUSY; 771 goto ereqmemreg; 772 } 773 774 ret = -ENOMEM; 775 info->pram = ioremap(res->start, PRAM_SIZE); 776 if (!info->pram) 777 goto emappram; 778 info->xram = ioremap(res->start + XRAM_OFFSET, XRAM_SIZE); 779 if (!info->xram) 780 goto emapxram; 781 info->yram = ioremap(res->start + YRAM_OFFSET, YRAM_SIZE); 782 if (!info->yram) 783 goto emapyram; 784 info->reg = ioremap(res->start + REG_OFFSET, resource_size(res) - 785 REG_OFFSET); 786 if (!info->reg) 787 goto emapreg; 788 789 dev_set_drvdata(&pdev->dev, info); 790 791 /* register using ARRAY version so we can keep dai name */ 792 ret = snd_soc_register_dais(&pdev->dev, &siu_i2s_dai, 1); 793 if (ret < 0) 794 goto edaiinit; 795 796 ret = snd_soc_register_platform(&pdev->dev, &siu_platform); 797 if (ret < 0) 798 goto esocregp; 799 800 pm_runtime_enable(&pdev->dev); 801 802 return ret; 803 804 esocregp: 805 snd_soc_unregister_dai(&pdev->dev); 806 edaiinit: 807 iounmap(info->reg); 808 emapreg: 809 iounmap(info->yram); 810 emapyram: 811 iounmap(info->xram); 812 emapxram: 813 iounmap(info->pram); 814 emappram: 815 release_mem_region(res->start, resource_size(res)); 816 ereqmemreg: 817 egetres: 818 ereqfw: 819 kfree(info); 820 821 return ret; 822 } 823 824 static int __devexit siu_remove(struct platform_device *pdev) 825 { 826 struct siu_info *info = dev_get_drvdata(&pdev->dev); 827 struct resource *res; 828 829 pm_runtime_disable(&pdev->dev); 830 831 snd_soc_unregister_platform(&pdev->dev); 832 snd_soc_unregister_dai(&pdev->dev); 833 834 iounmap(info->reg); 835 iounmap(info->yram); 836 iounmap(info->xram); 837 iounmap(info->pram); 838 res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 839 if (res) 840 release_mem_region(res->start, resource_size(res)); 841 kfree(info); 842 843 return 0; 844 } 845 846 static struct platform_driver siu_driver = { 847 .driver = { 848 .owner = THIS_MODULE, 849 .name = "siu-pcm-audio", 850 }, 851 .probe = siu_probe, 852 .remove = __devexit_p(siu_remove), 853 }; 854 855 static int __init siu_init(void) 856 { 857 return platform_driver_register(&siu_driver); 858 } 859 860 static void __exit siu_exit(void) 861 { 862 platform_driver_unregister(&siu_driver); 863 } 864 865 module_init(siu_init) 866 module_exit(siu_exit) 867 868 MODULE_AUTHOR("Carlos Munoz <carlos@kenati.com>"); 869 MODULE_DESCRIPTION("ALSA SoC SH7722 SIU driver"); 870 MODULE_LICENSE("GPL"); 871