1// SPDX-License-Identifier: (GPL-2.0 OR MIT) 2/* 3 * Copyright (c) 2019 BayLibre, SAS. 4 * Author: Neil Armstrong <narmstrong@baylibre.com> 5 */ 6 7#include <linux/clk-provider.h> 8#include <linux/module.h> 9 10#include "clk-regmap.h" 11#include "clk-cpu-dyndiv.h" 12 13static inline struct meson_clk_cpu_dyndiv_data * 14meson_clk_cpu_dyndiv_data(struct clk_regmap *clk) 15{ 16 return (struct meson_clk_cpu_dyndiv_data *)clk->data; 17} 18 19static unsigned long meson_clk_cpu_dyndiv_recalc_rate(struct clk_hw *hw, 20 unsigned long prate) 21{ 22 struct clk_regmap *clk = to_clk_regmap(hw); 23 struct meson_clk_cpu_dyndiv_data *data = meson_clk_cpu_dyndiv_data(clk); 24 25 return divider_recalc_rate(hw, prate, 26 meson_parm_read(clk->map, &data->div), 27 NULL, 0, data->div.width); 28} 29 30static int meson_clk_cpu_dyndiv_determine_rate(struct clk_hw *hw, 31 struct clk_rate_request *req) 32{ 33 struct clk_regmap *clk = to_clk_regmap(hw); 34 struct meson_clk_cpu_dyndiv_data *data = meson_clk_cpu_dyndiv_data(clk); 35 36 return divider_determine_rate(hw, req, NULL, data->div.width, 0); 37} 38 39static int meson_clk_cpu_dyndiv_set_rate(struct clk_hw *hw, unsigned long rate, 40 unsigned long parent_rate) 41{ 42 struct clk_regmap *clk = to_clk_regmap(hw); 43 struct meson_clk_cpu_dyndiv_data *data = meson_clk_cpu_dyndiv_data(clk); 44 unsigned int val; 45 int ret; 46 47 ret = divider_get_val(rate, parent_rate, NULL, data->div.width, 0); 48 if (ret < 0) 49 return ret; 50 51 val = (unsigned int)ret << data->div.shift; 52 53 /* Write the SYS_CPU_DYN_ENABLE bit before changing the divider */ 54 meson_parm_write(clk->map, &data->dyn, 1); 55 56 /* Update the divider while removing the SYS_CPU_DYN_ENABLE bit */ 57 return regmap_update_bits(clk->map, data->div.reg_off, 58 SETPMASK(data->div.width, data->div.shift) | 59 SETPMASK(data->dyn.width, data->dyn.shift), 60 val); 61}; 62 63const struct clk_ops meson_clk_cpu_dyndiv_ops = { 64 .recalc_rate = meson_clk_cpu_dyndiv_recalc_rate, 65 .determine_rate = meson_clk_cpu_dyndiv_determine_rate, 66 .set_rate = meson_clk_cpu_dyndiv_set_rate, 67}; 68EXPORT_SYMBOL_GPL(meson_clk_cpu_dyndiv_ops); 69 70MODULE_DESCRIPTION("Amlogic CPU Dynamic Clock divider"); 71MODULE_AUTHOR("Neil Armstrong <narmstrong@baylibre.com>"); 72MODULE_LICENSE("GPL v2"); 73