shmob_drm_plane.c 6.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * shmob_drm_plane.c -- SH Mobile DRM Planes
  4. *
  5. * Copyright (C) 2012 Renesas Electronics Corporation
  6. *
  7. * Laurent Pinchart (laurent.pinchart@ideasonboard.com)
  8. */
  9. #include <drm/drm_crtc.h>
  10. #include <drm/drm_crtc_helper.h>
  11. #include <drm/drm_fb_cma_helper.h>
  12. #include <drm/drm_fourcc.h>
  13. #include <drm/drm_gem_cma_helper.h>
  14. #include "shmob_drm_drv.h"
  15. #include "shmob_drm_kms.h"
  16. #include "shmob_drm_plane.h"
  17. #include "shmob_drm_regs.h"
  18. struct shmob_drm_plane {
  19. struct drm_plane plane;
  20. unsigned int index;
  21. unsigned int alpha;
  22. const struct shmob_drm_format_info *format;
  23. unsigned long dma[2];
  24. unsigned int src_x;
  25. unsigned int src_y;
  26. unsigned int crtc_x;
  27. unsigned int crtc_y;
  28. unsigned int crtc_w;
  29. unsigned int crtc_h;
  30. };
  31. #define to_shmob_plane(p) container_of(p, struct shmob_drm_plane, plane)
  32. static void shmob_drm_plane_compute_base(struct shmob_drm_plane *splane,
  33. struct drm_framebuffer *fb,
  34. int x, int y)
  35. {
  36. struct drm_gem_cma_object *gem;
  37. unsigned int bpp;
  38. bpp = splane->format->yuv ? 8 : splane->format->bpp;
  39. gem = drm_fb_cma_get_gem_obj(fb, 0);
  40. splane->dma[0] = gem->paddr + fb->offsets[0]
  41. + y * fb->pitches[0] + x * bpp / 8;
  42. if (splane->format->yuv) {
  43. bpp = splane->format->bpp - 8;
  44. gem = drm_fb_cma_get_gem_obj(fb, 1);
  45. splane->dma[1] = gem->paddr + fb->offsets[1]
  46. + y / (bpp == 4 ? 2 : 1) * fb->pitches[1]
  47. + x * (bpp == 16 ? 2 : 1);
  48. }
  49. }
  50. static void __shmob_drm_plane_setup(struct shmob_drm_plane *splane,
  51. struct drm_framebuffer *fb)
  52. {
  53. struct shmob_drm_device *sdev = splane->plane.dev->dev_private;
  54. u32 format;
  55. /* TODO: Support ROP3 mode */
  56. format = LDBBSIFR_EN | (splane->alpha << LDBBSIFR_LAY_SHIFT);
  57. switch (splane->format->fourcc) {
  58. case DRM_FORMAT_RGB565:
  59. case DRM_FORMAT_NV21:
  60. case DRM_FORMAT_NV61:
  61. case DRM_FORMAT_NV42:
  62. format |= LDBBSIFR_SWPL | LDBBSIFR_SWPW;
  63. break;
  64. case DRM_FORMAT_RGB888:
  65. case DRM_FORMAT_NV12:
  66. case DRM_FORMAT_NV16:
  67. case DRM_FORMAT_NV24:
  68. format |= LDBBSIFR_SWPL | LDBBSIFR_SWPW | LDBBSIFR_SWPB;
  69. break;
  70. case DRM_FORMAT_ARGB8888:
  71. default:
  72. format |= LDBBSIFR_SWPL;
  73. break;
  74. }
  75. switch (splane->format->fourcc) {
  76. case DRM_FORMAT_RGB565:
  77. format |= LDBBSIFR_AL_1 | LDBBSIFR_RY | LDBBSIFR_RPKF_RGB16;
  78. break;
  79. case DRM_FORMAT_RGB888:
  80. format |= LDBBSIFR_AL_1 | LDBBSIFR_RY | LDBBSIFR_RPKF_RGB24;
  81. break;
  82. case DRM_FORMAT_ARGB8888:
  83. format |= LDBBSIFR_AL_PK | LDBBSIFR_RY | LDDFR_PKF_ARGB32;
  84. break;
  85. case DRM_FORMAT_NV12:
  86. case DRM_FORMAT_NV21:
  87. format |= LDBBSIFR_AL_1 | LDBBSIFR_CHRR_420;
  88. break;
  89. case DRM_FORMAT_NV16:
  90. case DRM_FORMAT_NV61:
  91. format |= LDBBSIFR_AL_1 | LDBBSIFR_CHRR_422;
  92. break;
  93. case DRM_FORMAT_NV24:
  94. case DRM_FORMAT_NV42:
  95. format |= LDBBSIFR_AL_1 | LDBBSIFR_CHRR_444;
  96. break;
  97. }
  98. #define plane_reg_dump(sdev, splane, reg) \
  99. dev_dbg(sdev->ddev->dev, "%s(%u): %s 0x%08x 0x%08x\n", __func__, \
  100. splane->index, #reg, \
  101. lcdc_read(sdev, reg(splane->index)), \
  102. lcdc_read(sdev, reg(splane->index) + LCDC_SIDE_B_OFFSET))
  103. plane_reg_dump(sdev, splane, LDBnBSIFR);
  104. plane_reg_dump(sdev, splane, LDBnBSSZR);
  105. plane_reg_dump(sdev, splane, LDBnBLOCR);
  106. plane_reg_dump(sdev, splane, LDBnBSMWR);
  107. plane_reg_dump(sdev, splane, LDBnBSAYR);
  108. plane_reg_dump(sdev, splane, LDBnBSACR);
  109. lcdc_write(sdev, LDBCR, LDBCR_UPC(splane->index));
  110. dev_dbg(sdev->ddev->dev, "%s(%u): %s 0x%08x\n", __func__, splane->index,
  111. "LDBCR", lcdc_read(sdev, LDBCR));
  112. lcdc_write(sdev, LDBnBSIFR(splane->index), format);
  113. lcdc_write(sdev, LDBnBSSZR(splane->index),
  114. (splane->crtc_h << LDBBSSZR_BVSS_SHIFT) |
  115. (splane->crtc_w << LDBBSSZR_BHSS_SHIFT));
  116. lcdc_write(sdev, LDBnBLOCR(splane->index),
  117. (splane->crtc_y << LDBBLOCR_CVLC_SHIFT) |
  118. (splane->crtc_x << LDBBLOCR_CHLC_SHIFT));
  119. lcdc_write(sdev, LDBnBSMWR(splane->index),
  120. fb->pitches[0] << LDBBSMWR_BSMW_SHIFT);
  121. shmob_drm_plane_compute_base(splane, fb, splane->src_x, splane->src_y);
  122. lcdc_write(sdev, LDBnBSAYR(splane->index), splane->dma[0]);
  123. if (splane->format->yuv)
  124. lcdc_write(sdev, LDBnBSACR(splane->index), splane->dma[1]);
  125. lcdc_write(sdev, LDBCR,
  126. LDBCR_UPF(splane->index) | LDBCR_UPD(splane->index));
  127. dev_dbg(sdev->ddev->dev, "%s(%u): %s 0x%08x\n", __func__, splane->index,
  128. "LDBCR", lcdc_read(sdev, LDBCR));
  129. plane_reg_dump(sdev, splane, LDBnBSIFR);
  130. plane_reg_dump(sdev, splane, LDBnBSSZR);
  131. plane_reg_dump(sdev, splane, LDBnBLOCR);
  132. plane_reg_dump(sdev, splane, LDBnBSMWR);
  133. plane_reg_dump(sdev, splane, LDBnBSAYR);
  134. plane_reg_dump(sdev, splane, LDBnBSACR);
  135. }
  136. void shmob_drm_plane_setup(struct drm_plane *plane)
  137. {
  138. struct shmob_drm_plane *splane = to_shmob_plane(plane);
  139. if (plane->fb == NULL)
  140. return;
  141. __shmob_drm_plane_setup(splane, plane->fb);
  142. }
  143. static int
  144. shmob_drm_plane_update(struct drm_plane *plane, struct drm_crtc *crtc,
  145. struct drm_framebuffer *fb, int crtc_x, int crtc_y,
  146. unsigned int crtc_w, unsigned int crtc_h,
  147. uint32_t src_x, uint32_t src_y,
  148. uint32_t src_w, uint32_t src_h,
  149. struct drm_modeset_acquire_ctx *ctx)
  150. {
  151. struct shmob_drm_plane *splane = to_shmob_plane(plane);
  152. struct shmob_drm_device *sdev = plane->dev->dev_private;
  153. const struct shmob_drm_format_info *format;
  154. format = shmob_drm_format_info(fb->format->format);
  155. if (format == NULL) {
  156. dev_dbg(sdev->dev, "update_plane: unsupported format %08x\n",
  157. fb->format->format);
  158. return -EINVAL;
  159. }
  160. if (src_w >> 16 != crtc_w || src_h >> 16 != crtc_h) {
  161. dev_dbg(sdev->dev, "%s: scaling not supported\n", __func__);
  162. return -EINVAL;
  163. }
  164. splane->format = format;
  165. splane->src_x = src_x >> 16;
  166. splane->src_y = src_y >> 16;
  167. splane->crtc_x = crtc_x;
  168. splane->crtc_y = crtc_y;
  169. splane->crtc_w = crtc_w;
  170. splane->crtc_h = crtc_h;
  171. __shmob_drm_plane_setup(splane, fb);
  172. return 0;
  173. }
  174. static int shmob_drm_plane_disable(struct drm_plane *plane,
  175. struct drm_modeset_acquire_ctx *ctx)
  176. {
  177. struct shmob_drm_plane *splane = to_shmob_plane(plane);
  178. struct shmob_drm_device *sdev = plane->dev->dev_private;
  179. splane->format = NULL;
  180. lcdc_write(sdev, LDBnBSIFR(splane->index), 0);
  181. return 0;
  182. }
  183. static void shmob_drm_plane_destroy(struct drm_plane *plane)
  184. {
  185. drm_plane_force_disable(plane);
  186. drm_plane_cleanup(plane);
  187. }
  188. static const struct drm_plane_funcs shmob_drm_plane_funcs = {
  189. .update_plane = shmob_drm_plane_update,
  190. .disable_plane = shmob_drm_plane_disable,
  191. .destroy = shmob_drm_plane_destroy,
  192. };
  193. static const uint32_t formats[] = {
  194. DRM_FORMAT_RGB565,
  195. DRM_FORMAT_RGB888,
  196. DRM_FORMAT_ARGB8888,
  197. DRM_FORMAT_NV12,
  198. DRM_FORMAT_NV21,
  199. DRM_FORMAT_NV16,
  200. DRM_FORMAT_NV61,
  201. DRM_FORMAT_NV24,
  202. DRM_FORMAT_NV42,
  203. };
  204. int shmob_drm_plane_create(struct shmob_drm_device *sdev, unsigned int index)
  205. {
  206. struct shmob_drm_plane *splane;
  207. int ret;
  208. splane = devm_kzalloc(sdev->dev, sizeof(*splane), GFP_KERNEL);
  209. if (splane == NULL)
  210. return -ENOMEM;
  211. splane->index = index;
  212. splane->alpha = 255;
  213. ret = drm_plane_init(sdev->ddev, &splane->plane, 1,
  214. &shmob_drm_plane_funcs, formats,
  215. ARRAY_SIZE(formats), false);
  216. return ret;
  217. }