1 // SPDX-License-Identifier: GPL-2.0
3 // Helper routines for R-Car sound ADG.
6 #include <linux/clk-provider.h>
29 	struct clk *clk[CLKMAX];  member
30 	struct clk *clkout[CLKOUTMAX];
31 	struct clk *null_clk;
50 	     ((pos) = adg->clk[i]);		\
55 	     ((pos) = adg->clkout[i]);	\
57 #define rsnd_priv_to_adg(priv) ((struct rsnd_adg *)(priv)->adg)
73 	for (i = 3; i >= 0; i--) {  in rsnd_adg_calculate_rbgx()
76 			return (u32)((i << 8) | ((div / ratio) - 1));  in rsnd_adg_calculate_rbgx()
115 	int sel;  in __rsnd_adg_get_timesel_ratio()  local
119 		adg->clk_rate[CLKA],	/* 0000: CLKA */  in __rsnd_adg_get_timesel_ratio()
120 		adg->clk_rate[CLKB],	/* 0001: CLKB */  in __rsnd_adg_get_timesel_ratio()
121 		adg->clk_rate[CLKC],	/* 0010: CLKC */  in __rsnd_adg_get_timesel_ratio()
122 		adg->rbga_rate_for_441khz,	/* 0011: RBGA */  in __rsnd_adg_get_timesel_ratio()
123 		adg->rbgb_rate_for_48khz,	/* 0100: RBGB */  in __rsnd_adg_get_timesel_ratio()
129 	for (sel = 0; sel < ARRAY_SIZE(sel_rate); sel++) {  in __rsnd_adg_get_timesel_ratio()
134 		if (!sel_rate[sel])  in __rsnd_adg_get_timesel_ratio()
138 			diff = abs(target_rate - sel_rate[sel] / div);  in __rsnd_adg_get_timesel_ratio()
140 				val = (sel << 8) | idx;  in __rsnd_adg_get_timesel_ratio()
142 				en = 1 << (sel + 1); /* fixme */  in __rsnd_adg_get_timesel_ratio()
189 	if (runtime->rate != in_rate) {  in rsnd_adg_get_timesel_ratio()
192 	} else if (runtime->rate != out_rate) {  in rsnd_adg_get_timesel_ratio()
307 		if (rate == adg->clk_rate[i])  in rsnd_adg_clk_query()
313 	if (rate == adg->rbga_rate_for_441khz)  in rsnd_adg_clk_query()
316 	if (rate == adg->rbgb_rate_for_48khz)  in rsnd_adg_clk_query()
319 	return -EIO;  in rsnd_adg_clk_query()
352 	rsnd_mod_bset(adg_mod, BRGCKR, 0x80770000, adg->ckr | ckr);  in rsnd_adg_ssi_clk_try_start()
353 	rsnd_mod_write(adg_mod, BRRA,  adg->rbga);  in rsnd_adg_ssi_clk_try_start()
354 	rsnd_mod_write(adg_mod, BRRB,  adg->rbgb);  in rsnd_adg_ssi_clk_try_start()
358 		(ckr) ?	adg->rbgb_rate_for_48khz :  in rsnd_adg_ssi_clk_try_start()
359 			adg->rbga_rate_for_441khz);  in rsnd_adg_ssi_clk_try_start()
367 	struct clk *clk;  in rsnd_adg_clk_control()  local
370 	for_each_rsnd_clk(clk, adg, i) {  in rsnd_adg_clk_control()
372 			clk_prepare_enable(clk);  in rsnd_adg_clk_control()
379 			adg->clk_rate[i] = clk_get_rate(clk);  in rsnd_adg_clk_control()
381 			clk_disable_unprepare(clk);  in rsnd_adg_clk_control()
386 static struct clk *rsnd_adg_create_null_clk(struct rsnd_priv *priv,  in rsnd_adg_create_null_clk()
391 	struct clk *clk;  in rsnd_adg_create_null_clk()  local
393 	clk = clk_register_fixed_rate(dev, name, parent, 0, 0);  in rsnd_adg_create_null_clk()
394 	if (IS_ERR_OR_NULL(clk)) {  in rsnd_adg_create_null_clk()
395 		dev_err(dev, "create null clk error\n");  in rsnd_adg_create_null_clk()
396 		return ERR_CAST(clk);  in rsnd_adg_create_null_clk()
399 	return clk;  in rsnd_adg_create_null_clk()
402 static struct clk *rsnd_adg_null_clk_get(struct rsnd_priv *priv)  in rsnd_adg_null_clk_get()
404 	struct rsnd_adg *adg = priv->adg;  in rsnd_adg_null_clk_get()
406 	if (!adg->null_clk) {  in rsnd_adg_null_clk_get()
409 		adg->null_clk = rsnd_adg_create_null_clk(priv, name, NULL);  in rsnd_adg_null_clk_get()
412 	return adg->null_clk;  in rsnd_adg_null_clk_get()
417 	struct rsnd_adg *adg = priv->adg;  in rsnd_adg_null_clk_clean()
419 	if (adg->null_clk)  in rsnd_adg_null_clk_clean()
420 		clk_unregister_fixed_rate(adg->null_clk);  in rsnd_adg_null_clk_clean()
425 	struct rsnd_adg *adg = priv->adg;  in rsnd_adg_get_clkin()
427 	struct clk *clk;  in rsnd_adg_get_clkin()  local
431 		clk = devm_clk_get(dev, clk_name[i]);  in rsnd_adg_get_clkin()
433 		if (IS_ERR_OR_NULL(clk))  in rsnd_adg_get_clkin()
434 			clk = rsnd_adg_null_clk_get(priv);  in rsnd_adg_get_clkin()
435 		if (IS_ERR_OR_NULL(clk))  in rsnd_adg_get_clkin()
438 		adg->clk[i] = clk;  in rsnd_adg_get_clkin()
448 	return -EIO;  in rsnd_adg_get_clkin()
453 	struct rsnd_adg *adg = priv->adg;  in rsnd_adg_unregister_clkout()
454 	struct clk *clk;  in rsnd_adg_unregister_clkout()  local
457 	for_each_rsnd_clkout(clk, adg, i)  in rsnd_adg_unregister_clkout()
458 		clk_unregister_fixed_rate(clk);  in rsnd_adg_unregister_clkout()
463 	struct rsnd_adg *adg = priv->adg;  in rsnd_adg_get_clkout()
464 	struct clk *clk;  in rsnd_adg_get_clkout()  local
466 	struct device_node *np = dev->of_node;  in rsnd_adg_get_clkout()
497 	prop = of_find_property(np, "clock-frequency", NULL);  in rsnd_adg_get_clkout()
501 	req_size = prop->length / sizeof(u32);  in rsnd_adg_get_clkout()
503 		dev_err(dev, "too many clock-frequency\n");  in rsnd_adg_get_clkout()
504 		return -EINVAL;  in rsnd_adg_get_clkout()
507 	of_property_read_u32_array(np, "clock-frequency", req_rate, req_size);  in rsnd_adg_get_clkout()
520 	if (of_get_property(np, "clkout-lr-asynchronous", NULL))  in rsnd_adg_get_clkout()
527 	 * SSI itself can divide parent clock by 1/1 - 1/16  in rsnd_adg_get_clkout()
532 	adg->rbga_rate_for_441khz	= 0;  in rsnd_adg_get_clkout()
533 	adg->rbgb_rate_for_48khz	= 0;  in rsnd_adg_get_clkout()
534 	for_each_rsnd_clk(clk, adg, i) {  in rsnd_adg_get_clkout()
535 		rate = clk_get_rate(clk);  in rsnd_adg_get_clkout()
541 		if (!adg->rbga_rate_for_441khz && (0 == rate % 44100)) {  in rsnd_adg_get_clkout()
548 				adg->rbga_rate_for_441khz = rate / div;  in rsnd_adg_get_clkout()
552 					parent_clk_name = __clk_get_name(clk);  in rsnd_adg_get_clkout()
557 		if (!adg->rbgb_rate_for_48khz && (0 == rate % 48000)) {  in rsnd_adg_get_clkout()
564 				adg->rbgb_rate_for_48khz = rate / div;  in rsnd_adg_get_clkout()
568 					parent_clk_name = __clk_get_name(clk);  in rsnd_adg_get_clkout()
578 	of_property_read_u32(np, "#clock-cells", &count);  in rsnd_adg_get_clkout()
583 		clk = clk_register_fixed_rate(dev, clkout_name[CLKOUT],  in rsnd_adg_get_clkout()
585 		if (IS_ERR_OR_NULL(clk))  in rsnd_adg_get_clkout()
588 		adg->clkout[CLKOUT] = clk;  in rsnd_adg_get_clkout()
589 		of_clk_add_provider(np, of_clk_src_simple_get, clk);  in rsnd_adg_get_clkout()
596 			clk = clk_register_fixed_rate(dev, clkout_name[i],  in rsnd_adg_get_clkout()
599 			if (IS_ERR_OR_NULL(clk))  in rsnd_adg_get_clkout()
602 			adg->clkout[i] = clk;  in rsnd_adg_get_clkout()
604 		adg->onecell.clks	= adg->clkout;  in rsnd_adg_get_clkout()
605 		adg->onecell.clk_num	= CLKOUTMAX;  in rsnd_adg_get_clkout()
607 				    &adg->onecell);  in rsnd_adg_get_clkout()
611 	adg->ckr = ckr;  in rsnd_adg_get_clkout()
612 	adg->rbga = rbga;  in rsnd_adg_get_clkout()
613 	adg->rbgb = rbgb;  in rsnd_adg_get_clkout()
622 	return -EIO;  in rsnd_adg_get_clkout()
647 	struct clk *clk;  in rsnd_adg_clk_dbg_info()  local
650 	for_each_rsnd_clk(clk, adg, i)  in rsnd_adg_clk_dbg_info()
652 			clk_name[i], clk, clk_get_rate(clk));  in rsnd_adg_clk_dbg_info()
655 		adg->ckr, adg->rbga, adg->rbgb);  in rsnd_adg_clk_dbg_info()
656 	dbg_msg(dev, m, "BRGA (for 44100 base) = %d\n", adg->rbga_rate_for_441khz);  in rsnd_adg_clk_dbg_info()
657 	dbg_msg(dev, m, "BRGB (for 48000 base) = %d\n", adg->rbgb_rate_for_48khz);  in rsnd_adg_clk_dbg_info()
663 	for_each_rsnd_clkout(clk, adg, i)  in rsnd_adg_clk_dbg_info()
665 			clk, clk_get_rate(clk));  in rsnd_adg_clk_dbg_info()
679 		return -ENOMEM;  in rsnd_adg_probe()
681 	ret = rsnd_mod_init(priv, &adg->mod, &adg_ops,  in rsnd_adg_probe()
686 	priv->adg = adg;  in rsnd_adg_probe()
705 	struct device_node *np = dev->of_node;  in rsnd_adg_remove()