msm_fb.c 7.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311
  1. /*
  2. * Copyright (c) 2018-2021, The Linux Foundation. All rights reserved.
  3. * Copyright (C) 2013 Red Hat
  4. * Author: Rob Clark <[email protected]>
  5. *
  6. * This program is free software; you can redistribute it and/or modify it
  7. * under the terms of the GNU General Public License version 2 as published by
  8. * the Free Software Foundation.
  9. *
  10. * This program is distributed in the hope that it will be useful, but WITHOUT
  11. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  12. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  13. * more details.
  14. *
  15. * You should have received a copy of the GNU General Public License along with
  16. * this program. If not, see <http://www.gnu.org/licenses/>.
  17. */
  18. #include <drm/drm_crtc.h>
  19. #include <drm/drm_fourcc.h>
  20. #include <drm/drm_damage_helper.h>
  21. #include <drm/drm_gem_framebuffer_helper.h>
  22. #include <drm/drm_probe_helper.h>
  23. #include "msm_drv.h"
  24. #include "msm_kms.h"
  25. #include "msm_gem.h"
  26. struct msm_framebuffer {
  27. struct drm_framebuffer base;
  28. const struct msm_format *format;
  29. u32 cache_flags;
  30. u32 cache_type;
  31. };
  32. #define to_msm_framebuffer(x) container_of(x, struct msm_framebuffer, base)
  33. static const struct drm_framebuffer_funcs msm_framebuffer_funcs = {
  34. .create_handle = drm_gem_fb_create_handle,
  35. .destroy = drm_gem_fb_destroy,
  36. .dirty = drm_atomic_helper_dirtyfb,
  37. };
  38. /* prepare/pin all the fb's bo's for scanout. Note that it is not valid
  39. * to prepare an fb more multiple different initiator 'id's. But that
  40. * should be fine, since only the scanout (mdpN) side of things needs
  41. * this, the gpu doesn't care about fb's.
  42. */
  43. int msm_framebuffer_prepare(struct drm_framebuffer *fb,
  44. struct msm_gem_address_space *aspace)
  45. {
  46. struct msm_framebuffer *msm_fb;
  47. int ret, i, n;
  48. uint64_t iova;
  49. if (!fb) {
  50. DRM_ERROR("from:%pS null fb\n", __builtin_return_address(0));
  51. return -EINVAL;
  52. }
  53. msm_fb = to_msm_framebuffer(fb);
  54. n = fb->format->num_planes;
  55. for (i = 0; i < n; i++) {
  56. ret = msm_gem_get_iova(fb->obj[i], aspace, &iova);
  57. DBG("FB[%u]: iova[%d]: %08llx (%d)", fb->base.id, i, iova, ret);
  58. if (ret)
  59. return ret;
  60. }
  61. return 0;
  62. }
  63. void msm_framebuffer_cleanup(struct drm_framebuffer *fb,
  64. struct msm_gem_address_space *aspace)
  65. {
  66. struct msm_framebuffer *msm_fb;
  67. int i, n;
  68. if (fb == NULL) {
  69. DRM_ERROR("from:%pS null fb\n", __builtin_return_address(0));
  70. return;
  71. }
  72. msm_fb = to_msm_framebuffer(fb);
  73. n = fb->format->num_planes;
  74. for (i = 0; i < n; i++)
  75. msm_gem_put_iova(fb->obj[i], aspace);
  76. }
  77. uint32_t msm_framebuffer_iova(struct drm_framebuffer *fb,
  78. struct msm_gem_address_space *aspace, int plane)
  79. {
  80. if (!fb) {
  81. DRM_ERROR("from:%pS null fb\n", __builtin_return_address(0));
  82. return -EINVAL;
  83. }
  84. if (!fb->obj[plane])
  85. return 0;
  86. return msm_gem_iova(fb->obj[plane], aspace) + fb->offsets[plane];
  87. }
  88. uint32_t msm_framebuffer_phys(struct drm_framebuffer *fb,
  89. int plane)
  90. {
  91. struct msm_framebuffer *msm_fb;
  92. dma_addr_t phys_addr;
  93. if (!fb) {
  94. DRM_ERROR("from:%pS null fb\n", __builtin_return_address(0));
  95. return -EINVAL;
  96. }
  97. msm_fb = to_msm_framebuffer(fb);
  98. if (!msm_fb->base.obj[plane])
  99. return 0;
  100. phys_addr = msm_gem_get_dma_addr(msm_fb->base.obj[plane]);
  101. if (!phys_addr)
  102. return 0;
  103. return phys_addr + fb->offsets[plane];
  104. }
  105. struct drm_gem_object *msm_framebuffer_bo(struct drm_framebuffer *fb, int plane)
  106. {
  107. if (!fb) {
  108. DRM_ERROR("from:%pS null fb\n", __builtin_return_address(0));
  109. return ERR_PTR(-EINVAL);
  110. }
  111. return drm_gem_fb_get_obj(fb, plane);
  112. }
  113. const struct msm_format *msm_framebuffer_format(struct drm_framebuffer *fb)
  114. {
  115. return fb ? (to_msm_framebuffer(fb))->format : NULL;
  116. }
  117. struct drm_framebuffer *msm_framebuffer_create(struct drm_device *dev,
  118. struct drm_file *file, const struct drm_mode_fb_cmd2 *mode_cmd)
  119. {
  120. const struct drm_format_info *info = drm_get_format_info(dev,
  121. mode_cmd);
  122. struct drm_gem_object *bos[4] = {0};
  123. struct drm_framebuffer *fb;
  124. int ret, i, n = info->num_planes;
  125. for (i = 0; i < n; i++) {
  126. bos[i] = drm_gem_object_lookup(file, mode_cmd->handles[i]);
  127. if (!bos[i]) {
  128. ret = -ENXIO;
  129. goto out_unref;
  130. }
  131. }
  132. fb = msm_framebuffer_init(dev, mode_cmd, bos);
  133. if (IS_ERR(fb)) {
  134. ret = PTR_ERR(fb);
  135. goto out_unref;
  136. }
  137. return fb;
  138. out_unref:
  139. for (i = 0; i < n; i++)
  140. drm_gem_object_put(bos[i]);
  141. return ERR_PTR(ret);
  142. }
  143. struct drm_framebuffer *msm_framebuffer_init(struct drm_device *dev,
  144. const struct drm_mode_fb_cmd2 *mode_cmd,
  145. struct drm_gem_object **bos)
  146. {
  147. const struct drm_format_info *info = drm_get_format_info(dev,
  148. mode_cmd);
  149. struct msm_drm_private *priv = dev->dev_private;
  150. struct msm_kms *kms = priv->kms;
  151. struct msm_framebuffer *msm_fb = NULL;
  152. struct drm_framebuffer *fb;
  153. const struct msm_format *format;
  154. int ret, i, num_planes;
  155. bool is_modified = false;
  156. DBG("create framebuffer: dev=%pK, mode_cmd=%pK (%dx%d@%4.4s)",
  157. dev, mode_cmd, mode_cmd->width, mode_cmd->height,
  158. (char *)&mode_cmd->pixel_format);
  159. num_planes = info->num_planes;
  160. format = kms->funcs->get_format(kms, mode_cmd->pixel_format,
  161. mode_cmd->modifier[0]);
  162. if (!format) {
  163. dev_err(dev->dev, "unsupported pixel format: %4.4s\n",
  164. (char *)&mode_cmd->pixel_format);
  165. ret = -EINVAL;
  166. goto fail;
  167. }
  168. msm_fb = kzalloc(sizeof(*msm_fb), GFP_KERNEL);
  169. if (!msm_fb) {
  170. ret = -ENOMEM;
  171. goto fail;
  172. }
  173. fb = &msm_fb->base;
  174. msm_fb->format = format;
  175. if (mode_cmd->flags & DRM_MODE_FB_MODIFIERS) {
  176. for (i = 0; i < ARRAY_SIZE(mode_cmd->modifier); i++) {
  177. if (mode_cmd->modifier[i]) {
  178. is_modified = true;
  179. break;
  180. }
  181. }
  182. }
  183. if (num_planes > ARRAY_SIZE(fb->obj)) {
  184. ret = -EINVAL;
  185. goto fail;
  186. }
  187. if (is_modified) {
  188. if (!kms->funcs->check_modified_format) {
  189. dev_err(dev->dev, "can't check modified fb format\n");
  190. ret = -EINVAL;
  191. goto fail;
  192. } else {
  193. ret = kms->funcs->check_modified_format(
  194. kms, msm_fb->format, mode_cmd, bos);
  195. if (ret)
  196. goto fail;
  197. }
  198. } else {
  199. const struct drm_format_info *info;
  200. info = drm_format_info(mode_cmd->pixel_format);
  201. if (!info || num_planes > ARRAY_SIZE(info->cpp)) {
  202. ret = -EINVAL;
  203. goto fail;
  204. }
  205. for (i = 0; i < num_planes; i++) {
  206. unsigned int width = mode_cmd->width / (i ?
  207. info->hsub : 1);
  208. unsigned int height = mode_cmd->height / (i ?
  209. info->vsub : 1);
  210. unsigned int min_size;
  211. min_size = (height - 1) * mode_cmd->pitches[i]
  212. + width * info->cpp[i]
  213. + mode_cmd->offsets[i];
  214. if (!bos[i] || bos[i]->size < min_size) {
  215. ret = -EINVAL;
  216. goto fail;
  217. }
  218. }
  219. }
  220. for (i = 0; i < num_planes; i++)
  221. msm_fb->base.obj[i] = bos[i];
  222. drm_helper_mode_fill_fb_struct(dev, fb, mode_cmd);
  223. ret = drm_framebuffer_init(dev, fb, &msm_framebuffer_funcs);
  224. if (ret) {
  225. dev_err(dev->dev, "framebuffer init failed: %d\n", ret);
  226. goto fail;
  227. }
  228. DBG("create: FB ID: %d (%pK)", fb->base.id, fb);
  229. return fb;
  230. fail:
  231. kfree(msm_fb);
  232. return ERR_PTR(ret);
  233. }
  234. void msm_framebuffer_set_cache_hint(struct drm_framebuffer *fb, u32 flags, u32 type)
  235. {
  236. struct msm_framebuffer *msm_fb;
  237. if (!fb)
  238. return;
  239. msm_fb = to_msm_framebuffer(fb);
  240. msm_fb->cache_flags = flags;
  241. msm_fb->cache_type = type;
  242. }
  243. void msm_framebuffer_get_cache_hint(struct drm_framebuffer *fb, u32 *flags, u32 *type)
  244. {
  245. struct msm_framebuffer *msm_fb;
  246. if (!fb) {
  247. *flags = 0;
  248. *type = 0;
  249. return;
  250. }
  251. msm_fb = to_msm_framebuffer(fb);
  252. *flags = msm_fb->cache_flags;
  253. *type = msm_fb->cache_type;
  254. }