172 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * Copyright (C) 2016 Red Hat4 * 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 is35 * 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 CRTC38 * (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 to50 * be used as a cursor51 */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 the57 * 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