sound/soc/uniphier/aio-cpu.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 //
   3 // Socionext UniPhier AIO ALSA CPU DAI driver.
   4 //
   5 // Copyright (c) 2016-2018 Socionext Inc.
   6
   7 #include <linux/clk.h>
   8 #include <linux/errno.h>
   9 #include <linux/kernel.h>
  10 #include <linux/mfd/syscon.h>
  11 #include <linux/module.h>
  12 #include <linux/of.h>
  13 #include <linux/of_platform.h>
  14 #include <linux/platform_device.h>
  15 #include <linux/reset.h>
  16 #include <sound/core.h>
  17 #include <sound/pcm.h>
  18 #include <sound/pcm_params.h>
  19 #include <sound/soc.h>
  20
  21 #include "aio.h"
  22
  23 static bool is_valid_pll(struct uniphier_aio_chip *chip, int pll_id)
  24 {
  25         struct device *dev = &chip->pdev->dev;
  26
  27         if (pll_id < 0 || chip->num_plls <= pll_id) {
  28                 dev_err(dev, "PLL(%d) is not supported\n", pll_id);
  29                 return false;
  30         }
  31
  32         return chip->plls[pll_id].enable;
  33 }
  34
  35 /**
  36  * find_volume - find volume supported HW port by HW port number
  37  * @chip: the AIO chip pointer
  38  * @oport_hw: HW port number, one of AUD_HW_XXXX
  39  *
  40  * Find AIO device from device list by HW port number. Volume feature is
  41  * available only in Output and PCM ports, this limitation comes from HW
  42  * specifications.
  43  *
  44  * Return: The pointer of AIO substream if successful, otherwise NULL on error.
  45  */
  46 static struct uniphier_aio_sub *find_volume(struct uniphier_aio_chip *chip,
  47                                             int oport_hw)
  48 {
  49         int i;
  50
  51         for (i = 0; i < chip->num_aios; i++) {
  52                 struct uniphier_aio_sub *sub = &chip->aios[i].sub[0];
  53
  54                 if (!sub->swm)
  55                         continue;
  56
  57                 if (sub->swm->oport.hw == oport_hw)
  58                         return sub;
  59         }
  60
  61         return NULL;
  62 }
  63
  64 static bool match_spec(const struct uniphier_aio_spec *spec,
  65                        const char *name, int dir)
  66 {
  67         if (dir == SNDRV_PCM_STREAM_PLAYBACK &&
  68             spec->swm.dir != PORT_DIR_OUTPUT) {
  69                 return false;
  70         }
  71
  72         if (dir == SNDRV_PCM_STREAM_CAPTURE &&
  73             spec->swm.dir != PORT_DIR_INPUT) {
  74                 return false;
  75         }
  76
  77         if (spec->name && strcmp(spec->name, name) == 0)
  78                 return true;
  79
  80         if (spec->gname && strcmp(spec->gname, name) == 0)
  81                 return true;
  82
  83         return false;
  84 }
  85
  86 /**
  87  * find_spec - find HW specification info by name
  88  * @aio: the AIO device pointer
  89  * @name: name of device
  90  * @direction: the direction of substream, SNDRV_PCM_STREAM_*
  91  *
  92  * Find hardware specification information from list by device name. This
  93  * information is used for telling the difference of SoCs to driver.
  94  *
  95  * Specification list is array of 'struct uniphier_aio_spec' which is defined
  96  * in each drivers (see: aio-i2s.c).
  97  *
  98  * Return: The pointer of hardware specification of AIO if successful,
  99  * otherwise NULL on error.
 100  */
 101 static const struct uniphier_aio_spec *find_spec(struct uniphier_aio *aio,
 102                                                  const char *name,
 103                                                  int direction)
 104 {
 105         const struct uniphier_aio_chip_spec *chip_spec = aio->chip->chip_spec;
 106         int i;
 107
 108         for (i = 0; i < chip_spec->num_specs; i++) {
 109                 const struct uniphier_aio_spec *spec = &chip_spec->specs[i];
 110
 111                 if (match_spec(spec, name, direction))
 112                         return spec;
 113         }
 114
 115         return NULL;
 116 }
 117
 118 /**
 119  * find_divider - find clock divider by frequency
 120  * @aio: the AIO device pointer
 121  * @pll_id: PLL ID, should be AUD_PLL_XX
 122  * @freq: required frequency
 123  *
 124  * Find suitable clock divider by frequency.
 125  *
 126  * Return: The ID of PLL if successful, otherwise negative error value.
 127  */
 128 static int find_divider(struct uniphier_aio *aio, int pll_id, unsigned int freq)
 129 {
 130         struct uniphier_aio_pll *pll;
 131         int mul[] = { 1, 1, 1, 2, };
 132         int div[] = { 2, 3, 1, 3, };
 133         int i;
 134
 135         if (!is_valid_pll(aio->chip, pll_id))
 136                 return -EINVAL;
 137
 138         pll = &aio->chip->plls[pll_id];
 139         for (i = 0; i < ARRAY_SIZE(mul); i++)
 140                 if (pll->freq * mul[i] / div[i] == freq)
 141                         return i;
 142
 143         return -ENOTSUPP;
 144 }
 145
 146 static int uniphier_aio_set_sysclk(struct snd_soc_dai *dai, int clk_id,
 147                                    unsigned int freq, int dir)
 148 {
 149         struct uniphier_aio *aio = uniphier_priv(dai);
 150         struct device *dev = &aio->chip->pdev->dev;
 151         bool pll_auto = false;
 152         int pll_id, div_id;
 153
 154         switch (clk_id) {
 155         case AUD_CLK_IO:
 156                 return -ENOTSUPP;
 157         case AUD_CLK_A1:
 158                 pll_id = AUD_PLL_A1;
 159                 break;
 160         case AUD_CLK_F1:
 161                 pll_id = AUD_PLL_F1;
 162                 break;
 163         case AUD_CLK_A2:
 164                 pll_id = AUD_PLL_A2;
 165                 break;
 166         case AUD_CLK_F2:
 167                 pll_id = AUD_PLL_F2;
 168                 break;
 169         case AUD_CLK_A:
 170                 pll_id = AUD_PLL_A1;
 171                 pll_auto = true;
 172                 break;
 173         case AUD_CLK_F:
 174                 pll_id = AUD_PLL_F1;
 175                 pll_auto = true;
 176                 break;
 177         case AUD_CLK_APLL:
 178                 pll_id = AUD_PLL_APLL;
 179                 break;
 180         case AUD_CLK_RX0:
 181                 pll_id = AUD_PLL_RX0;
 182                 break;
 183         case AUD_CLK_USB0:
 184                 pll_id = AUD_PLL_USB0;
 185                 break;
 186         case AUD_CLK_HSC0:
 187                 pll_id = AUD_PLL_HSC0;
 188                 break;
 189         default:
 190                 dev_err(dev, "Sysclk(%d) is not supported\n", clk_id);
 191                 return -EINVAL;
 192         }
 193
 194         if (pll_auto) {
 195                 for (pll_id = 0; pll_id < aio->chip->num_plls; pll_id++) {
 196                         div_id = find_divider(aio, pll_id, freq);
 197                         if (div_id >= 0) {
 198                                 aio->plldiv = div_id;
 199                                 break;
 200                         }
 201                 }
 202                 if (pll_id == aio->chip->num_plls) {
 203                         dev_err(dev, "Sysclk frequency is not supported(%d)\n",
 204                                 freq);
 205                         return -EINVAL;
 206                 }
 207         }
 208
 209         if (dir == SND_SOC_CLOCK_OUT)
 210                 aio->pll_out = pll_id;
 211         else
 212                 aio->pll_in = pll_id;
 213
 214         return 0;
 215 }
 216
 217 static int uniphier_aio_set_pll(struct snd_soc_dai *dai, int pll_id,
 218                                 int source, unsigned int freq_in,
 219                                 unsigned int freq_out)
 220 {
 221         struct uniphier_aio *aio = uniphier_priv(dai);
 222         int ret;
 223
 224         if (!is_valid_pll(aio->chip, pll_id))
 225                 return -EINVAL;
 226
 227         ret = aio_chip_set_pll(aio->chip, pll_id, freq_out);
 228         if (ret < 0)
 229                 return ret;
 230
 231         return 0;
 232 }
 233
 234 static int uniphier_aio_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
 235 {
 236         struct uniphier_aio *aio = uniphier_priv(dai);
 237         struct device *dev = &aio->chip->pdev->dev;
 238
 239         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
 240         case SND_SOC_DAIFMT_LEFT_J:
 241         case SND_SOC_DAIFMT_RIGHT_J:
 242         case SND_SOC_DAIFMT_I2S:
 243                 aio->fmt = fmt & SND_SOC_DAIFMT_FORMAT_MASK;
 244                 break;
 245         default:
 246                 dev_err(dev, "Format is not supported(%d)\n",
 247                         fmt & SND_SOC_DAIFMT_FORMAT_MASK);
 248                 return -EINVAL;
 249         }
 250
 251         return 0;
 252 }
 253
 254 static int uniphier_aio_startup(struct snd_pcm_substream *substream,
 255                                 struct snd_soc_dai *dai)
 256 {
 257         struct uniphier_aio *aio = uniphier_priv(dai);
 258         struct uniphier_aio_sub *sub = &aio->sub[substream->stream];
 259         int ret;
 260
 261         sub->substream = substream;
 262         sub->pass_through = 0;
 263         sub->use_mmap = true;
 264
 265         ret = aio_init(sub);
 266         if (ret)
 267                 return ret;
 268
 269         return 0;
 270 }
 271
 272 static void uniphier_aio_shutdown(struct snd_pcm_substream *substream,
 273                                   struct snd_soc_dai *dai)
 274 {
 275         struct uniphier_aio *aio = uniphier_priv(dai);
 276         struct uniphier_aio_sub *sub = &aio->sub[substream->stream];
 277
 278         sub->substream = NULL;
 279 }
 280
 281 static int uniphier_aio_hw_params(struct snd_pcm_substream *substream,
 282                                   struct snd_pcm_hw_params *params,
 283                                   struct snd_soc_dai *dai)
 284 {
 285         struct uniphier_aio *aio = uniphier_priv(dai);
 286         struct uniphier_aio_sub *sub = &aio->sub[substream->stream];
 287         struct device *dev = &aio->chip->pdev->dev;
 288         int freq, ret;
 289
 290         switch (params_rate(params)) {
 291         case 48000:
 292         case 32000:
 293         case 24000:
 294                 freq = 12288000;
 295                 break;
 296         case 44100:
 297         case 22050:
 298                 freq = 11289600;
 299                 break;
 300         default:
 301                 dev_err(dev, "Rate is not supported(%d)\n",
 302                         params_rate(params));
 303                 return -EINVAL;
 304         }
 305         ret = snd_soc_dai_set_sysclk(dai, AUD_CLK_A,
 306                                      freq, SND_SOC_CLOCK_OUT);
 307         if (ret)
 308                 return ret;
 309
 310         sub->params = *params;
 311         sub->setting = 1;
 312
 313         aio_port_reset(sub);
 314         aio_port_set_volume(sub, sub->vol);
 315         aio_src_reset(sub);
 316
 317         return 0;
 318 }
 319
 320 static int uniphier_aio_hw_free(struct snd_pcm_substream *substream,
 321                                 struct snd_soc_dai *dai)
 322 {
 323         struct uniphier_aio *aio = uniphier_priv(dai);
 324         struct uniphier_aio_sub *sub = &aio->sub[substream->stream];
 325
 326         sub->setting = 0;
 327
 328         return 0;
 329 }
 330
 331 static int uniphier_aio_prepare(struct snd_pcm_substream *substream,
 332                                 struct snd_soc_dai *dai)
 333 {
 334         struct uniphier_aio *aio = uniphier_priv(dai);
 335         struct uniphier_aio_sub *sub = &aio->sub[substream->stream];
 336         int ret;
 337
 338         ret = aio_port_set_param(sub, sub->pass_through, &sub->params);
 339         if (ret)
 340                 return ret;
 341         ret = aio_src_set_param(sub, &sub->params);
 342         if (ret)
 343                 return ret;
 344         aio_port_set_enable(sub, 1);
 345
 346         ret = aio_if_set_param(sub, sub->pass_through);
 347         if (ret)
 348                 return ret;
 349
 350         if (sub->swm->type == PORT_TYPE_CONV) {
 351                 ret = aio_srcif_set_param(sub);
 352                 if (ret)
 353                         return ret;
 354                 ret = aio_srcch_set_param(sub);
 355                 if (ret)
 356                         return ret;
 357                 aio_srcch_set_enable(sub, 1);
 358         }
 359
 360         return 0;
 361 }
 362
 363 const struct snd_soc_dai_ops uniphier_aio_i2s_ops = {
 364         .set_sysclk  = uniphier_aio_set_sysclk,
 365         .set_pll     = uniphier_aio_set_pll,
 366         .set_fmt     = uniphier_aio_set_fmt,
 367         .startup     = uniphier_aio_startup,
 368         .shutdown    = uniphier_aio_shutdown,
 369         .hw_params   = uniphier_aio_hw_params,
 370         .hw_free     = uniphier_aio_hw_free,
 371         .prepare     = uniphier_aio_prepare,
 372 };
 373 EXPORT_SYMBOL_GPL(uniphier_aio_i2s_ops);
 374
 375 const struct snd_soc_dai_ops uniphier_aio_spdif_ops = {
 376         .set_sysclk  = uniphier_aio_set_sysclk,
 377         .set_pll     = uniphier_aio_set_pll,
 378         .startup     = uniphier_aio_startup,
 379         .shutdown    = uniphier_aio_shutdown,
 380         .hw_params   = uniphier_aio_hw_params,
 381         .hw_free     = uniphier_aio_hw_free,
 382         .prepare     = uniphier_aio_prepare,
 383 };
 384 EXPORT_SYMBOL_GPL(uniphier_aio_spdif_ops);
 385
 386 int uniphier_aio_dai_probe(struct snd_soc_dai *dai)
 387 {
 388         struct uniphier_aio *aio = uniphier_priv(dai);
 389         int i;
 390
 391         for (i = 0; i < ARRAY_SIZE(aio->sub); i++) {
 392                 struct uniphier_aio_sub *sub = &aio->sub[i];
 393                 const struct uniphier_aio_spec *spec;
 394
 395                 spec = find_spec(aio, dai->name, i);
 396                 if (!spec)
 397                         continue;
 398
 399                 sub->swm = &spec->swm;
 400                 sub->spec = spec;
 401
 402                 sub->vol = AUD_VOL_INIT;
 403         }
 404
 405         aio_iecout_set_enable(aio->chip, true);
 406         aio_chip_init(aio->chip);
 407         aio->chip->active = 1;
 408
 409         return 0;
 410 }
 411 EXPORT_SYMBOL_GPL(uniphier_aio_dai_probe);
 412
 413 int uniphier_aio_dai_remove(struct snd_soc_dai *dai)
 414 {
 415         struct uniphier_aio *aio = uniphier_priv(dai);
 416
 417         aio->chip->active = 0;
 418
 419         return 0;
 420 }
 421 EXPORT_SYMBOL_GPL(uniphier_aio_dai_remove);
 422
 423 static void uniphier_aio_dai_suspend(struct snd_soc_dai *dai)
 424 {
 425         struct uniphier_aio *aio = uniphier_priv(dai);
 426
 427         if (!dai->active)
 428                 return;
 429
 430         aio->chip->num_wup_aios--;
 431         if (!aio->chip->num_wup_aios) {
 432                 reset_control_assert(aio->chip->rst);
 433                 clk_disable_unprepare(aio->chip->clk);
 434         }
 435 }
 436
 437 static int uniphier_aio_suspend(struct snd_soc_component *component)
 438 {
 439         struct snd_soc_dai *dai;
 440
 441         for_each_component_dais(component, dai)
 442                 uniphier_aio_dai_suspend(dai);
 443         return 0;
 444 }
 445
 446 static int uniphier_aio_dai_resume(struct snd_soc_dai *dai)
 447 {
 448         struct uniphier_aio *aio = uniphier_priv(dai);
 449         int ret, i;
 450
 451         if (!dai->active)
 452                 return 0;
 453
 454         if (!aio->chip->active)
 455                 return 0;
 456
 457         if (!aio->chip->num_wup_aios) {
 458                 ret = clk_prepare_enable(aio->chip->clk);
 459                 if (ret)
 460                         return ret;
 461
 462                 ret = reset_control_deassert(aio->chip->rst);
 463                 if (ret)
 464                         goto err_out_clock;
 465         }
 466
 467         aio_iecout_set_enable(aio->chip, true);
 468         aio_chip_init(aio->chip);
 469
 470         for (i = 0; i < ARRAY_SIZE(aio->sub); i++) {
 471                 struct uniphier_aio_sub *sub = &aio->sub[i];
 472
 473                 if (!sub->spec || !sub->substream)
 474                         continue;
 475
 476                 ret = aio_init(sub);
 477                 if (ret)
 478                         goto err_out_reset;
 479
 480                 if (!sub->setting)
 481                         continue;
 482
 483                 aio_port_reset(sub);
 484                 aio_src_reset(sub);
 485         }
 486         aio->chip->num_wup_aios++;
 487
 488         return 0;
 489
 490 err_out_reset:
 491         if (!aio->chip->num_wup_aios)
 492                 reset_control_assert(aio->chip->rst);
 493 err_out_clock:
 494         if (!aio->chip->num_wup_aios)
 495                 clk_disable_unprepare(aio->chip->clk);
 496
 497         return ret;
 498 }
 499
 500 static int uniphier_aio_resume(struct snd_soc_component *component)
 501 {
 502         struct snd_soc_dai *dai;
 503         int ret = 0;
 504
 505         for_each_component_dais(component, dai)
 506                 ret |= uniphier_aio_dai_resume(dai);
 507         return ret;
 508 }
 509
 510 static int uniphier_aio_vol_info(struct snd_kcontrol *kcontrol,
 511                                  struct snd_ctl_elem_info *uinfo)
 512 {
 513         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
 514         uinfo->count = 1;
 515         uinfo->value.integer.min = 0;
 516         uinfo->value.integer.max = AUD_VOL_MAX;
 517
 518         return 0;
 519 }
 520
 521 static int uniphier_aio_vol_get(struct snd_kcontrol *kcontrol,
 522                                 struct snd_ctl_elem_value *ucontrol)
 523 {
 524         struct snd_soc_component *comp = snd_soc_kcontrol_component(kcontrol);
 525         struct uniphier_aio_chip *chip = snd_soc_component_get_drvdata(comp);
 526         struct uniphier_aio_sub *sub;
 527         int oport_hw = kcontrol->private_value;
 528
 529         sub = find_volume(chip, oport_hw);
 530         if (!sub)
 531                 return 0;
 532
 533         ucontrol->value.integer.value[0] = sub->vol;
 534
 535         return 0;
 536 }
 537
 538 static int uniphier_aio_vol_put(struct snd_kcontrol *kcontrol,
 539                                 struct snd_ctl_elem_value *ucontrol)
 540 {
 541         struct snd_soc_component *comp = snd_soc_kcontrol_component(kcontrol);
 542         struct uniphier_aio_chip *chip = snd_soc_component_get_drvdata(comp);
 543         struct uniphier_aio_sub *sub;
 544         int oport_hw = kcontrol->private_value;
 545
 546         sub = find_volume(chip, oport_hw);
 547         if (!sub)
 548                 return 0;
 549
 550         if (sub->vol == ucontrol->value.integer.value[0])
 551                 return 0;
 552         sub->vol = ucontrol->value.integer.value[0];
 553
 554         aio_port_set_volume(sub, sub->vol);
 555
 556         return 0;
 557 }
 558
 559 static const struct snd_kcontrol_new uniphier_aio_controls[] = {
 560         {
 561                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
 562                 .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
 563                 .name = "HPCMOUT1 Volume",
 564                 .info = uniphier_aio_vol_info,
 565                 .get = uniphier_aio_vol_get,
 566                 .put = uniphier_aio_vol_put,
 567                 .private_value = AUD_HW_HPCMOUT1,
 568         },
 569         {
 570                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
 571                 .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
 572                 .name = "PCMOUT1 Volume",
 573                 .info = uniphier_aio_vol_info,
 574                 .get = uniphier_aio_vol_get,
 575                 .put = uniphier_aio_vol_put,
 576                 .private_value = AUD_HW_PCMOUT1,
 577         },
 578         {
 579                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
 580                 .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
 581                 .name = "PCMOUT2 Volume",
 582                 .info = uniphier_aio_vol_info,
 583                 .get = uniphier_aio_vol_get,
 584                 .put = uniphier_aio_vol_put,
 585                 .private_value = AUD_HW_PCMOUT2,
 586         },
 587         {
 588                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
 589                 .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
 590                 .name = "PCMOUT3 Volume",
 591                 .info = uniphier_aio_vol_info,
 592                 .get = uniphier_aio_vol_get,
 593                 .put = uniphier_aio_vol_put,
 594                 .private_value = AUD_HW_PCMOUT3,
 595         },
 596         {
 597                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
 598                 .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
 599                 .name = "HIECOUT1 Volume",
 600                 .info = uniphier_aio_vol_info,
 601                 .get = uniphier_aio_vol_get,
 602                 .put = uniphier_aio_vol_put,
 603                 .private_value = AUD_HW_HIECOUT1,
 604         },
 605         {
 606                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
 607                 .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,
 608                 .name = "IECOUT1 Volume",
 609                 .info = uniphier_aio_vol_info,
 610                 .get = uniphier_aio_vol_get,
 611                 .put = uniphier_aio_vol_put,
 612                 .private_value = AUD_HW_IECOUT1,
 613         },
 614 };
 615
 616 static const struct snd_soc_component_driver uniphier_aio_component = {
 617         .name = "uniphier-aio",
 618         .controls = uniphier_aio_controls,
 619         .num_controls = ARRAY_SIZE(uniphier_aio_controls),
 620         .suspend = uniphier_aio_suspend,
 621         .resume  = uniphier_aio_resume,
 622 };
 623
 624 int uniphier_aio_probe(struct platform_device *pdev)
 625 {
 626         struct uniphier_aio_chip *chip;
 627         struct device *dev = &pdev->dev;
 628         int ret, i, j;
 629
 630         chip = devm_kzalloc(dev, sizeof(*chip), GFP_KERNEL);
 631         if (!chip)
 632                 return -ENOMEM;
 633
 634         chip->chip_spec = of_device_get_match_data(dev);
 635         if (!chip->chip_spec)
 636                 return -EINVAL;
 637
 638         chip->regmap_sg = syscon_regmap_lookup_by_phandle(dev->of_node,
 639                                                           "socionext,syscon");
 640         if (IS_ERR(chip->regmap_sg)) {
 641                 if (PTR_ERR(chip->regmap_sg) == -EPROBE_DEFER)
 642                         return -EPROBE_DEFER;
 643                 chip->regmap_sg = NULL;
 644         }
 645
 646         chip->clk = devm_clk_get(dev, "aio");
 647         if (IS_ERR(chip->clk))
 648                 return PTR_ERR(chip->clk);
 649
 650         chip->rst = devm_reset_control_get_shared(dev, "aio");
 651         if (IS_ERR(chip->rst))
 652                 return PTR_ERR(chip->rst);
 653
 654         chip->num_aios = chip->chip_spec->num_dais;
 655         chip->num_wup_aios = chip->num_aios;
 656         chip->aios = devm_kcalloc(dev,
 657                                   chip->num_aios, sizeof(struct uniphier_aio),
 658                                   GFP_KERNEL);
 659         if (!chip->aios)
 660                 return -ENOMEM;
 661
 662         chip->num_plls = chip->chip_spec->num_plls;
 663         chip->plls = devm_kcalloc(dev,
 664                                   chip->num_plls,
 665                                   sizeof(struct uniphier_aio_pll),
 666                                   GFP_KERNEL);
 667         if (!chip->plls)
 668                 return -ENOMEM;
 669         memcpy(chip->plls, chip->chip_spec->plls,
 670                sizeof(struct uniphier_aio_pll) * chip->num_plls);
 671
 672         for (i = 0; i < chip->num_aios; i++) {
 673                 struct uniphier_aio *aio = &chip->aios[i];
 674
 675                 aio->chip = chip;
 676                 aio->fmt = SND_SOC_DAIFMT_I2S;
 677
 678                 for (j = 0; j < ARRAY_SIZE(aio->sub); j++) {
 679                         struct uniphier_aio_sub *sub = &aio->sub[j];
 680
 681                         sub->aio = aio;
 682                         spin_lock_init(&sub->lock);
 683                 }
 684         }
 685
 686         chip->pdev = pdev;
 687         platform_set_drvdata(pdev, chip);
 688
 689         ret = clk_prepare_enable(chip->clk);
 690         if (ret)
 691                 return ret;
 692
 693         ret = reset_control_deassert(chip->rst);
 694         if (ret)
 695                 goto err_out_clock;
 696
 697         ret = devm_snd_soc_register_component(dev, &uniphier_aio_component,
 698                                               chip->chip_spec->dais,
 699                                               chip->chip_spec->num_dais);
 700         if (ret) {
 701                 dev_err(dev, "Register component failed.\n");
 702                 goto err_out_reset;
 703         }
 704
 705         ret = uniphier_aiodma_soc_register_platform(pdev);
 706         if (ret) {
 707                 dev_err(dev, "Register platform failed.\n");
 708                 goto err_out_reset;
 709         }
 710
 711         return 0;
 712
 713 err_out_reset:
 714         reset_control_assert(chip->rst);
 715
 716 err_out_clock:
 717         clk_disable_unprepare(chip->clk);
 718
 719         return ret;
 720 }
 721 EXPORT_SYMBOL_GPL(uniphier_aio_probe);
 722
 723 int uniphier_aio_remove(struct platform_device *pdev)
 724 {
 725         struct uniphier_aio_chip *chip = platform_get_drvdata(pdev);
 726
 727         reset_control_assert(chip->rst);
 728         clk_disable_unprepare(chip->clk);
 729
 730         return 0;
 731 }
 732 EXPORT_SYMBOL_GPL(uniphier_aio_remove);
 733
 734 MODULE_AUTHOR("Katsuhiro Suzuki <suzuki.katsuhiro@socionext.com>");
 735 MODULE_DESCRIPTION("UniPhier AIO CPU DAI driver.");
 736 MODULE_LICENSE("GPL v2");