• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
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/device.h>
13 #include <linux/gpio.h>
14 #include <linux/module.h>
15 #include <linux/of.h>
16 #include <linux/of_gpio.h>
17 #include <linux/platform_device.h>
18 #include <linux/string.h>
19 #include <sound/jack.h>
20 #include <sound/simple_card.h>
21 #include <sound/soc-dai.h>
22 #include <sound/soc.h>
23 
24 struct simple_card_data {
25 	struct snd_soc_card snd_card;
26 	struct simple_dai_props {
27 		struct asoc_simple_dai cpu_dai;
28 		struct asoc_simple_dai codec_dai;
29 		unsigned int mclk_fs;
30 	} *dai_props;
31 	unsigned int mclk_fs;
32 	int gpio_hp_det;
33 	int gpio_hp_det_invert;
34 	int gpio_mic_det;
35 	int gpio_mic_det_invert;
36 	struct snd_soc_dai_link dai_link[];	/* dynamically allocated */
37 };
38 
39 #define simple_priv_to_dev(priv) ((priv)->snd_card.dev)
40 #define simple_priv_to_link(priv, i) ((priv)->snd_card.dai_link + i)
41 #define simple_priv_to_props(priv, i) ((priv)->dai_props + i)
42 
asoc_simple_card_startup(struct snd_pcm_substream * substream)43 static int asoc_simple_card_startup(struct snd_pcm_substream *substream)
44 {
45 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
46 	struct simple_card_data *priv =	snd_soc_card_get_drvdata(rtd->card);
47 	struct simple_dai_props *dai_props =
48 		&priv->dai_props[rtd - rtd->card->rtd];
49 	int ret;
50 
51 	ret = clk_prepare_enable(dai_props->cpu_dai.clk);
52 	if (ret)
53 		return ret;
54 
55 	ret = clk_prepare_enable(dai_props->codec_dai.clk);
56 	if (ret)
57 		clk_disable_unprepare(dai_props->cpu_dai.clk);
58 
59 	return ret;
60 }
61 
asoc_simple_card_shutdown(struct snd_pcm_substream * substream)62 static void asoc_simple_card_shutdown(struct snd_pcm_substream *substream)
63 {
64 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
65 	struct simple_card_data *priv =	snd_soc_card_get_drvdata(rtd->card);
66 	struct simple_dai_props *dai_props =
67 		&priv->dai_props[rtd - rtd->card->rtd];
68 
69 	clk_disable_unprepare(dai_props->cpu_dai.clk);
70 
71 	clk_disable_unprepare(dai_props->codec_dai.clk);
72 }
73 
asoc_simple_card_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params)74 static int asoc_simple_card_hw_params(struct snd_pcm_substream *substream,
75 				      struct snd_pcm_hw_params *params)
76 {
77 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
78 	struct snd_soc_dai *codec_dai = rtd->codec_dai;
79 	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
80 	struct simple_card_data *priv = snd_soc_card_get_drvdata(rtd->card);
81 	struct simple_dai_props *dai_props =
82 		&priv->dai_props[rtd - rtd->card->rtd];
83 	unsigned int mclk, mclk_fs = 0;
84 	int ret = 0;
85 
86 	if (priv->mclk_fs)
87 		mclk_fs = priv->mclk_fs;
88 	else if (dai_props->mclk_fs)
89 		mclk_fs = dai_props->mclk_fs;
90 
91 	if (mclk_fs) {
92 		mclk = params_rate(params) * mclk_fs;
93 		ret = snd_soc_dai_set_sysclk(codec_dai, 0, mclk,
94 					     SND_SOC_CLOCK_IN);
95 		if (ret && ret != -ENOTSUPP)
96 			goto err;
97 
98 		ret = snd_soc_dai_set_sysclk(cpu_dai, 0, mclk,
99 					     SND_SOC_CLOCK_OUT);
100 		if (ret && ret != -ENOTSUPP)
101 			goto err;
102 	}
103 	return 0;
104 err:
105 	return ret;
106 }
107 
108 static struct snd_soc_ops asoc_simple_card_ops = {
109 	.startup = asoc_simple_card_startup,
110 	.shutdown = asoc_simple_card_shutdown,
111 	.hw_params = asoc_simple_card_hw_params,
112 };
113 
114 static struct snd_soc_jack simple_card_hp_jack;
115 static struct snd_soc_jack_pin simple_card_hp_jack_pins[] = {
116 	{
117 		.pin = "Headphones",
118 		.mask = SND_JACK_HEADPHONE,
119 	},
120 };
121 static struct snd_soc_jack_gpio simple_card_hp_jack_gpio = {
122 	.name = "Headphone detection",
123 	.report = SND_JACK_HEADPHONE,
124 	.debounce_time = 150,
125 };
126 
127 static struct snd_soc_jack simple_card_mic_jack;
128 static struct snd_soc_jack_pin simple_card_mic_jack_pins[] = {
129 	{
130 		.pin = "Mic Jack",
131 		.mask = SND_JACK_MICROPHONE,
132 	},
133 };
134 static struct snd_soc_jack_gpio simple_card_mic_jack_gpio = {
135 	.name = "Mic detection",
136 	.report = SND_JACK_MICROPHONE,
137 	.debounce_time = 150,
138 };
139 
__asoc_simple_card_dai_init(struct snd_soc_dai * dai,struct asoc_simple_dai * set)140 static int __asoc_simple_card_dai_init(struct snd_soc_dai *dai,
141 				       struct asoc_simple_dai *set)
142 {
143 	int ret;
144 
145 	if (set->sysclk) {
146 		ret = snd_soc_dai_set_sysclk(dai, 0, set->sysclk, 0);
147 		if (ret && ret != -ENOTSUPP) {
148 			dev_err(dai->dev, "simple-card: set_sysclk error\n");
149 			goto err;
150 		}
151 	}
152 
153 	if (set->slots) {
154 		ret = snd_soc_dai_set_tdm_slot(dai,
155 					       set->tx_slot_mask,
156 					       set->rx_slot_mask,
157 						set->slots,
158 						set->slot_width);
159 		if (ret && ret != -ENOTSUPP) {
160 			dev_err(dai->dev, "simple-card: set_tdm_slot error\n");
161 			goto err;
162 		}
163 	}
164 
165 	ret = 0;
166 
167 err:
168 	return ret;
169 }
170 
asoc_simple_card_dai_init(struct snd_soc_pcm_runtime * rtd)171 static int asoc_simple_card_dai_init(struct snd_soc_pcm_runtime *rtd)
172 {
173 	struct simple_card_data *priv =	snd_soc_card_get_drvdata(rtd->card);
174 	struct snd_soc_dai *codec = rtd->codec_dai;
175 	struct snd_soc_dai *cpu = rtd->cpu_dai;
176 	struct simple_dai_props *dai_props;
177 	int num, ret;
178 
179 	num = rtd - rtd->card->rtd;
180 	dai_props = &priv->dai_props[num];
181 	ret = __asoc_simple_card_dai_init(codec, &dai_props->codec_dai);
182 	if (ret < 0)
183 		return ret;
184 
185 	ret = __asoc_simple_card_dai_init(cpu, &dai_props->cpu_dai);
186 	if (ret < 0)
187 		return ret;
188 
189 	if (gpio_is_valid(priv->gpio_hp_det)) {
190 		snd_soc_card_jack_new(rtd->card, "Headphones",
191 				      SND_JACK_HEADPHONE,
192 				      &simple_card_hp_jack,
193 				      simple_card_hp_jack_pins,
194 				      ARRAY_SIZE(simple_card_hp_jack_pins));
195 
196 		simple_card_hp_jack_gpio.gpio = priv->gpio_hp_det;
197 		simple_card_hp_jack_gpio.invert = priv->gpio_hp_det_invert;
198 		snd_soc_jack_add_gpios(&simple_card_hp_jack, 1,
199 				       &simple_card_hp_jack_gpio);
200 	}
201 
202 	if (gpio_is_valid(priv->gpio_mic_det)) {
203 		snd_soc_card_jack_new(rtd->card, "Mic Jack",
204 				      SND_JACK_MICROPHONE,
205 				      &simple_card_mic_jack,
206 				      simple_card_mic_jack_pins,
207 				      ARRAY_SIZE(simple_card_mic_jack_pins));
208 		simple_card_mic_jack_gpio.gpio = priv->gpio_mic_det;
209 		simple_card_mic_jack_gpio.invert = priv->gpio_mic_det_invert;
210 		snd_soc_jack_add_gpios(&simple_card_mic_jack, 1,
211 				       &simple_card_mic_jack_gpio);
212 	}
213 	return 0;
214 }
215 
216 static int
asoc_simple_card_sub_parse_of(struct device_node * np,struct asoc_simple_dai * dai,struct device_node ** p_node,const char ** name,int * args_count)217 asoc_simple_card_sub_parse_of(struct device_node *np,
218 			      struct asoc_simple_dai *dai,
219 			      struct device_node **p_node,
220 			      const char **name,
221 			      int *args_count)
222 {
223 	struct of_phandle_args args;
224 	struct clk *clk;
225 	u32 val;
226 	int ret;
227 
228 	/*
229 	 * Get node via "sound-dai = <&phandle port>"
230 	 * it will be used as xxx_of_node on soc_bind_dai_link()
231 	 */
232 	ret = of_parse_phandle_with_args(np, "sound-dai",
233 					 "#sound-dai-cells", 0, &args);
234 	if (ret)
235 		return ret;
236 
237 	*p_node = args.np;
238 
239 	if (args_count)
240 		*args_count = args.args_count;
241 
242 	/* Get dai->name */
243 	ret = snd_soc_of_get_dai_name(np, name);
244 	if (ret < 0)
245 		return ret;
246 
247 	/* Parse TDM slot */
248 	ret = snd_soc_of_parse_tdm_slot(np, &dai->tx_slot_mask,
249 					&dai->rx_slot_mask,
250 					&dai->slots, &dai->slot_width);
251 	if (ret)
252 		return ret;
253 
254 	/*
255 	 * Parse dai->sysclk come from "clocks = <&xxx>"
256 	 * (if system has common clock)
257 	 *  or "system-clock-frequency = <xxx>"
258 	 *  or device's module clock.
259 	 */
260 	if (of_property_read_bool(np, "clocks")) {
261 		clk = of_clk_get(np, 0);
262 		if (IS_ERR(clk)) {
263 			ret = PTR_ERR(clk);
264 			return ret;
265 		}
266 
267 		dai->sysclk = clk_get_rate(clk);
268 		dai->clk = clk;
269 	} else if (!of_property_read_u32(np, "system-clock-frequency", &val)) {
270 		dai->sysclk = val;
271 	} else {
272 		clk = of_clk_get(args.np, 0);
273 		if (!IS_ERR(clk))
274 			dai->sysclk = clk_get_rate(clk);
275 	}
276 
277 	return 0;
278 }
279 
asoc_simple_card_parse_daifmt(struct device_node * node,struct simple_card_data * priv,struct device_node * codec,char * prefix,int idx)280 static int asoc_simple_card_parse_daifmt(struct device_node *node,
281 					 struct simple_card_data *priv,
282 					 struct device_node *codec,
283 					 char *prefix, int idx)
284 {
285 	struct snd_soc_dai_link *dai_link = simple_priv_to_link(priv, idx);
286 	struct device *dev = simple_priv_to_dev(priv);
287 	struct device_node *bitclkmaster = NULL;
288 	struct device_node *framemaster = NULL;
289 	unsigned int daifmt;
290 
291 	daifmt = snd_soc_of_parse_daifmt(node, prefix,
292 					 &bitclkmaster, &framemaster);
293 	daifmt &= ~SND_SOC_DAIFMT_MASTER_MASK;
294 
295 	if (strlen(prefix) && !bitclkmaster && !framemaster) {
296 		/*
297 		 * No dai-link level and master setting was not found from
298 		 * sound node level, revert back to legacy DT parsing and
299 		 * take the settings from codec node.
300 		 */
301 		dev_dbg(dev, "Revert to legacy daifmt parsing\n");
302 
303 		daifmt = snd_soc_of_parse_daifmt(codec, NULL, NULL, NULL) |
304 			(daifmt & ~SND_SOC_DAIFMT_CLOCK_MASK);
305 	} else {
306 		if (codec == bitclkmaster)
307 			daifmt |= (codec == framemaster) ?
308 				SND_SOC_DAIFMT_CBM_CFM : SND_SOC_DAIFMT_CBM_CFS;
309 		else
310 			daifmt |= (codec == framemaster) ?
311 				SND_SOC_DAIFMT_CBS_CFM : SND_SOC_DAIFMT_CBS_CFS;
312 	}
313 
314 	dai_link->dai_fmt = daifmt;
315 
316 	of_node_put(bitclkmaster);
317 	of_node_put(framemaster);
318 
319 	return 0;
320 }
321 
asoc_simple_card_dai_link_of(struct device_node * node,struct simple_card_data * priv,int idx,bool is_top_level_node)322 static int asoc_simple_card_dai_link_of(struct device_node *node,
323 					struct simple_card_data *priv,
324 					int idx,
325 					bool is_top_level_node)
326 {
327 	struct device *dev = simple_priv_to_dev(priv);
328 	struct snd_soc_dai_link *dai_link = simple_priv_to_link(priv, idx);
329 	struct simple_dai_props *dai_props = simple_priv_to_props(priv, idx);
330 	struct device_node *cpu = NULL;
331 	struct device_node *plat = NULL;
332 	struct device_node *codec = NULL;
333 	char *name;
334 	char prop[128];
335 	char *prefix = "";
336 	int ret, cpu_args;
337 	u32 val;
338 
339 	/* For single DAI link & old style of DT node */
340 	if (is_top_level_node)
341 		prefix = "simple-audio-card,";
342 
343 	snprintf(prop, sizeof(prop), "%scpu", prefix);
344 	cpu = of_get_child_by_name(node, prop);
345 
346 	if (!cpu) {
347 		ret = -EINVAL;
348 		dev_err(dev, "%s: Can't find %s DT node\n", __func__, prop);
349 		goto dai_link_of_err;
350 	}
351 
352 	snprintf(prop, sizeof(prop), "%splat", prefix);
353 	plat = of_get_child_by_name(node, prop);
354 
355 	snprintf(prop, sizeof(prop), "%scodec", prefix);
356 	codec = of_get_child_by_name(node, prop);
357 
358 	if (!codec) {
359 		ret = -EINVAL;
360 		dev_err(dev, "%s: Can't find %s DT node\n", __func__, prop);
361 		goto dai_link_of_err;
362 	}
363 
364 	ret = asoc_simple_card_parse_daifmt(node, priv,
365 					    codec, prefix, idx);
366 	if (ret < 0)
367 		goto dai_link_of_err;
368 
369 	if (!of_property_read_u32(node, "mclk-fs", &val))
370 		dai_props->mclk_fs = val;
371 
372 	ret = asoc_simple_card_sub_parse_of(cpu, &dai_props->cpu_dai,
373 					    &dai_link->cpu_of_node,
374 					    &dai_link->cpu_dai_name,
375 					    &cpu_args);
376 	if (ret < 0)
377 		goto dai_link_of_err;
378 
379 	ret = asoc_simple_card_sub_parse_of(codec, &dai_props->codec_dai,
380 					    &dai_link->codec_of_node,
381 					    &dai_link->codec_dai_name, NULL);
382 	if (ret < 0)
383 		goto dai_link_of_err;
384 
385 	if (!dai_link->cpu_dai_name || !dai_link->codec_dai_name) {
386 		ret = -EINVAL;
387 		goto dai_link_of_err;
388 	}
389 
390 	if (plat) {
391 		struct of_phandle_args args;
392 
393 		ret = of_parse_phandle_with_args(plat, "sound-dai",
394 						 "#sound-dai-cells", 0, &args);
395 		dai_link->platform_of_node = args.np;
396 	} else {
397 		/* Assumes platform == cpu */
398 		dai_link->platform_of_node = dai_link->cpu_of_node;
399 	}
400 
401 	/* DAI link name is created from CPU/CODEC dai name */
402 	name = devm_kzalloc(dev,
403 			    strlen(dai_link->cpu_dai_name)   +
404 			    strlen(dai_link->codec_dai_name) + 2,
405 			    GFP_KERNEL);
406 	if (!name) {
407 		ret = -ENOMEM;
408 		goto dai_link_of_err;
409 	}
410 
411 	sprintf(name, "%s-%s", dai_link->cpu_dai_name,
412 				dai_link->codec_dai_name);
413 	dai_link->name = dai_link->stream_name = name;
414 	dai_link->ops = &asoc_simple_card_ops;
415 	dai_link->init = asoc_simple_card_dai_init;
416 
417 	dev_dbg(dev, "\tname : %s\n", dai_link->stream_name);
418 	dev_dbg(dev, "\tformat : %04x\n", dai_link->dai_fmt);
419 	dev_dbg(dev, "\tcpu : %s / %d\n",
420 		dai_link->cpu_dai_name,
421 		dai_props->cpu_dai.sysclk);
422 	dev_dbg(dev, "\tcodec : %s / %d\n",
423 		dai_link->codec_dai_name,
424 		dai_props->codec_dai.sysclk);
425 
426 	/*
427 	 * In soc_bind_dai_link() will check cpu name after
428 	 * of_node matching if dai_link has cpu_dai_name.
429 	 * but, it will never match if name was created by
430 	 * fmt_single_name() remove cpu_dai_name if cpu_args
431 	 * was 0. See:
432 	 *	fmt_single_name()
433 	 *	fmt_multiple_name()
434 	 */
435 	if (!cpu_args)
436 		dai_link->cpu_dai_name = NULL;
437 
438 dai_link_of_err:
439 	of_node_put(cpu);
440 	of_node_put(codec);
441 
442 	return ret;
443 }
444 
asoc_simple_card_parse_of(struct device_node * node,struct simple_card_data * priv)445 static int asoc_simple_card_parse_of(struct device_node *node,
446 				     struct simple_card_data *priv)
447 {
448 	struct device *dev = simple_priv_to_dev(priv);
449 	enum of_gpio_flags flags;
450 	u32 val;
451 	int ret;
452 
453 	if (!node)
454 		return -EINVAL;
455 
456 	/* Parse the card name from DT */
457 	snd_soc_of_parse_card_name(&priv->snd_card, "simple-audio-card,name");
458 
459 	/* The off-codec widgets */
460 	if (of_property_read_bool(node, "simple-audio-card,widgets")) {
461 		ret = snd_soc_of_parse_audio_simple_widgets(&priv->snd_card,
462 					"simple-audio-card,widgets");
463 		if (ret)
464 			return ret;
465 	}
466 
467 	/* DAPM routes */
468 	if (of_property_read_bool(node, "simple-audio-card,routing")) {
469 		ret = snd_soc_of_parse_audio_routing(&priv->snd_card,
470 					"simple-audio-card,routing");
471 		if (ret)
472 			return ret;
473 	}
474 
475 	/* Factor to mclk, used in hw_params() */
476 	ret = of_property_read_u32(node, "simple-audio-card,mclk-fs", &val);
477 	if (ret == 0)
478 		priv->mclk_fs = val;
479 
480 	dev_dbg(dev, "New simple-card: %s\n", priv->snd_card.name ?
481 		priv->snd_card.name : "");
482 
483 	/* Single/Muti DAI link(s) & New style of DT node */
484 	if (of_get_child_by_name(node, "simple-audio-card,dai-link")) {
485 		struct device_node *np = NULL;
486 		int i = 0;
487 
488 		for_each_child_of_node(node, np) {
489 			dev_dbg(dev, "\tlink %d:\n", i);
490 			ret = asoc_simple_card_dai_link_of(np, priv,
491 							   i, false);
492 			if (ret < 0) {
493 				of_node_put(np);
494 				return ret;
495 			}
496 			i++;
497 		}
498 	} else {
499 		/* For single DAI link & old style of DT node */
500 		ret = asoc_simple_card_dai_link_of(node, priv, 0, true);
501 		if (ret < 0)
502 			return ret;
503 	}
504 
505 	priv->gpio_hp_det = of_get_named_gpio_flags(node,
506 				"simple-audio-card,hp-det-gpio", 0, &flags);
507 	priv->gpio_hp_det_invert = !!(flags & OF_GPIO_ACTIVE_LOW);
508 	if (priv->gpio_hp_det == -EPROBE_DEFER)
509 		return -EPROBE_DEFER;
510 
511 	priv->gpio_mic_det = of_get_named_gpio_flags(node,
512 				"simple-audio-card,mic-det-gpio", 0, &flags);
513 	priv->gpio_mic_det_invert = !!(flags & OF_GPIO_ACTIVE_LOW);
514 	if (priv->gpio_mic_det == -EPROBE_DEFER)
515 		return -EPROBE_DEFER;
516 
517 	if (!priv->snd_card.name)
518 		priv->snd_card.name = priv->snd_card.dai_link->name;
519 
520 	return 0;
521 }
522 
523 /* Decrease the reference count of the device nodes */
asoc_simple_card_unref(struct snd_soc_card * card)524 static int asoc_simple_card_unref(struct snd_soc_card *card)
525 {
526 	struct snd_soc_dai_link *dai_link;
527 	int num_links;
528 
529 	for (num_links = 0, dai_link = card->dai_link;
530 	     num_links < card->num_links;
531 	     num_links++, dai_link++) {
532 		of_node_put(dai_link->cpu_of_node);
533 		of_node_put(dai_link->codec_of_node);
534 	}
535 	return 0;
536 }
537 
asoc_simple_card_probe(struct platform_device * pdev)538 static int asoc_simple_card_probe(struct platform_device *pdev)
539 {
540 	struct simple_card_data *priv;
541 	struct snd_soc_dai_link *dai_link;
542 	struct device_node *np = pdev->dev.of_node;
543 	struct device *dev = &pdev->dev;
544 	int num_links, ret;
545 
546 	/* Get the number of DAI links */
547 	if (np && of_get_child_by_name(np, "simple-audio-card,dai-link"))
548 		num_links = of_get_child_count(np);
549 	else
550 		num_links = 1;
551 
552 	/* Allocate the private data and the DAI link array */
553 	priv = devm_kzalloc(dev,
554 			sizeof(*priv) + sizeof(*dai_link) * num_links,
555 			GFP_KERNEL);
556 	if (!priv)
557 		return -ENOMEM;
558 
559 	/* Init snd_soc_card */
560 	priv->snd_card.owner = THIS_MODULE;
561 	priv->snd_card.dev = dev;
562 	dai_link = priv->dai_link;
563 	priv->snd_card.dai_link = dai_link;
564 	priv->snd_card.num_links = num_links;
565 
566 	priv->gpio_hp_det = -ENOENT;
567 	priv->gpio_mic_det = -ENOENT;
568 
569 	/* Get room for the other properties */
570 	priv->dai_props = devm_kzalloc(dev,
571 			sizeof(*priv->dai_props) * num_links,
572 			GFP_KERNEL);
573 	if (!priv->dai_props)
574 		return -ENOMEM;
575 
576 	if (np && of_device_is_available(np)) {
577 
578 		ret = asoc_simple_card_parse_of(np, priv);
579 		if (ret < 0) {
580 			if (ret != -EPROBE_DEFER)
581 				dev_err(dev, "parse error %d\n", ret);
582 			goto err;
583 		}
584 
585 	} else {
586 		struct asoc_simple_card_info *cinfo;
587 
588 		cinfo = dev->platform_data;
589 		if (!cinfo) {
590 			dev_err(dev, "no info for asoc-simple-card\n");
591 			return -EINVAL;
592 		}
593 
594 		if (!cinfo->name ||
595 		    !cinfo->codec_dai.name ||
596 		    !cinfo->codec ||
597 		    !cinfo->platform ||
598 		    !cinfo->cpu_dai.name) {
599 			dev_err(dev, "insufficient asoc_simple_card_info settings\n");
600 			return -EINVAL;
601 		}
602 
603 		priv->snd_card.name	= (cinfo->card) ? cinfo->card : cinfo->name;
604 		dai_link->name		= cinfo->name;
605 		dai_link->stream_name	= cinfo->name;
606 		dai_link->platform_name	= cinfo->platform;
607 		dai_link->codec_name	= cinfo->codec;
608 		dai_link->cpu_dai_name	= cinfo->cpu_dai.name;
609 		dai_link->codec_dai_name = cinfo->codec_dai.name;
610 		dai_link->dai_fmt	= cinfo->daifmt;
611 		dai_link->init		= asoc_simple_card_dai_init;
612 		memcpy(&priv->dai_props->cpu_dai, &cinfo->cpu_dai,
613 					sizeof(priv->dai_props->cpu_dai));
614 		memcpy(&priv->dai_props->codec_dai, &cinfo->codec_dai,
615 					sizeof(priv->dai_props->codec_dai));
616 
617 	}
618 
619 	snd_soc_card_set_drvdata(&priv->snd_card, priv);
620 
621 	ret = devm_snd_soc_register_card(&pdev->dev, &priv->snd_card);
622 	if (ret >= 0)
623 		return ret;
624 
625 err:
626 	asoc_simple_card_unref(&priv->snd_card);
627 	return ret;
628 }
629 
asoc_simple_card_remove(struct platform_device * pdev)630 static int asoc_simple_card_remove(struct platform_device *pdev)
631 {
632 	struct snd_soc_card *card = platform_get_drvdata(pdev);
633 	struct simple_card_data *priv = snd_soc_card_get_drvdata(card);
634 
635 	if (gpio_is_valid(priv->gpio_hp_det))
636 		snd_soc_jack_free_gpios(&simple_card_hp_jack, 1,
637 					&simple_card_hp_jack_gpio);
638 	if (gpio_is_valid(priv->gpio_mic_det))
639 		snd_soc_jack_free_gpios(&simple_card_mic_jack, 1,
640 					&simple_card_mic_jack_gpio);
641 
642 	return asoc_simple_card_unref(card);
643 }
644 
645 static const struct of_device_id asoc_simple_of_match[] = {
646 	{ .compatible = "simple-audio-card", },
647 	{},
648 };
649 MODULE_DEVICE_TABLE(of, asoc_simple_of_match);
650 
651 static struct platform_driver asoc_simple_card = {
652 	.driver = {
653 		.name = "asoc-simple-card",
654 		.of_match_table = asoc_simple_of_match,
655 	},
656 	.probe = asoc_simple_card_probe,
657 	.remove = asoc_simple_card_remove,
658 };
659 
660 module_platform_driver(asoc_simple_card);
661 
662 MODULE_ALIAS("platform:asoc-simple-card");
663 MODULE_LICENSE("GPL");
664 MODULE_DESCRIPTION("ASoC Simple Sound Card");
665 MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");
666