1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright (C) 2016 Red Hat
4 * Author: Rob Clark <robdclark@gmail.com>
5 */
6
7#include "mdp5_kms.h"
8
9int mdp5_pipe_assign(struct drm_atomic_state *s, struct drm_plane *plane,
10		     uint32_t caps, uint32_t blkcfg,
11		     struct mdp5_hw_pipe **hwpipe,
12		     struct mdp5_hw_pipe **r_hwpipe)
13{
14	struct msm_drm_private *priv = s->dev->dev_private;
15	struct mdp5_kms *mdp5_kms = to_mdp5_kms(to_mdp_kms(priv->kms));
16	struct mdp5_global_state *new_global_state, *old_global_state;
17	struct mdp5_hw_pipe_state *old_state, *new_state;
18	int i, j;
19
20	new_global_state = mdp5_get_global_state(s);
21	if (IS_ERR(new_global_state))
22		return PTR_ERR(new_global_state);
23
24	/* grab old_state after mdp5_get_global_state(), since now we hold lock: */
25	old_global_state = mdp5_get_existing_global_state(mdp5_kms);
26
27	old_state = &old_global_state->hwpipe;
28	new_state = &new_global_state->hwpipe;
29
30	for (i = 0; i < mdp5_kms->num_hwpipes; i++) {
31		struct mdp5_hw_pipe *cur = mdp5_kms->hwpipes[i];
32
33		/* skip if already in-use.. check both new and old state,
34		 * since we cannot immediately re-use a pipe that is
35		 * released in the current update in some cases:
36		 *  (1) mdp5 can have SMP (non-double-buffered)
37		 *  (2) hw pipe previously assigned to different CRTC
38		 *      (vblanks might not be aligned)
39		 */
40		if (new_state->hwpipe_to_plane[cur->idx] ||
41				old_state->hwpipe_to_plane[cur->idx])
42			continue;
43
44		/* skip if doesn't support some required caps: */
45		if (caps & ~cur->caps)
46			continue;
47
48		/*
49		 * don't assign a cursor pipe to a plane that isn't going to
50		 * be used as a cursor
51		 */
52		if (cur->caps & MDP_PIPE_CAP_CURSOR &&
53				plane->type != DRM_PLANE_TYPE_CURSOR)
54			continue;
55
56		/* possible candidate, take the one with the
57		 * fewest unneeded caps bits set:
58		 */
59		if (!(*hwpipe) || (hweight_long(cur->caps & ~caps) <
60				   hweight_long((*hwpipe)->caps & ~caps))) {
61			bool r_found = false;
62
63			if (r_hwpipe) {
64				for (j = i + 1; j < mdp5_kms->num_hwpipes;
65				     j++) {
66					struct mdp5_hw_pipe *r_cur =
67							mdp5_kms->hwpipes[j];
68
69					/* reject different types of hwpipes */
70					if (r_cur->caps != cur->caps)
71						continue;
72
73					/* respect priority, eg. VIG0 > VIG1 */
74					if (cur->pipe > r_cur->pipe)
75						continue;
76
77					*r_hwpipe = r_cur;
78					r_found = true;
79					break;
80				}
81			}
82
83			if (!r_hwpipe || r_found)
84				*hwpipe = cur;
85		}
86	}
87
88	if (!(*hwpipe))
89		return -ENOMEM;
90
91	if (r_hwpipe && !(*r_hwpipe))
92		return -ENOMEM;
93
94	if (mdp5_kms->smp) {
95		int ret;
96
97		/* We don't support SMP and 2 hwpipes/plane together */
98		WARN_ON(r_hwpipe);
99
100		DBG("%s: alloc SMP blocks", (*hwpipe)->name);
101		ret = mdp5_smp_assign(mdp5_kms->smp, &new_global_state->smp,
102				(*hwpipe)->pipe, blkcfg);
103		if (ret)
104			return -ENOMEM;
105
106		(*hwpipe)->blkcfg = blkcfg;
107	}
108
109	DBG("%s: assign to plane %s for caps %x",
110			(*hwpipe)->name, plane->name, caps);
111	new_state->hwpipe_to_plane[(*hwpipe)->idx] = plane;
112
113	if (r_hwpipe) {
114		DBG("%s: assign to right of plane %s for caps %x",
115		    (*r_hwpipe)->name, plane->name, caps);
116		new_state->hwpipe_to_plane[(*r_hwpipe)->idx] = plane;
117	}
118
119	return 0;
120}
121
122int mdp5_pipe_release(struct drm_atomic_state *s, struct mdp5_hw_pipe *hwpipe)
123{
124	struct msm_drm_private *priv = s->dev->dev_private;
125	struct mdp5_kms *mdp5_kms = to_mdp5_kms(to_mdp_kms(priv->kms));
126	struct mdp5_global_state *state;
127	struct mdp5_hw_pipe_state *new_state;
128
129	if (!hwpipe)
130		return 0;
131
132	state = mdp5_get_global_state(s);
133	if (IS_ERR(state))
134		return PTR_ERR(state);
135
136	new_state = &state->hwpipe;
137
138	if (WARN_ON(!new_state->hwpipe_to_plane[hwpipe->idx]))
139		return -EINVAL;
140
141	DBG("%s: release from plane %s", hwpipe->name,
142		new_state->hwpipe_to_plane[hwpipe->idx]->name);
143
144	if (mdp5_kms->smp) {
145		DBG("%s: free SMP blocks", hwpipe->name);
146		mdp5_smp_release(mdp5_kms->smp, &state->smp, hwpipe->pipe);
147	}
148
149	new_state->hwpipe_to_plane[hwpipe->idx] = NULL;
150
151	return 0;
152}
153
154struct mdp5_hw_pipe *mdp5_pipe_init(struct drm_device *dev,
155		enum mdp5_pipe pipe,
156		uint32_t reg_offset, uint32_t caps)
157{
158	struct mdp5_hw_pipe *hwpipe;
159
160	hwpipe = devm_kzalloc(dev->dev, sizeof(*hwpipe), GFP_KERNEL);
161	if (!hwpipe)
162		return ERR_PTR(-ENOMEM);
163
164	hwpipe->name = pipe2name(pipe);
165	hwpipe->pipe = pipe;
166	hwpipe->reg_offset = reg_offset;
167	hwpipe->caps = caps;
168	hwpipe->flush_mask = mdp_ctl_flush_mask_pipe(pipe);
169
170	return hwpipe;
171}
172