1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Copyright (c) 2019 BayLibre, SAS. 4 * Author: Jerome Brunet <jbrunet@baylibre.com> 5 */ 6 7 #include <linux/clk-provider.h> 8 #include <linux/of.h> 9 #include <linux/platform_device.h> 10 #include <linux/mfd/syscon.h> 11 #include <linux/regmap.h> 12 #include <linux/module.h> 13 14 #include "clk-regmap.h" 15 #include "meson-eeclk.h" 16 17 int meson_eeclkc_probe(struct platform_device *pdev) 18 { 19 const struct meson_eeclkc_data *data; 20 struct device *dev = &pdev->dev; 21 struct device_node *np; 22 struct regmap *map; 23 int ret, i; 24 25 data = of_device_get_match_data(dev); 26 if (!data) 27 return -EINVAL; 28 29 /* Get the hhi system controller node */ 30 np = of_get_parent(dev->of_node); 31 map = syscon_node_to_regmap(np); 32 of_node_put(np); 33 if (IS_ERR(map)) { 34 dev_err(dev, 35 "failed to get HHI regmap\n"); 36 return PTR_ERR(map); 37 } 38 39 if (data->init_count) 40 regmap_multi_reg_write(map, data->init_regs, data->init_count); 41 42 for (i = 0; i < data->hw_clks.num; i++) { 43 /* array might be sparse */ 44 if (!data->hw_clks.hws[i]) 45 continue; 46 47 ret = devm_clk_hw_register(dev, data->hw_clks.hws[i]); 48 if (ret) { 49 dev_err(dev, "Clock registration failed\n"); 50 return ret; 51 } 52 } 53 54 return devm_of_clk_add_hw_provider(dev, meson_clk_hw_get, (void *)&data->hw_clks); 55 } 56 EXPORT_SYMBOL_NS_GPL(meson_eeclkc_probe, "CLK_MESON"); 57 58 MODULE_DESCRIPTION("Amlogic Main Clock Controller Helpers"); 59 MODULE_LICENSE("GPL"); 60 MODULE_IMPORT_NS("CLK_MESON"); 61