// SPDX-License-Identifier: GPL-2.0-only /* * Samsung Exynos ACPM protocol based clock driver. * * Copyright 2025 Linaro Ltd. */ #include #include #include #include #include #include #include #include #include #include struct acpm_clk { u32 id; struct clk_hw hw; unsigned int mbox_chan_id; const struct acpm_handle *handle; }; struct acpm_clk_variant { const char *name; }; struct acpm_clk_driver_data { const struct acpm_clk_variant *clks; unsigned int nr_clks; unsigned int mbox_chan_id; }; #define to_acpm_clk(clk) container_of(clk, struct acpm_clk, hw) #define ACPM_CLK(cname) \ { \ .name = cname, \ } static const struct acpm_clk_variant gs101_acpm_clks[] = { ACPM_CLK("mif"), ACPM_CLK("int"), ACPM_CLK("cpucl0"), ACPM_CLK("cpucl1"), ACPM_CLK("cpucl2"), ACPM_CLK("g3d"), ACPM_CLK("g3dl2"), ACPM_CLK("tpu"), ACPM_CLK("intcam"), ACPM_CLK("tnr"), ACPM_CLK("cam"), ACPM_CLK("mfc"), ACPM_CLK("disp"), ACPM_CLK("bo"), }; static const struct acpm_clk_driver_data acpm_clk_gs101 = { .clks = gs101_acpm_clks, .nr_clks = ARRAY_SIZE(gs101_acpm_clks), .mbox_chan_id = 0, }; static unsigned long acpm_clk_recalc_rate(struct clk_hw *hw, unsigned long parent_rate) { struct acpm_clk *clk = to_acpm_clk(hw); return clk->handle->ops.dvfs_ops.get_rate(clk->handle, clk->mbox_chan_id, clk->id); } static int acpm_clk_determine_rate(struct clk_hw *hw, struct clk_rate_request *req) { /* * We can't figure out what rate it will be, so just return the * rate back to the caller. acpm_clk_recalc_rate() will be called * after the rate is set and we'll know what rate the clock is * running at then. */ return 0; } static int acpm_clk_set_rate(struct clk_hw *hw, unsigned long rate, unsigned long parent_rate) { struct acpm_clk *clk = to_acpm_clk(hw); return clk->handle->ops.dvfs_ops.set_rate(clk->handle, clk->mbox_chan_id, clk->id, rate); } static const struct clk_ops acpm_clk_ops = { .recalc_rate = acpm_clk_recalc_rate, .determine_rate = acpm_clk_determine_rate, .set_rate = acpm_clk_set_rate, }; static int acpm_clk_register(struct device *dev, struct acpm_clk *aclk, const char *name) { struct clk_init_data init = {}; init.name = name; init.ops = &acpm_clk_ops; aclk->hw.init = &init; return devm_clk_hw_register(dev, &aclk->hw); } static int acpm_clk_probe(struct platform_device *pdev) { const struct acpm_handle *acpm_handle; struct clk_hw_onecell_data *clk_data; struct clk_hw **hws; struct device *dev = &pdev->dev; struct acpm_clk *aclks; unsigned int mbox_chan_id; int i, err, count; acpm_handle = devm_acpm_get_by_node(dev, dev->parent->of_node); if (IS_ERR(acpm_handle)) return dev_err_probe(dev, PTR_ERR(acpm_handle), "Failed to get acpm handle\n"); count = acpm_clk_gs101.nr_clks; mbox_chan_id = acpm_clk_gs101.mbox_chan_id; clk_data = devm_kzalloc(dev, struct_size(clk_data, hws, count), GFP_KERNEL); if (!clk_data) return -ENOMEM; clk_data->num = count; hws = clk_data->hws; aclks = devm_kcalloc(dev, count, sizeof(*aclks), GFP_KERNEL); if (!aclks) return -ENOMEM; for (i = 0; i < count; i++) { struct acpm_clk *aclk = &aclks[i]; /* * The code assumes the clock IDs start from zero, * are sequential and do not have gaps. */ aclk->id = i; aclk->handle = acpm_handle; aclk->mbox_chan_id = mbox_chan_id; hws[i] = &aclk->hw; err = acpm_clk_register(dev, aclk, acpm_clk_gs101.clks[i].name); if (err) return dev_err_probe(dev, err, "Failed to register clock\n"); } return devm_of_clk_add_hw_provider(dev, of_clk_hw_onecell_get, clk_data); } static const struct platform_device_id acpm_clk_id[] = { { "gs101-acpm-clk" }, {} }; MODULE_DEVICE_TABLE(platform, acpm_clk_id); static struct platform_driver acpm_clk_driver = { .driver = { .name = "acpm-clocks", }, .probe = acpm_clk_probe, .id_table = acpm_clk_id, }; module_platform_driver(acpm_clk_driver); MODULE_AUTHOR("Tudor Ambarus "); MODULE_DESCRIPTION("Samsung Exynos ACPM clock driver"); MODULE_LICENSE("GPL");