dpu_writeback.c

  1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved.
  4 */
  5
  6#include <drm/drm_edid.h>
  7#include <drm/drm_framebuffer.h>
  8
  9#include "dpu_writeback.h"
 10
 11static int dpu_wb_conn_get_modes(struct drm_connector *connector)
 12{
 13	struct drm_device *dev = connector->dev;
 14	struct msm_drm_private *priv = dev->dev_private;
 15	struct dpu_kms *dpu_kms = to_dpu_kms(priv->kms);
 16
 17	/*
 18	 * We should ideally be limiting the modes only to the maxlinewidth but
 19	 * on some chipsets this will allow even 4k modes to be added which will
 20	 * fail the per SSPP bandwidth checks. So, till we have dual-SSPP support
 21	 * and source split support added lets limit the modes based on max_mixer_width
 22	 * as 4K modes can then be supported.
 23	 */
 24	return drm_add_modes_noedid(connector, dpu_kms->catalog->caps->max_mixer_width,
 25			dev->mode_config.max_height);
 26}
 27
 28static int dpu_wb_conn_atomic_check(struct drm_connector *connector,
 29				    struct drm_atomic_state *state)
 30{
 31	struct drm_writeback_connector *wb_conn = drm_connector_to_writeback(connector);
 32	struct dpu_wb_connector *dpu_wb_conn = to_dpu_wb_conn(wb_conn);
 33	struct drm_connector_state *conn_state =
 34		drm_atomic_get_new_connector_state(state, connector);
 35	struct drm_crtc *crtc;
 36	struct drm_crtc_state *crtc_state;
 37	const struct drm_display_mode *mode;
 38	struct drm_framebuffer *fb;
 39
 40	DPU_DEBUG("[atomic_check:%d]\n", connector->base.id);
 41
 42	if (!conn_state || !conn_state->connector) {
 43		DPU_ERROR("invalid connector state\n");
 44		return -EINVAL;
 45	}
 46
 47	crtc = conn_state->crtc;
 48	if (!crtc)
 49		return 0;
 50
 51	if (!conn_state->writeback_job || !conn_state->writeback_job->fb)
 52		return 0;
 53
 54	crtc_state = drm_atomic_get_crtc_state(state, crtc);
 55	if (IS_ERR(crtc_state))
 56		return PTR_ERR(crtc_state);
 57
 58	mode = &crtc_state->mode;
 59
 60	fb = conn_state->writeback_job->fb;
 61
 62	DPU_DEBUG("[fb_id:%u][fb:%u,%u][mode:\"%s\":%ux%u]\n", fb->base.id, fb->width, fb->height,
 63		  mode->name, mode->hdisplay, mode->vdisplay);
 64
 65	if (fb->width != mode->hdisplay) {
 66		DPU_ERROR("invalid fb w=%d, mode w=%d\n", fb->width, mode->hdisplay);
 67		return -EINVAL;
 68	} else if (fb->height != mode->vdisplay) {
 69		DPU_ERROR("invalid fb h=%d, mode h=%d\n", fb->height, mode->vdisplay);
 70		return -EINVAL;
 71	} else if (fb->width > dpu_wb_conn->maxlinewidth) {
 72		DPU_ERROR("invalid fb w=%d, maxlinewidth=%u\n",
 73			  fb->width, dpu_wb_conn->maxlinewidth);
 74		return -EINVAL;
 75	} else if (fb->modifier != DRM_FORMAT_MOD_LINEAR) {
 76		DPU_ERROR("unsupported fb modifier:%#llx\n", fb->modifier);
 77		return -EINVAL;
 78	}
 79
 80	return drm_atomic_helper_check_wb_connector_state(conn_state->connector, conn_state->state);
 81}
 82
 83static const struct drm_connector_funcs dpu_wb_conn_funcs = {
 84	.reset = drm_atomic_helper_connector_reset,
 85	.fill_modes = drm_helper_probe_single_connector_modes,
 86	.atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
 87	.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
 88};
 89
 90static int dpu_wb_conn_prepare_job(struct drm_writeback_connector *connector,
 91		struct drm_writeback_job *job)
 92{
 93
 94	struct dpu_wb_connector *dpu_wb_conn = to_dpu_wb_conn(connector);
 95
 96	if (!job->fb)
 97		return 0;
 98
 99	dpu_encoder_prepare_wb_job(dpu_wb_conn->wb_enc, job);
100
101	return 0;
102}
103
104static void dpu_wb_conn_cleanup_job(struct drm_writeback_connector *connector,
105		struct drm_writeback_job *job)
106{
107	struct dpu_wb_connector *dpu_wb_conn = to_dpu_wb_conn(connector);
108
109	if (!job->fb)
110		return;
111
112	dpu_encoder_cleanup_wb_job(dpu_wb_conn->wb_enc, job);
113}
114
115static const struct drm_connector_helper_funcs dpu_wb_conn_helper_funcs = {
116	.get_modes = dpu_wb_conn_get_modes,
117	.atomic_check = dpu_wb_conn_atomic_check,
118	.prepare_writeback_job = dpu_wb_conn_prepare_job,
119	.cleanup_writeback_job = dpu_wb_conn_cleanup_job,
120};
121
122int dpu_writeback_init(struct drm_device *dev, struct drm_encoder *enc,
123		const u32 *format_list, u32 num_formats, u32 maxlinewidth)
124{
125	struct dpu_wb_connector *dpu_wb_conn;
126	int rc = 0;
127
128	dpu_wb_conn = devm_kzalloc(dev->dev, sizeof(*dpu_wb_conn), GFP_KERNEL);
129	if (!dpu_wb_conn)
130		return -ENOMEM;
131
132	dpu_wb_conn->maxlinewidth = maxlinewidth;
133
134	drm_connector_helper_add(&dpu_wb_conn->base.base, &dpu_wb_conn_helper_funcs);
135
136	rc = drmm_writeback_connector_init(dev, &dpu_wb_conn->base,
137					   &dpu_wb_conn_funcs, enc,
138					   format_list, num_formats);
139
140	if (!rc)
141		dpu_wb_conn->wb_enc = enc;
142
143	return rc;
144}