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> 17*20425f63SKevin Hilman #include <linux/module.h> 18*20425f63SKevin 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; 4188e2da81SYixun Lan struct regmap *regmap; 4288e2da81SYixun Lan int ret, clkid; 4388e2da81SYixun Lan 4488e2da81SYixun Lan data = (struct meson_aoclk_data *) of_device_get_match_data(dev); 4588e2da81SYixun Lan if (!data) 4688e2da81SYixun Lan return -ENODEV; 4788e2da81SYixun Lan 4888e2da81SYixun Lan rstc = devm_kzalloc(dev, sizeof(*rstc), GFP_KERNEL); 4988e2da81SYixun Lan if (!rstc) 5088e2da81SYixun Lan return -ENOMEM; 5188e2da81SYixun Lan 5288e2da81SYixun Lan regmap = syscon_node_to_regmap(of_get_parent(dev->of_node)); 5388e2da81SYixun Lan if (IS_ERR(regmap)) { 5488e2da81SYixun Lan dev_err(dev, "failed to get regmap\n"); 5588e2da81SYixun Lan return PTR_ERR(regmap); 5688e2da81SYixun Lan } 5788e2da81SYixun Lan 5888e2da81SYixun Lan /* Reset Controller */ 5988e2da81SYixun Lan rstc->data = data; 6088e2da81SYixun Lan rstc->regmap = regmap; 6188e2da81SYixun Lan rstc->reset.ops = &meson_aoclk_reset_ops; 623270ee14SJulia Lawall rstc->reset.nr_resets = data->num_reset; 6388e2da81SYixun Lan rstc->reset.of_node = dev->of_node; 6488e2da81SYixun Lan ret = devm_reset_controller_register(dev, &rstc->reset); 6588e2da81SYixun Lan if (ret) { 6688e2da81SYixun Lan dev_err(dev, "failed to register reset controller\n"); 6788e2da81SYixun Lan return ret; 6888e2da81SYixun Lan } 6988e2da81SYixun Lan 708d9981efSJerome Brunet /* Populate regmap */ 718d9981efSJerome Brunet for (clkid = 0; clkid < data->num_clks; clkid++) 7288e2da81SYixun Lan data->clks[clkid]->map = regmap; 7388e2da81SYixun Lan 748d9981efSJerome Brunet /* Register all clks */ 758d9981efSJerome Brunet for (clkid = 0; clkid < data->hw_data->num; clkid++) { 768d9981efSJerome Brunet if (!data->hw_data->hws[clkid]) 778d9981efSJerome Brunet continue; 788d9981efSJerome Brunet 7988e2da81SYixun Lan ret = devm_clk_hw_register(dev, data->hw_data->hws[clkid]); 808d9981efSJerome Brunet if (ret) { 818d9981efSJerome Brunet dev_err(dev, "Clock registration failed\n"); 8288e2da81SYixun Lan return ret; 8388e2da81SYixun Lan } 848d9981efSJerome Brunet } 8588e2da81SYixun Lan 8688e2da81SYixun Lan return devm_of_clk_add_hw_provider(dev, of_clk_hw_onecell_get, 8788e2da81SYixun Lan (void *) data->hw_data); 8888e2da81SYixun Lan } 89*20425f63SKevin Hilman EXPORT_SYMBOL_GPL(meson_aoclkc_probe); 90*20425f63SKevin Hilman MODULE_LICENSE("GPL v2"); 91