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>
14 #include <soc/qcom/rpmh.h>
17 #include <dt-bindings/clock/qcom,rpmh.h>
23  * struct bcm_db - Auxiliary data pertaining to each Bus Clock Manager(BCM)
24  * @unit: divisor used to convert Hz value to an RPMh msg
25  * @width: multiplier used to convert Hz value to an RPMh msg
37  * struct clk_rpmh - individual rpmh clock data structure
38  * @hw:			handle between common and hardware-specific interfaces
39  * @res_name:		resource name for the rpmh clock
41  * @res_addr:		base address of the rpmh resource within the RPMh
42  * @res_on_val:		rpmh clock enable value
43  * @state:		rpmh clock requested state
44  * @aggr_state:		rpmh clock aggregated state
45  * @last_sent_aggr_state: rpmh clock last aggr state sent to RPMh
46  * @valid_state_mask:	mask to determine the state of the rpmh clock
47  * @unit:		divisor to convert rate to rpmh msg in magnitudes of Khz
49  * @peer:		pointer to the clock rpmh sibling
140 	return (c->last_sent_aggr_state & BIT(state))  in has_state_changed()
141 		!= (c->aggr_state & BIT(state));  in has_state_changed()
148 		return rpmh_write(c->dev, state, cmd, 1);  in clk_rpmh_send()
150 	return rpmh_write_async(c->dev, state, cmd, 1);  in clk_rpmh_send()
161 	cmd.addr = c->res_addr;  in clk_rpmh_send_aggregate_command()
162 	cmd_state = c->aggr_state;  in clk_rpmh_send_aggregate_command()
163 	on_val = c->res_on_val;  in clk_rpmh_send_aggregate_command()
173 				dev_err(c->dev, "set %s state of %s failed: (%d)\n",  in clk_rpmh_send_aggregate_command()
176 					"wake" : "active", c->res_name, ret);  in clk_rpmh_send_aggregate_command()
182 	c->last_sent_aggr_state = c->aggr_state;  in clk_rpmh_send_aggregate_command()
183 	c->peer->last_sent_aggr_state =  c->last_sent_aggr_state;  in clk_rpmh_send_aggregate_command()
196 	c->state = enable ? c->valid_state_mask : 0;  in clk_rpmh_aggregate_state_send_command()
197 	c->aggr_state = c->state | c->peer->state;  in clk_rpmh_aggregate_state_send_command()
198 	c->peer->aggr_state = c->aggr_state;  in clk_rpmh_aggregate_state_send_command()
205 		c->state = 0;  in clk_rpmh_aggregate_state_send_command()
207 		c->state = c->valid_state_mask;  in clk_rpmh_aggregate_state_send_command()
209 	WARN(1, "clk: %s failed to %s\n", c->res_name,  in clk_rpmh_aggregate_state_send_command()
241 	 * RPMh clocks have a fixed rate. Return static rate.  in clk_rpmh_recalc_rate()
243 	return prate / r->div;  in clk_rpmh_recalc_rate()
261 		if (c->aggr_state)  in clk_rpmh_bcm_send_cmd()
262 			cmd_state = c->aggr_state;  in clk_rpmh_bcm_send_cmd()
269 	if (c->last_sent_aggr_state != cmd_state) {  in clk_rpmh_bcm_send_cmd()
270 		cmd.addr = c->res_addr;  in clk_rpmh_bcm_send_cmd()
274 		 * Send only an active only state request. RPMh continues to  in clk_rpmh_bcm_send_cmd()
280 			dev_err(c->dev, "set active state of %s failed: (%d)\n",  in clk_rpmh_bcm_send_cmd()
281 				c->res_name, ret);  in clk_rpmh_bcm_send_cmd()
283 			c->last_sent_aggr_state = cmd_state;  in clk_rpmh_bcm_send_cmd()
311 	c->aggr_state = rate / c->unit;  in clk_rpmh_bcm_set_rate()
313 	 * Since any non-zero value sent to hw would result in enabling the  in clk_rpmh_bcm_set_rate()
333 	return (unsigned long)c->aggr_state * c->unit;  in clk_rpmh_bcm_recalc_rate()
344 /* Resource name must match resource id present in cmd-db */
667 	 * The clka3 RPMh resource is missing in cmd-db
855 	struct clk_rpmh_desc *rpmh = data;  in of_clk_rpmh_hw_get()  local
856 	unsigned int idx = clkspec->args[0];  in of_clk_rpmh_hw_get()
858 	if (idx >= rpmh->num_clks) {  in of_clk_rpmh_hw_get()
860 		return ERR_PTR(-EINVAL);  in of_clk_rpmh_hw_get()
863 	return rpmh->clks[idx];  in of_clk_rpmh_hw_get()
873 	desc = of_device_get_match_data(&pdev->dev);  in clk_rpmh_probe()
875 		return -ENODEV;  in clk_rpmh_probe()
877 	hw_clks = desc->clks;  in clk_rpmh_probe()
879 	for (i = 0; i < desc->num_clks; i++) {  in clk_rpmh_probe()
888 		name = hw_clks[i]->init->name;  in clk_rpmh_probe()
891 		res_addr = cmd_db_read_addr(rpmh_clk->res_name);  in clk_rpmh_probe()
893 			dev_err(&pdev->dev, "missing RPMh resource address for %s\n",  in clk_rpmh_probe()
894 				rpmh_clk->res_name);  in clk_rpmh_probe()
895 			return -ENODEV;  in clk_rpmh_probe()
898 		data = cmd_db_read_aux_data(rpmh_clk->res_name, &aux_data_len);  in clk_rpmh_probe()
901 			dev_err(&pdev->dev,  in clk_rpmh_probe()
902 				"error reading RPMh aux data for %s (%d)\n",  in clk_rpmh_probe()
903 				rpmh_clk->res_name, ret);  in clk_rpmh_probe()
909 			rpmh_clk->unit = le32_to_cpu(data->unit) * 1000ULL;  in clk_rpmh_probe()
911 		rpmh_clk->res_addr += res_addr;  in clk_rpmh_probe()
912 		rpmh_clk->dev = &pdev->dev;  in clk_rpmh_probe()
914 		ret = devm_clk_hw_register(&pdev->dev, hw_clks[i]);  in clk_rpmh_probe()
916 			dev_err(&pdev->dev, "failed to register %s\n", name);  in clk_rpmh_probe()
922 	ret = devm_of_clk_add_hw_provider(&pdev->dev, of_clk_rpmh_hw_get,  in clk_rpmh_probe()
925 		dev_err(&pdev->dev, "Failed to add clock provider\n");  in clk_rpmh_probe()
929 	dev_dbg(&pdev->dev, "Registered RPMh clocks\n");  in clk_rpmh_probe()
935 	{ .compatible = "qcom,qcs615-rpmh-clk", .data = &clk_rpmh_qcs615},
936 	{ .compatible = "qcom,qdu1000-rpmh-clk", .data = &clk_rpmh_qdu1000},
937 	{ .compatible = "qcom,sa8775p-rpmh-clk", .data = &clk_rpmh_sa8775p},
938 	{ .compatible = "qcom,sar2130p-rpmh-clk", .data = &clk_rpmh_sar2130p},
939 	{ .compatible = "qcom,sc7180-rpmh-clk", .data = &clk_rpmh_sc7180},
940 	{ .compatible = "qcom,sc7280-rpmh-clk", .data = &clk_rpmh_sc7280},
941 	{ .compatible = "qcom,sc8180x-rpmh-clk", .data = &clk_rpmh_sc8180x},
942 	{ .compatible = "qcom,sc8280xp-rpmh-clk", .data = &clk_rpmh_sc8280xp},
943 	{ .compatible = "qcom,sdm845-rpmh-clk", .data = &clk_rpmh_sdm845},
944 	{ .compatible = "qcom,sdm670-rpmh-clk", .data = &clk_rpmh_sdm670},
945 	{ .compatible = "qcom,sdx55-rpmh-clk",  .data = &clk_rpmh_sdx55},
946 	{ .compatible = "qcom,sdx65-rpmh-clk",  .data = &clk_rpmh_sdx65},
947 	{ .compatible = "qcom,sdx75-rpmh-clk",  .data = &clk_rpmh_sdx75},
948 	{ .compatible = "qcom,sm4450-rpmh-clk", .data = &clk_rpmh_sm4450},
949 	{ .compatible = "qcom,sm6350-rpmh-clk", .data = &clk_rpmh_sm6350},
950 	{ .compatible = "qcom,sm8150-rpmh-clk", .data = &clk_rpmh_sm8150},
951 	{ .compatible = "qcom,sm8250-rpmh-clk", .data = &clk_rpmh_sm8250},
952 	{ .compatible = "qcom,sm8350-rpmh-clk", .data = &clk_rpmh_sm8350},
953 	{ .compatible = "qcom,sm8450-rpmh-clk", .data = &clk_rpmh_sm8450},
954 	{ .compatible = "qcom,sm8550-rpmh-clk", .data = &clk_rpmh_sm8550},
955 	{ .compatible = "qcom,sm8650-rpmh-clk", .data = &clk_rpmh_sm8650},
956 	{ .compatible = "qcom,sm8750-rpmh-clk", .data = &clk_rpmh_sm8750},
957 	{ .compatible = "qcom,x1e80100-rpmh-clk", .data = &clk_rpmh_x1e80100},
965 		.name	= "clk-rpmh",
982 MODULE_DESCRIPTION("QCOM RPMh Clock Driver");