rockchip_drm_fb.c 3.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (C) Fuzhou Rockchip Electronics Co.Ltd
  4. * Author:Mark Yao <mark.yao@rock-chips.com>
  5. */
  6. #include <linux/kernel.h>
  7. #include <drm/drm.h>
  8. #include <drm/drm_atomic.h>
  9. #include <drm/drm_damage_helper.h>
  10. #include <drm/drm_fb_helper.h>
  11. #include <drm/drm_fourcc.h>
  12. #include <drm/drm_gem_framebuffer_helper.h>
  13. #include <drm/drm_probe_helper.h>
  14. #include "rockchip_drm_drv.h"
  15. #include "rockchip_drm_fb.h"
  16. #include "rockchip_drm_gem.h"
  17. static const struct drm_framebuffer_funcs rockchip_drm_fb_funcs = {
  18. .destroy = drm_gem_fb_destroy,
  19. .create_handle = drm_gem_fb_create_handle,
  20. .dirty = drm_atomic_helper_dirtyfb,
  21. };
  22. static struct drm_framebuffer *
  23. rockchip_fb_alloc(struct drm_device *dev, const struct drm_mode_fb_cmd2 *mode_cmd,
  24. struct drm_gem_object **obj, unsigned int num_planes)
  25. {
  26. struct drm_framebuffer *fb;
  27. int ret;
  28. int i;
  29. fb = kzalloc(sizeof(*fb), GFP_KERNEL);
  30. if (!fb)
  31. return ERR_PTR(-ENOMEM);
  32. drm_helper_mode_fill_fb_struct(dev, fb, mode_cmd);
  33. for (i = 0; i < num_planes; i++)
  34. fb->obj[i] = obj[i];
  35. ret = drm_framebuffer_init(dev, fb, &rockchip_drm_fb_funcs);
  36. if (ret) {
  37. DRM_DEV_ERROR(dev->dev,
  38. "Failed to initialize framebuffer: %d\n",
  39. ret);
  40. kfree(fb);
  41. return ERR_PTR(ret);
  42. }
  43. return fb;
  44. }
  45. static const struct drm_mode_config_helper_funcs rockchip_mode_config_helpers = {
  46. .atomic_commit_tail = drm_atomic_helper_commit_tail_rpm,
  47. };
  48. static struct drm_framebuffer *
  49. rockchip_fb_create(struct drm_device *dev, struct drm_file *file,
  50. const struct drm_mode_fb_cmd2 *mode_cmd)
  51. {
  52. struct drm_afbc_framebuffer *afbc_fb;
  53. const struct drm_format_info *info;
  54. int ret;
  55. info = drm_get_format_info(dev, mode_cmd);
  56. if (!info)
  57. return ERR_PTR(-ENOMEM);
  58. afbc_fb = kzalloc(sizeof(*afbc_fb), GFP_KERNEL);
  59. if (!afbc_fb)
  60. return ERR_PTR(-ENOMEM);
  61. ret = drm_gem_fb_init_with_funcs(dev, &afbc_fb->base, file, mode_cmd,
  62. &rockchip_drm_fb_funcs);
  63. if (ret) {
  64. kfree(afbc_fb);
  65. return ERR_PTR(ret);
  66. }
  67. if (drm_is_afbc(mode_cmd->modifier[0])) {
  68. int ret, i;
  69. ret = drm_gem_fb_afbc_init(dev, mode_cmd, afbc_fb);
  70. if (ret) {
  71. struct drm_gem_object **obj = afbc_fb->base.obj;
  72. for (i = 0; i < info->num_planes; ++i)
  73. drm_gem_object_put(obj[i]);
  74. kfree(afbc_fb);
  75. return ERR_PTR(ret);
  76. }
  77. }
  78. return &afbc_fb->base;
  79. }
  80. static const struct drm_mode_config_funcs rockchip_drm_mode_config_funcs = {
  81. .fb_create = rockchip_fb_create,
  82. .output_poll_changed = drm_fb_helper_output_poll_changed,
  83. .atomic_check = drm_atomic_helper_check,
  84. .atomic_commit = drm_atomic_helper_commit,
  85. };
  86. struct drm_framebuffer *
  87. rockchip_drm_framebuffer_init(struct drm_device *dev,
  88. const struct drm_mode_fb_cmd2 *mode_cmd,
  89. struct drm_gem_object *obj)
  90. {
  91. struct drm_framebuffer *fb;
  92. fb = rockchip_fb_alloc(dev, mode_cmd, &obj, 1);
  93. if (IS_ERR(fb))
  94. return ERR_CAST(fb);
  95. return fb;
  96. }
  97. void rockchip_drm_mode_config_init(struct drm_device *dev)
  98. {
  99. dev->mode_config.min_width = 0;
  100. dev->mode_config.min_height = 0;
  101. /*
  102. * set max width and height as default value(4096x4096).
  103. * this value would be used to check framebuffer size limitation
  104. * at drm_mode_addfb().
  105. */
  106. dev->mode_config.max_width = 4096;
  107. dev->mode_config.max_height = 4096;
  108. dev->mode_config.funcs = &rockchip_drm_mode_config_funcs;
  109. dev->mode_config.helper_private = &rockchip_mode_config_helpers;
  110. }