1// SPDX-License-Identifier: GPL-2.0
2//
3// ASoC Audio Graph Card2 support
4//
5// Copyright (C) 2020 Renesas Electronics Corp.
6// Copyright (C) 2020 Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
7//
8// based on ${LINUX}/sound/soc/generic/audio-graph-card.c
9#include <linux/clk.h>
10#include <linux/device.h>
11#include <linux/gpio.h>
12#include <linux/gpio/consumer.h>
13#include <linux/module.h>
14#include <linux/of.h>
15#include <linux/of_device.h>
16#include <linux/of_gpio.h>
17#include <linux/of_graph.h>
18#include <linux/platform_device.h>
19#include <linux/string.h>
20#include <sound/graph_card.h>
21
22/************************************
23	daifmt
24 ************************************
25	ports {
26		format = "left_j";
27		port@0 {
28			bitclock-master;
29			sample0: endpoint@0 {
30				frame-master;
31			};
32			sample1: endpoint@1 {
33				format = "i2s";
34			};
35		};
36		...
37	};
38
39 You can set daifmt at ports/port/endpoint.
40 It uses *latest* format, and *share* master settings.
41 In above case,
42	sample0: left_j, bitclock-master, frame-master
43	sample1: i2s,    bitclock-master
44
45 If there was no settings, *Codec* will be
46 bitclock/frame provider as default.
47 see
48	graph_parse_daifmt().
49
50 "format" property is no longer needed on DT if both CPU/Codec drivers are
51 supporting snd_soc_dai_ops :: .auto_selectable_formats.
52 see
53	snd_soc_runtime_get_dai_fmt()
54
55	sample driver
56		linux/sound/soc/sh/rcar/core.c
57		linux/sound/soc/codecs/ak4613.c
58		linux/sound/soc/codecs/pcm3168a.c
59		linux/sound/soc/soc-utils.c
60		linux/sound/soc/generic/test-component.c
61
62 ************************************
63	Normal Audio-Graph
64 ************************************
65
66 CPU <---> Codec
67
68 sound {
69	compatible = "audio-graph-card2";
70	links = <&cpu>;
71 };
72
73 CPU {
74	cpu: port {
75		bitclock-master;
76		frame-master;
77		cpu_ep: endpoint { remote-endpoint = <&codec_ep>; }; };
78 };
79
80 Codec {
81	port {	codec_ep: endpoint { remote-endpoint = <&cpu_ep>; }; };
82 };
83
84 ************************************
85	Multi-CPU/Codec
86 ************************************
87
88It has connection part (= X) and list part (= y).
89links indicates connection part of CPU side (= A).
90
91	    +-+   (A)	     +-+
92 CPU1 --(y) | | <-(X)--(X)-> | | (y)-- Codec1
93 CPU2 --(y) | |		     | | (y)-- Codec2
94	    +-+		     +-+
95
96	sound {
97		compatible = "audio-graph-card2";
98
99(A)		links = <&mcpu>;
100
101		multi {
102			ports@0 {
103(X) (A)			mcpu:	port@0 { mcpu0_ep: endpoint { remote-endpoint = <&mcodec0_ep>; }; };
104(y)				port@1 { mcpu1_ep: endpoint { remote-endpoint = <&cpu1_ep>; }; };
105(y)				port@2 { mcpu2_ep: endpoint { remote-endpoint = <&cpu2_ep>; }; };
106			};
107			ports@1 {
108(X)				port@0 { mcodec0_ep: endpoint { remote-endpoint = <&mcpu0_ep>; }; };
109(y)				port@1 { mcodec1_ep: endpoint { remote-endpoint = <&codec1_ep>; }; };
110(y)				port@2 { mcodec2_ep: endpoint { remote-endpoint = <&codec2_ep>; }; };
111			};
112		};
113	};
114
115 CPU {
116	ports {
117		bitclock-master;
118		frame-master;
119		port@0 { cpu1_ep: endpoint { remote-endpoint = <&mcpu1_ep>; }; };
120		port@1 { cpu2_ep: endpoint { remote-endpoint = <&mcpu2_ep>; }; };
121	};
122 };
123
124 Codec {
125	ports {
126		port@0 { codec1_ep: endpoint { remote-endpoint = <&mcodec1_ep>; }; };
127		port@1 { codec2_ep: endpoint { remote-endpoint = <&mcodec2_ep>; }; };
128	};
129 };
130
131 ************************************
132	DPCM
133 ************************************
134
135		DSP
136	   ************
137 PCM0 <--> * fe0  be0 * <--> DAI0: Codec Headset
138 PCM1 <--> * fe1  be1 * <--> DAI1: Codec Speakers
139 PCM2 <--> * fe2  be2 * <--> DAI2: MODEM
140 PCM3 <--> * fe3  be3 * <--> DAI3: BT
141	   *	  be4 * <--> DAI4: DMIC
142	   *	  be5 * <--> DAI5: FM
143	   ************
144
145 sound {
146	compatible = "audio-graph-card2";
147
148	// indicate routing
149	routing = "xxx Playback", "xxx Playback",
150		  "xxx Playback", "xxx Playback",
151		  "xxx Playback", "xxx Playback";
152
153	// indicate all Front-End, Back-End
154	links = <&fe0, &fe1, ...,
155		 &be0, &be1, ...>;
156
157	dpcm {
158		// Front-End
159		ports@0 {
160			fe0: port@0 { fe0_ep: endpoint { remote-endpoint = <&pcm0_ep>; }; };
161			fe1: port@1 { fe1_ep: endpoint { remote-endpoint = <&pcm1_ep>; }; };
162			...
163		};
164		// Back-End
165		ports@1 {
166			be0: port@0 { be0_ep: endpoint { remote-endpoint = <&dai0_ep>; }; };
167			be1: port@1 { be1_ep: endpoint { remote-endpoint = <&dai1_ep>; }; };
168			...
169		};
170	};
171 };
172
173 CPU {
174	ports {
175		bitclock-master;
176		frame-master;
177		port@0 { pcm0_ep: endpoint { remote-endpoint = <&fe0_ep>; }; };
178		port@1 { pcm1_ep: endpoint { remote-endpoint = <&fe1_ep>; }; };
179		...
180	};
181 };
182
183 Codec {
184	ports {
185		port@0 { dai0_ep: endpoint { remote-endpoint = <&be0_ep>; }; };
186		port@1 { dai1_ep: endpoint { remote-endpoint = <&be1_ep>; }; };
187		...
188	};
189 };
190
191 ************************************
192	Codec to Codec
193 ************************************
194
195 +--+
196 |  |<-- Codec0 <- IN
197 |  |--> Codec1 -> OUT
198 +--+
199
200 sound {
201	compatible = "audio-graph-card2";
202
203	routing = "OUT" ,"DAI1 Playback",
204		  "DAI0 Capture", "IN";
205
206	links = <&c2c>;
207
208	codec2codec {
209		ports {
210			rate = <48000>;
211		c2c:	port@0 { c2cf_ep: endpoint { remote-endpoint = <&codec0_ep>; }; };
212			port@1 { c2cb_ep: endpoint { remote-endpoint = <&codec1_ep>; }; };
213	};
214 };
215
216 Codec {
217	ports {
218		port@0 {
219			bitclock-master;
220			frame-master;
221			 codec0_ep: endpoint { remote-endpoint = <&c2cf_ep>; }; };
222		port@1 { codec1_ep: endpoint { remote-endpoint = <&c2cb_ep>; }; };
223	};
224 };
225
226*/
227
228enum graph_type {
229	GRAPH_NORMAL,
230	GRAPH_DPCM,
231	GRAPH_C2C,
232
233	GRAPH_MULTI,	/* don't use ! Use this only in __graph_get_type() */
234};
235
236#define GRAPH_NODENAME_MULTI	"multi"
237#define GRAPH_NODENAME_DPCM	"dpcm"
238#define GRAPH_NODENAME_C2C	"codec2codec"
239
240#define port_to_endpoint(port) of_get_child_by_name(port, "endpoint")
241
242static enum graph_type __graph_get_type(struct device_node *lnk)
243{
244	struct device_node *np, *parent_np;
245	enum graph_type ret;
246
247	/*
248	 * target {
249	 *	ports {
250	 * =>		lnk:	port@0 { ... };
251	 *			port@1 { ... };
252	 *	};
253	 * };
254	 */
255	np = of_get_parent(lnk);
256	if (of_node_name_eq(np, "ports")) {
257		parent_np = of_get_parent(np);
258		of_node_put(np);
259		np = parent_np;
260	}
261
262	if (of_node_name_eq(np, GRAPH_NODENAME_MULTI)) {
263		ret = GRAPH_MULTI;
264		goto out_put;
265	}
266
267	if (of_node_name_eq(np, GRAPH_NODENAME_DPCM)) {
268		ret = GRAPH_DPCM;
269		goto out_put;
270	}
271
272	if (of_node_name_eq(np, GRAPH_NODENAME_C2C)) {
273		ret = GRAPH_C2C;
274		goto out_put;
275	}
276
277	ret = GRAPH_NORMAL;
278
279out_put:
280	of_node_put(np);
281	return ret;
282
283}
284
285static enum graph_type graph_get_type(struct asoc_simple_priv *priv,
286				      struct device_node *lnk)
287{
288	enum graph_type type = __graph_get_type(lnk);
289
290	/* GRAPH_MULTI here means GRAPH_NORMAL */
291	if (type == GRAPH_MULTI)
292		type = GRAPH_NORMAL;
293
294#ifdef DEBUG
295	{
296		struct device *dev = simple_priv_to_dev(priv);
297		const char *str = "Normal";
298
299		switch (type) {
300		case GRAPH_DPCM:
301			if (asoc_graph_is_ports0(lnk))
302				str = "DPCM Front-End";
303			else
304				str = "DPCM Back-End";
305			break;
306		case GRAPH_C2C:
307			str = "Codec2Codec";
308			break;
309		default:
310			break;
311		}
312
313		dev_dbg(dev, "%pOF (%s)", lnk, str);
314	}
315#endif
316	return type;
317}
318
319static int graph_lnk_is_multi(struct device_node *lnk)
320{
321	return __graph_get_type(lnk) == GRAPH_MULTI;
322}
323
324static struct device_node *graph_get_next_multi_ep(struct device_node **port)
325{
326	struct device_node *ports = of_get_parent(*port);
327	struct device_node *ep = NULL;
328	struct device_node *rep = NULL;
329
330	/*
331	 * multi {
332	 *	ports {
333	 * =>	lnk:	port@0 { ... };
334	 *		port@1 { ep { ... = rep0 } };
335	 *		port@2 { ep { ... = rep1 } };
336	 *		...
337	 *	};
338	 * };
339	 *
340	 * xxx {
341	 *	port@0 { rep0 };
342	 *	port@1 { rep1 };
343	 * };
344	 */
345	do {
346		*port = of_get_next_child(ports, *port);
347		if (!*port)
348			break;
349	} while (!of_node_name_eq(*port, "port"));
350
351	if (*port) {
352		ep  = port_to_endpoint(*port);
353		rep = of_graph_get_remote_endpoint(ep);
354	}
355
356	of_node_put(ep);
357	of_node_put(ports);
358
359	return rep;
360}
361
362static const struct snd_soc_ops graph_ops = {
363	.startup	= asoc_simple_startup,
364	.shutdown	= asoc_simple_shutdown,
365	.hw_params	= asoc_simple_hw_params,
366};
367
368static void graph_parse_convert(struct device_node *ep,
369				struct simple_dai_props *props)
370{
371	struct device_node *port = of_get_parent(ep);
372	struct device_node *ports = of_get_parent(port);
373	struct asoc_simple_data *adata = &props->adata;
374
375	if (of_node_name_eq(ports, "ports"))
376		asoc_simple_parse_convert(ports, NULL, adata);
377	asoc_simple_parse_convert(port, NULL, adata);
378	asoc_simple_parse_convert(ep,   NULL, adata);
379
380	of_node_put(port);
381	of_node_put(ports);
382}
383
384static void graph_parse_mclk_fs(struct device_node *ep,
385				struct simple_dai_props *props)
386{
387	struct device_node *port	= of_get_parent(ep);
388	struct device_node *ports	= of_get_parent(port);
389
390	if (of_node_name_eq(ports, "ports"))
391		of_property_read_u32(ports, "mclk-fs", &props->mclk_fs);
392	of_property_read_u32(port,	"mclk-fs", &props->mclk_fs);
393	of_property_read_u32(ep,	"mclk-fs", &props->mclk_fs);
394
395	of_node_put(port);
396	of_node_put(ports);
397}
398
399static int __graph_parse_node(struct asoc_simple_priv *priv,
400			      enum graph_type gtype,
401			      struct device_node *ep,
402			      struct link_info *li,
403			      int is_cpu, int idx)
404{
405	struct device *dev = simple_priv_to_dev(priv);
406	struct snd_soc_dai_link *dai_link = simple_priv_to_link(priv, li->link);
407	struct simple_dai_props *dai_props = simple_priv_to_props(priv, li->link);
408	struct snd_soc_dai_link_component *dlc;
409	struct asoc_simple_dai *dai;
410	int ret, is_single_links = 0;
411
412	if (is_cpu) {
413		dlc = asoc_link_to_cpu(dai_link, idx);
414		dai = simple_props_to_dai_cpu(dai_props, idx);
415	} else {
416		dlc = asoc_link_to_codec(dai_link, idx);
417		dai = simple_props_to_dai_codec(dai_props, idx);
418	}
419
420	graph_parse_mclk_fs(ep, dai_props);
421
422	ret = asoc_graph_parse_dai(dev, ep, dlc, &is_single_links);
423	if (ret < 0)
424		return ret;
425
426	ret = asoc_simple_parse_tdm(ep, dai);
427	if (ret < 0)
428		return ret;
429
430	ret = asoc_simple_parse_tdm_width_map(dev, ep, dai);
431	if (ret < 0)
432		return ret;
433
434	ret = asoc_simple_parse_clk(dev, ep, dai, dlc);
435	if (ret < 0)
436		return ret;
437
438	/*
439	 * set DAI Name
440	 */
441	if (!dai_link->name) {
442		struct snd_soc_dai_link_component *cpus = dlc;
443		struct snd_soc_dai_link_component *codecs = asoc_link_to_codec(dai_link, idx);
444		char *cpu_multi   = "";
445		char *codec_multi = "";
446
447		if (dai_link->num_cpus > 1)
448			cpu_multi = "_multi";
449		if (dai_link->num_codecs > 1)
450			codec_multi = "_multi";
451
452		switch (gtype) {
453		case GRAPH_NORMAL:
454			/* run is_cpu only. see audio_graph2_link_normal() */
455			if (is_cpu)
456				asoc_simple_set_dailink_name(dev, dai_link, "%s%s-%s%s",
457							       cpus->dai_name,   cpu_multi,
458							     codecs->dai_name, codec_multi);
459			break;
460		case GRAPH_DPCM:
461			if (is_cpu)
462				asoc_simple_set_dailink_name(dev, dai_link, "fe.%pOFP.%s%s",
463						cpus->of_node, cpus->dai_name, cpu_multi);
464			else
465				asoc_simple_set_dailink_name(dev, dai_link, "be.%pOFP.%s%s",
466						codecs->of_node, codecs->dai_name, codec_multi);
467			break;
468		case GRAPH_C2C:
469			/* run is_cpu only. see audio_graph2_link_c2c() */
470			if (is_cpu)
471				asoc_simple_set_dailink_name(dev, dai_link, "c2c.%s%s-%s%s",
472							     cpus->dai_name,   cpu_multi,
473							     codecs->dai_name, codec_multi);
474			break;
475		default:
476			break;
477		}
478	}
479
480	/*
481	 * Check "prefix" from top node
482	 * if DPCM-BE case
483	 */
484	if (!is_cpu && gtype == GRAPH_DPCM) {
485		struct snd_soc_dai_link_component *codecs = asoc_link_to_codec(dai_link, idx);
486		struct snd_soc_codec_conf *cconf = simple_props_to_codec_conf(dai_props, idx);
487		struct device_node *rport  = of_get_parent(ep);
488		struct device_node *rports = of_get_parent(rport);
489
490		if (of_node_name_eq(rports, "ports"))
491			snd_soc_of_parse_node_prefix(rports, cconf, codecs->of_node, "prefix");
492		snd_soc_of_parse_node_prefix(rport,  cconf, codecs->of_node, "prefix");
493
494		of_node_put(rport);
495		of_node_put(rports);
496	}
497
498	if (is_cpu) {
499		struct snd_soc_dai_link_component *cpus = dlc;
500		struct snd_soc_dai_link_component *platforms = asoc_link_to_platform(dai_link, idx);
501
502		asoc_simple_canonicalize_cpu(cpus, is_single_links);
503		asoc_simple_canonicalize_platform(platforms, cpus);
504	}
505
506	return 0;
507}
508
509static int graph_parse_node(struct asoc_simple_priv *priv,
510			    enum graph_type gtype,
511			    struct device_node *port,
512			    struct link_info *li, int is_cpu)
513{
514	struct device_node *ep;
515	int ret = 0;
516
517	if (graph_lnk_is_multi(port)) {
518		int idx;
519
520		of_node_get(port);
521
522		for (idx = 0;; idx++) {
523			ep = graph_get_next_multi_ep(&port);
524			if (!ep)
525				break;
526
527			ret = __graph_parse_node(priv, gtype, ep,
528						 li, is_cpu, idx);
529			of_node_put(ep);
530			if (ret < 0)
531				break;
532		}
533	} else {
534		/* Single CPU / Codec */
535		ep = port_to_endpoint(port);
536		ret = __graph_parse_node(priv, gtype, ep, li, is_cpu, 0);
537		of_node_put(ep);
538	}
539
540	return ret;
541}
542
543static void graph_parse_daifmt(struct device_node *node,
544			       unsigned int *daifmt, unsigned int *bit_frame)
545{
546	unsigned int fmt;
547
548	/*
549	 * see also above "daifmt" explanation
550	 * and samples.
551	 */
552
553	/*
554	 *	ports {
555	 * (A)
556	 *		port {
557	 * (B)
558	 *			endpoint {
559	 * (C)
560	 *			};
561	 *		};
562	 *	};
563	 * };
564	 */
565
566	/*
567	 * clock_provider:
568	 *
569	 * It can be judged it is provider
570	 * if (A) or (B) or (C) has bitclock-master / frame-master flag.
571	 *
572	 * use "or"
573	 */
574	*bit_frame |= snd_soc_daifmt_parse_clock_provider_as_bitmap(node, NULL);
575
576#define update_daifmt(name)					\
577	if (!(*daifmt & SND_SOC_DAIFMT_##name##_MASK) &&	\
578		 (fmt & SND_SOC_DAIFMT_##name##_MASK))		\
579		*daifmt |= fmt & SND_SOC_DAIFMT_##name##_MASK
580
581	/*
582	 * format
583	 *
584	 * This function is called by (C) -> (B) -> (A) order.
585	 * Set if applicable part was not yet set.
586	 */
587	fmt = snd_soc_daifmt_parse_format(node, NULL);
588	update_daifmt(FORMAT);
589	update_daifmt(CLOCK);
590	update_daifmt(INV);
591}
592
593static void graph_link_init(struct asoc_simple_priv *priv,
594			    struct device_node *port,
595			    struct link_info *li,
596			    int is_cpu_node)
597{
598	struct snd_soc_dai_link *dai_link = simple_priv_to_link(priv, li->link);
599	struct device_node *ep;
600	struct device_node *ports;
601	unsigned int daifmt = 0, daiclk = 0;
602	unsigned int bit_frame = 0;
603
604	if (graph_lnk_is_multi(port)) {
605		of_node_get(port);
606		ep = graph_get_next_multi_ep(&port);
607		port = of_get_parent(ep);
608	} else {
609		ep = port_to_endpoint(port);
610	}
611
612	ports = of_get_parent(port);
613
614	/*
615	 *	ports {
616	 * (A)
617	 *		port {
618	 * (B)
619	 *			endpoint {
620	 * (C)
621	 *			};
622	 *		};
623	 *	};
624	 * };
625	 */
626	graph_parse_daifmt(ep,    &daifmt, &bit_frame);		/* (C) */
627	graph_parse_daifmt(port,  &daifmt, &bit_frame);		/* (B) */
628	if (of_node_name_eq(ports, "ports"))
629		graph_parse_daifmt(ports, &daifmt, &bit_frame);	/* (A) */
630
631	/*
632	 * convert bit_frame
633	 * We need to flip clock_provider if it was CPU node,
634	 * because it is Codec base.
635	 */
636	daiclk = snd_soc_daifmt_clock_provider_from_bitmap(bit_frame);
637	if (is_cpu_node)
638		daiclk = snd_soc_daifmt_clock_provider_flipped(daiclk);
639
640	dai_link->dai_fmt	= daifmt | daiclk;
641	dai_link->init		= asoc_simple_dai_init;
642	dai_link->ops		= &graph_ops;
643	if (priv->ops)
644		dai_link->ops	= priv->ops;
645}
646
647int audio_graph2_link_normal(struct asoc_simple_priv *priv,
648			     struct device_node *lnk,
649			     struct link_info *li)
650{
651	struct device_node *cpu_port = lnk;
652	struct device_node *cpu_ep = port_to_endpoint(cpu_port);
653	struct device_node *codec_port = of_graph_get_remote_port(cpu_ep);
654	int ret;
655
656	/*
657	 * call Codec first.
658	 * see
659	 *	__graph_parse_node() :: DAI Naming
660	 */
661	ret = graph_parse_node(priv, GRAPH_NORMAL, codec_port, li, 0);
662	if (ret < 0)
663		goto err;
664
665	/*
666	 * call CPU, and set DAI Name
667	 */
668	ret = graph_parse_node(priv, GRAPH_NORMAL, cpu_port, li, 1);
669	if (ret < 0)
670		goto err;
671
672	graph_link_init(priv, cpu_port, li, 1);
673err:
674	of_node_put(codec_port);
675	of_node_put(cpu_ep);
676
677	return ret;
678}
679EXPORT_SYMBOL_GPL(audio_graph2_link_normal);
680
681int audio_graph2_link_dpcm(struct asoc_simple_priv *priv,
682			   struct device_node *lnk,
683			   struct link_info *li)
684{
685	struct device_node *ep = port_to_endpoint(lnk);
686	struct device_node *rep = of_graph_get_remote_endpoint(ep);
687	struct device_node *rport = of_graph_get_remote_port(ep);
688	struct snd_soc_dai_link *dai_link = simple_priv_to_link(priv, li->link);
689	struct simple_dai_props *dai_props = simple_priv_to_props(priv, li->link);
690	int is_cpu = asoc_graph_is_ports0(lnk);
691	int ret;
692
693	if (is_cpu) {
694		/*
695		 * dpcm {
696		 *	// Front-End
697		 *	ports@0 {
698		 * =>		lnk: port@0 { ep: { ... = rep }; };
699		 *		 ...
700		 *	};
701		 *	// Back-End
702		 *	ports@0 {
703		 *		 ...
704		 *	};
705		 * };
706		 *
707		 * CPU {
708		 *	rports: ports {
709		 *		rport: port@0 { rep: { ... = ep } };
710		 *	}
711		 * }
712		 */
713		/*
714		 * setup CPU here, Codec is already set as dummy.
715		 * see
716		 *	asoc_simple_init_priv()
717		 */
718		dai_link->dynamic		= 1;
719		dai_link->dpcm_merged_format	= 1;
720
721		ret = graph_parse_node(priv, GRAPH_DPCM, rport, li, 1);
722		if (ret)
723			goto err;
724	} else {
725		/*
726		 * dpcm {
727		 *	// Front-End
728		 *	ports@0 {
729		 *		 ...
730		 *	};
731		 *	// Back-End
732		 *	ports@0 {
733		 * =>		lnk: port@0 { ep: { ... = rep; }; };
734		 *		 ...
735		 *	};
736		 * };
737		 *
738		 * Codec {
739		 *	rports: ports {
740		 *		rport: port@0 { rep: { ... = ep; }; };
741		 *	}
742		 * }
743		 */
744		/*
745		 * setup Codec here, CPU is already set as dummy.
746		 * see
747		 *	asoc_simple_init_priv()
748		 */
749
750		/* BE settings */
751		dai_link->no_pcm		= 1;
752		dai_link->be_hw_params_fixup	= asoc_simple_be_hw_params_fixup;
753
754		ret = graph_parse_node(priv, GRAPH_DPCM, rport, li, 0);
755		if (ret < 0)
756			goto err;
757	}
758
759	graph_parse_convert(ep,  dai_props); /* at node of <dpcm> */
760	graph_parse_convert(rep, dai_props); /* at node of <CPU/Codec> */
761
762	snd_soc_dai_link_set_capabilities(dai_link);
763
764	graph_link_init(priv, rport, li, is_cpu);
765err:
766	of_node_put(ep);
767	of_node_put(rep);
768	of_node_put(rport);
769
770	return ret;
771}
772EXPORT_SYMBOL_GPL(audio_graph2_link_dpcm);
773
774int audio_graph2_link_c2c(struct asoc_simple_priv *priv,
775			  struct device_node *lnk,
776			  struct link_info *li)
777{
778	struct snd_soc_dai_link *dai_link = simple_priv_to_link(priv, li->link);
779	struct device_node *port0, *port1, *ports;
780	struct device_node *codec0_port, *codec1_port;
781	struct device_node *ep0, *ep1;
782	u32 val = 0;
783	int ret = -EINVAL;
784
785	/*
786	 * codec2codec {
787	 *	ports {
788	 *		rate = <48000>;
789	 * =>	lnk:	port@0 { c2c0_ep: { ... = codec0_ep; }; };
790	 *		port@1 { c2c1_ep: { ... = codec1_ep; }; };
791	 *	};
792	 * };
793	 *
794	 * Codec {
795	 *	ports {
796	 *		port@0 { codec0_ep: ... }; };
797	 *		port@1 { codec1_ep: ... }; };
798	 *	};
799	 * };
800	 */
801	of_node_get(lnk);
802	port0 = lnk;
803	ports = of_get_parent(port0);
804	port1 = of_get_next_child(ports, lnk);
805
806	/*
807	 * Card2 can use original Codec2Codec settings if DT has.
808	 * It will use default settings if no settings on DT.
809	 * see
810	 *	asoc_simple_init_for_codec2codec()
811	 *
812	 * Add more settings here if needed
813	 */
814	of_property_read_u32(ports, "rate", &val);
815	if (val) {
816		struct device *dev = simple_priv_to_dev(priv);
817		struct snd_soc_pcm_stream *c2c_conf;
818
819		c2c_conf = devm_kzalloc(dev, sizeof(*c2c_conf), GFP_KERNEL);
820		if (!c2c_conf)
821			goto err1;
822
823		c2c_conf->formats	= SNDRV_PCM_FMTBIT_S32_LE; /* update ME */
824		c2c_conf->rates		= SNDRV_PCM_RATE_8000_384000;
825		c2c_conf->rate_min	=
826		c2c_conf->rate_max	= val;
827		c2c_conf->channels_min	=
828		c2c_conf->channels_max	= 2; /* update ME */
829
830		dai_link->c2c_params		= c2c_conf;
831		dai_link->num_c2c_params	= 1;
832	}
833
834	ep0 = port_to_endpoint(port0);
835	ep1 = port_to_endpoint(port1);
836
837	codec0_port = of_graph_get_remote_port(ep0);
838	codec1_port = of_graph_get_remote_port(ep1);
839
840	/*
841	 * call Codec first.
842	 * see
843	 *	__graph_parse_node() :: DAI Naming
844	 */
845	ret = graph_parse_node(priv, GRAPH_C2C, codec1_port, li, 0);
846	if (ret < 0)
847		goto err2;
848
849	/*
850	 * call CPU, and set DAI Name
851	 */
852	ret = graph_parse_node(priv, GRAPH_C2C, codec0_port, li, 1);
853	if (ret < 0)
854		goto err2;
855
856	graph_link_init(priv, codec0_port, li, 1);
857err2:
858	of_node_put(ep0);
859	of_node_put(ep1);
860	of_node_put(codec0_port);
861	of_node_put(codec1_port);
862err1:
863	of_node_put(ports);
864	of_node_put(port0);
865	of_node_put(port1);
866
867	return ret;
868}
869EXPORT_SYMBOL_GPL(audio_graph2_link_c2c);
870
871static int graph_link(struct asoc_simple_priv *priv,
872		      struct graph2_custom_hooks *hooks,
873		      enum graph_type gtype,
874		      struct device_node *lnk,
875		      struct link_info *li)
876{
877	struct device *dev = simple_priv_to_dev(priv);
878	GRAPH2_CUSTOM func = NULL;
879	int ret = -EINVAL;
880
881	switch (gtype) {
882	case GRAPH_NORMAL:
883		if (hooks && hooks->custom_normal)
884			func = hooks->custom_normal;
885		else
886			func = audio_graph2_link_normal;
887		break;
888	case GRAPH_DPCM:
889		if (hooks && hooks->custom_dpcm)
890			func = hooks->custom_dpcm;
891		else
892			func = audio_graph2_link_dpcm;
893		break;
894	case GRAPH_C2C:
895		if (hooks && hooks->custom_c2c)
896			func = hooks->custom_c2c;
897		else
898			func = audio_graph2_link_c2c;
899		break;
900	default:
901		break;
902	}
903
904	if (!func) {
905		dev_err(dev, "non supported gtype (%d)\n", gtype);
906		goto err;
907	}
908
909	ret = func(priv, lnk, li);
910	if (ret < 0)
911		goto err;
912
913	li->link++;
914err:
915	return ret;
916}
917
918static int graph_counter(struct device_node *lnk)
919{
920	/*
921	 * Multi CPU / Codec
922	 *
923	 * multi {
924	 *	ports {
925	 * =>		lnk:	port@0 { ... };
926	 *			port@1 { ... };
927	 *			port@2 { ... };
928	 *			...
929	 *	};
930	 * };
931	 *
932	 * ignore first lnk part
933	 */
934	if (graph_lnk_is_multi(lnk))
935		return of_graph_get_endpoint_count(of_get_parent(lnk)) - 1;
936	/*
937	 * Single CPU / Codec
938	 */
939	else
940		return 1;
941}
942
943static int graph_count_normal(struct asoc_simple_priv *priv,
944			      struct device_node *lnk,
945			      struct link_info *li)
946{
947	struct device_node *cpu_port = lnk;
948	struct device_node *cpu_ep = port_to_endpoint(cpu_port);
949	struct device_node *codec_port = of_graph_get_remote_port(cpu_ep);
950
951	/*
952	 *	CPU {
953	 * =>		lnk: port { endpoint { .. }; };
954	 *	};
955	 */
956	/*
957	 * DON'T REMOVE platforms
958	 * see
959	 *	simple-card.c :: simple_count_noml()
960	 */
961	li->num[li->link].cpus		=
962	li->num[li->link].platforms	= graph_counter(cpu_port);
963
964	li->num[li->link].codecs	= graph_counter(codec_port);
965
966	of_node_put(cpu_ep);
967	of_node_put(codec_port);
968
969	return 0;
970}
971
972static int graph_count_dpcm(struct asoc_simple_priv *priv,
973			    struct device_node *lnk,
974			    struct link_info *li)
975{
976	struct device_node *ep = port_to_endpoint(lnk);
977	struct device_node *rport = of_graph_get_remote_port(ep);
978
979	/*
980	 * dpcm {
981	 *	// Front-End
982	 *	ports@0 {
983	 * =>		lnk: port@0 { endpoint { ... }; };
984	 *		 ...
985	 *	};
986	 *	// Back-End
987	 *	ports@1 {
988	 * =>		lnk: port@0 { endpoint { ... }; };
989	 *		 ...
990	 *	};
991	 * };
992	 */
993
994	if (asoc_graph_is_ports0(lnk)) {
995		/*
996		 * DON'T REMOVE platforms
997		 * see
998		 *	simple-card.c :: simple_count_noml()
999		 */
1000		li->num[li->link].cpus		= graph_counter(rport); /* FE */
1001		li->num[li->link].platforms	= graph_counter(rport);
1002	} else {
1003		li->num[li->link].codecs	= graph_counter(rport); /* BE */
1004	}
1005
1006	of_node_put(ep);
1007	of_node_put(rport);
1008
1009	return 0;
1010}
1011
1012static int graph_count_c2c(struct asoc_simple_priv *priv,
1013			   struct device_node *lnk,
1014			   struct link_info *li)
1015{
1016	struct device_node *ports = of_get_parent(lnk);
1017	struct device_node *port0 = lnk;
1018	struct device_node *port1 = of_get_next_child(ports, lnk);
1019	struct device_node *ep0 = port_to_endpoint(port0);
1020	struct device_node *ep1 = port_to_endpoint(port1);
1021	struct device_node *codec0 = of_graph_get_remote_port(ep0);
1022	struct device_node *codec1 = of_graph_get_remote_port(ep1);
1023
1024	of_node_get(lnk);
1025
1026	/*
1027	 * codec2codec {
1028	 *	ports {
1029	 * =>	lnk:	port@0 { endpoint { ... }; };
1030	 *		port@1 { endpoint { ... }; };
1031	 *	};
1032	 * };
1033	 */
1034	/*
1035	 * DON'T REMOVE platforms
1036	 * see
1037	 *	simple-card.c :: simple_count_noml()
1038	 */
1039	li->num[li->link].cpus		=
1040	li->num[li->link].platforms	= graph_counter(codec0);
1041
1042	li->num[li->link].codecs	= graph_counter(codec1);
1043
1044	of_node_put(ports);
1045	of_node_put(port1);
1046	of_node_put(ep0);
1047	of_node_put(ep1);
1048	of_node_put(codec0);
1049	of_node_put(codec1);
1050
1051	return 0;
1052}
1053
1054static int graph_count(struct asoc_simple_priv *priv,
1055		       struct graph2_custom_hooks *hooks,
1056		       enum graph_type gtype,
1057		       struct device_node *lnk,
1058		       struct link_info *li)
1059{
1060	struct device *dev = simple_priv_to_dev(priv);
1061	GRAPH2_CUSTOM func = NULL;
1062	int ret = -EINVAL;
1063
1064	if (li->link >= SNDRV_MAX_LINKS) {
1065		dev_err(dev, "too many links\n");
1066		return ret;
1067	}
1068
1069	switch (gtype) {
1070	case GRAPH_NORMAL:
1071		func = graph_count_normal;
1072		break;
1073	case GRAPH_DPCM:
1074		func = graph_count_dpcm;
1075		break;
1076	case GRAPH_C2C:
1077		func = graph_count_c2c;
1078		break;
1079	default:
1080		break;
1081	}
1082
1083	if (!func) {
1084		dev_err(dev, "non supported gtype (%d)\n", gtype);
1085		goto err;
1086	}
1087
1088	ret = func(priv, lnk, li);
1089	if (ret < 0)
1090		goto err;
1091
1092	li->link++;
1093err:
1094	return ret;
1095}
1096
1097static int graph_for_each_link(struct asoc_simple_priv *priv,
1098			       struct graph2_custom_hooks *hooks,
1099			       struct link_info *li,
1100			       int (*func)(struct asoc_simple_priv *priv,
1101					   struct graph2_custom_hooks *hooks,
1102					   enum graph_type gtype,
1103					   struct device_node *lnk,
1104					   struct link_info *li))
1105{
1106	struct of_phandle_iterator it;
1107	struct device *dev = simple_priv_to_dev(priv);
1108	struct device_node *node = dev->of_node;
1109	struct device_node *lnk;
1110	enum graph_type gtype;
1111	int rc, ret;
1112
1113	/* loop for all listed CPU port */
1114	of_for_each_phandle(&it, rc, node, "links", NULL, 0) {
1115		lnk = it.node;
1116
1117		gtype = graph_get_type(priv, lnk);
1118
1119		ret = func(priv, hooks, gtype, lnk, li);
1120		if (ret < 0)
1121			return ret;
1122	}
1123
1124	return 0;
1125}
1126
1127int audio_graph2_parse_of(struct asoc_simple_priv *priv, struct device *dev,
1128			  struct graph2_custom_hooks *hooks)
1129{
1130	struct snd_soc_card *card = simple_priv_to_card(priv);
1131	struct link_info *li;
1132	int ret;
1133
1134	li = devm_kzalloc(dev, sizeof(*li), GFP_KERNEL);
1135	if (!li)
1136		return -ENOMEM;
1137
1138	card->probe	= asoc_graph_card_probe;
1139	card->owner	= THIS_MODULE;
1140	card->dev	= dev;
1141
1142	if ((hooks) && (hooks)->hook_pre) {
1143		ret = (hooks)->hook_pre(priv);
1144		if (ret < 0)
1145			goto err;
1146	}
1147
1148	ret = graph_for_each_link(priv, hooks, li, graph_count);
1149	if (!li->link)
1150		ret = -EINVAL;
1151	if (ret < 0)
1152		goto err;
1153
1154	ret = asoc_simple_init_priv(priv, li);
1155	if (ret < 0)
1156		goto err;
1157
1158	priv->pa_gpio = devm_gpiod_get_optional(dev, "pa", GPIOD_OUT_LOW);
1159	if (IS_ERR(priv->pa_gpio)) {
1160		ret = PTR_ERR(priv->pa_gpio);
1161		dev_err(dev, "failed to get amplifier gpio: %d\n", ret);
1162		goto err;
1163	}
1164
1165	ret = asoc_simple_parse_widgets(card, NULL);
1166	if (ret < 0)
1167		goto err;
1168
1169	ret = asoc_simple_parse_routing(card, NULL);
1170	if (ret < 0)
1171		goto err;
1172
1173	memset(li, 0, sizeof(*li));
1174	ret = graph_for_each_link(priv, hooks, li, graph_link);
1175	if (ret < 0)
1176		goto err;
1177
1178	ret = asoc_simple_parse_card_name(card, NULL);
1179	if (ret < 0)
1180		goto err;
1181
1182	snd_soc_card_set_drvdata(card, priv);
1183
1184	if ((hooks) && (hooks)->hook_post) {
1185		ret = (hooks)->hook_post(priv);
1186		if (ret < 0)
1187			goto err;
1188	}
1189
1190	asoc_simple_debug_info(priv);
1191
1192	ret = devm_snd_soc_register_card(dev, card);
1193err:
1194	devm_kfree(dev, li);
1195
1196	if (ret < 0)
1197		dev_err_probe(dev, ret, "parse error\n");
1198
1199	return ret;
1200}
1201EXPORT_SYMBOL_GPL(audio_graph2_parse_of);
1202
1203static int graph_probe(struct platform_device *pdev)
1204{
1205	struct asoc_simple_priv *priv;
1206	struct device *dev = &pdev->dev;
1207
1208	/* Allocate the private data and the DAI link array */
1209	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
1210	if (!priv)
1211		return -ENOMEM;
1212
1213	return audio_graph2_parse_of(priv, dev, NULL);
1214}
1215
1216static const struct of_device_id graph_of_match[] = {
1217	{ .compatible = "audio-graph-card2", },
1218	{},
1219};
1220MODULE_DEVICE_TABLE(of, graph_of_match);
1221
1222static struct platform_driver graph_card = {
1223	.driver = {
1224		.name = "asoc-audio-graph-card2",
1225		.pm = &snd_soc_pm_ops,
1226		.of_match_table = graph_of_match,
1227	},
1228	.probe	= graph_probe,
1229	.remove	= asoc_simple_remove,
1230};
1231module_platform_driver(graph_card);
1232
1233MODULE_ALIAS("platform:asoc-audio-graph-card2");
1234MODULE_LICENSE("GPL v2");
1235MODULE_DESCRIPTION("ASoC Audio Graph Card2");
1236MODULE_AUTHOR("Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>");
1237