1
2
3
4
5#define pr_fmt(fmt) "[drm:%s:%d] " fmt, __func__, __LINE__
6
7#include <linux/debugfs.h>
8#include <linux/delay.h>
9
10#include "dpu_vbif.h"
11#include "dpu_hw_vbif.h"
12#include "dpu_trace.h"
13
14
15
16
17
18
19
20static int _dpu_vbif_wait_for_xin_halt(struct dpu_hw_vbif *vbif, u32 xin_id)
21{
22 ktime_t timeout;
23 bool status;
24 int rc;
25
26 if (!vbif || !vbif->cap || !vbif->ops.get_halt_ctrl) {
27 DPU_ERROR("invalid arguments vbif %d\n", vbif != NULL);
28 return -EINVAL;
29 }
30
31 timeout = ktime_add_us(ktime_get(), vbif->cap->xin_halt_timeout);
32 for (;;) {
33 status = vbif->ops.get_halt_ctrl(vbif, xin_id);
34 if (status)
35 break;
36 if (ktime_compare_safe(ktime_get(), timeout) > 0) {
37 status = vbif->ops.get_halt_ctrl(vbif, xin_id);
38 break;
39 }
40 usleep_range(501, 1000);
41 }
42
43 if (!status) {
44 rc = -ETIMEDOUT;
45 DPU_ERROR("VBIF %d client %d not halting. TIMEDOUT.\n",
46 vbif->idx - VBIF_0, xin_id);
47 } else {
48 rc = 0;
49 DPU_DEBUG("VBIF %d client %d is halted\n",
50 vbif->idx - VBIF_0, xin_id);
51 }
52
53 return rc;
54}
55
56
57
58
59
60
61
62static void _dpu_vbif_apply_dynamic_ot_limit(struct dpu_hw_vbif *vbif,
63 u32 *ot_lim, struct dpu_vbif_set_ot_params *params)
64{
65 u64 pps;
66 const struct dpu_vbif_dynamic_ot_tbl *tbl;
67 u32 i;
68
69 if (!vbif || !(vbif->cap->features & BIT(DPU_VBIF_QOS_OTLIM)))
70 return;
71
72
73 if (!params->is_wfd)
74 return;
75
76 pps = params->frame_rate;
77 pps *= params->width;
78 pps *= params->height;
79
80 tbl = params->rd ? &vbif->cap->dynamic_ot_rd_tbl :
81 &vbif->cap->dynamic_ot_wr_tbl;
82
83 for (i = 0; i < tbl->count; i++) {
84 if (pps <= tbl->cfg[i].pps) {
85 *ot_lim = tbl->cfg[i].ot_limit;
86 break;
87 }
88 }
89
90 DPU_DEBUG("vbif:%d xin:%d w:%d h:%d fps:%d pps:%llu ot:%u\n",
91 vbif->idx - VBIF_0, params->xin_id,
92 params->width, params->height, params->frame_rate,
93 pps, *ot_lim);
94}
95
96
97
98
99
100
101
102static u32 _dpu_vbif_get_ot_limit(struct dpu_hw_vbif *vbif,
103 struct dpu_vbif_set_ot_params *params)
104{
105 u32 ot_lim = 0;
106 u32 val;
107
108 if (!vbif || !vbif->cap) {
109 DPU_ERROR("invalid arguments vbif %d\n", vbif != NULL);
110 return -EINVAL;
111 }
112
113 if (vbif->cap->default_ot_wr_limit && !params->rd)
114 ot_lim = vbif->cap->default_ot_wr_limit;
115 else if (vbif->cap->default_ot_rd_limit && params->rd)
116 ot_lim = vbif->cap->default_ot_rd_limit;
117
118
119
120
121
122 if (ot_lim == 0)
123 goto exit;
124
125
126 _dpu_vbif_apply_dynamic_ot_limit(vbif, &ot_lim, params);
127
128 if (vbif && vbif->ops.get_limit_conf) {
129 val = vbif->ops.get_limit_conf(vbif,
130 params->xin_id, params->rd);
131 if (val == ot_lim)
132 ot_lim = 0;
133 }
134
135exit:
136 DPU_DEBUG("vbif:%d xin:%d ot_lim:%d\n",
137 vbif->idx - VBIF_0, params->xin_id, ot_lim);
138 return ot_lim;
139}
140
141
142
143
144
145
146
147
148void dpu_vbif_set_ot_limit(struct dpu_kms *dpu_kms,
149 struct dpu_vbif_set_ot_params *params)
150{
151 struct dpu_hw_vbif *vbif = NULL;
152 struct dpu_hw_mdp *mdp;
153 bool forced_on = false;
154 u32 ot_lim;
155 int ret, i;
156
157 mdp = dpu_kms->hw_mdp;
158
159 for (i = 0; i < ARRAY_SIZE(dpu_kms->hw_vbif); i++) {
160 if (dpu_kms->hw_vbif[i] &&
161 dpu_kms->hw_vbif[i]->idx == params->vbif_idx)
162 vbif = dpu_kms->hw_vbif[i];
163 }
164
165 if (!vbif || !mdp) {
166 DPU_DEBUG("invalid arguments vbif %d mdp %d\n",
167 vbif != NULL, mdp != NULL);
168 return;
169 }
170
171 if (!mdp->ops.setup_clk_force_ctrl ||
172 !vbif->ops.set_limit_conf ||
173 !vbif->ops.set_halt_ctrl)
174 return;
175
176
177 if (vbif->ops.set_write_gather_en && !params->rd)
178 vbif->ops.set_write_gather_en(vbif, params->xin_id);
179
180 ot_lim = _dpu_vbif_get_ot_limit(vbif, params) & 0xFF;
181
182 if (ot_lim == 0)
183 return;
184
185 trace_dpu_perf_set_ot(params->num, params->xin_id, ot_lim,
186 params->vbif_idx);
187
188 forced_on = mdp->ops.setup_clk_force_ctrl(mdp, params->clk_ctrl, true);
189
190 vbif->ops.set_limit_conf(vbif, params->xin_id, params->rd, ot_lim);
191
192 vbif->ops.set_halt_ctrl(vbif, params->xin_id, true);
193
194 ret = _dpu_vbif_wait_for_xin_halt(vbif, params->xin_id);
195 if (ret)
196 trace_dpu_vbif_wait_xin_halt_fail(vbif->idx, params->xin_id);
197
198 vbif->ops.set_halt_ctrl(vbif, params->xin_id, false);
199
200 if (forced_on)
201 mdp->ops.setup_clk_force_ctrl(mdp, params->clk_ctrl, false);
202}
203
204void dpu_vbif_set_qos_remap(struct dpu_kms *dpu_kms,
205 struct dpu_vbif_set_qos_params *params)
206{
207 struct dpu_hw_vbif *vbif = NULL;
208 struct dpu_hw_mdp *mdp;
209 bool forced_on = false;
210 const struct dpu_vbif_qos_tbl *qos_tbl;
211 int i;
212
213 if (!params || !dpu_kms->hw_mdp) {
214 DPU_ERROR("invalid arguments\n");
215 return;
216 }
217 mdp = dpu_kms->hw_mdp;
218
219 for (i = 0; i < ARRAY_SIZE(dpu_kms->hw_vbif); i++) {
220 if (dpu_kms->hw_vbif[i] &&
221 dpu_kms->hw_vbif[i]->idx == params->vbif_idx) {
222 vbif = dpu_kms->hw_vbif[i];
223 break;
224 }
225 }
226
227 if (!vbif || !vbif->cap) {
228 DPU_ERROR("invalid vbif %d\n", params->vbif_idx);
229 return;
230 }
231
232 if (!vbif->ops.set_qos_remap || !mdp->ops.setup_clk_force_ctrl) {
233 DPU_DEBUG("qos remap not supported\n");
234 return;
235 }
236
237 qos_tbl = params->is_rt ? &vbif->cap->qos_rt_tbl :
238 &vbif->cap->qos_nrt_tbl;
239
240 if (!qos_tbl->npriority_lvl || !qos_tbl->priority_lvl) {
241 DPU_DEBUG("qos tbl not defined\n");
242 return;
243 }
244
245 forced_on = mdp->ops.setup_clk_force_ctrl(mdp, params->clk_ctrl, true);
246
247 for (i = 0; i < qos_tbl->npriority_lvl; i++) {
248 DPU_DEBUG("vbif:%d xin:%d lvl:%d/%d\n",
249 params->vbif_idx, params->xin_id, i,
250 qos_tbl->priority_lvl[i]);
251 vbif->ops.set_qos_remap(vbif, params->xin_id, i,
252 qos_tbl->priority_lvl[i]);
253 }
254
255 if (forced_on)
256 mdp->ops.setup_clk_force_ctrl(mdp, params->clk_ctrl, false);
257}
258
259void dpu_vbif_clear_errors(struct dpu_kms *dpu_kms)
260{
261 struct dpu_hw_vbif *vbif;
262 u32 i, pnd, src;
263
264 for (i = 0; i < ARRAY_SIZE(dpu_kms->hw_vbif); i++) {
265 vbif = dpu_kms->hw_vbif[i];
266 if (vbif && vbif->ops.clear_errors) {
267 vbif->ops.clear_errors(vbif, &pnd, &src);
268 if (pnd || src) {
269 DRM_DEBUG_KMS("VBIF %d: pnd 0x%X, src 0x%X\n",
270 vbif->idx - VBIF_0, pnd, src);
271 }
272 }
273 }
274}
275
276void dpu_vbif_init_memtypes(struct dpu_kms *dpu_kms)
277{
278 struct dpu_hw_vbif *vbif;
279 int i, j;
280
281 for (i = 0; i < ARRAY_SIZE(dpu_kms->hw_vbif); i++) {
282 vbif = dpu_kms->hw_vbif[i];
283 if (vbif && vbif->cap && vbif->ops.set_mem_type) {
284 for (j = 0; j < vbif->cap->memtype_count; j++)
285 vbif->ops.set_mem_type(
286 vbif, j, vbif->cap->memtype[j]);
287 }
288 }
289}
290
291#ifdef CONFIG_DEBUG_FS
292
293void dpu_debugfs_vbif_init(struct dpu_kms *dpu_kms, struct dentry *debugfs_root)
294{
295 char vbif_name[32];
296 struct dentry *entry, *debugfs_vbif;
297 int i, j;
298
299 entry = debugfs_create_dir("vbif", debugfs_root);
300
301 for (i = 0; i < dpu_kms->catalog->vbif_count; i++) {
302 const struct dpu_vbif_cfg *vbif = &dpu_kms->catalog->vbif[i];
303
304 snprintf(vbif_name, sizeof(vbif_name), "%d", vbif->id);
305
306 debugfs_vbif = debugfs_create_dir(vbif_name, entry);
307
308 debugfs_create_u32("features", 0600, debugfs_vbif,
309 (u32 *)&vbif->features);
310
311 debugfs_create_u32("xin_halt_timeout", 0400, debugfs_vbif,
312 (u32 *)&vbif->xin_halt_timeout);
313
314 debugfs_create_u32("default_rd_ot_limit", 0400, debugfs_vbif,
315 (u32 *)&vbif->default_ot_rd_limit);
316
317 debugfs_create_u32("default_wr_ot_limit", 0400, debugfs_vbif,
318 (u32 *)&vbif->default_ot_wr_limit);
319
320 for (j = 0; j < vbif->dynamic_ot_rd_tbl.count; j++) {
321 const struct dpu_vbif_dynamic_ot_cfg *cfg =
322 &vbif->dynamic_ot_rd_tbl.cfg[j];
323
324 snprintf(vbif_name, sizeof(vbif_name),
325 "dynamic_ot_rd_%d_pps", j);
326 debugfs_create_u64(vbif_name, 0400, debugfs_vbif,
327 (u64 *)&cfg->pps);
328 snprintf(vbif_name, sizeof(vbif_name),
329 "dynamic_ot_rd_%d_ot_limit", j);
330 debugfs_create_u32(vbif_name, 0400, debugfs_vbif,
331 (u32 *)&cfg->ot_limit);
332 }
333
334 for (j = 0; j < vbif->dynamic_ot_wr_tbl.count; j++) {
335 const struct dpu_vbif_dynamic_ot_cfg *cfg =
336 &vbif->dynamic_ot_wr_tbl.cfg[j];
337
338 snprintf(vbif_name, sizeof(vbif_name),
339 "dynamic_ot_wr_%d_pps", j);
340 debugfs_create_u64(vbif_name, 0400, debugfs_vbif,
341 (u64 *)&cfg->pps);
342 snprintf(vbif_name, sizeof(vbif_name),
343 "dynamic_ot_wr_%d_ot_limit", j);
344 debugfs_create_u32(vbif_name, 0400, debugfs_vbif,
345 (u32 *)&cfg->ot_limit);
346 }
347 }
348}
349#endif
350
