clk/actions/owl-common.c

0001 // SPDX-License-Identifier: GPL-2.0+
0002 //
0003 // OWL common clock driver
0004 //
0005 // Copyright (c) 2014 Actions Semi Inc.
0006 // Author: David Liu <liuwei@actions-semi.com>
0007 //
0008 // Copyright (c) 2018 Linaro Ltd.
0009 // Author: Manivannan Sadhasivam <manivannan.sadhasivam@linaro.org>
0010
0011 #include <linux/of_address.h>
0012 #include <linux/of_platform.h>
0013 #include <linux/platform_device.h>
0014 #include <linux/regmap.h>
0015
0016 #include "owl-common.h"
0017
0018 static const struct regmap_config owl_regmap_config = {
0019     .reg_bits   = 32,
0020     .reg_stride = 4,
0021     .val_bits   = 32,
0022     .max_register   = 0x00cc,
0023     .fast_io    = true,
0024 };
0025
0026 static void owl_clk_set_regmap(const struct owl_clk_desc *desc,
0027              struct regmap *regmap)
0028 {
0029     int i;
0030     struct owl_clk_common *clks;
0031
0032     for (i = 0; i < desc->num_clks; i++) {
0033         clks = desc->clks[i];
0034         if (!clks)
0035             continue;
0036
0037         clks->regmap = regmap;
0038     }
0039 }
0040
0041 int owl_clk_regmap_init(struct platform_device *pdev,
0042             struct owl_clk_desc *desc)
0043 {
0044     void __iomem *base;
0045     struct regmap *regmap;
0046     struct resource *res;
0047
0048     res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
0049     base = devm_ioremap_resource(&pdev->dev, res);
0050     if (IS_ERR(base))
0051         return PTR_ERR(base);
0052
0053     regmap = devm_regmap_init_mmio(&pdev->dev, base, &owl_regmap_config);
0054     if (IS_ERR(regmap)) {
0055         pr_err("failed to init regmap\n");
0056         return PTR_ERR(regmap);
0057     }
0058
0059     owl_clk_set_regmap(desc, regmap);
0060     desc->regmap = regmap;
0061
0062     return 0;
0063 }
0064
0065 int owl_clk_probe(struct device *dev, struct clk_hw_onecell_data *hw_clks)
0066 {
0067     int i, ret;
0068     struct clk_hw *hw;
0069
0070     for (i = 0; i < hw_clks->num; i++) {
0071         const char *name;
0072
0073         hw = hw_clks->hws[i];
0074         if (IS_ERR_OR_NULL(hw))
0075             continue;
0076
0077         name = hw->init->name;
0078         ret = devm_clk_hw_register(dev, hw);
0079         if (ret) {
0080             dev_err(dev, "Couldn't register clock %d - %s\n",
0081                 i, name);
0082             return ret;
0083         }
0084     }
0085
0086     ret = devm_of_clk_add_hw_provider(dev, of_clk_hw_onecell_get, hw_clks);
0087     if (ret)
0088         dev_err(dev, "Failed to add clock provider\n");
0089
0090     return ret;
0091 }