2 * Freescale i.MX drm driver
4 * Copyright (C) 2011 Sascha Hauer, Pengutronix
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * as published by the Free Software Foundation; either version 2
9 * of the License, or (at your option) any later version.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
16 #include <linux/component.h>
17 #include <linux/device.h>
19 #include <linux/module.h>
20 #include <linux/platform_device.h>
22 #include <drm/drm_fb_helper.h>
23 #include <drm/drm_crtc_helper.h>
24 #include <drm/drm_gem_cma_helper.h>
25 #include <drm/drm_fb_cma_helper.h>
26 #include <drm/drm_plane_helper.h>
27 #include <drm/drm_of.h>
28 #include <video/imx-ipu-v3.h>
34 struct imx_drm_component
{
35 struct device_node
*of_node
;
36 struct list_head list
;
39 struct imx_drm_device
{
40 struct drm_device
*drm
;
41 struct imx_drm_crtc
*crtc
[MAX_CRTC
];
43 struct drm_fbdev_cma
*fbhelper
;
47 struct drm_crtc
*crtc
;
48 struct imx_drm_crtc_helper_funcs imx_drm_helper_funcs
;
51 #if IS_ENABLED(CONFIG_DRM_FBDEV_EMULATION)
52 static int legacyfb_depth
= 16;
53 module_param(legacyfb_depth
, int, 0444);
56 unsigned int imx_drm_crtc_id(struct imx_drm_crtc
*crtc
)
58 return drm_crtc_index(crtc
->crtc
);
60 EXPORT_SYMBOL_GPL(imx_drm_crtc_id
);
62 static void imx_drm_driver_lastclose(struct drm_device
*drm
)
64 struct imx_drm_device
*imxdrm
= drm
->dev_private
;
66 drm_fbdev_cma_restore_mode(imxdrm
->fbhelper
);
69 static int imx_drm_driver_unload(struct drm_device
*drm
)
71 struct imx_drm_device
*imxdrm
= drm
->dev_private
;
73 drm_kms_helper_poll_fini(drm
);
76 drm_fbdev_cma_fini(imxdrm
->fbhelper
);
78 component_unbind_all(drm
->dev
, drm
);
80 drm_vblank_cleanup(drm
);
81 drm_mode_config_cleanup(drm
);
83 platform_set_drvdata(drm
->platformdev
, NULL
);
88 static struct imx_drm_crtc
*imx_drm_find_crtc(struct drm_crtc
*crtc
)
90 struct imx_drm_device
*imxdrm
= crtc
->dev
->dev_private
;
93 for (i
= 0; i
< MAX_CRTC
; i
++)
94 if (imxdrm
->crtc
[i
] && imxdrm
->crtc
[i
]->crtc
== crtc
)
95 return imxdrm
->crtc
[i
];
100 int imx_drm_set_bus_config(struct drm_encoder
*encoder
, u32 bus_format
,
101 int hsync_pin
, int vsync_pin
, u32 bus_flags
)
103 struct imx_drm_crtc_helper_funcs
*helper
;
104 struct imx_drm_crtc
*imx_crtc
;
106 imx_crtc
= imx_drm_find_crtc(encoder
->crtc
);
110 helper
= &imx_crtc
->imx_drm_helper_funcs
;
111 if (helper
->set_interface_pix_fmt
)
112 return helper
->set_interface_pix_fmt(encoder
->crtc
,
113 bus_format
, hsync_pin
, vsync_pin
,
117 EXPORT_SYMBOL_GPL(imx_drm_set_bus_config
);
119 int imx_drm_set_bus_format(struct drm_encoder
*encoder
, u32 bus_format
)
121 return imx_drm_set_bus_config(encoder
, bus_format
, 2, 3,
122 DRM_BUS_FLAG_DE_HIGH
|
123 DRM_BUS_FLAG_PIXDATA_NEGEDGE
);
125 EXPORT_SYMBOL_GPL(imx_drm_set_bus_format
);
127 int imx_drm_crtc_vblank_get(struct imx_drm_crtc
*imx_drm_crtc
)
129 return drm_crtc_vblank_get(imx_drm_crtc
->crtc
);
131 EXPORT_SYMBOL_GPL(imx_drm_crtc_vblank_get
);
133 void imx_drm_crtc_vblank_put(struct imx_drm_crtc
*imx_drm_crtc
)
135 drm_crtc_vblank_put(imx_drm_crtc
->crtc
);
137 EXPORT_SYMBOL_GPL(imx_drm_crtc_vblank_put
);
139 void imx_drm_handle_vblank(struct imx_drm_crtc
*imx_drm_crtc
)
141 drm_crtc_handle_vblank(imx_drm_crtc
->crtc
);
143 EXPORT_SYMBOL_GPL(imx_drm_handle_vblank
);
145 static int imx_drm_enable_vblank(struct drm_device
*drm
, unsigned int pipe
)
147 struct imx_drm_device
*imxdrm
= drm
->dev_private
;
148 struct imx_drm_crtc
*imx_drm_crtc
= imxdrm
->crtc
[pipe
];
154 if (!imx_drm_crtc
->imx_drm_helper_funcs
.enable_vblank
)
157 ret
= imx_drm_crtc
->imx_drm_helper_funcs
.enable_vblank(
163 static void imx_drm_disable_vblank(struct drm_device
*drm
, unsigned int pipe
)
165 struct imx_drm_device
*imxdrm
= drm
->dev_private
;
166 struct imx_drm_crtc
*imx_drm_crtc
= imxdrm
->crtc
[pipe
];
171 if (!imx_drm_crtc
->imx_drm_helper_funcs
.disable_vblank
)
174 imx_drm_crtc
->imx_drm_helper_funcs
.disable_vblank(imx_drm_crtc
->crtc
);
177 static const struct file_operations imx_drm_driver_fops
= {
178 .owner
= THIS_MODULE
,
180 .release
= drm_release
,
181 .unlocked_ioctl
= drm_ioctl
,
182 .mmap
= drm_gem_cma_mmap
,
185 .llseek
= noop_llseek
,
188 void imx_drm_connector_destroy(struct drm_connector
*connector
)
190 drm_connector_unregister(connector
);
191 drm_connector_cleanup(connector
);
193 EXPORT_SYMBOL_GPL(imx_drm_connector_destroy
);
195 void imx_drm_encoder_destroy(struct drm_encoder
*encoder
)
197 drm_encoder_cleanup(encoder
);
199 EXPORT_SYMBOL_GPL(imx_drm_encoder_destroy
);
201 static void imx_drm_output_poll_changed(struct drm_device
*drm
)
203 struct imx_drm_device
*imxdrm
= drm
->dev_private
;
205 drm_fbdev_cma_hotplug_event(imxdrm
->fbhelper
);
208 static const struct drm_mode_config_funcs imx_drm_mode_config_funcs
= {
209 .fb_create
= drm_fb_cma_create
,
210 .output_poll_changed
= imx_drm_output_poll_changed
,
214 * Main DRM initialisation. This binds, initialises and registers
215 * with DRM the subcomponents of the driver.
217 static int imx_drm_driver_load(struct drm_device
*drm
, unsigned long flags
)
219 struct imx_drm_device
*imxdrm
;
220 struct drm_connector
*connector
;
223 imxdrm
= devm_kzalloc(drm
->dev
, sizeof(*imxdrm
), GFP_KERNEL
);
229 drm
->dev_private
= imxdrm
;
232 * enable drm irq mode.
233 * - with irq_enabled = true, we can use the vblank feature.
235 * P.S. note that we wouldn't use drm irq handler but
236 * just specific driver own one instead because
237 * drm framework supports only one irq handler and
238 * drivers can well take care of their interrupts
240 drm
->irq_enabled
= true;
243 * set max width and height as default value(4096x4096).
244 * this value would be used to check framebuffer size limitation
245 * at drm_mode_addfb().
247 drm
->mode_config
.min_width
= 64;
248 drm
->mode_config
.min_height
= 64;
249 drm
->mode_config
.max_width
= 4096;
250 drm
->mode_config
.max_height
= 4096;
251 drm
->mode_config
.funcs
= &imx_drm_mode_config_funcs
;
253 drm_mode_config_init(drm
);
255 ret
= drm_vblank_init(drm
, MAX_CRTC
);
259 platform_set_drvdata(drm
->platformdev
, drm
);
261 /* Now try and bind all our sub-components */
262 ret
= component_bind_all(drm
->dev
, drm
);
267 * All components are now added, we can publish the connector sysfs
268 * entries to userspace. This will generate hotplug events and so
269 * userspace will expect to be able to access DRM at this point.
271 list_for_each_entry(connector
, &drm
->mode_config
.connector_list
, head
) {
272 ret
= drm_connector_register(connector
);
275 "[CONNECTOR:%d:%s] drm_connector_register failed: %d\n",
277 connector
->name
, ret
);
283 * All components are now initialised, so setup the fb helper.
284 * The fb helper takes copies of key hardware information, so the
285 * crtcs/connectors/encoders must not change after this point.
287 #if IS_ENABLED(CONFIG_DRM_FBDEV_EMULATION)
288 if (legacyfb_depth
!= 16 && legacyfb_depth
!= 32) {
289 dev_warn(drm
->dev
, "Invalid legacyfb_depth. Defaulting to 16bpp\n");
292 drm_helper_disable_unused_functions(drm
);
293 imxdrm
->fbhelper
= drm_fbdev_cma_init(drm
, legacyfb_depth
,
294 drm
->mode_config
.num_crtc
, MAX_CRTC
);
295 if (IS_ERR(imxdrm
->fbhelper
)) {
296 ret
= PTR_ERR(imxdrm
->fbhelper
);
297 imxdrm
->fbhelper
= NULL
;
302 drm_kms_helper_poll_init(drm
);
307 component_unbind_all(drm
->dev
, drm
);
309 drm_vblank_cleanup(drm
);
311 drm_mode_config_cleanup(drm
);
317 * imx_drm_add_crtc - add a new crtc
319 int imx_drm_add_crtc(struct drm_device
*drm
, struct drm_crtc
*crtc
,
320 struct imx_drm_crtc
**new_crtc
, struct drm_plane
*primary_plane
,
321 const struct imx_drm_crtc_helper_funcs
*imx_drm_helper_funcs
,
322 struct device_node
*port
)
324 struct imx_drm_device
*imxdrm
= drm
->dev_private
;
325 struct imx_drm_crtc
*imx_drm_crtc
;
328 * The vblank arrays are dimensioned by MAX_CRTC - we can't
329 * pass IDs greater than this to those functions.
331 if (imxdrm
->pipes
>= MAX_CRTC
)
334 if (imxdrm
->drm
->open_count
)
337 imx_drm_crtc
= kzalloc(sizeof(*imx_drm_crtc
), GFP_KERNEL
);
341 imx_drm_crtc
->imx_drm_helper_funcs
= *imx_drm_helper_funcs
;
342 imx_drm_crtc
->crtc
= crtc
;
346 imxdrm
->crtc
[imxdrm
->pipes
++] = imx_drm_crtc
;
348 *new_crtc
= imx_drm_crtc
;
350 drm_crtc_helper_add(crtc
,
351 imx_drm_crtc
->imx_drm_helper_funcs
.crtc_helper_funcs
);
353 drm_crtc_init_with_planes(drm
, crtc
, primary_plane
, NULL
,
354 imx_drm_crtc
->imx_drm_helper_funcs
.crtc_funcs
, NULL
);
358 EXPORT_SYMBOL_GPL(imx_drm_add_crtc
);
361 * imx_drm_remove_crtc - remove a crtc
363 int imx_drm_remove_crtc(struct imx_drm_crtc
*imx_drm_crtc
)
365 struct imx_drm_device
*imxdrm
= imx_drm_crtc
->crtc
->dev
->dev_private
;
366 unsigned int pipe
= drm_crtc_index(imx_drm_crtc
->crtc
);
368 drm_crtc_cleanup(imx_drm_crtc
->crtc
);
370 imxdrm
->crtc
[pipe
] = NULL
;
376 EXPORT_SYMBOL_GPL(imx_drm_remove_crtc
);
378 int imx_drm_encoder_parse_of(struct drm_device
*drm
,
379 struct drm_encoder
*encoder
, struct device_node
*np
)
381 uint32_t crtc_mask
= drm_of_find_possible_crtcs(drm
, np
);
384 * If we failed to find the CRTC(s) which this encoder is
385 * supposed to be connected to, it's because the CRTC has
386 * not been registered yet. Defer probing, and hope that
387 * the required CRTC is added later.
390 return -EPROBE_DEFER
;
392 encoder
->possible_crtcs
= crtc_mask
;
394 /* FIXME: this is the mask of outputs which can clone this output. */
395 encoder
->possible_clones
= ~0;
399 EXPORT_SYMBOL_GPL(imx_drm_encoder_parse_of
);
401 static const struct drm_ioctl_desc imx_drm_ioctls
[] = {
405 static struct drm_driver imx_drm_driver
= {
406 .driver_features
= DRIVER_MODESET
| DRIVER_GEM
| DRIVER_PRIME
,
407 .load
= imx_drm_driver_load
,
408 .unload
= imx_drm_driver_unload
,
409 .lastclose
= imx_drm_driver_lastclose
,
410 .gem_free_object_unlocked
= drm_gem_cma_free_object
,
411 .gem_vm_ops
= &drm_gem_cma_vm_ops
,
412 .dumb_create
= drm_gem_cma_dumb_create
,
413 .dumb_map_offset
= drm_gem_cma_dumb_map_offset
,
414 .dumb_destroy
= drm_gem_dumb_destroy
,
416 .prime_handle_to_fd
= drm_gem_prime_handle_to_fd
,
417 .prime_fd_to_handle
= drm_gem_prime_fd_to_handle
,
418 .gem_prime_import
= drm_gem_prime_import
,
419 .gem_prime_export
= drm_gem_prime_export
,
420 .gem_prime_get_sg_table
= drm_gem_cma_prime_get_sg_table
,
421 .gem_prime_import_sg_table
= drm_gem_cma_prime_import_sg_table
,
422 .gem_prime_vmap
= drm_gem_cma_prime_vmap
,
423 .gem_prime_vunmap
= drm_gem_cma_prime_vunmap
,
424 .gem_prime_mmap
= drm_gem_cma_prime_mmap
,
425 .get_vblank_counter
= drm_vblank_no_hw_counter
,
426 .enable_vblank
= imx_drm_enable_vblank
,
427 .disable_vblank
= imx_drm_disable_vblank
,
428 .ioctls
= imx_drm_ioctls
,
429 .num_ioctls
= ARRAY_SIZE(imx_drm_ioctls
),
430 .fops
= &imx_drm_driver_fops
,
432 .desc
= "i.MX DRM graphics",
439 static int compare_of(struct device
*dev
, void *data
)
441 struct device_node
*np
= data
;
443 /* Special case for DI, dev->of_node may not be set yet */
444 if (strcmp(dev
->driver
->name
, "imx-ipuv3-crtc") == 0) {
445 struct ipu_client_platformdata
*pdata
= dev
->platform_data
;
447 return pdata
->of_node
== np
;
450 /* Special case for LDB, one device for two channels */
451 if (of_node_cmp(np
->name
, "lvds-channel") == 0) {
452 np
= of_get_parent(np
);
456 return dev
->of_node
== np
;
459 static int imx_drm_bind(struct device
*dev
)
461 return drm_platform_init(&imx_drm_driver
, to_platform_device(dev
));
464 static void imx_drm_unbind(struct device
*dev
)
466 drm_put_dev(dev_get_drvdata(dev
));
469 static const struct component_master_ops imx_drm_ops
= {
470 .bind
= imx_drm_bind
,
471 .unbind
= imx_drm_unbind
,
474 static int imx_drm_platform_probe(struct platform_device
*pdev
)
476 int ret
= drm_of_component_probe(&pdev
->dev
, compare_of
, &imx_drm_ops
);
479 ret
= dma_set_coherent_mask(&pdev
->dev
, DMA_BIT_MASK(32));
484 static int imx_drm_platform_remove(struct platform_device
*pdev
)
486 component_master_del(&pdev
->dev
, &imx_drm_ops
);
490 #ifdef CONFIG_PM_SLEEP
491 static int imx_drm_suspend(struct device
*dev
)
493 struct drm_device
*drm_dev
= dev_get_drvdata(dev
);
495 /* The drm_dev is NULL before .load hook is called */
499 drm_kms_helper_poll_disable(drm_dev
);
504 static int imx_drm_resume(struct device
*dev
)
506 struct drm_device
*drm_dev
= dev_get_drvdata(dev
);
511 drm_helper_resume_force_mode(drm_dev
);
512 drm_kms_helper_poll_enable(drm_dev
);
518 static SIMPLE_DEV_PM_OPS(imx_drm_pm_ops
, imx_drm_suspend
, imx_drm_resume
);
520 static const struct of_device_id imx_drm_dt_ids
[] = {
521 { .compatible
= "fsl,imx-display-subsystem", },
524 MODULE_DEVICE_TABLE(of
, imx_drm_dt_ids
);
526 static struct platform_driver imx_drm_pdrv
= {
527 .probe
= imx_drm_platform_probe
,
528 .remove
= imx_drm_platform_remove
,
531 .pm
= &imx_drm_pm_ops
,
532 .of_match_table
= imx_drm_dt_ids
,
535 module_platform_driver(imx_drm_pdrv
);
537 MODULE_AUTHOR("Sascha Hauer <s.hauer@pengutronix.de>");
538 MODULE_DESCRIPTION("i.MX drm driver core");
539 MODULE_LICENSE("GPL");