mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-09-22 04:31:58 +08:00
f5072cffb3
The .remove() callback for a platform driver returns an int which makes
many driver authors wrongly assume it's possible to do error handling by
returning an error code. However the value returned is ignored (apart
from emitting a warning) and this typically results in resource leaks.
To improve here there is a quest to make the remove callback return
void. In the first step of this quest all drivers are converted to
.remove_new(), which already returns void. Eventually after all drivers
are converted, .remove_new() will be renamed to .remove().
Trivially convert this driver from always returning zero in the remove
callback to the void returning variant.
Fixes: 1496dd413b ("clk: imx: imx8mp: Add pm_runtime support for power saving")
Signed-off-by: Uwe Kleine-König <u.kleine-koenig@pengutronix.de>
Reviewed-by: Abel Vesa <abel.vesa@linaro.org>
Link: https://lore.kernel.org/r/20240423071232.463201-2-u.kleine-koenig@pengutronix.de
Signed-off-by: Abel Vesa <abel.vesa@linaro.org>
396 lines
10 KiB
C
396 lines
10 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* Driver for i.MX8M Plus Audio BLK_CTRL
|
|
*
|
|
* Copyright (C) 2022 Marek Vasut <marex@denx.de>
|
|
*/
|
|
|
|
#include <linux/clk-provider.h>
|
|
#include <linux/device.h>
|
|
#include <linux/io.h>
|
|
#include <linux/mod_devicetable.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/pm_runtime.h>
|
|
|
|
#include <dt-bindings/clock/imx8mp-clock.h>
|
|
|
|
#include "clk.h"
|
|
|
|
#define CLKEN0 0x000
|
|
#define CLKEN1 0x004
|
|
#define EARC 0x200
|
|
#define SAI1_MCLK_SEL 0x300
|
|
#define SAI2_MCLK_SEL 0x304
|
|
#define SAI3_MCLK_SEL 0x308
|
|
#define SAI5_MCLK_SEL 0x30C
|
|
#define SAI6_MCLK_SEL 0x310
|
|
#define SAI7_MCLK_SEL 0x314
|
|
#define PDM_SEL 0x318
|
|
#define SAI_PLL_GNRL_CTL 0x400
|
|
#define SAI_PLL_FDIVL_CTL0 0x404
|
|
#define SAI_PLL_FDIVL_CTL1 0x408
|
|
#define SAI_PLL_SSCG_CTL 0x40C
|
|
#define SAI_PLL_MNIT_CTL 0x410
|
|
#define IPG_LP_CTRL 0x504
|
|
|
|
#define SAIn_MCLK1_PARENT(n) \
|
|
static const struct clk_parent_data \
|
|
clk_imx8mp_audiomix_sai##n##_mclk1_parents[] = { \
|
|
{ \
|
|
.fw_name = "sai"__stringify(n), \
|
|
.name = "sai"__stringify(n) \
|
|
}, { \
|
|
.fw_name = "sai"__stringify(n)"_mclk", \
|
|
.name = "sai"__stringify(n)"_mclk" \
|
|
}, \
|
|
}
|
|
|
|
SAIn_MCLK1_PARENT(1);
|
|
SAIn_MCLK1_PARENT(2);
|
|
SAIn_MCLK1_PARENT(3);
|
|
SAIn_MCLK1_PARENT(5);
|
|
SAIn_MCLK1_PARENT(6);
|
|
SAIn_MCLK1_PARENT(7);
|
|
|
|
static const struct clk_parent_data clk_imx8mp_audiomix_sai_mclk2_parents[] = {
|
|
{ .fw_name = "sai1", .name = "sai1" },
|
|
{ .fw_name = "sai2", .name = "sai2" },
|
|
{ .fw_name = "sai3", .name = "sai3" },
|
|
{ .name = "dummy" },
|
|
{ .fw_name = "sai5", .name = "sai5" },
|
|
{ .fw_name = "sai6", .name = "sai6" },
|
|
{ .fw_name = "sai7", .name = "sai7" },
|
|
{ .fw_name = "sai1_mclk", .name = "sai1_mclk" },
|
|
{ .fw_name = "sai2_mclk", .name = "sai2_mclk" },
|
|
{ .fw_name = "sai3_mclk", .name = "sai3_mclk" },
|
|
{ .name = "dummy" },
|
|
{ .fw_name = "sai5_mclk", .name = "sai5_mclk" },
|
|
{ .fw_name = "sai6_mclk", .name = "sai6_mclk" },
|
|
{ .fw_name = "sai7_mclk", .name = "sai7_mclk" },
|
|
{ .fw_name = "spdif_extclk", .name = "spdif_extclk" },
|
|
{ .name = "dummy" },
|
|
};
|
|
|
|
static const struct clk_parent_data clk_imx8mp_audiomix_pdm_parents[] = {
|
|
{ .fw_name = "pdm", .name = "pdm" },
|
|
{ .name = "sai_pll_out_div2" },
|
|
{ .fw_name = "sai1_mclk", .name = "sai1_mclk" },
|
|
{ .name = "dummy" },
|
|
};
|
|
|
|
|
|
static const struct clk_parent_data clk_imx8mp_audiomix_pll_parents[] = {
|
|
{ .fw_name = "osc_24m", .name = "osc_24m" },
|
|
{ .name = "dummy" },
|
|
{ .name = "dummy" },
|
|
{ .name = "dummy" },
|
|
};
|
|
|
|
static const struct clk_parent_data clk_imx8mp_audiomix_pll_bypass_sels[] = {
|
|
{ .fw_name = "sai_pll", .name = "sai_pll" },
|
|
{ .fw_name = "sai_pll_ref_sel", .name = "sai_pll_ref_sel" },
|
|
};
|
|
|
|
#define CLK_GATE(gname, cname) \
|
|
{ \
|
|
gname"_cg", \
|
|
IMX8MP_CLK_AUDIOMIX_##cname, \
|
|
{ .fw_name = "ahb", .name = "ahb" }, NULL, 1, \
|
|
CLKEN0 + 4 * !!(IMX8MP_CLK_AUDIOMIX_##cname / 32), \
|
|
1, IMX8MP_CLK_AUDIOMIX_##cname % 32 \
|
|
}
|
|
|
|
#define CLK_SAIn(n) \
|
|
{ \
|
|
"sai"__stringify(n)"_mclk1_sel", \
|
|
IMX8MP_CLK_AUDIOMIX_SAI##n##_MCLK1_SEL, {}, \
|
|
clk_imx8mp_audiomix_sai##n##_mclk1_parents, \
|
|
ARRAY_SIZE(clk_imx8mp_audiomix_sai##n##_mclk1_parents), \
|
|
SAI##n##_MCLK_SEL, 1, 0 \
|
|
}, { \
|
|
"sai"__stringify(n)"_mclk2_sel", \
|
|
IMX8MP_CLK_AUDIOMIX_SAI##n##_MCLK2_SEL, {}, \
|
|
clk_imx8mp_audiomix_sai_mclk2_parents, \
|
|
ARRAY_SIZE(clk_imx8mp_audiomix_sai_mclk2_parents), \
|
|
SAI##n##_MCLK_SEL, 4, 1 \
|
|
}, { \
|
|
"sai"__stringify(n)"_ipg_cg", \
|
|
IMX8MP_CLK_AUDIOMIX_SAI##n##_IPG, \
|
|
{ .fw_name = "ahb", .name = "ahb" }, NULL, 1, \
|
|
CLKEN0, 1, IMX8MP_CLK_AUDIOMIX_SAI##n##_IPG \
|
|
}, { \
|
|
"sai"__stringify(n)"_mclk1_cg", \
|
|
IMX8MP_CLK_AUDIOMIX_SAI##n##_MCLK1, \
|
|
{ \
|
|
.fw_name = "sai"__stringify(n)"_mclk1_sel", \
|
|
.name = "sai"__stringify(n)"_mclk1_sel" \
|
|
}, NULL, 1, \
|
|
CLKEN0, 1, IMX8MP_CLK_AUDIOMIX_SAI##n##_MCLK1 \
|
|
}, { \
|
|
"sai"__stringify(n)"_mclk2_cg", \
|
|
IMX8MP_CLK_AUDIOMIX_SAI##n##_MCLK2, \
|
|
{ \
|
|
.fw_name = "sai"__stringify(n)"_mclk2_sel", \
|
|
.name = "sai"__stringify(n)"_mclk2_sel" \
|
|
}, NULL, 1, \
|
|
CLKEN0, 1, IMX8MP_CLK_AUDIOMIX_SAI##n##_MCLK2 \
|
|
}, { \
|
|
"sai"__stringify(n)"_mclk3_cg", \
|
|
IMX8MP_CLK_AUDIOMIX_SAI##n##_MCLK3, \
|
|
{ \
|
|
.fw_name = "sai_pll_out_div2", \
|
|
.name = "sai_pll_out_div2" \
|
|
}, NULL, 1, \
|
|
CLKEN0, 1, IMX8MP_CLK_AUDIOMIX_SAI##n##_MCLK3 \
|
|
}
|
|
|
|
#define CLK_PDM \
|
|
{ \
|
|
"pdm_sel", IMX8MP_CLK_AUDIOMIX_PDM_SEL, {}, \
|
|
clk_imx8mp_audiomix_pdm_parents, \
|
|
ARRAY_SIZE(clk_imx8mp_audiomix_pdm_parents), \
|
|
PDM_SEL, 2, 0 \
|
|
}
|
|
|
|
struct clk_imx8mp_audiomix_sel {
|
|
const char *name;
|
|
int clkid;
|
|
const struct clk_parent_data parent; /* For gate */
|
|
const struct clk_parent_data *parents; /* For mux */
|
|
int num_parents;
|
|
u16 reg;
|
|
u8 width;
|
|
u8 shift;
|
|
};
|
|
|
|
static struct clk_imx8mp_audiomix_sel sels[] = {
|
|
CLK_GATE("asrc", ASRC_IPG),
|
|
CLK_GATE("pdm", PDM_IPG),
|
|
CLK_GATE("earc", EARC_IPG),
|
|
CLK_GATE("ocrama", OCRAMA_IPG),
|
|
CLK_GATE("aud2htx", AUD2HTX_IPG),
|
|
CLK_GATE("earc_phy", EARC_PHY),
|
|
CLK_GATE("sdma2", SDMA2_ROOT),
|
|
CLK_GATE("sdma3", SDMA3_ROOT),
|
|
CLK_GATE("spba2", SPBA2_ROOT),
|
|
CLK_GATE("dsp", DSP_ROOT),
|
|
CLK_GATE("dspdbg", DSPDBG_ROOT),
|
|
CLK_GATE("edma", EDMA_ROOT),
|
|
CLK_GATE("audpll", AUDPLL_ROOT),
|
|
CLK_GATE("mu2", MU2_ROOT),
|
|
CLK_GATE("mu3", MU3_ROOT),
|
|
CLK_PDM,
|
|
CLK_SAIn(1),
|
|
CLK_SAIn(2),
|
|
CLK_SAIn(3),
|
|
CLK_SAIn(5),
|
|
CLK_SAIn(6),
|
|
CLK_SAIn(7)
|
|
};
|
|
|
|
static const u16 audiomix_regs[] = {
|
|
CLKEN0,
|
|
CLKEN1,
|
|
EARC,
|
|
SAI1_MCLK_SEL,
|
|
SAI2_MCLK_SEL,
|
|
SAI3_MCLK_SEL,
|
|
SAI5_MCLK_SEL,
|
|
SAI6_MCLK_SEL,
|
|
SAI7_MCLK_SEL,
|
|
PDM_SEL,
|
|
SAI_PLL_GNRL_CTL,
|
|
SAI_PLL_FDIVL_CTL0,
|
|
SAI_PLL_FDIVL_CTL1,
|
|
SAI_PLL_SSCG_CTL,
|
|
SAI_PLL_MNIT_CTL,
|
|
IPG_LP_CTRL,
|
|
};
|
|
|
|
struct clk_imx8mp_audiomix_priv {
|
|
void __iomem *base;
|
|
u32 regs_save[ARRAY_SIZE(audiomix_regs)];
|
|
|
|
/* Must be last */
|
|
struct clk_hw_onecell_data clk_data;
|
|
};
|
|
|
|
static void clk_imx8mp_audiomix_save_restore(struct device *dev, bool save)
|
|
{
|
|
struct clk_imx8mp_audiomix_priv *priv = dev_get_drvdata(dev);
|
|
void __iomem *base = priv->base;
|
|
int i;
|
|
|
|
if (save) {
|
|
for (i = 0; i < ARRAY_SIZE(audiomix_regs); i++)
|
|
priv->regs_save[i] = readl(base + audiomix_regs[i]);
|
|
} else {
|
|
for (i = 0; i < ARRAY_SIZE(audiomix_regs); i++)
|
|
writel(priv->regs_save[i], base + audiomix_regs[i]);
|
|
}
|
|
}
|
|
|
|
static int clk_imx8mp_audiomix_probe(struct platform_device *pdev)
|
|
{
|
|
struct clk_imx8mp_audiomix_priv *priv;
|
|
struct clk_hw_onecell_data *clk_hw_data;
|
|
struct device *dev = &pdev->dev;
|
|
void __iomem *base;
|
|
struct clk_hw *hw;
|
|
int i, ret;
|
|
|
|
priv = devm_kzalloc(dev,
|
|
struct_size(priv, clk_data.hws, IMX8MP_CLK_AUDIOMIX_END),
|
|
GFP_KERNEL);
|
|
if (!priv)
|
|
return -ENOMEM;
|
|
|
|
clk_hw_data = &priv->clk_data;
|
|
clk_hw_data->num = IMX8MP_CLK_AUDIOMIX_END;
|
|
|
|
base = devm_platform_ioremap_resource(pdev, 0);
|
|
if (IS_ERR(base))
|
|
return PTR_ERR(base);
|
|
|
|
priv->base = base;
|
|
dev_set_drvdata(dev, priv);
|
|
|
|
/*
|
|
* pm_runtime_enable needs to be called before clk register.
|
|
* That is to make core->rpm_enabled to be true for clock
|
|
* usage.
|
|
*/
|
|
pm_runtime_get_noresume(dev);
|
|
pm_runtime_set_active(dev);
|
|
pm_runtime_enable(dev);
|
|
|
|
for (i = 0; i < ARRAY_SIZE(sels); i++) {
|
|
if (sels[i].num_parents == 1) {
|
|
hw = devm_clk_hw_register_gate_parent_data(dev,
|
|
sels[i].name, &sels[i].parent, 0,
|
|
base + sels[i].reg, sels[i].shift, 0, NULL);
|
|
} else {
|
|
hw = devm_clk_hw_register_mux_parent_data_table(dev,
|
|
sels[i].name, sels[i].parents,
|
|
sels[i].num_parents, 0,
|
|
base + sels[i].reg,
|
|
sels[i].shift, sels[i].width,
|
|
0, NULL, NULL);
|
|
}
|
|
|
|
if (IS_ERR(hw)) {
|
|
ret = PTR_ERR(hw);
|
|
goto err_clk_register;
|
|
}
|
|
|
|
clk_hw_data->hws[sels[i].clkid] = hw;
|
|
}
|
|
|
|
/* SAI PLL */
|
|
hw = devm_clk_hw_register_mux_parent_data_table(dev,
|
|
"sai_pll_ref_sel", clk_imx8mp_audiomix_pll_parents,
|
|
ARRAY_SIZE(clk_imx8mp_audiomix_pll_parents),
|
|
CLK_SET_RATE_NO_REPARENT, base + SAI_PLL_GNRL_CTL,
|
|
0, 2, 0, NULL, NULL);
|
|
clk_hw_data->hws[IMX8MP_CLK_AUDIOMIX_SAI_PLL_REF_SEL] = hw;
|
|
|
|
hw = imx_dev_clk_hw_pll14xx(dev, "sai_pll", "sai_pll_ref_sel",
|
|
base + 0x400, &imx_1443x_pll);
|
|
if (IS_ERR(hw)) {
|
|
ret = PTR_ERR(hw);
|
|
goto err_clk_register;
|
|
}
|
|
clk_hw_data->hws[IMX8MP_CLK_AUDIOMIX_SAI_PLL] = hw;
|
|
|
|
hw = devm_clk_hw_register_mux_parent_data_table(dev,
|
|
"sai_pll_bypass", clk_imx8mp_audiomix_pll_bypass_sels,
|
|
ARRAY_SIZE(clk_imx8mp_audiomix_pll_bypass_sels),
|
|
CLK_SET_RATE_NO_REPARENT | CLK_SET_RATE_PARENT,
|
|
base + SAI_PLL_GNRL_CTL, 16, 1, 0, NULL, NULL);
|
|
if (IS_ERR(hw)) {
|
|
ret = PTR_ERR(hw);
|
|
goto err_clk_register;
|
|
}
|
|
|
|
clk_hw_data->hws[IMX8MP_CLK_AUDIOMIX_SAI_PLL_BYPASS] = hw;
|
|
|
|
hw = devm_clk_hw_register_gate(dev, "sai_pll_out", "sai_pll_bypass",
|
|
0, base + SAI_PLL_GNRL_CTL, 13,
|
|
0, NULL);
|
|
if (IS_ERR(hw)) {
|
|
ret = PTR_ERR(hw);
|
|
goto err_clk_register;
|
|
}
|
|
clk_hw_data->hws[IMX8MP_CLK_AUDIOMIX_SAI_PLL_OUT] = hw;
|
|
|
|
hw = devm_clk_hw_register_fixed_factor(dev, "sai_pll_out_div2",
|
|
"sai_pll_out", 0, 1, 2);
|
|
if (IS_ERR(hw)) {
|
|
ret = PTR_ERR(hw);
|
|
goto err_clk_register;
|
|
}
|
|
|
|
ret = devm_of_clk_add_hw_provider(&pdev->dev, of_clk_hw_onecell_get,
|
|
clk_hw_data);
|
|
if (ret)
|
|
goto err_clk_register;
|
|
|
|
pm_runtime_put_sync(dev);
|
|
return 0;
|
|
|
|
err_clk_register:
|
|
pm_runtime_put_sync(dev);
|
|
pm_runtime_disable(dev);
|
|
return ret;
|
|
}
|
|
|
|
static void clk_imx8mp_audiomix_remove(struct platform_device *pdev)
|
|
{
|
|
pm_runtime_disable(&pdev->dev);
|
|
}
|
|
|
|
static int clk_imx8mp_audiomix_runtime_suspend(struct device *dev)
|
|
{
|
|
clk_imx8mp_audiomix_save_restore(dev, true);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int clk_imx8mp_audiomix_runtime_resume(struct device *dev)
|
|
{
|
|
clk_imx8mp_audiomix_save_restore(dev, false);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct dev_pm_ops clk_imx8mp_audiomix_pm_ops = {
|
|
RUNTIME_PM_OPS(clk_imx8mp_audiomix_runtime_suspend,
|
|
clk_imx8mp_audiomix_runtime_resume, NULL)
|
|
SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
|
|
pm_runtime_force_resume)
|
|
};
|
|
|
|
static const struct of_device_id clk_imx8mp_audiomix_of_match[] = {
|
|
{ .compatible = "fsl,imx8mp-audio-blk-ctrl" },
|
|
{ /* sentinel */ }
|
|
};
|
|
MODULE_DEVICE_TABLE(of, clk_imx8mp_audiomix_of_match);
|
|
|
|
static struct platform_driver clk_imx8mp_audiomix_driver = {
|
|
.probe = clk_imx8mp_audiomix_probe,
|
|
.remove_new = clk_imx8mp_audiomix_remove,
|
|
.driver = {
|
|
.name = "imx8mp-audio-blk-ctrl",
|
|
.of_match_table = clk_imx8mp_audiomix_of_match,
|
|
.pm = pm_ptr(&clk_imx8mp_audiomix_pm_ops),
|
|
},
|
|
};
|
|
|
|
module_platform_driver(clk_imx8mp_audiomix_driver);
|
|
|
|
MODULE_AUTHOR("Marek Vasut <marex@denx.de>");
|
|
MODULE_DESCRIPTION("Freescale i.MX8MP Audio Block Controller driver");
|
|
MODULE_LICENSE("GPL");
|