armada_overlay.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (C) 2012 Russell King
  4. * Rewritten from the dovefb driver, and Armada510 manuals.
  5. */
  6. #include <linux/bitfield.h>
  7. #include <drm/armada_drm.h>
  8. #include <drm/drm_atomic.h>
  9. #include <drm/drm_atomic_helper.h>
  10. #include <drm/drm_atomic_uapi.h>
  11. #include <drm/drm_fourcc.h>
  12. #include <drm/drm_plane_helper.h>
  13. #include <drm/drm_print.h>
  14. #include "armada_crtc.h"
  15. #include "armada_drm.h"
  16. #include "armada_fb.h"
  17. #include "armada_gem.h"
  18. #include "armada_hw.h"
  19. #include "armada_ioctlP.h"
  20. #include "armada_plane.h"
  21. #include "armada_trace.h"
  22. #define DEFAULT_BRIGHTNESS 0
  23. #define DEFAULT_CONTRAST 0x4000
  24. #define DEFAULT_SATURATION 0x4000
  25. #define DEFAULT_ENCODING DRM_COLOR_YCBCR_BT601
  26. struct armada_overlay_state {
  27. struct armada_plane_state base;
  28. u32 colorkey_yr;
  29. u32 colorkey_ug;
  30. u32 colorkey_vb;
  31. u32 colorkey_mode;
  32. u32 colorkey_enable;
  33. s16 brightness;
  34. u16 contrast;
  35. u16 saturation;
  36. };
  37. #define drm_to_overlay_state(s) \
  38. container_of(s, struct armada_overlay_state, base.base)
  39. static inline u32 armada_spu_contrast(struct drm_plane_state *state)
  40. {
  41. return drm_to_overlay_state(state)->brightness << 16 |
  42. drm_to_overlay_state(state)->contrast;
  43. }
  44. static inline u32 armada_spu_saturation(struct drm_plane_state *state)
  45. {
  46. /* Docs say 15:0, but it seems to actually be 31:16 on Armada 510 */
  47. return drm_to_overlay_state(state)->saturation << 16;
  48. }
  49. static inline u32 armada_csc(struct drm_plane_state *state)
  50. {
  51. /*
  52. * The CFG_CSC_RGB_* settings control the output of the colour space
  53. * converter, setting the range of output values it produces. Since
  54. * we will be blending with the full-range graphics, we need to
  55. * produce full-range RGB output from the conversion.
  56. */
  57. return CFG_CSC_RGB_COMPUTER |
  58. (state->color_encoding == DRM_COLOR_YCBCR_BT709 ?
  59. CFG_CSC_YUV_CCIR709 : CFG_CSC_YUV_CCIR601);
  60. }
  61. /* === Plane support === */
  62. static void armada_drm_overlay_plane_atomic_update(struct drm_plane *plane,
  63. struct drm_atomic_state *state)
  64. {
  65. struct drm_plane_state *old_state = drm_atomic_get_old_plane_state(state,
  66. plane);
  67. struct drm_plane_state *new_state = drm_atomic_get_new_plane_state(state,
  68. plane);
  69. struct armada_crtc *dcrtc;
  70. struct armada_regs *regs;
  71. unsigned int idx;
  72. u32 cfg, cfg_mask, val;
  73. DRM_DEBUG_KMS("[PLANE:%d:%s]\n", plane->base.id, plane->name);
  74. if (!new_state->fb || WARN_ON(!new_state->crtc))
  75. return;
  76. DRM_DEBUG_KMS("[PLANE:%d:%s] is on [CRTC:%d:%s] with [FB:%d] visible %u->%u\n",
  77. plane->base.id, plane->name,
  78. new_state->crtc->base.id, new_state->crtc->name,
  79. new_state->fb->base.id,
  80. old_state->visible, new_state->visible);
  81. dcrtc = drm_to_armada_crtc(new_state->crtc);
  82. regs = dcrtc->regs + dcrtc->regs_idx;
  83. idx = 0;
  84. if (!old_state->visible && new_state->visible)
  85. armada_reg_queue_mod(regs, idx,
  86. 0, CFG_PDWN16x66 | CFG_PDWN32x66,
  87. LCD_SPU_SRAM_PARA1);
  88. val = armada_src_hw(new_state);
  89. if (armada_src_hw(old_state) != val)
  90. armada_reg_queue_set(regs, idx, val, LCD_SPU_DMA_HPXL_VLN);
  91. val = armada_dst_yx(new_state);
  92. if (armada_dst_yx(old_state) != val)
  93. armada_reg_queue_set(regs, idx, val, LCD_SPU_DMA_OVSA_HPXL_VLN);
  94. val = armada_dst_hw(new_state);
  95. if (armada_dst_hw(old_state) != val)
  96. armada_reg_queue_set(regs, idx, val, LCD_SPU_DZM_HPXL_VLN);
  97. /* FIXME: overlay on an interlaced display */
  98. if (old_state->src.x1 != new_state->src.x1 ||
  99. old_state->src.y1 != new_state->src.y1 ||
  100. old_state->fb != new_state->fb ||
  101. new_state->crtc->state->mode_changed) {
  102. const struct drm_format_info *format;
  103. u16 src_x;
  104. armada_reg_queue_set(regs, idx, armada_addr(new_state, 0, 0),
  105. LCD_SPU_DMA_START_ADDR_Y0);
  106. armada_reg_queue_set(regs, idx, armada_addr(new_state, 0, 1),
  107. LCD_SPU_DMA_START_ADDR_U0);
  108. armada_reg_queue_set(regs, idx, armada_addr(new_state, 0, 2),
  109. LCD_SPU_DMA_START_ADDR_V0);
  110. armada_reg_queue_set(regs, idx, armada_addr(new_state, 1, 0),
  111. LCD_SPU_DMA_START_ADDR_Y1);
  112. armada_reg_queue_set(regs, idx, armada_addr(new_state, 1, 1),
  113. LCD_SPU_DMA_START_ADDR_U1);
  114. armada_reg_queue_set(regs, idx, armada_addr(new_state, 1, 2),
  115. LCD_SPU_DMA_START_ADDR_V1);
  116. val = armada_pitch(new_state, 0) << 16 | armada_pitch(new_state,
  117. 0);
  118. armada_reg_queue_set(regs, idx, val, LCD_SPU_DMA_PITCH_YC);
  119. val = armada_pitch(new_state, 1) << 16 | armada_pitch(new_state,
  120. 2);
  121. armada_reg_queue_set(regs, idx, val, LCD_SPU_DMA_PITCH_UV);
  122. cfg = CFG_DMA_FMT(drm_fb_to_armada_fb(new_state->fb)->fmt) |
  123. CFG_DMA_MOD(drm_fb_to_armada_fb(new_state->fb)->mod) |
  124. CFG_CBSH_ENA;
  125. if (new_state->visible)
  126. cfg |= CFG_DMA_ENA;
  127. /*
  128. * Shifting a YUV packed format image by one pixel causes the
  129. * U/V planes to swap. Compensate for it by also toggling
  130. * the UV swap.
  131. */
  132. format = new_state->fb->format;
  133. src_x = new_state->src.x1 >> 16;
  134. if (format->num_planes == 1 && src_x & (format->hsub - 1))
  135. cfg ^= CFG_DMA_MOD(CFG_SWAPUV);
  136. if (to_armada_plane_state(new_state)->interlace)
  137. cfg |= CFG_DMA_FTOGGLE;
  138. cfg_mask = CFG_CBSH_ENA | CFG_DMAFORMAT |
  139. CFG_DMA_MOD(CFG_SWAPRB | CFG_SWAPUV |
  140. CFG_SWAPYU | CFG_YUV2RGB) |
  141. CFG_DMA_FTOGGLE | CFG_DMA_TSTMODE |
  142. CFG_DMA_ENA;
  143. } else if (old_state->visible != new_state->visible) {
  144. cfg = new_state->visible ? CFG_DMA_ENA : 0;
  145. cfg_mask = CFG_DMA_ENA;
  146. } else {
  147. cfg = cfg_mask = 0;
  148. }
  149. if (drm_rect_width(&old_state->src) != drm_rect_width(&new_state->src) ||
  150. drm_rect_width(&old_state->dst) != drm_rect_width(&new_state->dst)) {
  151. cfg_mask |= CFG_DMA_HSMOOTH;
  152. if (drm_rect_width(&new_state->src) >> 16 !=
  153. drm_rect_width(&new_state->dst))
  154. cfg |= CFG_DMA_HSMOOTH;
  155. }
  156. if (cfg_mask)
  157. armada_reg_queue_mod(regs, idx, cfg, cfg_mask,
  158. LCD_SPU_DMA_CTRL0);
  159. val = armada_spu_contrast(new_state);
  160. if ((!old_state->visible && new_state->visible) ||
  161. armada_spu_contrast(old_state) != val)
  162. armada_reg_queue_set(regs, idx, val, LCD_SPU_CONTRAST);
  163. val = armada_spu_saturation(new_state);
  164. if ((!old_state->visible && new_state->visible) ||
  165. armada_spu_saturation(old_state) != val)
  166. armada_reg_queue_set(regs, idx, val, LCD_SPU_SATURATION);
  167. if (!old_state->visible && new_state->visible)
  168. armada_reg_queue_set(regs, idx, 0x00002000, LCD_SPU_CBSH_HUE);
  169. val = armada_csc(new_state);
  170. if ((!old_state->visible && new_state->visible) ||
  171. armada_csc(old_state) != val)
  172. armada_reg_queue_mod(regs, idx, val, CFG_CSC_MASK,
  173. LCD_SPU_IOPAD_CONTROL);
  174. val = drm_to_overlay_state(new_state)->colorkey_yr;
  175. if ((!old_state->visible && new_state->visible) ||
  176. drm_to_overlay_state(old_state)->colorkey_yr != val)
  177. armada_reg_queue_set(regs, idx, val, LCD_SPU_COLORKEY_Y);
  178. val = drm_to_overlay_state(new_state)->colorkey_ug;
  179. if ((!old_state->visible && new_state->visible) ||
  180. drm_to_overlay_state(old_state)->colorkey_ug != val)
  181. armada_reg_queue_set(regs, idx, val, LCD_SPU_COLORKEY_U);
  182. val = drm_to_overlay_state(new_state)->colorkey_vb;
  183. if ((!old_state->visible && new_state->visible) ||
  184. drm_to_overlay_state(old_state)->colorkey_vb != val)
  185. armada_reg_queue_set(regs, idx, val, LCD_SPU_COLORKEY_V);
  186. val = drm_to_overlay_state(new_state)->colorkey_mode;
  187. if ((!old_state->visible && new_state->visible) ||
  188. drm_to_overlay_state(old_state)->colorkey_mode != val)
  189. armada_reg_queue_mod(regs, idx, val, CFG_CKMODE_MASK |
  190. CFG_ALPHAM_MASK | CFG_ALPHA_MASK,
  191. LCD_SPU_DMA_CTRL1);
  192. val = drm_to_overlay_state(new_state)->colorkey_enable;
  193. if (((!old_state->visible && new_state->visible) ||
  194. drm_to_overlay_state(old_state)->colorkey_enable != val) &&
  195. dcrtc->variant->has_spu_adv_reg)
  196. armada_reg_queue_mod(regs, idx, val, ADV_GRACOLORKEY |
  197. ADV_VIDCOLORKEY, LCD_SPU_ADV_REG);
  198. dcrtc->regs_idx += idx;
  199. }
  200. static void armada_drm_overlay_plane_atomic_disable(struct drm_plane *plane,
  201. struct drm_atomic_state *state)
  202. {
  203. struct drm_plane_state *old_state = drm_atomic_get_old_plane_state(state,
  204. plane);
  205. struct armada_crtc *dcrtc;
  206. struct armada_regs *regs;
  207. unsigned int idx = 0;
  208. DRM_DEBUG_KMS("[PLANE:%d:%s]\n", plane->base.id, plane->name);
  209. if (!old_state->crtc)
  210. return;
  211. DRM_DEBUG_KMS("[PLANE:%d:%s] was on [CRTC:%d:%s] with [FB:%d]\n",
  212. plane->base.id, plane->name,
  213. old_state->crtc->base.id, old_state->crtc->name,
  214. old_state->fb->base.id);
  215. dcrtc = drm_to_armada_crtc(old_state->crtc);
  216. regs = dcrtc->regs + dcrtc->regs_idx;
  217. /* Disable plane and power down the YUV FIFOs */
  218. armada_reg_queue_mod(regs, idx, 0, CFG_DMA_ENA, LCD_SPU_DMA_CTRL0);
  219. armada_reg_queue_mod(regs, idx, CFG_PDWN16x66 | CFG_PDWN32x66, 0,
  220. LCD_SPU_SRAM_PARA1);
  221. dcrtc->regs_idx += idx;
  222. }
  223. static const struct drm_plane_helper_funcs armada_overlay_plane_helper_funcs = {
  224. .atomic_check = armada_drm_plane_atomic_check,
  225. .atomic_update = armada_drm_overlay_plane_atomic_update,
  226. .atomic_disable = armada_drm_overlay_plane_atomic_disable,
  227. };
  228. static int
  229. armada_overlay_plane_update(struct drm_plane *plane, struct drm_crtc *crtc,
  230. struct drm_framebuffer *fb,
  231. int crtc_x, int crtc_y, unsigned crtc_w, unsigned crtc_h,
  232. uint32_t src_x, uint32_t src_y, uint32_t src_w, uint32_t src_h,
  233. struct drm_modeset_acquire_ctx *ctx)
  234. {
  235. struct drm_atomic_state *state;
  236. struct drm_plane_state *plane_state;
  237. int ret = 0;
  238. trace_armada_ovl_plane_update(plane, crtc, fb,
  239. crtc_x, crtc_y, crtc_w, crtc_h,
  240. src_x, src_y, src_w, src_h);
  241. state = drm_atomic_state_alloc(plane->dev);
  242. if (!state)
  243. return -ENOMEM;
  244. state->acquire_ctx = ctx;
  245. plane_state = drm_atomic_get_plane_state(state, plane);
  246. if (IS_ERR(plane_state)) {
  247. ret = PTR_ERR(plane_state);
  248. goto fail;
  249. }
  250. ret = drm_atomic_set_crtc_for_plane(plane_state, crtc);
  251. if (ret != 0)
  252. goto fail;
  253. drm_atomic_set_fb_for_plane(plane_state, fb);
  254. plane_state->crtc_x = crtc_x;
  255. plane_state->crtc_y = crtc_y;
  256. plane_state->crtc_h = crtc_h;
  257. plane_state->crtc_w = crtc_w;
  258. plane_state->src_x = src_x;
  259. plane_state->src_y = src_y;
  260. plane_state->src_h = src_h;
  261. plane_state->src_w = src_w;
  262. ret = drm_atomic_nonblocking_commit(state);
  263. fail:
  264. drm_atomic_state_put(state);
  265. return ret;
  266. }
  267. static void armada_overlay_reset(struct drm_plane *plane)
  268. {
  269. struct armada_overlay_state *state;
  270. if (plane->state)
  271. __drm_atomic_helper_plane_destroy_state(plane->state);
  272. kfree(plane->state);
  273. plane->state = NULL;
  274. state = kzalloc_obj(*state);
  275. if (state) {
  276. state->colorkey_yr = 0xfefefe00;
  277. state->colorkey_ug = 0x01010100;
  278. state->colorkey_vb = 0x01010100;
  279. state->colorkey_mode = CFG_CKMODE(CKMODE_RGB) |
  280. CFG_ALPHAM_GRA | CFG_ALPHA(0);
  281. state->colorkey_enable = ADV_GRACOLORKEY;
  282. state->brightness = DEFAULT_BRIGHTNESS;
  283. state->contrast = DEFAULT_CONTRAST;
  284. state->saturation = DEFAULT_SATURATION;
  285. __drm_atomic_helper_plane_reset(plane, &state->base.base);
  286. state->base.base.color_encoding = DEFAULT_ENCODING;
  287. state->base.base.color_range = DRM_COLOR_YCBCR_LIMITED_RANGE;
  288. }
  289. }
  290. static struct drm_plane_state *
  291. armada_overlay_duplicate_state(struct drm_plane *plane)
  292. {
  293. struct armada_overlay_state *state;
  294. if (WARN_ON(!plane->state))
  295. return NULL;
  296. state = kmemdup(plane->state, sizeof(*state), GFP_KERNEL);
  297. if (state)
  298. __drm_atomic_helper_plane_duplicate_state(plane,
  299. &state->base.base);
  300. return &state->base.base;
  301. }
  302. static int armada_overlay_set_property(struct drm_plane *plane,
  303. struct drm_plane_state *state, struct drm_property *property,
  304. uint64_t val)
  305. {
  306. struct armada_private *priv = drm_to_armada_dev(plane->dev);
  307. #define K2R(val) (((val) >> 0) & 0xff)
  308. #define K2G(val) (((val) >> 8) & 0xff)
  309. #define K2B(val) (((val) >> 16) & 0xff)
  310. if (property == priv->colorkey_prop) {
  311. #define CCC(v) ((v) << 24 | (v) << 16 | (v) << 8)
  312. drm_to_overlay_state(state)->colorkey_yr = CCC(K2R(val));
  313. drm_to_overlay_state(state)->colorkey_ug = CCC(K2G(val));
  314. drm_to_overlay_state(state)->colorkey_vb = CCC(K2B(val));
  315. #undef CCC
  316. } else if (property == priv->colorkey_min_prop) {
  317. drm_to_overlay_state(state)->colorkey_yr &= ~0x00ff0000;
  318. drm_to_overlay_state(state)->colorkey_yr |= K2R(val) << 16;
  319. drm_to_overlay_state(state)->colorkey_ug &= ~0x00ff0000;
  320. drm_to_overlay_state(state)->colorkey_ug |= K2G(val) << 16;
  321. drm_to_overlay_state(state)->colorkey_vb &= ~0x00ff0000;
  322. drm_to_overlay_state(state)->colorkey_vb |= K2B(val) << 16;
  323. } else if (property == priv->colorkey_max_prop) {
  324. drm_to_overlay_state(state)->colorkey_yr &= ~0xff000000;
  325. drm_to_overlay_state(state)->colorkey_yr |= K2R(val) << 24;
  326. drm_to_overlay_state(state)->colorkey_ug &= ~0xff000000;
  327. drm_to_overlay_state(state)->colorkey_ug |= K2G(val) << 24;
  328. drm_to_overlay_state(state)->colorkey_vb &= ~0xff000000;
  329. drm_to_overlay_state(state)->colorkey_vb |= K2B(val) << 24;
  330. } else if (property == priv->colorkey_val_prop) {
  331. drm_to_overlay_state(state)->colorkey_yr &= ~0x0000ff00;
  332. drm_to_overlay_state(state)->colorkey_yr |= K2R(val) << 8;
  333. drm_to_overlay_state(state)->colorkey_ug &= ~0x0000ff00;
  334. drm_to_overlay_state(state)->colorkey_ug |= K2G(val) << 8;
  335. drm_to_overlay_state(state)->colorkey_vb &= ~0x0000ff00;
  336. drm_to_overlay_state(state)->colorkey_vb |= K2B(val) << 8;
  337. } else if (property == priv->colorkey_alpha_prop) {
  338. drm_to_overlay_state(state)->colorkey_yr &= ~0x000000ff;
  339. drm_to_overlay_state(state)->colorkey_yr |= K2R(val);
  340. drm_to_overlay_state(state)->colorkey_ug &= ~0x000000ff;
  341. drm_to_overlay_state(state)->colorkey_ug |= K2G(val);
  342. drm_to_overlay_state(state)->colorkey_vb &= ~0x000000ff;
  343. drm_to_overlay_state(state)->colorkey_vb |= K2B(val);
  344. } else if (property == priv->colorkey_mode_prop) {
  345. if (val == CKMODE_DISABLE) {
  346. drm_to_overlay_state(state)->colorkey_mode =
  347. CFG_CKMODE(CKMODE_DISABLE) |
  348. CFG_ALPHAM_CFG | CFG_ALPHA(255);
  349. drm_to_overlay_state(state)->colorkey_enable = 0;
  350. } else {
  351. drm_to_overlay_state(state)->colorkey_mode =
  352. CFG_CKMODE(val) |
  353. CFG_ALPHAM_GRA | CFG_ALPHA(0);
  354. drm_to_overlay_state(state)->colorkey_enable =
  355. ADV_GRACOLORKEY;
  356. }
  357. } else if (property == priv->brightness_prop) {
  358. drm_to_overlay_state(state)->brightness = val - 256;
  359. } else if (property == priv->contrast_prop) {
  360. drm_to_overlay_state(state)->contrast = val;
  361. } else if (property == priv->saturation_prop) {
  362. drm_to_overlay_state(state)->saturation = val;
  363. } else {
  364. return -EINVAL;
  365. }
  366. return 0;
  367. }
  368. static int armada_overlay_get_property(struct drm_plane *plane,
  369. const struct drm_plane_state *state, struct drm_property *property,
  370. uint64_t *val)
  371. {
  372. struct armada_private *priv = drm_to_armada_dev(plane->dev);
  373. #define C2K(c,s) (((c) >> (s)) & 0xff)
  374. #define R2BGR(r,g,b,s) (C2K(r,s) << 0 | C2K(g,s) << 8 | C2K(b,s) << 16)
  375. if (property == priv->colorkey_prop) {
  376. /* Do best-efforts here for this property */
  377. *val = R2BGR(drm_to_overlay_state(state)->colorkey_yr,
  378. drm_to_overlay_state(state)->colorkey_ug,
  379. drm_to_overlay_state(state)->colorkey_vb, 16);
  380. /* If min != max, or min != val, error out */
  381. if (*val != R2BGR(drm_to_overlay_state(state)->colorkey_yr,
  382. drm_to_overlay_state(state)->colorkey_ug,
  383. drm_to_overlay_state(state)->colorkey_vb, 24) ||
  384. *val != R2BGR(drm_to_overlay_state(state)->colorkey_yr,
  385. drm_to_overlay_state(state)->colorkey_ug,
  386. drm_to_overlay_state(state)->colorkey_vb, 8))
  387. return -EINVAL;
  388. } else if (property == priv->colorkey_min_prop) {
  389. *val = R2BGR(drm_to_overlay_state(state)->colorkey_yr,
  390. drm_to_overlay_state(state)->colorkey_ug,
  391. drm_to_overlay_state(state)->colorkey_vb, 16);
  392. } else if (property == priv->colorkey_max_prop) {
  393. *val = R2BGR(drm_to_overlay_state(state)->colorkey_yr,
  394. drm_to_overlay_state(state)->colorkey_ug,
  395. drm_to_overlay_state(state)->colorkey_vb, 24);
  396. } else if (property == priv->colorkey_val_prop) {
  397. *val = R2BGR(drm_to_overlay_state(state)->colorkey_yr,
  398. drm_to_overlay_state(state)->colorkey_ug,
  399. drm_to_overlay_state(state)->colorkey_vb, 8);
  400. } else if (property == priv->colorkey_alpha_prop) {
  401. *val = R2BGR(drm_to_overlay_state(state)->colorkey_yr,
  402. drm_to_overlay_state(state)->colorkey_ug,
  403. drm_to_overlay_state(state)->colorkey_vb, 0);
  404. } else if (property == priv->colorkey_mode_prop) {
  405. *val = FIELD_GET(CFG_CKMODE_MASK,
  406. drm_to_overlay_state(state)->colorkey_mode);
  407. } else if (property == priv->brightness_prop) {
  408. *val = drm_to_overlay_state(state)->brightness + 256;
  409. } else if (property == priv->contrast_prop) {
  410. *val = drm_to_overlay_state(state)->contrast;
  411. } else if (property == priv->saturation_prop) {
  412. *val = drm_to_overlay_state(state)->saturation;
  413. } else {
  414. return -EINVAL;
  415. }
  416. return 0;
  417. }
  418. static const struct drm_plane_funcs armada_ovl_plane_funcs = {
  419. .update_plane = armada_overlay_plane_update,
  420. .disable_plane = drm_atomic_helper_disable_plane,
  421. .destroy = drm_plane_helper_destroy,
  422. .reset = armada_overlay_reset,
  423. .atomic_duplicate_state = armada_overlay_duplicate_state,
  424. .atomic_destroy_state = drm_atomic_helper_plane_destroy_state,
  425. .atomic_set_property = armada_overlay_set_property,
  426. .atomic_get_property = armada_overlay_get_property,
  427. };
  428. static const uint32_t armada_ovl_formats[] = {
  429. DRM_FORMAT_UYVY,
  430. DRM_FORMAT_YUYV,
  431. DRM_FORMAT_YUV420,
  432. DRM_FORMAT_YVU420,
  433. DRM_FORMAT_YUV422,
  434. DRM_FORMAT_YVU422,
  435. DRM_FORMAT_VYUY,
  436. DRM_FORMAT_YVYU,
  437. DRM_FORMAT_ARGB8888,
  438. DRM_FORMAT_ABGR8888,
  439. DRM_FORMAT_XRGB8888,
  440. DRM_FORMAT_XBGR8888,
  441. DRM_FORMAT_RGB888,
  442. DRM_FORMAT_BGR888,
  443. DRM_FORMAT_ARGB1555,
  444. DRM_FORMAT_ABGR1555,
  445. DRM_FORMAT_RGB565,
  446. DRM_FORMAT_BGR565,
  447. };
  448. static const struct drm_prop_enum_list armada_drm_colorkey_enum_list[] = {
  449. { CKMODE_DISABLE, "disabled" },
  450. { CKMODE_Y, "Y component" },
  451. { CKMODE_U, "U component" },
  452. { CKMODE_V, "V component" },
  453. { CKMODE_RGB, "RGB" },
  454. { CKMODE_R, "R component" },
  455. { CKMODE_G, "G component" },
  456. { CKMODE_B, "B component" },
  457. };
  458. static int armada_overlay_create_properties(struct drm_device *dev)
  459. {
  460. struct armada_private *priv = drm_to_armada_dev(dev);
  461. if (priv->colorkey_prop)
  462. return 0;
  463. priv->colorkey_prop = drm_property_create_range(dev, 0,
  464. "colorkey", 0, 0xffffff);
  465. priv->colorkey_min_prop = drm_property_create_range(dev, 0,
  466. "colorkey_min", 0, 0xffffff);
  467. priv->colorkey_max_prop = drm_property_create_range(dev, 0,
  468. "colorkey_max", 0, 0xffffff);
  469. priv->colorkey_val_prop = drm_property_create_range(dev, 0,
  470. "colorkey_val", 0, 0xffffff);
  471. priv->colorkey_alpha_prop = drm_property_create_range(dev, 0,
  472. "colorkey_alpha", 0, 0xffffff);
  473. priv->colorkey_mode_prop = drm_property_create_enum(dev, 0,
  474. "colorkey_mode",
  475. armada_drm_colorkey_enum_list,
  476. ARRAY_SIZE(armada_drm_colorkey_enum_list));
  477. priv->brightness_prop = drm_property_create_range(dev, 0,
  478. "brightness", 0, 256 + 255);
  479. priv->contrast_prop = drm_property_create_range(dev, 0,
  480. "contrast", 0, 0x7fff);
  481. priv->saturation_prop = drm_property_create_range(dev, 0,
  482. "saturation", 0, 0x7fff);
  483. if (!priv->colorkey_prop)
  484. return -ENOMEM;
  485. return 0;
  486. }
  487. int armada_overlay_plane_create(struct drm_device *dev, unsigned long crtcs)
  488. {
  489. struct armada_private *priv = drm_to_armada_dev(dev);
  490. struct drm_mode_object *mobj;
  491. struct drm_plane *overlay;
  492. int ret;
  493. ret = armada_overlay_create_properties(dev);
  494. if (ret)
  495. return ret;
  496. overlay = kzalloc_obj(*overlay);
  497. if (!overlay)
  498. return -ENOMEM;
  499. drm_plane_helper_add(overlay, &armada_overlay_plane_helper_funcs);
  500. ret = drm_universal_plane_init(dev, overlay, crtcs,
  501. &armada_ovl_plane_funcs,
  502. armada_ovl_formats,
  503. ARRAY_SIZE(armada_ovl_formats),
  504. NULL,
  505. DRM_PLANE_TYPE_OVERLAY, NULL);
  506. if (ret) {
  507. kfree(overlay);
  508. return ret;
  509. }
  510. mobj = &overlay->base;
  511. drm_object_attach_property(mobj, priv->colorkey_prop,
  512. 0x0101fe);
  513. drm_object_attach_property(mobj, priv->colorkey_min_prop,
  514. 0x0101fe);
  515. drm_object_attach_property(mobj, priv->colorkey_max_prop,
  516. 0x0101fe);
  517. drm_object_attach_property(mobj, priv->colorkey_val_prop,
  518. 0x0101fe);
  519. drm_object_attach_property(mobj, priv->colorkey_alpha_prop,
  520. 0x000000);
  521. drm_object_attach_property(mobj, priv->colorkey_mode_prop,
  522. CKMODE_RGB);
  523. drm_object_attach_property(mobj, priv->brightness_prop,
  524. 256 + DEFAULT_BRIGHTNESS);
  525. drm_object_attach_property(mobj, priv->contrast_prop,
  526. DEFAULT_CONTRAST);
  527. drm_object_attach_property(mobj, priv->saturation_prop,
  528. DEFAULT_SATURATION);
  529. ret = drm_plane_create_color_properties(overlay,
  530. BIT(DRM_COLOR_YCBCR_BT601) |
  531. BIT(DRM_COLOR_YCBCR_BT709),
  532. BIT(DRM_COLOR_YCBCR_LIMITED_RANGE),
  533. DEFAULT_ENCODING,
  534. DRM_COLOR_YCBCR_LIMITED_RANGE);
  535. return ret;
  536. }