1 // SPDX-License-Identifier: GPL-2.0
3  * Copyright (c) 2018-2021, The Linux Foundation. All rights reserved.
6 #include <linux/clk-provider.h>
13 #include <soc/qcom/cmd-db.h>
17 #include <dt-bindings/clock/qcom,rpmh.h>
23  * struct bcm_db - Auxiliary data pertaining to each Bus Clock Manager(BCM)
37  * struct clk_rpmh - individual rpmh clock data structure
38  * @hw:			handle between common and hardware-specific interfaces
142 	return (c->last_sent_aggr_state & BIT(state))  in has_state_changed()
143 		!= (c->aggr_state & BIT(state));  in has_state_changed()
150 		return rpmh_write(c->dev, state, cmd, 1);  in clk_rpmh_send()
152 	return rpmh_write_async(c->dev, state, cmd, 1);  in clk_rpmh_send()
163 	cmd.addr = c->res_addr;  in clk_rpmh_send_aggregate_command()
164 	cmd_state = c->aggr_state;  in clk_rpmh_send_aggregate_command()
165 	on_val = c->res_on_val;  in clk_rpmh_send_aggregate_command()
175 				dev_err(c->dev, "set %s state of %s failed: (%d)\n",  in clk_rpmh_send_aggregate_command()
178 					"wake" : "active", c->res_name, ret);  in clk_rpmh_send_aggregate_command()
184 	c->last_sent_aggr_state = c->aggr_state;  in clk_rpmh_send_aggregate_command()
185 	c->peer->last_sent_aggr_state = c->last_sent_aggr_state;  in clk_rpmh_send_aggregate_command()
191  * Update state and aggregate state values based on enable value.
198 	c->state = enable ? c->valid_state_mask : 0;  in clk_rpmh_aggregate_state_send_command()
199 	c->aggr_state = c->state | c->peer->state;  in clk_rpmh_aggregate_state_send_command()
200 	c->peer->aggr_state = c->aggr_state;  in clk_rpmh_aggregate_state_send_command()
207 		c->state = 0;  in clk_rpmh_aggregate_state_send_command()
209 		c->state = c->valid_state_mask;  in clk_rpmh_aggregate_state_send_command()
211 	WARN(1, "clk: %s failed to %s\n", c->res_name,  in clk_rpmh_aggregate_state_send_command()
245 	return prate / r->div;  in clk_rpmh_recalc_rate()
263 		if (c->aggr_state)  in clk_rpmh_bcm_send_cmd()
264 			cmd_state = c->aggr_state;  in clk_rpmh_bcm_send_cmd()
271 	if (c->last_sent_aggr_state != cmd_state) {  in clk_rpmh_bcm_send_cmd()
272 		cmd.addr = c->res_addr;  in clk_rpmh_bcm_send_cmd()
282 			dev_err(c->dev, "set active state of %s failed: (%d)\n",  in clk_rpmh_bcm_send_cmd()
283 				c->res_name, ret);  in clk_rpmh_bcm_send_cmd()
285 			c->last_sent_aggr_state = cmd_state;  in clk_rpmh_bcm_send_cmd()
313 	c->aggr_state = rate / c->unit;  in clk_rpmh_bcm_set_rate()
315 	 * Since any non-zero value sent to hw would result in enabling the  in clk_rpmh_bcm_set_rate()
335 	return (unsigned long)c->aggr_state * c->unit;  in clk_rpmh_bcm_recalc_rate()
346 /* Resource name must match resource id present in cmd-db */
558 	 * downstream, but do not exist in cmd-db on SM7635, so skip them.
700 	 * The clka3 RPMh resource is missing in cmd-db
907 	unsigned int idx = clkspec->args[0];  in of_clk_rpmh_hw_get()
909 	if (idx >= rpmh->num_clks) {  in of_clk_rpmh_hw_get()
911 		return ERR_PTR(-EINVAL);  in of_clk_rpmh_hw_get()
914 	return rpmh->clks[idx];  in of_clk_rpmh_hw_get()
924 	desc = of_device_get_match_data(&pdev->dev);  in clk_rpmh_probe()
926 		return -ENODEV;  in clk_rpmh_probe()
928 	hw_clks = desc->clks;  in clk_rpmh_probe()
930 	for (i = 0; i < desc->num_clks; i++) {  in clk_rpmh_probe()
939 		name = hw_clks[i]->init->name;  in clk_rpmh_probe()
942 		res_addr = cmd_db_read_addr(rpmh_clk->res_name);  in clk_rpmh_probe()
946 			if (desc->clka_optional &&  in clk_rpmh_probe()
947 			    !strncmp(rpmh_clk->res_name, "clka", sizeof("clka") - 1))  in clk_rpmh_probe()
950 			dev_err(&pdev->dev, "missing RPMh resource address for %s\n",  in clk_rpmh_probe()
951 				rpmh_clk->res_name);  in clk_rpmh_probe()
952 			return -ENODEV;  in clk_rpmh_probe()
955 		data = cmd_db_read_aux_data(rpmh_clk->res_name, &aux_data_len);  in clk_rpmh_probe()
958 			dev_err(&pdev->dev,  in clk_rpmh_probe()
960 				rpmh_clk->res_name, ret);  in clk_rpmh_probe()
966 			rpmh_clk->unit = le32_to_cpu(data->unit) * 1000ULL;  in clk_rpmh_probe()
968 		rpmh_clk->res_addr += res_addr;  in clk_rpmh_probe()
969 		rpmh_clk->dev = &pdev->dev;  in clk_rpmh_probe()
971 		ret = devm_clk_hw_register(&pdev->dev, hw_clks[i]);  in clk_rpmh_probe()
973 			dev_err(&pdev->dev, "failed to register %s\n", name);  in clk_rpmh_probe()
979 	ret = devm_of_clk_add_hw_provider(&pdev->dev, of_clk_rpmh_hw_get,  in clk_rpmh_probe()
982 		dev_err(&pdev->dev, "Failed to add clock provider\n");  in clk_rpmh_probe()
986 	dev_dbg(&pdev->dev, "Registered RPMh clocks\n");  in clk_rpmh_probe()
992 	{ .compatible = "qcom,glymur-rpmh-clk", .data = &clk_rpmh_glymur},
993 	{ .compatible = "qcom,milos-rpmh-clk", .data = &clk_rpmh_milos},
994 	{ .compatible = "qcom,qcs615-rpmh-clk", .data = &clk_rpmh_qcs615},
995 	{ .compatible = "qcom,qdu1000-rpmh-clk", .data = &clk_rpmh_qdu1000},
996 	{ .compatible = "qcom,sa8775p-rpmh-clk", .data = &clk_rpmh_sa8775p},
997 	{ .compatible = "qcom,sar2130p-rpmh-clk", .data = &clk_rpmh_sar2130p},
998 	{ .compatible = "qcom,sc7180-rpmh-clk", .data = &clk_rpmh_sc7180},
999 	{ .compatible = "qcom,sc7280-rpmh-clk", .data = &clk_rpmh_sc7280},
1000 	{ .compatible = "qcom,sc8180x-rpmh-clk", .data = &clk_rpmh_sc8180x},
1001 	{ .compatible = "qcom,sc8280xp-rpmh-clk", .data = &clk_rpmh_sc8280xp},
1002 	{ .compatible = "qcom,sdm845-rpmh-clk", .data = &clk_rpmh_sdm845},
1003 	{ .compatible = "qcom,sdm670-rpmh-clk", .data = &clk_rpmh_sdm670},
1004 	{ .compatible = "qcom,sdx55-rpmh-clk",  .data = &clk_rpmh_sdx55},
1005 	{ .compatible = "qcom,sdx65-rpmh-clk",  .data = &clk_rpmh_sdx65},
1006 	{ .compatible = "qcom,sdx75-rpmh-clk",  .data = &clk_rpmh_sdx75},
1007 	{ .compatible = "qcom,sm4450-rpmh-clk", .data = &clk_rpmh_sm4450},
1008 	{ .compatible = "qcom,sm6350-rpmh-clk", .data = &clk_rpmh_sm6350},
1009 	{ .compatible = "qcom,sm8150-rpmh-clk", .data = &clk_rpmh_sm8150},
1010 	{ .compatible = "qcom,sm8250-rpmh-clk", .data = &clk_rpmh_sm8250},
1011 	{ .compatible = "qcom,sm8350-rpmh-clk", .data = &clk_rpmh_sm8350},
1012 	{ .compatible = "qcom,sm8450-rpmh-clk", .data = &clk_rpmh_sm8450},
1013 	{ .compatible = "qcom,sm8550-rpmh-clk", .data = &clk_rpmh_sm8550},
1014 	{ .compatible = "qcom,sm8650-rpmh-clk", .data = &clk_rpmh_sm8650},
1015 	{ .compatible = "qcom,sm8750-rpmh-clk", .data = &clk_rpmh_sm8750},
1016 	{ .compatible = "qcom,x1e80100-rpmh-clk", .data = &clk_rpmh_x1e80100},
1024 		.name	= "clk-rpmh",