188e2da81SYixun Lan // SPDX-License-Identifier: GPL-2.0+ 288e2da81SYixun Lan /* 388e2da81SYixun Lan * Amlogic Meson-AXG Clock Controller Driver 488e2da81SYixun Lan * 588e2da81SYixun Lan * Copyright (c) 2016 BayLibre, SAS. 688e2da81SYixun Lan * Author: Neil Armstrong <narmstrong@baylibre.com> 788e2da81SYixun Lan * 888e2da81SYixun Lan * Copyright (c) 2018 Amlogic, inc. 988e2da81SYixun Lan * Author: Qiufang Dai <qiufang.dai@amlogic.com> 1088e2da81SYixun Lan * Author: Yixun Lan <yixun.lan@amlogic.com> 1188e2da81SYixun Lan */ 1288e2da81SYixun Lan 1388e2da81SYixun Lan #include <linux/platform_device.h> 1488e2da81SYixun Lan #include <linux/reset-controller.h> 1588e2da81SYixun Lan #include <linux/mfd/syscon.h> 1688e2da81SYixun Lan #include <linux/of_device.h> 1720425f63SKevin Hilman #include <linux/module.h> 1820425f63SKevin Hilman 19439a6bb5SJerome Brunet #include <linux/slab.h> 2088e2da81SYixun Lan #include "meson-aoclk.h" 2188e2da81SYixun Lan 2288e2da81SYixun Lan static int meson_aoclk_do_reset(struct reset_controller_dev *rcdev, 2388e2da81SYixun Lan unsigned long id) 2488e2da81SYixun Lan { 2588e2da81SYixun Lan struct meson_aoclk_reset_controller *rstc = 2688e2da81SYixun Lan container_of(rcdev, struct meson_aoclk_reset_controller, reset); 2788e2da81SYixun Lan 2888e2da81SYixun Lan return regmap_write(rstc->regmap, rstc->data->reset_reg, 2988e2da81SYixun Lan BIT(rstc->data->reset[id])); 3088e2da81SYixun Lan } 3188e2da81SYixun Lan 3288e2da81SYixun Lan static const struct reset_control_ops meson_aoclk_reset_ops = { 3388e2da81SYixun Lan .reset = meson_aoclk_do_reset, 3488e2da81SYixun Lan }; 3588e2da81SYixun Lan 3688e2da81SYixun Lan int meson_aoclkc_probe(struct platform_device *pdev) 3788e2da81SYixun Lan { 3888e2da81SYixun Lan struct meson_aoclk_reset_controller *rstc; 3988e2da81SYixun Lan struct meson_aoclk_data *data; 4088e2da81SYixun Lan struct device *dev = &pdev->dev; 41*89ab396dSLiang He struct device_node *np; 4288e2da81SYixun Lan struct regmap *regmap; 4388e2da81SYixun Lan int ret, clkid; 4488e2da81SYixun Lan 4588e2da81SYixun Lan data = (struct meson_aoclk_data *) of_device_get_match_data(dev); 4688e2da81SYixun Lan if (!data) 4788e2da81SYixun Lan return -ENODEV; 4888e2da81SYixun Lan 4988e2da81SYixun Lan rstc = devm_kzalloc(dev, sizeof(*rstc), GFP_KERNEL); 5088e2da81SYixun Lan if (!rstc) 5188e2da81SYixun Lan return -ENOMEM; 5288e2da81SYixun Lan 53*89ab396dSLiang He np = of_get_parent(dev->of_node); 54*89ab396dSLiang He regmap = syscon_node_to_regmap(np); 55*89ab396dSLiang He of_node_put(np); 5688e2da81SYixun Lan if (IS_ERR(regmap)) { 5788e2da81SYixun Lan dev_err(dev, "failed to get regmap\n"); 5888e2da81SYixun Lan return PTR_ERR(regmap); 5988e2da81SYixun Lan } 6088e2da81SYixun Lan 6188e2da81SYixun Lan /* Reset Controller */ 6288e2da81SYixun Lan rstc->data = data; 6388e2da81SYixun Lan rstc->regmap = regmap; 6488e2da81SYixun Lan rstc->reset.ops = &meson_aoclk_reset_ops; 653270ee14SJulia Lawall rstc->reset.nr_resets = data->num_reset; 6688e2da81SYixun Lan rstc->reset.of_node = dev->of_node; 6788e2da81SYixun Lan ret = devm_reset_controller_register(dev, &rstc->reset); 6888e2da81SYixun Lan if (ret) { 6988e2da81SYixun Lan dev_err(dev, "failed to register reset controller\n"); 7088e2da81SYixun Lan return ret; 7188e2da81SYixun Lan } 7288e2da81SYixun Lan 738d9981efSJerome Brunet /* Populate regmap */ 748d9981efSJerome Brunet for (clkid = 0; clkid < data->num_clks; clkid++) 7588e2da81SYixun Lan data->clks[clkid]->map = regmap; 7688e2da81SYixun Lan 778d9981efSJerome Brunet /* Register all clks */ 788d9981efSJerome Brunet for (clkid = 0; clkid < data->hw_data->num; clkid++) { 798d9981efSJerome Brunet if (!data->hw_data->hws[clkid]) 808d9981efSJerome Brunet continue; 818d9981efSJerome Brunet 8288e2da81SYixun Lan ret = devm_clk_hw_register(dev, data->hw_data->hws[clkid]); 838d9981efSJerome Brunet if (ret) { 848d9981efSJerome Brunet dev_err(dev, "Clock registration failed\n"); 8588e2da81SYixun Lan return ret; 8688e2da81SYixun Lan } 878d9981efSJerome Brunet } 8888e2da81SYixun Lan 8988e2da81SYixun Lan return devm_of_clk_add_hw_provider(dev, of_clk_hw_onecell_get, 9088e2da81SYixun Lan (void *) data->hw_data); 9188e2da81SYixun Lan } 9220425f63SKevin Hilman EXPORT_SYMBOL_GPL(meson_aoclkc_probe); 9320425f63SKevin Hilman MODULE_LICENSE("GPL v2"); 94