phy: ti-pipe3: move clk initialization to a separate function
No functional change. Moved clock initialization done in probe to a separate function as part of cleaning up ti_pipe3_probe. Signed-off-by: Kishon Vijay Abraham I <kishon@ti.com>
This commit is contained in:
parent
d65ff52eb8
commit
234738ea33
|
@ -308,48 +308,11 @@ static const struct phy_ops ops = {
|
||||||
|
|
||||||
static const struct of_device_id ti_pipe3_id_table[];
|
static const struct of_device_id ti_pipe3_id_table[];
|
||||||
|
|
||||||
static int ti_pipe3_probe(struct platform_device *pdev)
|
static int ti_pipe3_get_clk(struct ti_pipe3 *phy)
|
||||||
{
|
{
|
||||||
struct ti_pipe3 *phy;
|
|
||||||
struct phy *generic_phy;
|
|
||||||
struct phy_provider *phy_provider;
|
|
||||||
struct resource *res;
|
|
||||||
struct device_node *node = pdev->dev.of_node;
|
|
||||||
struct device_node *control_node;
|
|
||||||
struct platform_device *control_pdev;
|
|
||||||
const struct of_device_id *match;
|
|
||||||
struct clk *clk;
|
struct clk *clk;
|
||||||
struct device *dev = &pdev->dev;
|
struct device *dev = phy->dev;
|
||||||
|
struct device_node *node = dev->of_node;
|
||||||
phy = devm_kzalloc(dev, sizeof(*phy), GFP_KERNEL);
|
|
||||||
if (!phy)
|
|
||||||
return -ENOMEM;
|
|
||||||
|
|
||||||
phy->dev = dev;
|
|
||||||
|
|
||||||
if (!of_device_is_compatible(node, "ti,phy-pipe3-pcie")) {
|
|
||||||
match = of_match_device(ti_pipe3_id_table, dev);
|
|
||||||
if (!match)
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
phy->dpll_map = (struct pipe3_dpll_map *)match->data;
|
|
||||||
if (!phy->dpll_map) {
|
|
||||||
dev_err(dev, "no DPLL data\n");
|
|
||||||
return -EINVAL;
|
|
||||||
}
|
|
||||||
|
|
||||||
res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
|
|
||||||
"pll_ctrl");
|
|
||||||
phy->pll_ctrl_base = devm_ioremap_resource(dev, res);
|
|
||||||
if (IS_ERR(phy->pll_ctrl_base))
|
|
||||||
return PTR_ERR(phy->pll_ctrl_base);
|
|
||||||
|
|
||||||
phy->sys_clk = devm_clk_get(dev, "sysclk");
|
|
||||||
if (IS_ERR(phy->sys_clk)) {
|
|
||||||
dev_err(dev, "unable to get sysclk\n");
|
|
||||||
return -EINVAL;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
phy->refclk = devm_clk_get(dev, "refclk");
|
phy->refclk = devm_clk_get(dev, "refclk");
|
||||||
if (IS_ERR(phy->refclk)) {
|
if (IS_ERR(phy->refclk)) {
|
||||||
|
@ -369,25 +332,17 @@ static int ti_pipe3_probe(struct platform_device *pdev)
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
phy->wkupclk = ERR_PTR(-ENODEV);
|
phy->wkupclk = ERR_PTR(-ENODEV);
|
||||||
phy->dpll_reset_syscon = syscon_regmap_lookup_by_phandle(node,
|
}
|
||||||
"syscon-pllreset");
|
|
||||||
if (IS_ERR(phy->dpll_reset_syscon)) {
|
if (!of_device_is_compatible(node, "ti,phy-pipe3-pcie")) {
|
||||||
dev_info(dev,
|
phy->sys_clk = devm_clk_get(dev, "sysclk");
|
||||||
"can't get syscon-pllreset, sata dpll won't idle\n");
|
if (IS_ERR(phy->sys_clk)) {
|
||||||
phy->dpll_reset_syscon = NULL;
|
dev_err(dev, "unable to get sysclk\n");
|
||||||
} else {
|
return -EINVAL;
|
||||||
if (of_property_read_u32_index(node,
|
|
||||||
"syscon-pllreset", 1,
|
|
||||||
&phy->dpll_reset_reg)) {
|
|
||||||
dev_err(dev,
|
|
||||||
"couldn't get pllreset reg. offset\n");
|
|
||||||
return -EINVAL;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
if (of_device_is_compatible(node, "ti,phy-pipe3-pcie")) {
|
if (of_device_is_compatible(node, "ti,phy-pipe3-pcie")) {
|
||||||
|
|
||||||
clk = devm_clk_get(dev, "dpll_ref");
|
clk = devm_clk_get(dev, "dpll_ref");
|
||||||
if (IS_ERR(clk)) {
|
if (IS_ERR(clk)) {
|
||||||
dev_err(dev, "unable to get dpll ref clk\n");
|
dev_err(dev, "unable to get dpll ref clk\n");
|
||||||
|
@ -418,6 +373,68 @@ static int ti_pipe3_probe(struct platform_device *pdev)
|
||||||
phy->div_clk = ERR_PTR(-ENODEV);
|
phy->div_clk = ERR_PTR(-ENODEV);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int ti_pipe3_probe(struct platform_device *pdev)
|
||||||
|
{
|
||||||
|
struct ti_pipe3 *phy;
|
||||||
|
struct phy *generic_phy;
|
||||||
|
struct phy_provider *phy_provider;
|
||||||
|
struct resource *res;
|
||||||
|
struct device_node *node = pdev->dev.of_node;
|
||||||
|
struct device_node *control_node;
|
||||||
|
struct platform_device *control_pdev;
|
||||||
|
const struct of_device_id *match;
|
||||||
|
struct device *dev = &pdev->dev;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
phy = devm_kzalloc(dev, sizeof(*phy), GFP_KERNEL);
|
||||||
|
if (!phy)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
phy->dev = dev;
|
||||||
|
|
||||||
|
if (!of_device_is_compatible(node, "ti,phy-pipe3-pcie")) {
|
||||||
|
match = of_match_device(ti_pipe3_id_table, dev);
|
||||||
|
if (!match)
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
phy->dpll_map = (struct pipe3_dpll_map *)match->data;
|
||||||
|
if (!phy->dpll_map) {
|
||||||
|
dev_err(dev, "no DPLL data\n");
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
|
||||||
|
"pll_ctrl");
|
||||||
|
phy->pll_ctrl_base = devm_ioremap_resource(dev, res);
|
||||||
|
if (IS_ERR(phy->pll_ctrl_base))
|
||||||
|
return PTR_ERR(phy->pll_ctrl_base);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (of_device_is_compatible(node, "ti,phy-pipe3-sata")) {
|
||||||
|
phy->dpll_reset_syscon = syscon_regmap_lookup_by_phandle(node,
|
||||||
|
"syscon-pllreset");
|
||||||
|
if (IS_ERR(phy->dpll_reset_syscon)) {
|
||||||
|
dev_info(dev,
|
||||||
|
"can't get syscon-pllreset, sata dpll won't idle\n");
|
||||||
|
phy->dpll_reset_syscon = NULL;
|
||||||
|
} else {
|
||||||
|
if (of_property_read_u32_index(node,
|
||||||
|
"syscon-pllreset", 1,
|
||||||
|
&phy->dpll_reset_reg)) {
|
||||||
|
dev_err(dev,
|
||||||
|
"couldn't get pllreset reg. offset\n");
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
ret = ti_pipe3_get_clk(phy);
|
||||||
|
if (ret)
|
||||||
|
return ret;
|
||||||
|
|
||||||
control_node = of_parse_phandle(node, "ctrl-module", 0);
|
control_node = of_parse_phandle(node, "ctrl-module", 0);
|
||||||
if (!control_node) {
|
if (!control_node) {
|
||||||
dev_err(dev, "Failed to get control device phandle\n");
|
dev_err(dev, "Failed to get control device phandle\n");
|
||||||
|
|
Loading…
Reference in New Issue