18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * tegra_asoc_utils.c - Harmony machine ASoC driver
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * Author: Stephen Warren <swarren@nvidia.com>
68c2ecf20Sopenharmony_ci * Copyright (C) 2010,2012 - NVIDIA, Inc.
78c2ecf20Sopenharmony_ci */
88c2ecf20Sopenharmony_ci
98c2ecf20Sopenharmony_ci#include <linux/clk.h>
108c2ecf20Sopenharmony_ci#include <linux/device.h>
118c2ecf20Sopenharmony_ci#include <linux/err.h>
128c2ecf20Sopenharmony_ci#include <linux/kernel.h>
138c2ecf20Sopenharmony_ci#include <linux/module.h>
148c2ecf20Sopenharmony_ci#include <linux/of.h>
158c2ecf20Sopenharmony_ci
168c2ecf20Sopenharmony_ci#include "tegra_asoc_utils.h"
178c2ecf20Sopenharmony_ci
188c2ecf20Sopenharmony_ciint tegra_asoc_utils_set_rate(struct tegra_asoc_utils_data *data, int srate,
198c2ecf20Sopenharmony_ci			      int mclk)
208c2ecf20Sopenharmony_ci{
218c2ecf20Sopenharmony_ci	int new_baseclock;
228c2ecf20Sopenharmony_ci	bool clk_change;
238c2ecf20Sopenharmony_ci	int err;
248c2ecf20Sopenharmony_ci
258c2ecf20Sopenharmony_ci	switch (srate) {
268c2ecf20Sopenharmony_ci	case 11025:
278c2ecf20Sopenharmony_ci	case 22050:
288c2ecf20Sopenharmony_ci	case 44100:
298c2ecf20Sopenharmony_ci	case 88200:
308c2ecf20Sopenharmony_ci		if (data->soc == TEGRA_ASOC_UTILS_SOC_TEGRA20)
318c2ecf20Sopenharmony_ci			new_baseclock = 56448000;
328c2ecf20Sopenharmony_ci		else if (data->soc == TEGRA_ASOC_UTILS_SOC_TEGRA30)
338c2ecf20Sopenharmony_ci			new_baseclock = 564480000;
348c2ecf20Sopenharmony_ci		else
358c2ecf20Sopenharmony_ci			new_baseclock = 282240000;
368c2ecf20Sopenharmony_ci		break;
378c2ecf20Sopenharmony_ci	case 8000:
388c2ecf20Sopenharmony_ci	case 16000:
398c2ecf20Sopenharmony_ci	case 32000:
408c2ecf20Sopenharmony_ci	case 48000:
418c2ecf20Sopenharmony_ci	case 64000:
428c2ecf20Sopenharmony_ci	case 96000:
438c2ecf20Sopenharmony_ci		if (data->soc == TEGRA_ASOC_UTILS_SOC_TEGRA20)
448c2ecf20Sopenharmony_ci			new_baseclock = 73728000;
458c2ecf20Sopenharmony_ci		else if (data->soc == TEGRA_ASOC_UTILS_SOC_TEGRA30)
468c2ecf20Sopenharmony_ci			new_baseclock = 552960000;
478c2ecf20Sopenharmony_ci		else
488c2ecf20Sopenharmony_ci			new_baseclock = 368640000;
498c2ecf20Sopenharmony_ci		break;
508c2ecf20Sopenharmony_ci	default:
518c2ecf20Sopenharmony_ci		return -EINVAL;
528c2ecf20Sopenharmony_ci	}
538c2ecf20Sopenharmony_ci
548c2ecf20Sopenharmony_ci	clk_change = ((new_baseclock != data->set_baseclock) ||
558c2ecf20Sopenharmony_ci			(mclk != data->set_mclk));
568c2ecf20Sopenharmony_ci	if (!clk_change)
578c2ecf20Sopenharmony_ci		return 0;
588c2ecf20Sopenharmony_ci
598c2ecf20Sopenharmony_ci	data->set_baseclock = 0;
608c2ecf20Sopenharmony_ci	data->set_mclk = 0;
618c2ecf20Sopenharmony_ci
628c2ecf20Sopenharmony_ci	clk_disable_unprepare(data->clk_cdev1);
638c2ecf20Sopenharmony_ci
648c2ecf20Sopenharmony_ci	err = clk_set_rate(data->clk_pll_a, new_baseclock);
658c2ecf20Sopenharmony_ci	if (err) {
668c2ecf20Sopenharmony_ci		dev_err(data->dev, "Can't set pll_a rate: %d\n", err);
678c2ecf20Sopenharmony_ci		return err;
688c2ecf20Sopenharmony_ci	}
698c2ecf20Sopenharmony_ci
708c2ecf20Sopenharmony_ci	err = clk_set_rate(data->clk_pll_a_out0, mclk);
718c2ecf20Sopenharmony_ci	if (err) {
728c2ecf20Sopenharmony_ci		dev_err(data->dev, "Can't set pll_a_out0 rate: %d\n", err);
738c2ecf20Sopenharmony_ci		return err;
748c2ecf20Sopenharmony_ci	}
758c2ecf20Sopenharmony_ci
768c2ecf20Sopenharmony_ci	/* Don't set cdev1/extern1 rate; it's locked to pll_a_out0 */
778c2ecf20Sopenharmony_ci
788c2ecf20Sopenharmony_ci	err = clk_prepare_enable(data->clk_cdev1);
798c2ecf20Sopenharmony_ci	if (err) {
808c2ecf20Sopenharmony_ci		dev_err(data->dev, "Can't enable cdev1: %d\n", err);
818c2ecf20Sopenharmony_ci		return err;
828c2ecf20Sopenharmony_ci	}
838c2ecf20Sopenharmony_ci
848c2ecf20Sopenharmony_ci	data->set_baseclock = new_baseclock;
858c2ecf20Sopenharmony_ci	data->set_mclk = mclk;
868c2ecf20Sopenharmony_ci
878c2ecf20Sopenharmony_ci	return 0;
888c2ecf20Sopenharmony_ci}
898c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(tegra_asoc_utils_set_rate);
908c2ecf20Sopenharmony_ci
918c2ecf20Sopenharmony_ciint tegra_asoc_utils_set_ac97_rate(struct tegra_asoc_utils_data *data)
928c2ecf20Sopenharmony_ci{
938c2ecf20Sopenharmony_ci	const int pll_rate = 73728000;
948c2ecf20Sopenharmony_ci	const int ac97_rate = 24576000;
958c2ecf20Sopenharmony_ci	int err;
968c2ecf20Sopenharmony_ci
978c2ecf20Sopenharmony_ci	clk_disable_unprepare(data->clk_cdev1);
988c2ecf20Sopenharmony_ci
998c2ecf20Sopenharmony_ci	/*
1008c2ecf20Sopenharmony_ci	 * AC97 rate is fixed at 24.576MHz and is used for both the host
1018c2ecf20Sopenharmony_ci	 * controller and the external codec
1028c2ecf20Sopenharmony_ci	 */
1038c2ecf20Sopenharmony_ci	err = clk_set_rate(data->clk_pll_a, pll_rate);
1048c2ecf20Sopenharmony_ci	if (err) {
1058c2ecf20Sopenharmony_ci		dev_err(data->dev, "Can't set pll_a rate: %d\n", err);
1068c2ecf20Sopenharmony_ci		return err;
1078c2ecf20Sopenharmony_ci	}
1088c2ecf20Sopenharmony_ci
1098c2ecf20Sopenharmony_ci	err = clk_set_rate(data->clk_pll_a_out0, ac97_rate);
1108c2ecf20Sopenharmony_ci	if (err) {
1118c2ecf20Sopenharmony_ci		dev_err(data->dev, "Can't set pll_a_out0 rate: %d\n", err);
1128c2ecf20Sopenharmony_ci		return err;
1138c2ecf20Sopenharmony_ci	}
1148c2ecf20Sopenharmony_ci
1158c2ecf20Sopenharmony_ci	/* Don't set cdev1/extern1 rate; it's locked to pll_a_out0 */
1168c2ecf20Sopenharmony_ci
1178c2ecf20Sopenharmony_ci	err = clk_prepare_enable(data->clk_cdev1);
1188c2ecf20Sopenharmony_ci	if (err) {
1198c2ecf20Sopenharmony_ci		dev_err(data->dev, "Can't enable cdev1: %d\n", err);
1208c2ecf20Sopenharmony_ci		return err;
1218c2ecf20Sopenharmony_ci	}
1228c2ecf20Sopenharmony_ci
1238c2ecf20Sopenharmony_ci	data->set_baseclock = pll_rate;
1248c2ecf20Sopenharmony_ci	data->set_mclk = ac97_rate;
1258c2ecf20Sopenharmony_ci
1268c2ecf20Sopenharmony_ci	return 0;
1278c2ecf20Sopenharmony_ci}
1288c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(tegra_asoc_utils_set_ac97_rate);
1298c2ecf20Sopenharmony_ci
1308c2ecf20Sopenharmony_ciint tegra_asoc_utils_init(struct tegra_asoc_utils_data *data,
1318c2ecf20Sopenharmony_ci			  struct device *dev)
1328c2ecf20Sopenharmony_ci{
1338c2ecf20Sopenharmony_ci	struct clk *clk_out_1, *clk_extern1;
1348c2ecf20Sopenharmony_ci	int ret;
1358c2ecf20Sopenharmony_ci
1368c2ecf20Sopenharmony_ci	data->dev = dev;
1378c2ecf20Sopenharmony_ci
1388c2ecf20Sopenharmony_ci	if (of_machine_is_compatible("nvidia,tegra20"))
1398c2ecf20Sopenharmony_ci		data->soc = TEGRA_ASOC_UTILS_SOC_TEGRA20;
1408c2ecf20Sopenharmony_ci	else if (of_machine_is_compatible("nvidia,tegra30"))
1418c2ecf20Sopenharmony_ci		data->soc = TEGRA_ASOC_UTILS_SOC_TEGRA30;
1428c2ecf20Sopenharmony_ci	else if (of_machine_is_compatible("nvidia,tegra114"))
1438c2ecf20Sopenharmony_ci		data->soc = TEGRA_ASOC_UTILS_SOC_TEGRA114;
1448c2ecf20Sopenharmony_ci	else if (of_machine_is_compatible("nvidia,tegra124"))
1458c2ecf20Sopenharmony_ci		data->soc = TEGRA_ASOC_UTILS_SOC_TEGRA124;
1468c2ecf20Sopenharmony_ci	else {
1478c2ecf20Sopenharmony_ci		dev_err(data->dev, "SoC unknown to Tegra ASoC utils\n");
1488c2ecf20Sopenharmony_ci		return -EINVAL;
1498c2ecf20Sopenharmony_ci	}
1508c2ecf20Sopenharmony_ci
1518c2ecf20Sopenharmony_ci	data->clk_pll_a = devm_clk_get(dev, "pll_a");
1528c2ecf20Sopenharmony_ci	if (IS_ERR(data->clk_pll_a)) {
1538c2ecf20Sopenharmony_ci		dev_err(data->dev, "Can't retrieve clk pll_a\n");
1548c2ecf20Sopenharmony_ci		return PTR_ERR(data->clk_pll_a);
1558c2ecf20Sopenharmony_ci	}
1568c2ecf20Sopenharmony_ci
1578c2ecf20Sopenharmony_ci	data->clk_pll_a_out0 = devm_clk_get(dev, "pll_a_out0");
1588c2ecf20Sopenharmony_ci	if (IS_ERR(data->clk_pll_a_out0)) {
1598c2ecf20Sopenharmony_ci		dev_err(data->dev, "Can't retrieve clk pll_a_out0\n");
1608c2ecf20Sopenharmony_ci		return PTR_ERR(data->clk_pll_a_out0);
1618c2ecf20Sopenharmony_ci	}
1628c2ecf20Sopenharmony_ci
1638c2ecf20Sopenharmony_ci	data->clk_cdev1 = devm_clk_get(dev, "mclk");
1648c2ecf20Sopenharmony_ci	if (IS_ERR(data->clk_cdev1)) {
1658c2ecf20Sopenharmony_ci		dev_err(data->dev, "Can't retrieve clk cdev1\n");
1668c2ecf20Sopenharmony_ci		return PTR_ERR(data->clk_cdev1);
1678c2ecf20Sopenharmony_ci	}
1688c2ecf20Sopenharmony_ci
1698c2ecf20Sopenharmony_ci	/*
1708c2ecf20Sopenharmony_ci	 * If clock parents are not set in DT, configure here to use clk_out_1
1718c2ecf20Sopenharmony_ci	 * as mclk and extern1 as parent for Tegra30 and higher.
1728c2ecf20Sopenharmony_ci	 */
1738c2ecf20Sopenharmony_ci	if (!of_find_property(dev->of_node, "assigned-clock-parents", NULL) &&
1748c2ecf20Sopenharmony_ci	    data->soc > TEGRA_ASOC_UTILS_SOC_TEGRA20) {
1758c2ecf20Sopenharmony_ci		dev_warn(data->dev,
1768c2ecf20Sopenharmony_ci			 "Configuring clocks for a legacy device-tree\n");
1778c2ecf20Sopenharmony_ci		dev_warn(data->dev,
1788c2ecf20Sopenharmony_ci			 "Please update DT to use assigned-clock-parents\n");
1798c2ecf20Sopenharmony_ci		clk_extern1 = devm_clk_get(dev, "extern1");
1808c2ecf20Sopenharmony_ci		if (IS_ERR(clk_extern1)) {
1818c2ecf20Sopenharmony_ci			dev_err(data->dev, "Can't retrieve clk extern1\n");
1828c2ecf20Sopenharmony_ci			return PTR_ERR(clk_extern1);
1838c2ecf20Sopenharmony_ci		}
1848c2ecf20Sopenharmony_ci
1858c2ecf20Sopenharmony_ci		ret = clk_set_parent(clk_extern1, data->clk_pll_a_out0);
1868c2ecf20Sopenharmony_ci		if (ret < 0) {
1878c2ecf20Sopenharmony_ci			dev_err(data->dev,
1888c2ecf20Sopenharmony_ci				"Set parent failed for clk extern1\n");
1898c2ecf20Sopenharmony_ci			return ret;
1908c2ecf20Sopenharmony_ci		}
1918c2ecf20Sopenharmony_ci
1928c2ecf20Sopenharmony_ci		clk_out_1 = devm_clk_get(dev, "pmc_clk_out_1");
1938c2ecf20Sopenharmony_ci		if (IS_ERR(clk_out_1)) {
1948c2ecf20Sopenharmony_ci			dev_err(data->dev, "Can't retrieve pmc_clk_out_1\n");
1958c2ecf20Sopenharmony_ci			return PTR_ERR(clk_out_1);
1968c2ecf20Sopenharmony_ci		}
1978c2ecf20Sopenharmony_ci
1988c2ecf20Sopenharmony_ci		ret = clk_set_parent(clk_out_1, clk_extern1);
1998c2ecf20Sopenharmony_ci		if (ret < 0) {
2008c2ecf20Sopenharmony_ci			dev_err(data->dev,
2018c2ecf20Sopenharmony_ci				"Set parent failed for pmc_clk_out_1\n");
2028c2ecf20Sopenharmony_ci			return ret;
2038c2ecf20Sopenharmony_ci		}
2048c2ecf20Sopenharmony_ci
2058c2ecf20Sopenharmony_ci		data->clk_cdev1 = clk_out_1;
2068c2ecf20Sopenharmony_ci	}
2078c2ecf20Sopenharmony_ci
2088c2ecf20Sopenharmony_ci	/*
2098c2ecf20Sopenharmony_ci	 * FIXME: There is some unknown dependency between audio mclk disable
2108c2ecf20Sopenharmony_ci	 * and suspend-resume functionality on Tegra30, although audio mclk is
2118c2ecf20Sopenharmony_ci	 * only needed for audio.
2128c2ecf20Sopenharmony_ci	 */
2138c2ecf20Sopenharmony_ci	ret = clk_prepare_enable(data->clk_cdev1);
2148c2ecf20Sopenharmony_ci	if (ret) {
2158c2ecf20Sopenharmony_ci		dev_err(data->dev, "Can't enable cdev1: %d\n", ret);
2168c2ecf20Sopenharmony_ci		return ret;
2178c2ecf20Sopenharmony_ci	}
2188c2ecf20Sopenharmony_ci
2198c2ecf20Sopenharmony_ci	return 0;
2208c2ecf20Sopenharmony_ci}
2218c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(tegra_asoc_utils_init);
2228c2ecf20Sopenharmony_ci
2238c2ecf20Sopenharmony_ciMODULE_AUTHOR("Stephen Warren <swarren@nvidia.com>");
2248c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("Tegra ASoC utility code");
2258c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL");
226