~hc/RK356X_SDK_RELEASE.git

..	..	@@ -1,59 +1,56 @@
	1	+// SPDX-License-Identifier: GPL-2.0-only
1	2	/*
2	3	* Copyright (C) Fuzhou Rockchip Electronics Co.Ltd
3	4	* Author:Mark Yao <mark.yao@rock-chips.com>
4		- *
5		- * This software is licensed under the terms of the GNU General Public
6		- * License version 2, as published by the Free Software Foundation, and
7		- * may be copied, distributed, and modified under those terms.
8		- *
9		- * This program is distributed in the hope that it will be useful,
10		- * but WITHOUT ANY WARRANTY; without even the implied warranty of
11		- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12		- * GNU General Public License for more details.
13	5	*/
14	6
	7	+#include <linux/clk.h>
	8	+#include <linux/component.h>
	9	+#include <linux/debugfs.h>
	10	+#include <linux/delay.h>
	11	+#include <linux/fixp-arith.h>
	12	+#include <linux/iopoll.h>
	13	+#include <linux/kernel.h>
	14	+#include <linux/mfd/syscon.h>
	15	+#include <linux/module.h>
	16	+#include <linux/of.h>
	17	+#include <linux/of_device.h>
	18	+#include <linux/overflow.h>
	19	+#include <linux/platform_device.h>
	20	+#include <linux/pm_runtime.h>
	21	+#include <linux/regmap.h>
	22	+#include <linux/reset.h>
	23	+#include <linux/sort.h>
	24	+
15	25	#include <drm/drm.h>
16		-#include <drm/drmP.h>
17	26	#include <drm/drm_atomic.h>
	27	+#include <drm/drm_atomic_uapi.h>
18	28	#include <drm/drm_crtc.h>
19	29	#include <drm/drm_crtc_helper.h>
	30	+#include <drm/drm_debugfs.h>
20	31	#include <drm/drm_flip_work.h>
	32	+#include <drm/drm_fourcc.h>
	33	+#include <drm/drm_gem_framebuffer_helper.h>
21	34	#include <drm/drm_plane_helper.h>
	35	+#include <drm/drm_probe_helper.h>
	36	+#include <drm/drm_self_refresh_helper.h>
	37	+#include <drm/drm_vblank.h>
	38	+
22	39	#ifdef CONFIG_DRM_ANALOGIX_DP
23	40	#include <drm/bridge/analogix_dp.h>
24	41	#endif
25	42	#include <dt-bindings/soc/rockchip-system-status.h>
26	43
27		-#include <linux/debugfs.h>
28		-#include <linux/fixp-arith.h>
29		-#include <linux/iopoll.h>
30		-#include <linux/kernel.h>
31		-#include <linux/module.h>
32		-#include <linux/platform_device.h>
33		-#include <linux/clk.h>
34		-#include <linux/iopoll.h>
35		-#include <linux/of.h>
36		-#include <linux/of_device.h>
37		-#include <linux/pm_runtime.h>
38		-#include <linux/component.h>
39		-#include <linux/overflow.h>
40		-#include <linux/regmap.h>
41		-#include <linux/mfd/syscon.h>
42		-
43		-#include <linux/reset.h>
44		-#include <linux/delay.h>
45		-#include <linux/sort.h>
46	44	#include <soc/rockchip/rockchip_dmc.h>
47	45	#include <soc/rockchip/rockchip-system-status.h>
48	46	#include <uapi/linux/videodev2.h>
49		-
50		-#include "../drm_internal.h"
	47	+#include "../drm_crtc_internal.h"
51	48
52	49	#include "rockchip_drm_drv.h"
53	50	#include "rockchip_drm_gem.h"
54	51	#include "rockchip_drm_fb.h"
55		-#include "rockchip_drm_psr.h"
56	52	#include "rockchip_drm_vop.h"
	53	+#include "rockchip_rgb.h"
57	54
58	55	#define VOP_REG_SUPPORT(vop, reg) \
59	56	(reg.mask && \
..	..	@@ -151,7 +148,6 @@
151	148	} \
152	149	} while (0)
153	150
154		-#define to_vop(x) container_of(x, struct vop, crtc)
155	151	#define to_vop_win(x) container_of(x, struct vop_win, base)
156	152	#define to_vop_plane_state(x) container_of(x, struct vop_plane_state, base)
157	153
..	..	@@ -172,7 +168,6 @@
172	168	struct drm_rect dest;
173	169	dma_addr_t yrgb_mst;
174	170	dma_addr_t uv_mst;
175		- void *yrgb_kvaddr;
176	171	const uint32_t *y2r_table;
177	172	const uint32_t *r2r_table;
178	173	const uint32_t *r2y_table;
..	..	@@ -181,7 +176,7 @@
181	176	bool r2r_en;
182	177	bool r2y_en;
183	178	int color_space;
184		- int color_key;
	179	+ u32 color_key;
185	180	unsigned int csc_mode;
186	181	int global_alpha;
187	182	int blend_mode;
..	..	@@ -191,21 +186,15 @@
191	186	struct vop_dump_list *planlist;
192	187	};
193	188
194		-struct rockchip_mcu_timing {
195		- int mcu_pix_total;
196		- int mcu_cs_pst;
197		- int mcu_cs_pend;
198		- int mcu_rw_pst;
199		- int mcu_rw_pend;
200		- int mcu_hold_mode;
201		-};
202		-
203	189	struct vop_win {
204	190	struct vop_win *parent;
205	191	struct drm_plane base;
206	192
207	193	int win_id;
208	194	int area_id;
	195	+ u8 plane_id; /* unique plane id */
	196	+ const char *name;
	197	+
209	198	int zpos;
210	199	uint32_t offset;
211	200	enum drm_plane_type type;
..	..	@@ -213,28 +202,45 @@
213	202	const struct vop_csc *csc;
214	203	const uint32_t *data_formats;
215	204	uint32_t nformats;
	205	+ const uint64_t *format_modifiers;
216	206	u64 feature;
217	207	struct vop *vop;
218	208	struct vop_plane_state state;
219	209
	210	+ struct drm_property *input_width_prop;
	211	+ struct drm_property *input_height_prop;
	212	+ struct drm_property *output_width_prop;
	213	+ struct drm_property *output_height_prop;
220	214	struct drm_property *color_key_prop;
	215	+ struct drm_property *scale_prop;
	216	+ struct drm_property *name_prop;
221	217	};
222	218
223	219	struct vop {
224		- struct drm_crtc crtc;
	220	+ struct rockchip_crtc rockchip_crtc;
225	221	struct device *dev;
226	222	struct drm_device *drm_dev;
227	223	struct dentry *debugfs;
228	224	struct drm_info_list *debugfs_files;
229		- struct drm_property *plane_zpos_prop;
230	225	struct drm_property *plane_feature_prop;
	226	+ struct drm_property *plane_mask_prop;
231	227	struct drm_property *feature_prop;
	228	+
232	229	bool is_iommu_enabled;
233	230	bool is_iommu_needed;
234	231	bool is_enabled;
235	232	bool support_multi_area;
236	233
	234	+ bool aclk_rate_reset;
	235	+ unsigned long aclk_rate;
	236	+
237	237	u32 version;
	238	+ u32 background;
	239	+ u32 line_flag;
	240	+ u8 id;
	241	+ u8 plane_mask;
	242	+ u64 soc_id;
	243	+ struct drm_prop_enum_list *plane_name_list;
238	244
239	245	struct drm_tv_connector_state active_tv_state;
240	246	bool pre_overlay;
..	..	@@ -308,13 +314,12 @@
308	314	{ MEDIA_BUS_FMT_RGB666_1X18, "RGB666_1X18" },
309	315	{ MEDIA_BUS_FMT_RGB666_1X24_CPADHI, "RGB666_1X24_CPADHI" },
310	316	{ MEDIA_BUS_FMT_RGB666_1X7X3_SPWG, "RGB666_1X7X3_SPWG" },
311		- { MEDIA_BUS_FMT_RGB666_1X7X3_JEIDA, "RGB666_1X7X3_JEIDA" },
312	317	{ MEDIA_BUS_FMT_YUV8_1X24, "YUV8_1X24" },
313	318	{ MEDIA_BUS_FMT_UYYVYY8_0_5X24, "UYYVYY8_0_5X24" },
314	319	{ MEDIA_BUS_FMT_YUV10_1X30, "YUV10_1X30" },
315	320	{ MEDIA_BUS_FMT_UYYVYY10_0_5X30, "UYYVYY10_0_5X30" },
316		- { MEDIA_BUS_FMT_SRGB888_3X8, "SRGB888_3X8" },
317		- { MEDIA_BUS_FMT_SRGB888_DUMMY_4X8, "SRGB888_DUMMY_4X8" },
	321	+ { MEDIA_BUS_FMT_RGB888_3X8, "RGB888_3X8" },
	322	+ { MEDIA_BUS_FMT_RGB888_DUMMY_4X8, "RGB888_DUMMY_4X8" },
318	323	{ MEDIA_BUS_FMT_RGB888_1X24, "RGB888_1X24" },
319	324	{ MEDIA_BUS_FMT_RGB888_1X7X4_SPWG, "RGB888_1X7X4_SPWG" },
320	325	{ MEDIA_BUS_FMT_RGB888_1X7X4_JEIDA, "RGB888_1X7X4_JEIDA" },
..	..	@@ -324,6 +329,15 @@
324	329	};
325	330
326	331	static DRM_ENUM_NAME_FN(drm_get_bus_format_name, drm_bus_format_enum_list)
	332	+
	333	+static inline struct vop to_vop(struct drm_crtc crtc)
	334	+{
	335	+ struct rockchip_crtc *rockchip_crtc;
	336	+
	337	+ rockchip_crtc = container_of(crtc, struct rockchip_crtc, crtc);
	338	+
	339	+ return container_of(rockchip_crtc, struct vop, rockchip_crtc);
	340	+}
327	341
328	342	static void vop_lock(struct vop *vop)
329	343	{
..	..	@@ -583,20 +597,46 @@
583	597	case DRM_FORMAT_BGR565:
584	598	return VOP_FMT_RGB565;
585	599	case DRM_FORMAT_NV12:
586		- case DRM_FORMAT_NV12_10:
	600	+ case DRM_FORMAT_NV15:
587	601	return VOP_FMT_YUV420SP;
588	602	case DRM_FORMAT_NV16:
589		- case DRM_FORMAT_NV16_10:
	603	+ case DRM_FORMAT_NV20:
590	604	return VOP_FMT_YUV422SP;
591	605	case DRM_FORMAT_NV24:
592		- case DRM_FORMAT_NV24_10:
	606	+ case DRM_FORMAT_NV30:
593	607	return VOP_FMT_YUV444SP;
	608	+ case DRM_FORMAT_YVYU:
	609	+ case DRM_FORMAT_VYUY:
594	610	case DRM_FORMAT_YUYV:
	611	+ case DRM_FORMAT_UYVY:
595	612	return VOP_FMT_YUYV;
596	613	default:
597	614	DRM_ERROR("unsupported format[%08x]\n", format);
598	615	return -EINVAL;
599	616	}
	617	+}
	618	+
	619	+static int vop_convert_afbc_format(uint32_t format)
	620	+{
	621	+ switch (format) {
	622	+ case DRM_FORMAT_XRGB8888:
	623	+ case DRM_FORMAT_ARGB8888:
	624	+ case DRM_FORMAT_XBGR8888:
	625	+ case DRM_FORMAT_ABGR8888:
	626	+ return AFBDC_FMT_U8U8U8U8;
	627	+ case DRM_FORMAT_RGB888:
	628	+ case DRM_FORMAT_BGR888:
	629	+ return AFBDC_FMT_U8U8U8;
	630	+ case DRM_FORMAT_RGB565:
	631	+ case DRM_FORMAT_BGR565:
	632	+ return AFBDC_FMT_RGB565;
	633	+ /* either of the below should not be reachable */
	634	+ default:
	635	+ DRM_WARN_ONCE("unsupported AFBC format[%08x]\n", format);
	636	+ return -EINVAL;
	637	+ }
	638	+
	639	+ return -EINVAL;
600	640	}
601	641
602	642	static bool is_uv_swap(uint32_t bus_format, uint32_t output_mode)
..	..	@@ -618,6 +658,21 @@
618	658	bus_format == MEDIA_BUS_FMT_YUV10_1X30) &&
619	659	(output_mode == ROCKCHIP_OUT_MODE_AAAA \|\|
620	660	output_mode == ROCKCHIP_OUT_MODE_P888)))
	661	+ return true;
	662	+ else
	663	+ return false;
	664	+}
	665	+
	666	+static bool is_rb_swap(uint32_t bus_format, uint32_t output_mode)
	667	+{
	668	+ /*
	669	+ * The default component order of serial formats
	670	+ * is BGR. So it is needed to enable RB swap.
	671	+ */
	672	+ if (bus_format == MEDIA_BUS_FMT_RGB888_3X8 \|\|
	673	+ bus_format == MEDIA_BUS_FMT_RGB888_DUMMY_4X8 \|\|
	674	+ bus_format == MEDIA_BUS_FMT_RGB666_3X6 \|\|
	675	+ bus_format == MEDIA_BUS_FMT_RGB565_2X8_LE)
621	676	return true;
622	677	else
623	678	return false;
..	..	@@ -661,12 +716,15 @@
661	716	{
662	717	switch (format) {
663	718	case DRM_FORMAT_NV12:
664		- case DRM_FORMAT_NV12_10:
	719	+ case DRM_FORMAT_NV15:
665	720	case DRM_FORMAT_NV16:
666		- case DRM_FORMAT_NV16_10:
	721	+ case DRM_FORMAT_NV20:
667	722	case DRM_FORMAT_NV24:
668		- case DRM_FORMAT_NV24_10:
	723	+ case DRM_FORMAT_NV30:
	724	+ case DRM_FORMAT_YVYU:
	725	+ case DRM_FORMAT_VYUY:
669	726	case DRM_FORMAT_YUYV:
	727	+ case DRM_FORMAT_UYVY:
670	728	return true;
671	729	default:
672	730	return false;
..	..	@@ -676,7 +734,10 @@
676	734	static bool is_yuyv_format(uint32_t format)
677	735	{
678	736	switch (format) {
	737	+ case DRM_FORMAT_YVYU:
	738	+ case DRM_FORMAT_VYUY:
679	739	case DRM_FORMAT_YUYV:
	740	+ case DRM_FORMAT_UYVY:
680	741	return true;
681	742	default:
682	743	return false;
..	..	@@ -686,9 +747,9 @@
686	747	static bool is_yuv_10bit(uint32_t format)
687	748	{
688	749	switch (format) {
689		- case DRM_FORMAT_NV12_10:
690		- case DRM_FORMAT_NV16_10:
691		- case DRM_FORMAT_NV24_10:
	750	+ case DRM_FORMAT_NV15:
	751	+ case DRM_FORMAT_NV20:
	752	+ case DRM_FORMAT_NV30:
692	753	return true;
693	754	default:
694	755	return false;
..	..	@@ -704,6 +765,20 @@
704	765	default:
705	766	return false;
706	767	}
	768	+}
	769	+
	770	+static inline bool rockchip_afbc(struct drm_plane *plane, u64 modifier)
	771	+{
	772	+ int i;
	773	+
	774	+ if (modifier == DRM_FORMAT_MOD_LINEAR)
	775	+ return false;
	776	+
	777	+ for (i = 0 ; i < plane->modifier_count; i++)
	778	+ if (plane->modifiers[i] == modifier)
	779	+ break;
	780	+
	781	+ return (i < plane->modifier_count) ? true : false;
707	782	}
708	783
709	784	static uint16_t scl_vop_cal_scale(enum scale_mode mode, uint32_t src,
..	..	@@ -747,9 +822,9 @@
747	822	uint16_t yrgb_hor_scl_mode, yrgb_ver_scl_mode;
748	823	uint16_t cbcr_hor_scl_mode = SCALE_NONE;
749	824	uint16_t cbcr_ver_scl_mode = SCALE_NONE;
750		- int hsub = drm_format_horz_chroma_subsampling(pixel_format);
751		- int vsub = drm_format_vert_chroma_subsampling(pixel_format);
752		- const struct drm_format_info *info;
	825	+ const struct drm_format_info *info = drm_format_info(pixel_format);
	826	+ uint8_t hsub = info->hsub;
	827	+ uint8_t vsub = info->vsub;
753	828	bool is_yuv = false;
754	829	uint16_t cbcr_src_w = src_w / hsub;
755	830	uint16_t cbcr_src_h = src_h / vsub;
..	..	@@ -757,17 +832,27 @@
757	832	uint16_t lb_mode;
758	833	uint32_t val;
759	834	const struct vop_data *vop_data = vop->data;
	835	+ struct drm_display_mode *adjusted_mode = &vop->rockchip_crtc.crtc.state->adjusted_mode;
760	836	int vskiplines;
761	837
762	838	if (!win->phy->scl)
763	839	return;
	840	+
	841	+ if ((adjusted_mode->flags & DRM_MODE_FLAG_INTERLACE) && vop->version == VOP_VERSION(2, 2)) {
	842	+ VOP_SCL_SET(vop, win, scale_yrgb_x, ((src_w << 12) / dst_w));
	843	+ VOP_SCL_SET(vop, win, scale_yrgb_y, ((src_h << 12) / dst_h));
	844	+ if (is_yuv) {
	845	+ VOP_SCL_SET(vop, win, scale_cbcr_x, ((cbcr_src_w << 12) / dst_w));
	846	+ VOP_SCL_SET(vop, win, scale_cbcr_y, ((cbcr_src_h << 12) / dst_h));
	847	+ }
	848	+ return;
	849	+ }
764	850
765	851	if (!(vop_data->feature & VOP_FEATURE_ALPHA_SCALE)) {
766	852	if (is_alpha_support(pixel_format) &&
767	853	(src_w != dst_w \|\| src_h != dst_h))
768	854	DRM_ERROR("ERROR: unsupported ppixel alpha&scale\n");
769	855	}
770		- info = drm_format_info(pixel_format);
771	856
772	857	if (info->is_yuv)
773	858	is_yuv = true;
..	..	@@ -1193,7 +1278,7 @@
1193	1278	* UI(rgbx) -> yuv -> rgb ->hdr2sdr -> overlay -> output.
1194	1279	*/
1195	1280	if (s->hdr.hdr2sdr_en &&
1196		- vop_plane_state->eotf == SMPTE_ST2084 &&
	1281	+ vop_plane_state->eotf == HDMI_EOTF_SMPTE_ST2084 &&
1197	1282	!is_yuv_support(pstate->fb->format->format))
1198	1283	vop_plane_state->r2y_en = true;
1199	1284	if (win->feature & WIN_FEATURE_PRE_OVERLAY)
..	..	@@ -1533,6 +1618,18 @@
1533	1618	vop_enable_debug_irq(crtc);
1534	1619	}
1535	1620
	1621	+static void vop_crtc_atomic_disable_for_psr(struct drm_crtc *crtc,
	1622	+ struct drm_crtc_state *old_state)
	1623	+{
	1624	+ struct vop *vop = to_vop(crtc);
	1625	+
	1626	+ vop_disable_all_planes(vop);
	1627	+ drm_crtc_vblank_off(crtc);
	1628	+ vop->aclk_rate = clk_get_rate(vop->aclk);
	1629	+ clk_set_rate(vop->aclk, vop->aclk_rate / 3);
	1630	+ vop->aclk_rate_reset = true;
	1631	+}
	1632	+
1536	1633	static void vop_crtc_atomic_disable(struct drm_crtc *crtc,
1537	1634	struct drm_crtc_state *old_state)
1538	1635	{
..	..	@@ -1541,6 +1638,11 @@
1541	1638	SYS_STATUS_LCDC1 : SYS_STATUS_LCDC0;
1542	1639
1543	1640	WARN_ON(vop->event);
	1641	+
	1642	+ if (crtc->state->self_refresh_active) {
	1643	+ vop_crtc_atomic_disable_for_psr(crtc, old_state);
	1644	+ goto out;
	1645	+ }
1544	1646
1545	1647	vop_lock(vop);
1546	1648	VOP_CTRL_SET(vop, reg_done_frm, 1);
..	..	@@ -1589,6 +1691,7 @@
1589	1691
1590	1692	rockchip_clear_system_status(sys_status);
1591	1693
	1694	+out:
1592	1695	if (crtc->state->event && !crtc->state->active) {
1593	1696	spin_lock_irq(&crtc->dev->event_lock);
1594	1697	drm_crtc_send_vblank_event(crtc, crtc->state->event);
..	..	@@ -1614,6 +1717,21 @@
1614	1717	drm_framebuffer_put(old_state->fb);
1615	1718	}
1616	1719
	1720	+static bool rockchip_vop_mod_supported(struct drm_plane *plane,
	1721	+ u32 format, u64 modifier)
	1722	+{
	1723	+ if (modifier == DRM_FORMAT_MOD_LINEAR)
	1724	+ return true;
	1725	+
	1726	+ if (!rockchip_afbc(plane, modifier)) {
	1727	+ DRM_DEBUG_KMS("Unsupported format modifier 0x%llx\n", modifier);
	1728	+
	1729	+ return false;
	1730	+ }
	1731	+
	1732	+ return vop_convert_afbc_format(format) >= 0;
	1733	+}
	1734	+
1617	1735	static int vop_plane_atomic_check(struct drm_plane *plane,
1618	1736	struct drm_plane_state *state)
1619	1737	{
..	..	@@ -1627,13 +1745,14 @@
1627	1745	int ret;
1628	1746	struct drm_rect *dest = &vop_plane_state->dest;
1629	1747	struct drm_rect *src = &vop_plane_state->src;
	1748	+ struct drm_gem_object obj, uv_obj;
	1749	+ struct rockchip_gem_object rk_obj, rk_uv_obj;
1630	1750	int min_scale = win->phy->scl ? FRAC_16_16(1, 8) :
1631	1751	DRM_PLANE_HELPER_NO_SCALING;
1632	1752	int max_scale = win->phy->scl ? FRAC_16_16(8, 1) :
1633	1753	DRM_PLANE_HELPER_NO_SCALING;
1634	1754	unsigned long offset;
1635	1755	dma_addr_t dma_addr;
1636		- void *kvaddr;
1637	1756
1638	1757	crtc = crtc ? crtc : plane->state->crtc;
1639	1758	if (!crtc \|\| !fb) {
..	..	@@ -1645,14 +1764,8 @@
1645	1764	if (WARN_ON(!crtc_state))
1646	1765	return -EINVAL;
1647	1766
1648		- src->x1 = state->src_x;
1649		- src->y1 = state->src_y;
1650		- src->x2 = state->src_x + state->src_w;
1651		- src->y2 = state->src_y + state->src_h;
1652		- dest->x1 = state->crtc_x;
1653		- dest->y1 = state->crtc_y;
1654		- dest->x2 = state->crtc_x + state->crtc_w;
1655		- dest->y2 = state->crtc_y + state->crtc_h;
	1767	+ vop_plane_state->zpos = state->zpos;
	1768	+ vop_plane_state->blend_mode = state->pixel_blend_mode;
1656	1769
1657	1770	ret = drm_atomic_helper_check_plane_state(state, crtc_state,
1658	1771	min_scale, max_scale,
..	..	@@ -1660,8 +1773,22 @@
1660	1773	if (ret)
1661	1774	return ret;
1662	1775
1663		- if (!state->visible)
	1776	+ if (!state->visible) {
	1777	+ DRM_ERROR("%s is invisible(src: pos[%d, %d] rect[%d x %d] dst: pos[%d, %d] rect[%d x %d]\n",
	1778	+ plane->name, state->src_x >> 16, state->src_y >> 16, state->src_w >> 16,
	1779	+ state->src_h >> 16, state->crtc_x, state->crtc_y, state->crtc_w,
	1780	+ state->crtc_h);
1664	1781	return 0;
	1782	+ }
	1783	+
	1784	+ src->x1 = state->src.x1;
	1785	+ src->y1 = state->src.y1;
	1786	+ src->x2 = state->src.x2;
	1787	+ src->y2 = state->src.y2;
	1788	+ dest->x1 = state->dst.x1;
	1789	+ dest->y1 = state->dst.y1;
	1790	+ dest->x2 = state->dst.x2;
	1791	+ dest->y2 = state->dst.y2;
1665	1792
1666	1793	vop_plane_state->format = vop_convert_format(fb->format->format);
1667	1794	if (vop_plane_state->format < 0)
..	..	@@ -1670,12 +1797,19 @@
1670	1797	vop = to_vop(crtc);
1671	1798	vop_data = vop->data;
1672	1799
1673		- if (state->src_w >> 16 < 4 \|\| state->src_h >> 16 < 4 \|\|
1674		- state->crtc_w < 4 \|\| state->crtc_h < 4) {
1675		- DRM_ERROR("Invalid size: %dx%d->%dx%d, min size is 4x4\n",
1676		- state->src_w >> 16, state->src_h >> 16,
1677		- state->crtc_w, state->crtc_h);
	1800	+ if (VOP_MAJOR(vop->version) == 2 && is_alpha_support(fb->format->format) &&
	1801	+ vop_plane_state->global_alpha != 0xff) {
	1802	+ DRM_ERROR("Pixel alpha and global alpha can't be enabled at the same time\n");
1678	1803	return -EINVAL;
	1804	+ }
	1805	+
	1806	+ if (drm_rect_width(src) >> 16 < 4 \|\| drm_rect_height(src) >> 16 < 4 \|\|
	1807	+ drm_rect_width(dest) < 4 \|\| drm_rect_width(dest) < 4) {
	1808	+ DRM_ERROR("Invalid size: %dx%d->%dx%d, min size is 4x4\n",
	1809	+ drm_rect_width(src) >> 16, drm_rect_height(src) >> 16,
	1810	+ drm_rect_width(dest), drm_rect_height(dest));
	1811	+ state->visible = false;
	1812	+ return 0;
1679	1813	}
1680	1814
1681	1815	if (drm_rect_width(src) >> 16 > vop_data->max_input.width \|\|
..	..	@@ -1702,26 +1836,27 @@
1702	1836	return -EINVAL;
1703	1837	}
1704	1838
1705		- offset = (src->x1 >> 16) * fb->format->bpp[0] / 8;
	1839	+ offset = (src->x1 >> 16) * fb->format->cpp[0];
1706	1840	vop_plane_state->offset = offset + fb->offsets[0];
1707	1841	if (state->rotation & DRM_MODE_REFLECT_Y)
1708	1842	offset += ((src->y2 >> 16) - 1) * fb->pitches[0];
1709	1843	else
1710	1844	offset += (src->y1 >> 16) * fb->pitches[0];
1711	1845
1712		- dma_addr = rockchip_fb_get_dma_addr(fb, 0);
1713		- kvaddr = rockchip_fb_get_kvaddr(fb, 0);
1714		- vop_plane_state->yrgb_mst = dma_addr + offset + fb->offsets[0];
1715		- vop_plane_state->yrgb_kvaddr = kvaddr + offset + fb->offsets[0];
	1846	+ obj = fb->obj[0];
	1847	+ rk_obj = to_rockchip_obj(obj);
	1848	+ vop_plane_state->yrgb_mst = rk_obj->dma_addr + offset + fb->offsets[0];
1716	1849	if (fb->format->is_yuv) {
1717		- int hsub = drm_format_horz_chroma_subsampling(fb->format->format);
1718		- int vsub = drm_format_vert_chroma_subsampling(fb->format->format);
	1850	+ int hsub = fb->format->hsub;
	1851	+ int vsub = fb->format->vsub;
1719	1852
1720		- offset = (src->x1 >> 16) * fb->format->bpp[1] / hsub / 8;
	1853	+ offset = (src->x1 >> 16) * fb->format->cpp[1] / hsub;
1721	1854	offset += (src->y1 >> 16) * fb->pitches[1] / vsub;
1722	1855
1723		- dma_addr = rockchip_fb_get_dma_addr(fb, 1);
1724		- dma_addr += offset + fb->offsets[1];
	1856	+ uv_obj = fb->obj[1];
	1857	+ rk_uv_obj = to_rockchip_obj(uv_obj);
	1858	+
	1859	+ dma_addr = rk_uv_obj->dma_addr + offset + fb->offsets[1];
1725	1860	vop_plane_state->uv_mst = dma_addr;
1726	1861	}
1727	1862
..	..	@@ -1737,6 +1872,9 @@
1737	1872	struct vop_plane_state *vop_plane_state =
1738	1873	to_vop_plane_state(plane->state);
1739	1874	#endif
	1875	+
	1876	+ rockchip_drm_dbg(vop->dev, VOP_DEBUG_PLANE, "disable win%d-area%d by %s\n",
	1877	+ win->win_id, win->area_id, current->comm);
1740	1878
1741	1879	if (!old_state->crtc)
1742	1880	return;
..	..	@@ -1847,20 +1985,19 @@
1847	1985	uint32_t val;
1848	1986	bool rb_swap, global_alpha_en;
1849	1987	int is_yuv = fb->format->is_yuv;
	1988	+ struct drm_format_name_buf format_name;
1850	1989
1851	1990	#if defined(CONFIG_ROCKCHIP_DRM_DEBUG)
1852	1991	bool AFBC_flag = false;
1853	1992	struct vop_dump_list *planlist;
1854	1993	unsigned long num_pages;
1855	1994	struct page **pages;
1856		- struct rockchip_drm_fb *rk_fb;
1857	1995	struct drm_gem_object *obj;
1858	1996	struct rockchip_gem_object *rk_obj;
1859	1997
1860	1998	num_pages = 0;
1861	1999	pages = NULL;
1862		- rk_fb = to_rockchip_fb(fb);
1863		- obj = rk_fb->obj[0];
	2000	+ obj = fb->obj[0];
1864	2001	rk_obj = to_rockchip_obj(obj);
1865	2002	if (rk_obj) {
1866	2003	num_pages = rk_obj->num_pages;
..	..	@@ -1908,6 +2045,8 @@
1908	2045	dsp_h = 4;
1909	2046	actual_h = dsp_h * actual_h / drm_rect_height(dest);
1910	2047	}
	2048	+ if ((adjusted_mode->flags & DRM_MODE_FLAG_INTERLACE) && vop->version == VOP_VERSION(2, 2))
	2049	+ dsp_h = dsp_h / 2;
1911	2050
1912	2051	act_info = (actual_h - 1) << 16 \| ((actual_w - 1) & 0xffff);
1913	2052
..	..	@@ -1916,12 +2055,18 @@
1916	2055
1917	2056	dsp_stx = dest->x1 + mode->crtc_htotal - mode->crtc_hsync_start;
1918	2057	dsp_sty = dest->y1 + mode->crtc_vtotal - mode->crtc_vsync_start;
	2058	+ if ((adjusted_mode->flags & DRM_MODE_FLAG_INTERLACE) && vop->version == VOP_VERSION(2, 2))
	2059	+ dsp_sty = dest->y1 / 2 + mode->crtc_vtotal - mode->crtc_vsync_start;
1919	2060	dsp_st = dsp_sty << 16 \| (dsp_stx & 0xffff);
1920	2061
1921	2062	s = to_rockchip_crtc_state(crtc->state);
1922	2063	spin_lock(&vop->reg_lock);
1923	2064
1924	2065	VOP_WIN_SET(vop, win, format, vop_plane_state->format);
	2066	+
	2067	+ VOP_WIN_SET(vop, win, interlace_read,
	2068	+ (adjusted_mode->flags & DRM_MODE_FLAG_INTERLACE) ? 1 : 0);
	2069	+
1925	2070	VOP_WIN_SET(vop, win, yrgb_vir, DIV_ROUND_UP(fb->pitches[0], 4));
1926	2071	VOP_WIN_SET(vop, win, yrgb_mst, vop_plane_state->yrgb_mst);
1927	2072
..	..	@@ -1939,7 +2084,7 @@
1939	2084
1940	2085	if (win->phy->scl)
1941	2086	scl_vop_cal_scl_fac(vop, win, actual_w, actual_h,
1942		- drm_rect_width(dest), drm_rect_height(dest),
	2087	+ drm_rect_width(dest), dsp_h,
1943	2088	fb->format->format);
1944	2089
1945	2090	if (VOP_WIN_SUPPORT(vop, win, color_key))
..	..	@@ -1970,7 +2115,6 @@
1970	2115	src_blend_m0 = ALPHA_PER_PIX;
1971	2116	else
1972	2117	src_blend_m0 = ALPHA_GLOBAL;
1973		-
1974	2118
1975	2119	if (vop_plane_state->blend_mode == 0 \|\| src_blend_m0 == ALPHA_GLOBAL)
1976	2120	pre_multi_alpha = ALPHA_SRC_NO_PRE_MUL;
..	..	@@ -2006,6 +2150,13 @@
2006	2150	VOP_WIN_SET(vop, win, enable, 1);
2007	2151	VOP_WIN_SET(vop, win, gate, 1);
2008	2152	spin_unlock(&vop->reg_lock);
	2153	+
	2154	+ drm_get_format_name(fb->format->format, &format_name);
	2155	+ rockchip_drm_dbg(vop->dev, VOP_DEBUG_PLANE,
	2156	+ "update win%d-area%d [%dx%d->%dx%d@(%d, %d)] zpos:%d fmt[%s%s] addr[%pad] by %s\n",
	2157	+ win->win_id, win->area_id, actual_w, actual_h,
	2158	+ dsp_w, dsp_h, dsp_stx, dsp_sty, vop_plane_state->zpos, format_name.str,
	2159	+ fb->modifier ? "[AFBC]" : "", &vop_plane_state->yrgb_mst, current->comm);
2009	2160	/*
2010	2161	* spi interface(vop_plane_state->yrgb_kvaddr, fb->pixel_format,
2011	2162	* actual_w, actual_h)
..	..	@@ -2027,17 +2178,17 @@
2027	2178	planlist->dump_info.offset = vop_plane_state->offset;
2028	2179	planlist->dump_info.pitches = fb->pitches[0];
2029	2180	planlist->dump_info.height = actual_h;
2030		- planlist->dump_info.pixel_format = fb->format->format;
2031		- list_add_tail(&planlist->entry, &crtc->vop_dump_list_head);
	2181	+ planlist->dump_info.format = fb->format;
	2182	+ list_add_tail(&planlist->entry, &vop->rockchip_crtc.vop_dump_list_head);
2032	2183	vop_plane_state->planlist = planlist;
2033	2184	} else {
2034	2185	DRM_ERROR("can't alloc a node of planlist %p\n", planlist);
2035	2186	return;
2036	2187	}
2037		- if (crtc->vop_dump_status == DUMP_KEEP \|\|
2038		- crtc->vop_dump_times > 0) {
2039		- vop_plane_dump(&planlist->dump_info, crtc->frame_count);
2040		- crtc->vop_dump_times--;
	2188	+ if (vop->rockchip_crtc.vop_dump_status == DUMP_KEEP \|\|
	2189	+ vop->rockchip_crtc.vop_dump_times > 0) {
	2190	+ rockchip_drm_dump_plane_buffer(&planlist->dump_info, vop->rockchip_crtc.frame_count);
	2191	+ vop->rockchip_crtc.vop_dump_times--;
2041	2192	}
2042	2193	#endif
2043	2194	}
..	..	@@ -2186,10 +2337,9 @@
2186	2337	if (!vop_plane_state)
2187	2338	return;
2188	2339
2189		- win->state.zpos = win->zpos;
	2340	+ __drm_atomic_helper_plane_reset(plane, &vop_plane_state->base);
	2341	+ vop_plane_state->base.zpos = win->zpos;
2190	2342	vop_plane_state->global_alpha = 0xff;
2191		- plane->state = &vop_plane_state->base;
2192		- plane->state->plane = plane;
2193	2343	}
2194	2344
2195	2345	static struct drm_plane_state *
..	..	@@ -2232,11 +2382,6 @@
2232	2382	struct vop_win *win = to_vop_win(plane);
2233	2383	struct vop_plane_state *plane_state = to_vop_plane_state(state);
2234	2384
2235		- if (property == win->vop->plane_zpos_prop) {
2236		- plane_state->zpos = val;
2237		- return 0;
2238		- }
2239		-
2240	2385	if (property == private->eotf_prop) {
2241	2386	plane_state->eotf = val;
2242	2387	return 0;
..	..	@@ -2244,16 +2389,6 @@
2244	2389
2245	2390	if (property == private->color_space_prop) {
2246	2391	plane_state->color_space = val;
2247		- return 0;
2248		- }
2249		-
2250		- if (property == private->global_alpha_prop) {
2251		- plane_state->global_alpha = val;
2252		- return 0;
2253		- }
2254		-
2255		- if (property == private->blend_mode_prop) {
2256		- plane_state->blend_mode = val;
2257	2392	return 0;
2258	2393	}
2259	2394
..	..	@@ -2282,11 +2417,6 @@
2282	2417	struct vop_win *win = to_vop_win(plane);
2283	2418	struct rockchip_drm_private *private = plane->dev->dev_private;
2284	2419
2285		- if (property == win->vop->plane_zpos_prop) {
2286		- *val = plane_state->zpos;
2287		- return 0;
2288		- }
2289		-
2290	2420	if (property == private->eotf_prop) {
2291	2421	*val = plane_state->eotf;
2292	2422	return 0;
..	..	@@ -2294,16 +2424,6 @@
2294	2424
2295	2425	if (property == private->color_space_prop) {
2296	2426	*val = plane_state->color_space;
2297		- return 0;
2298		- }
2299		-
2300		- if (property == private->global_alpha_prop) {
2301		- *val = plane_state->global_alpha;
2302		- return 0;
2303		- }
2304		-
2305		- if (property == private->blend_mode_prop) {
2306		- *val = plane_state->blend_mode;
2307	2427	return 0;
2308	2428	}
2309	2429
..	..	@@ -2344,6 +2464,7 @@
2344	2464	.atomic_destroy_state = vop_atomic_plane_destroy_state,
2345	2465	.atomic_set_property = vop_atomic_plane_set_property,
2346	2466	.atomic_get_property = vop_atomic_plane_get_property,
	2467	+ .format_mod_supported = rockchip_vop_mod_supported,
2347	2468	};
2348	2469
2349	2470	static int vop_crtc_enable_vblank(struct drm_crtc *crtc)
..	..	@@ -2400,13 +2521,13 @@
2400	2521	if (e && e->base.file_priv == file_priv) {
2401	2522	vop->event = NULL;
2402	2523
2403		- //e->base.destroy(&e->base);//todo
	2524	+ /* e->base.destroy(&e->base);//todo */
2404	2525	file_priv->event_space += sizeof(e->event);
2405	2526	}
2406	2527	spin_unlock_irqrestore(&drm->event_lock, flags);
2407	2528	}
2408	2529
2409		-static int vop_crtc_loader_protect(struct drm_crtc *crtc, bool on)
	2530	+static int vop_crtc_loader_protect(struct drm_crtc crtc, bool on, void data)
2410	2531	{
2411	2532	struct rockchip_drm_private *private = crtc->dev->dev_private;
2412	2533	struct vop *vop = to_vop(crtc);
..	..	@@ -2465,6 +2586,9 @@
2465	2586	struct drm_framebuffer *fb = state->fb;
2466	2587	struct drm_format_name_buf format_name;
2467	2588	int i;
	2589	+ struct drm_gem_object *obj;
	2590	+ struct rockchip_gem_object *rk_obj;
	2591	+ dma_addr_t fb_addr;
2468	2592	u64 afbdc_format =
2469	2593	DRM_FORMAT_MOD_ARM_AFBC(AFBC_FORMAT_MOD_BLOCK_SIZE_16x16);
2470	2594
..	..	@@ -2492,14 +2616,30 @@
2492	2616	DEBUG_PRINT("\tdst: pos[%dx%d] rect[%dx%d]\n", dest->x1, dest->y1,
2493	2617	drm_rect_width(dest), drm_rect_height(dest));
2494	2618
2495		- for (i = 0; i < drm_format_num_planes(fb->format->format); i++) {
2496		- dma_addr_t fb_addr = rockchip_fb_get_dma_addr(fb, i);
	2619	+ for (i = 0; i < fb->format->num_planes; i++) {
	2620	+ obj = fb->obj[0];
	2621	+ rk_obj = to_rockchip_obj(obj);
	2622	+ fb_addr = rk_obj->dma_addr + fb->offsets[0];
2497	2623
2498	2624	DEBUG_PRINT("\tbuf[%d]: addr: %pad pitch: %d offset: %d\n",
2499	2625	i, &fb_addr, fb->pitches[i], fb->offsets[i]);
2500	2626	}
2501	2627
2502	2628	return 0;
	2629	+}
	2630	+
	2631	+static void vop_dump_connector_on_crtc(struct drm_crtc crtc, struct seq_file s)
	2632	+{
	2633	+ struct drm_connector_list_iter conn_iter;
	2634	+ struct drm_connector *connector;
	2635	+
	2636	+ drm_connector_list_iter_begin(crtc->dev, &conn_iter);
	2637	+ drm_for_each_connector_iter(connector, &conn_iter) {
	2638	+ if (crtc->state->connector_mask & drm_connector_mask(connector))
	2639	+ DEBUG_PRINT(" Connector: %s\n", connector->name);
	2640	+
	2641	+ }
	2642	+ drm_connector_list_iter_end(&conn_iter);
2503	2643	}
2504	2644
2505	2645	static int vop_crtc_debugfs_dump(struct drm_crtc crtc, struct seq_file s)
..	..	@@ -2518,8 +2658,7 @@
2518	2658	if (!crtc_state->active)
2519	2659	return 0;
2520	2660
2521		- DEBUG_PRINT(" Connector: %s\n",
2522		- drm_get_connector_name(state->output_type));
	2661	+ vop_dump_connector_on_crtc(crtc, s);
2523	2662	DEBUG_PRINT("\tbus_format[%x]: %s\n", state->bus_format,
2524	2663	drm_get_bus_format_name(state->bus_format));
2525	2664	DEBUG_PRINT("\toverlay_mode[%d] output_mode[%x]",
..	..	@@ -2613,24 +2752,15 @@
2613	2752	goto remove;
2614	2753	}
2615	2754	#if defined(CONFIG_ROCKCHIP_DRM_DEBUG)
2616		- drm_debugfs_vop_add(crtc, vop->debugfs);
	2755	+ rockchip_drm_add_dump_buffer(crtc, vop->debugfs);
2617	2756	#endif
2618	2757	for (i = 0; i < ARRAY_SIZE(vop_debugfs_files); i++)
2619	2758	vop->debugfs_files[i].data = vop;
2620	2759
2621		- ret = drm_debugfs_create_files(vop->debugfs_files,
2622		- ARRAY_SIZE(vop_debugfs_files),
2623		- vop->debugfs,
2624		- minor);
2625		- if (ret) {
2626		- dev_err(vop->dev, "could not install rockchip_debugfs_list\n");
2627		- goto free;
2628		- }
	2760	+ drm_debugfs_create_files(vop->debugfs_files, ARRAY_SIZE(vop_debugfs_files),
	2761	+ vop->debugfs, minor);
2629	2762
2630	2763	return 0;
2631		-free:
2632		- kfree(vop->debugfs_files);
2633		- vop->debugfs_files = NULL;
2634	2764	remove:
2635	2765	debugfs_remove(vop->debugfs);
2636	2766	vop->debugfs = NULL;
..	..	@@ -2638,10 +2768,10 @@
2638	2768	}
2639	2769
2640	2770	static enum drm_mode_status
2641		-vop_crtc_mode_valid(struct drm_crtc crtc, const struct drm_display_mode mode,
2642		- int output_type)
	2771	+vop_crtc_mode_valid(struct drm_crtc crtc, const struct drm_display_mode mode)
2643	2772	{
2644	2773	struct vop *vop = to_vop(crtc);
	2774	+ struct rockchip_crtc_state *s = to_rockchip_crtc_state(crtc->state);
2645	2775	const struct vop_data *vop_data = vop->data;
2646	2776	int request_clock = mode->clock;
2647	2777	int clock;
..	..	@@ -2654,15 +2784,20 @@
2654	2784	VOP_MINOR(vop->version) <= 2)
2655	2785	return MODE_BAD;
2656	2786
2657		- if (mode->flags & DRM_MODE_FLAG_DBLCLK)
	2787	+ /*
	2788	+ * Dclk need to be double if BT656 interface and vop version >= 2.12.
	2789	+ */
	2790	+ if (mode->flags & DRM_MODE_FLAG_DBLCLK \|\|
	2791	+ (VOP_MAJOR(vop->version) == 2 && VOP_MINOR(vop->version) >= 12 &&
	2792	+ s->output_if & VOP_OUTPUT_IF_BT656))
2658	2793	request_clock *= 2;
2659	2794	clock = clk_round_rate(vop->dclk, request_clock * 1000) / 1000;
2660	2795
2661	2796	/*
2662	2797	* Hdmi or DisplayPort request a Accurate clock.
2663	2798	*/
2664		- if (output_type == DRM_MODE_CONNECTOR_HDMIA \|\|
2665		- output_type == DRM_MODE_CONNECTOR_DisplayPort)
	2799	+ if (s->output_type == DRM_MODE_CONNECTOR_HDMIA \|\|
	2800	+ s->output_type == DRM_MODE_CONNECTOR_DisplayPort)
2666	2801	if (clock != request_clock)
2667	2802	return MODE_CLOCK_RANGE;
2668	2803
..	..	@@ -2692,7 +2827,7 @@
2692	2827	struct drm_framebuffer *fb = pstate->fb;
2693	2828	struct drm_rect *dest = &vop_plane_state->dest;
2694	2829	struct drm_rect *src = &vop_plane_state->src;
2695		- int bpp = fb->format->bpp[0];
	2830	+ int bpp = fb->format->cpp[0] << 3;
2696	2831	int src_width = drm_rect_width(src) >> 16;
2697	2832	int src_height = drm_rect_height(src) >> 16;
2698	2833	int dest_width = drm_rect_width(dest);
..	..	@@ -2741,8 +2876,7 @@
2741	2876
2742	2877	static size_t vop_crtc_bandwidth(struct drm_crtc *crtc,
2743	2878	struct drm_crtc_state *crtc_state,
2744		- size_t *frame_bw_mbyte,
2745		- unsigned int *plane_num_total)
	2879	+ struct dmcfreq_vop_info *vop_bw_info)
2746	2880	{
2747	2881	struct drm_display_mode *adjusted_mode = &crtc_state->adjusted_mode;
2748	2882	u16 htotal = adjusted_mode->crtc_htotal;
..	..	@@ -2752,64 +2886,77 @@
2752	2886	struct drm_plane_state *pstate;
2753	2887	struct vop_bandwidth *pbandwidth;
2754	2888	struct drm_plane *plane;
2755		- u64 bandwidth;
	2889	+ u64 line_bw_mbyte = 0;
2756	2890	int cnt = 0, plane_num = 0;
2757	2891	struct drm_atomic_state *state = crtc_state->state;
2758	2892	#if defined(CONFIG_ROCKCHIP_DRM_DEBUG)
2759	2893	struct vop_dump_list pos, n;
	2894	+ struct vop *vop = to_vop(crtc);
2760	2895	#endif
2761	2896
2762	2897	if (!htotal \|\| !vdisplay)
2763	2898	return 0;
2764	2899
2765	2900	#if defined(CONFIG_ROCKCHIP_DRM_DEBUG)
2766		- if (!crtc->vop_dump_list_init_flag) {
2767		- INIT_LIST_HEAD(&crtc->vop_dump_list_head);
2768		- crtc->vop_dump_list_init_flag = true;
	2901	+ if (!vop->rockchip_crtc.vop_dump_list_init_flag) {
	2902	+ INIT_LIST_HEAD(&vop->rockchip_crtc.vop_dump_list_head);
	2903	+ vop->rockchip_crtc.vop_dump_list_init_flag = true;
2769	2904	}
2770		- list_for_each_entry_safe(pos, n, &crtc->vop_dump_list_head, entry) {
	2905	+ list_for_each_entry_safe(pos, n, &vop->rockchip_crtc.vop_dump_list_head, entry) {
2771	2906	list_del(&pos->entry);
2772	2907	}
2773		- if (crtc->vop_dump_status == DUMP_KEEP \|\|
2774		- crtc->vop_dump_times > 0) {
2775		- crtc->frame_count++;
	2908	+ if (vop->rockchip_crtc.vop_dump_status == DUMP_KEEP \|\|
	2909	+ vop->rockchip_crtc.vop_dump_times > 0) {
	2910	+ vop->rockchip_crtc.frame_count++;
2776	2911	}
2777	2912	#endif
2778	2913
2779	2914	drm_atomic_crtc_state_for_each_plane(plane, crtc_state)
2780	2915	plane_num++;
2781	2916
2782		- if (plane_num_total)
2783		- *plane_num_total += plane_num;
	2917	+ vop_bw_info->plane_num += plane_num;
2784	2918	pbandwidth = kmalloc_array(plane_num, sizeof(*pbandwidth),
2785	2919	GFP_KERNEL);
2786	2920	if (!pbandwidth)
2787	2921	return -ENOMEM;
2788	2922
2789	2923	drm_atomic_crtc_state_for_each_plane(plane, crtc_state) {
	2924	+ int act_w, act_h, cpp, afbc_fac;
	2925	+
2790	2926	pstate = drm_atomic_get_existing_plane_state(state, plane);
2791	2927	if (pstate->crtc != crtc \|\| !pstate->fb)
2792	2928	continue;
2793	2929
	2930	+ /* This is an empirical value, if it's afbc format, the frame buffer size div 2 */
	2931	+ afbc_fac = rockchip_afbc(plane, pstate->fb->modifier) ? 2 : 1;
	2932	+
2794	2933	vop_plane_state = to_vop_plane_state(pstate);
2795	2934	pbandwidth[cnt].y1 = vop_plane_state->dest.y1;
2796	2935	pbandwidth[cnt].y2 = vop_plane_state->dest.y2;
2797		- pbandwidth[cnt++].bandwidth = vop_plane_line_bandwidth(pstate);
	2936	+ pbandwidth[cnt++].bandwidth = vop_plane_line_bandwidth(pstate) / afbc_fac;
	2937	+
	2938	+ act_w = drm_rect_width(&pstate->src) >> 16;
	2939	+ act_h = drm_rect_height(&pstate->src) >> 16;
	2940	+ cpp = pstate->fb->format->cpp[0];
	2941	+
	2942	+ vop_bw_info->frame_bw_mbyte += act_w * act_h / 1000 * cpp * drm_mode_vrefresh(adjusted_mode) / 1000;
	2943	+
2798	2944	}
2799	2945
2800	2946	sort(pbandwidth, cnt, sizeof(pbandwidth[0]), vop_bandwidth_cmp, NULL);
2801	2947
2802		- bandwidth = vop_calc_max_bandwidth(pbandwidth, 0, cnt, vdisplay);
	2948	+ vop_bw_info->line_bw_mbyte = vop_calc_max_bandwidth(pbandwidth, 0, cnt, vdisplay);
2803	2949	kfree(pbandwidth);
2804	2950	/*
2805		- * bandwidth(MB/s)
	2951	+ * line_bandwidth(MB/s)
2806	2952	* = line_bandwidth / line_time
2807	2953	* = line_bandwidth(Byte) * clock(KHZ) / 1000 / htotal
2808	2954	*/
2809		- bandwidth *= clock;
2810		- do_div(bandwidth, htotal * 1000);
	2955	+ line_bw_mbyte *= clock;
	2956	+ do_div(line_bw_mbyte, htotal * 1000);
	2957	+ vop_bw_info->line_bw_mbyte = line_bw_mbyte;
2811	2958
2812		- return bandwidth;
	2959	+ return vop_bw_info->line_bw_mbyte;
2813	2960	}
2814	2961
2815	2962	static void vop_crtc_close(struct drm_crtc *crtc)
..	..	@@ -2892,16 +3039,50 @@
2892	3039	vop_set_out_mode(vop, state->output_mode);
2893	3040	}
2894	3041
	3042	+static int vop_crtc_wait_vact_end(struct drm_crtc *crtc, unsigned int mstimeout)
	3043	+{
	3044	+ struct vop *vop = to_vop(crtc);
	3045	+ unsigned long jiffies_left;
	3046	+ int ret = 0;
	3047	+
	3048	+ if (!vop->is_enabled)
	3049	+ return -ENODEV;
	3050	+
	3051	+ mutex_lock(&vop->vop_lock);
	3052	+
	3053	+ if (vop_line_flag_irq_is_enabled(vop)) {
	3054	+ ret = -EBUSY;
	3055	+ goto out;
	3056	+ }
	3057	+
	3058	+ reinit_completion(&vop->line_flag_completion);
	3059	+ vop_line_flag_irq_enable(vop);
	3060	+
	3061	+ jiffies_left = wait_for_completion_timeout(&vop->line_flag_completion,
	3062	+ msecs_to_jiffies(mstimeout));
	3063	+ vop_line_flag_irq_disable(vop);
	3064	+
	3065	+ if (jiffies_left == 0) {
	3066	+ DRM_DEV_ERROR(vop->dev, "timeout waiting for lineflag IRQ\n");
	3067	+ ret = -ETIMEDOUT;
	3068	+ goto out;
	3069	+ }
	3070	+
	3071	+out:
	3072	+ mutex_unlock(&vop->vop_lock);
	3073	+ return ret;
	3074	+}
	3075	+
2895	3076	static const struct rockchip_crtc_funcs private_crtc_funcs = {
2896	3077	.loader_protect = vop_crtc_loader_protect,
2897	3078	.cancel_pending_vblank = vop_crtc_cancel_pending_vblank,
2898	3079	.debugfs_init = vop_crtc_debugfs_init,
2899	3080	.debugfs_dump = vop_crtc_debugfs_dump,
2900	3081	.regs_dump = vop_crtc_regs_dump,
2901		- .mode_valid = vop_crtc_mode_valid,
2902	3082	.bandwidth = vop_crtc_bandwidth,
2903	3083	.crtc_close = vop_crtc_close,
2904	3084	.crtc_send_mcu_cmd = vop_crtc_send_mcu_cmd,
	3085	+ .wait_vact_end = vop_crtc_wait_vact_end,
2905	3086	};
2906	3087
2907	3088	static bool vop_crtc_mode_fixup(struct drm_crtc *crtc,
..	..	@@ -2910,6 +3091,8 @@
2910	3091	{
2911	3092	struct vop *vop = to_vop(crtc);
2912	3093	const struct vop_data *vop_data = vop->data;
	3094	+ struct drm_crtc_state *new_crtc_state = container_of(mode, struct drm_crtc_state, mode);
	3095	+ struct rockchip_crtc_state *s = to_rockchip_crtc_state(new_crtc_state);
2913	3096
2914	3097	if (mode->hdisplay > vop_data->max_output.width)
2915	3098	return false;
..	..	@@ -2917,8 +3100,17 @@
2917	3100	drm_mode_set_crtcinfo(adj_mode,
2918	3101	CRTC_INTERLACE_HALVE_V \| CRTC_STEREO_DOUBLE);
2919	3102
2920		- if (mode->flags & DRM_MODE_FLAG_DBLCLK)
	3103	+ /*
	3104	+ * Dclk need to be double if BT656 interface and vop version >= 2.12.
	3105	+ */
	3106	+ if (mode->flags & DRM_MODE_FLAG_DBLCLK \|\|
	3107	+ (VOP_MAJOR(vop->version) == 2 && VOP_MINOR(vop->version) >= 12 &&
	3108	+ s->output_if & VOP_OUTPUT_IF_BT656))
2921	3109	adj_mode->crtc_clock *= 2;
	3110	+
	3111	+ if (vop->mcu_timing.mcu_pix_total)
	3112	+ adj_mode->crtc_clock = rockchip_drm_get_cycles_per_pixel(s->bus_format)
	3113	+ (vop->mcu_timing.mcu_pix_total + 1);
2922	3114
2923	3115	adj_mode->crtc_clock =
2924	3116	DIV_ROUND_UP(clk_round_rate(vop->dclk, adj_mode->crtc_clock * 1000),
..	..	@@ -2943,13 +3135,14 @@
2943	3135
2944	3136	switch (s->bus_format) {
2945	3137	case MEDIA_BUS_FMT_RGB565_1X16:
	3138	+ case MEDIA_BUS_FMT_RGB565_2X8_LE:
2946	3139	VOP_CTRL_SET(vop, dither_down_en, 1);
2947	3140	VOP_CTRL_SET(vop, dither_down_mode, RGB888_TO_RGB565);
2948	3141	break;
2949	3142	case MEDIA_BUS_FMT_RGB666_1X18:
2950	3143	case MEDIA_BUS_FMT_RGB666_1X24_CPADHI:
2951	3144	case MEDIA_BUS_FMT_RGB666_1X7X3_SPWG:
2952		- case MEDIA_BUS_FMT_RGB666_1X7X3_JEIDA:
	3145	+ case MEDIA_BUS_FMT_RGB666_3X6:
2953	3146	VOP_CTRL_SET(vop, dither_down_en, 1);
2954	3147	VOP_CTRL_SET(vop, dither_down_mode, RGB888_TO_RGB666);
2955	3148	break;
..	..	@@ -2963,8 +3156,8 @@
2963	3156	VOP_CTRL_SET(vop, dither_down_en, 0);
2964	3157	VOP_CTRL_SET(vop, pre_dither_down_en, 0);
2965	3158	break;
2966		- case MEDIA_BUS_FMT_SRGB888_3X8:
2967		- case MEDIA_BUS_FMT_SRGB888_DUMMY_4X8:
	3159	+ case MEDIA_BUS_FMT_RGB888_3X8:
	3160	+ case MEDIA_BUS_FMT_RGB888_DUMMY_4X8:
2968	3161	case MEDIA_BUS_FMT_RGB888_1X24:
2969	3162	case MEDIA_BUS_FMT_RGB888_1X7X4_SPWG:
2970	3163	case MEDIA_BUS_FMT_RGB888_1X7X4_JEIDA:
..	..	@@ -2986,12 +3179,15 @@
2986	3179	struct vop *vop = to_vop(crtc);
2987	3180	u32 val;
2988	3181
2989		- if (s->output_mode == ROCKCHIP_OUT_MODE_AAAA &&
2990		- !(vop->data->feature & VOP_FEATURE_OUTPUT_10BIT))
	3182	+ if ((s->output_mode == ROCKCHIP_OUT_MODE_AAAA &&
	3183	+ !(vop->data->feature & VOP_FEATURE_OUTPUT_10BIT)) \|\|
	3184	+ (VOP_MAJOR(vop->version) == 2 && VOP_MINOR(vop->version) >= 12 &&
	3185	+ s->output_if & VOP_OUTPUT_IF_BT656))
2991	3186	s->output_mode = ROCKCHIP_OUT_MODE_P888;
2992	3187
2993		- if (is_uv_swap(s->bus_format, s->output_mode))
2994		- VOP_CTRL_SET(vop, dsp_data_swap, DSP_RB_SWAP);
	3188	+ if (is_uv_swap(s->bus_format, s->output_mode) \|\|
	3189	+ is_rb_swap(s->bus_format, s->output_mode))
	3190	+ VOP_CTRL_SET(vop, dsp_rb_swap, 1);
2995	3191	else
2996	3192	VOP_CTRL_SET(vop, dsp_data_swap, 0);
2997	3193
..	..	@@ -3097,11 +3293,20 @@
3097	3293	int for_ddr_freq = 0;
3098	3294	bool dclk_inv, yc_swap = false;
3099	3295
	3296	+ if (old_state && old_state->self_refresh_active) {
	3297	+ drm_crtc_vblank_on(crtc);
	3298	+ if (vop->aclk_rate_reset)
	3299	+ clk_set_rate(vop->aclk, vop->aclk_rate);
	3300	+ vop->aclk_rate_reset = false;
	3301	+
	3302	+ return;
	3303	+ }
	3304	+
3100	3305	rockchip_set_system_status(sys_status);
3101	3306	vop_lock(vop);
3102	3307	DRM_DEV_INFO(vop->dev, "Update mode to %dx%d%s%d, type: %d\n",
3103	3308	hdisplay, vdisplay, interlaced ? "i" : "p",
3104		- adjusted_mode->vrefresh, s->output_type);
	3309	+ drm_mode_vrefresh(adjusted_mode), s->output_type);
3105	3310	vop_initial(crtc);
3106	3311	vop_disable_allwin(vop);
3107	3312	VOP_CTRL_SET(vop, standby, 0);
..	..	@@ -3118,6 +3323,9 @@
3118	3323	vop_mcu_mode(crtc);
3119	3324
3120	3325	dclk_inv = (s->bus_flags & DRM_BUS_FLAG_PIXDATA_DRIVE_NEGEDGE) ? 1 : 0;
	3326	+ /* For improving signal quality, dclk need to be inverted by default on rv1106. */
	3327	+ if ((VOP_MAJOR(vop->version) == 2 && VOP_MINOR(vop->version) == 12))
	3328	+ dclk_inv = !dclk_inv;
3121	3329
3122	3330	VOP_CTRL_SET(vop, dclk_pol, dclk_inv);
3123	3331	val = (adjusted_mode->flags & DRM_MODE_FLAG_NHSYNC) ?
..	..	@@ -3147,6 +3355,10 @@
3147	3355	yc_swap = is_yc_swap(s->bus_format);
3148	3356	VOP_CTRL_SET(vop, bt1120_yc_swap, yc_swap);
3149	3357	VOP_CTRL_SET(vop, yuv_clip, 1);
	3358	+ } else if (s->output_if & VOP_OUTPUT_IF_BT656) {
	3359	+ VOP_CTRL_SET(vop, bt656_en, 1);
	3360	+ yc_swap = is_yc_swap(s->bus_format);
	3361	+ VOP_CTRL_SET(vop, bt1120_yc_swap, yc_swap);
3150	3362	}
3151	3363	break;
3152	3364	case DRM_MODE_CONNECTOR_eDP:
..	..	@@ -3233,7 +3445,8 @@
3233	3445	VOP_CTRL_SET(vop, vtotal_pw, vtotal << 16 \| vsync_len);
3234	3446
3235	3447	VOP_CTRL_SET(vop, core_dclk_div,
3236		- !!(adjusted_mode->flags & DRM_MODE_FLAG_DBLCLK));
	3448	+ !!(adjusted_mode->flags & DRM_MODE_FLAG_DBLCLK) \|\|
	3449	+ s->output_if & VOP_OUTPUT_IF_BT656);
3237	3450
3238	3451	VOP_CTRL_SET(vop, win_csc_mode_sel, 1);
3239	3452
..	..	@@ -3258,7 +3471,6 @@
3258	3471	struct drm_crtc_state *crtc_state)
3259	3472	{
3260	3473	struct vop *vop = to_vop(crtc);
3261		- const struct vop_data *vop_data = vop->data;
3262	3474	struct rockchip_crtc_state *s = to_rockchip_crtc_state(crtc_state);
3263	3475	struct drm_atomic_state *state = crtc_state->state;
3264	3476	struct drm_plane *plane;
..	..	@@ -3288,8 +3500,8 @@
3288	3500	DRM_FORMAT_MOD_ARM_AFBC(AFBC_FORMAT_MOD_BLOCK_SIZE_16x16))
3289	3501	continue;
3290	3502
3291		- if (!(vop_data->feature & VOP_FEATURE_AFBDC)) {
3292		- DRM_ERROR("not support afbdc\n");
	3503	+ if (!VOP_CTRL_SUPPORT(vop, afbdc_en)) {
	3504	+ DRM_INFO("not support afbdc\n");
3293	3505	return -EINVAL;
3294	3506	}
3295	3507
..	..	@@ -3329,10 +3541,17 @@
3329	3541
3330	3542	if (VOP_CTRL_SUPPORT(vop, afbdc_pic_vir_width)) {
3331	3543	u32 align_x1, align_x2, align_y1, align_y2, align_val;
	3544	+ struct drm_gem_object *obj;
	3545	+ struct rockchip_gem_object *rk_obj;
	3546	+ dma_addr_t fb_addr;
	3547	+
	3548	+ obj = fb->obj[0];
	3549	+ rk_obj = to_rockchip_obj(obj);
	3550	+ fb_addr = rk_obj->dma_addr + fb->offsets[0];
3332	3551
3333	3552	s->afbdc_win_format = afbdc_format;
3334	3553	s->afbdc_win_id = win->win_id;
3335		- s->afbdc_win_ptr = rockchip_fb_get_dma_addr(fb, 0);
	3554	+ s->afbdc_win_ptr = fb_addr;
3336	3555	s->afbdc_win_vir_width = fb->width;
3337	3556	s->afbdc_win_xoffset = (src->x1 >> 16);
3338	3557	s->afbdc_win_yoffset = (src->y1 >> 16);
..	..	@@ -3716,6 +3935,7 @@
3716	3935	struct rockchip_crtc_state *s =
3717	3936	to_rockchip_crtc_state(crtc->state);
3718	3937	struct vop *vop = to_vop(crtc);
	3938	+ const struct vop_data *vop_data = vop->data;
3719	3939
3720	3940	spin_lock(&vop->reg_lock);
3721	3941
..	..	@@ -3743,7 +3963,8 @@
3743	3963	VOP_CTRL_SET(vop, afbdc_en, s->afbdc_en);
3744	3964
3745	3965	VOP_CTRL_SET(vop, dsp_layer_sel, s->dsp_layer_sel);
3746		- vop_post_config(crtc);
	3966	+ if (vop_data->feature & VOP_FEATURE_OVERSCAN)
	3967	+ vop_post_config(crtc);
3747	3968
3748	3969	spin_unlock(&vop->reg_lock);
3749	3970	}
..	..	@@ -3821,6 +4042,7 @@
3821	4042	spin_lock_irqsave(&vop->irq_lock, flags);
3822	4043	vop->pre_overlay = s->hdr.pre_overlay;
3823	4044	vop_cfg_done(vop);
	4045	+ rockchip_drm_dbg(vop->dev, VOP_DEBUG_CFG_DONE, "cfg_done\n\n");
3824	4046	/*
3825	4047	* rk322x and rk332x odd-even field will mistake when in interlace mode.
3826	4048	* we must switch to frame effect before switch screen and switch to
..	..	@@ -3854,21 +4076,6 @@
3854	4076	crtc->state->event = NULL;
3855	4077	}
3856	4078	spin_unlock_irq(&crtc->dev->event_lock);
3857		-
3858		-#if 0
3859		- for_each_plane_in_state(old_state, plane, old_plane_state, i) {
3860		- if (!old_plane_state->fb)
3861		- continue;
3862		-
3863		- if (old_plane_state->fb == plane->state->fb)
3864		- continue;
3865		-
3866		- drm_framebuffer_get(old_plane_state->fb);
3867		- WARN_ON(drm_crtc_vblank_get(crtc) != 0);
3868		- drm_flip_work_queue(&vop->fb_unref_work, old_plane_state->fb);
3869		- set_bit(VOP_PENDING_FB_UNREF, &vop->pending);
3870		- }
3871		-#else
3872	4079	for_each_old_plane_in_state(old_state, plane, old_plane_state, i) {
3873	4080	if (!old_plane_state->fb)
3874	4081	continue;
..	..	@@ -3881,11 +4088,11 @@
3881	4088	drm_flip_work_queue(&vop->fb_unref_work, old_plane_state->fb);
3882	4089	set_bit(VOP_PENDING_FB_UNREF, &vop->pending);
3883	4090	}
3884		-#endif
3885	4091	}
3886	4092
3887	4093	static const struct drm_crtc_helper_funcs vop_crtc_helper_funcs = {
3888	4094	.mode_fixup = vop_crtc_mode_fixup,
	4095	+ .mode_valid = vop_crtc_mode_valid,
3889	4096	.atomic_check = vop_crtc_atomic_check,
3890	4097	.atomic_flush = vop_crtc_atomic_flush,
3891	4098	.atomic_enable = vop_crtc_atomic_enable,
..	..	@@ -3921,6 +4128,9 @@
3921	4128	static struct drm_crtc_state vop_crtc_duplicate_state(struct drm_crtc crtc)
3922	4129	{
3923	4130	struct rockchip_crtc_state rockchip_state, old_state;
	4131	+
	4132	+ if (WARN_ON(!crtc->state))
	4133	+ return NULL;
3924	4134
3925	4135	old_state = to_rockchip_crtc_state(crtc->state);
3926	4136	rockchip_state = kmemdup(old_state, sizeof(*old_state), GFP_KERNEL);
..	..	@@ -4036,8 +4246,19 @@
4036	4246	return 0;
4037	4247	}
4038	4248
4039		- if (property == private->alpha_scale_prop) {
4040		- *val = (vop->data->feature & VOP_FEATURE_ALPHA_SCALE) ? 1 : 0;
	4249	+ if (property == private->aclk_prop) {
	4250	+ /* KHZ, keep align with mode->clock */
	4251	+ *val = clk_get_rate(vop->aclk) / 1000;
	4252	+ return 0;
	4253	+ }
	4254	+
	4255	+ if (property == private->bg_prop) {
	4256	+ *val = vop->background;
	4257	+ return 0;
	4258	+ }
	4259	+
	4260	+ if (property == private->line_flag_prop) {
	4261	+ *val = vop->line_flag;
4041	4262	return 0;
4042	4263	}
4043	4264
..	..	@@ -4051,9 +4272,10 @@
4051	4272	uint64_t val)
4052	4273	{
4053	4274	struct drm_device *drm_dev = crtc->dev;
	4275	+ struct rockchip_drm_private *private = drm_dev->dev_private;
4054	4276	struct drm_mode_config *mode_config = &drm_dev->mode_config;
4055	4277	struct rockchip_crtc_state *s = to_rockchip_crtc_state(state);
4056		- //struct vop *vop = to_vop(crtc);
	4278	+ struct vop *vop = to_vop(crtc);
4057	4279
4058	4280	if (property == mode_config->tv_left_margin_property) {
4059	4281	s->left_margin = val;
..	..	@@ -4072,6 +4294,16 @@
4072	4294
4073	4295	if (property == mode_config->tv_bottom_margin_property) {
4074	4296	s->bottom_margin = val;
	4297	+ return 0;
	4298	+ }
	4299	+
	4300	+ if (property == private->bg_prop) {
	4301	+ vop->background = val;
	4302	+ return 0;
	4303	+ }
	4304	+
	4305	+ if (property == private->line_flag_prop) {
	4306	+ vop->line_flag = val;
4075	4307	return 0;
4076	4308	}
4077	4309
..	..	@@ -4100,14 +4332,14 @@
4100	4332	struct vop *vop = container_of(work, struct vop, fb_unref_work);
4101	4333	struct drm_framebuffer *fb = val;
4102	4334
4103		- drm_crtc_vblank_put(&vop->crtc);
	4335	+ drm_crtc_vblank_put(&vop->rockchip_crtc.crtc);
4104	4336	drm_framebuffer_put(fb);
4105	4337	}
4106	4338
4107	4339	static void vop_handle_vblank(struct vop *vop)
4108	4340	{
4109	4341	struct drm_device *drm = vop->drm_dev;
4110		- struct drm_crtc *crtc = &vop->crtc;
	4342	+ struct drm_crtc *crtc = &vop->rockchip_crtc.crtc;
4111	4343	unsigned long flags;
4112	4344
4113	4345	spin_lock_irqsave(&drm->event_lock, flags);
..	..	@@ -4125,7 +4357,7 @@
4125	4357	static irqreturn_t vop_isr(int irq, void *data)
4126	4358	{
4127	4359	struct vop *vop = data;
4128		- struct drm_crtc *crtc = &vop->crtc;
	4360	+ struct drm_crtc *crtc = &vop->rockchip_crtc.crtc;
4129	4361	uint32_t active_irqs;
4130	4362	unsigned long flags;
4131	4363	int ret = IRQ_NONE;
..	..	@@ -4176,6 +4408,7 @@
4176	4408	* frame effective, but actually it's effective immediately, so
4177	4409	* we config this register at frame start.
4178	4410	*/
	4411	+ rockchip_drm_dbg(vop->dev, VOP_DEBUG_VSYNC, "vsync\n");
4179	4412	spin_lock_irqsave(&vop->irq_lock, flags);
4180	4413	VOP_CTRL_SET(vop, level2_overlay_en, vop->pre_overlay);
4181	4414	VOP_CTRL_SET(vop, alpha_hard_calc, vop->pre_overlay);
..	..	@@ -4222,27 +4455,49 @@
4222	4455
4223	4456	flags \|= (VOP_WIN_SUPPORT(vop, win, xmirror)) ? DRM_MODE_REFLECT_X : 0;
4224	4457	flags \|= (VOP_WIN_SUPPORT(vop, win, ymirror)) ? DRM_MODE_REFLECT_Y : 0;
	4458	+
4225	4459	if (flags)
4226	4460	drm_plane_create_rotation_property(plane, DRM_MODE_ROTATE_0,
4227	4461	DRM_MODE_ROTATE_0 \| flags);
	4462	+}
	4463	+
	4464	+static int vop_plane_create_name_property(struct vop vop, struct vop_win win)
	4465	+{
	4466	+ struct drm_prop_enum_list *props = vop->plane_name_list;
	4467	+ struct drm_property *prop;
	4468	+ uint64_t bits = BIT_ULL(win->plane_id);
	4469	+
	4470	+ prop = drm_property_create_bitmask(vop->drm_dev,
	4471	+ DRM_MODE_PROP_IMMUTABLE, "NAME",
	4472	+ props, vop->num_wins, bits);
	4473	+ if (!prop) {
	4474	+ DRM_DEV_ERROR(vop->dev, "create Name prop for %s failed\n", win->name);
	4475	+ return -ENOMEM;
	4476	+ }
	4477	+ win->name_prop = prop;
	4478	+ drm_object_attach_property(&win->base.base, win->name_prop, bits);
	4479	+
	4480	+ return 0;
4228	4481	}
4229	4482
4230	4483	static int vop_plane_init(struct vop vop, struct vop_win win,
4231	4484	unsigned long possible_crtcs)
4232	4485	{
4233	4486	struct rockchip_drm_private *private = vop->drm_dev->dev_private;
	4487	+ unsigned int blend_caps = BIT(DRM_MODE_BLEND_PIXEL_NONE) \| BIT(DRM_MODE_BLEND_PREMULTI) \|
	4488	+ BIT(DRM_MODE_BLEND_COVERAGE);
	4489	+ const struct vop_data *vop_data = vop->data;
4234	4490	uint64_t feature = 0;
4235	4491	int ret;
4236	4492
4237	4493	ret = drm_universal_plane_init(vop->drm_dev, &win->base, possible_crtcs, &vop_plane_funcs,
4238		- win->data_formats, win->nformats, NULL, win->type, NULL);
	4494	+ win->data_formats, win->nformats, win->format_modifiers,
	4495	+ win->type, win->name);
4239	4496	if (ret) {
4240	4497	DRM_ERROR("failed to initialize plane %d\n", ret);
4241	4498	return ret;
4242	4499	}
4243	4500	drm_plane_helper_add(&win->base, &plane_helper_funcs);
4244		- drm_object_attach_property(&win->base.base,
4245		- vop->plane_zpos_prop, win->win_id);
4246	4501
4247	4502	if (win->phy->scl)
4248	4503	feature \|= BIT(ROCKCHIP_DRM_PLANE_FEATURE_SCALE);
..	..	@@ -4262,15 +4517,9 @@
4262	4517	drm_object_attach_property(&win->base.base,
4263	4518	private->color_space_prop, 0);
4264	4519	if (VOP_WIN_SUPPORT(vop, win, global_alpha_val))
4265		- drm_object_attach_property(&win->base.base,
4266		- private->global_alpha_prop, 0xff);
4267		- drm_object_attach_property(&win->base.base,
4268		- private->blend_mode_prop, 0);
	4520	+ drm_plane_create_alpha_property(&win->base);
4269	4521	drm_object_attach_property(&win->base.base,
4270	4522	private->async_commit_prop, 0);
4271		- if (VOP_WIN_SUPPORT(vop, win, color_key))
4272		- drm_object_attach_property(&win->base.base,
4273		- win->color_key_prop, 0);
4274	4523
4275	4524	if (win->parent)
4276	4525	drm_object_attach_property(&win->base.base, private->share_id_prop,
..	..	@@ -4278,6 +4527,45 @@
4278	4527	else
4279	4528	drm_object_attach_property(&win->base.base, private->share_id_prop,
4280	4529	win->base.base.id);
	4530	+
	4531	+ drm_plane_create_blend_mode_property(&win->base, blend_caps);
	4532	+ drm_plane_create_zpos_property(&win->base, win->win_id, 0, vop->num_wins - 1);
	4533	+ vop_plane_create_name_property(vop, win);
	4534	+
	4535	+
	4536	+ win->input_width_prop = drm_property_create_range(vop->drm_dev, DRM_MODE_PROP_IMMUTABLE,
	4537	+ "INPUT_WIDTH", 0, vop_data->max_input.width);
	4538	+ win->input_height_prop = drm_property_create_range(vop->drm_dev, DRM_MODE_PROP_IMMUTABLE,
	4539	+ "INPUT_HEIGHT", 0, vop_data->max_input.height);
	4540	+
	4541	+ win->output_width_prop = drm_property_create_range(vop->drm_dev, DRM_MODE_PROP_IMMUTABLE,
	4542	+ "OUTPUT_WIDTH", 0, vop_data->max_input.width);
	4543	+ win->output_height_prop = drm_property_create_range(vop->drm_dev, DRM_MODE_PROP_IMMUTABLE,
	4544	+ "OUTPUT_HEIGHT", 0, vop_data->max_input.height);
	4545	+
	4546	+ win->scale_prop = drm_property_create_range(vop->drm_dev, DRM_MODE_PROP_IMMUTABLE,
	4547	+ "SCALE_RATE", 8, 8);
	4548	+ /*
	4549	+ * Support 24 bit(RGB888) or 16 bit(rgb565) color key.
	4550	+ * Bit 31 is used as a flag to disable (0) or enable
	4551	+ * color keying (1).
	4552	+ */
	4553	+ if (VOP_WIN_SUPPORT(vop, win, color_key))
	4554	+ win->color_key_prop = drm_property_create_range(vop->drm_dev, 0,
	4555	+ "colorkey", 0, 0x80ffffff);
	4556	+ if (!win->input_width_prop \|\| !win->input_height_prop \|\|
	4557	+ !win->scale_prop) {
	4558	+ DRM_ERROR("failed to create property\n");
	4559	+ return -ENOMEM;
	4560	+ }
	4561	+
	4562	+ drm_object_attach_property(&win->base.base, win->input_width_prop, 0);
	4563	+ drm_object_attach_property(&win->base.base, win->input_height_prop, 0);
	4564	+ drm_object_attach_property(&win->base.base, win->output_width_prop, 0);
	4565	+ drm_object_attach_property(&win->base.base, win->output_height_prop, 0);
	4566	+ drm_object_attach_property(&win->base.base, win->scale_prop, 0);
	4567	+ if (VOP_WIN_SUPPORT(vop, win, color_key))
	4568	+ drm_object_attach_property(&win->base.base, win->color_key_prop, 0);
4281	4569
4282	4570	return 0;
4283	4571	}
..	..	@@ -4339,16 +4627,75 @@
4339	4627	return 0;
4340	4628	}
4341	4629
	4630	+static int vop_crtc_create_plane_mask_property(struct vop vop, struct drm_crtc crtc)
	4631	+{
	4632	+ struct drm_property *prop;
	4633	+
	4634	+ static const struct drm_prop_enum_list props[] = {
	4635	+ { ROCKCHIP_VOP_WIN0, "Win0" },
	4636	+ { ROCKCHIP_VOP_WIN1, "Win1" },
	4637	+ { ROCKCHIP_VOP_WIN2, "Win2" },
	4638	+ { ROCKCHIP_VOP_WIN3, "Win3" },
	4639	+ };
	4640	+
	4641	+ prop = drm_property_create_bitmask(vop->drm_dev,
	4642	+ DRM_MODE_PROP_IMMUTABLE, "PLANE_MASK",
	4643	+ props, ARRAY_SIZE(props),
	4644	+ 0xffffffff);
	4645	+ if (!prop) {
	4646	+ DRM_DEV_ERROR(vop->dev, "create plane_mask prop for vp%d failed\n", vop->id);
	4647	+ return -ENOMEM;
	4648	+ }
	4649	+
	4650	+ vop->plane_mask_prop = prop;
	4651	+ drm_object_attach_property(&crtc->base, vop->plane_mask_prop, vop->plane_mask);
	4652	+
	4653	+ return 0;
	4654	+}
	4655	+
	4656	+static int vop_crtc_create_feature_property(struct vop vop, struct drm_crtc crtc)
	4657	+{
	4658	+ const struct vop_data *vop_data = vop->data;
	4659	+
	4660	+ struct drm_property *prop;
	4661	+ u64 feature = 0;
	4662	+
	4663	+ static const struct drm_prop_enum_list props[] = {
	4664	+ { ROCKCHIP_DRM_CRTC_FEATURE_ALPHA_SCALE, "ALPHA_SCALE" },
	4665	+ { ROCKCHIP_DRM_CRTC_FEATURE_HDR10, "HDR10" },
	4666	+ { ROCKCHIP_DRM_CRTC_FEATURE_NEXT_HDR, "NEXT_HDR" },
	4667	+ };
	4668	+
	4669	+ if (vop_data->feature & VOP_FEATURE_ALPHA_SCALE)
	4670	+ feature \|= BIT(ROCKCHIP_DRM_CRTC_FEATURE_ALPHA_SCALE);
	4671	+ if (vop_data->feature & VOP_FEATURE_HDR10)
	4672	+ feature \|= BIT(ROCKCHIP_DRM_CRTC_FEATURE_HDR10);
	4673	+ if (vop_data->feature & VOP_FEATURE_NEXT_HDR)
	4674	+ feature \|= BIT(ROCKCHIP_DRM_CRTC_FEATURE_NEXT_HDR);
	4675	+
	4676	+ prop = drm_property_create_bitmask(vop->drm_dev,
	4677	+ DRM_MODE_PROP_IMMUTABLE, "FEATURE",
	4678	+ props, ARRAY_SIZE(props),
	4679	+ 0xffffffff);
	4680	+ if (!prop) {
	4681	+ DRM_DEV_ERROR(vop->dev, "create FEATURE prop for vop%d failed\n", vop->id);
	4682	+ return -ENOMEM;
	4683	+ }
	4684	+
	4685	+ vop->feature_prop = prop;
	4686	+ drm_object_attach_property(&crtc->base, vop->feature_prop, feature);
	4687	+
	4688	+ return 0;
	4689	+}
	4690	+
4342	4691	static int vop_create_crtc(struct vop *vop)
4343	4692	{
4344	4693	struct device *dev = vop->dev;
4345		- const struct vop_data *vop_data = vop->data;
4346	4694	struct drm_device *drm_dev = vop->drm_dev;
4347	4695	struct rockchip_drm_private *private = drm_dev->dev_private;
4348	4696	struct drm_plane primary = NULL, cursor = NULL, plane, tmp;
4349		- struct drm_crtc *crtc = &vop->crtc;
	4697	+ struct drm_crtc *crtc = &vop->rockchip_crtc.crtc;
4350	4698	struct device_node *port;
4351		- uint64_t feature = 0;
4352	4699	int ret = 0;
4353	4700	int i;
4354	4701
..	..	@@ -4364,7 +4711,8 @@
4364	4711	win->type != DRM_PLANE_TYPE_CURSOR)
4365	4712	continue;
4366	4713
4367		- if (vop_plane_init(vop, win, 0)) {
	4714	+ ret = vop_plane_init(vop, win, 0);
	4715	+ if (ret) {
4368	4716	DRM_DEV_ERROR(vop->dev, "failed to init plane\n");
4369	4717	goto err_cleanup_planes;
4370	4718	}
..	..	@@ -4394,7 +4742,8 @@
4394	4742	if (win->type != DRM_PLANE_TYPE_OVERLAY)
4395	4743	continue;
4396	4744
4397		- if (vop_plane_init(vop, win, possible_crtcs)) {
	4745	+ ret = vop_plane_init(vop, win, possible_crtcs);
	4746	+ if (ret) {
4398	4747	DRM_DEV_ERROR(vop->dev, "failed to init overlay\n");
4399	4748	goto err_cleanup_crtc;
4400	4749	}
..	..	@@ -4417,6 +4766,12 @@
4417	4766	crtc->port = port;
4418	4767	rockchip_register_crtc_funcs(crtc, &private_crtc_funcs);
4419	4768
	4769	+ drm_object_attach_property(&crtc->base, private->soc_id_prop, vop->soc_id);
	4770	+ drm_object_attach_property(&crtc->base, private->port_id_prop, vop->id);
	4771	+ drm_object_attach_property(&crtc->base, private->aclk_prop, 0);
	4772	+ drm_object_attach_property(&crtc->base, private->bg_prop, 0);
	4773	+ drm_object_attach_property(&crtc->base, private->line_flag_prop, 0);
	4774	+
4420	4775	#define VOP_ATTACH_MODE_CONFIG_PROP(prop, v) \
4421	4776	drm_object_attach_property(&crtc->base, drm_dev->mode_config.prop, v)
4422	4777
..	..	@@ -4424,13 +4779,15 @@
4424	4779	VOP_ATTACH_MODE_CONFIG_PROP(tv_right_margin_property, 100);
4425	4780	VOP_ATTACH_MODE_CONFIG_PROP(tv_top_margin_property, 100);
4426	4781	VOP_ATTACH_MODE_CONFIG_PROP(tv_bottom_margin_property, 100);
4427		-
4428	4782	#undef VOP_ATTACH_MODE_CONFIG_PROP
4429		- drm_object_attach_property(&crtc->base, private->alpha_scale_prop, 0);
4430		- if (vop_data->feature & VOP_FEATURE_AFBDC)
4431		- feature \|= BIT(ROCKCHIP_DRM_CRTC_FEATURE_AFBDC);
4432		- drm_object_attach_property(&crtc->base, vop->feature_prop,
4433		- feature);
	4783	+ vop_crtc_create_plane_mask_property(vop, crtc);
	4784	+ vop_crtc_create_feature_property(vop, crtc);
	4785	+ ret = drm_self_refresh_helper_init(crtc);
	4786	+ if (ret)
	4787	+ DRM_DEV_DEBUG_KMS(vop->dev,
	4788	+ "Failed to init %s with SR helpers %d, ignoring\n",
	4789	+ crtc->name, ret);
	4790	+
4434	4791	if (vop->lut_regs) {
4435	4792	u16 r_base, g_base, *b_base;
4436	4793	u32 lut_len = vop->lut_len;
..	..	@@ -4477,9 +4834,11 @@
4477	4834
4478	4835	static void vop_destroy_crtc(struct vop *vop)
4479	4836	{
4480		- struct drm_crtc *crtc = &vop->crtc;
	4837	+ struct drm_crtc *crtc = &vop->rockchip_crtc.crtc;
4481	4838	struct drm_device *drm_dev = vop->drm_dev;
4482	4839	struct drm_plane plane, tmp;
	4840	+
	4841	+ drm_self_refresh_helper_cleanup(crtc);
4483	4842
4484	4843	of_node_put(crtc->port);
4485	4844
..	..	@@ -4531,16 +4890,15 @@
4531	4890	const struct vop_data *vop_data = vop->data;
4532	4891	unsigned int i, j;
4533	4892	unsigned int num_wins = 0;
4534		- struct drm_property *prop;
	4893	+ char name[DRM_PROP_NAME_LEN];
	4894	+ uint8_t plane_id = 0;
	4895	+ struct drm_prop_enum_list *plane_name_list;
4535	4896	static const struct drm_prop_enum_list props[] = {
4536	4897	{ ROCKCHIP_DRM_PLANE_FEATURE_SCALE, "scale" },
4537	4898	{ ROCKCHIP_DRM_PLANE_FEATURE_ALPHA, "alpha" },
4538	4899	{ ROCKCHIP_DRM_PLANE_FEATURE_HDR2SDR, "hdr2sdr" },
4539	4900	{ ROCKCHIP_DRM_PLANE_FEATURE_SDR2HDR, "sdr2hdr" },
4540	4901	{ ROCKCHIP_DRM_PLANE_FEATURE_AFBDC, "afbdc" },
4541		- };
4542		- static const struct drm_prop_enum_list crtc_props[] = {
4543		- { ROCKCHIP_DRM_CRTC_FEATURE_AFBDC, "afbdc" },
4544	4902	};
4545	4903
4546	4904	for (i = 0; i < vop_data->win_size; i++) {
..	..	@@ -4556,16 +4914,16 @@
4556	4914	vop_win->type = win_data->type;
4557	4915	vop_win->data_formats = win_data->phy->data_formats;
4558	4916	vop_win->nformats = win_data->phy->nformats;
	4917	+ vop_win->format_modifiers = win_data->format_modifiers;
4559	4918	vop_win->feature = win_data->feature;
4560	4919	vop_win->vop = vop;
4561	4920	vop_win->win_id = i;
4562	4921	vop_win->area_id = 0;
	4922	+ vop_win->plane_id = plane_id++;
	4923	+ snprintf(name, sizeof(name), "VOP%d-win%d-%d", vop->id, vop_win->win_id, vop_win->area_id);
	4924	+ vop_win->name = devm_kstrdup(vop->dev, name, GFP_KERNEL);
4563	4925	vop_win->zpos = vop_plane_get_zpos(win_data->type,
4564	4926	vop_data->win_size);
4565		- if (VOP_WIN_SUPPORT(vop, vop_win, color_key))
4566		- vop_win->color_key_prop = drm_property_create_range(vop->drm_dev, 0,
4567		- "colorkey", 0,
4568		- 0x80ffffff);
4569	4927
4570	4928	num_wins++;
4571	4929
..	..	@@ -4582,22 +4940,19 @@
4582	4940	vop_area->type = DRM_PLANE_TYPE_OVERLAY;
4583	4941	vop_area->data_formats = vop_win->data_formats;
4584	4942	vop_area->nformats = vop_win->nformats;
	4943	+ vop_area->format_modifiers = win_data->format_modifiers;
4585	4944	vop_area->vop = vop;
4586	4945	vop_area->win_id = i;
4587	4946	vop_area->area_id = j + 1;
	4947	+ vop_area->plane_id = plane_id++;
	4948	+ snprintf(name, sizeof(name), "VOP%d-win%d-%d", vop->id, vop_area->win_id, vop_area->area_id);
	4949	+ vop_area->name = devm_kstrdup(vop->dev, name, GFP_KERNEL);
4588	4950	num_wins++;
4589	4951	}
	4952	+ vop->plane_mask \|= BIT(vop_win->win_id);
4590	4953	}
4591	4954
4592	4955	vop->num_wins = num_wins;
4593		-
4594		- prop = drm_property_create_range(vop->drm_dev, DRM_MODE_PROP_ATOMIC,
4595		- "ZPOS", 0, vop->data->win_size - 1);
4596		- if (!prop) {
4597		- DRM_ERROR("failed to create zpos property\n");
4598		- return -EINVAL;
4599		- }
4600		- vop->plane_zpos_prop = prop;
4601	4956
4602	4957	vop->plane_feature_prop = drm_property_create_bitmask(vop->drm_dev,
4603	4958	DRM_MODE_PROP_IMMUTABLE, "FEATURE",
..	..	@@ -4612,66 +4967,25 @@
4612	4967	return -EINVAL;
4613	4968	}
4614	4969
4615		- vop->feature_prop = drm_property_create_bitmask(vop->drm_dev,
4616		- DRM_MODE_PROP_IMMUTABLE, "FEATURE",
4617		- crtc_props, ARRAY_SIZE(crtc_props),
4618		- BIT(ROCKCHIP_DRM_CRTC_FEATURE_AFBDC));
4619		- if (!vop->feature_prop) {
4620		- DRM_ERROR("failed to create vop feature property\n");
4621		- return -EINVAL;
	4970	+ plane_name_list = devm_kzalloc(vop->dev,
	4971	+ vop->num_wins * sizeof(*plane_name_list),
	4972	+ GFP_KERNEL);
	4973	+ if (!plane_name_list) {
	4974	+ DRM_DEV_ERROR(vop->dev, "failed to alloc memory for plane_name_list\n");
	4975	+ return -ENOMEM;
4622	4976	}
	4977	+
	4978	+ for (i = 0; i < vop->num_wins; i++) {
	4979	+ struct vop_win *vop_win = &vop->win[i];
	4980	+
	4981	+ plane_name_list[i].type = vop_win->plane_id;
	4982	+ plane_name_list[i].name = vop_win->name;
	4983	+ }
	4984	+
	4985	+ vop->plane_name_list = plane_name_list;
4623	4986
4624	4987	return 0;
4625	4988	}
4626		-
4627		-/**
4628		- * rockchip_drm_wait_vact_end
4629		- * @crtc: CRTC to enable line flag
4630		- * @mstimeout: millisecond for timeout
4631		- *
4632		- * Wait for vact_end line flag irq or timeout.
4633		- *
4634		- * Returns:
4635		- * Zero on success, negative errno on failure.
4636		- */
4637		-int rockchip_drm_wait_vact_end(struct drm_crtc *crtc, unsigned int mstimeout)
4638		-{
4639		- struct vop *vop = to_vop(crtc);
4640		- unsigned long jiffies_left;
4641		- int ret = 0;
4642		-
4643		- if (!crtc \|\| !vop->is_enabled)
4644		- return -ENODEV;
4645		-
4646		- mutex_lock(&vop->vop_lock);
4647		- if (mstimeout <= 0) {
4648		- ret = -EINVAL;
4649		- goto out;
4650		- }
4651		-
4652		- if (vop_line_flag_irq_is_enabled(vop)) {
4653		- ret = -EBUSY;
4654		- goto out;
4655		- }
4656		-
4657		- reinit_completion(&vop->line_flag_completion);
4658		- vop_line_flag_irq_enable(vop);
4659		-
4660		- jiffies_left = wait_for_completion_timeout(&vop->line_flag_completion,
4661		- msecs_to_jiffies(mstimeout));
4662		- vop_line_flag_irq_disable(vop);
4663		-
4664		- if (jiffies_left == 0) {
4665		- DRM_DEV_ERROR(vop->dev, "Timeout waiting for IRQ\n");
4666		- ret = -ETIMEDOUT;
4667		- goto out;
4668		- }
4669		-
4670		-out:
4671		- mutex_unlock(&vop->vop_lock);
4672		- return ret;
4673		-}
4674		-EXPORT_SYMBOL(rockchip_drm_wait_vact_end);
4675	4989
4676	4990	static int vop_bind(struct device dev, struct device master, void *data)
4677	4991	{
..	..	@@ -4707,6 +5021,8 @@
4707	5021	vop->drm_dev = drm_dev;
4708	5022	vop->num_wins = num_wins;
4709	5023	vop->version = vop_data->version;
	5024	+ vop->soc_id = vop_data->soc_id;
	5025	+ vop->id = vop_data->vop_id;
4710	5026	dev_set_drvdata(dev, vop);
4711	5027	vop->support_multi_area = of_property_read_bool(dev->of_node, "support-multi-area");
4712	5028