GitHub-Mirror/Star64_linux
2
0
Fork 0
mirror of https://github.com/Fishwaldo/Star64_linux.git synced 2025-06-19 13:11:14 +00:00
Code Issues Projects Releases Packages Wiki Activity Actions

clk: at91: audio-pll: separate registration from DT parsing

Browse source 
Separate registration out of of_sama5d2_clk_audio_pll*_setup to allow other
code to use it.

Signed-off-by: Alexandre Belloni <alexandre.belloni@bootlin.com>
[sboyd@kernel.org: Include pmc.h]
Signed-off-by: Stephen Boyd <sboyd@kernel.org>
This commit is contained in:
Alexandre Belloni 2018-10-16 16:21:42 +02:00 • committed by Stephen Boyd
parent 61170a9373
commit 08979ee55a
1 changed files with 119 additions and 46 deletions
Download patch file Download diff file Expand all files Collapse all files

165
drivers/clk/at91/clk-audio-pll.c
View file

@ -43,6 +43,8 @@
#include <linux/regmap.h> #include <linux/regmap.h>
#include <linux/slab.h> #include <linux/slab.h>
#include "pmc.h"
#define AUDIO_PLL_DIV_FRAC BIT(22) #define AUDIO_PLL_DIV_FRAC BIT(22)
#define AUDIO_PLL_ND_MAX (AT91_PMC_AUDIO_PLL_ND_MASK >> \ #define AUDIO_PLL_ND_MAX (AT91_PMC_AUDIO_PLL_ND_MASK >> \
AT91_PMC_AUDIO_PLL_ND_OFFSET) AT91_PMC_AUDIO_PLL_ND_OFFSET)
@ -444,85 +446,156 @@ static const struct clk_ops audio_pll_pmc_ops = {
.set_rate = clk_audio_pll_pmc_set_rate, .set_rate = clk_audio_pll_pmc_set_rate,
}; };
static int of_sama5d2_clk_audio_pll_setup(struct device_node *np, struct clk_hw * __init
struct clk_init_data *init, at91_clk_register_audio_pll_frac(struct regmap *regmap, const char *name,
struct clk_hw *hw, const char *parent_name)
struct regmap **clk_audio_regmap)
{ {
struct regmap *regmap; struct clk_audio_frac *frac_ck;
const char *parent_names[1]; struct clk_init_data init = {};
int ret; int ret;
regmap = syscon_node_to_regmap(of_get_parent(np)); frac_ck = kzalloc(sizeof(*frac_ck), GFP_KERNEL);
if (IS_ERR(regmap)) if (!frac_ck)
return PTR_ERR(regmap); return ERR_PTR(-ENOMEM);
init->name = np->name; init.name = name;
of_clk_parent_fill(np, parent_names, 1); init.ops = &audio_pll_frac_ops;
init->parent_names = parent_names; init.parent_names = &parent_name;
init->num_parents = 1; init.num_parents = 1;
init.flags = CLK_SET_RATE_GATE;
hw->init = init; frac_ck->hw.init = &init;
*clk_audio_regmap = regmap; frac_ck->regmap = regmap;
ret = clk_hw_register(NULL, hw); ret = clk_hw_register(NULL, &frac_ck->hw);
if (ret) if (ret) {
return ret; kfree(frac_ck);
return ERR_PTR(ret);
}
return of_clk_add_hw_provider(np, of_clk_hw_simple_get, hw); return &frac_ck->hw;
} }
static void __init of_sama5d2_clk_audio_pll_frac_setup(struct device_node *np) static void __init of_sama5d2_clk_audio_pll_frac_setup(struct device_node *np)
{ {
struct clk_audio_frac *frac_ck; struct clk_hw *hw;
struct clk_init_data init = {}; const char *name = np->name;
const char *parent_name;
struct regmap *regmap;
frac_ck = kzalloc(sizeof(*frac_ck), GFP_KERNEL); regmap = syscon_node_to_regmap(of_get_parent(np));
if (!frac_ck) if (IS_ERR(regmap))
return; return;
init.ops = &audio_pll_frac_ops; parent_name = of_clk_get_parent_name(np, 0);
init.flags = CLK_SET_RATE_GATE;
if (of_sama5d2_clk_audio_pll_setup(np, &init, &frac_ck->hw, hw = at91_clk_register_audio_pll_frac(regmap, name, parent_name);
&frac_ck->regmap)) if (IS_ERR(hw))
kfree(frac_ck); return;
of_clk_add_hw_provider(np, of_clk_hw_simple_get, hw);
}
struct clk_hw * __init
at91_clk_register_audio_pll_pad(struct regmap *regmap, const char *name,
const char *parent_name)
{
struct clk_audio_pad *apad_ck;
struct clk_init_data init;
int ret;
apad_ck = kzalloc(sizeof(*apad_ck), GFP_KERNEL);
if (!apad_ck)
return ERR_PTR(-ENOMEM);
init.name = name;
init.ops = &audio_pll_pad_ops;
init.parent_names = &parent_name;
init.num_parents = 1;
init.flags = CLK_SET_RATE_GATE | CLK_SET_PARENT_GATE |
CLK_SET_RATE_PARENT;
apad_ck->hw.init = &init;
apad_ck->regmap = regmap;
ret = clk_hw_register(NULL, &apad_ck->hw);
if (ret) {
kfree(apad_ck);
return ERR_PTR(ret);
}
return &apad_ck->hw;
} }
static void __init of_sama5d2_clk_audio_pll_pad_setup(struct device_node *np) static void __init of_sama5d2_clk_audio_pll_pad_setup(struct device_node *np)
{ {
struct clk_audio_pad *apad_ck; struct clk_hw *hw;
struct clk_init_data init = {}; const char *name = np->name;
const char *parent_name;
struct regmap *regmap;
apad_ck = kzalloc(sizeof(*apad_ck), GFP_KERNEL); regmap = syscon_node_to_regmap(of_get_parent(np));
if (!apad_ck) if (IS_ERR(regmap))
return; return;
init.ops = &audio_pll_pad_ops; parent_name = of_clk_get_parent_name(np, 0);
hw = at91_clk_register_audio_pll_pad(regmap, name, parent_name);
if (IS_ERR(hw))
return;
of_clk_add_hw_provider(np, of_clk_hw_simple_get, hw);
}
struct clk_hw * __init
at91_clk_register_audio_pll_pmc(struct regmap *regmap, const char *name,
const char *parent_name)
{
struct clk_audio_pmc *apmc_ck;
struct clk_init_data init;
int ret;
apmc_ck = kzalloc(sizeof(*apmc_ck), GFP_KERNEL);
if (!apmc_ck)
return ERR_PTR(-ENOMEM);
init.name = name;
init.ops = &audio_pll_pmc_ops;
init.parent_names = &parent_name;
init.num_parents = 1;
init.flags = CLK_SET_RATE_GATE | CLK_SET_PARENT_GATE | init.flags = CLK_SET_RATE_GATE | CLK_SET_PARENT_GATE |
CLK_SET_RATE_PARENT; CLK_SET_RATE_PARENT;
if (of_sama5d2_clk_audio_pll_setup(np, &init, &apad_ck->hw, apmc_ck->hw.init = &init;
&apad_ck->regmap)) apmc_ck->regmap = regmap;
kfree(apad_ck);
ret = clk_hw_register(NULL, &apmc_ck->hw);
if (ret) {
kfree(apmc_ck);
return ERR_PTR(ret);
}
return &apmc_ck->hw;
} }
static void __init of_sama5d2_clk_audio_pll_pmc_setup(struct device_node *np) static void __init of_sama5d2_clk_audio_pll_pmc_setup(struct device_node *np)
{ {
struct clk_audio_pmc *apmc_ck; struct clk_hw *hw;
struct clk_init_data init = {}; const char *name = np->name;
const char *parent_name;
struct regmap *regmap;
apmc_ck = kzalloc(sizeof(*apmc_ck), GFP_KERNEL); regmap = syscon_node_to_regmap(of_get_parent(np));
if (!apmc_ck) if (IS_ERR(regmap))
return; return;
init.ops = &audio_pll_pmc_ops; parent_name = of_clk_get_parent_name(np, 0);
init.flags = CLK_SET_RATE_GATE | CLK_SET_PARENT_GATE |
CLK_SET_RATE_PARENT;
if (of_sama5d2_clk_audio_pll_setup(np, &init, &apmc_ck->hw, hw = at91_clk_register_audio_pll_pmc(regmap, name, parent_name);
&apmc_ck->regmap)) if (IS_ERR(hw))
kfree(apmc_ck); return;
of_clk_add_hw_provider(np, of_clk_hw_simple_get, hw);
} }
CLK_OF_DECLARE(of_sama5d2_clk_audio_pll_frac_setup, CLK_OF_DECLARE(of_sama5d2_clk_audio_pll_frac_setup,