1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <linux/clk.h>
16#include <linux/device.h>
17#include <linux/dma-mapping.h>
18#include <linux/io.h>
19#include <linux/module.h>
20#include <linux/of_platform.h>
21#include <linux/platform_device.h>
22#include <linux/pm_runtime.h>
23#include <linux/reset.h>
24
25#include <drm/drm_drv.h>
26#include <drm/drm_fb_cma_helper.h>
27#include <drm/drm_fb_helper.h>
28#include <drm/drm_managed.h>
29#include <uapi/drm/v3d_drm.h>
30
31#include "v3d_drv.h"
32#include "v3d_regs.h"
33
34#define DRIVER_NAME "v3d"
35#define DRIVER_DESC "Broadcom V3D graphics"
36#define DRIVER_DATE "20180419"
37#define DRIVER_MAJOR 1
38#define DRIVER_MINOR 0
39#define DRIVER_PATCHLEVEL 0
40
41static int v3d_get_param_ioctl(struct drm_device *dev, void *data,
42 struct drm_file *file_priv)
43{
44 struct v3d_dev *v3d = to_v3d_dev(dev);
45 struct drm_v3d_get_param *args = data;
46 int ret;
47 static const u32 reg_map[] = {
48 [DRM_V3D_PARAM_V3D_UIFCFG] = V3D_HUB_UIFCFG,
49 [DRM_V3D_PARAM_V3D_HUB_IDENT1] = V3D_HUB_IDENT1,
50 [DRM_V3D_PARAM_V3D_HUB_IDENT2] = V3D_HUB_IDENT2,
51 [DRM_V3D_PARAM_V3D_HUB_IDENT3] = V3D_HUB_IDENT3,
52 [DRM_V3D_PARAM_V3D_CORE0_IDENT0] = V3D_CTL_IDENT0,
53 [DRM_V3D_PARAM_V3D_CORE0_IDENT1] = V3D_CTL_IDENT1,
54 [DRM_V3D_PARAM_V3D_CORE0_IDENT2] = V3D_CTL_IDENT2,
55 };
56
57 if (args->pad != 0)
58 return -EINVAL;
59
60
61
62
63
64 if (args->param < ARRAY_SIZE(reg_map) &&
65 (reg_map[args->param] ||
66 args->param == DRM_V3D_PARAM_V3D_CORE0_IDENT0)) {
67 u32 offset = reg_map[args->param];
68
69 if (args->value != 0)
70 return -EINVAL;
71
72 ret = pm_runtime_get_sync(v3d->drm.dev);
73 if (ret < 0)
74 return ret;
75 if (args->param >= DRM_V3D_PARAM_V3D_CORE0_IDENT0 &&
76 args->param <= DRM_V3D_PARAM_V3D_CORE0_IDENT2) {
77 args->value = V3D_CORE_READ(0, offset);
78 } else {
79 args->value = V3D_READ(offset);
80 }
81 pm_runtime_mark_last_busy(v3d->drm.dev);
82 pm_runtime_put_autosuspend(v3d->drm.dev);
83 return 0;
84 }
85
86
87 switch (args->param) {
88 case DRM_V3D_PARAM_SUPPORTS_TFU:
89 args->value = 1;
90 return 0;
91 case DRM_V3D_PARAM_SUPPORTS_CSD:
92 args->value = v3d_has_csd(v3d);
93 return 0;
94 case DRM_V3D_PARAM_SUPPORTS_CACHE_FLUSH:
95 args->value = 1;
96 return 0;
97 default:
98 DRM_DEBUG("Unknown parameter %d\n", args->param);
99 return -EINVAL;
100 }
101}
102
103static int
104v3d_open(struct drm_device *dev, struct drm_file *file)
105{
106 struct v3d_dev *v3d = to_v3d_dev(dev);
107 struct v3d_file_priv *v3d_priv;
108 struct drm_gpu_scheduler *sched;
109 int i;
110
111 v3d_priv = kzalloc(sizeof(*v3d_priv), GFP_KERNEL);
112 if (!v3d_priv)
113 return -ENOMEM;
114
115 v3d_priv->v3d = v3d;
116
117 for (i = 0; i < V3D_MAX_QUEUES; i++) {
118 sched = &v3d->queue[i].sched;
119 drm_sched_entity_init(&v3d_priv->sched_entity[i],
120 DRM_SCHED_PRIORITY_NORMAL, &sched,
121 1, NULL);
122 }
123
124 file->driver_priv = v3d_priv;
125
126 return 0;
127}
128
129static void
130v3d_postclose(struct drm_device *dev, struct drm_file *file)
131{
132 struct v3d_file_priv *v3d_priv = file->driver_priv;
133 enum v3d_queue q;
134
135 for (q = 0; q < V3D_MAX_QUEUES; q++) {
136 drm_sched_entity_destroy(&v3d_priv->sched_entity[q]);
137 }
138
139 kfree(v3d_priv);
140}
141
142DEFINE_DRM_GEM_FOPS(v3d_drm_fops);
143
144
145
146
147
148
149
150static const struct drm_ioctl_desc v3d_drm_ioctls[] = {
151 DRM_IOCTL_DEF_DRV(V3D_SUBMIT_CL, v3d_submit_cl_ioctl, DRM_RENDER_ALLOW | DRM_AUTH),
152 DRM_IOCTL_DEF_DRV(V3D_WAIT_BO, v3d_wait_bo_ioctl, DRM_RENDER_ALLOW),
153 DRM_IOCTL_DEF_DRV(V3D_CREATE_BO, v3d_create_bo_ioctl, DRM_RENDER_ALLOW),
154 DRM_IOCTL_DEF_DRV(V3D_MMAP_BO, v3d_mmap_bo_ioctl, DRM_RENDER_ALLOW),
155 DRM_IOCTL_DEF_DRV(V3D_GET_PARAM, v3d_get_param_ioctl, DRM_RENDER_ALLOW),
156 DRM_IOCTL_DEF_DRV(V3D_GET_BO_OFFSET, v3d_get_bo_offset_ioctl, DRM_RENDER_ALLOW),
157 DRM_IOCTL_DEF_DRV(V3D_SUBMIT_TFU, v3d_submit_tfu_ioctl, DRM_RENDER_ALLOW | DRM_AUTH),
158 DRM_IOCTL_DEF_DRV(V3D_SUBMIT_CSD, v3d_submit_csd_ioctl, DRM_RENDER_ALLOW | DRM_AUTH),
159};
160
161static const struct drm_driver v3d_drm_driver = {
162 .driver_features = (DRIVER_GEM |
163 DRIVER_RENDER |
164 DRIVER_SYNCOBJ),
165
166 .open = v3d_open,
167 .postclose = v3d_postclose,
168
169#if defined(CONFIG_DEBUG_FS)
170 .debugfs_init = v3d_debugfs_init,
171#endif
172
173 .gem_create_object = v3d_create_object,
174 .prime_handle_to_fd = drm_gem_prime_handle_to_fd,
175 .prime_fd_to_handle = drm_gem_prime_fd_to_handle,
176 .gem_prime_import_sg_table = v3d_prime_import_sg_table,
177 .gem_prime_mmap = drm_gem_prime_mmap,
178
179 .ioctls = v3d_drm_ioctls,
180 .num_ioctls = ARRAY_SIZE(v3d_drm_ioctls),
181 .fops = &v3d_drm_fops,
182
183 .name = DRIVER_NAME,
184 .desc = DRIVER_DESC,
185 .date = DRIVER_DATE,
186 .major = DRIVER_MAJOR,
187 .minor = DRIVER_MINOR,
188 .patchlevel = DRIVER_PATCHLEVEL,
189};
190
191static const struct of_device_id v3d_of_match[] = {
192 { .compatible = "brcm,7268-v3d" },
193 { .compatible = "brcm,7278-v3d" },
194 {},
195};
196MODULE_DEVICE_TABLE(of, v3d_of_match);
197
198static int
199map_regs(struct v3d_dev *v3d, void __iomem **regs, const char *name)
200{
201 struct resource *res =
202 platform_get_resource_byname(v3d_to_pdev(v3d), IORESOURCE_MEM, name);
203
204 *regs = devm_ioremap_resource(v3d->drm.dev, res);
205 return PTR_ERR_OR_ZERO(*regs);
206}
207
208static int v3d_platform_drm_probe(struct platform_device *pdev)
209{
210 struct device *dev = &pdev->dev;
211 struct drm_device *drm;
212 struct v3d_dev *v3d;
213 int ret;
214 u32 mmu_debug;
215 u32 ident1;
216
217
218 v3d = devm_drm_dev_alloc(dev, &v3d_drm_driver, struct v3d_dev, drm);
219 if (IS_ERR(v3d))
220 return PTR_ERR(v3d);
221
222 drm = &v3d->drm;
223
224 platform_set_drvdata(pdev, drm);
225
226 ret = map_regs(v3d, &v3d->hub_regs, "hub");
227 if (ret)
228 return ret;
229
230 ret = map_regs(v3d, &v3d->core_regs[0], "core0");
231 if (ret)
232 return ret;
233
234 mmu_debug = V3D_READ(V3D_MMU_DEBUG_INFO);
235 dma_set_mask_and_coherent(dev,
236 DMA_BIT_MASK(30 + V3D_GET_FIELD(mmu_debug, V3D_MMU_PA_WIDTH)));
237 v3d->va_width = 30 + V3D_GET_FIELD(mmu_debug, V3D_MMU_VA_WIDTH);
238
239 ident1 = V3D_READ(V3D_HUB_IDENT1);
240 v3d->ver = (V3D_GET_FIELD(ident1, V3D_HUB_IDENT1_TVER) * 10 +
241 V3D_GET_FIELD(ident1, V3D_HUB_IDENT1_REV));
242 v3d->cores = V3D_GET_FIELD(ident1, V3D_HUB_IDENT1_NCORES);
243 WARN_ON(v3d->cores > 1);
244
245 v3d->reset = devm_reset_control_get_exclusive(dev, NULL);
246 if (IS_ERR(v3d->reset)) {
247 ret = PTR_ERR(v3d->reset);
248
249 if (ret == -EPROBE_DEFER)
250 return ret;
251
252 v3d->reset = NULL;
253 ret = map_regs(v3d, &v3d->bridge_regs, "bridge");
254 if (ret) {
255 dev_err(dev,
256 "Failed to get reset control or bridge regs\n");
257 return ret;
258 }
259 }
260
261 if (v3d->ver < 41) {
262 ret = map_regs(v3d, &v3d->gca_regs, "gca");
263 if (ret)
264 return ret;
265 }
266
267 v3d->mmu_scratch = dma_alloc_wc(dev, 4096, &v3d->mmu_scratch_paddr,
268 GFP_KERNEL | __GFP_NOWARN | __GFP_ZERO);
269 if (!v3d->mmu_scratch) {
270 dev_err(dev, "Failed to allocate MMU scratch page\n");
271 return -ENOMEM;
272 }
273
274 pm_runtime_use_autosuspend(dev);
275 pm_runtime_set_autosuspend_delay(dev, 50);
276 pm_runtime_enable(dev);
277
278 ret = v3d_gem_init(drm);
279 if (ret)
280 goto dma_free;
281
282 ret = v3d_irq_init(v3d);
283 if (ret)
284 goto gem_destroy;
285
286 ret = drm_dev_register(drm, 0);
287 if (ret)
288 goto irq_disable;
289
290 return 0;
291
292irq_disable:
293 v3d_irq_disable(v3d);
294gem_destroy:
295 v3d_gem_destroy(drm);
296dma_free:
297 dma_free_wc(dev, 4096, v3d->mmu_scratch, v3d->mmu_scratch_paddr);
298 return ret;
299}
300
301static int v3d_platform_drm_remove(struct platform_device *pdev)
302{
303 struct drm_device *drm = platform_get_drvdata(pdev);
304 struct v3d_dev *v3d = to_v3d_dev(drm);
305
306 drm_dev_unregister(drm);
307
308 v3d_gem_destroy(drm);
309
310 dma_free_wc(v3d->drm.dev, 4096, v3d->mmu_scratch,
311 v3d->mmu_scratch_paddr);
312
313 return 0;
314}
315
316static struct platform_driver v3d_platform_driver = {
317 .probe = v3d_platform_drm_probe,
318 .remove = v3d_platform_drm_remove,
319 .driver = {
320 .name = "v3d",
321 .of_match_table = v3d_of_match,
322 },
323};
324
325module_platform_driver(v3d_platform_driver);
326
327MODULE_ALIAS("platform:v3d-drm");
328MODULE_DESCRIPTION("Broadcom V3D DRM Driver");
329MODULE_AUTHOR("Eric Anholt <eric@anholt.net>");
330MODULE_LICENSE("GPL v2");
331
