| /* | 
 |  * i.MX IPUv3 DP Overlay Planes | 
 |  * | 
 |  * Copyright (C) 2013 Philipp Zabel, Pengutronix | 
 |  * | 
 |  * This program is free software; you can redistribute it and/or | 
 |  * modify it under the terms of the GNU General Public License | 
 |  * as published by the Free Software Foundation; either version 2 | 
 |  * of the License, or (at your option) any later version. | 
 |  * This program is distributed in the hope that it will be useful, | 
 |  * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
 |  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
 |  * GNU General Public License for more details. | 
 |  */ | 
 |  | 
 | #include <drm/drmP.h> | 
 | #include <drm/drm_atomic.h> | 
 | #include <drm/drm_atomic_helper.h> | 
 | #include <drm/drm_fb_cma_helper.h> | 
 | #include <drm/drm_gem_cma_helper.h> | 
 | #include <drm/drm_plane_helper.h> | 
 |  | 
 | #include "video/imx-ipu-v3.h" | 
 | #include "ipuv3-plane.h" | 
 |  | 
 | struct ipu_plane_state { | 
 | 	struct drm_plane_state base; | 
 | 	bool use_pre; | 
 | }; | 
 |  | 
 | static inline struct ipu_plane_state * | 
 | to_ipu_plane_state(struct drm_plane_state *p) | 
 | { | 
 | 	return container_of(p, struct ipu_plane_state, base); | 
 | } | 
 |  | 
 | static inline struct ipu_plane *to_ipu_plane(struct drm_plane *p) | 
 | { | 
 | 	return container_of(p, struct ipu_plane, base); | 
 | } | 
 |  | 
 | static const uint32_t ipu_plane_formats[] = { | 
 | 	DRM_FORMAT_ARGB1555, | 
 | 	DRM_FORMAT_XRGB1555, | 
 | 	DRM_FORMAT_ABGR1555, | 
 | 	DRM_FORMAT_XBGR1555, | 
 | 	DRM_FORMAT_RGBA5551, | 
 | 	DRM_FORMAT_BGRA5551, | 
 | 	DRM_FORMAT_ARGB4444, | 
 | 	DRM_FORMAT_ARGB8888, | 
 | 	DRM_FORMAT_XRGB8888, | 
 | 	DRM_FORMAT_ABGR8888, | 
 | 	DRM_FORMAT_XBGR8888, | 
 | 	DRM_FORMAT_RGBA8888, | 
 | 	DRM_FORMAT_RGBX8888, | 
 | 	DRM_FORMAT_BGRA8888, | 
 | 	DRM_FORMAT_BGRA8888, | 
 | 	DRM_FORMAT_UYVY, | 
 | 	DRM_FORMAT_VYUY, | 
 | 	DRM_FORMAT_YUYV, | 
 | 	DRM_FORMAT_YVYU, | 
 | 	DRM_FORMAT_YUV420, | 
 | 	DRM_FORMAT_YVU420, | 
 | 	DRM_FORMAT_YUV422, | 
 | 	DRM_FORMAT_YVU422, | 
 | 	DRM_FORMAT_YUV444, | 
 | 	DRM_FORMAT_YVU444, | 
 | 	DRM_FORMAT_NV12, | 
 | 	DRM_FORMAT_NV16, | 
 | 	DRM_FORMAT_RGB565, | 
 | 	DRM_FORMAT_RGB565_A8, | 
 | 	DRM_FORMAT_BGR565_A8, | 
 | 	DRM_FORMAT_RGB888_A8, | 
 | 	DRM_FORMAT_BGR888_A8, | 
 | 	DRM_FORMAT_RGBX8888_A8, | 
 | 	DRM_FORMAT_BGRX8888_A8, | 
 | }; | 
 |  | 
 | int ipu_plane_irq(struct ipu_plane *ipu_plane) | 
 | { | 
 | 	return ipu_idmac_channel_irq(ipu_plane->ipu, ipu_plane->ipu_ch, | 
 | 				     IPU_IRQ_EOF); | 
 | } | 
 |  | 
 | static inline unsigned long | 
 | drm_plane_state_to_eba(struct drm_plane_state *state, int plane) | 
 | { | 
 | 	struct drm_framebuffer *fb = state->fb; | 
 | 	struct drm_gem_cma_object *cma_obj; | 
 | 	int x = state->src.x1 >> 16; | 
 | 	int y = state->src.y1 >> 16; | 
 |  | 
 | 	cma_obj = drm_fb_cma_get_gem_obj(fb, plane); | 
 | 	BUG_ON(!cma_obj); | 
 |  | 
 | 	return cma_obj->paddr + fb->offsets[plane] + fb->pitches[plane] * y + | 
 | 	       fb->format->cpp[plane] * x; | 
 | } | 
 |  | 
 | static inline unsigned long | 
 | drm_plane_state_to_ubo(struct drm_plane_state *state) | 
 | { | 
 | 	struct drm_framebuffer *fb = state->fb; | 
 | 	struct drm_gem_cma_object *cma_obj; | 
 | 	unsigned long eba = drm_plane_state_to_eba(state, 0); | 
 | 	int x = state->src.x1 >> 16; | 
 | 	int y = state->src.y1 >> 16; | 
 |  | 
 | 	cma_obj = drm_fb_cma_get_gem_obj(fb, 1); | 
 | 	BUG_ON(!cma_obj); | 
 |  | 
 | 	x /= drm_format_horz_chroma_subsampling(fb->format->format); | 
 | 	y /= drm_format_vert_chroma_subsampling(fb->format->format); | 
 |  | 
 | 	return cma_obj->paddr + fb->offsets[1] + fb->pitches[1] * y + | 
 | 	       fb->format->cpp[1] * x - eba; | 
 | } | 
 |  | 
 | static inline unsigned long | 
 | drm_plane_state_to_vbo(struct drm_plane_state *state) | 
 | { | 
 | 	struct drm_framebuffer *fb = state->fb; | 
 | 	struct drm_gem_cma_object *cma_obj; | 
 | 	unsigned long eba = drm_plane_state_to_eba(state, 0); | 
 | 	int x = state->src.x1 >> 16; | 
 | 	int y = state->src.y1 >> 16; | 
 |  | 
 | 	cma_obj = drm_fb_cma_get_gem_obj(fb, 2); | 
 | 	BUG_ON(!cma_obj); | 
 |  | 
 | 	x /= drm_format_horz_chroma_subsampling(fb->format->format); | 
 | 	y /= drm_format_vert_chroma_subsampling(fb->format->format); | 
 |  | 
 | 	return cma_obj->paddr + fb->offsets[2] + fb->pitches[2] * y + | 
 | 	       fb->format->cpp[2] * x - eba; | 
 | } | 
 |  | 
 | void ipu_plane_put_resources(struct ipu_plane *ipu_plane) | 
 | { | 
 | 	if (!IS_ERR_OR_NULL(ipu_plane->dp)) | 
 | 		ipu_dp_put(ipu_plane->dp); | 
 | 	if (!IS_ERR_OR_NULL(ipu_plane->dmfc)) | 
 | 		ipu_dmfc_put(ipu_plane->dmfc); | 
 | 	if (!IS_ERR_OR_NULL(ipu_plane->ipu_ch)) | 
 | 		ipu_idmac_put(ipu_plane->ipu_ch); | 
 | 	if (!IS_ERR_OR_NULL(ipu_plane->alpha_ch)) | 
 | 		ipu_idmac_put(ipu_plane->alpha_ch); | 
 | } | 
 |  | 
 | int ipu_plane_get_resources(struct ipu_plane *ipu_plane) | 
 | { | 
 | 	int ret; | 
 | 	int alpha_ch; | 
 |  | 
 | 	ipu_plane->ipu_ch = ipu_idmac_get(ipu_plane->ipu, ipu_plane->dma); | 
 | 	if (IS_ERR(ipu_plane->ipu_ch)) { | 
 | 		ret = PTR_ERR(ipu_plane->ipu_ch); | 
 | 		DRM_ERROR("failed to get idmac channel: %d\n", ret); | 
 | 		return ret; | 
 | 	} | 
 |  | 
 | 	alpha_ch = ipu_channel_alpha_channel(ipu_plane->dma); | 
 | 	if (alpha_ch >= 0) { | 
 | 		ipu_plane->alpha_ch = ipu_idmac_get(ipu_plane->ipu, alpha_ch); | 
 | 		if (IS_ERR(ipu_plane->alpha_ch)) { | 
 | 			ret = PTR_ERR(ipu_plane->alpha_ch); | 
 | 			DRM_ERROR("failed to get alpha idmac channel %d: %d\n", | 
 | 				  alpha_ch, ret); | 
 | 			return ret; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	ipu_plane->dmfc = ipu_dmfc_get(ipu_plane->ipu, ipu_plane->dma); | 
 | 	if (IS_ERR(ipu_plane->dmfc)) { | 
 | 		ret = PTR_ERR(ipu_plane->dmfc); | 
 | 		DRM_ERROR("failed to get dmfc: ret %d\n", ret); | 
 | 		goto err_out; | 
 | 	} | 
 |  | 
 | 	if (ipu_plane->dp_flow >= 0) { | 
 | 		ipu_plane->dp = ipu_dp_get(ipu_plane->ipu, ipu_plane->dp_flow); | 
 | 		if (IS_ERR(ipu_plane->dp)) { | 
 | 			ret = PTR_ERR(ipu_plane->dp); | 
 | 			DRM_ERROR("failed to get dp flow: %d\n", ret); | 
 | 			goto err_out; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | err_out: | 
 | 	ipu_plane_put_resources(ipu_plane); | 
 |  | 
 | 	return ret; | 
 | } | 
 |  | 
 | static bool ipu_plane_separate_alpha(struct ipu_plane *ipu_plane) | 
 | { | 
 | 	switch (ipu_plane->base.state->fb->format->format) { | 
 | 	case DRM_FORMAT_RGB565_A8: | 
 | 	case DRM_FORMAT_BGR565_A8: | 
 | 	case DRM_FORMAT_RGB888_A8: | 
 | 	case DRM_FORMAT_BGR888_A8: | 
 | 	case DRM_FORMAT_RGBX8888_A8: | 
 | 	case DRM_FORMAT_BGRX8888_A8: | 
 | 		return true; | 
 | 	default: | 
 | 		return false; | 
 | 	} | 
 | } | 
 |  | 
 | static void ipu_plane_enable(struct ipu_plane *ipu_plane) | 
 | { | 
 | 	if (ipu_plane->dp) | 
 | 		ipu_dp_enable(ipu_plane->ipu); | 
 | 	ipu_dmfc_enable_channel(ipu_plane->dmfc); | 
 | 	ipu_idmac_enable_channel(ipu_plane->ipu_ch); | 
 | 	if (ipu_plane_separate_alpha(ipu_plane)) | 
 | 		ipu_idmac_enable_channel(ipu_plane->alpha_ch); | 
 | 	if (ipu_plane->dp) | 
 | 		ipu_dp_enable_channel(ipu_plane->dp); | 
 | } | 
 |  | 
 | void ipu_plane_disable(struct ipu_plane *ipu_plane, bool disable_dp_channel) | 
 | { | 
 | 	DRM_DEBUG_KMS("[%d] %s\n", __LINE__, __func__); | 
 |  | 
 | 	ipu_idmac_wait_busy(ipu_plane->ipu_ch, 50); | 
 |  | 
 | 	if (ipu_plane->dp && disable_dp_channel) | 
 | 		ipu_dp_disable_channel(ipu_plane->dp, false); | 
 | 	ipu_idmac_disable_channel(ipu_plane->ipu_ch); | 
 | 	if (ipu_plane->alpha_ch) | 
 | 		ipu_idmac_disable_channel(ipu_plane->alpha_ch); | 
 | 	ipu_dmfc_disable_channel(ipu_plane->dmfc); | 
 | 	if (ipu_plane->dp) | 
 | 		ipu_dp_disable(ipu_plane->ipu); | 
 | 	if (ipu_prg_present(ipu_plane->ipu)) | 
 | 		ipu_prg_channel_disable(ipu_plane->ipu_ch); | 
 | } | 
 |  | 
 | void ipu_plane_disable_deferred(struct drm_plane *plane) | 
 | { | 
 | 	struct ipu_plane *ipu_plane = to_ipu_plane(plane); | 
 |  | 
 | 	if (ipu_plane->disabling) { | 
 | 		ipu_plane->disabling = false; | 
 | 		ipu_plane_disable(ipu_plane, false); | 
 | 	} | 
 | } | 
 | EXPORT_SYMBOL_GPL(ipu_plane_disable_deferred); | 
 |  | 
 | static void ipu_plane_destroy(struct drm_plane *plane) | 
 | { | 
 | 	struct ipu_plane *ipu_plane = to_ipu_plane(plane); | 
 |  | 
 | 	DRM_DEBUG_KMS("[%d] %s\n", __LINE__, __func__); | 
 |  | 
 | 	drm_plane_cleanup(plane); | 
 | 	kfree(ipu_plane); | 
 | } | 
 |  | 
 | void ipu_plane_state_reset(struct drm_plane *plane) | 
 | { | 
 | 	struct ipu_plane_state *ipu_state; | 
 |  | 
 | 	if (plane->state) { | 
 | 		ipu_state = to_ipu_plane_state(plane->state); | 
 | 		__drm_atomic_helper_plane_destroy_state(plane->state); | 
 | 		kfree(ipu_state); | 
 | 	} | 
 |  | 
 | 	ipu_state = kzalloc(sizeof(*ipu_state), GFP_KERNEL); | 
 |  | 
 | 	if (ipu_state) { | 
 | 		ipu_state->base.plane = plane; | 
 | 		ipu_state->base.rotation = DRM_MODE_ROTATE_0; | 
 | 	} | 
 |  | 
 | 	plane->state = &ipu_state->base; | 
 | } | 
 |  | 
 | struct drm_plane_state *ipu_plane_duplicate_state(struct drm_plane *plane) | 
 | { | 
 | 	struct ipu_plane_state *state; | 
 |  | 
 | 	if (WARN_ON(!plane->state)) | 
 | 		return NULL; | 
 |  | 
 | 	state = kmalloc(sizeof(*state), GFP_KERNEL); | 
 | 	if (state) | 
 | 		__drm_atomic_helper_plane_duplicate_state(plane, &state->base); | 
 |  | 
 | 	return &state->base; | 
 | } | 
 |  | 
 | void ipu_plane_destroy_state(struct drm_plane *plane, | 
 | 			     struct drm_plane_state *state) | 
 | { | 
 | 	struct ipu_plane_state *ipu_state = to_ipu_plane_state(state); | 
 |  | 
 | 	__drm_atomic_helper_plane_destroy_state(state); | 
 | 	kfree(ipu_state); | 
 | } | 
 |  | 
 | static const struct drm_plane_funcs ipu_plane_funcs = { | 
 | 	.update_plane	= drm_atomic_helper_update_plane, | 
 | 	.disable_plane	= drm_atomic_helper_disable_plane, | 
 | 	.destroy	= ipu_plane_destroy, | 
 | 	.reset		= ipu_plane_state_reset, | 
 | 	.atomic_duplicate_state	= ipu_plane_duplicate_state, | 
 | 	.atomic_destroy_state	= ipu_plane_destroy_state, | 
 | }; | 
 |  | 
 | static int ipu_plane_atomic_check(struct drm_plane *plane, | 
 | 				  struct drm_plane_state *state) | 
 | { | 
 | 	struct drm_plane_state *old_state = plane->state; | 
 | 	struct drm_crtc_state *crtc_state; | 
 | 	struct device *dev = plane->dev->dev; | 
 | 	struct drm_framebuffer *fb = state->fb; | 
 | 	struct drm_framebuffer *old_fb = old_state->fb; | 
 | 	unsigned long eba, ubo, vbo, old_ubo, old_vbo, alpha_eba; | 
 | 	bool can_position = (plane->type == DRM_PLANE_TYPE_OVERLAY); | 
 | 	struct drm_rect clip; | 
 | 	int hsub, vsub; | 
 | 	int ret; | 
 |  | 
 | 	/* Ok to disable */ | 
 | 	if (!fb) | 
 | 		return 0; | 
 |  | 
 | 	if (!state->crtc) | 
 | 		return -EINVAL; | 
 |  | 
 | 	crtc_state = | 
 | 		drm_atomic_get_existing_crtc_state(state->state, state->crtc); | 
 | 	if (WARN_ON(!crtc_state)) | 
 | 		return -EINVAL; | 
 |  | 
 | 	clip.x1 = 0; | 
 | 	clip.y1 = 0; | 
 | 	clip.x2 = crtc_state->adjusted_mode.hdisplay; | 
 | 	clip.y2 = crtc_state->adjusted_mode.vdisplay; | 
 | 	ret = drm_plane_helper_check_state(state, &clip, | 
 | 					   DRM_PLANE_HELPER_NO_SCALING, | 
 | 					   DRM_PLANE_HELPER_NO_SCALING, | 
 | 					   can_position, true); | 
 | 	if (ret) | 
 | 		return ret; | 
 |  | 
 | 	/* CRTC should be enabled */ | 
 | 	if (!crtc_state->enable) | 
 | 		return -EINVAL; | 
 |  | 
 | 	switch (plane->type) { | 
 | 	case DRM_PLANE_TYPE_PRIMARY: | 
 | 		/* full plane minimum width is 13 pixels */ | 
 | 		if (drm_rect_width(&state->dst) < 13) | 
 | 			return -EINVAL; | 
 | 		break; | 
 | 	case DRM_PLANE_TYPE_OVERLAY: | 
 | 		break; | 
 | 	default: | 
 | 		dev_warn(dev, "Unsupported plane type %d\n", plane->type); | 
 | 		return -EINVAL; | 
 | 	} | 
 |  | 
 | 	if (drm_rect_height(&state->dst) < 2) | 
 | 		return -EINVAL; | 
 |  | 
 | 	/* | 
 | 	 * We support resizing active plane or changing its format by | 
 | 	 * forcing CRTC mode change in plane's ->atomic_check callback | 
 | 	 * and disabling all affected active planes in CRTC's ->atomic_disable | 
 | 	 * callback.  The planes will be reenabled in plane's ->atomic_update | 
 | 	 * callback. | 
 | 	 */ | 
 | 	if (old_fb && | 
 | 	    (drm_rect_width(&state->dst) != drm_rect_width(&old_state->dst) || | 
 | 	     drm_rect_height(&state->dst) != drm_rect_height(&old_state->dst) || | 
 | 	     fb->format != old_fb->format)) | 
 | 		crtc_state->mode_changed = true; | 
 |  | 
 | 	eba = drm_plane_state_to_eba(state, 0); | 
 |  | 
 | 	if (eba & 0x7) | 
 | 		return -EINVAL; | 
 |  | 
 | 	if (fb->pitches[0] < 1 || fb->pitches[0] > 16384) | 
 | 		return -EINVAL; | 
 |  | 
 | 	if (old_fb && fb->pitches[0] != old_fb->pitches[0]) | 
 | 		crtc_state->mode_changed = true; | 
 |  | 
 | 	switch (fb->format->format) { | 
 | 	case DRM_FORMAT_YUV420: | 
 | 	case DRM_FORMAT_YVU420: | 
 | 	case DRM_FORMAT_YUV422: | 
 | 	case DRM_FORMAT_YVU422: | 
 | 	case DRM_FORMAT_YUV444: | 
 | 	case DRM_FORMAT_YVU444: | 
 | 		/* | 
 | 		 * Multiplanar formats have to meet the following restrictions: | 
 | 		 * - The (up to) three plane addresses are EBA, EBA+UBO, EBA+VBO | 
 | 		 * - EBA, UBO and VBO are a multiple of 8 | 
 | 		 * - UBO and VBO are unsigned and not larger than 0xfffff8 | 
 | 		 * - Only EBA may be changed while scanout is active | 
 | 		 * - The strides of U and V planes must be identical. | 
 | 		 */ | 
 | 		vbo = drm_plane_state_to_vbo(state); | 
 |  | 
 | 		if (vbo & 0x7 || vbo > 0xfffff8) | 
 | 			return -EINVAL; | 
 |  | 
 | 		if (old_fb && (fb->format == old_fb->format)) { | 
 | 			old_vbo = drm_plane_state_to_vbo(old_state); | 
 | 			if (vbo != old_vbo) | 
 | 				crtc_state->mode_changed = true; | 
 | 		} | 
 |  | 
 | 		if (fb->pitches[1] != fb->pitches[2]) | 
 | 			return -EINVAL; | 
 |  | 
 | 		/* fall-through */ | 
 | 	case DRM_FORMAT_NV12: | 
 | 	case DRM_FORMAT_NV16: | 
 | 		ubo = drm_plane_state_to_ubo(state); | 
 |  | 
 | 		if (ubo & 0x7 || ubo > 0xfffff8) | 
 | 			return -EINVAL; | 
 |  | 
 | 		if (old_fb && (fb->format == old_fb->format)) { | 
 | 			old_ubo = drm_plane_state_to_ubo(old_state); | 
 | 			if (ubo != old_ubo) | 
 | 				crtc_state->mode_changed = true; | 
 | 		} | 
 |  | 
 | 		if (fb->pitches[1] < 1 || fb->pitches[1] > 16384) | 
 | 			return -EINVAL; | 
 |  | 
 | 		if (old_fb && old_fb->pitches[1] != fb->pitches[1]) | 
 | 			crtc_state->mode_changed = true; | 
 |  | 
 | 		/* | 
 | 		 * The x/y offsets must be even in case of horizontal/vertical | 
 | 		 * chroma subsampling. | 
 | 		 */ | 
 | 		hsub = drm_format_horz_chroma_subsampling(fb->format->format); | 
 | 		vsub = drm_format_vert_chroma_subsampling(fb->format->format); | 
 | 		if (((state->src.x1 >> 16) & (hsub - 1)) || | 
 | 		    ((state->src.y1 >> 16) & (vsub - 1))) | 
 | 			return -EINVAL; | 
 | 		break; | 
 | 	case DRM_FORMAT_RGB565_A8: | 
 | 	case DRM_FORMAT_BGR565_A8: | 
 | 	case DRM_FORMAT_RGB888_A8: | 
 | 	case DRM_FORMAT_BGR888_A8: | 
 | 	case DRM_FORMAT_RGBX8888_A8: | 
 | 	case DRM_FORMAT_BGRX8888_A8: | 
 | 		alpha_eba = drm_plane_state_to_eba(state, 1); | 
 | 		if (alpha_eba & 0x7) | 
 | 			return -EINVAL; | 
 |  | 
 | 		if (fb->pitches[1] < 1 || fb->pitches[1] > 16384) | 
 | 			return -EINVAL; | 
 |  | 
 | 		if (old_fb && old_fb->pitches[1] != fb->pitches[1]) | 
 | 			crtc_state->mode_changed = true; | 
 | 		break; | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static void ipu_plane_atomic_disable(struct drm_plane *plane, | 
 | 				     struct drm_plane_state *old_state) | 
 | { | 
 | 	struct ipu_plane *ipu_plane = to_ipu_plane(plane); | 
 |  | 
 | 	if (ipu_plane->dp) | 
 | 		ipu_dp_disable_channel(ipu_plane->dp, true); | 
 | 	ipu_plane->disabling = true; | 
 | } | 
 |  | 
 | static int ipu_chan_assign_axi_id(int ipu_chan) | 
 | { | 
 | 	switch (ipu_chan) { | 
 | 	case IPUV3_CHANNEL_MEM_BG_SYNC: | 
 | 		return 1; | 
 | 	case IPUV3_CHANNEL_MEM_FG_SYNC: | 
 | 		return 2; | 
 | 	case IPUV3_CHANNEL_MEM_DC_SYNC: | 
 | 		return 3; | 
 | 	default: | 
 | 		return 0; | 
 | 	} | 
 | } | 
 |  | 
 | static void ipu_plane_atomic_update(struct drm_plane *plane, | 
 | 				    struct drm_plane_state *old_state) | 
 | { | 
 | 	struct ipu_plane *ipu_plane = to_ipu_plane(plane); | 
 | 	struct drm_plane_state *state = plane->state; | 
 | 	struct ipu_plane_state *ipu_state = to_ipu_plane_state(state); | 
 | 	struct drm_crtc_state *crtc_state = state->crtc->state; | 
 | 	struct drm_framebuffer *fb = state->fb; | 
 | 	struct drm_rect *dst = &state->dst; | 
 | 	unsigned long eba, ubo, vbo; | 
 | 	unsigned long alpha_eba = 0; | 
 | 	enum ipu_color_space ics; | 
 | 	unsigned int axi_id = 0; | 
 | 	int active; | 
 |  | 
 | 	if (ipu_plane->dp_flow == IPU_DP_FLOW_SYNC_FG) | 
 | 		ipu_dp_set_window_pos(ipu_plane->dp, dst->x1, dst->y1); | 
 |  | 
 | 	eba = drm_plane_state_to_eba(state, 0); | 
 |  | 
 | 	/* | 
 | 	 * Configure PRG channel and attached PRE, this changes the EBA to an | 
 | 	 * internal SRAM location. | 
 | 	 */ | 
 | 	if (ipu_state->use_pre) { | 
 | 		axi_id = ipu_chan_assign_axi_id(ipu_plane->dma); | 
 | 		ipu_prg_channel_configure(ipu_plane->ipu_ch, axi_id, | 
 | 					  drm_rect_width(&state->src) >> 16, | 
 | 					  drm_rect_height(&state->src) >> 16, | 
 | 					  state->fb->pitches[0], | 
 | 					  state->fb->format->format, &eba); | 
 | 	} | 
 |  | 
 | 	if (old_state->fb && !drm_atomic_crtc_needs_modeset(crtc_state)) { | 
 | 		/* nothing to do if PRE is used */ | 
 | 		if (ipu_state->use_pre) | 
 | 			return; | 
 | 		active = ipu_idmac_get_current_buffer(ipu_plane->ipu_ch); | 
 | 		ipu_cpmem_set_buffer(ipu_plane->ipu_ch, !active, eba); | 
 | 		ipu_idmac_select_buffer(ipu_plane->ipu_ch, !active); | 
 | 		if (ipu_plane_separate_alpha(ipu_plane)) { | 
 | 			active = ipu_idmac_get_current_buffer(ipu_plane->alpha_ch); | 
 | 			ipu_cpmem_set_buffer(ipu_plane->alpha_ch, !active, | 
 | 					     alpha_eba); | 
 | 			ipu_idmac_select_buffer(ipu_plane->alpha_ch, !active); | 
 | 		} | 
 | 		return; | 
 | 	} | 
 |  | 
 | 	switch (ipu_plane->dp_flow) { | 
 | 	case IPU_DP_FLOW_SYNC_BG: | 
 | 		ipu_dp_setup_channel(ipu_plane->dp, | 
 | 					IPUV3_COLORSPACE_RGB, | 
 | 					IPUV3_COLORSPACE_RGB); | 
 | 		ipu_dp_set_global_alpha(ipu_plane->dp, true, 0, true); | 
 | 		break; | 
 | 	case IPU_DP_FLOW_SYNC_FG: | 
 | 		ics = ipu_drm_fourcc_to_colorspace(state->fb->format->format); | 
 | 		ipu_dp_setup_channel(ipu_plane->dp, ics, | 
 | 					IPUV3_COLORSPACE_UNKNOWN); | 
 | 		/* Enable local alpha on partial plane */ | 
 | 		switch (state->fb->format->format) { | 
 | 		case DRM_FORMAT_ARGB1555: | 
 | 		case DRM_FORMAT_ABGR1555: | 
 | 		case DRM_FORMAT_RGBA5551: | 
 | 		case DRM_FORMAT_BGRA5551: | 
 | 		case DRM_FORMAT_ARGB4444: | 
 | 		case DRM_FORMAT_ARGB8888: | 
 | 		case DRM_FORMAT_ABGR8888: | 
 | 		case DRM_FORMAT_RGBA8888: | 
 | 		case DRM_FORMAT_BGRA8888: | 
 | 		case DRM_FORMAT_RGB565_A8: | 
 | 		case DRM_FORMAT_BGR565_A8: | 
 | 		case DRM_FORMAT_RGB888_A8: | 
 | 		case DRM_FORMAT_BGR888_A8: | 
 | 		case DRM_FORMAT_RGBX8888_A8: | 
 | 		case DRM_FORMAT_BGRX8888_A8: | 
 | 			ipu_dp_set_global_alpha(ipu_plane->dp, false, 0, false); | 
 | 			break; | 
 | 		default: | 
 | 			ipu_dp_set_global_alpha(ipu_plane->dp, true, 0, true); | 
 | 			break; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	ipu_dmfc_config_wait4eot(ipu_plane->dmfc, drm_rect_width(dst)); | 
 |  | 
 | 	ipu_cpmem_zero(ipu_plane->ipu_ch); | 
 | 	ipu_cpmem_set_resolution(ipu_plane->ipu_ch, | 
 | 				 drm_rect_width(&state->src) >> 16, | 
 | 				 drm_rect_height(&state->src) >> 16); | 
 | 	ipu_cpmem_set_fmt(ipu_plane->ipu_ch, state->fb->format->format); | 
 | 	ipu_cpmem_set_high_priority(ipu_plane->ipu_ch); | 
 | 	ipu_idmac_set_double_buffer(ipu_plane->ipu_ch, 1); | 
 | 	ipu_cpmem_set_stride(ipu_plane->ipu_ch, state->fb->pitches[0]); | 
 | 	ipu_cpmem_set_axi_id(ipu_plane->ipu_ch, axi_id); | 
 | 	switch (fb->format->format) { | 
 | 	case DRM_FORMAT_YUV420: | 
 | 	case DRM_FORMAT_YVU420: | 
 | 	case DRM_FORMAT_YUV422: | 
 | 	case DRM_FORMAT_YVU422: | 
 | 	case DRM_FORMAT_YUV444: | 
 | 	case DRM_FORMAT_YVU444: | 
 | 		ubo = drm_plane_state_to_ubo(state); | 
 | 		vbo = drm_plane_state_to_vbo(state); | 
 | 		if (fb->format->format == DRM_FORMAT_YVU420 || | 
 | 		    fb->format->format == DRM_FORMAT_YVU422 || | 
 | 		    fb->format->format == DRM_FORMAT_YVU444) | 
 | 			swap(ubo, vbo); | 
 |  | 
 | 		ipu_cpmem_set_yuv_planar_full(ipu_plane->ipu_ch, | 
 | 					      fb->pitches[1], ubo, vbo); | 
 |  | 
 | 		dev_dbg(ipu_plane->base.dev->dev, | 
 | 			"phy = %lu %lu %lu, x = %d, y = %d", eba, ubo, vbo, | 
 | 			state->src.x1 >> 16, state->src.y1 >> 16); | 
 | 		break; | 
 | 	case DRM_FORMAT_NV12: | 
 | 	case DRM_FORMAT_NV16: | 
 | 		ubo = drm_plane_state_to_ubo(state); | 
 |  | 
 | 		ipu_cpmem_set_yuv_planar_full(ipu_plane->ipu_ch, | 
 | 					      fb->pitches[1], ubo, ubo); | 
 |  | 
 | 		dev_dbg(ipu_plane->base.dev->dev, | 
 | 			"phy = %lu %lu, x = %d, y = %d", eba, ubo, | 
 | 			state->src.x1 >> 16, state->src.y1 >> 16); | 
 | 		break; | 
 | 	case DRM_FORMAT_RGB565_A8: | 
 | 	case DRM_FORMAT_BGR565_A8: | 
 | 	case DRM_FORMAT_RGB888_A8: | 
 | 	case DRM_FORMAT_BGR888_A8: | 
 | 	case DRM_FORMAT_RGBX8888_A8: | 
 | 	case DRM_FORMAT_BGRX8888_A8: | 
 | 		alpha_eba = drm_plane_state_to_eba(state, 1); | 
 |  | 
 | 		dev_dbg(ipu_plane->base.dev->dev, "phys = %lu %lu, x = %d, y = %d", | 
 | 			eba, alpha_eba, state->src.x1 >> 16, state->src.y1 >> 16); | 
 |  | 
 | 		ipu_cpmem_set_burstsize(ipu_plane->ipu_ch, 16); | 
 |  | 
 | 		ipu_cpmem_zero(ipu_plane->alpha_ch); | 
 | 		ipu_cpmem_set_resolution(ipu_plane->alpha_ch, | 
 | 					 drm_rect_width(&state->src) >> 16, | 
 | 					 drm_rect_height(&state->src) >> 16); | 
 | 		ipu_cpmem_set_format_passthrough(ipu_plane->alpha_ch, 8); | 
 | 		ipu_cpmem_set_high_priority(ipu_plane->alpha_ch); | 
 | 		ipu_idmac_set_double_buffer(ipu_plane->alpha_ch, 1); | 
 | 		ipu_cpmem_set_stride(ipu_plane->alpha_ch, | 
 | 				     state->fb->pitches[1]); | 
 | 		ipu_cpmem_set_burstsize(ipu_plane->alpha_ch, 16); | 
 | 		ipu_cpmem_set_buffer(ipu_plane->alpha_ch, 0, alpha_eba); | 
 | 		ipu_cpmem_set_buffer(ipu_plane->alpha_ch, 1, alpha_eba); | 
 | 		break; | 
 | 	default: | 
 | 		dev_dbg(ipu_plane->base.dev->dev, "phys = %lu, x = %d, y = %d", | 
 | 			eba, state->src.x1 >> 16, state->src.y1 >> 16); | 
 | 		break; | 
 | 	} | 
 | 	ipu_cpmem_set_buffer(ipu_plane->ipu_ch, 0, eba); | 
 | 	ipu_cpmem_set_buffer(ipu_plane->ipu_ch, 1, eba); | 
 | 	ipu_plane_enable(ipu_plane); | 
 | } | 
 |  | 
 | static const struct drm_plane_helper_funcs ipu_plane_helper_funcs = { | 
 | 	.prepare_fb = drm_fb_cma_prepare_fb, | 
 | 	.atomic_check = ipu_plane_atomic_check, | 
 | 	.atomic_disable = ipu_plane_atomic_disable, | 
 | 	.atomic_update = ipu_plane_atomic_update, | 
 | }; | 
 |  | 
 | int ipu_planes_assign_pre(struct drm_device *dev, | 
 | 			  struct drm_atomic_state *state) | 
 | { | 
 | 	struct drm_plane_state *plane_state; | 
 | 	struct drm_plane *plane; | 
 | 	int available_pres = ipu_prg_max_active_channels(); | 
 | 	int i; | 
 |  | 
 | 	for_each_plane_in_state(state, plane, plane_state, i) { | 
 | 		struct ipu_plane_state *ipu_state = | 
 | 				to_ipu_plane_state(plane_state); | 
 | 		struct ipu_plane *ipu_plane = to_ipu_plane(plane); | 
 |  | 
 | 		if (ipu_prg_present(ipu_plane->ipu) && available_pres && | 
 | 		    plane_state->fb && | 
 | 		    ipu_prg_format_supported(ipu_plane->ipu, | 
 | 					     plane_state->fb->format->format, | 
 | 					     plane_state->fb->modifier)) { | 
 | 			ipu_state->use_pre = true; | 
 | 			available_pres--; | 
 | 		} else { | 
 | 			ipu_state->use_pre = false; | 
 | 		} | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | } | 
 | EXPORT_SYMBOL_GPL(ipu_planes_assign_pre); | 
 |  | 
 | struct ipu_plane *ipu_plane_init(struct drm_device *dev, struct ipu_soc *ipu, | 
 | 				 int dma, int dp, unsigned int possible_crtcs, | 
 | 				 enum drm_plane_type type) | 
 | { | 
 | 	struct ipu_plane *ipu_plane; | 
 | 	int ret; | 
 |  | 
 | 	DRM_DEBUG_KMS("channel %d, dp flow %d, possible_crtcs=0x%x\n", | 
 | 		      dma, dp, possible_crtcs); | 
 |  | 
 | 	ipu_plane = kzalloc(sizeof(*ipu_plane), GFP_KERNEL); | 
 | 	if (!ipu_plane) { | 
 | 		DRM_ERROR("failed to allocate plane\n"); | 
 | 		return ERR_PTR(-ENOMEM); | 
 | 	} | 
 |  | 
 | 	ipu_plane->ipu = ipu; | 
 | 	ipu_plane->dma = dma; | 
 | 	ipu_plane->dp_flow = dp; | 
 |  | 
 | 	ret = drm_universal_plane_init(dev, &ipu_plane->base, possible_crtcs, | 
 | 				       &ipu_plane_funcs, ipu_plane_formats, | 
 | 				       ARRAY_SIZE(ipu_plane_formats), type, | 
 | 				       NULL); | 
 | 	if (ret) { | 
 | 		DRM_ERROR("failed to initialize plane\n"); | 
 | 		kfree(ipu_plane); | 
 | 		return ERR_PTR(ret); | 
 | 	} | 
 |  | 
 | 	drm_plane_helper_add(&ipu_plane->base, &ipu_plane_helper_funcs); | 
 |  | 
 | 	return ipu_plane; | 
 | } |