sound/soc/generic/simple-card.c

   1 /*
   2  * ASoC simple sound card support
   3  *
   4  * Copyright (C) 2012 Renesas Solutions Corp.
   5  * Kuninori Morimoto <kuninori.morimoto.gx@renesas.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 version 2 as
   9  * published by the Free Software Foundation.
  10  */
  11 #include <linux/clk.h>
  12 #include <linux/module.h>
  13 #include <linux/of.h>
  14 #include <linux/platform_device.h>
  15 #include <linux/string.h>
  16 #include <sound/simple_card.h>
  17
  18 struct simple_card_data {
  19         struct snd_soc_card snd_card;
  20         unsigned int daifmt;
  21         struct asoc_simple_dai cpu_dai;
  22         struct asoc_simple_dai codec_dai;
  23         struct snd_soc_dai_link snd_link;
  24 };
  25
  26 static int __asoc_simple_card_dai_init(struct snd_soc_dai *dai,
  27                                        struct asoc_simple_dai *set)
  28 {
  29         int ret;
  30
  31         if (set->fmt) {
  32                 ret = snd_soc_dai_set_fmt(dai, set->fmt);
  33                 if (ret && ret != -ENOTSUPP) {
  34                         dev_err(dai->dev, "simple-card: set_fmt error\n");
  35                         goto err;
  36                 }
  37         }
  38
  39         if (set->sysclk) {
  40                 ret = snd_soc_dai_set_sysclk(dai, 0, set->sysclk, 0);
  41                 if (ret && ret != -ENOTSUPP) {
  42                         dev_err(dai->dev, "simple-card: set_sysclk error\n");
  43                         goto err;
  44                 }
  45         }
  46
  47         ret = 0;
  48
  49 err:
  50         return ret;
  51 }
  52
  53 static int asoc_simple_card_dai_init(struct snd_soc_pcm_runtime *rtd)
  54 {
  55         struct simple_card_data *priv =
  56                                 snd_soc_card_get_drvdata(rtd->card);
  57         struct snd_soc_dai *codec = rtd->codec_dai;
  58         struct snd_soc_dai *cpu = rtd->cpu_dai;
  59         int ret;
  60
  61         ret = __asoc_simple_card_dai_init(codec, &priv->codec_dai);
  62         if (ret < 0)
  63                 return ret;
  64
  65         ret = __asoc_simple_card_dai_init(cpu, &priv->cpu_dai);
  66         if (ret < 0)
  67                 return ret;
  68
  69         return 0;
  70 }
  71
  72 static int
  73 asoc_simple_card_sub_parse_of(struct device_node *np,
  74                               unsigned int daifmt,
  75                               struct asoc_simple_dai *dai,
  76                               const struct device_node **p_node,
  77                               const char **name)
  78 {
  79         struct device_node *node;
  80         struct clk *clk;
  81         int ret;
  82
  83         /*
  84          * get node via "sound-dai = <&phandle port>"
  85          * it will be used as xxx_of_node on soc_bind_dai_link()
  86          */
  87         node = of_parse_phandle(np, "sound-dai", 0);
  88         if (!node)
  89                 return -ENODEV;
  90         *p_node = node;
  91
  92         /* get dai->name */
  93         ret = snd_soc_of_get_dai_name(np, name);
  94         if (ret < 0)
  95                 goto parse_error;
  96
  97         /*
  98          * bitclock-inversion, frame-inversion
  99          * bitclock-master,    frame-master
 100          * and specific "format" if it has
 101          */
 102         dai->fmt = snd_soc_of_parse_daifmt(np, NULL);
 103         dai->fmt |= daifmt;
 104
 105         /*
 106          * dai->sysclk come from
 107          *  "clocks = <&xxx>" (if system has common clock)
 108          *  or "system-clock-frequency = <xxx>"
 109          *  or device's module clock.
 110          */
 111         if (of_property_read_bool(np, "clocks")) {
 112                 clk = of_clk_get(np, 0);
 113                 if (IS_ERR(clk)) {
 114                         ret = PTR_ERR(clk);
 115                         goto parse_error;
 116                 }
 117
 118                 dai->sysclk = clk_get_rate(clk);
 119         } else if (of_property_read_bool(np, "system-clock-frequency")) {
 120                 of_property_read_u32(np,
 121                                      "system-clock-frequency",
 122                                      &dai->sysclk);
 123         } else {
 124                 clk = of_clk_get(node, 0);
 125                 if (!IS_ERR(clk))
 126                         dai->sysclk = clk_get_rate(clk);
 127         }
 128
 129         ret = 0;
 130
 131 parse_error:
 132         of_node_put(node);
 133
 134         return ret;
 135 }
 136
 137 static int asoc_simple_card_parse_of(struct device_node *node,
 138                                      struct simple_card_data *priv,
 139                                      struct device *dev)
 140 {
 141         struct snd_soc_dai_link *dai_link = priv->snd_card.dai_link;
 142         struct device_node *np;
 143         char *name;
 144         int ret;
 145
 146         /* parsing the card name from DT */
 147         snd_soc_of_parse_card_name(&priv->snd_card, "simple-audio-card,name");
 148
 149         /* get CPU/CODEC common format via simple-audio-card,format */
 150         priv->daifmt = snd_soc_of_parse_daifmt(node, "simple-audio-card,") &
 151                 (SND_SOC_DAIFMT_FORMAT_MASK | SND_SOC_DAIFMT_INV_MASK);
 152
 153         /* DAPM routes */
 154         if (of_property_read_bool(node, "simple-audio-card,routing")) {
 155                 ret = snd_soc_of_parse_audio_routing(&priv->snd_card,
 156                                         "simple-audio-card,routing");
 157                 if (ret)
 158                         return ret;
 159         }
 160
 161         /* CPU sub-node */
 162         ret = -EINVAL;
 163         np = of_get_child_by_name(node, "simple-audio-card,cpu");
 164         if (np)
 165                 ret = asoc_simple_card_sub_parse_of(np, priv->daifmt,
 166                                                   &priv->cpu_dai,
 167                                                   &dai_link->cpu_of_node,
 168                                                   &dai_link->cpu_dai_name);
 169         if (ret < 0)
 170                 return ret;
 171
 172         /* CODEC sub-node */
 173         ret = -EINVAL;
 174         np = of_get_child_by_name(node, "simple-audio-card,codec");
 175         if (np)
 176                 ret = asoc_simple_card_sub_parse_of(np, priv->daifmt,
 177                                                   &priv->codec_dai,
 178                                                   &dai_link->codec_of_node,
 179                                                   &dai_link->codec_dai_name);
 180         if (ret < 0)
 181                 return ret;
 182
 183         if (!dai_link->cpu_dai_name || !dai_link->codec_dai_name)
 184                 return -EINVAL;
 185
 186         /* card name is created from CPU/CODEC dai name */
 187         name = devm_kzalloc(dev,
 188                             strlen(dai_link->cpu_dai_name)   +
 189                             strlen(dai_link->codec_dai_name) + 2,
 190                             GFP_KERNEL);
 191         sprintf(name, "%s-%s", dai_link->cpu_dai_name,
 192                                 dai_link->codec_dai_name);
 193         if (!priv->snd_card.name)
 194                 priv->snd_card.name = name;
 195         dai_link->name = dai_link->stream_name = name;
 196
 197         /* simple-card assumes platform == cpu */
 198         dai_link->platform_of_node = dai_link->cpu_of_node;
 199
 200         dev_dbg(dev, "card-name : %s\n", name);
 201         dev_dbg(dev, "platform : %04x\n", priv->daifmt);
 202         dev_dbg(dev, "cpu : %s / %04x / %d\n",
 203                 dai_link->cpu_dai_name,
 204                 priv->cpu_dai.fmt,
 205                 priv->cpu_dai.sysclk);
 206         dev_dbg(dev, "codec : %s / %04x / %d\n",
 207                 dai_link->codec_dai_name,
 208                 priv->codec_dai.fmt,
 209                 priv->codec_dai.sysclk);
 210
 211         return 0;
 212 }
 213
 214 static int asoc_simple_card_probe(struct platform_device *pdev)
 215 {
 216         struct simple_card_data *priv;
 217         struct snd_soc_dai_link *dai_link;
 218         struct device_node *np = pdev->dev.of_node;
 219         struct device *dev = &pdev->dev;
 220         int ret;
 221
 222         priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
 223         if (!priv)
 224                 return -ENOMEM;
 225
 226         /*
 227          * init snd_soc_card
 228          */
 229         priv->snd_card.owner = THIS_MODULE;
 230         priv->snd_card.dev = dev;
 231         dai_link = &priv->snd_link;
 232         priv->snd_card.dai_link = dai_link;
 233         priv->snd_card.num_links = 1;
 234
 235         if (np && of_device_is_available(np)) {
 236
 237                 ret = asoc_simple_card_parse_of(np, priv, dev);
 238                 if (ret < 0) {
 239                         if (ret != -EPROBE_DEFER)
 240                                 dev_err(dev, "parse error %d\n", ret);
 241                         return ret;
 242                 }
 243         } else {
 244                 struct asoc_simple_card_info *cinfo;
 245
 246                 cinfo = dev->platform_data;
 247                 if (!cinfo) {
 248                         dev_err(dev, "no info for asoc-simple-card\n");
 249                         return -EINVAL;
 250                 }
 251
 252                 if (!cinfo->name        ||
 253                     !cinfo->card        ||
 254                     !cinfo->codec_dai.name      ||
 255                     !cinfo->codec       ||
 256                     !cinfo->platform    ||
 257                     !cinfo->cpu_dai.name) {
 258                         dev_err(dev, "insufficient asoc_simple_card_info settings\n");
 259                         return -EINVAL;
 260                 }
 261
 262                 priv->snd_card.name     = cinfo->card;
 263                 dai_link->name          = cinfo->name;
 264                 dai_link->stream_name   = cinfo->name;
 265                 dai_link->platform_name = cinfo->platform;
 266                 dai_link->codec_name    = cinfo->codec;
 267                 dai_link->cpu_dai_name  = cinfo->cpu_dai.name;
 268                 dai_link->codec_dai_name = cinfo->codec_dai.name;
 269                 memcpy(&priv->cpu_dai, &cinfo->cpu_dai,
 270                                                 sizeof(priv->cpu_dai));
 271                 memcpy(&priv->codec_dai, &cinfo->codec_dai,
 272                                                 sizeof(priv->codec_dai));
 273         }
 274
 275         /*
 276          * init snd_soc_dai_link
 277          */
 278         dai_link->init = asoc_simple_card_dai_init;
 279
 280         snd_soc_card_set_drvdata(&priv->snd_card, priv);
 281
 282         return devm_snd_soc_register_card(&pdev->dev, &priv->snd_card);
 283 }
 284
 285 static const struct of_device_id asoc_simple_of_match[] = {
 286         { .compatible = "simple-audio-card", },
 287         {},
 288 };
 289 MODULE_DEVICE_TABLE(of, asoc_simple_of_match);
 290
 291 static struct platform_driver asoc_simple_card = {
 292         .driver = {
 293                 .name   = "asoc-simple-card",
 294                 .owner = THIS_MODULE,
 295                 .of_match_table = asoc_simple_of_match,
 296         },
 297         .probe          = asoc_simple_card_probe,
 298 };
 299
 300 module_platform_driver(asoc_simple_card);
 301
 302 MODULE_ALIAS("platform:asoc-simple-card");
 303 MODULE_LICENSE("GPL");
 304 MODULE_DESCRIPTION("ASoC Simple Sound Card");
 305 MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");