meson_plane.c 6.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Amlogic Meson Video Processing Unit driver
  4. *
  5. * Copyright (c) 2018 BayLibre, SAS.
  6. * Author: Neil Armstrong <narmstrong@baylibre.com>
  7. */
  8. #include <common.h>
  9. #include <dm.h>
  10. #include <asm/io.h>
  11. #include <linux/bitfield.h>
  12. #include <linux/bitops.h>
  13. #include "meson_vpu.h"
  14. /* OSDx_BLKx_CFG */
  15. #define OSD_CANVAS_SEL 16
  16. #define OSD_ENDIANNESS_LE BIT(15)
  17. #define OSD_ENDIANNESS_BE (0)
  18. #define OSD_BLK_MODE_422 (0x03 << 8)
  19. #define OSD_BLK_MODE_16 (0x04 << 8)
  20. #define OSD_BLK_MODE_32 (0x05 << 8)
  21. #define OSD_BLK_MODE_24 (0x07 << 8)
  22. #define OSD_OUTPUT_COLOR_RGB BIT(7)
  23. #define OSD_OUTPUT_COLOR_YUV (0)
  24. #define OSD_COLOR_MATRIX_32_RGBA (0x00 << 2)
  25. #define OSD_COLOR_MATRIX_32_ARGB (0x01 << 2)
  26. #define OSD_COLOR_MATRIX_32_ABGR (0x02 << 2)
  27. #define OSD_COLOR_MATRIX_32_BGRA (0x03 << 2)
  28. #define OSD_COLOR_MATRIX_24_RGB (0x00 << 2)
  29. #define OSD_COLOR_MATRIX_16_RGB655 (0x00 << 2)
  30. #define OSD_COLOR_MATRIX_16_RGB565 (0x04 << 2)
  31. #define OSD_INTERLACE_ENABLED BIT(1)
  32. #define OSD_INTERLACE_ODD BIT(0)
  33. #define OSD_INTERLACE_EVEN (0)
  34. /* OSDx_CTRL_STAT */
  35. #define OSD_ENABLE BIT(21)
  36. #define OSD_BLK0_ENABLE BIT(0)
  37. #define OSD_GLOBAL_ALPHA_SHIFT 12
  38. /* OSDx_CTRL_STAT2 */
  39. #define OSD_REPLACE_EN BIT(14)
  40. #define OSD_REPLACE_SHIFT 6
  41. /*
  42. * When the output is interlaced, the OSD must switch between
  43. * each field using the INTERLACE_SEL_ODD (0) of VIU_OSD1_BLK0_CFG_W0
  44. * at each vsync.
  45. * But the vertical scaler can provide such funtionnality if
  46. * is configured for 2:1 scaling with interlace options enabled.
  47. */
  48. static void meson_vpp_setup_interlace_vscaler_osd1(struct meson_vpu_priv *priv,
  49. struct video_priv *uc_priv)
  50. {
  51. writel(BIT(3) /* Enable scaler */ |
  52. BIT(2), /* Select OSD1 */
  53. priv->io_base + _REG(VPP_OSD_SC_CTRL0));
  54. writel(((uc_priv->xsize - 1) << 16) | (uc_priv->ysize - 1),
  55. priv->io_base + _REG(VPP_OSD_SCI_WH_M1));
  56. /* 2:1 scaling */
  57. writel((0 << 16) | uc_priv->xsize,
  58. priv->io_base + _REG(VPP_OSD_SCO_H_START_END));
  59. writel(((0 >> 1) << 16) | (uc_priv->ysize >> 1),
  60. priv->io_base + _REG(VPP_OSD_SCO_V_START_END));
  61. /* 2:1 scaling values */
  62. writel(BIT(16), priv->io_base + _REG(VPP_OSD_VSC_INI_PHASE));
  63. writel(BIT(25), priv->io_base + _REG(VPP_OSD_VSC_PHASE_STEP));
  64. writel(0, priv->io_base + _REG(VPP_OSD_HSC_CTRL0));
  65. writel((4 << 0) /* osd_vsc_bank_length */ |
  66. (4 << 3) /* osd_vsc_top_ini_rcv_num0 */ |
  67. (1 << 8) /* osd_vsc_top_rpt_p0_num0 */ |
  68. (6 << 11) /* osd_vsc_bot_ini_rcv_num0 */ |
  69. (2 << 16) /* osd_vsc_bot_rpt_p0_num0 */ |
  70. BIT(23) /* osd_prog_interlace */ |
  71. BIT(24), /* Enable vertical scaler */
  72. priv->io_base + _REG(VPP_OSD_VSC_CTRL0));
  73. }
  74. static void
  75. meson_vpp_disable_interlace_vscaler_osd1(struct meson_vpu_priv *priv)
  76. {
  77. writel(0, priv->io_base + _REG(VPP_OSD_SC_CTRL0));
  78. writel(0, priv->io_base + _REG(VPP_OSD_VSC_CTRL0));
  79. writel(0, priv->io_base + _REG(VPP_OSD_HSC_CTRL0));
  80. }
  81. void meson_vpu_setup_plane(struct udevice *dev, bool is_interlaced)
  82. {
  83. struct video_uc_plat *uc_plat = dev_get_uclass_plat(dev);
  84. struct video_priv *uc_priv = dev_get_uclass_priv(dev);
  85. struct meson_vpu_priv *priv = dev_get_priv(dev);
  86. u32 osd1_ctrl_stat;
  87. u32 osd1_blk0_cfg[5];
  88. bool osd1_interlace;
  89. unsigned int src_x1, src_x2, src_y1, src_y2;
  90. unsigned int dest_x1, dest_x2, dest_y1, dest_y2;
  91. dest_x1 = src_x1 = 0;
  92. dest_x2 = src_x2 = uc_priv->xsize;
  93. dest_y1 = src_y1 = 0;
  94. dest_y2 = src_y2 = uc_priv->ysize;
  95. if (meson_vpu_is_compatible(priv, VPU_COMPATIBLE_G12A)) {
  96. /* VD1 Preblend vertical start/end */
  97. writel(FIELD_PREP(GENMASK(11, 0), 2303),
  98. priv->io_base + _REG(VPP_PREBLEND_VD1_V_START_END));
  99. /* Setup Blender */
  100. writel(uc_priv->xsize |
  101. uc_priv->ysize << 16,
  102. priv->io_base + _REG(VPP_POSTBLEND_H_SIZE));
  103. writel(0 << 16 |
  104. (uc_priv->xsize - 1),
  105. priv->io_base + _REG(VPP_OSD1_BLD_H_SCOPE));
  106. writel(0 << 16 |
  107. (uc_priv->ysize - 1),
  108. priv->io_base + _REG(VPP_OSD1_BLD_V_SCOPE));
  109. writel(uc_priv->xsize << 16 |
  110. uc_priv->ysize,
  111. priv->io_base + _REG(VPP_OUT_H_V_SIZE));
  112. } else {
  113. /* Enable VPP Postblend */
  114. writel(uc_priv->xsize,
  115. priv->io_base + _REG(VPP_POSTBLEND_H_SIZE));
  116. writel_bits(VPP_POSTBLEND_ENABLE, VPP_POSTBLEND_ENABLE,
  117. priv->io_base + _REG(VPP_MISC));
  118. }
  119. /* uc_plat->base is the framebuffer */
  120. /* Enable OSD and BLK0, set max global alpha */
  121. osd1_ctrl_stat = OSD_ENABLE | (0xFF << OSD_GLOBAL_ALPHA_SHIFT) |
  122. OSD_BLK0_ENABLE;
  123. /* Set up BLK0 to point to the right canvas */
  124. osd1_blk0_cfg[0] = ((MESON_CANVAS_ID_OSD1 << OSD_CANVAS_SEL) |
  125. OSD_ENDIANNESS_LE);
  126. /* On GXBB, Use the old non-HDR RGB2YUV converter */
  127. if (meson_vpu_is_compatible(priv, VPU_COMPATIBLE_GXBB))
  128. osd1_blk0_cfg[0] |= OSD_OUTPUT_COLOR_RGB;
  129. /* For XRGB, replace the pixel's alpha by 0xFF */
  130. writel_bits(OSD_REPLACE_EN, OSD_REPLACE_EN,
  131. priv->io_base + _REG(VIU_OSD1_CTRL_STAT2));
  132. osd1_blk0_cfg[0] |= OSD_BLK_MODE_32 |
  133. OSD_COLOR_MATRIX_32_ARGB;
  134. if (is_interlaced) {
  135. osd1_interlace = true;
  136. dest_y1 /= 2;
  137. dest_y2 /= 2;
  138. } else {
  139. osd1_interlace = false;
  140. }
  141. /*
  142. * The format of these registers is (x2 << 16 | x1),
  143. * where x2 is exclusive.
  144. * e.g. +30x1920 would be (1919 << 16) | 30
  145. */
  146. osd1_blk0_cfg[1] = ((src_x2 - 1) << 16) | src_x1;
  147. osd1_blk0_cfg[2] = ((src_y2 - 1) << 16) | src_y1;
  148. osd1_blk0_cfg[3] = ((dest_x2 - 1) << 16) | dest_x1;
  149. osd1_blk0_cfg[4] = ((dest_y2 - 1) << 16) | dest_y1;
  150. writel(osd1_ctrl_stat, priv->io_base + _REG(VIU_OSD1_CTRL_STAT));
  151. writel(osd1_blk0_cfg[0], priv->io_base + _REG(VIU_OSD1_BLK0_CFG_W0));
  152. writel(osd1_blk0_cfg[1], priv->io_base + _REG(VIU_OSD1_BLK0_CFG_W1));
  153. writel(osd1_blk0_cfg[2], priv->io_base + _REG(VIU_OSD1_BLK0_CFG_W2));
  154. writel(osd1_blk0_cfg[3], priv->io_base + _REG(VIU_OSD1_BLK0_CFG_W3));
  155. writel(osd1_blk0_cfg[4], priv->io_base + _REG(VIU_OSD1_BLK0_CFG_W4));
  156. /* If output is interlace, make use of the Scaler */
  157. if (osd1_interlace)
  158. meson_vpp_setup_interlace_vscaler_osd1(priv, uc_priv);
  159. else
  160. meson_vpp_disable_interlace_vscaler_osd1(priv);
  161. meson_canvas_setup(priv, MESON_CANVAS_ID_OSD1,
  162. uc_plat->base, uc_priv->xsize * 4,
  163. uc_priv->ysize, MESON_CANVAS_WRAP_NONE,
  164. MESON_CANVAS_BLKMODE_LINEAR);
  165. /* Enable OSD1 */
  166. if (meson_vpu_is_compatible(priv, VPU_COMPATIBLE_G12A)) {
  167. writel(((dest_x2 - 1) << 16) | dest_x1,
  168. priv->io_base + _REG(VIU_OSD_BLEND_DIN0_SCOPE_H));
  169. writel(((dest_y2 - 1) << 16) | dest_y1,
  170. priv->io_base + _REG(VIU_OSD_BLEND_DIN0_SCOPE_V));
  171. writel(uc_priv->xsize << 16 | uc_priv->ysize,
  172. priv->io_base + _REG(VIU_OSD_BLEND_BLEND0_SIZE));
  173. writel(uc_priv->xsize << 16 | uc_priv->ysize,
  174. priv->io_base + _REG(VIU_OSD_BLEND_BLEND1_SIZE));
  175. writel_bits(3 << 8, 3 << 8,
  176. priv->io_base + _REG(OSD1_BLEND_SRC_CTRL));
  177. } else
  178. writel_bits(VPP_OSD1_POSTBLEND, VPP_OSD1_POSTBLEND,
  179. priv->io_base + _REG(VPP_MISC));
  180. }