PageRenderTime 32ms CodeModel.GetById 9ms app.highlight 19ms RepoModel.GetById 1ms app.codeStats 0ms

/drivers/gpu/drm/omapdrm/omap_plane.c

https://gitlab.com/tbwtiot/kernel_source
C | 452 lines | 318 code | 86 blank | 48 comment | 32 complexity | 6c90323b685f15d03d62267eddabcedd MD5 | raw file
  1/*
  2 * drivers/gpu/drm/omapdrm/omap_plane.c
  3 *
  4 * Copyright (C) 2011 Texas Instruments
  5 * Author: Rob Clark <rob.clark@linaro.org>
  6 *
  7 * This program is free software; you can redistribute it and/or modify it
  8 * under the terms of the GNU General Public License version 2 as published by
  9 * the Free Software Foundation.
 10 *
 11 * This program is distributed in the hope that it will be useful, but WITHOUT
 12 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 13 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 14 * more details.
 15 *
 16 * You should have received a copy of the GNU General Public License along with
 17 * this program.  If not, see <http://www.gnu.org/licenses/>.
 18 */
 19
 20#include "drm_flip_work.h"
 21
 22#include "omap_drv.h"
 23#include "omap_dmm_tiler.h"
 24
 25/* some hackery because omapdss has an 'enum omap_plane' (which would be
 26 * better named omap_plane_id).. and compiler seems unhappy about having
 27 * both a 'struct omap_plane' and 'enum omap_plane'
 28 */
 29#define omap_plane _omap_plane
 30
 31/*
 32 * plane funcs
 33 */
 34
 35struct callback {
 36	void (*fxn)(void *);
 37	void *arg;
 38};
 39
 40#define to_omap_plane(x) container_of(x, struct omap_plane, base)
 41
 42struct omap_plane {
 43	struct drm_plane base;
 44	int id;  /* TODO rename omap_plane -> omap_plane_id in omapdss so I can use the enum */
 45	const char *name;
 46	struct omap_overlay_info info;
 47	struct omap_drm_apply apply;
 48
 49	/* position/orientation of scanout within the fb: */
 50	struct omap_drm_window win;
 51	bool enabled;
 52
 53	/* last fb that we pinned: */
 54	struct drm_framebuffer *pinned_fb;
 55
 56	uint32_t nformats;
 57	uint32_t formats[32];
 58
 59	struct omap_drm_irq error_irq;
 60
 61	/* for deferring bo unpin's until next post_apply(): */
 62	struct drm_flip_work unpin_work;
 63
 64	// XXX maybe get rid of this and handle vblank in crtc too?
 65	struct callback apply_done_cb;
 66};
 67
 68static void unpin_worker(struct drm_flip_work *work, void *val)
 69{
 70	struct omap_plane *omap_plane =
 71			container_of(work, struct omap_plane, unpin_work);
 72	struct drm_device *dev = omap_plane->base.dev;
 73
 74	omap_framebuffer_unpin(val);
 75	mutex_lock(&dev->mode_config.mutex);
 76	drm_framebuffer_unreference(val);
 77	mutex_unlock(&dev->mode_config.mutex);
 78}
 79
 80/* update which fb (if any) is pinned for scanout */
 81static int update_pin(struct drm_plane *plane, struct drm_framebuffer *fb)
 82{
 83	struct omap_plane *omap_plane = to_omap_plane(plane);
 84	struct drm_framebuffer *pinned_fb = omap_plane->pinned_fb;
 85
 86	if (pinned_fb != fb) {
 87		int ret = 0;
 88
 89		DBG("%p -> %p", pinned_fb, fb);
 90
 91		if (fb) {
 92			drm_framebuffer_reference(fb);
 93			ret = omap_framebuffer_pin(fb);
 94		}
 95
 96		if (pinned_fb)
 97			drm_flip_work_queue(&omap_plane->unpin_work, pinned_fb);
 98
 99		if (ret) {
100			dev_err(plane->dev->dev, "could not swap %p -> %p\n",
101					omap_plane->pinned_fb, fb);
102			drm_framebuffer_unreference(fb);
103			omap_plane->pinned_fb = NULL;
104			return ret;
105		}
106
107		omap_plane->pinned_fb = fb;
108	}
109
110	return 0;
111}
112
113static void omap_plane_pre_apply(struct omap_drm_apply *apply)
114{
115	struct omap_plane *omap_plane =
116			container_of(apply, struct omap_plane, apply);
117	struct omap_drm_window *win = &omap_plane->win;
118	struct drm_plane *plane = &omap_plane->base;
119	struct drm_device *dev = plane->dev;
120	struct omap_overlay_info *info = &omap_plane->info;
121	struct drm_crtc *crtc = plane->crtc;
122	enum omap_channel channel;
123	bool enabled = omap_plane->enabled && crtc;
124	bool ilace, replication;
125	u32 low, high;
126	int ret;
127
128	DBG("%s, enabled=%d", omap_plane->name, enabled);
129
130	/* if fb has changed, pin new fb: */
131	update_pin(plane, enabled ? plane->fb : NULL);
132
133	if (!enabled) {
134		dispc_ovl_enable(omap_plane->id, false);
135		return;
136	}
137
138	channel = omap_crtc_channel(crtc);
139
140	/* update scanout: */
141	omap_framebuffer_update_scanout(plane->fb, win, info);
142
143	DBG("%dx%d -> %dx%d (%d)", info->width, info->height,
144			info->out_width, info->out_height,
145			info->screen_width);
146	DBG("%d,%d %08x %08x", info->pos_x, info->pos_y,
147			info->paddr, info->p_uv_addr);
148
149	/* TODO: */
150	ilace = false;
151	replication = false;
152
153	dispc_ovl_compute_fifo_thresholds(omap_plane->id, &low, &high,
154		false, false);
155	dispc_ovl_set_fifo_threshold(omap_plane->id, low, high);
156
157	/* and finally, update omapdss: */
158	ret = dispc_ovl_setup(omap_plane->id, info,
159			replication, omap_crtc_timings(crtc), false);
160	if (ret) {
161		dev_err(dev->dev, "dispc_ovl_setup failed: %d\n", ret);
162		return;
163	}
164
165	dispc_ovl_enable(omap_plane->id, true);
166	dispc_ovl_set_channel_out(omap_plane->id, channel);
167}
168
169static void omap_plane_post_apply(struct omap_drm_apply *apply)
170{
171	struct omap_plane *omap_plane =
172			container_of(apply, struct omap_plane, apply);
173	struct drm_plane *plane = &omap_plane->base;
174	struct omap_drm_private *priv = plane->dev->dev_private;
175	struct omap_overlay_info *info = &omap_plane->info;
176	struct callback cb;
177
178	cb = omap_plane->apply_done_cb;
179	omap_plane->apply_done_cb.fxn = NULL;
180
181	drm_flip_work_commit(&omap_plane->unpin_work, priv->wq);
182
183	if (cb.fxn)
184		cb.fxn(cb.arg);
185
186	if (omap_plane->enabled) {
187		omap_framebuffer_flush(plane->fb, info->pos_x, info->pos_y,
188				info->out_width, info->out_height);
189	}
190}
191
192static int apply(struct drm_plane *plane)
193{
194	if (plane->crtc) {
195		struct omap_plane *omap_plane = to_omap_plane(plane);
196		return omap_crtc_apply(plane->crtc, &omap_plane->apply);
197	}
198	return 0;
199}
200
201int omap_plane_mode_set(struct drm_plane *plane,
202		struct drm_crtc *crtc, struct drm_framebuffer *fb,
203		int crtc_x, int crtc_y,
204		unsigned int crtc_w, unsigned int crtc_h,
205		uint32_t src_x, uint32_t src_y,
206		uint32_t src_w, uint32_t src_h,
207		void (*fxn)(void *), void *arg)
208{
209	struct omap_plane *omap_plane = to_omap_plane(plane);
210	struct omap_drm_window *win = &omap_plane->win;
211
212	win->crtc_x = crtc_x;
213	win->crtc_y = crtc_y;
214	win->crtc_w = crtc_w;
215	win->crtc_h = crtc_h;
216
217	/* src values are in Q16 fixed point, convert to integer: */
218	win->src_x = src_x >> 16;
219	win->src_y = src_y >> 16;
220	win->src_w = src_w >> 16;
221	win->src_h = src_h >> 16;
222
223	if (fxn) {
224		/* omap_crtc should ensure that a new page flip
225		 * isn't permitted while there is one pending:
226		 */
227		BUG_ON(omap_plane->apply_done_cb.fxn);
228
229		omap_plane->apply_done_cb.fxn = fxn;
230		omap_plane->apply_done_cb.arg = arg;
231	}
232
233	plane->fb = fb;
234	plane->crtc = crtc;
235
236	return apply(plane);
237}
238
239static int omap_plane_update(struct drm_plane *plane,
240		struct drm_crtc *crtc, struct drm_framebuffer *fb,
241		int crtc_x, int crtc_y,
242		unsigned int crtc_w, unsigned int crtc_h,
243		uint32_t src_x, uint32_t src_y,
244		uint32_t src_w, uint32_t src_h)
245{
246	struct omap_plane *omap_plane = to_omap_plane(plane);
247	omap_plane->enabled = true;
248
249	if (plane->fb)
250		drm_framebuffer_unreference(plane->fb);
251
252	drm_framebuffer_reference(fb);
253
254	return omap_plane_mode_set(plane, crtc, fb,
255			crtc_x, crtc_y, crtc_w, crtc_h,
256			src_x, src_y, src_w, src_h,
257			NULL, NULL);
258}
259
260static int omap_plane_disable(struct drm_plane *plane)
261{
262	struct omap_plane *omap_plane = to_omap_plane(plane);
263	omap_plane->win.rotation = BIT(DRM_ROTATE_0);
264	return omap_plane_dpms(plane, DRM_MODE_DPMS_OFF);
265}
266
267static void omap_plane_destroy(struct drm_plane *plane)
268{
269	struct omap_plane *omap_plane = to_omap_plane(plane);
270
271	DBG("%s", omap_plane->name);
272
273	omap_irq_unregister(plane->dev, &omap_plane->error_irq);
274
275	omap_plane_disable(plane);
276	drm_plane_cleanup(plane);
277
278	drm_flip_work_cleanup(&omap_plane->unpin_work);
279
280	kfree(omap_plane);
281}
282
283int omap_plane_dpms(struct drm_plane *plane, int mode)
284{
285	struct omap_plane *omap_plane = to_omap_plane(plane);
286	bool enabled = (mode == DRM_MODE_DPMS_ON);
287	int ret = 0;
288
289	if (enabled != omap_plane->enabled) {
290		omap_plane->enabled = enabled;
291		ret = apply(plane);
292	}
293
294	return ret;
295}
296
297/* helper to install properties which are common to planes and crtcs */
298void omap_plane_install_properties(struct drm_plane *plane,
299		struct drm_mode_object *obj)
300{
301	struct drm_device *dev = plane->dev;
302	struct omap_drm_private *priv = dev->dev_private;
303	struct drm_property *prop;
304
305	if (priv->has_dmm) {
306		prop = priv->rotation_prop;
307		if (!prop) {
308			const struct drm_prop_enum_list props[] = {
309					{ DRM_ROTATE_0,   "rotate-0" },
310					{ DRM_ROTATE_90,  "rotate-90" },
311					{ DRM_ROTATE_180, "rotate-180" },
312					{ DRM_ROTATE_270, "rotate-270" },
313					{ DRM_REFLECT_X,  "reflect-x" },
314					{ DRM_REFLECT_Y,  "reflect-y" },
315			};
316			prop = drm_property_create_bitmask(dev, 0, "rotation",
317					props, ARRAY_SIZE(props));
318			if (prop == NULL)
319				return;
320			priv->rotation_prop = prop;
321		}
322		drm_object_attach_property(obj, prop, 0);
323	}
324
325	prop = priv->zorder_prop;
326	if (!prop) {
327		prop = drm_property_create_range(dev, 0, "zorder", 0, 3);
328		if (prop == NULL)
329			return;
330		priv->zorder_prop = prop;
331	}
332	drm_object_attach_property(obj, prop, 0);
333}
334
335int omap_plane_set_property(struct drm_plane *plane,
336		struct drm_property *property, uint64_t val)
337{
338	struct omap_plane *omap_plane = to_omap_plane(plane);
339	struct omap_drm_private *priv = plane->dev->dev_private;
340	int ret = -EINVAL;
341
342	if (property == priv->rotation_prop) {
343		DBG("%s: rotation: %02x", omap_plane->name, (uint32_t)val);
344		omap_plane->win.rotation = val;
345		ret = apply(plane);
346	} else if (property == priv->zorder_prop) {
347		DBG("%s: zorder: %02x", omap_plane->name, (uint32_t)val);
348		omap_plane->info.zorder = val;
349		ret = apply(plane);
350	}
351
352	return ret;
353}
354
355static const struct drm_plane_funcs omap_plane_funcs = {
356		.update_plane = omap_plane_update,
357		.disable_plane = omap_plane_disable,
358		.destroy = omap_plane_destroy,
359		.set_property = omap_plane_set_property,
360};
361
362static void omap_plane_error_irq(struct omap_drm_irq *irq, uint32_t irqstatus)
363{
364	struct omap_plane *omap_plane =
365			container_of(irq, struct omap_plane, error_irq);
366	DRM_ERROR("%s: errors: %08x\n", omap_plane->name, irqstatus);
367}
368
369static const char *plane_names[] = {
370		[OMAP_DSS_GFX] = "gfx",
371		[OMAP_DSS_VIDEO1] = "vid1",
372		[OMAP_DSS_VIDEO2] = "vid2",
373		[OMAP_DSS_VIDEO3] = "vid3",
374};
375
376static const uint32_t error_irqs[] = {
377		[OMAP_DSS_GFX] = DISPC_IRQ_GFX_FIFO_UNDERFLOW,
378		[OMAP_DSS_VIDEO1] = DISPC_IRQ_VID1_FIFO_UNDERFLOW,
379		[OMAP_DSS_VIDEO2] = DISPC_IRQ_VID2_FIFO_UNDERFLOW,
380		[OMAP_DSS_VIDEO3] = DISPC_IRQ_VID3_FIFO_UNDERFLOW,
381};
382
383/* initialize plane */
384struct drm_plane *omap_plane_init(struct drm_device *dev,
385		int id, bool private_plane)
386{
387	struct omap_drm_private *priv = dev->dev_private;
388	struct drm_plane *plane = NULL;
389	struct omap_plane *omap_plane;
390	struct omap_overlay_info *info;
391	int ret;
392
393	DBG("%s: priv=%d", plane_names[id], private_plane);
394
395	omap_plane = kzalloc(sizeof(*omap_plane), GFP_KERNEL);
396	if (!omap_plane)
397		goto fail;
398
399	ret = drm_flip_work_init(&omap_plane->unpin_work, 16,
400			"unpin", unpin_worker);
401	if (ret) {
402		dev_err(dev->dev, "could not allocate unpin FIFO\n");
403		goto fail;
404	}
405
406	omap_plane->nformats = omap_framebuffer_get_formats(
407			omap_plane->formats, ARRAY_SIZE(omap_plane->formats),
408			dss_feat_get_supported_color_modes(id));
409	omap_plane->id = id;
410	omap_plane->name = plane_names[id];
411
412	plane = &omap_plane->base;
413
414	omap_plane->apply.pre_apply  = omap_plane_pre_apply;
415	omap_plane->apply.post_apply = omap_plane_post_apply;
416
417	omap_plane->error_irq.irqmask = error_irqs[id];
418	omap_plane->error_irq.irq = omap_plane_error_irq;
419	omap_irq_register(dev, &omap_plane->error_irq);
420
421	drm_plane_init(dev, plane, (1 << priv->num_crtcs) - 1, &omap_plane_funcs,
422			omap_plane->formats, omap_plane->nformats, private_plane);
423
424	omap_plane_install_properties(plane, &plane->base);
425
426	/* get our starting configuration, set defaults for parameters
427	 * we don't currently use, etc:
428	 */
429	info = &omap_plane->info;
430	info->rotation_type = OMAP_DSS_ROT_DMA;
431	info->rotation = OMAP_DSS_ROT_0;
432	info->global_alpha = 0xff;
433	info->mirror = 0;
434
435	/* Set defaults depending on whether we are a CRTC or overlay
436	 * layer.
437	 * TODO add ioctl to give userspace an API to change this.. this
438	 * will come in a subsequent patch.
439	 */
440	if (private_plane)
441		omap_plane->info.zorder = 0;
442	else
443		omap_plane->info.zorder = id;
444
445	return plane;
446
447fail:
448	if (plane)
449		omap_plane_destroy(plane);
450
451	return NULL;
452}