mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
90 lines
2.3 KiB
90 lines
2.3 KiB
// SPDX-License-Identifier: GPL-2.0+ |
|
/* |
|
* Amlogic Meson-AXG Clock Controller Driver |
|
* |
|
* Copyright (c) 2016 BayLibre, SAS. |
|
* Author: Neil Armstrong <[email protected]> |
|
* |
|
* Copyright (c) 2018 Amlogic, inc. |
|
* Author: Qiufang Dai <[email protected]> |
|
* Author: Yixun Lan <[email protected]> |
|
*/ |
|
|
|
#include <linux/platform_device.h> |
|
#include <linux/reset-controller.h> |
|
#include <linux/mfd/syscon.h> |
|
#include <linux/of_device.h> |
|
#include <linux/module.h> |
|
|
|
#include <linux/slab.h> |
|
#include "meson-aoclk.h" |
|
|
|
static int meson_aoclk_do_reset(struct reset_controller_dev *rcdev, |
|
unsigned long id) |
|
{ |
|
struct meson_aoclk_reset_controller *rstc = |
|
container_of(rcdev, struct meson_aoclk_reset_controller, reset); |
|
|
|
return regmap_write(rstc->regmap, rstc->data->reset_reg, |
|
BIT(rstc->data->reset[id])); |
|
} |
|
|
|
static const struct reset_control_ops meson_aoclk_reset_ops = { |
|
.reset = meson_aoclk_do_reset, |
|
}; |
|
|
|
int meson_aoclkc_probe(struct platform_device *pdev) |
|
{ |
|
struct meson_aoclk_reset_controller *rstc; |
|
struct meson_aoclk_data *data; |
|
struct device *dev = &pdev->dev; |
|
struct regmap *regmap; |
|
int ret, clkid; |
|
|
|
data = (struct meson_aoclk_data *) of_device_get_match_data(dev); |
|
if (!data) |
|
return -ENODEV; |
|
|
|
rstc = devm_kzalloc(dev, sizeof(*rstc), GFP_KERNEL); |
|
if (!rstc) |
|
return -ENOMEM; |
|
|
|
regmap = syscon_node_to_regmap(of_get_parent(dev->of_node)); |
|
if (IS_ERR(regmap)) { |
|
dev_err(dev, "failed to get regmap\n"); |
|
return PTR_ERR(regmap); |
|
} |
|
|
|
/* Reset Controller */ |
|
rstc->data = data; |
|
rstc->regmap = regmap; |
|
rstc->reset.ops = &meson_aoclk_reset_ops; |
|
rstc->reset.nr_resets = data->num_reset; |
|
rstc->reset.of_node = dev->of_node; |
|
ret = devm_reset_controller_register(dev, &rstc->reset); |
|
if (ret) { |
|
dev_err(dev, "failed to register reset controller\n"); |
|
return ret; |
|
} |
|
|
|
/* Populate regmap */ |
|
for (clkid = 0; clkid < data->num_clks; clkid++) |
|
data->clks[clkid]->map = regmap; |
|
|
|
/* Register all clks */ |
|
for (clkid = 0; clkid < data->hw_data->num; clkid++) { |
|
if (!data->hw_data->hws[clkid]) |
|
continue; |
|
|
|
ret = devm_clk_hw_register(dev, data->hw_data->hws[clkid]); |
|
if (ret) { |
|
dev_err(dev, "Clock registration failed\n"); |
|
return ret; |
|
} |
|
} |
|
|
|
return devm_of_clk_add_hw_provider(dev, of_clk_hw_onecell_get, |
|
(void *) data->hw_data); |
|
} |
|
EXPORT_SYMBOL_GPL(meson_aoclkc_probe); |
|
MODULE_LICENSE("GPL v2");
|
|
|