armada_overlay.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597
  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_uapi.h>
  12. #include <drm/drm_atomic_helper.h>
  13. #include <drm/drm_plane_helper.h>
  14. #include <drm/armada_drm.h>
  15. #include "armada_crtc.h"
  16. #include "armada_drm.h"
  17. #include "armada_fb.h"
  18. #include "armada_gem.h"
  19. #include "armada_hw.h"
  20. #include "armada_ioctlP.h"
  21. #include "armada_plane.h"
  22. #include "armada_trace.h"
  23. #define DEFAULT_BRIGHTNESS 0
  24. #define DEFAULT_CONTRAST 0x4000
  25. #define DEFAULT_SATURATION 0x4000
  26. #define DEFAULT_ENCODING DRM_COLOR_YCBCR_BT601
  27. struct armada_overlay_state {
  28. struct drm_plane_state base;
  29. u32 colorkey_yr;
  30. u32 colorkey_ug;
  31. u32 colorkey_vb;
  32. u32 colorkey_mode;
  33. u32 colorkey_enable;
  34. s16 brightness;
  35. u16 contrast;
  36. u16 saturation;
  37. };
  38. #define drm_to_overlay_state(s) \
  39. container_of(s, struct armada_overlay_state, base)
  40. static inline u32 armada_spu_contrast(struct drm_plane_state *state)
  41. {
  42. return drm_to_overlay_state(state)->brightness << 16 |
  43. drm_to_overlay_state(state)->contrast;
  44. }
  45. static inline u32 armada_spu_saturation(struct drm_plane_state *state)
  46. {
  47. /* Docs say 15:0, but it seems to actually be 31:16 on Armada 510 */
  48. return drm_to_overlay_state(state)->saturation << 16;
  49. }
  50. static inline u32 armada_csc(struct drm_plane_state *state)
  51. {
  52. /*
  53. * The CFG_CSC_RGB_* settings control the output of the colour space
  54. * converter, setting the range of output values it produces. Since
  55. * we will be blending with the full-range graphics, we need to
  56. * produce full-range RGB output from the conversion.
  57. */
  58. return CFG_CSC_RGB_COMPUTER |
  59. (state->color_encoding == DRM_COLOR_YCBCR_BT709 ?
  60. CFG_CSC_YUV_CCIR709 : CFG_CSC_YUV_CCIR601);
  61. }
  62. /* === Plane support === */
  63. static void armada_drm_overlay_plane_atomic_update(struct drm_plane *plane,
  64. struct drm_plane_state *old_state)
  65. {
  66. struct drm_plane_state *state = plane->state;
  67. struct armada_crtc *dcrtc;
  68. struct armada_regs *regs;
  69. unsigned int idx;
  70. u32 cfg, cfg_mask, val;
  71. DRM_DEBUG_KMS("[PLANE:%d:%s]\n", plane->base.id, plane->name);
  72. if (!state->fb || WARN_ON(!state->crtc))
  73. return;
  74. DRM_DEBUG_KMS("[PLANE:%d:%s] is on [CRTC:%d:%s] with [FB:%d] visible %u->%u\n",
  75. plane->base.id, plane->name,
  76. state->crtc->base.id, state->crtc->name,
  77. state->fb->base.id,
  78. old_state->visible, state->visible);
  79. dcrtc = drm_to_armada_crtc(state->crtc);
  80. regs = dcrtc->regs + dcrtc->regs_idx;
  81. idx = 0;
  82. if (!old_state->visible && state->visible)
  83. armada_reg_queue_mod(regs, idx,
  84. 0, CFG_PDWN16x66 | CFG_PDWN32x66,
  85. LCD_SPU_SRAM_PARA1);
  86. val = armada_rect_hw_fp(&state->src);
  87. if (armada_rect_hw_fp(&old_state->src) != val)
  88. armada_reg_queue_set(regs, idx, val, LCD_SPU_DMA_HPXL_VLN);
  89. val = armada_rect_yx(&state->dst);
  90. if (armada_rect_yx(&old_state->dst) != val)
  91. armada_reg_queue_set(regs, idx, val, LCD_SPU_DMA_OVSA_HPXL_VLN);
  92. val = armada_rect_hw(&state->dst);
  93. if (armada_rect_hw(&old_state->dst) != val)
  94. armada_reg_queue_set(regs, idx, val, LCD_SPU_DZM_HPXL_VLN);
  95. /* FIXME: overlay on an interlaced display */
  96. if (old_state->src.x1 != state->src.x1 ||
  97. old_state->src.y1 != state->src.y1 ||
  98. old_state->fb != state->fb) {
  99. const struct drm_format_info *format;
  100. u16 src_x, pitches[3];
  101. u32 addrs[2][3];
  102. armada_drm_plane_calc(state, addrs, pitches, false);
  103. armada_reg_queue_set(regs, idx, addrs[0][0],
  104. LCD_SPU_DMA_START_ADDR_Y0);
  105. armada_reg_queue_set(regs, idx, addrs[0][1],
  106. LCD_SPU_DMA_START_ADDR_U0);
  107. armada_reg_queue_set(regs, idx, addrs[0][2],
  108. LCD_SPU_DMA_START_ADDR_V0);
  109. armada_reg_queue_set(regs, idx, addrs[1][0],
  110. LCD_SPU_DMA_START_ADDR_Y1);
  111. armada_reg_queue_set(regs, idx, addrs[1][1],
  112. LCD_SPU_DMA_START_ADDR_U1);
  113. armada_reg_queue_set(regs, idx, addrs[1][2],
  114. LCD_SPU_DMA_START_ADDR_V1);
  115. val = pitches[0] << 16 | pitches[0];
  116. armada_reg_queue_set(regs, idx, val, LCD_SPU_DMA_PITCH_YC);
  117. val = pitches[1] << 16 | pitches[2];
  118. armada_reg_queue_set(regs, idx, val, LCD_SPU_DMA_PITCH_UV);
  119. cfg = CFG_DMA_FMT(drm_fb_to_armada_fb(state->fb)->fmt) |
  120. CFG_DMA_MOD(drm_fb_to_armada_fb(state->fb)->mod) |
  121. CFG_CBSH_ENA;
  122. if (state->visible)
  123. cfg |= CFG_DMA_ENA;
  124. /*
  125. * Shifting a YUV packed format image by one pixel causes the
  126. * U/V planes to swap. Compensate for it by also toggling
  127. * the UV swap.
  128. */
  129. format = state->fb->format;
  130. src_x = state->src.x1 >> 16;
  131. if (format->num_planes == 1 && src_x & (format->hsub - 1))
  132. cfg ^= CFG_DMA_MOD(CFG_SWAPUV);
  133. cfg_mask = CFG_CBSH_ENA | CFG_DMAFORMAT |
  134. CFG_DMA_MOD(CFG_SWAPRB | CFG_SWAPUV |
  135. CFG_SWAPYU | CFG_YUV2RGB) |
  136. CFG_DMA_FTOGGLE | CFG_DMA_TSTMODE |
  137. CFG_DMA_ENA;
  138. } else if (old_state->visible != state->visible) {
  139. cfg = state->visible ? CFG_DMA_ENA : 0;
  140. cfg_mask = CFG_DMA_ENA;
  141. } else {
  142. cfg = cfg_mask = 0;
  143. }
  144. if (drm_rect_width(&old_state->src) != drm_rect_width(&state->src) ||
  145. drm_rect_width(&old_state->dst) != drm_rect_width(&state->dst)) {
  146. cfg_mask |= CFG_DMA_HSMOOTH;
  147. if (drm_rect_width(&state->src) >> 16 !=
  148. drm_rect_width(&state->dst))
  149. cfg |= CFG_DMA_HSMOOTH;
  150. }
  151. if (cfg_mask)
  152. armada_reg_queue_mod(regs, idx, cfg, cfg_mask,
  153. LCD_SPU_DMA_CTRL0);
  154. val = armada_spu_contrast(state);
  155. if ((!old_state->visible && state->visible) ||
  156. armada_spu_contrast(old_state) != val)
  157. armada_reg_queue_set(regs, idx, val, LCD_SPU_CONTRAST);
  158. val = armada_spu_saturation(state);
  159. if ((!old_state->visible && state->visible) ||
  160. armada_spu_saturation(old_state) != val)
  161. armada_reg_queue_set(regs, idx, val, LCD_SPU_SATURATION);
  162. if (!old_state->visible && state->visible)
  163. armada_reg_queue_set(regs, idx, 0x00002000, LCD_SPU_CBSH_HUE);
  164. val = armada_csc(state);
  165. if ((!old_state->visible && state->visible) ||
  166. armada_csc(old_state) != val)
  167. armada_reg_queue_mod(regs, idx, val, CFG_CSC_MASK,
  168. LCD_SPU_IOPAD_CONTROL);
  169. val = drm_to_overlay_state(state)->colorkey_yr;
  170. if ((!old_state->visible && state->visible) ||
  171. drm_to_overlay_state(old_state)->colorkey_yr != val)
  172. armada_reg_queue_set(regs, idx, val, LCD_SPU_COLORKEY_Y);
  173. val = drm_to_overlay_state(state)->colorkey_ug;
  174. if ((!old_state->visible && state->visible) ||
  175. drm_to_overlay_state(old_state)->colorkey_ug != val)
  176. armada_reg_queue_set(regs, idx, val, LCD_SPU_COLORKEY_U);
  177. val = drm_to_overlay_state(state)->colorkey_vb;
  178. if ((!old_state->visible && state->visible) ||
  179. drm_to_overlay_state(old_state)->colorkey_vb != val)
  180. armada_reg_queue_set(regs, idx, val, LCD_SPU_COLORKEY_V);
  181. val = drm_to_overlay_state(state)->colorkey_mode;
  182. if ((!old_state->visible && state->visible) ||
  183. drm_to_overlay_state(old_state)->colorkey_mode != val)
  184. armada_reg_queue_mod(regs, idx, val, CFG_CKMODE_MASK |
  185. CFG_ALPHAM_MASK | CFG_ALPHA_MASK,
  186. LCD_SPU_DMA_CTRL1);
  187. val = drm_to_overlay_state(state)->colorkey_enable;
  188. if (((!old_state->visible && state->visible) ||
  189. drm_to_overlay_state(old_state)->colorkey_enable != val) &&
  190. dcrtc->variant->has_spu_adv_reg)
  191. armada_reg_queue_mod(regs, idx, val, ADV_GRACOLORKEY |
  192. ADV_VIDCOLORKEY, LCD_SPU_ADV_REG);
  193. dcrtc->regs_idx += idx;
  194. }
  195. static void armada_drm_overlay_plane_atomic_disable(struct drm_plane *plane,
  196. struct drm_plane_state *old_state)
  197. {
  198. struct armada_crtc *dcrtc;
  199. struct armada_regs *regs;
  200. unsigned int idx = 0;
  201. DRM_DEBUG_KMS("[PLANE:%d:%s]\n", plane->base.id, plane->name);
  202. if (!old_state->crtc)
  203. return;
  204. DRM_DEBUG_KMS("[PLANE:%d:%s] was on [CRTC:%d:%s] with [FB:%d]\n",
  205. plane->base.id, plane->name,
  206. old_state->crtc->base.id, old_state->crtc->name,
  207. old_state->fb->base.id);
  208. dcrtc = drm_to_armada_crtc(old_state->crtc);
  209. regs = dcrtc->regs + dcrtc->regs_idx;
  210. /* Disable plane and power down the YUV FIFOs */
  211. armada_reg_queue_mod(regs, idx, 0, CFG_DMA_ENA, LCD_SPU_DMA_CTRL0);
  212. armada_reg_queue_mod(regs, idx, CFG_PDWN16x66 | CFG_PDWN32x66, 0,
  213. LCD_SPU_SRAM_PARA1);
  214. dcrtc->regs_idx += idx;
  215. }
  216. static const struct drm_plane_helper_funcs armada_overlay_plane_helper_funcs = {
  217. .prepare_fb = armada_drm_plane_prepare_fb,
  218. .cleanup_fb = armada_drm_plane_cleanup_fb,
  219. .atomic_check = armada_drm_plane_atomic_check,
  220. .atomic_update = armada_drm_overlay_plane_atomic_update,
  221. .atomic_disable = armada_drm_overlay_plane_atomic_disable,
  222. };
  223. static int
  224. armada_overlay_plane_update(struct drm_plane *plane, struct drm_crtc *crtc,
  225. struct drm_framebuffer *fb,
  226. int crtc_x, int crtc_y, unsigned crtc_w, unsigned crtc_h,
  227. uint32_t src_x, uint32_t src_y, uint32_t src_w, uint32_t src_h,
  228. struct drm_modeset_acquire_ctx *ctx)
  229. {
  230. struct drm_atomic_state *state;
  231. struct drm_plane_state *plane_state;
  232. int ret = 0;
  233. trace_armada_ovl_plane_update(plane, crtc, fb,
  234. crtc_x, crtc_y, crtc_w, crtc_h,
  235. src_x, src_y, src_w, src_h);
  236. state = drm_atomic_state_alloc(plane->dev);
  237. if (!state)
  238. return -ENOMEM;
  239. state->acquire_ctx = ctx;
  240. plane_state = drm_atomic_get_plane_state(state, plane);
  241. if (IS_ERR(plane_state)) {
  242. ret = PTR_ERR(plane_state);
  243. goto fail;
  244. }
  245. ret = drm_atomic_set_crtc_for_plane(plane_state, crtc);
  246. if (ret != 0)
  247. goto fail;
  248. drm_atomic_set_fb_for_plane(plane_state, fb);
  249. plane_state->crtc_x = crtc_x;
  250. plane_state->crtc_y = crtc_y;
  251. plane_state->crtc_h = crtc_h;
  252. plane_state->crtc_w = crtc_w;
  253. plane_state->src_x = src_x;
  254. plane_state->src_y = src_y;
  255. plane_state->src_h = src_h;
  256. plane_state->src_w = src_w;
  257. ret = drm_atomic_nonblocking_commit(state);
  258. fail:
  259. drm_atomic_state_put(state);
  260. return ret;
  261. }
  262. static void armada_ovl_plane_destroy(struct drm_plane *plane)
  263. {
  264. drm_plane_cleanup(plane);
  265. kfree(plane);
  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. state = kzalloc(sizeof(*state), GFP_KERNEL);
  274. if (state) {
  275. state->base.plane = plane;
  276. state->base.color_encoding = DEFAULT_ENCODING;
  277. state->base.color_range = DRM_COLOR_YCBCR_LIMITED_RANGE;
  278. state->base.rotation = DRM_MODE_ROTATE_0;
  279. state->colorkey_yr = 0xfefefe00;
  280. state->colorkey_ug = 0x01010100;
  281. state->colorkey_vb = 0x01010100;
  282. state->colorkey_mode = CFG_CKMODE(CKMODE_RGB) |
  283. CFG_ALPHAM_GRA | CFG_ALPHA(0);
  284. state->colorkey_enable = ADV_GRACOLORKEY;
  285. state->brightness = DEFAULT_BRIGHTNESS;
  286. state->contrast = DEFAULT_CONTRAST;
  287. state->saturation = DEFAULT_SATURATION;
  288. }
  289. plane->state = &state->base;
  290. }
  291. struct drm_plane_state *
  292. armada_overlay_duplicate_state(struct drm_plane *plane)
  293. {
  294. struct armada_overlay_state *state;
  295. if (WARN_ON(!plane->state))
  296. return NULL;
  297. state = kmemdup(plane->state, sizeof(*state), GFP_KERNEL);
  298. if (state)
  299. __drm_atomic_helper_plane_duplicate_state(plane, &state->base);
  300. return &state->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 = plane->dev->dev_private;
  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 = plane->dev->dev_private;
  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 = (drm_to_overlay_state(state)->colorkey_mode &
  406. CFG_CKMODE_MASK) >> ffs(CFG_CKMODE_MASK);
  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 = armada_ovl_plane_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 = dev->dev_private;
  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 = dev->dev_private;
  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(sizeof(*overlay), GFP_KERNEL);
  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. }