armada_overlay.c 20 KB

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