253 lines · c
1// SPDX-License-Identifier: GPL-2.02/*3 * Copyright (C) 2018 Texas Instruments Incorporated - https://www.ti.com/4 * Author: Tomi Valkeinen <tomi.valkeinen@ti.com>5 */6 7#include <drm/drm_atomic.h>8#include <drm/drm_atomic_helper.h>9#include <drm/drm_blend.h>10#include <drm/drm_crtc.h>11#include <drm/drm_fb_dma_helper.h>12#include <drm/drm_fourcc.h>13#include <drm/drm_framebuffer.h>14#include <drm/drm_gem_atomic_helper.h>15 16#include "tidss_crtc.h"17#include "tidss_dispc.h"18#include "tidss_drv.h"19#include "tidss_plane.h"20 21/* drm_plane_helper_funcs */22 23static int tidss_plane_atomic_check(struct drm_plane *plane,24 struct drm_atomic_state *state)25{26 struct drm_plane_state *new_plane_state = drm_atomic_get_new_plane_state(state,27 plane);28 struct drm_device *ddev = plane->dev;29 struct tidss_device *tidss = to_tidss(ddev);30 struct tidss_plane *tplane = to_tidss_plane(plane);31 const struct drm_format_info *finfo;32 struct drm_crtc_state *crtc_state;33 u32 hw_plane = tplane->hw_plane_id;34 u32 hw_videoport;35 int ret;36 37 dev_dbg(ddev->dev, "%s\n", __func__);38 39 if (!new_plane_state->crtc) {40 /*41 * The visible field is not reset by the DRM core but only42 * updated by drm_atomic_helper_check_plane_state(), set it43 * manually.44 */45 new_plane_state->visible = false;46 return 0;47 }48 49 crtc_state = drm_atomic_get_crtc_state(state,50 new_plane_state->crtc);51 if (IS_ERR(crtc_state))52 return PTR_ERR(crtc_state);53 54 ret = drm_atomic_helper_check_plane_state(new_plane_state, crtc_state,55 0,56 INT_MAX, true, true);57 if (ret < 0)58 return ret;59 60 /*61 * The HW is only able to start drawing at subpixel boundary62 * (the two first checks bellow). At the end of a row the HW63 * can only jump integer number of subpixels forward to the64 * beginning of the next row. So we can only show picture with65 * integer subpixel width (the third check). However, after66 * reaching the end of the drawn picture the drawing starts67 * again at the absolute memory address where top left corner68 * position of the drawn picture is (so there is no need to69 * check for odd height).70 */71 72 finfo = drm_format_info(new_plane_state->fb->format->format);73 74 if ((new_plane_state->src_x >> 16) % finfo->hsub != 0) {75 dev_dbg(ddev->dev,76 "%s: x-position %u not divisible subpixel size %u\n",77 __func__, (new_plane_state->src_x >> 16), finfo->hsub);78 return -EINVAL;79 }80 81 if ((new_plane_state->src_y >> 16) % finfo->vsub != 0) {82 dev_dbg(ddev->dev,83 "%s: y-position %u not divisible subpixel size %u\n",84 __func__, (new_plane_state->src_y >> 16), finfo->vsub);85 return -EINVAL;86 }87 88 if ((new_plane_state->src_w >> 16) % finfo->hsub != 0) {89 dev_dbg(ddev->dev,90 "%s: src width %u not divisible by subpixel size %u\n",91 __func__, (new_plane_state->src_w >> 16),92 finfo->hsub);93 return -EINVAL;94 }95 96 if (!new_plane_state->visible)97 return 0;98 99 hw_videoport = to_tidss_crtc(new_plane_state->crtc)->hw_videoport;100 101 ret = dispc_plane_check(tidss->dispc, hw_plane, new_plane_state,102 hw_videoport);103 if (ret)104 return ret;105 106 return 0;107}108 109static void tidss_plane_atomic_update(struct drm_plane *plane,110 struct drm_atomic_state *state)111{112 struct drm_device *ddev = plane->dev;113 struct tidss_device *tidss = to_tidss(ddev);114 struct tidss_plane *tplane = to_tidss_plane(plane);115 struct drm_plane_state *new_state = drm_atomic_get_new_plane_state(state,116 plane);117 u32 hw_videoport;118 119 dev_dbg(ddev->dev, "%s\n", __func__);120 121 if (!new_state->visible) {122 dispc_plane_enable(tidss->dispc, tplane->hw_plane_id, false);123 return;124 }125 126 hw_videoport = to_tidss_crtc(new_state->crtc)->hw_videoport;127 128 dispc_plane_setup(tidss->dispc, tplane->hw_plane_id, new_state, hw_videoport);129}130 131static void tidss_plane_atomic_enable(struct drm_plane *plane,132 struct drm_atomic_state *state)133{134 struct drm_device *ddev = plane->dev;135 struct tidss_device *tidss = to_tidss(ddev);136 struct tidss_plane *tplane = to_tidss_plane(plane);137 138 dev_dbg(ddev->dev, "%s\n", __func__);139 140 dispc_plane_enable(tidss->dispc, tplane->hw_plane_id, true);141}142 143static void tidss_plane_atomic_disable(struct drm_plane *plane,144 struct drm_atomic_state *state)145{146 struct drm_device *ddev = plane->dev;147 struct tidss_device *tidss = to_tidss(ddev);148 struct tidss_plane *tplane = to_tidss_plane(plane);149 150 dev_dbg(ddev->dev, "%s\n", __func__);151 152 dispc_plane_enable(tidss->dispc, tplane->hw_plane_id, false);153}154 155static void drm_plane_destroy(struct drm_plane *plane)156{157 struct tidss_plane *tplane = to_tidss_plane(plane);158 159 drm_plane_cleanup(plane);160 kfree(tplane);161}162 163static const struct drm_plane_helper_funcs tidss_plane_helper_funcs = {164 .atomic_check = tidss_plane_atomic_check,165 .atomic_update = tidss_plane_atomic_update,166 .atomic_enable = tidss_plane_atomic_enable,167 .atomic_disable = tidss_plane_atomic_disable,168};169 170static const struct drm_plane_helper_funcs tidss_primary_plane_helper_funcs = {171 .atomic_check = tidss_plane_atomic_check,172 .atomic_update = tidss_plane_atomic_update,173 .atomic_enable = tidss_plane_atomic_enable,174 .atomic_disable = tidss_plane_atomic_disable,175 .get_scanout_buffer = drm_fb_dma_get_scanout_buffer,176};177 178static const struct drm_plane_funcs tidss_plane_funcs = {179 .update_plane = drm_atomic_helper_update_plane,180 .disable_plane = drm_atomic_helper_disable_plane,181 .reset = drm_atomic_helper_plane_reset,182 .destroy = drm_plane_destroy,183 .atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state,184 .atomic_destroy_state = drm_atomic_helper_plane_destroy_state,185};186 187struct tidss_plane *tidss_plane_create(struct tidss_device *tidss,188 u32 hw_plane_id, u32 plane_type,189 u32 crtc_mask, const u32 *formats,190 u32 num_formats)191{192 struct tidss_plane *tplane;193 enum drm_plane_type type;194 u32 possible_crtcs;195 u32 num_planes = tidss->feat->num_planes;196 u32 color_encodings = (BIT(DRM_COLOR_YCBCR_BT601) |197 BIT(DRM_COLOR_YCBCR_BT709));198 u32 color_ranges = (BIT(DRM_COLOR_YCBCR_FULL_RANGE) |199 BIT(DRM_COLOR_YCBCR_LIMITED_RANGE));200 u32 default_encoding = DRM_COLOR_YCBCR_BT601;201 u32 default_range = DRM_COLOR_YCBCR_FULL_RANGE;202 u32 blend_modes = (BIT(DRM_MODE_BLEND_PREMULTI) |203 BIT(DRM_MODE_BLEND_COVERAGE));204 int ret;205 206 tplane = kzalloc(sizeof(*tplane), GFP_KERNEL);207 if (!tplane)208 return ERR_PTR(-ENOMEM);209 210 tplane->hw_plane_id = hw_plane_id;211 212 possible_crtcs = crtc_mask;213 type = plane_type;214 215 ret = drm_universal_plane_init(&tidss->ddev, &tplane->plane,216 possible_crtcs,217 &tidss_plane_funcs,218 formats, num_formats,219 NULL, type, NULL);220 if (ret < 0)221 goto err;222 223 if (type == DRM_PLANE_TYPE_PRIMARY)224 drm_plane_helper_add(&tplane->plane, &tidss_primary_plane_helper_funcs);225 else226 drm_plane_helper_add(&tplane->plane, &tidss_plane_helper_funcs);227 228 drm_plane_create_zpos_property(&tplane->plane, tidss->num_planes, 0,229 num_planes - 1);230 231 ret = drm_plane_create_color_properties(&tplane->plane,232 color_encodings,233 color_ranges,234 default_encoding,235 default_range);236 if (ret)237 goto err;238 239 ret = drm_plane_create_alpha_property(&tplane->plane);240 if (ret)241 goto err;242 243 ret = drm_plane_create_blend_mode_property(&tplane->plane, blend_modes);244 if (ret)245 goto err;246 247 return tplane;248 249err:250 kfree(tplane);251 return ERR_PTR(ret);252}253