1 | // SPDX-License-Identifier: GPL-2.0+ |
2 | /* |
3 | * Freescale i.MX drm driver |
4 | * |
5 | * Copyright (C) 2011 Sascha Hauer, Pengutronix |
6 | */ |
7 | |
8 | #include <linux/component.h> |
9 | #include <linux/device.h> |
10 | #include <linux/dma-buf.h> |
11 | #include <linux/module.h> |
12 | #include <linux/platform_device.h> |
13 | |
14 | #include <video/imx-ipu-v3.h> |
15 | |
16 | #include <drm/drm_atomic.h> |
17 | #include <drm/drm_atomic_helper.h> |
18 | #include <drm/drm_drv.h> |
19 | #include <drm/drm_fbdev_dma.h> |
20 | #include <drm/drm_gem_dma_helper.h> |
21 | #include <drm/drm_gem_framebuffer_helper.h> |
22 | #include <drm/drm_managed.h> |
23 | #include <drm/drm_of.h> |
24 | #include <drm/drm_probe_helper.h> |
25 | #include <drm/drm_vblank.h> |
26 | |
27 | #include "imx-drm.h" |
28 | #include "ipuv3-plane.h" |
29 | |
30 | #define MAX_CRTC 4 |
31 | |
32 | static int legacyfb_depth = 16; |
33 | module_param(legacyfb_depth, int, 0444); |
34 | |
35 | DEFINE_DRM_GEM_DMA_FOPS(imx_drm_driver_fops); |
36 | |
37 | void imx_drm_connector_destroy(struct drm_connector *connector) |
38 | { |
39 | drm_connector_unregister(connector); |
40 | drm_connector_cleanup(connector); |
41 | } |
42 | EXPORT_SYMBOL_GPL(imx_drm_connector_destroy); |
43 | |
44 | static int imx_drm_atomic_check(struct drm_device *dev, |
45 | struct drm_atomic_state *state) |
46 | { |
47 | int ret; |
48 | |
49 | ret = drm_atomic_helper_check(dev, state); |
50 | if (ret) |
51 | return ret; |
52 | |
53 | /* |
54 | * Check modeset again in case crtc_state->mode_changed is |
55 | * updated in plane's ->atomic_check callback. |
56 | */ |
57 | ret = drm_atomic_helper_check_modeset(dev, state); |
58 | if (ret) |
59 | return ret; |
60 | |
61 | /* Assign PRG/PRE channels and check if all constrains are satisfied. */ |
62 | ret = ipu_planes_assign_pre(dev, state); |
63 | if (ret) |
64 | return ret; |
65 | |
66 | return ret; |
67 | } |
68 | |
69 | static const struct drm_mode_config_funcs imx_drm_mode_config_funcs = { |
70 | .fb_create = drm_gem_fb_create, |
71 | .atomic_check = imx_drm_atomic_check, |
72 | .atomic_commit = drm_atomic_helper_commit, |
73 | }; |
74 | |
75 | static void imx_drm_atomic_commit_tail(struct drm_atomic_state *state) |
76 | { |
77 | struct drm_device *dev = state->dev; |
78 | struct drm_plane *plane; |
79 | struct drm_plane_state *old_plane_state, *new_plane_state; |
80 | bool plane_disabling = false; |
81 | int i; |
82 | |
83 | drm_atomic_helper_commit_modeset_disables(dev, state); |
84 | |
85 | drm_atomic_helper_commit_planes(dev, state, |
86 | DRM_PLANE_COMMIT_ACTIVE_ONLY | |
87 | DRM_PLANE_COMMIT_NO_DISABLE_AFTER_MODESET); |
88 | |
89 | drm_atomic_helper_commit_modeset_enables(dev, old_state: state); |
90 | |
91 | for_each_oldnew_plane_in_state(state, plane, old_plane_state, new_plane_state, i) { |
92 | if (drm_atomic_plane_disabling(old_plane_state, new_plane_state)) |
93 | plane_disabling = true; |
94 | } |
95 | |
96 | /* |
97 | * The flip done wait is only strictly required by imx-drm if a deferred |
98 | * plane disable is in-flight. As the core requires blocking commits |
99 | * to wait for the flip it is done here unconditionally. This keeps the |
100 | * workitem around a bit longer than required for the majority of |
101 | * non-blocking commits, but we accept that for the sake of simplicity. |
102 | */ |
103 | drm_atomic_helper_wait_for_flip_done(dev, old_state: state); |
104 | |
105 | if (plane_disabling) { |
106 | for_each_old_plane_in_state(state, plane, old_plane_state, i) |
107 | ipu_plane_disable_deferred(plane); |
108 | |
109 | } |
110 | |
111 | drm_atomic_helper_commit_hw_done(state); |
112 | } |
113 | |
114 | static const struct drm_mode_config_helper_funcs imx_drm_mode_config_helpers = { |
115 | .atomic_commit_tail = imx_drm_atomic_commit_tail, |
116 | }; |
117 | |
118 | |
119 | int imx_drm_encoder_parse_of(struct drm_device *drm, |
120 | struct drm_encoder *encoder, struct device_node *np) |
121 | { |
122 | uint32_t crtc_mask = drm_of_find_possible_crtcs(dev: drm, port: np); |
123 | |
124 | /* |
125 | * If we failed to find the CRTC(s) which this encoder is |
126 | * supposed to be connected to, it's because the CRTC has |
127 | * not been registered yet. Defer probing, and hope that |
128 | * the required CRTC is added later. |
129 | */ |
130 | if (crtc_mask == 0) |
131 | return -EPROBE_DEFER; |
132 | |
133 | encoder->possible_crtcs = crtc_mask; |
134 | |
135 | /* FIXME: cloning support not clear, disable it all for now */ |
136 | encoder->possible_clones = 0; |
137 | |
138 | return 0; |
139 | } |
140 | EXPORT_SYMBOL_GPL(imx_drm_encoder_parse_of); |
141 | |
142 | static const struct drm_ioctl_desc imx_drm_ioctls[] = { |
143 | /* none so far */ |
144 | }; |
145 | |
146 | static int imx_drm_dumb_create(struct drm_file *file_priv, |
147 | struct drm_device *drm, |
148 | struct drm_mode_create_dumb *args) |
149 | { |
150 | u32 width = args->width; |
151 | int ret; |
152 | |
153 | args->width = ALIGN(width, 8); |
154 | |
155 | ret = drm_gem_dma_dumb_create(file_priv, drm, args); |
156 | if (ret) |
157 | return ret; |
158 | |
159 | args->width = width; |
160 | return ret; |
161 | } |
162 | |
163 | static const struct drm_driver imx_drm_driver = { |
164 | .driver_features = DRIVER_MODESET | DRIVER_GEM | DRIVER_ATOMIC, |
165 | DRM_GEM_DMA_DRIVER_OPS_WITH_DUMB_CREATE(imx_drm_dumb_create), |
166 | .ioctls = imx_drm_ioctls, |
167 | .num_ioctls = ARRAY_SIZE(imx_drm_ioctls), |
168 | .fops = &imx_drm_driver_fops, |
169 | .name = "imx-drm" , |
170 | .desc = "i.MX DRM graphics" , |
171 | .date = "20120507" , |
172 | .major = 1, |
173 | .minor = 0, |
174 | .patchlevel = 0, |
175 | }; |
176 | |
177 | static int compare_of(struct device *dev, void *data) |
178 | { |
179 | struct device_node *np = data; |
180 | |
181 | /* Special case for DI, dev->of_node may not be set yet */ |
182 | if (strcmp(dev->driver->name, "imx-ipuv3-crtc" ) == 0) { |
183 | struct ipu_client_platformdata *pdata = dev->platform_data; |
184 | |
185 | return pdata->of_node == np; |
186 | } |
187 | |
188 | /* Special case for LDB, one device for two channels */ |
189 | if (of_node_name_eq(np, name: "lvds-channel" )) { |
190 | np = of_get_parent(node: np); |
191 | of_node_put(node: np); |
192 | } |
193 | |
194 | return dev->of_node == np; |
195 | } |
196 | |
197 | static int imx_drm_bind(struct device *dev) |
198 | { |
199 | struct drm_device *drm; |
200 | int ret; |
201 | |
202 | drm = drm_dev_alloc(driver: &imx_drm_driver, parent: dev); |
203 | if (IS_ERR(ptr: drm)) |
204 | return PTR_ERR(ptr: drm); |
205 | |
206 | /* |
207 | * set max width and height as default value(4096x4096). |
208 | * this value would be used to check framebuffer size limitation |
209 | * at drm_mode_addfb(). |
210 | */ |
211 | drm->mode_config.min_width = 1; |
212 | drm->mode_config.min_height = 1; |
213 | drm->mode_config.max_width = 4096; |
214 | drm->mode_config.max_height = 4096; |
215 | drm->mode_config.funcs = &imx_drm_mode_config_funcs; |
216 | drm->mode_config.helper_private = &imx_drm_mode_config_helpers; |
217 | drm->mode_config.normalize_zpos = true; |
218 | |
219 | ret = drmm_mode_config_init(dev: drm); |
220 | if (ret) |
221 | goto err_kms; |
222 | |
223 | ret = drm_vblank_init(dev: drm, MAX_CRTC); |
224 | if (ret) |
225 | goto err_kms; |
226 | |
227 | dev_set_drvdata(dev, data: drm); |
228 | |
229 | /* Now try and bind all our sub-components */ |
230 | ret = component_bind_all(parent: dev, data: drm); |
231 | if (ret) |
232 | goto err_kms; |
233 | |
234 | drm_mode_config_reset(dev: drm); |
235 | |
236 | /* |
237 | * All components are now initialised, so setup the fb helper. |
238 | * The fb helper takes copies of key hardware information, so the |
239 | * crtcs/connectors/encoders must not change after this point. |
240 | */ |
241 | if (legacyfb_depth != 16 && legacyfb_depth != 32) { |
242 | dev_warn(dev, "Invalid legacyfb_depth. Defaulting to 16bpp\n" ); |
243 | legacyfb_depth = 16; |
244 | } |
245 | |
246 | drm_kms_helper_poll_init(dev: drm); |
247 | |
248 | ret = drm_dev_register(dev: drm, flags: 0); |
249 | if (ret) |
250 | goto err_poll_fini; |
251 | |
252 | drm_fbdev_dma_setup(dev: drm, preferred_bpp: legacyfb_depth); |
253 | |
254 | return 0; |
255 | |
256 | err_poll_fini: |
257 | drm_kms_helper_poll_fini(dev: drm); |
258 | component_unbind_all(parent: drm->dev, data: drm); |
259 | err_kms: |
260 | dev_set_drvdata(dev, NULL); |
261 | drm_dev_put(dev: drm); |
262 | |
263 | return ret; |
264 | } |
265 | |
266 | static void imx_drm_unbind(struct device *dev) |
267 | { |
268 | struct drm_device *drm = dev_get_drvdata(dev); |
269 | |
270 | drm_dev_unregister(dev: drm); |
271 | |
272 | drm_kms_helper_poll_fini(dev: drm); |
273 | drm_atomic_helper_shutdown(dev: drm); |
274 | |
275 | component_unbind_all(parent: drm->dev, data: drm); |
276 | |
277 | drm_dev_put(dev: drm); |
278 | |
279 | dev_set_drvdata(dev, NULL); |
280 | } |
281 | |
282 | static const struct component_master_ops imx_drm_ops = { |
283 | .bind = imx_drm_bind, |
284 | .unbind = imx_drm_unbind, |
285 | }; |
286 | |
287 | static int imx_drm_platform_probe(struct platform_device *pdev) |
288 | { |
289 | int ret = drm_of_component_probe(dev: &pdev->dev, compare_of, m_ops: &imx_drm_ops); |
290 | |
291 | if (!ret) |
292 | ret = dma_set_coherent_mask(dev: &pdev->dev, DMA_BIT_MASK(32)); |
293 | |
294 | return ret; |
295 | } |
296 | |
297 | static void imx_drm_platform_remove(struct platform_device *pdev) |
298 | { |
299 | component_master_del(&pdev->dev, &imx_drm_ops); |
300 | } |
301 | |
302 | static void imx_drm_platform_shutdown(struct platform_device *pdev) |
303 | { |
304 | drm_atomic_helper_shutdown(dev: platform_get_drvdata(pdev)); |
305 | } |
306 | |
307 | #ifdef CONFIG_PM_SLEEP |
308 | static int imx_drm_suspend(struct device *dev) |
309 | { |
310 | struct drm_device *drm_dev = dev_get_drvdata(dev); |
311 | |
312 | return drm_mode_config_helper_suspend(dev: drm_dev); |
313 | } |
314 | |
315 | static int imx_drm_resume(struct device *dev) |
316 | { |
317 | struct drm_device *drm_dev = dev_get_drvdata(dev); |
318 | |
319 | return drm_mode_config_helper_resume(dev: drm_dev); |
320 | } |
321 | #endif |
322 | |
323 | static SIMPLE_DEV_PM_OPS(imx_drm_pm_ops, imx_drm_suspend, imx_drm_resume); |
324 | |
325 | static const struct of_device_id imx_drm_dt_ids[] = { |
326 | { .compatible = "fsl,imx-display-subsystem" , }, |
327 | { /* sentinel */ }, |
328 | }; |
329 | MODULE_DEVICE_TABLE(of, imx_drm_dt_ids); |
330 | |
331 | static struct platform_driver imx_drm_pdrv = { |
332 | .probe = imx_drm_platform_probe, |
333 | .remove_new = imx_drm_platform_remove, |
334 | .shutdown = imx_drm_platform_shutdown, |
335 | .driver = { |
336 | .name = "imx-drm" , |
337 | .pm = &imx_drm_pm_ops, |
338 | .of_match_table = imx_drm_dt_ids, |
339 | }, |
340 | }; |
341 | |
342 | static struct platform_driver * const drivers[] = { |
343 | &imx_drm_pdrv, |
344 | &ipu_drm_driver, |
345 | }; |
346 | |
347 | static int __init imx_drm_init(void) |
348 | { |
349 | if (drm_firmware_drivers_only()) |
350 | return -ENODEV; |
351 | |
352 | return platform_register_drivers(drivers, ARRAY_SIZE(drivers)); |
353 | } |
354 | module_init(imx_drm_init); |
355 | |
356 | static void __exit imx_drm_exit(void) |
357 | { |
358 | platform_unregister_drivers(drivers, ARRAY_SIZE(drivers)); |
359 | } |
360 | module_exit(imx_drm_exit); |
361 | |
362 | MODULE_AUTHOR("Sascha Hauer <s.hauer@pengutronix.de>" ); |
363 | MODULE_DESCRIPTION("i.MX drm driver core" ); |
364 | MODULE_LICENSE("GPL" ); |
365 | |