msm_fb.c

  1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * Copyright (C) 2013 Red Hat
  4 * Author: Rob Clark <robdclark@gmail.com>
  5 */
  6
  7#include <drm/drm_crtc.h>
  8#include <drm/drm_damage_helper.h>
  9#include <drm/drm_file.h>
 10#include <drm/drm_fourcc.h>
 11#include <drm/drm_framebuffer.h>
 12#include <drm/drm_gem_framebuffer_helper.h>
 13#include <drm/drm_probe_helper.h>
 14
 15#include "msm_drv.h"
 16#include "msm_kms.h"
 17#include "msm_gem.h"
 18
 19struct msm_framebuffer {
 20	struct drm_framebuffer base;
 21	const struct msm_format *format;
 22
 23	/* Count of # of attached planes which need dirtyfb: */
 24	refcount_t dirtyfb;
 25
 26	/* Framebuffer per-plane address, if pinned, else zero: */
 27	uint64_t iova[DRM_FORMAT_MAX_PLANES];
 28	atomic_t prepare_count;
 29};
 30#define to_msm_framebuffer(x) container_of(x, struct msm_framebuffer, base)
 31
 32static struct drm_framebuffer *msm_framebuffer_init(struct drm_device *dev,
 33		const struct drm_format_info *info,
 34		const struct drm_mode_fb_cmd2 *mode_cmd, struct drm_gem_object **bos);
 35
 36static int msm_framebuffer_dirtyfb(struct drm_framebuffer *fb,
 37				   struct drm_file *file_priv, unsigned int flags,
 38				   unsigned int color, struct drm_clip_rect *clips,
 39				   unsigned int num_clips)
 40{
 41	struct msm_framebuffer *msm_fb = to_msm_framebuffer(fb);
 42
 43	/* If this fb is not used on any display requiring pixel data to be
 44	 * flushed, then skip dirtyfb
 45	 */
 46	if (refcount_read(&msm_fb->dirtyfb) == 1)
 47		return 0;
 48
 49	return drm_atomic_helper_dirtyfb(fb, file_priv, flags, color,
 50					 clips, num_clips);
 51}
 52
 53static const struct drm_framebuffer_funcs msm_framebuffer_funcs = {
 54	.create_handle = drm_gem_fb_create_handle,
 55	.destroy = drm_gem_fb_destroy,
 56	.dirty = msm_framebuffer_dirtyfb,
 57};
 58
 59#ifdef CONFIG_DEBUG_FS
 60void msm_framebuffer_describe(struct drm_framebuffer *fb, struct seq_file *m)
 61{
 62	struct msm_gem_stats stats = {};
 63	int i, n = fb->format->num_planes;
 64
 65	seq_printf(m, "fb: %dx%d@%4.4s (%2d, ID:%d)\n",
 66			fb->width, fb->height, (char *)&fb->format->format,
 67			drm_framebuffer_read_refcount(fb), fb->base.id);
 68
 69	for (i = 0; i < n; i++) {
 70		seq_printf(m, "   %d: offset=%d pitch=%d, obj: ",
 71				i, fb->offsets[i], fb->pitches[i]);
 72		msm_gem_describe(fb->obj[i], m, &stats);
 73	}
 74}
 75#endif
 76
 77/* prepare/pin all the fb's bo's for scanout.
 78 */
 79int msm_framebuffer_prepare(struct drm_framebuffer *fb, bool needs_dirtyfb)
 80{
 81	struct msm_drm_private *priv = fb->dev->dev_private;
 82	struct drm_gpuvm *vm = priv->kms->vm;
 83	struct msm_framebuffer *msm_fb = to_msm_framebuffer(fb);
 84	int ret, i, n = fb->format->num_planes;
 85
 86	if (needs_dirtyfb)
 87		refcount_inc(&msm_fb->dirtyfb);
 88
 89	if (atomic_inc_return(&msm_fb->prepare_count) > 1)
 90		return 0;
 91
 92	for (i = 0; i < n; i++) {
 93		msm_gem_vma_get(fb->obj[i]);
 94		ret = msm_gem_get_and_pin_iova(fb->obj[i], vm, &msm_fb->iova[i]);
 95		drm_dbg_state(fb->dev, "FB[%u]: iova[%d]: %08llx (%d)\n",
 96			      fb->base.id, i, msm_fb->iova[i], ret);
 97		if (ret)
 98			return ret;
 99	}
100
101	return 0;
102}
103
104void msm_framebuffer_cleanup(struct drm_framebuffer *fb, bool needed_dirtyfb)
105{
106	struct msm_drm_private *priv = fb->dev->dev_private;
107	struct drm_gpuvm *vm = priv->kms->vm;
108	struct msm_framebuffer *msm_fb = to_msm_framebuffer(fb);
109	int i, n = fb->format->num_planes;
110
111	if (needed_dirtyfb)
112		refcount_dec(&msm_fb->dirtyfb);
113
114	if (atomic_dec_return(&msm_fb->prepare_count))
115		return;
116
117	memset(msm_fb->iova, 0, sizeof(msm_fb->iova));
118
119	for (i = 0; i < n; i++) {
120		msm_gem_unpin_iova(fb->obj[i], vm);
121		msm_gem_vma_put(fb->obj[i]);
122	}
123}
124
125uint32_t msm_framebuffer_iova(struct drm_framebuffer *fb, int plane)
126{
127	struct msm_framebuffer *msm_fb = to_msm_framebuffer(fb);
128	return msm_fb->iova[plane] + fb->offsets[plane];
129}
130
131struct drm_gem_object *msm_framebuffer_bo(struct drm_framebuffer *fb, int plane)
132{
133	return drm_gem_fb_get_obj(fb, plane);
134}
135
136const struct msm_format *msm_framebuffer_format(struct drm_framebuffer *fb)
137{
138	struct msm_framebuffer *msm_fb = to_msm_framebuffer(fb);
139	return msm_fb->format;
140}
141
142struct drm_framebuffer *msm_framebuffer_create(struct drm_device *dev,
143		struct drm_file *file, const struct drm_format_info *info,
144		const struct drm_mode_fb_cmd2 *mode_cmd)
145{
146	struct drm_gem_object *bos[4] = {0};
147	struct drm_framebuffer *fb;
148	int ret, i, n = info->num_planes;
149
150	for (i = 0; i < n; i++) {
151		bos[i] = drm_gem_object_lookup(file, mode_cmd->handles[i]);
152		if (!bos[i]) {
153			ret = -ENXIO;
154			goto out_unref;
155		}
156	}
157
158	fb = msm_framebuffer_init(dev, info, mode_cmd, bos);
159	if (IS_ERR(fb)) {
160		ret = PTR_ERR(fb);
161		goto out_unref;
162	}
163
164	return fb;
165
166out_unref:
167	for (i = 0; i < n; i++)
168		drm_gem_object_put(bos[i]);
169	return ERR_PTR(ret);
170}
171
172static struct drm_framebuffer *msm_framebuffer_init(struct drm_device *dev,
173		const struct drm_format_info *info,
174		const struct drm_mode_fb_cmd2 *mode_cmd, struct drm_gem_object **bos)
175{
176	struct msm_drm_private *priv = dev->dev_private;
177	struct msm_kms *kms = priv->kms;
178	struct msm_framebuffer *msm_fb = NULL;
179	struct drm_framebuffer *fb;
180	const struct msm_format *format;
181	int ret, i, n;
182
183	drm_dbg_state(dev, "create framebuffer: mode_cmd=%p (%dx%d@%p4cc)\n",
184		      mode_cmd, mode_cmd->width, mode_cmd->height,
185		      &mode_cmd->pixel_format);
186
187	n = info->num_planes;
188	format = mdp_get_format(kms, mode_cmd->pixel_format,
189			mode_cmd->modifier[0]);
190	if (!format) {
191		DRM_DEV_ERROR(dev->dev, "unsupported pixel format: %p4cc\n",
192			      &mode_cmd->pixel_format);
193		ret = -EINVAL;
194		goto fail;
195	}
196
197	msm_fb = kzalloc(sizeof(*msm_fb), GFP_KERNEL);
198	if (!msm_fb) {
199		ret = -ENOMEM;
200		goto fail;
201	}
202
203	fb = &msm_fb->base;
204
205	msm_fb->format = format;
206
207	if (n > ARRAY_SIZE(fb->obj)) {
208		ret = -EINVAL;
209		goto fail;
210	}
211
212	for (i = 0; i < n; i++) {
213		unsigned int width = mode_cmd->width / (i ? info->hsub : 1);
214		unsigned int height = mode_cmd->height / (i ? info->vsub : 1);
215		unsigned int min_size;
216
217		min_size = (height - 1) * mode_cmd->pitches[i]
218			 + width * info->cpp[i]
219			 + mode_cmd->offsets[i];
220
221		if (bos[i]->size < min_size) {
222			ret = -EINVAL;
223			goto fail;
224		}
225
226		msm_fb->base.obj[i] = bos[i];
227	}
228
229	drm_helper_mode_fill_fb_struct(dev, fb, info, mode_cmd);
230
231	ret = drm_framebuffer_init(dev, fb, &msm_framebuffer_funcs);
232	if (ret) {
233		DRM_DEV_ERROR(dev->dev, "framebuffer init failed: %d\n", ret);
234		goto fail;
235	}
236
237	refcount_set(&msm_fb->dirtyfb, 1);
238
239	drm_dbg_state(dev, "create: FB ID: %d (%p)\n", fb->base.id, fb);
240
241	return fb;
242
243fail:
244	kfree(msm_fb);
245
246	return ERR_PTR(ret);
247}
248
249struct drm_framebuffer *
250msm_alloc_stolen_fb(struct drm_device *dev, int w, int h, int p, uint32_t format)
251{
252	struct drm_mode_fb_cmd2 mode_cmd = {
253		.pixel_format = format,
254		.width = w,
255		.height = h,
256		.pitches = { p },
257	};
258	struct drm_gem_object *bo;
259	struct drm_framebuffer *fb;
260	int size;
261
262	/* allocate backing bo */
263	size = mode_cmd.pitches[0] * mode_cmd.height;
264	DBG("allocating %d bytes for fb %d", size, dev->primary->index);
265	bo = msm_gem_new(dev, size, MSM_BO_SCANOUT | MSM_BO_WC | MSM_BO_STOLEN);
266	if (IS_ERR(bo)) {
267		dev_warn(dev->dev, "could not allocate stolen bo\n");
268		/* try regular bo: */
269		bo = msm_gem_new(dev, size, MSM_BO_SCANOUT | MSM_BO_WC);
270	}
271	if (IS_ERR(bo)) {
272		DRM_DEV_ERROR(dev->dev, "failed to allocate buffer object\n");
273		return ERR_CAST(bo);
274	}
275
276	msm_gem_object_set_name(bo, "stolenfb");
277
278	fb = msm_framebuffer_init(dev,
279				  drm_get_format_info(dev, mode_cmd.pixel_format,
280						      mode_cmd.modifier[0]),
281				  &mode_cmd, &bo);
282	if (IS_ERR(fb)) {
283		DRM_DEV_ERROR(dev->dev, "failed to allocate fb\n");
284		/* note: if fb creation failed, we can't rely on fb destroy
285		 * to unref the bo:
286		 */
287		drm_gem_object_put(bo);
288		return ERR_CAST(fb);
289	}
290
291	return fb;
292}