1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19#include <linux/clk.h>
20#include <linux/component.h>
21#include <linux/pm_runtime.h>
22#include "vc4_drv.h"
23#include "vc4_regs.h"
24
25#ifdef CONFIG_DEBUG_FS
26#define REGDEF(reg) { reg, #reg }
27static const struct {
28 uint32_t reg;
29 const char *name;
30} vc4_reg_defs[] = {
31 REGDEF(V3D_IDENT0),
32 REGDEF(V3D_IDENT1),
33 REGDEF(V3D_IDENT2),
34 REGDEF(V3D_SCRATCH),
35 REGDEF(V3D_L2CACTL),
36 REGDEF(V3D_SLCACTL),
37 REGDEF(V3D_INTCTL),
38 REGDEF(V3D_INTENA),
39 REGDEF(V3D_INTDIS),
40 REGDEF(V3D_CT0CS),
41 REGDEF(V3D_CT1CS),
42 REGDEF(V3D_CT0EA),
43 REGDEF(V3D_CT1EA),
44 REGDEF(V3D_CT0CA),
45 REGDEF(V3D_CT1CA),
46 REGDEF(V3D_CT00RA0),
47 REGDEF(V3D_CT01RA0),
48 REGDEF(V3D_CT0LC),
49 REGDEF(V3D_CT1LC),
50 REGDEF(V3D_CT0PC),
51 REGDEF(V3D_CT1PC),
52 REGDEF(V3D_PCS),
53 REGDEF(V3D_BFC),
54 REGDEF(V3D_RFC),
55 REGDEF(V3D_BPCA),
56 REGDEF(V3D_BPCS),
57 REGDEF(V3D_BPOA),
58 REGDEF(V3D_BPOS),
59 REGDEF(V3D_BXCF),
60 REGDEF(V3D_SQRSV0),
61 REGDEF(V3D_SQRSV1),
62 REGDEF(V3D_SQCNTL),
63 REGDEF(V3D_SRQPC),
64 REGDEF(V3D_SRQUA),
65 REGDEF(V3D_SRQUL),
66 REGDEF(V3D_SRQCS),
67 REGDEF(V3D_VPACNTL),
68 REGDEF(V3D_VPMBASE),
69 REGDEF(V3D_PCTRC),
70 REGDEF(V3D_PCTRE),
71 REGDEF(V3D_PCTR(0)),
72 REGDEF(V3D_PCTRS(0)),
73 REGDEF(V3D_PCTR(1)),
74 REGDEF(V3D_PCTRS(1)),
75 REGDEF(V3D_PCTR(2)),
76 REGDEF(V3D_PCTRS(2)),
77 REGDEF(V3D_PCTR(3)),
78 REGDEF(V3D_PCTRS(3)),
79 REGDEF(V3D_PCTR(4)),
80 REGDEF(V3D_PCTRS(4)),
81 REGDEF(V3D_PCTR(5)),
82 REGDEF(V3D_PCTRS(5)),
83 REGDEF(V3D_PCTR(6)),
84 REGDEF(V3D_PCTRS(6)),
85 REGDEF(V3D_PCTR(7)),
86 REGDEF(V3D_PCTRS(7)),
87 REGDEF(V3D_PCTR(8)),
88 REGDEF(V3D_PCTRS(8)),
89 REGDEF(V3D_PCTR(9)),
90 REGDEF(V3D_PCTRS(9)),
91 REGDEF(V3D_PCTR(10)),
92 REGDEF(V3D_PCTRS(10)),
93 REGDEF(V3D_PCTR(11)),
94 REGDEF(V3D_PCTRS(11)),
95 REGDEF(V3D_PCTR(12)),
96 REGDEF(V3D_PCTRS(12)),
97 REGDEF(V3D_PCTR(13)),
98 REGDEF(V3D_PCTRS(13)),
99 REGDEF(V3D_PCTR(14)),
100 REGDEF(V3D_PCTRS(14)),
101 REGDEF(V3D_PCTR(15)),
102 REGDEF(V3D_PCTRS(15)),
103 REGDEF(V3D_DBGE),
104 REGDEF(V3D_FDBGO),
105 REGDEF(V3D_FDBGB),
106 REGDEF(V3D_FDBGR),
107 REGDEF(V3D_FDBGS),
108 REGDEF(V3D_ERRSTAT),
109};
110
111int vc4_v3d_debugfs_regs(struct seq_file *m, void *unused)
112{
113 struct drm_info_node *node = (struct drm_info_node *)m->private;
114 struct drm_device *dev = node->minor->dev;
115 struct vc4_dev *vc4 = to_vc4_dev(dev);
116 int i;
117
118 for (i = 0; i < ARRAY_SIZE(vc4_reg_defs); i++) {
119 seq_printf(m, "%s (0x%04x): 0x%08x\n",
120 vc4_reg_defs[i].name, vc4_reg_defs[i].reg,
121 V3D_READ(vc4_reg_defs[i].reg));
122 }
123
124 return 0;
125}
126
127int vc4_v3d_debugfs_ident(struct seq_file *m, void *unused)
128{
129 struct drm_info_node *node = (struct drm_info_node *)m->private;
130 struct drm_device *dev = node->minor->dev;
131 struct vc4_dev *vc4 = to_vc4_dev(dev);
132 uint32_t ident1 = V3D_READ(V3D_IDENT1);
133 uint32_t nslc = VC4_GET_FIELD(ident1, V3D_IDENT1_NSLC);
134 uint32_t tups = VC4_GET_FIELD(ident1, V3D_IDENT1_TUPS);
135 uint32_t qups = VC4_GET_FIELD(ident1, V3D_IDENT1_QUPS);
136
137 seq_printf(m, "Revision: %d\n",
138 VC4_GET_FIELD(ident1, V3D_IDENT1_REV));
139 seq_printf(m, "Slices: %d\n", nslc);
140 seq_printf(m, "TMUs: %d\n", nslc * tups);
141 seq_printf(m, "QPUs: %d\n", nslc * qups);
142 seq_printf(m, "Semaphores: %d\n",
143 VC4_GET_FIELD(ident1, V3D_IDENT1_NSEM));
144
145 return 0;
146}
147#endif
148
149static void vc4_v3d_init_hw(struct drm_device *dev)
150{
151 struct vc4_dev *vc4 = to_vc4_dev(dev);
152
153
154
155
156
157 V3D_WRITE(V3D_VPMBASE, 0);
158}
159
160int vc4_v3d_get_bin_slot(struct vc4_dev *vc4)
161{
162 struct drm_device *dev = vc4->dev;
163 unsigned long irqflags;
164 int slot;
165 uint64_t seqno = 0;
166 struct vc4_exec_info *exec;
167
168try_again:
169 spin_lock_irqsave(&vc4->job_lock, irqflags);
170 slot = ffs(~vc4->bin_alloc_used);
171 if (slot != 0) {
172
173 slot--;
174 vc4->bin_alloc_used |= BIT(slot);
175 spin_unlock_irqrestore(&vc4->job_lock, irqflags);
176 return slot;
177 }
178
179
180
181
182 exec = vc4_last_render_job(vc4);
183 if (exec)
184 seqno = exec->seqno;
185 spin_unlock_irqrestore(&vc4->job_lock, irqflags);
186
187 if (seqno) {
188 int ret = vc4_wait_for_seqno(dev, seqno, ~0ull, true);
189
190 if (ret == 0)
191 goto try_again;
192
193 return ret;
194 }
195
196 return -ENOMEM;
197}
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221int
222vc4_allocate_bin_bo(struct drm_device *drm)
223{
224 struct vc4_dev *vc4 = to_vc4_dev(drm);
225 struct vc4_v3d *v3d = vc4->v3d;
226 uint32_t size = 16 * 1024 * 1024;
227 int ret = 0;
228 struct list_head list;
229
230
231
232
233
234
235
236 INIT_LIST_HEAD(&list);
237
238 while (true) {
239 struct vc4_bo *bo = vc4_bo_create(drm, size, true,
240 VC4_BO_TYPE_BIN);
241
242 if (IS_ERR(bo)) {
243 ret = PTR_ERR(bo);
244
245 dev_err(&v3d->pdev->dev,
246 "Failed to allocate memory for tile binning: "
247 "%d. You may need to enable CMA or give it "
248 "more memory.",
249 ret);
250 break;
251 }
252
253
254 if ((bo->base.paddr & 0xf0000000) ==
255 ((bo->base.paddr + bo->base.base.size - 1) & 0xf0000000)) {
256 vc4->bin_bo = bo;
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274 vc4->bin_alloc_size = 512 * 1024;
275 vc4->bin_alloc_used = 0;
276 vc4->bin_alloc_overflow = 0;
277 WARN_ON_ONCE(sizeof(vc4->bin_alloc_used) * 8 !=
278 bo->base.base.size / vc4->bin_alloc_size);
279
280 break;
281 }
282
283
284 list_add(&bo->unref_head, &list);
285 }
286
287
288 while (!list_empty(&list)) {
289 struct vc4_bo *bo = list_last_entry(&list,
290 struct vc4_bo, unref_head);
291
292 list_del(&bo->unref_head);
293 drm_gem_object_put_unlocked(&bo->base.base);
294 }
295
296 return ret;
297}
298
299#ifdef CONFIG_PM
300static int vc4_v3d_runtime_suspend(struct device *dev)
301{
302 struct vc4_v3d *v3d = dev_get_drvdata(dev);
303 struct vc4_dev *vc4 = v3d->vc4;
304
305 vc4_irq_uninstall(vc4->dev);
306
307 drm_gem_object_put_unlocked(&vc4->bin_bo->base.base);
308 vc4->bin_bo = NULL;
309
310 clk_disable_unprepare(v3d->clk);
311
312 return 0;
313}
314
315static int vc4_v3d_runtime_resume(struct device *dev)
316{
317 struct vc4_v3d *v3d = dev_get_drvdata(dev);
318 struct vc4_dev *vc4 = v3d->vc4;
319 int ret;
320
321 ret = vc4_allocate_bin_bo(vc4->dev);
322 if (ret)
323 return ret;
324
325 ret = clk_prepare_enable(v3d->clk);
326 if (ret != 0)
327 return ret;
328
329 vc4_v3d_init_hw(vc4->dev);
330
331
332 enable_irq(vc4->dev->irq);
333 vc4_irq_postinstall(vc4->dev);
334
335 return 0;
336}
337#endif
338
339static int vc4_v3d_bind(struct device *dev, struct device *master, void *data)
340{
341 struct platform_device *pdev = to_platform_device(dev);
342 struct drm_device *drm = dev_get_drvdata(master);
343 struct vc4_dev *vc4 = to_vc4_dev(drm);
344 struct vc4_v3d *v3d = NULL;
345 int ret;
346
347 v3d = devm_kzalloc(&pdev->dev, sizeof(*v3d), GFP_KERNEL);
348 if (!v3d)
349 return -ENOMEM;
350
351 dev_set_drvdata(dev, v3d);
352
353 v3d->pdev = pdev;
354
355 v3d->regs = vc4_ioremap_regs(pdev, 0);
356 if (IS_ERR(v3d->regs))
357 return PTR_ERR(v3d->regs);
358
359 vc4->v3d = v3d;
360 v3d->vc4 = vc4;
361
362 v3d->clk = devm_clk_get(dev, NULL);
363 if (IS_ERR(v3d->clk)) {
364 int ret = PTR_ERR(v3d->clk);
365
366 if (ret == -ENOENT) {
367
368 ret = 0;
369 v3d->clk = NULL;
370 } else {
371 if (ret != -EPROBE_DEFER)
372 dev_err(dev, "Failed to get V3D clock: %d\n",
373 ret);
374 return ret;
375 }
376 }
377
378 if (V3D_READ(V3D_IDENT0) != V3D_EXPECTED_IDENT0) {
379 DRM_ERROR("V3D_IDENT0 read 0x%08x instead of 0x%08x\n",
380 V3D_READ(V3D_IDENT0), V3D_EXPECTED_IDENT0);
381 return -EINVAL;
382 }
383
384 ret = clk_prepare_enable(v3d->clk);
385 if (ret != 0)
386 return ret;
387
388 ret = vc4_allocate_bin_bo(drm);
389 if (ret) {
390 clk_disable_unprepare(v3d->clk);
391 return ret;
392 }
393
394
395
396
397 V3D_WRITE(V3D_BPOA, 0);
398 V3D_WRITE(V3D_BPOS, 0);
399
400 vc4_v3d_init_hw(drm);
401
402 ret = drm_irq_install(drm, platform_get_irq(pdev, 0));
403 if (ret) {
404 DRM_ERROR("Failed to install IRQ handler\n");
405 return ret;
406 }
407
408 pm_runtime_set_active(dev);
409 pm_runtime_use_autosuspend(dev);
410 pm_runtime_set_autosuspend_delay(dev, 40);
411 pm_runtime_enable(dev);
412
413 return 0;
414}
415
416static void vc4_v3d_unbind(struct device *dev, struct device *master,
417 void *data)
418{
419 struct drm_device *drm = dev_get_drvdata(master);
420 struct vc4_dev *vc4 = to_vc4_dev(drm);
421
422 pm_runtime_disable(dev);
423
424 drm_irq_uninstall(drm);
425
426
427
428
429
430 V3D_WRITE(V3D_BPOA, 0);
431 V3D_WRITE(V3D_BPOS, 0);
432
433 vc4->v3d = NULL;
434}
435
436static const struct dev_pm_ops vc4_v3d_pm_ops = {
437 SET_RUNTIME_PM_OPS(vc4_v3d_runtime_suspend, vc4_v3d_runtime_resume, NULL)
438};
439
440static const struct component_ops vc4_v3d_ops = {
441 .bind = vc4_v3d_bind,
442 .unbind = vc4_v3d_unbind,
443};
444
445static int vc4_v3d_dev_probe(struct platform_device *pdev)
446{
447 return component_add(&pdev->dev, &vc4_v3d_ops);
448}
449
450static int vc4_v3d_dev_remove(struct platform_device *pdev)
451{
452 component_del(&pdev->dev, &vc4_v3d_ops);
453 return 0;
454}
455
456static const struct of_device_id vc4_v3d_dt_match[] = {
457 { .compatible = "brcm,bcm2835-v3d" },
458 { .compatible = "brcm,cygnus-v3d" },
459 { .compatible = "brcm,vc4-v3d" },
460 {}
461};
462
463struct platform_driver vc4_v3d_driver = {
464 .probe = vc4_v3d_dev_probe,
465 .remove = vc4_v3d_dev_remove,
466 .driver = {
467 .name = "vc4_v3d",
468 .of_match_table = vc4_v3d_dt_match,
469 .pm = &vc4_v3d_pm_ops,
470 },
471};
472