armada_overlay.c 20 KB

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