>
> >
> >> +
> >> +#endif /* __DC_KMS_H__ */
> >> diff --git a/drivers/gpu/drm/imx/dc/dc-plane.c b/drivers/gpu/drm/imx/dc/dc-plane.c
> >> new file mode 100644
> >> index 000000000000..a49b043ca167
> >> --- /dev/null
> >> +++ b/drivers/gpu/drm/imx/dc/dc-plane.c
> >> @@ -0,0 +1,227 @@
> >> +// SPDX-License-Identifier: GPL-2.0+
> >> +/*
> >> + * Copyright 2024 NXP
> >> + */
> >> +
> >> +#include <drm/drm_atomic.h>
> >> +#include <drm/drm_atomic_helper.h>
> >> +#include <drm/drm_atomic_state_helper.h>
> >> +#include <drm/drm_crtc.h>
> >> +#include <drm/drm_drv.h>
> >> +#include <drm/drm_fb_dma_helper.h>
> >> +#include <drm/drm_fourcc.h>
> >> +#include <drm/drm_framebuffer.h>
> >> +#include <drm/drm_gem_atomic_helper.h>
> >> +#include <drm/drm_plane_helper.h>
> >> +
> >> +#include "dc-drv.h"
> >> +#include "dc-fu.h"
> >> +#include "dc-plane.h"
> >> +
> >> +#define DC_PLANE_MAX_PITCH 0x10000
> >> +#define DC_PLANE_MAX_PIX_CNT 8192
> >> +
> >> +static const uint32_t dc_plane_formats[] = {
> >> + DRM_FORMAT_XRGB8888,
> >> +};
> >> +
> >> +static const struct drm_plane_funcs dc_plane_funcs = {
> >> + .update_plane = drm_atomic_helper_update_plane,
> >> + .disable_plane = drm_atomic_helper_disable_plane,
> >> + .destroy = drm_plane_cleanup,
> >> + .reset = drm_atomic_helper_plane_reset,
> >> + .atomic_duplicate_state = drm_atomic_helper_plane_duplicate_state,
> >> + .atomic_destroy_state = drm_atomic_helper_plane_destroy_state,
> >> +};
> >> +
> >> +static int dc_plane_check_no_off_screen(struct drm_plane_state *state,
> >> + struct drm_crtc_state *crtc_state)
> >> +{
> >> + if (state->dst.x1 < 0 || state->dst.y1 < 0 ||
> >> + state->dst.x2 > crtc_state->adjusted_mode.hdisplay ||
> >> + state->dst.y2 > crtc_state->adjusted_mode.vdisplay) {
> >> + dc_plane_dbg(state->plane, "no off screen\n");
> >> + return -EINVAL;
> >> + }
> >> +
> >> + return 0;
> >> +}
> >> +
> >> +static int dc_plane_check_max_source_resolution(struct drm_plane_state *state)
> >> +{
> >> + int src_h = drm_rect_height(&state->src) >> 16;
> >> + int src_w = drm_rect_width(&state->src) >> 16;
> >> +
> >> + if (src_w > DC_PLANE_MAX_PIX_CNT || src_h > DC_PLANE_MAX_PIX_CNT) {
> >> + dc_plane_dbg(state->plane, "invalid source resolution\n");
> >> + return -EINVAL;
> >> + }
> >> +
> >> + return 0;
> >> +}
> >> +
> >> +static int dc_plane_check_fb(struct drm_plane_state *state)
> >> +{
> >> + struct drm_framebuffer *fb = state->fb;
> >> + dma_addr_t baseaddr = drm_fb_dma_get_gem_addr(fb, state, 0);
> >> +
> >> + /* base address alignment */
> >> + if (baseaddr & 0x3) {
> >> + dc_plane_dbg(state->plane, "fb bad baddr alignment\n");
> >> + return -EINVAL;
> >> + }
> >> +
> >> + /* pitches[0] range */
> >> + if (fb->pitches[0] > DC_PLANE_MAX_PITCH) {
> >> + dc_plane_dbg(state->plane, "fb pitches[0] is out of range\n");
> >> + return -EINVAL;
> >> + }
> >> +
> >> + /* pitches[0] alignment */
> >> + if (fb->pitches[0] & 0x3) {
> >> + dc_plane_dbg(state->plane, "fb bad pitches[0] alignment\n");
> >> + return -EINVAL;
> >> + }
> >> +
> >> + return 0;
> >> +}
> >> +
> >> +static int
> >> +dc_plane_atomic_check(struct drm_plane *plane, struct drm_atomic_state *state)
> >> +{
> >> + struct drm_plane_state *plane_state =
> >> + drm_atomic_get_new_plane_state(state, plane);
> >> + struct drm_crtc_state *crtc_state;
> >> + int ret;
> >> +
> >> + /* ok to disable */
> >> + if (!plane_state->fb)
> >> + return 0;
> >> +
> >> + if (!plane_state->crtc) {
> >> + dc_plane_dbg(plane, "no CRTC in plane state\n");
> >> + return -EINVAL;
> >> + }
> >> +
> >> + crtc_state =
> >> + drm_atomic_get_existing_crtc_state(state, plane_state->crtc);
> >> + if (WARN_ON(!crtc_state))
> >> + return -EINVAL;
> >> +
> >> + ret = drm_atomic_helper_check_plane_state(plane_state, crtc_state,
> >> + DRM_PLANE_NO_SCALING,
> >> + DRM_PLANE_NO_SCALING,
> >> + true, false);
> >> + if (ret) {
> >> + dc_plane_dbg(plane, "failed to check plane state: %d\n", ret);
> >> + return ret;
> >> + }
> >> +
> >> + ret = dc_plane_check_no_off_screen(plane_state, crtc_state);
> >> + if (ret)
> >> + return ret;
> >> +
> >> + ret = dc_plane_check_max_source_resolution(plane_state);
> >> + if (ret)
> >> + return ret;
> >> +
> >> + return dc_plane_check_fb(plane_state);
> >> +}
> >> +
> >> +static void
> >> +dc_plane_atomic_update(struct drm_plane *plane, struct drm_atomic_state *state)
> >> +{
> >> + struct drm_plane_state *new_state =
> >> + drm_atomic_get_new_plane_state(state, plane);
> >> + struct dc_plane *dplane = to_dc_plane(plane);
> >> + struct drm_framebuffer *fb = new_state->fb;
> >> + const struct dc_fu_ops *fu_ops;
> >> + struct dc_lb *lb = dplane->lb;
> >> + struct dc_fu *fu = dplane->fu;
> >> + dma_addr_t baseaddr;
> >> + int src_w, src_h;
> >> + int idx;
> >> +
> >> + if (!drm_dev_enter(plane->dev, &idx))
> >> + return;
> >> +
> >> + src_w = drm_rect_width(&new_state->src) >> 16;
> >> + src_h = drm_rect_height(&new_state->src) >> 16;
> >> +
> >> + baseaddr = drm_fb_dma_get_gem_addr(fb, new_state, 0);
> >> +
> >> + fu_ops = dc_fu_get_ops(dplane->fu);
> >> +
> >> + fu_ops->set_layerblend(fu, lb);
> >> + fu_ops->set_burstlength(fu, baseaddr);
> >> + fu_ops->set_src_stride(fu, fb->pitches[0]);
> >> + fu_ops->set_src_buf_dimensions(fu, src_w, src_h);
> >> + fu_ops->set_fmt(fu, fb->format);
> >> + fu_ops->set_framedimensions(fu, src_w, src_h);
> >> + fu_ops->set_baseaddress(fu, baseaddr);
> >> + fu_ops->enable_src_buf(fu);
> >
> > Are you expecting that these ops might change? Can you call the function
> > directly?
>
> Looking at struct dc_fl and struct dc_fw, you may find struct dc_fu
> is the base class. These function calls take struct dc_fu as
> arguments so that derived instances may specify their implementations.
>
> So, I can't call their implementation functions directly.
Ack.
>
> >
> >> +
> >> + dc_plane_dbg(plane, "uses %s\n", fu_ops->get_name(fu));
> >> +
> >> + dc_lb_pec_dynamic_prim_sel(lb, dc_cf_get_link_id(dplane->cf));
> >> + dc_lb_pec_dynamic_sec_sel(lb, fu_ops->get_link_id(fu));
> >> + dc_lb_mode(lb, LB_BLEND);
> >> + dc_lb_blendcontrol(lb);
> >> + dc_lb_position(lb, new_state->dst.x1, new_state->dst.y1);
> >> + dc_lb_pec_clken(lb, CLKEN_AUTOMATIC);
> >> +
> >> + dc_plane_dbg(plane, "uses LayerBlend%u\n", dc_lb_get_id(lb));
> >> +
> >> + /* set ExtDst's source to LayerBlend */
> >> + dc_ed_pec_src_sel(dplane->ed, dc_lb_get_link_id(lb));
> >> +
> >> + drm_dev_exit(idx);
> >> +}
> >> +
> >> +static void dc_plane_atomic_disable(struct drm_plane *plane,
> >> + struct drm_atomic_state *state)
> >> +{
> >> + struct dc_plane *dplane = to_dc_plane(plane);
> >> + const struct dc_fu_ops *fu_ops;
> >> + int idx;
> >> +
> >> + if (!drm_dev_enter(plane->dev, &idx))
> >> + return;
> >> +
> >> + /* disable fetchunit in shadow */
> >> + fu_ops = dc_fu_get_ops(dplane->fu);
> >> + fu_ops->disable_src_buf(dplane->fu);
> >> +
> >> + /* set ExtDst's source to ConstFrame */
> >> + dc_ed_pec_src_sel(dplane->ed, dc_cf_get_link_id(dplane->cf));
> >> +
> >> + drm_dev_exit(idx);
> >> +}
> >> +
> >> +static const struct drm_plane_helper_funcs dc_plane_helper_funcs = {
> >> + .atomic_check = dc_plane_atomic_check,
> >> + .atomic_update = dc_plane_atomic_update,
> >> + .atomic_disable = dc_plane_atomic_disable,
> >> +};
> >> +
> >> +int dc_plane_init(struct dc_drm_device *dc_drm, struct dc_plane *dc_plane)
> >> +{
> >> + struct drm_plane *plane = &dc_plane->base;
> >> + int ret;
> >> +
> >> + ret = drm_universal_plane_init(&dc_drm->base, plane, 0, &dc_plane_funcs,
> >> + dc_plane_formats,
> >> + ARRAY_SIZE(dc_plane_formats),
> >> + NULL, DRM_PLANE_TYPE_PRIMARY, NULL);
> >> + if (ret)
> >> + return ret;
> >> +
> >> + drm_plane_helper_add(plane, &dc_plane_helper_funcs);
> >> +
> >> + dc_plane->fu = dc_drm->pe->fu_disp[plane->index];
> >> + dc_plane->cf = dc_drm->pe->cf_cont[plane->index];
> >> + dc_plane->lb = dc_drm->pe->lb[plane->index];
> >> + dc_plane->ed = dc_drm->pe->ed_cont[plane->index];
> >> +
> >> + return 0;
> >> +}
> >> diff --git a/drivers/gpu/drm/imx/dc/dc-plane.h b/drivers/gpu/drm/imx/dc/dc-plane.h
> >> new file mode 100644
> >> index 000000000000..e72c3a7cb66f
> >> --- /dev/null
> >> +++ b/drivers/gpu/drm/imx/dc/dc-plane.h
> >> @@ -0,0 +1,37 @@
> >> +/* SPDX-License-Identifier: GPL-2.0+ */
> >> +/*
> >> + * Copyright 2024 NXP
> >> + */
> >> +
> >> +#ifndef __DC_PLANE_H__
> >> +#define __DC_PLANE_H__
> >> +
> >> +#include <linux/container_of.h>
> >> +
> >> +#include <drm/drm_plane.h>
> >> +#include <drm/drm_print.h>
> >> +
> >> +#include "dc-fu.h"
> >> +#include "dc-pe.h"
> >> +
> >> +#define dc_plane_dbg(plane, fmt, ...) \
> >> +do { \
> >> + typeof(plane) _plane = (plane); \
> >> + drm_dbg_kms(_plane->dev, "[PLANE:%d:%s] " fmt, \
> >> + _plane->base.id, _plane->name, ##__VA_ARGS__); \
> >> +} while (0)
> >> +
> >> +struct dc_plane {
> >> + struct drm_plane base;
> >> + struct dc_fu *fu;
> >> + struct dc_cf *cf;
> >> + struct dc_lb *lb;
> >> + struct dc_ed *ed;
> >> +};
> >> +
> >> +static inline struct dc_plane *to_dc_plane(struct drm_plane *plane)
> >> +{
> >> + return container_of(plane, struct dc_plane, base);
> >> +}
> >> +
> >> +#endif /* __DC_PLANE_H__ */
> >> --
> >> 2.34.1
> >>
> >
>
> --
> Regards,
> Liu Ying
>
--
With best wishes
Dmitry
