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
dpu_wb_conn_get_modes(struct drm_connector * connector)11 static 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
dpu_wb_conn_atomic_check(struct drm_connector * connector,struct drm_atomic_state * state)28 static 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
83 static 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
dpu_wb_conn_prepare_job(struct drm_writeback_connector * connector,struct drm_writeback_job * job)90 static 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
dpu_wb_conn_cleanup_job(struct drm_writeback_connector * connector,struct drm_writeback_job * job)104 static 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
115 static 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
dpu_writeback_init(struct drm_device * dev,struct drm_encoder * enc,const u32 * format_list,u32 num_formats,u32 maxlinewidth)122 int 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 }
145