1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Copyright (c) 2020, The Linux Foundation. All rights reserved.
4  */
5 
6 #include <linux/interconnect.h>
7 #include <linux/interconnect-provider.h>
8 #include <linux/module.h>
9 #include <linux/of.h>
10 #include <linux/of_platform.h>
11 #include <linux/slab.h>
12 
13 #include "bcm-voter.h"
14 #include "icc-common.h"
15 #include "icc-rpmh.h"
16 
17 /**
18  * qcom_icc_pre_aggregate - cleans up stale values from prior icc_set
19  * @node: icc node to operate on
20  */
21 void qcom_icc_pre_aggregate(struct icc_node *node)
22 {
23 	size_t i;
24 	struct qcom_icc_node *qn;
25 	struct qcom_icc_provider *qp;
26 
27 	qn = node->data;
28 	qp = to_qcom_provider(node->provider);
29 
30 	for (i = 0; i < QCOM_ICC_NUM_BUCKETS; i++) {
31 		qn->sum_avg[i] = 0;
32 		qn->max_peak[i] = 0;
33 	}
34 
35 	for (i = 0; i < qn->num_bcms; i++)
36 		qcom_icc_bcm_voter_add(qp->voter, qn->bcms[i]);
37 }
38 EXPORT_SYMBOL_GPL(qcom_icc_pre_aggregate);
39 
40 /**
41  * qcom_icc_aggregate - aggregate bw for buckets indicated by tag
42  * @node: node to aggregate
43  * @tag: tag to indicate which buckets to aggregate
44  * @avg_bw: new bw to sum aggregate
45  * @peak_bw: new bw to max aggregate
46  * @agg_avg: existing aggregate avg bw val
47  * @agg_peak: existing aggregate peak bw val
48  */
49 int qcom_icc_aggregate(struct icc_node *node, u32 tag, u32 avg_bw,
50 		       u32 peak_bw, u32 *agg_avg, u32 *agg_peak)
51 {
52 	size_t i;
53 	struct qcom_icc_node *qn;
54 
55 	qn = node->data;
56 
57 	if (!tag)
58 		tag = QCOM_ICC_TAG_ALWAYS;
59 
60 	for (i = 0; i < QCOM_ICC_NUM_BUCKETS; i++) {
61 		if (tag & BIT(i)) {
62 			qn->sum_avg[i] += avg_bw;
63 			qn->max_peak[i] = max_t(u32, qn->max_peak[i], peak_bw);
64 		}
65 
66 		if (node->init_avg || node->init_peak) {
67 			qn->sum_avg[i] = max_t(u64, qn->sum_avg[i], node->init_avg);
68 			qn->max_peak[i] = max_t(u64, qn->max_peak[i], node->init_peak);
69 		}
70 	}
71 
72 	*agg_avg += avg_bw;
73 	*agg_peak = max_t(u32, *agg_peak, peak_bw);
74 
75 	return 0;
76 }
77 EXPORT_SYMBOL_GPL(qcom_icc_aggregate);
78 
79 /**
80  * qcom_icc_set - set the constraints based on path
81  * @src: source node for the path to set constraints on
82  * @dst: destination node for the path to set constraints on
83  *
84  * Return: 0 on success, or an error code otherwise
85  */
86 int qcom_icc_set(struct icc_node *src, struct icc_node *dst)
87 {
88 	struct qcom_icc_provider *qp;
89 	struct icc_node *node;
90 
91 	if (!src)
92 		node = dst;
93 	else
94 		node = src;
95 
96 	qp = to_qcom_provider(node->provider);
97 
98 	qcom_icc_bcm_voter_commit(qp->voter);
99 
100 	return 0;
101 }
102 EXPORT_SYMBOL_GPL(qcom_icc_set);
103 
104 /**
105  * qcom_icc_bcm_init - populates bcm aux data and connect qnodes
106  * @bcm: bcm to be initialized
107  * @dev: associated provider device
108  *
109  * Return: 0 on success, or an error code otherwise
110  */
111 int qcom_icc_bcm_init(struct qcom_icc_bcm *bcm, struct device *dev)
112 {
113 	struct qcom_icc_node *qn;
114 	const struct bcm_db *data;
115 	size_t data_count;
116 	int i;
117 
118 	/* BCM is already initialised*/
119 	if (bcm->addr)
120 		return 0;
121 
122 	bcm->addr = cmd_db_read_addr(bcm->name);
123 	if (!bcm->addr) {
124 		dev_err(dev, "%s could not find RPMh address\n",
125 			bcm->name);
126 		return -EINVAL;
127 	}
128 
129 	data = cmd_db_read_aux_data(bcm->name, &data_count);
130 	if (IS_ERR(data)) {
131 		dev_err(dev, "%s command db read error (%ld)\n",
132 			bcm->name, PTR_ERR(data));
133 		return PTR_ERR(data);
134 	}
135 	if (!data_count) {
136 		dev_err(dev, "%s command db missing or partial aux data\n",
137 			bcm->name);
138 		return -EINVAL;
139 	}
140 
141 	bcm->aux_data.unit = le32_to_cpu(data->unit);
142 	bcm->aux_data.width = le16_to_cpu(data->width);
143 	bcm->aux_data.vcd = data->vcd;
144 	bcm->aux_data.reserved = data->reserved;
145 	INIT_LIST_HEAD(&bcm->list);
146 	INIT_LIST_HEAD(&bcm->ws_list);
147 
148 	if (!bcm->vote_scale)
149 		bcm->vote_scale = 1000;
150 
151 	/* Link Qnodes to their respective BCMs */
152 	for (i = 0; i < bcm->num_nodes; i++) {
153 		qn = bcm->nodes[i];
154 		qn->bcms[qn->num_bcms] = bcm;
155 		qn->num_bcms++;
156 	}
157 
158 	return 0;
159 }
160 EXPORT_SYMBOL_GPL(qcom_icc_bcm_init);
161 
162 int qcom_icc_rpmh_probe(struct platform_device *pdev)
163 {
164 	const struct qcom_icc_desc *desc;
165 	struct device *dev = &pdev->dev;
166 	struct icc_onecell_data *data;
167 	struct icc_provider *provider;
168 	struct qcom_icc_node * const *qnodes, *qn;
169 	struct qcom_icc_provider *qp;
170 	struct icc_node *node;
171 	size_t num_nodes, i, j;
172 	int ret;
173 
174 	desc = of_device_get_match_data(dev);
175 	if (!desc)
176 		return -EINVAL;
177 
178 	qnodes = desc->nodes;
179 	num_nodes = desc->num_nodes;
180 
181 	qp = devm_kzalloc(dev, sizeof(*qp), GFP_KERNEL);
182 	if (!qp)
183 		return -ENOMEM;
184 
185 	data = devm_kzalloc(dev, struct_size(data, nodes, num_nodes), GFP_KERNEL);
186 	if (!data)
187 		return -ENOMEM;
188 	data->num_nodes = num_nodes;
189 
190 	provider = &qp->provider;
191 	provider->dev = dev;
192 	provider->set = qcom_icc_set;
193 	provider->pre_aggregate = qcom_icc_pre_aggregate;
194 	provider->aggregate = qcom_icc_aggregate;
195 	provider->xlate_extended = qcom_icc_xlate_extended;
196 	provider->data = data;
197 
198 	icc_provider_init(provider);
199 
200 	qp->dev = dev;
201 	qp->bcms = desc->bcms;
202 	qp->num_bcms = desc->num_bcms;
203 
204 	qp->voter = of_bcm_voter_get(qp->dev, NULL);
205 	if (IS_ERR(qp->voter))
206 		return PTR_ERR(qp->voter);
207 
208 	for (i = 0; i < qp->num_bcms; i++)
209 		qcom_icc_bcm_init(qp->bcms[i], dev);
210 
211 	for (i = 0; i < num_nodes; i++) {
212 		qn = qnodes[i];
213 		if (!qn)
214 			continue;
215 
216 		node = icc_node_create(qn->id);
217 		if (IS_ERR(node)) {
218 			ret = PTR_ERR(node);
219 			goto err_remove_nodes;
220 		}
221 
222 		node->name = qn->name;
223 		node->data = qn;
224 		icc_node_add(node, provider);
225 
226 		for (j = 0; j < qn->num_links; j++)
227 			icc_link_create(node, qn->links[j]);
228 
229 		data->nodes[i] = node;
230 	}
231 
232 	ret = icc_provider_register(provider);
233 	if (ret)
234 		goto err_remove_nodes;
235 
236 	platform_set_drvdata(pdev, qp);
237 
238 	/* Populate child NoC devices if any */
239 	if (of_get_child_count(dev->of_node) > 0) {
240 		ret = of_platform_populate(dev->of_node, NULL, NULL, dev);
241 		if (ret)
242 			goto err_deregister_provider;
243 	}
244 
245 	return 0;
246 
247 err_deregister_provider:
248 	icc_provider_deregister(provider);
249 err_remove_nodes:
250 	icc_nodes_remove(provider);
251 
252 	return ret;
253 }
254 EXPORT_SYMBOL_GPL(qcom_icc_rpmh_probe);
255 
256 int qcom_icc_rpmh_remove(struct platform_device *pdev)
257 {
258 	struct qcom_icc_provider *qp = platform_get_drvdata(pdev);
259 
260 	icc_provider_deregister(&qp->provider);
261 	icc_nodes_remove(&qp->provider);
262 
263 	return 0;
264 }
265 EXPORT_SYMBOL_GPL(qcom_icc_rpmh_remove);
266 
267 MODULE_LICENSE("GPL v2");
268