#define DRV_NAME "tegra-snd-harmony"
struct tegra_harmony {
+ struct tegra_asoc_utils_data util_data;
struct harmony_audio_platform_data *pdata;
int gpio_spkr_en_requested;
};
struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
struct snd_soc_codec *codec = rtd->codec;
struct snd_soc_card *card = codec->card;
+ struct tegra_harmony *harmony = snd_soc_card_get_drvdata(card);
int srate, mclk, mclk_change;
int err;
while (mclk < 6000000)
mclk *= 2;
- err = tegra_asoc_utils_set_rate(srate, mclk, &mclk_change);
+ err = tegra_asoc_utils_set_rate(&harmony->util_data, srate, mclk,
+ &mclk_change);
if (err < 0) {
dev_err(card->dev, "Can't configure clocks\n");
return err;
harmony->pdata = pdata;
- ret = tegra_asoc_utils_init();
+ ret = tegra_asoc_utils_init(&harmony->util_data, &pdev->dev);
if (ret)
goto err_free_harmony;
snd_soc_card_set_drvdata(card, NULL);
platform_set_drvdata(pdev, NULL);
card->dev = NULL;
- tegra_asoc_utils_fini();
+ tegra_asoc_utils_fini(&harmony->util_data);
err_free_harmony:
kfree(harmony);
return ret;
platform_set_drvdata(pdev, NULL);
card->dev = NULL;
- tegra_asoc_utils_fini();
+ tegra_asoc_utils_fini(&harmony->util_data);
if (harmony->gpio_spkr_en_requested)
gpio_free(pdata->gpio_spkr_en);
*/
#include <linux/clk.h>
+#include <linux/device.h>
#include <linux/err.h>
#include <linux/kernel.h>
#include "tegra_asoc_utils.h"
-#define PREFIX "ASoC Tegra: "
-
-static struct clk *clk_pll_a;
-static struct clk *clk_pll_a_out0;
-static struct clk *clk_cdev1;
-
-static int set_baseclock, set_mclk;
-
-int tegra_asoc_utils_set_rate(int srate, int mclk, int *mclk_change)
+int tegra_asoc_utils_set_rate(struct tegra_asoc_utils_data *data, int srate,
+ int mclk, int *mclk_change)
{
int new_baseclock;
int err;
return -EINVAL;
}
- *mclk_change = ((new_baseclock != set_baseclock) ||
- (mclk != set_mclk));
+ *mclk_change = ((new_baseclock != data->set_baseclock) ||
+ (mclk != data->set_mclk));
if (!*mclk_change)
return 0;
- set_baseclock = 0;
- set_mclk = 0;
+ data->set_baseclock = 0;
+ data->set_mclk = 0;
- clk_disable(clk_cdev1);
- clk_disable(clk_pll_a_out0);
- clk_disable(clk_pll_a);
+ clk_disable(data->clk_cdev1);
+ clk_disable(data->clk_pll_a_out0);
+ clk_disable(data->clk_pll_a);
- err = clk_set_rate(clk_pll_a, new_baseclock);
+ err = clk_set_rate(data->clk_pll_a, new_baseclock);
if (err) {
- pr_err(PREFIX "Can't set pll_a rate: %d\n", err);
+ dev_err(data->dev, "Can't set pll_a rate: %d\n", err);
return err;
}
- err = clk_set_rate(clk_pll_a_out0, mclk);
+ err = clk_set_rate(data->clk_pll_a_out0, mclk);
if (err) {
- pr_err(PREFIX "Can't set pll_a_out0 rate: %d\n", err);
+ dev_err(data->dev, "Can't set pll_a_out0 rate: %d\n", err);
return err;
}
/* Don't set cdev1 rate; its locked to pll_a_out0 */
- err = clk_enable(clk_pll_a);
+ err = clk_enable(data->clk_pll_a);
if (err) {
- pr_err(PREFIX "Can't enable pll_a: %d\n", err);
+ dev_err(data->dev, "Can't enable pll_a: %d\n", err);
return err;
}
- err = clk_enable(clk_pll_a_out0);
+ err = clk_enable(data->clk_pll_a_out0);
if (err) {
- pr_err(PREFIX "Can't enable pll_a_out0: %d\n", err);
+ dev_err(data->dev, "Can't enable pll_a_out0: %d\n", err);
return err;
}
- err = clk_enable(clk_cdev1);
+ err = clk_enable(data->clk_cdev1);
if (err) {
- pr_err(PREFIX "Can't enable cdev1: %d\n", err);
+ dev_err(data->dev, "Can't enable cdev1: %d\n", err);
return err;
}
- set_baseclock = new_baseclock;
- set_mclk = mclk;
+ data->set_baseclock = new_baseclock;
+ data->set_mclk = mclk;
return 0;
}
-int tegra_asoc_utils_init(void)
+int tegra_asoc_utils_init(struct tegra_asoc_utils_data *data,
+ struct device *dev)
{
int ret;
- clk_pll_a = clk_get_sys(NULL, "pll_a");
- if (IS_ERR(clk_pll_a)) {
- pr_err(PREFIX "Can't retrieve clk pll_a\n");
- ret = PTR_ERR(clk_pll_a);
+ data->dev = dev;
+
+ data->clk_pll_a = clk_get_sys(NULL, "pll_a");
+ if (IS_ERR(data->clk_pll_a)) {
+ dev_err(data->dev, "Can't retrieve clk pll_a\n");
+ ret = PTR_ERR(data->clk_pll_a);
goto err;
}
- clk_pll_a_out0 = clk_get_sys(NULL, "pll_a_out0");
- if (IS_ERR(clk_pll_a_out0)) {
- pr_err(PREFIX "Can't retrieve clk pll_a_out0\n");
- ret = PTR_ERR(clk_pll_a_out0);
+ data->clk_pll_a_out0 = clk_get_sys(NULL, "pll_a_out0");
+ if (IS_ERR(data->clk_pll_a_out0)) {
+ dev_err(data->dev, "Can't retrieve clk pll_a_out0\n");
+ ret = PTR_ERR(data->clk_pll_a_out0);
goto err_put_pll_a;
}
- clk_cdev1 = clk_get_sys(NULL, "cdev1");
- if (IS_ERR(clk_cdev1)) {
- pr_err(PREFIX "Can't retrieve clk cdev1\n");
- ret = PTR_ERR(clk_cdev1);
+ data->clk_cdev1 = clk_get_sys(NULL, "cdev1");
+ if (IS_ERR(data->clk_cdev1)) {
+ dev_err(data->dev, "Can't retrieve clk cdev1\n");
+ ret = PTR_ERR(data->clk_cdev1);
goto err_put_pll_a_out0;
}
return 0;
err_put_pll_a_out0:
- clk_put(clk_pll_a_out0);
+ clk_put(data->clk_pll_a_out0);
err_put_pll_a:
- clk_put(clk_pll_a);
+ clk_put(data->clk_pll_a);
err:
return ret;
}
-void tegra_asoc_utils_fini(void)
+void tegra_asoc_utils_fini(struct tegra_asoc_utils_data *data)
{
- clk_put(clk_cdev1);
- clk_put(clk_pll_a_out0);
- clk_put(clk_pll_a);
+ clk_put(data->clk_cdev1);
+ clk_put(data->clk_pll_a_out0);
+ clk_put(data->clk_pll_a);
}