1 // SPDX-License-Identifier: GPL-2.0-only
3 * Copyright (C) 2014 Red Hat
4 * Author: Rob Clark <robdclark@gmail.com>
7 #include <drm/drm_atomic_uapi.h>
8 #include <drm/drm_vblank.h>
10 #include "msm_atomic_trace.h"
16 * Helpers to control vblanks while we flush.. basically just to ensure
17 * that vblank accounting is switched on, so we get valid seqn/timestamp
18 * on pageflip events (if requested)
21 static void vblank_get(struct msm_kms *kms, unsigned crtc_mask)
23 struct drm_crtc *crtc;
25 for_each_crtc_mask(kms->dev, crtc, crtc_mask) {
26 if (!crtc->state->active)
28 drm_crtc_vblank_get(crtc);
32 static void vblank_put(struct msm_kms *kms, unsigned crtc_mask)
34 struct drm_crtc *crtc;
36 for_each_crtc_mask(kms->dev, crtc, crtc_mask) {
37 if (!crtc->state->active)
39 drm_crtc_vblank_put(crtc);
43 static void lock_crtcs(struct msm_kms *kms, unsigned int crtc_mask)
46 struct drm_crtc *crtc;
48 for_each_crtc_mask(kms->dev, crtc, crtc_mask) {
49 crtc_index = drm_crtc_index(crtc);
50 mutex_lock_nested(&kms->commit_lock[crtc_index], crtc_index);
54 static void unlock_crtcs(struct msm_kms *kms, unsigned int crtc_mask)
56 struct drm_crtc *crtc;
58 for_each_crtc_mask_reverse(kms->dev, crtc, crtc_mask)
59 mutex_unlock(&kms->commit_lock[drm_crtc_index(crtc)]);
62 static void msm_atomic_async_commit(struct msm_kms *kms, int crtc_idx)
64 unsigned crtc_mask = BIT(crtc_idx);
66 trace_msm_atomic_async_commit_start(crtc_mask);
68 lock_crtcs(kms, crtc_mask);
70 if (!(kms->pending_crtc_mask & crtc_mask)) {
71 unlock_crtcs(kms, crtc_mask);
75 kms->pending_crtc_mask &= ~crtc_mask;
77 kms->funcs->enable_commit(kms);
79 vblank_get(kms, crtc_mask);
82 * Flush hardware updates:
84 trace_msm_atomic_flush_commit(crtc_mask);
85 kms->funcs->flush_commit(kms, crtc_mask);
88 * Wait for flush to complete:
90 trace_msm_atomic_wait_flush_start(crtc_mask);
91 kms->funcs->wait_flush(kms, crtc_mask);
92 trace_msm_atomic_wait_flush_finish(crtc_mask);
94 vblank_put(kms, crtc_mask);
96 kms->funcs->complete_commit(kms, crtc_mask);
97 unlock_crtcs(kms, crtc_mask);
98 kms->funcs->disable_commit(kms);
101 trace_msm_atomic_async_commit_finish(crtc_mask);
104 static void msm_atomic_pending_work(struct kthread_work *work)
106 struct msm_pending_timer *timer = container_of(work,
107 struct msm_pending_timer, work.work);
109 msm_atomic_async_commit(timer->kms, timer->crtc_idx);
112 int msm_atomic_init_pending_timer(struct msm_pending_timer *timer,
113 struct msm_kms *kms, int crtc_idx)
116 timer->crtc_idx = crtc_idx;
118 timer->worker = kthread_create_worker(0, "atomic-worker-%d", crtc_idx);
119 if (IS_ERR(timer->worker)) {
120 int ret = PTR_ERR(timer->worker);
121 timer->worker = NULL;
124 sched_set_fifo(timer->worker->task);
126 msm_hrtimer_work_init(&timer->work, timer->worker,
127 msm_atomic_pending_work,
128 CLOCK_MONOTONIC, HRTIMER_MODE_ABS);
133 void msm_atomic_destroy_pending_timer(struct msm_pending_timer *timer)
136 kthread_destroy_worker(timer->worker);
139 static bool can_do_async(struct drm_atomic_state *state,
140 struct drm_crtc **async_crtc)
142 struct drm_connector_state *connector_state;
143 struct drm_connector *connector;
144 struct drm_crtc_state *crtc_state;
145 struct drm_crtc *crtc;
146 int i, num_crtcs = 0;
148 if (!(state->legacy_cursor_update || state->async_update))
151 /* any connector change, means slow path: */
152 for_each_new_connector_in_state(state, connector, connector_state, i)
155 for_each_new_crtc_in_state(state, crtc, crtc_state, i) {
156 if (drm_atomic_crtc_needs_modeset(crtc_state))
166 /* Get bitmask of crtcs that will need to be flushed. The bitmask
167 * can be used with for_each_crtc_mask() iterator, to iterate
168 * effected crtcs without needing to preserve the atomic state.
170 static unsigned get_crtc_mask(struct drm_atomic_state *state)
172 struct drm_crtc_state *crtc_state;
173 struct drm_crtc *crtc;
174 unsigned i, mask = 0;
176 for_each_new_crtc_in_state(state, crtc, crtc_state, i)
177 mask |= drm_crtc_mask(crtc);
182 int msm_atomic_check(struct drm_device *dev, struct drm_atomic_state *state)
184 struct drm_crtc_state *old_crtc_state, *new_crtc_state;
185 struct drm_crtc *crtc;
188 for_each_oldnew_crtc_in_state(state, crtc, old_crtc_state,
190 if ((old_crtc_state->ctm && !new_crtc_state->ctm) ||
191 (!old_crtc_state->ctm && new_crtc_state->ctm)) {
192 new_crtc_state->mode_changed = true;
193 state->allow_modeset = true;
197 return drm_atomic_helper_check(dev, state);
200 void msm_atomic_commit_tail(struct drm_atomic_state *state)
202 struct drm_device *dev = state->dev;
203 struct msm_drm_private *priv = dev->dev_private;
204 struct msm_kms *kms = priv->kms;
205 struct drm_crtc *async_crtc = NULL;
206 unsigned crtc_mask = get_crtc_mask(state);
207 bool async = can_do_async(state, &async_crtc);
209 trace_msm_atomic_commit_tail_start(async, crtc_mask);
211 kms->funcs->enable_commit(kms);
214 * Ensure any previous (potentially async) commit has
217 lock_crtcs(kms, crtc_mask);
218 trace_msm_atomic_wait_flush_start(crtc_mask);
219 kms->funcs->wait_flush(kms, crtc_mask);
220 trace_msm_atomic_wait_flush_finish(crtc_mask);
223 * Now that there is no in-progress flush, prepare the
226 if (kms->funcs->prepare_commit)
227 kms->funcs->prepare_commit(kms, state);
230 * Push atomic updates down to hardware:
232 drm_atomic_helper_commit_modeset_disables(dev, state);
233 drm_atomic_helper_commit_planes(dev, state, 0);
234 drm_atomic_helper_commit_modeset_enables(dev, state);
237 struct msm_pending_timer *timer =
238 &kms->pending_timers[drm_crtc_index(async_crtc)];
240 /* async updates are limited to single-crtc updates: */
241 WARN_ON(crtc_mask != drm_crtc_mask(async_crtc));
244 * Start timer if we don't already have an update pending
247 if (!(kms->pending_crtc_mask & crtc_mask)) {
248 ktime_t vsync_time, wakeup_time;
250 kms->pending_crtc_mask |= crtc_mask;
252 if (drm_crtc_next_vblank_start(async_crtc, &vsync_time))
255 wakeup_time = ktime_sub(vsync_time, ms_to_ktime(1));
257 msm_hrtimer_queue_work(&timer->work, wakeup_time,
261 kms->funcs->disable_commit(kms);
262 unlock_crtcs(kms, crtc_mask);
264 * At this point, from drm core's perspective, we
265 * are done with the atomic update, so we can just
266 * go ahead and signal that it is done:
268 drm_atomic_helper_commit_hw_done(state);
269 drm_atomic_helper_cleanup_planes(dev, state);
271 trace_msm_atomic_commit_tail_finish(async, crtc_mask);
278 * If there is any async flush pending on updated crtcs, fold
279 * them into the current flush.
281 kms->pending_crtc_mask &= ~crtc_mask;
283 vblank_get(kms, crtc_mask);
286 * Flush hardware updates:
288 trace_msm_atomic_flush_commit(crtc_mask);
289 kms->funcs->flush_commit(kms, crtc_mask);
290 unlock_crtcs(kms, crtc_mask);
292 * Wait for flush to complete:
294 trace_msm_atomic_wait_flush_start(crtc_mask);
295 kms->funcs->wait_flush(kms, crtc_mask);
296 trace_msm_atomic_wait_flush_finish(crtc_mask);
298 vblank_put(kms, crtc_mask);
300 lock_crtcs(kms, crtc_mask);
301 kms->funcs->complete_commit(kms, crtc_mask);
302 unlock_crtcs(kms, crtc_mask);
303 kms->funcs->disable_commit(kms);
305 drm_atomic_helper_commit_hw_done(state);
306 drm_atomic_helper_cleanup_planes(dev, state);
308 trace_msm_atomic_commit_tail_finish(async, crtc_mask);