Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 1 | /* |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 2 | * ASoC simple SCU sound card support |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 3 | * |
| 4 | * Copyright (C) 2015 Renesas Solutions Corp. |
| 5 | * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com> |
| 6 | * |
| 7 | * based on ${LINUX}/sound/soc/generic/simple-card.c |
| 8 | * |
| 9 | * This program is free software; you can redistribute it and/or modify |
| 10 | * it under the terms of the GNU General Public License version 2 as |
| 11 | * published by the Free Software Foundation. |
| 12 | */ |
| 13 | #include <linux/clk.h> |
| 14 | #include <linux/device.h> |
| 15 | #include <linux/module.h> |
| 16 | #include <linux/of.h> |
| 17 | #include <linux/of_device.h> |
| 18 | #include <linux/platform_device.h> |
| 19 | #include <linux/string.h> |
| 20 | #include <sound/jack.h> |
| 21 | #include <sound/soc.h> |
| 22 | #include <sound/soc-dai.h> |
Kuninori Morimoto | d6a4a9a4 | 2016-06-30 06:03:13 +0000 | [diff] [blame] | 23 | #include <sound/simple_card_utils.h> |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 24 | |
Kuninori Morimoto | 6910e86 | 2016-10-28 03:37:44 +0000 | [diff] [blame] | 25 | struct simple_card_data { |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 26 | struct snd_soc_card snd_card; |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 27 | struct snd_soc_codec_conf codec_conf; |
Kuninori Morimoto | 303c3be | 2016-07-11 23:58:50 +0000 | [diff] [blame] | 28 | struct asoc_simple_dai *dai_props; |
Kuninori Morimoto | 3433bf0 | 2015-06-15 06:22:30 +0000 | [diff] [blame] | 29 | struct snd_soc_dai_link *dai_link; |
Kuninori Morimoto | cd8957f | 2017-06-15 00:24:28 +0000 | [diff] [blame] | 30 | struct asoc_simple_card_data adata; |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 31 | }; |
| 32 | |
Kuninori Morimoto | d27f3b4 | 2017-03-15 04:44:16 +0000 | [diff] [blame] | 33 | #define simple_priv_to_card(priv) (&(priv)->snd_card) |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 34 | #define simple_priv_to_props(priv, i) ((priv)->dai_props + (i)) |
Kuninori Morimoto | d27f3b4 | 2017-03-15 04:44:16 +0000 | [diff] [blame] | 35 | #define simple_priv_to_dev(priv) (simple_priv_to_card(priv)->dev) |
| 36 | #define simple_priv_to_link(priv, i) (simple_priv_to_card(priv)->dai_link + (i)) |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 37 | |
Kuninori Morimoto | 5bbf3866 | 2016-08-08 06:02:31 +0000 | [diff] [blame] | 38 | #define DAI "sound-dai" |
| 39 | #define CELL "#sound-dai-cells" |
Kuninori Morimoto | 64df0e6 | 2016-08-23 01:34:43 +0000 | [diff] [blame] | 40 | #define PREFIX "simple-audio-card," |
Kuninori Morimoto | 5bbf3866 | 2016-08-08 06:02:31 +0000 | [diff] [blame] | 41 | |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 42 | static int asoc_simple_card_startup(struct snd_pcm_substream *substream) |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 43 | { |
| 44 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
Kuninori Morimoto | 6910e86 | 2016-10-28 03:37:44 +0000 | [diff] [blame] | 45 | struct simple_card_data *priv = snd_soc_card_get_drvdata(rtd->card); |
Kuninori Morimoto | 303c3be | 2016-07-11 23:58:50 +0000 | [diff] [blame] | 46 | struct asoc_simple_dai *dai_props = |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 47 | simple_priv_to_props(priv, rtd->num); |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 48 | |
Kuninori Morimoto | bb24a3b | 2017-06-09 00:44:40 +0000 | [diff] [blame] | 49 | return asoc_simple_card_clk_enable(dai_props); |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 50 | } |
| 51 | |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 52 | static void asoc_simple_card_shutdown(struct snd_pcm_substream *substream) |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 53 | { |
| 54 | struct snd_soc_pcm_runtime *rtd = substream->private_data; |
Kuninori Morimoto | 6910e86 | 2016-10-28 03:37:44 +0000 | [diff] [blame] | 55 | struct simple_card_data *priv = snd_soc_card_get_drvdata(rtd->card); |
Kuninori Morimoto | 303c3be | 2016-07-11 23:58:50 +0000 | [diff] [blame] | 56 | struct asoc_simple_dai *dai_props = |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 57 | simple_priv_to_props(priv, rtd->num); |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 58 | |
Kuninori Morimoto | bb24a3b | 2017-06-09 00:44:40 +0000 | [diff] [blame] | 59 | asoc_simple_card_clk_disable(dai_props); |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 60 | } |
| 61 | |
Julia Lawall | 9b6fdef | 2016-10-15 16:55:49 +0200 | [diff] [blame] | 62 | static const struct snd_soc_ops asoc_simple_card_ops = { |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 63 | .startup = asoc_simple_card_startup, |
| 64 | .shutdown = asoc_simple_card_shutdown, |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 65 | }; |
| 66 | |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 67 | static int asoc_simple_card_dai_init(struct snd_soc_pcm_runtime *rtd) |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 68 | { |
Kuninori Morimoto | 6910e86 | 2016-10-28 03:37:44 +0000 | [diff] [blame] | 69 | struct simple_card_data *priv = snd_soc_card_get_drvdata(rtd->card); |
Kuninori Morimoto | 0470002 | 2015-06-15 06:24:15 +0000 | [diff] [blame] | 70 | struct snd_soc_dai *dai; |
| 71 | struct snd_soc_dai_link *dai_link; |
Kuninori Morimoto | 303c3be | 2016-07-11 23:58:50 +0000 | [diff] [blame] | 72 | struct asoc_simple_dai *dai_props; |
Mengdong Lin | 1a49798 | 2015-11-18 02:34:11 -0500 | [diff] [blame] | 73 | int num = rtd->num; |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 74 | |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 75 | dai_link = simple_priv_to_link(priv, num); |
| 76 | dai_props = simple_priv_to_props(priv, num); |
Kuninori Morimoto | 0470002 | 2015-06-15 06:24:15 +0000 | [diff] [blame] | 77 | dai = dai_link->dynamic ? |
| 78 | rtd->cpu_dai : |
| 79 | rtd->codec_dai; |
| 80 | |
Kuninori Morimoto | 600ee20 | 2016-08-09 05:49:21 +0000 | [diff] [blame] | 81 | return asoc_simple_card_init_dai(dai, dai_props); |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 82 | } |
| 83 | |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 84 | static int asoc_simple_card_be_hw_params_fixup(struct snd_soc_pcm_runtime *rtd, |
Kuninori Morimoto | af7e2be | 2015-03-26 04:01:46 +0000 | [diff] [blame] | 85 | struct snd_pcm_hw_params *params) |
| 86 | { |
Kuninori Morimoto | 6910e86 | 2016-10-28 03:37:44 +0000 | [diff] [blame] | 87 | struct simple_card_data *priv = snd_soc_card_get_drvdata(rtd->card); |
Kuninori Morimoto | af7e2be | 2015-03-26 04:01:46 +0000 | [diff] [blame] | 88 | |
Kuninori Morimoto | cd8957f | 2017-06-15 00:24:28 +0000 | [diff] [blame] | 89 | asoc_simple_card_convert_fixup(&priv->adata, params); |
Kuninori Morimoto | af7e2be | 2015-03-26 04:01:46 +0000 | [diff] [blame] | 90 | |
| 91 | return 0; |
| 92 | } |
| 93 | |
Kuninori Morimoto | 15a190ff | 2016-10-28 03:37:26 +0000 | [diff] [blame] | 94 | static int asoc_simple_card_dai_link_of(struct device_node *np, |
Kuninori Morimoto | 6910e86 | 2016-10-28 03:37:44 +0000 | [diff] [blame] | 95 | struct simple_card_data *priv, |
Kuninori Morimoto | 83216f3 | 2016-08-25 01:57:30 +0000 | [diff] [blame] | 96 | unsigned int daifmt, |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 97 | int idx, bool is_fe) |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 98 | { |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 99 | struct device *dev = simple_priv_to_dev(priv); |
| 100 | struct snd_soc_dai_link *dai_link = simple_priv_to_link(priv, idx); |
| 101 | struct asoc_simple_dai *dai_props = simple_priv_to_props(priv, idx); |
Kuninori Morimoto | d27f3b4 | 2017-03-15 04:44:16 +0000 | [diff] [blame] | 102 | struct snd_soc_card *card = simple_priv_to_card(priv); |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 103 | int ret; |
| 104 | |
Kuninori Morimoto | 0470002 | 2015-06-15 06:24:15 +0000 | [diff] [blame] | 105 | if (is_fe) { |
Kuninori Morimoto | 27b0108 | 2016-08-10 02:21:03 +0000 | [diff] [blame] | 106 | int is_single_links = 0; |
| 107 | |
Kuninori Morimoto | 0470002 | 2015-06-15 06:24:15 +0000 | [diff] [blame] | 108 | /* BE is dummy */ |
| 109 | dai_link->codec_of_node = NULL; |
| 110 | dai_link->codec_dai_name = "snd-soc-dummy-dai"; |
| 111 | dai_link->codec_name = "snd-soc-dummy"; |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 112 | |
Kuninori Morimoto | 0470002 | 2015-06-15 06:24:15 +0000 | [diff] [blame] | 113 | /* FE settings */ |
| 114 | dai_link->dynamic = 1; |
| 115 | dai_link->dpcm_merged_format = 1; |
Kuninori Morimoto | 5bbf3866 | 2016-08-08 06:02:31 +0000 | [diff] [blame] | 116 | |
| 117 | ret = asoc_simple_card_parse_cpu(np, dai_link, DAI, CELL, |
| 118 | &is_single_links); |
| 119 | if (ret) |
Kuninori Morimoto | 575f1f9 | 2015-12-01 08:33:23 +0000 | [diff] [blame] | 120 | return ret; |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 121 | |
Kuninori Morimoto | e984fd6 | 2017-01-23 07:29:42 +0000 | [diff] [blame] | 122 | ret = asoc_simple_card_parse_clk_cpu(dev, np, dai_link, dai_props); |
Kuninori Morimoto | c9a235d | 2016-07-19 02:53:32 +0000 | [diff] [blame] | 123 | if (ret < 0) |
| 124 | return ret; |
| 125 | |
Kuninori Morimoto | 8a99a6b | 2016-07-11 23:58:25 +0000 | [diff] [blame] | 126 | ret = asoc_simple_card_set_dailink_name(dev, dai_link, |
| 127 | "fe.%s", |
| 128 | dai_link->cpu_dai_name); |
| 129 | if (ret < 0) |
| 130 | return ret; |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 131 | |
Kuninori Morimoto | 27b0108 | 2016-08-10 02:21:03 +0000 | [diff] [blame] | 132 | asoc_simple_card_canonicalize_cpu(dai_link, is_single_links); |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 133 | } else { |
Kuninori Morimoto | 0470002 | 2015-06-15 06:24:15 +0000 | [diff] [blame] | 134 | /* FE is dummy */ |
| 135 | dai_link->cpu_of_node = NULL; |
| 136 | dai_link->cpu_dai_name = "snd-soc-dummy-dai"; |
| 137 | dai_link->cpu_name = "snd-soc-dummy"; |
| 138 | |
| 139 | /* BE settings */ |
| 140 | dai_link->no_pcm = 1; |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 141 | dai_link->be_hw_params_fixup = asoc_simple_card_be_hw_params_fixup; |
Kuninori Morimoto | 5bbf3866 | 2016-08-08 06:02:31 +0000 | [diff] [blame] | 142 | |
| 143 | ret = asoc_simple_card_parse_codec(np, dai_link, DAI, CELL); |
Kuninori Morimoto | 575f1f9 | 2015-12-01 08:33:23 +0000 | [diff] [blame] | 144 | if (ret < 0) |
| 145 | return ret; |
Kuninori Morimoto | 0470002 | 2015-06-15 06:24:15 +0000 | [diff] [blame] | 146 | |
Kuninori Morimoto | e984fd6 | 2017-01-23 07:29:42 +0000 | [diff] [blame] | 147 | ret = asoc_simple_card_parse_clk_codec(dev, np, dai_link, dai_props); |
Kuninori Morimoto | c9a235d | 2016-07-19 02:53:32 +0000 | [diff] [blame] | 148 | if (ret < 0) |
| 149 | return ret; |
| 150 | |
Kuninori Morimoto | 8a99a6b | 2016-07-11 23:58:25 +0000 | [diff] [blame] | 151 | ret = asoc_simple_card_set_dailink_name(dev, dai_link, |
| 152 | "be.%s", |
| 153 | dai_link->codec_dai_name); |
| 154 | if (ret < 0) |
| 155 | return ret; |
| 156 | |
Kuninori Morimoto | d27f3b4 | 2017-03-15 04:44:16 +0000 | [diff] [blame] | 157 | snd_soc_of_parse_audio_prefix(card, |
Kuninori Morimoto | 64df0e6 | 2016-08-23 01:34:43 +0000 | [diff] [blame] | 158 | &priv->codec_conf, |
| 159 | dai_link->codec_of_node, |
| 160 | PREFIX "prefix"); |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 161 | } |
| 162 | |
Kuninori Morimoto | 77b713b | 2017-06-14 00:35:13 +0000 | [diff] [blame] | 163 | ret = asoc_simple_card_of_parse_tdm(np, dai_props); |
Kuninori Morimoto | 9f64542 | 2016-08-25 01:58:55 +0000 | [diff] [blame] | 164 | if (ret) |
| 165 | return ret; |
| 166 | |
Kuninori Morimoto | a09f383 | 2016-08-09 05:50:19 +0000 | [diff] [blame] | 167 | ret = asoc_simple_card_canonicalize_dailink(dai_link); |
| 168 | if (ret < 0) |
| 169 | return ret; |
| 170 | |
Kuninori Morimoto | 83216f3 | 2016-08-25 01:57:30 +0000 | [diff] [blame] | 171 | dai_link->dai_fmt = daifmt; |
Kuninori Morimoto | 0470002 | 2015-06-15 06:24:15 +0000 | [diff] [blame] | 172 | dai_link->dpcm_playback = 1; |
| 173 | dai_link->dpcm_capture = 1; |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 174 | dai_link->ops = &asoc_simple_card_ops; |
| 175 | dai_link->init = asoc_simple_card_dai_init; |
Kuninori Morimoto | 0470002 | 2015-06-15 06:24:15 +0000 | [diff] [blame] | 176 | |
Kuninori Morimoto | c9a235d | 2016-07-19 02:53:32 +0000 | [diff] [blame] | 177 | return 0; |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 178 | } |
| 179 | |
Kuninori Morimoto | 0d6b352 | 2017-06-07 00:37:30 +0000 | [diff] [blame] | 180 | static int asoc_simple_card_parse_of(struct simple_card_data *priv) |
Kuninori Morimoto | 15a190ff | 2016-10-28 03:37:26 +0000 | [diff] [blame] | 181 | |
Kuninori Morimoto | af998f8 | 2015-12-17 02:49:43 +0000 | [diff] [blame] | 182 | { |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 183 | struct device *dev = simple_priv_to_dev(priv); |
Kuninori Morimoto | af998f8 | 2015-12-17 02:49:43 +0000 | [diff] [blame] | 184 | struct device_node *np; |
Kuninori Morimoto | d27f3b4 | 2017-03-15 04:44:16 +0000 | [diff] [blame] | 185 | struct snd_soc_card *card = simple_priv_to_card(priv); |
Kuninori Morimoto | 0d6b352 | 2017-06-07 00:37:30 +0000 | [diff] [blame] | 186 | struct device_node *node = dev->of_node; |
Kuninori Morimoto | af998f8 | 2015-12-17 02:49:43 +0000 | [diff] [blame] | 187 | unsigned int daifmt = 0; |
Kuninori Morimoto | af998f8 | 2015-12-17 02:49:43 +0000 | [diff] [blame] | 188 | bool is_fe; |
Kuninori Morimoto | 15a190ff | 2016-10-28 03:37:26 +0000 | [diff] [blame] | 189 | int ret, i; |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 190 | |
| 191 | if (!node) |
| 192 | return -EINVAL; |
| 193 | |
Daniel Baluta | d0148eb | 2017-08-11 17:12:19 +0300 | [diff] [blame] | 194 | ret = asoc_simple_card_of_parse_widgets(card, PREFIX); |
| 195 | if (ret < 0) |
| 196 | return ret; |
| 197 | |
Kuninori Morimoto | bfe6b58 | 2017-06-15 00:25:33 +0000 | [diff] [blame] | 198 | ret = asoc_simple_card_of_parse_routing(card, PREFIX, 0); |
Kuninori Morimoto | 64df0e6 | 2016-08-23 01:34:43 +0000 | [diff] [blame] | 199 | if (ret < 0) |
| 200 | return ret; |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 201 | |
Kuninori Morimoto | cd8957f | 2017-06-15 00:24:28 +0000 | [diff] [blame] | 202 | asoc_simple_card_parse_convert(dev, PREFIX, &priv->adata); |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 203 | |
Kuninori Morimoto | 15a190ff | 2016-10-28 03:37:26 +0000 | [diff] [blame] | 204 | /* find 1st codec */ |
| 205 | np = of_get_child_by_name(node, PREFIX "codec"); |
| 206 | if (!np) |
| 207 | return -ENODEV; |
| 208 | |
| 209 | ret = asoc_simple_card_parse_daifmt(dev, node, np, PREFIX, &daifmt); |
Kuninori Morimoto | af998f8 | 2015-12-17 02:49:43 +0000 | [diff] [blame] | 210 | if (ret < 0) |
| 211 | return ret; |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 212 | |
Kuninori Morimoto | 15a190ff | 2016-10-28 03:37:26 +0000 | [diff] [blame] | 213 | i = 0; |
| 214 | for_each_child_of_node(node, np) { |
| 215 | is_fe = false; |
| 216 | if (strcmp(np->name, PREFIX "cpu") == 0) |
| 217 | is_fe = true; |
| 218 | |
| 219 | ret = asoc_simple_card_dai_link_of(np, priv, daifmt, i, is_fe); |
| 220 | if (ret < 0) |
| 221 | return ret; |
| 222 | i++; |
| 223 | } |
| 224 | |
Kuninori Morimoto | d27f3b4 | 2017-03-15 04:44:16 +0000 | [diff] [blame] | 225 | ret = asoc_simple_card_parse_card_name(card, PREFIX); |
Kuninori Morimoto | 53ae918 | 2016-07-12 00:00:00 +0000 | [diff] [blame] | 226 | if (ret < 0) |
| 227 | return ret; |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 228 | |
| 229 | return 0; |
| 230 | } |
| 231 | |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 232 | static int asoc_simple_card_probe(struct platform_device *pdev) |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 233 | { |
Kuninori Morimoto | 6910e86 | 2016-10-28 03:37:44 +0000 | [diff] [blame] | 234 | struct simple_card_data *priv; |
Kuninori Morimoto | 1935992 | 2016-10-28 03:38:00 +0000 | [diff] [blame] | 235 | struct snd_soc_dai_link *dai_link; |
| 236 | struct asoc_simple_dai *dai_props; |
Kuninori Morimoto | d27f3b4 | 2017-03-15 04:44:16 +0000 | [diff] [blame] | 237 | struct snd_soc_card *card; |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 238 | struct device *dev = &pdev->dev; |
Kuninori Morimoto | 40b68da | 2017-03-15 04:43:40 +0000 | [diff] [blame] | 239 | struct device_node *np = dev->of_node; |
Kuninori Morimoto | 15a190ff | 2016-10-28 03:37:26 +0000 | [diff] [blame] | 240 | int num, ret; |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 241 | |
| 242 | /* Allocate the private data */ |
| 243 | priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); |
| 244 | if (!priv) |
| 245 | return -ENOMEM; |
| 246 | |
Kuninori Morimoto | 15a190ff | 2016-10-28 03:37:26 +0000 | [diff] [blame] | 247 | num = of_get_child_count(np); |
| 248 | |
Kuninori Morimoto | 1935992 | 2016-10-28 03:38:00 +0000 | [diff] [blame] | 249 | dai_props = devm_kzalloc(dev, sizeof(*dai_props) * num, GFP_KERNEL); |
| 250 | dai_link = devm_kzalloc(dev, sizeof(*dai_link) * num, GFP_KERNEL); |
| 251 | if (!dai_props || !dai_link) |
Kuninori Morimoto | 15a190ff | 2016-10-28 03:37:26 +0000 | [diff] [blame] | 252 | return -ENOMEM; |
| 253 | |
Kuninori Morimoto | 1935992 | 2016-10-28 03:38:00 +0000 | [diff] [blame] | 254 | priv->dai_props = dai_props; |
| 255 | priv->dai_link = dai_link; |
Kuninori Morimoto | 15a190ff | 2016-10-28 03:37:26 +0000 | [diff] [blame] | 256 | |
| 257 | /* Init snd_soc_card */ |
Kuninori Morimoto | d27f3b4 | 2017-03-15 04:44:16 +0000 | [diff] [blame] | 258 | card = simple_priv_to_card(priv); |
| 259 | card->owner = THIS_MODULE; |
| 260 | card->dev = dev; |
| 261 | card->dai_link = priv->dai_link; |
| 262 | card->num_links = num; |
| 263 | card->codec_conf = &priv->codec_conf; |
| 264 | card->num_configs = 1; |
Kuninori Morimoto | 15a190ff | 2016-10-28 03:37:26 +0000 | [diff] [blame] | 265 | |
Kuninori Morimoto | 0d6b352 | 2017-06-07 00:37:30 +0000 | [diff] [blame] | 266 | ret = asoc_simple_card_parse_of(priv); |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 267 | if (ret < 0) { |
| 268 | if (ret != -EPROBE_DEFER) |
| 269 | dev_err(dev, "parse error %d\n", ret); |
| 270 | goto err; |
| 271 | } |
| 272 | |
Kuninori Morimoto | d27f3b4 | 2017-03-15 04:44:16 +0000 | [diff] [blame] | 273 | snd_soc_card_set_drvdata(card, priv); |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 274 | |
Kuninori Morimoto | d27f3b4 | 2017-03-15 04:44:16 +0000 | [diff] [blame] | 275 | ret = devm_snd_soc_register_card(dev, card); |
Kuninori Morimoto | c73df77 | 2017-05-19 00:57:44 +0000 | [diff] [blame] | 276 | if (ret < 0) |
| 277 | goto err; |
| 278 | |
| 279 | return 0; |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 280 | err: |
Kuninori Morimoto | d27f3b4 | 2017-03-15 04:44:16 +0000 | [diff] [blame] | 281 | asoc_simple_card_clean_reference(card); |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 282 | |
| 283 | return ret; |
| 284 | } |
| 285 | |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 286 | static int asoc_simple_card_remove(struct platform_device *pdev) |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 287 | { |
| 288 | struct snd_soc_card *card = platform_get_drvdata(pdev); |
| 289 | |
Kuninori Morimoto | 239486b | 2016-08-10 02:22:01 +0000 | [diff] [blame] | 290 | return asoc_simple_card_clean_reference(card); |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 291 | } |
| 292 | |
Kuninori Morimoto | f4d70709 | 2016-08-25 01:58:31 +0000 | [diff] [blame] | 293 | static const struct of_device_id asoc_simple_of_match[] = { |
| 294 | { .compatible = "renesas,rsrc-card", }, |
| 295 | { .compatible = "simple-scu-audio-card", }, |
| 296 | {}, |
| 297 | }; |
| 298 | MODULE_DEVICE_TABLE(of, asoc_simple_of_match); |
| 299 | |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 300 | static struct platform_driver asoc_simple_card = { |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 301 | .driver = { |
Kuninori Morimoto | 64df0e6 | 2016-08-23 01:34:43 +0000 | [diff] [blame] | 302 | .name = "simple-scu-audio-card", |
Kuninori Morimoto | b4e0180 | 2017-08-22 04:56:06 +0000 | [diff] [blame] | 303 | .pm = &snd_soc_pm_ops, |
Kuninori Morimoto | f4d70709 | 2016-08-25 01:58:31 +0000 | [diff] [blame] | 304 | .of_match_table = asoc_simple_of_match, |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 305 | }, |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 306 | .probe = asoc_simple_card_probe, |
| 307 | .remove = asoc_simple_card_remove, |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 308 | }; |
| 309 | |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 310 | module_platform_driver(asoc_simple_card); |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 311 | |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 312 | MODULE_ALIAS("platform:asoc-simple-scu-card"); |
Kuninori Morimoto | 93bc047 | 2016-08-25 01:56:38 +0000 | [diff] [blame] | 313 | MODULE_LICENSE("GPL v2"); |
Kuninori Morimoto | 53e682b | 2016-08-23 01:34:17 +0000 | [diff] [blame] | 314 | MODULE_DESCRIPTION("ASoC Simple SCU Sound Card"); |
Kuninori Morimoto | 415f1cb | 2015-03-26 04:01:27 +0000 | [diff] [blame] | 315 | MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>"); |