1 // SPDX-License-Identifier: GPL-2.0
50 	} rate[0];  member
74 	struct scmi_clock_info *clk;  member
89 	attr = t->rx.buf;  in scmi_clock_protocol_attributes_get()
93 		ci->num_clocks = le16_to_cpu(attr->num_clocks);  in scmi_clock_protocol_attributes_get()
94 		ci->max_async_req = attr->max_async_req;  in scmi_clock_protocol_attributes_get()
102 				     u32 clk_id, struct scmi_clock_info *clk)  in scmi_clock_attributes_get()  argument
113 	put_unaligned_le32(clk_id, t->tx.buf);  in scmi_clock_attributes_get()
114 	attr = t->rx.buf;  in scmi_clock_attributes_get()
118 		strlcpy(clk->name, attr->name, SCMI_MAX_STR_SIZE);  in scmi_clock_attributes_get()
120 		clk->name[0] = '\0';  in scmi_clock_attributes_get()
131 		return -1;  in rate_cmp_func()
140 			      struct scmi_clock_info *clk)  in scmi_clock_describe_rates_get()  argument
142 	u64 *rate = NULL;  in scmi_clock_describe_rates_get()  local
156 	clk_desc = t->tx.buf;  in scmi_clock_describe_rates_get()
157 	rlist = t->rx.buf;  in scmi_clock_describe_rates_get()
160 		clk_desc->id = cpu_to_le32(clk_id);  in scmi_clock_describe_rates_get()
162 		clk_desc->rate_index = cpu_to_le32(tot_rate_cnt);  in scmi_clock_describe_rates_get()
168 		rates_flag = le32_to_cpu(rlist->num_rates_flags);  in scmi_clock_describe_rates_get()
174 			dev_err(handle->dev, "No. of rates > MAX_NUM_RATES");  in scmi_clock_describe_rates_get()
179 			clk->range.min_rate = RATE_TO_U64(rlist->rate[0]);  in scmi_clock_describe_rates_get()
180 			clk->range.max_rate = RATE_TO_U64(rlist->rate[1]);  in scmi_clock_describe_rates_get()
181 			clk->range.step_size = RATE_TO_U64(rlist->rate[2]);  in scmi_clock_describe_rates_get()
182 			dev_dbg(handle->dev, "Min %llu Max %llu Step %llu Hz\n",  in scmi_clock_describe_rates_get()
183 				clk->range.min_rate, clk->range.max_rate,  in scmi_clock_describe_rates_get()
184 				clk->range.step_size);  in scmi_clock_describe_rates_get()
188 		rate = &clk->list.rates[tot_rate_cnt];  in scmi_clock_describe_rates_get()
189 		for (cnt = 0; cnt < num_returned; cnt++, rate++) {  in scmi_clock_describe_rates_get()
190 			*rate = RATE_TO_U64(rlist->rate[cnt]);  in scmi_clock_describe_rates_get()
191 			dev_dbg(handle->dev, "Rate %llu Hz\n", *rate);  in scmi_clock_describe_rates_get()
203 	if (rate_discrete && rate) {  in scmi_clock_describe_rates_get()
204 		clk->list.num_rates = tot_rate_cnt;  in scmi_clock_describe_rates_get()
205 		sort(rate, tot_rate_cnt, sizeof(*rate), rate_cmp_func, NULL);  in scmi_clock_describe_rates_get()
208 	clk->rate_discrete = rate_discrete;  in scmi_clock_describe_rates_get()
226 	put_unaligned_le32(clk_id, t->tx.buf);  in scmi_clock_rate_get()
230 		*value = get_unaligned_le64(t->rx.buf);  in scmi_clock_rate_get()
237 			       u64 rate)  in scmi_clock_rate_set()  argument
243 	struct clock_info *ci = handle->clk_priv;  in scmi_clock_rate_set()
250 	if (ci->max_async_req &&  in scmi_clock_rate_set()
251 	    atomic_inc_return(&ci->cur_async_req) < ci->max_async_req)  in scmi_clock_rate_set()
254 	cfg = t->tx.buf;  in scmi_clock_rate_set()
255 	cfg->flags = cpu_to_le32(flags);  in scmi_clock_rate_set()
256 	cfg->id = cpu_to_le32(clk_id);  in scmi_clock_rate_set()
257 	cfg->value_low = cpu_to_le32(rate & 0xffffffff);  in scmi_clock_rate_set()
258 	cfg->value_high = cpu_to_le32(rate >> 32);  in scmi_clock_rate_set()
265 	if (ci->max_async_req)  in scmi_clock_rate_set()
266 		atomic_dec(&ci->cur_async_req);  in scmi_clock_rate_set()
284 	cfg = t->tx.buf;  in scmi_clock_config_set()
285 	cfg->id = cpu_to_le32(clk_id);  in scmi_clock_config_set()
286 	cfg->attributes = cpu_to_le32(config);  in scmi_clock_config_set()
306 	struct clock_info *ci = handle->clk_priv;  in scmi_clock_count_get()
308 	return ci->num_clocks;  in scmi_clock_count_get()
314 	struct clock_info *ci = handle->clk_priv;  in scmi_clock_info_get()
315 	struct scmi_clock_info *clk = ci->clk + clk_id;  in scmi_clock_info_get()  local
317 	if (!clk->name[0])  in scmi_clock_info_get()
320 	return clk;  in scmi_clock_info_get()
340 	dev_dbg(handle->dev, "Clock Version %d.%d\n",  in scmi_clock_protocol_init()
343 	cinfo = devm_kzalloc(handle->dev, sizeof(*cinfo), GFP_KERNEL);  in scmi_clock_protocol_init()
345 		return -ENOMEM;  in scmi_clock_protocol_init()
349 	cinfo->clk = devm_kcalloc(handle->dev, cinfo->num_clocks,  in scmi_clock_protocol_init()
350 				  sizeof(*cinfo->clk), GFP_KERNEL);  in scmi_clock_protocol_init()
351 	if (!cinfo->clk)  in scmi_clock_protocol_init()
352 		return -ENOMEM;  in scmi_clock_protocol_init()
354 	for (clkid = 0; clkid < cinfo->num_clocks; clkid++) {  in scmi_clock_protocol_init()
355 		struct scmi_clock_info *clk = cinfo->clk + clkid;  in scmi_clock_protocol_init()  local
357 		ret = scmi_clock_attributes_get(handle, clkid, clk);  in scmi_clock_protocol_init()
359 			scmi_clock_describe_rates_get(handle, clkid, clk);  in scmi_clock_protocol_init()
362 	cinfo->version = version;  in scmi_clock_protocol_init()
363 	handle->clk_ops = &clk_ops;  in scmi_clock_protocol_init()
364 	handle->clk_priv = cinfo;  in scmi_clock_protocol_init()