196f60e37SRussell King /* 296f60e37SRussell King * Copyright (C) 2012 Russell King 396f60e37SRussell King * Rewritten from the dovefb driver, and Armada510 manuals. 496f60e37SRussell King * 596f60e37SRussell King * This program is free software; you can redistribute it and/or modify 696f60e37SRussell King * it under the terms of the GNU General Public License version 2 as 796f60e37SRussell King * published by the Free Software Foundation. 896f60e37SRussell King */ 996f60e37SRussell King #include <drm/drmP.h> 1047dc413bSRussell King #include <drm/drm_atomic.h> 1172fdb40cSDaniel Vetter #include <drm/drm_atomic_uapi.h> 12bcd21a47SDave Airlie #include <drm/drm_atomic_helper.h> 1347dc413bSRussell King #include <drm/drm_plane_helper.h> 14d40af7b1SRussell King #include <drm/armada_drm.h> 1596f60e37SRussell King #include "armada_crtc.h" 1696f60e37SRussell King #include "armada_drm.h" 1796f60e37SRussell King #include "armada_fb.h" 1896f60e37SRussell King #include "armada_gem.h" 1996f60e37SRussell King #include "armada_hw.h" 2096f60e37SRussell King #include "armada_ioctlP.h" 21d40af7b1SRussell King #include "armada_plane.h" 22c8a220c6SRussell King #include "armada_trace.h" 2396f60e37SRussell King 2461ba2527SRussell King #define DEFAULT_BRIGHTNESS 0 2561ba2527SRussell King #define DEFAULT_CONTRAST 0x4000 2661ba2527SRussell King #define DEFAULT_SATURATION 0x4000 27c29277d4SRussell King #define DEFAULT_ENCODING DRM_COLOR_YCBCR_BT601 2861ba2527SRussell King 2961ba2527SRussell King struct armada_overlay_state { 301d1547ecSRussell King struct armada_plane_state base; 31c96103b6SRussell King u32 colorkey_yr; 32c96103b6SRussell King u32 colorkey_ug; 33c96103b6SRussell King u32 colorkey_vb; 34c96103b6SRussell King u32 colorkey_mode; 35c96103b6SRussell King u32 colorkey_enable; 3661ba2527SRussell King s16 brightness; 3761ba2527SRussell King u16 contrast; 3861ba2527SRussell King u16 saturation; 3961ba2527SRussell King }; 4061ba2527SRussell King #define drm_to_overlay_state(s) \ 411d1547ecSRussell King container_of(s, struct armada_overlay_state, base.base) 4261ba2527SRussell King 4361ba2527SRussell King static inline u32 armada_spu_contrast(struct drm_plane_state *state) 4461ba2527SRussell King { 4561ba2527SRussell King return drm_to_overlay_state(state)->brightness << 16 | 4661ba2527SRussell King drm_to_overlay_state(state)->contrast; 4761ba2527SRussell King } 4861ba2527SRussell King 4961ba2527SRussell King static inline u32 armada_spu_saturation(struct drm_plane_state *state) 5061ba2527SRussell King { 5161ba2527SRussell King /* Docs say 15:0, but it seems to actually be 31:16 on Armada 510 */ 5261ba2527SRussell King return drm_to_overlay_state(state)->saturation << 16; 5361ba2527SRussell King } 5496f60e37SRussell King 55c29277d4SRussell King static inline u32 armada_csc(struct drm_plane_state *state) 56c29277d4SRussell King { 57c29277d4SRussell King /* 58c29277d4SRussell King * The CFG_CSC_RGB_* settings control the output of the colour space 59c29277d4SRussell King * converter, setting the range of output values it produces. Since 60c29277d4SRussell King * we will be blending with the full-range graphics, we need to 61c29277d4SRussell King * produce full-range RGB output from the conversion. 62c29277d4SRussell King */ 63c29277d4SRussell King return CFG_CSC_RGB_COMPUTER | 64c29277d4SRussell King (state->color_encoding == DRM_COLOR_YCBCR_BT709 ? 65c29277d4SRussell King CFG_CSC_YUV_CCIR709 : CFG_CSC_YUV_CCIR601); 66c29277d4SRussell King } 67c29277d4SRussell King 6896f60e37SRussell King /* === Plane support === */ 6947dc413bSRussell King static void armada_drm_overlay_plane_atomic_update(struct drm_plane *plane, 7047dc413bSRussell King struct drm_plane_state *old_state) 7147dc413bSRussell King { 7247dc413bSRussell King struct drm_plane_state *state = plane->state; 7347dc413bSRussell King struct armada_crtc *dcrtc; 7447dc413bSRussell King struct armada_regs *regs; 753acea7b9SRussell King unsigned int idx; 763acea7b9SRussell King u32 cfg, cfg_mask, val; 7747dc413bSRussell King 7847dc413bSRussell King DRM_DEBUG_KMS("[PLANE:%d:%s]\n", plane->base.id, plane->name); 7947dc413bSRussell King 8047dc413bSRussell King if (!state->fb || WARN_ON(!state->crtc)) 8147dc413bSRussell King return; 8247dc413bSRussell King 8347dc413bSRussell King DRM_DEBUG_KMS("[PLANE:%d:%s] is on [CRTC:%d:%s] with [FB:%d] visible %u->%u\n", 8447dc413bSRussell King plane->base.id, plane->name, 8547dc413bSRussell King state->crtc->base.id, state->crtc->name, 8647dc413bSRussell King state->fb->base.id, 8747dc413bSRussell King old_state->visible, state->visible); 8847dc413bSRussell King 8947dc413bSRussell King dcrtc = drm_to_armada_crtc(state->crtc); 9047dc413bSRussell King regs = dcrtc->regs + dcrtc->regs_idx; 9147dc413bSRussell King 923acea7b9SRussell King idx = 0; 933acea7b9SRussell King if (!old_state->visible && state->visible) 943acea7b9SRussell King armada_reg_queue_mod(regs, idx, 953acea7b9SRussell King 0, CFG_PDWN16x66 | CFG_PDWN32x66, 963acea7b9SRussell King LCD_SPU_SRAM_PARA1); 979184ae8dSRussell King val = armada_src_hw(state); 989184ae8dSRussell King if (armada_src_hw(old_state) != val) 993acea7b9SRussell King armada_reg_queue_set(regs, idx, val, LCD_SPU_DMA_HPXL_VLN); 1009184ae8dSRussell King val = armada_dst_yx(state); 1019184ae8dSRussell King if (armada_dst_yx(old_state) != val) 1023acea7b9SRussell King armada_reg_queue_set(regs, idx, val, LCD_SPU_DMA_OVSA_HPXL_VLN); 1039184ae8dSRussell King val = armada_dst_hw(state); 1049184ae8dSRussell King if (armada_dst_hw(old_state) != val) 1053acea7b9SRussell King armada_reg_queue_set(regs, idx, val, LCD_SPU_DZM_HPXL_VLN); 1063acea7b9SRussell King /* FIXME: overlay on an interlaced display */ 1073acea7b9SRussell King if (old_state->src.x1 != state->src.x1 || 1083acea7b9SRussell King old_state->src.y1 != state->src.y1 || 10989e0c53cSRussell King old_state->fb != state->fb || 11089e0c53cSRussell King state->crtc->state->mode_changed) { 1113acea7b9SRussell King const struct drm_format_info *format; 1124aafe00eSRussell King u16 src_x, pitches[3]; 113b5bae71aSRussell King u32 addrs[2][3]; 1143acea7b9SRussell King 11589e0c53cSRussell King armada_drm_plane_calc(state, addrs, pitches, dcrtc->interlaced); 1163acea7b9SRussell King 117b5bae71aSRussell King armada_reg_queue_set(regs, idx, addrs[0][0], 1183acea7b9SRussell King LCD_SPU_DMA_START_ADDR_Y0); 119b5bae71aSRussell King armada_reg_queue_set(regs, idx, addrs[0][1], 1203acea7b9SRussell King LCD_SPU_DMA_START_ADDR_U0); 121b5bae71aSRussell King armada_reg_queue_set(regs, idx, addrs[0][2], 1223acea7b9SRussell King LCD_SPU_DMA_START_ADDR_V0); 123b5bae71aSRussell King armada_reg_queue_set(regs, idx, addrs[1][0], 1243acea7b9SRussell King LCD_SPU_DMA_START_ADDR_Y1); 125b5bae71aSRussell King armada_reg_queue_set(regs, idx, addrs[1][1], 1263acea7b9SRussell King LCD_SPU_DMA_START_ADDR_U1); 127b5bae71aSRussell King armada_reg_queue_set(regs, idx, addrs[1][2], 1283acea7b9SRussell King LCD_SPU_DMA_START_ADDR_V1); 1293acea7b9SRussell King 1304aafe00eSRussell King val = pitches[0] << 16 | pitches[0]; 1313acea7b9SRussell King armada_reg_queue_set(regs, idx, val, LCD_SPU_DMA_PITCH_YC); 1324aafe00eSRussell King val = pitches[1] << 16 | pitches[2]; 1333acea7b9SRussell King armada_reg_queue_set(regs, idx, val, LCD_SPU_DMA_PITCH_UV); 1343acea7b9SRussell King 1353acea7b9SRussell King cfg = CFG_DMA_FMT(drm_fb_to_armada_fb(state->fb)->fmt) | 1363acea7b9SRussell King CFG_DMA_MOD(drm_fb_to_armada_fb(state->fb)->mod) | 1373acea7b9SRussell King CFG_CBSH_ENA; 1383acea7b9SRussell King if (state->visible) 1393acea7b9SRussell King cfg |= CFG_DMA_ENA; 1403acea7b9SRussell King 1413acea7b9SRussell King /* 1423acea7b9SRussell King * Shifting a YUV packed format image by one pixel causes the 1433acea7b9SRussell King * U/V planes to swap. Compensate for it by also toggling 1443acea7b9SRussell King * the UV swap. 1453acea7b9SRussell King */ 1463acea7b9SRussell King format = state->fb->format; 147b4df3ba0SRussell King src_x = state->src.x1 >> 16; 1483acea7b9SRussell King if (format->num_planes == 1 && src_x & (format->hsub - 1)) 1493acea7b9SRussell King cfg ^= CFG_DMA_MOD(CFG_SWAPUV); 15089e0c53cSRussell King if (dcrtc->interlaced) 15189e0c53cSRussell King cfg |= CFG_DMA_FTOGGLE; 1523acea7b9SRussell King cfg_mask = CFG_CBSH_ENA | CFG_DMAFORMAT | 1533acea7b9SRussell King CFG_DMA_MOD(CFG_SWAPRB | CFG_SWAPUV | 1543acea7b9SRussell King CFG_SWAPYU | CFG_YUV2RGB) | 1553acea7b9SRussell King CFG_DMA_FTOGGLE | CFG_DMA_TSTMODE | 1563acea7b9SRussell King CFG_DMA_ENA; 1573acea7b9SRussell King } else if (old_state->visible != state->visible) { 1583acea7b9SRussell King cfg = state->visible ? CFG_DMA_ENA : 0; 1593acea7b9SRussell King cfg_mask = CFG_DMA_ENA; 1603acea7b9SRussell King } else { 1613acea7b9SRussell King cfg = cfg_mask = 0; 1623acea7b9SRussell King } 1633acea7b9SRussell King if (drm_rect_width(&old_state->src) != drm_rect_width(&state->src) || 1643acea7b9SRussell King drm_rect_width(&old_state->dst) != drm_rect_width(&state->dst)) { 1653acea7b9SRussell King cfg_mask |= CFG_DMA_HSMOOTH; 1663acea7b9SRussell King if (drm_rect_width(&state->src) >> 16 != 1673acea7b9SRussell King drm_rect_width(&state->dst)) 1683acea7b9SRussell King cfg |= CFG_DMA_HSMOOTH; 1693acea7b9SRussell King } 1703acea7b9SRussell King 1713acea7b9SRussell King if (cfg_mask) 1723acea7b9SRussell King armada_reg_queue_mod(regs, idx, cfg, cfg_mask, 1733acea7b9SRussell King LCD_SPU_DMA_CTRL0); 1743acea7b9SRussell King 17561ba2527SRussell King val = armada_spu_contrast(state); 17661ba2527SRussell King if ((!old_state->visible && state->visible) || 17761ba2527SRussell King armada_spu_contrast(old_state) != val) 17861ba2527SRussell King armada_reg_queue_set(regs, idx, val, LCD_SPU_CONTRAST); 17961ba2527SRussell King val = armada_spu_saturation(state); 18061ba2527SRussell King if ((!old_state->visible && state->visible) || 18161ba2527SRussell King armada_spu_saturation(old_state) != val) 18261ba2527SRussell King armada_reg_queue_set(regs, idx, val, LCD_SPU_SATURATION); 18361ba2527SRussell King if (!old_state->visible && state->visible) 18461ba2527SRussell King armada_reg_queue_set(regs, idx, 0x00002000, LCD_SPU_CBSH_HUE); 185c29277d4SRussell King val = armada_csc(state); 186c29277d4SRussell King if ((!old_state->visible && state->visible) || 187c29277d4SRussell King armada_csc(old_state) != val) 188c29277d4SRussell King armada_reg_queue_mod(regs, idx, val, CFG_CSC_MASK, 189c29277d4SRussell King LCD_SPU_IOPAD_CONTROL); 190c96103b6SRussell King val = drm_to_overlay_state(state)->colorkey_yr; 191c96103b6SRussell King if ((!old_state->visible && state->visible) || 192c96103b6SRussell King drm_to_overlay_state(old_state)->colorkey_yr != val) 193c96103b6SRussell King armada_reg_queue_set(regs, idx, val, LCD_SPU_COLORKEY_Y); 194c96103b6SRussell King val = drm_to_overlay_state(state)->colorkey_ug; 195c96103b6SRussell King if ((!old_state->visible && state->visible) || 196c96103b6SRussell King drm_to_overlay_state(old_state)->colorkey_ug != val) 197c96103b6SRussell King armada_reg_queue_set(regs, idx, val, LCD_SPU_COLORKEY_U); 198c96103b6SRussell King val = drm_to_overlay_state(state)->colorkey_vb; 199c96103b6SRussell King if ((!old_state->visible && state->visible) || 200c96103b6SRussell King drm_to_overlay_state(old_state)->colorkey_vb != val) 201c96103b6SRussell King armada_reg_queue_set(regs, idx, val, LCD_SPU_COLORKEY_V); 202c96103b6SRussell King val = drm_to_overlay_state(state)->colorkey_mode; 203c96103b6SRussell King if ((!old_state->visible && state->visible) || 204c96103b6SRussell King drm_to_overlay_state(old_state)->colorkey_mode != val) 205c96103b6SRussell King armada_reg_queue_mod(regs, idx, val, CFG_CKMODE_MASK | 206c96103b6SRussell King CFG_ALPHAM_MASK | CFG_ALPHA_MASK, 207c96103b6SRussell King LCD_SPU_DMA_CTRL1); 208c96103b6SRussell King val = drm_to_overlay_state(state)->colorkey_enable; 209c96103b6SRussell King if (((!old_state->visible && state->visible) || 210c96103b6SRussell King drm_to_overlay_state(old_state)->colorkey_enable != val) && 211c96103b6SRussell King dcrtc->variant->has_spu_adv_reg) 212c96103b6SRussell King armada_reg_queue_mod(regs, idx, val, ADV_GRACOLORKEY | 213c96103b6SRussell King ADV_VIDCOLORKEY, LCD_SPU_ADV_REG); 21461ba2527SRussell King 2153acea7b9SRussell King dcrtc->regs_idx += idx; 21647dc413bSRussell King } 21747dc413bSRussell King 21847dc413bSRussell King static void armada_drm_overlay_plane_atomic_disable(struct drm_plane *plane, 21947dc413bSRussell King struct drm_plane_state *old_state) 22047dc413bSRussell King { 22147dc413bSRussell King struct armada_crtc *dcrtc; 22247dc413bSRussell King struct armada_regs *regs; 22347dc413bSRussell King unsigned int idx = 0; 22447dc413bSRussell King 22547dc413bSRussell King DRM_DEBUG_KMS("[PLANE:%d:%s]\n", plane->base.id, plane->name); 22647dc413bSRussell King 22747dc413bSRussell King if (!old_state->crtc) 22847dc413bSRussell King return; 22947dc413bSRussell King 23047dc413bSRussell King DRM_DEBUG_KMS("[PLANE:%d:%s] was on [CRTC:%d:%s] with [FB:%d]\n", 23147dc413bSRussell King plane->base.id, plane->name, 23247dc413bSRussell King old_state->crtc->base.id, old_state->crtc->name, 23347dc413bSRussell King old_state->fb->base.id); 23447dc413bSRussell King 23547dc413bSRussell King dcrtc = drm_to_armada_crtc(old_state->crtc); 23647dc413bSRussell King regs = dcrtc->regs + dcrtc->regs_idx; 23747dc413bSRussell King 23847dc413bSRussell King /* Disable plane and power down the YUV FIFOs */ 23947dc413bSRussell King armada_reg_queue_mod(regs, idx, 0, CFG_DMA_ENA, LCD_SPU_DMA_CTRL0); 24047dc413bSRussell King armada_reg_queue_mod(regs, idx, CFG_PDWN16x66 | CFG_PDWN32x66, 0, 24147dc413bSRussell King LCD_SPU_SRAM_PARA1); 24247dc413bSRussell King 24347dc413bSRussell King dcrtc->regs_idx += idx; 24447dc413bSRussell King } 24547dc413bSRussell King 24647dc413bSRussell King static const struct drm_plane_helper_funcs armada_overlay_plane_helper_funcs = { 24747dc413bSRussell King .prepare_fb = armada_drm_plane_prepare_fb, 24847dc413bSRussell King .cleanup_fb = armada_drm_plane_cleanup_fb, 24947dc413bSRussell King .atomic_check = armada_drm_plane_atomic_check, 25047dc413bSRussell King .atomic_update = armada_drm_overlay_plane_atomic_update, 25147dc413bSRussell King .atomic_disable = armada_drm_overlay_plane_atomic_disable, 25247dc413bSRussell King }; 25347dc413bSRussell King 25447dc413bSRussell King static int 255b1ec9ed6SRussell King armada_overlay_plane_update(struct drm_plane *plane, struct drm_crtc *crtc, 25647dc413bSRussell King struct drm_framebuffer *fb, 25747dc413bSRussell King int crtc_x, int crtc_y, unsigned crtc_w, unsigned crtc_h, 25847dc413bSRussell King uint32_t src_x, uint32_t src_y, uint32_t src_w, uint32_t src_h, 25947dc413bSRussell King struct drm_modeset_acquire_ctx *ctx) 26047dc413bSRussell King { 261b1ec9ed6SRussell King struct drm_atomic_state *state; 262b1ec9ed6SRussell King struct drm_plane_state *plane_state; 263b1ec9ed6SRussell King int ret = 0; 26447dc413bSRussell King 26547dc413bSRussell King trace_armada_ovl_plane_update(plane, crtc, fb, 26647dc413bSRussell King crtc_x, crtc_y, crtc_w, crtc_h, 26747dc413bSRussell King src_x, src_y, src_w, src_h); 26847dc413bSRussell King 269b1ec9ed6SRussell King state = drm_atomic_state_alloc(plane->dev); 27047dc413bSRussell King if (!state) 27147dc413bSRussell King return -ENOMEM; 27247dc413bSRussell King 273b1ec9ed6SRussell King state->acquire_ctx = ctx; 274b1ec9ed6SRussell King plane_state = drm_atomic_get_plane_state(state, plane); 275b1ec9ed6SRussell King if (IS_ERR(plane_state)) { 276b1ec9ed6SRussell King ret = PTR_ERR(plane_state); 277b1ec9ed6SRussell King goto fail; 278b1ec9ed6SRussell King } 27947dc413bSRussell King 280b1ec9ed6SRussell King ret = drm_atomic_set_crtc_for_plane(plane_state, crtc); 281b1ec9ed6SRussell King if (ret != 0) 282b1ec9ed6SRussell King goto fail; 283b1ec9ed6SRussell King 284b1ec9ed6SRussell King drm_atomic_set_fb_for_plane(plane_state, fb); 285b1ec9ed6SRussell King plane_state->crtc_x = crtc_x; 286b1ec9ed6SRussell King plane_state->crtc_y = crtc_y; 287b1ec9ed6SRussell King plane_state->crtc_h = crtc_h; 288b1ec9ed6SRussell King plane_state->crtc_w = crtc_w; 289b1ec9ed6SRussell King plane_state->src_x = src_x; 290b1ec9ed6SRussell King plane_state->src_y = src_y; 291b1ec9ed6SRussell King plane_state->src_h = src_h; 292b1ec9ed6SRussell King plane_state->src_w = src_w; 293b1ec9ed6SRussell King 294b1ec9ed6SRussell King ret = drm_atomic_nonblocking_commit(state); 295b1ec9ed6SRussell King fail: 296b1ec9ed6SRussell King drm_atomic_state_put(state); 297b1ec9ed6SRussell King return ret; 29896f60e37SRussell King } 29996f60e37SRussell King 30028a2aebeSRussell King static void armada_ovl_plane_destroy(struct drm_plane *plane) 30196f60e37SRussell King { 30241dbb2dbSRussell King drm_plane_cleanup(plane); 303d701278aSRussell King kfree(plane); 30496f60e37SRussell King } 30596f60e37SRussell King 30661ba2527SRussell King static void armada_overlay_reset(struct drm_plane *plane) 30761ba2527SRussell King { 30861ba2527SRussell King struct armada_overlay_state *state; 30961ba2527SRussell King 31061ba2527SRussell King if (plane->state) 31161ba2527SRussell King __drm_atomic_helper_plane_destroy_state(plane->state); 31261ba2527SRussell King kfree(plane->state); 313ad52f53fSRussell King plane->state = NULL; 31461ba2527SRussell King 31561ba2527SRussell King state = kzalloc(sizeof(*state), GFP_KERNEL); 31661ba2527SRussell King if (state) { 317c96103b6SRussell King state->colorkey_yr = 0xfefefe00; 318c96103b6SRussell King state->colorkey_ug = 0x01010100; 319c96103b6SRussell King state->colorkey_vb = 0x01010100; 320c96103b6SRussell King state->colorkey_mode = CFG_CKMODE(CKMODE_RGB) | 321c96103b6SRussell King CFG_ALPHAM_GRA | CFG_ALPHA(0); 322c96103b6SRussell King state->colorkey_enable = ADV_GRACOLORKEY; 32361ba2527SRussell King state->brightness = DEFAULT_BRIGHTNESS; 32461ba2527SRussell King state->contrast = DEFAULT_CONTRAST; 32561ba2527SRussell King state->saturation = DEFAULT_SATURATION; 3261d1547ecSRussell King __drm_atomic_helper_plane_reset(plane, &state->base.base); 3271d1547ecSRussell King state->base.base.color_encoding = DEFAULT_ENCODING; 3281d1547ecSRussell King state->base.base.color_range = DRM_COLOR_YCBCR_LIMITED_RANGE; 32961ba2527SRussell King } 33061ba2527SRussell King } 33161ba2527SRussell King 33261ba2527SRussell King struct drm_plane_state * 33361ba2527SRussell King armada_overlay_duplicate_state(struct drm_plane *plane) 33461ba2527SRussell King { 33561ba2527SRussell King struct armada_overlay_state *state; 33661ba2527SRussell King 33761ba2527SRussell King if (WARN_ON(!plane->state)) 33861ba2527SRussell King return NULL; 33961ba2527SRussell King 34061ba2527SRussell King state = kmemdup(plane->state, sizeof(*state), GFP_KERNEL); 34161ba2527SRussell King if (state) 3421d1547ecSRussell King __drm_atomic_helper_plane_duplicate_state(plane, 3431d1547ecSRussell King &state->base.base); 3441d1547ecSRussell King return &state->base.base; 34561ba2527SRussell King } 34661ba2527SRussell King 34761ba2527SRussell King static int armada_overlay_set_property(struct drm_plane *plane, 34861ba2527SRussell King struct drm_plane_state *state, struct drm_property *property, 34961ba2527SRussell King uint64_t val) 35061ba2527SRussell King { 35161ba2527SRussell King struct armada_private *priv = plane->dev->dev_private; 35261ba2527SRussell King 353c96103b6SRussell King #define K2R(val) (((val) >> 0) & 0xff) 354c96103b6SRussell King #define K2G(val) (((val) >> 8) & 0xff) 355c96103b6SRussell King #define K2B(val) (((val) >> 16) & 0xff) 356c96103b6SRussell King if (property == priv->colorkey_prop) { 357c96103b6SRussell King #define CCC(v) ((v) << 24 | (v) << 16 | (v) << 8) 358c96103b6SRussell King drm_to_overlay_state(state)->colorkey_yr = CCC(K2R(val)); 359c96103b6SRussell King drm_to_overlay_state(state)->colorkey_ug = CCC(K2G(val)); 360c96103b6SRussell King drm_to_overlay_state(state)->colorkey_vb = CCC(K2B(val)); 361c96103b6SRussell King #undef CCC 362c96103b6SRussell King } else if (property == priv->colorkey_min_prop) { 363c96103b6SRussell King drm_to_overlay_state(state)->colorkey_yr &= ~0x00ff0000; 364c96103b6SRussell King drm_to_overlay_state(state)->colorkey_yr |= K2R(val) << 16; 365c96103b6SRussell King drm_to_overlay_state(state)->colorkey_ug &= ~0x00ff0000; 366c96103b6SRussell King drm_to_overlay_state(state)->colorkey_ug |= K2G(val) << 16; 367c96103b6SRussell King drm_to_overlay_state(state)->colorkey_vb &= ~0x00ff0000; 368c96103b6SRussell King drm_to_overlay_state(state)->colorkey_vb |= K2B(val) << 16; 369c96103b6SRussell King } else if (property == priv->colorkey_max_prop) { 370c96103b6SRussell King drm_to_overlay_state(state)->colorkey_yr &= ~0xff000000; 371c96103b6SRussell King drm_to_overlay_state(state)->colorkey_yr |= K2R(val) << 24; 372c96103b6SRussell King drm_to_overlay_state(state)->colorkey_ug &= ~0xff000000; 373c96103b6SRussell King drm_to_overlay_state(state)->colorkey_ug |= K2G(val) << 24; 374c96103b6SRussell King drm_to_overlay_state(state)->colorkey_vb &= ~0xff000000; 375c96103b6SRussell King drm_to_overlay_state(state)->colorkey_vb |= K2B(val) << 24; 376c96103b6SRussell King } else if (property == priv->colorkey_val_prop) { 377c96103b6SRussell King drm_to_overlay_state(state)->colorkey_yr &= ~0x0000ff00; 378c96103b6SRussell King drm_to_overlay_state(state)->colorkey_yr |= K2R(val) << 8; 379c96103b6SRussell King drm_to_overlay_state(state)->colorkey_ug &= ~0x0000ff00; 380c96103b6SRussell King drm_to_overlay_state(state)->colorkey_ug |= K2G(val) << 8; 381c96103b6SRussell King drm_to_overlay_state(state)->colorkey_vb &= ~0x0000ff00; 382c96103b6SRussell King drm_to_overlay_state(state)->colorkey_vb |= K2B(val) << 8; 383c96103b6SRussell King } else if (property == priv->colorkey_alpha_prop) { 384c96103b6SRussell King drm_to_overlay_state(state)->colorkey_yr &= ~0x000000ff; 385c96103b6SRussell King drm_to_overlay_state(state)->colorkey_yr |= K2R(val); 386c96103b6SRussell King drm_to_overlay_state(state)->colorkey_ug &= ~0x000000ff; 387c96103b6SRussell King drm_to_overlay_state(state)->colorkey_ug |= K2G(val); 388c96103b6SRussell King drm_to_overlay_state(state)->colorkey_vb &= ~0x000000ff; 389c96103b6SRussell King drm_to_overlay_state(state)->colorkey_vb |= K2B(val); 390c96103b6SRussell King } else if (property == priv->colorkey_mode_prop) { 391c96103b6SRussell King if (val == CKMODE_DISABLE) { 392c96103b6SRussell King drm_to_overlay_state(state)->colorkey_mode = 393c96103b6SRussell King CFG_CKMODE(CKMODE_DISABLE) | 394c96103b6SRussell King CFG_ALPHAM_CFG | CFG_ALPHA(255); 395c96103b6SRussell King drm_to_overlay_state(state)->colorkey_enable = 0; 396c96103b6SRussell King } else { 397c96103b6SRussell King drm_to_overlay_state(state)->colorkey_mode = 398c96103b6SRussell King CFG_CKMODE(val) | 399c96103b6SRussell King CFG_ALPHAM_GRA | CFG_ALPHA(0); 400c96103b6SRussell King drm_to_overlay_state(state)->colorkey_enable = 401c96103b6SRussell King ADV_GRACOLORKEY; 402c96103b6SRussell King } 403c96103b6SRussell King } else if (property == priv->brightness_prop) { 40461ba2527SRussell King drm_to_overlay_state(state)->brightness = val - 256; 40561ba2527SRussell King } else if (property == priv->contrast_prop) { 40661ba2527SRussell King drm_to_overlay_state(state)->contrast = val; 40761ba2527SRussell King } else if (property == priv->saturation_prop) { 40861ba2527SRussell King drm_to_overlay_state(state)->saturation = val; 40961ba2527SRussell King } else { 41061ba2527SRussell King return -EINVAL; 41161ba2527SRussell King } 41261ba2527SRussell King return 0; 41361ba2527SRussell King } 41461ba2527SRussell King 41561ba2527SRussell King static int armada_overlay_get_property(struct drm_plane *plane, 41661ba2527SRussell King const struct drm_plane_state *state, struct drm_property *property, 41761ba2527SRussell King uint64_t *val) 41861ba2527SRussell King { 41961ba2527SRussell King struct armada_private *priv = plane->dev->dev_private; 42061ba2527SRussell King 421c96103b6SRussell King #define C2K(c,s) (((c) >> (s)) & 0xff) 422c96103b6SRussell King #define R2BGR(r,g,b,s) (C2K(r,s) << 0 | C2K(g,s) << 8 | C2K(b,s) << 16) 423c96103b6SRussell King if (property == priv->colorkey_prop) { 424c96103b6SRussell King /* Do best-efforts here for this property */ 425c96103b6SRussell King *val = R2BGR(drm_to_overlay_state(state)->colorkey_yr, 426c96103b6SRussell King drm_to_overlay_state(state)->colorkey_ug, 427c96103b6SRussell King drm_to_overlay_state(state)->colorkey_vb, 16); 428c96103b6SRussell King /* If min != max, or min != val, error out */ 429c96103b6SRussell King if (*val != R2BGR(drm_to_overlay_state(state)->colorkey_yr, 430c96103b6SRussell King drm_to_overlay_state(state)->colorkey_ug, 431c96103b6SRussell King drm_to_overlay_state(state)->colorkey_vb, 24) || 432c96103b6SRussell King *val != R2BGR(drm_to_overlay_state(state)->colorkey_yr, 433c96103b6SRussell King drm_to_overlay_state(state)->colorkey_ug, 434c96103b6SRussell King drm_to_overlay_state(state)->colorkey_vb, 8)) 435c96103b6SRussell King return -EINVAL; 436c96103b6SRussell King } else if (property == priv->colorkey_min_prop) { 437c96103b6SRussell King *val = R2BGR(drm_to_overlay_state(state)->colorkey_yr, 438c96103b6SRussell King drm_to_overlay_state(state)->colorkey_ug, 439c96103b6SRussell King drm_to_overlay_state(state)->colorkey_vb, 16); 440c96103b6SRussell King } else if (property == priv->colorkey_max_prop) { 441c96103b6SRussell King *val = R2BGR(drm_to_overlay_state(state)->colorkey_yr, 442c96103b6SRussell King drm_to_overlay_state(state)->colorkey_ug, 443c96103b6SRussell King drm_to_overlay_state(state)->colorkey_vb, 24); 444c96103b6SRussell King } else if (property == priv->colorkey_val_prop) { 445c96103b6SRussell King *val = R2BGR(drm_to_overlay_state(state)->colorkey_yr, 446c96103b6SRussell King drm_to_overlay_state(state)->colorkey_ug, 447c96103b6SRussell King drm_to_overlay_state(state)->colorkey_vb, 8); 448c96103b6SRussell King } else if (property == priv->colorkey_alpha_prop) { 449c96103b6SRussell King *val = R2BGR(drm_to_overlay_state(state)->colorkey_yr, 450c96103b6SRussell King drm_to_overlay_state(state)->colorkey_ug, 451c96103b6SRussell King drm_to_overlay_state(state)->colorkey_vb, 0); 452c96103b6SRussell King } else if (property == priv->colorkey_mode_prop) { 453c96103b6SRussell King *val = (drm_to_overlay_state(state)->colorkey_mode & 454c96103b6SRussell King CFG_CKMODE_MASK) >> ffs(CFG_CKMODE_MASK); 455c96103b6SRussell King } else if (property == priv->brightness_prop) { 45661ba2527SRussell King *val = drm_to_overlay_state(state)->brightness + 256; 45761ba2527SRussell King } else if (property == priv->contrast_prop) { 45861ba2527SRussell King *val = drm_to_overlay_state(state)->contrast; 45961ba2527SRussell King } else if (property == priv->saturation_prop) { 46061ba2527SRussell King *val = drm_to_overlay_state(state)->saturation; 46161ba2527SRussell King } else { 46261ba2527SRussell King return -EINVAL; 46361ba2527SRussell King } 46461ba2527SRussell King return 0; 46561ba2527SRussell King } 46661ba2527SRussell King 46728a2aebeSRussell King static const struct drm_plane_funcs armada_ovl_plane_funcs = { 468b1ec9ed6SRussell King .update_plane = armada_overlay_plane_update, 469b1ec9ed6SRussell King .disable_plane = drm_atomic_helper_disable_plane, 47028a2aebeSRussell King .destroy = armada_ovl_plane_destroy, 47161ba2527SRussell King .reset = armada_overlay_reset, 47261ba2527SRussell King .atomic_duplicate_state = armada_overlay_duplicate_state, 47361ba2527SRussell King .atomic_destroy_state = drm_atomic_helper_plane_destroy_state, 47461ba2527SRussell King .atomic_set_property = armada_overlay_set_property, 47561ba2527SRussell King .atomic_get_property = armada_overlay_get_property, 47696f60e37SRussell King }; 47796f60e37SRussell King 47828a2aebeSRussell King static const uint32_t armada_ovl_formats[] = { 47996f60e37SRussell King DRM_FORMAT_UYVY, 48096f60e37SRussell King DRM_FORMAT_YUYV, 48196f60e37SRussell King DRM_FORMAT_YUV420, 48296f60e37SRussell King DRM_FORMAT_YVU420, 48396f60e37SRussell King DRM_FORMAT_YUV422, 48496f60e37SRussell King DRM_FORMAT_YVU422, 48596f60e37SRussell King DRM_FORMAT_VYUY, 48696f60e37SRussell King DRM_FORMAT_YVYU, 48796f60e37SRussell King DRM_FORMAT_ARGB8888, 48896f60e37SRussell King DRM_FORMAT_ABGR8888, 48996f60e37SRussell King DRM_FORMAT_XRGB8888, 49096f60e37SRussell King DRM_FORMAT_XBGR8888, 49196f60e37SRussell King DRM_FORMAT_RGB888, 49296f60e37SRussell King DRM_FORMAT_BGR888, 49396f60e37SRussell King DRM_FORMAT_ARGB1555, 49496f60e37SRussell King DRM_FORMAT_ABGR1555, 49596f60e37SRussell King DRM_FORMAT_RGB565, 49696f60e37SRussell King DRM_FORMAT_BGR565, 49796f60e37SRussell King }; 49896f60e37SRussell King 4998a63ca58SArvind Yadav static const struct drm_prop_enum_list armada_drm_colorkey_enum_list[] = { 50096f60e37SRussell King { CKMODE_DISABLE, "disabled" }, 50196f60e37SRussell King { CKMODE_Y, "Y component" }, 50296f60e37SRussell King { CKMODE_U, "U component" }, 50396f60e37SRussell King { CKMODE_V, "V component" }, 50496f60e37SRussell King { CKMODE_RGB, "RGB" }, 50596f60e37SRussell King { CKMODE_R, "R component" }, 50696f60e37SRussell King { CKMODE_G, "G component" }, 50796f60e37SRussell King { CKMODE_B, "B component" }, 50896f60e37SRussell King }; 50996f60e37SRussell King 51096f60e37SRussell King static int armada_overlay_create_properties(struct drm_device *dev) 51196f60e37SRussell King { 51296f60e37SRussell King struct armada_private *priv = dev->dev_private; 51396f60e37SRussell King 51496f60e37SRussell King if (priv->colorkey_prop) 51596f60e37SRussell King return 0; 51696f60e37SRussell King 51796f60e37SRussell King priv->colorkey_prop = drm_property_create_range(dev, 0, 51896f60e37SRussell King "colorkey", 0, 0xffffff); 51996f60e37SRussell King priv->colorkey_min_prop = drm_property_create_range(dev, 0, 52096f60e37SRussell King "colorkey_min", 0, 0xffffff); 52196f60e37SRussell King priv->colorkey_max_prop = drm_property_create_range(dev, 0, 52296f60e37SRussell King "colorkey_max", 0, 0xffffff); 52396f60e37SRussell King priv->colorkey_val_prop = drm_property_create_range(dev, 0, 52496f60e37SRussell King "colorkey_val", 0, 0xffffff); 52596f60e37SRussell King priv->colorkey_alpha_prop = drm_property_create_range(dev, 0, 52696f60e37SRussell King "colorkey_alpha", 0, 0xffffff); 52796f60e37SRussell King priv->colorkey_mode_prop = drm_property_create_enum(dev, 0, 52896f60e37SRussell King "colorkey_mode", 52996f60e37SRussell King armada_drm_colorkey_enum_list, 53096f60e37SRussell King ARRAY_SIZE(armada_drm_colorkey_enum_list)); 53196f60e37SRussell King priv->brightness_prop = drm_property_create_range(dev, 0, 53296f60e37SRussell King "brightness", 0, 256 + 255); 53396f60e37SRussell King priv->contrast_prop = drm_property_create_range(dev, 0, 53496f60e37SRussell King "contrast", 0, 0x7fff); 53596f60e37SRussell King priv->saturation_prop = drm_property_create_range(dev, 0, 53696f60e37SRussell King "saturation", 0, 0x7fff); 53796f60e37SRussell King 53896f60e37SRussell King if (!priv->colorkey_prop) 53996f60e37SRussell King return -ENOMEM; 54096f60e37SRussell King 54196f60e37SRussell King return 0; 54296f60e37SRussell King } 54396f60e37SRussell King 54496f60e37SRussell King int armada_overlay_plane_create(struct drm_device *dev, unsigned long crtcs) 54596f60e37SRussell King { 54696f60e37SRussell King struct armada_private *priv = dev->dev_private; 54796f60e37SRussell King struct drm_mode_object *mobj; 548d701278aSRussell King struct drm_plane *overlay; 54996f60e37SRussell King int ret; 55096f60e37SRussell King 55196f60e37SRussell King ret = armada_overlay_create_properties(dev); 55296f60e37SRussell King if (ret) 55396f60e37SRussell King return ret; 55496f60e37SRussell King 555d701278aSRussell King overlay = kzalloc(sizeof(*overlay), GFP_KERNEL); 556d701278aSRussell King if (!overlay) 55796f60e37SRussell King return -ENOMEM; 55896f60e37SRussell King 559d701278aSRussell King drm_plane_helper_add(overlay, &armada_overlay_plane_helper_funcs); 5605740d27fSRussell King 561d701278aSRussell King ret = drm_universal_plane_init(dev, overlay, crtcs, 562d563c245SRussell King &armada_ovl_plane_funcs, 563d563c245SRussell King armada_ovl_formats, 564d563c245SRussell King ARRAY_SIZE(armada_ovl_formats), 565e6fc3b68SBen Widawsky NULL, 566b0b3b795SVille Syrjälä DRM_PLANE_TYPE_OVERLAY, NULL); 56728a2aebeSRussell King if (ret) { 568d701278aSRussell King kfree(overlay); 56928a2aebeSRussell King return ret; 57028a2aebeSRussell King } 57196f60e37SRussell King 572d701278aSRussell King mobj = &overlay->base; 57396f60e37SRussell King drm_object_attach_property(mobj, priv->colorkey_prop, 57496f60e37SRussell King 0x0101fe); 57596f60e37SRussell King drm_object_attach_property(mobj, priv->colorkey_min_prop, 57696f60e37SRussell King 0x0101fe); 57796f60e37SRussell King drm_object_attach_property(mobj, priv->colorkey_max_prop, 57896f60e37SRussell King 0x0101fe); 57996f60e37SRussell King drm_object_attach_property(mobj, priv->colorkey_val_prop, 58096f60e37SRussell King 0x0101fe); 58196f60e37SRussell King drm_object_attach_property(mobj, priv->colorkey_alpha_prop, 58296f60e37SRussell King 0x000000); 58396f60e37SRussell King drm_object_attach_property(mobj, priv->colorkey_mode_prop, 58496f60e37SRussell King CKMODE_RGB); 58561ba2527SRussell King drm_object_attach_property(mobj, priv->brightness_prop, 58661ba2527SRussell King 256 + DEFAULT_BRIGHTNESS); 58796f60e37SRussell King drm_object_attach_property(mobj, priv->contrast_prop, 58861ba2527SRussell King DEFAULT_CONTRAST); 58996f60e37SRussell King drm_object_attach_property(mobj, priv->saturation_prop, 59061ba2527SRussell King DEFAULT_SATURATION); 59196f60e37SRussell King 592d701278aSRussell King ret = drm_plane_create_color_properties(overlay, 593c29277d4SRussell King BIT(DRM_COLOR_YCBCR_BT601) | 594c29277d4SRussell King BIT(DRM_COLOR_YCBCR_BT709), 595c29277d4SRussell King BIT(DRM_COLOR_YCBCR_LIMITED_RANGE), 596c29277d4SRussell King DEFAULT_ENCODING, 597c29277d4SRussell King DRM_COLOR_YCBCR_LIMITED_RANGE); 598c29277d4SRussell King 599c29277d4SRussell King return ret; 60096f60e37SRussell King } 601