Linux Audio

Check our new training course

Linux kernel drivers training

May 6-19, 2025
Register
Loading...
Note: File does not exist in v3.1.
  1/*
  2 * Copyright (C) 2014-2015 Broadcom
  3 * Copyright (C) 2013 Red Hat
  4 *
  5 * This program is free software; you can redistribute it and/or modify
  6 * it under the terms of the GNU General Public License version 2 as
  7 * published by the Free Software Foundation.
  8 */
  9
 10#include <linux/clk.h>
 11#include <linux/component.h>
 12#include <linux/device.h>
 13#include <linux/io.h>
 14#include <linux/module.h>
 15#include <linux/of_platform.h>
 16#include <linux/platform_device.h>
 17#include <linux/pm_runtime.h>
 18#include "drm_fb_cma_helper.h"
 19#include <drm/drm_fb_helper.h>
 20
 21#include "uapi/drm/vc4_drm.h"
 22#include "vc4_drv.h"
 23#include "vc4_regs.h"
 24
 25#define DRIVER_NAME "vc4"
 26#define DRIVER_DESC "Broadcom VC4 graphics"
 27#define DRIVER_DATE "20140616"
 28#define DRIVER_MAJOR 0
 29#define DRIVER_MINOR 0
 30#define DRIVER_PATCHLEVEL 0
 31
 32/* Helper function for mapping the regs on a platform device. */
 33void __iomem *vc4_ioremap_regs(struct platform_device *dev, int index)
 34{
 35	struct resource *res;
 36	void __iomem *map;
 37
 38	res = platform_get_resource(dev, IORESOURCE_MEM, index);
 39	map = devm_ioremap_resource(&dev->dev, res);
 40	if (IS_ERR(map)) {
 41		DRM_ERROR("Failed to map registers: %ld\n", PTR_ERR(map));
 42		return map;
 43	}
 44
 45	return map;
 46}
 47
 48static int vc4_get_param_ioctl(struct drm_device *dev, void *data,
 49			       struct drm_file *file_priv)
 50{
 51	struct vc4_dev *vc4 = to_vc4_dev(dev);
 52	struct drm_vc4_get_param *args = data;
 53	int ret;
 54
 55	if (args->pad != 0)
 56		return -EINVAL;
 57
 58	switch (args->param) {
 59	case DRM_VC4_PARAM_V3D_IDENT0:
 60		ret = pm_runtime_get_sync(&vc4->v3d->pdev->dev);
 61		if (ret < 0)
 62			return ret;
 63		args->value = V3D_READ(V3D_IDENT0);
 64		pm_runtime_mark_last_busy(&vc4->v3d->pdev->dev);
 65		pm_runtime_put_autosuspend(&vc4->v3d->pdev->dev);
 66		break;
 67	case DRM_VC4_PARAM_V3D_IDENT1:
 68		ret = pm_runtime_get_sync(&vc4->v3d->pdev->dev);
 69		if (ret < 0)
 70			return ret;
 71		args->value = V3D_READ(V3D_IDENT1);
 72		pm_runtime_mark_last_busy(&vc4->v3d->pdev->dev);
 73		pm_runtime_put_autosuspend(&vc4->v3d->pdev->dev);
 74		break;
 75	case DRM_VC4_PARAM_V3D_IDENT2:
 76		ret = pm_runtime_get_sync(&vc4->v3d->pdev->dev);
 77		if (ret < 0)
 78			return ret;
 79		args->value = V3D_READ(V3D_IDENT2);
 80		pm_runtime_mark_last_busy(&vc4->v3d->pdev->dev);
 81		pm_runtime_put_autosuspend(&vc4->v3d->pdev->dev);
 82		break;
 83	case DRM_VC4_PARAM_SUPPORTS_BRANCHES:
 84	case DRM_VC4_PARAM_SUPPORTS_ETC1:
 85	case DRM_VC4_PARAM_SUPPORTS_THREADED_FS:
 86		args->value = true;
 87		break;
 88	default:
 89		DRM_DEBUG("Unknown parameter %d\n", args->param);
 90		return -EINVAL;
 91	}
 92
 93	return 0;
 94}
 95
 96static void vc4_lastclose(struct drm_device *dev)
 97{
 98	struct vc4_dev *vc4 = to_vc4_dev(dev);
 99
100	drm_fbdev_cma_restore_mode(vc4->fbdev);
101}
102
103static const struct file_operations vc4_drm_fops = {
104	.owner = THIS_MODULE,
105	.open = drm_open,
106	.release = drm_release,
107	.unlocked_ioctl = drm_ioctl,
108	.mmap = vc4_mmap,
109	.poll = drm_poll,
110	.read = drm_read,
111	.compat_ioctl = drm_compat_ioctl,
112	.llseek = noop_llseek,
113};
114
115static const struct drm_ioctl_desc vc4_drm_ioctls[] = {
116	DRM_IOCTL_DEF_DRV(VC4_SUBMIT_CL, vc4_submit_cl_ioctl, DRM_RENDER_ALLOW),
117	DRM_IOCTL_DEF_DRV(VC4_WAIT_SEQNO, vc4_wait_seqno_ioctl, DRM_RENDER_ALLOW),
118	DRM_IOCTL_DEF_DRV(VC4_WAIT_BO, vc4_wait_bo_ioctl, DRM_RENDER_ALLOW),
119	DRM_IOCTL_DEF_DRV(VC4_CREATE_BO, vc4_create_bo_ioctl, DRM_RENDER_ALLOW),
120	DRM_IOCTL_DEF_DRV(VC4_MMAP_BO, vc4_mmap_bo_ioctl, DRM_RENDER_ALLOW),
121	DRM_IOCTL_DEF_DRV(VC4_CREATE_SHADER_BO, vc4_create_shader_bo_ioctl, DRM_RENDER_ALLOW),
122	DRM_IOCTL_DEF_DRV(VC4_GET_HANG_STATE, vc4_get_hang_state_ioctl,
123			  DRM_ROOT_ONLY),
124	DRM_IOCTL_DEF_DRV(VC4_GET_PARAM, vc4_get_param_ioctl, DRM_RENDER_ALLOW),
125};
126
127static struct drm_driver vc4_drm_driver = {
128	.driver_features = (DRIVER_MODESET |
129			    DRIVER_ATOMIC |
130			    DRIVER_GEM |
131			    DRIVER_HAVE_IRQ |
132			    DRIVER_RENDER |
133			    DRIVER_PRIME),
134	.lastclose = vc4_lastclose,
135	.irq_handler = vc4_irq,
136	.irq_preinstall = vc4_irq_preinstall,
137	.irq_postinstall = vc4_irq_postinstall,
138	.irq_uninstall = vc4_irq_uninstall,
139
140	.enable_vblank = vc4_enable_vblank,
141	.disable_vblank = vc4_disable_vblank,
142	.get_vblank_counter = drm_vblank_no_hw_counter,
143	.get_scanout_position = vc4_crtc_get_scanoutpos,
144	.get_vblank_timestamp = vc4_crtc_get_vblank_timestamp,
145
146#if defined(CONFIG_DEBUG_FS)
147	.debugfs_init = vc4_debugfs_init,
148	.debugfs_cleanup = vc4_debugfs_cleanup,
149#endif
150
151	.gem_create_object = vc4_create_object,
152	.gem_free_object_unlocked = vc4_free_object,
153	.gem_vm_ops = &drm_gem_cma_vm_ops,
154
155	.prime_handle_to_fd = drm_gem_prime_handle_to_fd,
156	.prime_fd_to_handle = drm_gem_prime_fd_to_handle,
157	.gem_prime_import = drm_gem_prime_import,
158	.gem_prime_export = vc4_prime_export,
159	.gem_prime_get_sg_table	= drm_gem_cma_prime_get_sg_table,
160	.gem_prime_import_sg_table = drm_gem_cma_prime_import_sg_table,
161	.gem_prime_vmap = vc4_prime_vmap,
162	.gem_prime_vunmap = drm_gem_cma_prime_vunmap,
163	.gem_prime_mmap = vc4_prime_mmap,
164
165	.dumb_create = vc4_dumb_create,
166	.dumb_map_offset = drm_gem_cma_dumb_map_offset,
167	.dumb_destroy = drm_gem_dumb_destroy,
168
169	.ioctls = vc4_drm_ioctls,
170	.num_ioctls = ARRAY_SIZE(vc4_drm_ioctls),
171	.fops = &vc4_drm_fops,
172
173	.name = DRIVER_NAME,
174	.desc = DRIVER_DESC,
175	.date = DRIVER_DATE,
176	.major = DRIVER_MAJOR,
177	.minor = DRIVER_MINOR,
178	.patchlevel = DRIVER_PATCHLEVEL,
179};
180
181static int compare_dev(struct device *dev, void *data)
182{
183	return dev == data;
184}
185
186static void vc4_match_add_drivers(struct device *dev,
187				  struct component_match **match,
188				  struct platform_driver *const *drivers,
189				  int count)
190{
191	int i;
192
193	for (i = 0; i < count; i++) {
194		struct device_driver *drv = &drivers[i]->driver;
195		struct device *p = NULL, *d;
196
197		while ((d = bus_find_device(&platform_bus_type, p, drv,
198					    (void *)platform_bus_type.match))) {
199			put_device(p);
200			component_match_add(dev, match, compare_dev, d);
201			p = d;
202		}
203		put_device(p);
204	}
205}
206
207static void vc4_kick_out_firmware_fb(void)
208{
209	struct apertures_struct *ap;
210
211	ap = alloc_apertures(1);
212	if (!ap)
213		return;
214
215	/* Since VC4 is a UMA device, the simplefb node may have been
216	 * located anywhere in memory.
217	 */
218	ap->ranges[0].base = 0;
219	ap->ranges[0].size = ~0;
220
221	drm_fb_helper_remove_conflicting_framebuffers(ap, "vc4drmfb", false);
222	kfree(ap);
223}
224
225static int vc4_drm_bind(struct device *dev)
226{
227	struct platform_device *pdev = to_platform_device(dev);
228	struct drm_device *drm;
229	struct vc4_dev *vc4;
230	int ret = 0;
231
232	dev->coherent_dma_mask = DMA_BIT_MASK(32);
233
234	vc4 = devm_kzalloc(dev, sizeof(*vc4), GFP_KERNEL);
235	if (!vc4)
236		return -ENOMEM;
237
238	drm = drm_dev_alloc(&vc4_drm_driver, dev);
239	if (IS_ERR(drm))
240		return PTR_ERR(drm);
241	platform_set_drvdata(pdev, drm);
242	vc4->dev = drm;
243	drm->dev_private = vc4;
244
245	vc4_bo_cache_init(drm);
246
247	drm_mode_config_init(drm);
248
249	vc4_gem_init(drm);
250
251	ret = component_bind_all(dev, drm);
252	if (ret)
253		goto gem_destroy;
254
255	vc4_kick_out_firmware_fb();
256
257	ret = drm_dev_register(drm, 0);
258	if (ret < 0)
259		goto unbind_all;
260
261	vc4_kms_load(drm);
262
263	return 0;
264
265unbind_all:
266	component_unbind_all(dev, drm);
267gem_destroy:
268	vc4_gem_destroy(drm);
269	drm_dev_unref(drm);
270	vc4_bo_cache_destroy(drm);
271	return ret;
272}
273
274static void vc4_drm_unbind(struct device *dev)
275{
276	struct platform_device *pdev = to_platform_device(dev);
277	struct drm_device *drm = platform_get_drvdata(pdev);
278	struct vc4_dev *vc4 = to_vc4_dev(drm);
279
280	drm_dev_unregister(drm);
281
282	if (vc4->fbdev)
283		drm_fbdev_cma_fini(vc4->fbdev);
284
285	drm_mode_config_cleanup(drm);
286
287	drm_dev_unref(drm);
288}
289
290static const struct component_master_ops vc4_drm_ops = {
291	.bind = vc4_drm_bind,
292	.unbind = vc4_drm_unbind,
293};
294
295static struct platform_driver *const component_drivers[] = {
296	&vc4_hdmi_driver,
297	&vc4_vec_driver,
298	&vc4_dpi_driver,
299	&vc4_hvs_driver,
300	&vc4_crtc_driver,
301	&vc4_v3d_driver,
302};
303
304static int vc4_platform_drm_probe(struct platform_device *pdev)
305{
306	struct component_match *match = NULL;
307	struct device *dev = &pdev->dev;
308
309	vc4_match_add_drivers(dev, &match,
310			      component_drivers, ARRAY_SIZE(component_drivers));
311
312	return component_master_add_with_match(dev, &vc4_drm_ops, match);
313}
314
315static int vc4_platform_drm_remove(struct platform_device *pdev)
316{
317	component_master_del(&pdev->dev, &vc4_drm_ops);
318
319	return 0;
320}
321
322static const struct of_device_id vc4_of_match[] = {
323	{ .compatible = "brcm,bcm2835-vc4", },
324	{},
325};
326MODULE_DEVICE_TABLE(of, vc4_of_match);
327
328static struct platform_driver vc4_platform_driver = {
329	.probe		= vc4_platform_drm_probe,
330	.remove		= vc4_platform_drm_remove,
331	.driver		= {
332		.name	= "vc4-drm",
333		.of_match_table = vc4_of_match,
334	},
335};
336
337static int __init vc4_drm_register(void)
338{
339	int i, ret;
340
341	for (i = 0; i < ARRAY_SIZE(component_drivers); i++) {
342		ret = platform_driver_register(component_drivers[i]);
343		if (ret) {
344			while (--i >= 0)
345				platform_driver_unregister(component_drivers[i]);
346			return ret;
347		}
348	}
349	return platform_driver_register(&vc4_platform_driver);
350}
351
352static void __exit vc4_drm_unregister(void)
353{
354	int i;
355
356	for (i = ARRAY_SIZE(component_drivers) - 1; i >= 0; i--)
357		platform_driver_unregister(component_drivers[i]);
358
359	platform_driver_unregister(&vc4_platform_driver);
360}
361
362module_init(vc4_drm_register);
363module_exit(vc4_drm_unregister);
364
365MODULE_ALIAS("platform:vc4-drm");
366MODULE_DESCRIPTION("Broadcom VC4 DRM Driver");
367MODULE_AUTHOR("Eric Anholt <eric@anholt.net>");
368MODULE_LICENSE("GPL v2");