drv.c 4.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Copyright (C) STMicroelectronics SA 2017
  4. *
  5. * Authors: Philippe Cornu <philippe.cornu@st.com>
  6. * Yannick Fertre <yannick.fertre@st.com>
  7. * Fabien Dessenne <fabien.dessenne@st.com>
  8. * Mickael Reulier <mickael.reulier@st.com>
  9. */
  10. #include <linux/component.h>
  11. #include <linux/of_platform.h>
  12. #include <drm/drm_atomic.h>
  13. #include <drm/drm_atomic_helper.h>
  14. #include <drm/drm_crtc_helper.h>
  15. #include <drm/drm_fb_helper.h>
  16. #include <drm/drm_fb_cma_helper.h>
  17. #include <drm/drm_gem_cma_helper.h>
  18. #include <drm/drm_gem_framebuffer_helper.h>
  19. #include "ltdc.h"
  20. #define STM_MAX_FB_WIDTH 2048
  21. #define STM_MAX_FB_HEIGHT 2048 /* same as width to handle orientation */
  22. static const struct drm_mode_config_funcs drv_mode_config_funcs = {
  23. .fb_create = drm_gem_fb_create,
  24. .output_poll_changed = drm_fb_helper_output_poll_changed,
  25. .atomic_check = drm_atomic_helper_check,
  26. .atomic_commit = drm_atomic_helper_commit,
  27. };
  28. static int stm_gem_cma_dumb_create(struct drm_file *file,
  29. struct drm_device *dev,
  30. struct drm_mode_create_dumb *args)
  31. {
  32. unsigned int min_pitch = DIV_ROUND_UP(args->width * args->bpp, 8);
  33. /*
  34. * in order to optimize data transfer, pitch is aligned on
  35. * 128 bytes, height is aligned on 4 bytes
  36. */
  37. args->pitch = roundup(min_pitch, 128);
  38. args->height = roundup(args->height, 4);
  39. return drm_gem_cma_dumb_create_internal(file, dev, args);
  40. }
  41. DEFINE_DRM_GEM_CMA_FOPS(drv_driver_fops);
  42. static struct drm_driver drv_driver = {
  43. .driver_features = DRIVER_MODESET | DRIVER_GEM | DRIVER_PRIME |
  44. DRIVER_ATOMIC,
  45. .lastclose = drm_fb_helper_lastclose,
  46. .name = "stm",
  47. .desc = "STMicroelectronics SoC DRM",
  48. .date = "20170330",
  49. .major = 1,
  50. .minor = 0,
  51. .patchlevel = 0,
  52. .fops = &drv_driver_fops,
  53. .dumb_create = stm_gem_cma_dumb_create,
  54. .prime_handle_to_fd = drm_gem_prime_handle_to_fd,
  55. .prime_fd_to_handle = drm_gem_prime_fd_to_handle,
  56. .gem_free_object_unlocked = drm_gem_cma_free_object,
  57. .gem_vm_ops = &drm_gem_cma_vm_ops,
  58. .gem_prime_export = drm_gem_prime_export,
  59. .gem_prime_import = drm_gem_prime_import,
  60. .gem_prime_get_sg_table = drm_gem_cma_prime_get_sg_table,
  61. .gem_prime_import_sg_table = drm_gem_cma_prime_import_sg_table,
  62. .gem_prime_vmap = drm_gem_cma_prime_vmap,
  63. .gem_prime_vunmap = drm_gem_cma_prime_vunmap,
  64. .gem_prime_mmap = drm_gem_cma_prime_mmap,
  65. };
  66. static int drv_load(struct drm_device *ddev)
  67. {
  68. struct platform_device *pdev = to_platform_device(ddev->dev);
  69. struct ltdc_device *ldev;
  70. int ret;
  71. DRM_DEBUG("%s\n", __func__);
  72. ldev = devm_kzalloc(ddev->dev, sizeof(*ldev), GFP_KERNEL);
  73. if (!ldev)
  74. return -ENOMEM;
  75. ddev->dev_private = (void *)ldev;
  76. drm_mode_config_init(ddev);
  77. /*
  78. * set max width and height as default value.
  79. * this value would be used to check framebuffer size limitation
  80. * at drm_mode_addfb().
  81. */
  82. ddev->mode_config.min_width = 0;
  83. ddev->mode_config.min_height = 0;
  84. ddev->mode_config.max_width = STM_MAX_FB_WIDTH;
  85. ddev->mode_config.max_height = STM_MAX_FB_HEIGHT;
  86. ddev->mode_config.funcs = &drv_mode_config_funcs;
  87. ret = ltdc_load(ddev);
  88. if (ret)
  89. goto err;
  90. drm_mode_config_reset(ddev);
  91. drm_kms_helper_poll_init(ddev);
  92. if (ddev->mode_config.num_connector) {
  93. ret = drm_fb_cma_fbdev_init(ddev, 16, 0);
  94. if (ret)
  95. DRM_DEBUG("Warning: fails to create fbdev\n");
  96. }
  97. platform_set_drvdata(pdev, ddev);
  98. return 0;
  99. err:
  100. drm_mode_config_cleanup(ddev);
  101. return ret;
  102. }
  103. static void drv_unload(struct drm_device *ddev)
  104. {
  105. DRM_DEBUG("%s\n", __func__);
  106. drm_fb_cma_fbdev_fini(ddev);
  107. drm_kms_helper_poll_fini(ddev);
  108. ltdc_unload(ddev);
  109. drm_mode_config_cleanup(ddev);
  110. }
  111. static int stm_drm_platform_probe(struct platform_device *pdev)
  112. {
  113. struct device *dev = &pdev->dev;
  114. struct drm_device *ddev;
  115. int ret;
  116. DRM_DEBUG("%s\n", __func__);
  117. dma_set_coherent_mask(dev, DMA_BIT_MASK(32));
  118. ddev = drm_dev_alloc(&drv_driver, dev);
  119. if (IS_ERR(ddev))
  120. return PTR_ERR(ddev);
  121. ret = drv_load(ddev);
  122. if (ret)
  123. goto err_put;
  124. ret = drm_dev_register(ddev, 0);
  125. if (ret)
  126. goto err_put;
  127. return 0;
  128. err_put:
  129. drm_dev_put(ddev);
  130. return ret;
  131. }
  132. static int stm_drm_platform_remove(struct platform_device *pdev)
  133. {
  134. struct drm_device *ddev = platform_get_drvdata(pdev);
  135. DRM_DEBUG("%s\n", __func__);
  136. drm_dev_unregister(ddev);
  137. drv_unload(ddev);
  138. drm_dev_put(ddev);
  139. return 0;
  140. }
  141. static const struct of_device_id drv_dt_ids[] = {
  142. { .compatible = "st,stm32-ltdc"},
  143. { /* end node */ },
  144. };
  145. MODULE_DEVICE_TABLE(of, drv_dt_ids);
  146. static struct platform_driver stm_drm_platform_driver = {
  147. .probe = stm_drm_platform_probe,
  148. .remove = stm_drm_platform_remove,
  149. .driver = {
  150. .name = "stm32-display",
  151. .of_match_table = drv_dt_ids,
  152. },
  153. };
  154. module_platform_driver(stm_drm_platform_driver);
  155. MODULE_AUTHOR("Philippe Cornu <philippe.cornu@st.com>");
  156. MODULE_AUTHOR("Yannick Fertre <yannick.fertre@st.com>");
  157. MODULE_AUTHOR("Fabien Dessenne <fabien.dessenne@st.com>");
  158. MODULE_AUTHOR("Mickael Reulier <mickael.reulier@st.com>");
  159. MODULE_DESCRIPTION("STMicroelectronics ST DRM LTDC driver");
  160. MODULE_LICENSE("GPL v2");