~hc/RK356X_SDK_RELEASE.git

..	..	@@ -1,59 +1,55 @@
	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
15		-#include <drm/drm.h>
16		-#include <drm/drmP.h>
17		-#include <drm/drm_atomic.h>
18		-#include <drm/drm_crtc.h>
19		-#include <drm/drm_crtc_helper.h>
20		-#include <drm/drm_flip_work.h>
21		-#include <drm/drm_plane_helper.h>
22		-#ifdef CONFIG_DRM_ANALOGIX_DP
23		-#include <drm/bridge/analogix_dp.h>
24		-#endif
25		-#include <dt-bindings/soc/rockchip-system-status.h>
26		-
	7	+#include <linux/clk.h>
	8	+#include <linux/component.h>
27	9	#include <linux/debugfs.h>
	10	+#include <linux/delay.h>
28	11	#include <linux/fixp-arith.h>
29	12	#include <linux/iopoll.h>
30	13	#include <linux/kernel.h>
	14	+#include <linux/mfd/syscon.h>
31	15	#include <linux/module.h>
32		-#include <linux/platform_device.h>
33		-#include <linux/clk.h>
34		-#include <linux/iopoll.h>
35	16	#include <linux/of.h>
36	17	#include <linux/of_device.h>
37		-#include <linux/pm_runtime.h>
38		-#include <linux/component.h>
39	18	#include <linux/overflow.h>
	19	+#include <linux/platform_device.h>
	20	+#include <linux/pm_runtime.h>
40	21	#include <linux/regmap.h>
41		-#include <linux/mfd/syscon.h>
42		-
43	22	#include <linux/reset.h>
44		-#include <linux/delay.h>
45	23	#include <linux/sort.h>
	24	+
	25	+#include <drm/drm.h>
	26	+#include <drm/drm_atomic.h>
	27	+#include <drm/drm_atomic_uapi.h>
	28	+#include <drm/drm_crtc.h>
	29	+#include <drm/drm_crtc_helper.h>
	30	+#include <drm/drm_debugfs.h>
	31	+#include <drm/drm_flip_work.h>
	32	+#include <drm/drm_fourcc.h>
	33	+#include <drm/drm_gem_framebuffer_helper.h>
	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	+
	39	+#ifdef CONFIG_DRM_ANALOGIX_DP
	40	+#include <drm/bridge/analogix_dp.h>
	41	+#endif
	42	+
46	43	#include <soc/rockchip/rockchip_dmc.h>
47	44	#include <soc/rockchip/rockchip-system-status.h>
48	45	#include <uapi/linux/videodev2.h>
49		-
50		-#include "../drm_internal.h"
	46	+#include "../drm_crtc_internal.h"
51	47
52	48	#include "rockchip_drm_drv.h"
53	49	#include "rockchip_drm_gem.h"
54	50	#include "rockchip_drm_fb.h"
55		-#include "rockchip_drm_psr.h"
56	51	#include "rockchip_drm_vop.h"
	52	+#include "rockchip_rgb.h"
57	53
58	54	#define VOP_REG_SUPPORT(vop, reg) \
59	55	(reg.mask && \
..	..	@@ -151,7 +147,6 @@
151	147	} \
152	148	} while (0)
153	149
154		-#define to_vop(x) container_of(x, struct vop, crtc)
155	150	#define to_vop_win(x) container_of(x, struct vop_win, base)
156	151	#define to_vop_plane_state(x) container_of(x, struct vop_plane_state, base)
157	152
..	..	@@ -172,7 +167,6 @@
172	167	struct drm_rect dest;
173	168	dma_addr_t yrgb_mst;
174	169	dma_addr_t uv_mst;
175		- void *yrgb_kvaddr;
176	170	const uint32_t *y2r_table;
177	171	const uint32_t *r2r_table;
178	172	const uint32_t *r2y_table;
..	..	@@ -181,7 +175,7 @@
181	175	bool r2r_en;
182	176	bool r2y_en;
183	177	int color_space;
184		- int color_key;
	178	+ u32 color_key;
185	179	unsigned int csc_mode;
186	180	int global_alpha;
187	181	int blend_mode;
..	..	@@ -191,21 +185,15 @@
191	185	struct vop_dump_list *planlist;
192	186	};
193	187
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	188	struct vop_win {
204	189	struct vop_win *parent;
205	190	struct drm_plane base;
206	191
207	192	int win_id;
208	193	int area_id;
	194	+ u8 plane_id; /* unique plane id */
	195	+ const char *name;
	196	+
209	197	int zpos;
210	198	uint32_t offset;
211	199	enum drm_plane_type type;
..	..	@@ -213,28 +201,43 @@
213	201	const struct vop_csc *csc;
214	202	const uint32_t *data_formats;
215	203	uint32_t nformats;
	204	+ const uint64_t *format_modifiers;
216	205	u64 feature;
217	206	struct vop *vop;
218	207	struct vop_plane_state state;
219	208
	209	+ struct drm_property *input_width_prop;
	210	+ struct drm_property *input_height_prop;
	211	+ struct drm_property *output_width_prop;
	212	+ struct drm_property *output_height_prop;
220	213	struct drm_property *color_key_prop;
	214	+ struct drm_property *scale_prop;
	215	+ struct drm_property *name_prop;
221	216	};
222	217
223	218	struct vop {
224		- struct drm_crtc crtc;
	219	+ struct rockchip_crtc rockchip_crtc;
225	220	struct device *dev;
226	221	struct drm_device *drm_dev;
227	222	struct dentry *debugfs;
228	223	struct drm_info_list *debugfs_files;
229		- struct drm_property *plane_zpos_prop;
230	224	struct drm_property *plane_feature_prop;
231	225	struct drm_property *feature_prop;
	226	+
232	227	bool is_iommu_enabled;
233	228	bool is_iommu_needed;
234	229	bool is_enabled;
235	230	bool support_multi_area;
236	231
	232	+ bool aclk_rate_reset;
	233	+ unsigned long aclk_rate;
	234	+
237	235	u32 version;
	236	+ u32 background;
	237	+ u32 line_flag;
	238	+ u8 id;
	239	+ u64 soc_id;
	240	+ struct drm_prop_enum_list *plane_name_list;
238	241
239	242	struct drm_tv_connector_state active_tv_state;
240	243	bool pre_overlay;
..	..	@@ -308,13 +311,14 @@
308	311	{ MEDIA_BUS_FMT_RGB666_1X18, "RGB666_1X18" },
309	312	{ MEDIA_BUS_FMT_RGB666_1X24_CPADHI, "RGB666_1X24_CPADHI" },
310	313	{ MEDIA_BUS_FMT_RGB666_1X7X3_SPWG, "RGB666_1X7X3_SPWG" },
311		- { MEDIA_BUS_FMT_RGB666_1X7X3_JEIDA, "RGB666_1X7X3_JEIDA" },
312	314	{ MEDIA_BUS_FMT_YUV8_1X24, "YUV8_1X24" },
313	315	{ MEDIA_BUS_FMT_UYYVYY8_0_5X24, "UYYVYY8_0_5X24" },
314	316	{ MEDIA_BUS_FMT_YUV10_1X30, "YUV10_1X30" },
315	317	{ 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" },
	318	+ { MEDIA_BUS_FMT_RGB565_2X8_LE, "RGB565_2X8_LE" },
	319	+ { MEDIA_BUS_FMT_RGB666_3X6, "RGB666_3X6" },
	320	+ { MEDIA_BUS_FMT_RGB888_3X8, "RGB888_3X8" },
	321	+ { MEDIA_BUS_FMT_RGB888_DUMMY_4X8, "RGB888_DUMMY_4X8" },
318	322	{ MEDIA_BUS_FMT_RGB888_1X24, "RGB888_1X24" },
319	323	{ MEDIA_BUS_FMT_RGB888_1X7X4_SPWG, "RGB888_1X7X4_SPWG" },
320	324	{ MEDIA_BUS_FMT_RGB888_1X7X4_JEIDA, "RGB888_1X7X4_JEIDA" },
..	..	@@ -324,6 +328,15 @@
324	328	};
325	329
326	330	static DRM_ENUM_NAME_FN(drm_get_bus_format_name, drm_bus_format_enum_list)
	331	+
	332	+static inline struct vop to_vop(struct drm_crtc crtc)
	333	+{
	334	+ struct rockchip_crtc *rockchip_crtc;
	335	+
	336	+ rockchip_crtc = container_of(crtc, struct rockchip_crtc, crtc);
	337	+
	338	+ return container_of(rockchip_crtc, struct vop, rockchip_crtc);
	339	+}
327	340
328	341	static void vop_lock(struct vop *vop)
329	342	{
..	..	@@ -449,6 +462,11 @@
449	462	const struct vop_hdr_table *table = vop->data->hdr_table;
450	463	uint32_t sdr2hdr_eotf_oetf_yn[65];
451	464	uint32_t sdr2hdr_oetf_dx_dxpow[64];
	465	+
	466	+ if (cmd != SDR2HDR_FOR_BT2020 && cmd != SDR2HDR_FOR_HDR && cmd != SDR2HDR_FOR_HLG_HDR) {
	467	+ DRM_WARN("unknown sdr2hdr oetf: %d\n", cmd);
	468	+ return;
	469	+ }
452	470
453	471	for (i = 0; i < 65; i++) {
454	472	if (cmd == SDR2HDR_FOR_BT2020)
..	..	@@ -583,20 +601,46 @@
583	601	case DRM_FORMAT_BGR565:
584	602	return VOP_FMT_RGB565;
585	603	case DRM_FORMAT_NV12:
586		- case DRM_FORMAT_NV12_10:
	604	+ case DRM_FORMAT_NV15:
587	605	return VOP_FMT_YUV420SP;
588	606	case DRM_FORMAT_NV16:
589		- case DRM_FORMAT_NV16_10:
	607	+ case DRM_FORMAT_NV20:
590	608	return VOP_FMT_YUV422SP;
591	609	case DRM_FORMAT_NV24:
592		- case DRM_FORMAT_NV24_10:
	610	+ case DRM_FORMAT_NV30:
593	611	return VOP_FMT_YUV444SP;
	612	+ case DRM_FORMAT_YVYU:
	613	+ case DRM_FORMAT_VYUY:
594	614	case DRM_FORMAT_YUYV:
	615	+ case DRM_FORMAT_UYVY:
595	616	return VOP_FMT_YUYV;
596	617	default:
597	618	DRM_ERROR("unsupported format[%08x]\n", format);
598	619	return -EINVAL;
599	620	}
	621	+}
	622	+
	623	+static int vop_convert_afbc_format(uint32_t format)
	624	+{
	625	+ switch (format) {
	626	+ case DRM_FORMAT_XRGB8888:
	627	+ case DRM_FORMAT_ARGB8888:
	628	+ case DRM_FORMAT_XBGR8888:
	629	+ case DRM_FORMAT_ABGR8888:
	630	+ return AFBDC_FMT_U8U8U8U8;
	631	+ case DRM_FORMAT_RGB888:
	632	+ case DRM_FORMAT_BGR888:
	633	+ return AFBDC_FMT_U8U8U8;
	634	+ case DRM_FORMAT_RGB565:
	635	+ case DRM_FORMAT_BGR565:
	636	+ return AFBDC_FMT_RGB565;
	637	+ /* either of the below should not be reachable */
	638	+ default:
	639	+ DRM_WARN_ONCE("unsupported AFBC format[%08x]\n", format);
	640	+ return -EINVAL;
	641	+ }
	642	+
	643	+ return -EINVAL;
600	644	}
601	645
602	646	static bool is_uv_swap(uint32_t bus_format, uint32_t output_mode)
..	..	@@ -618,6 +662,21 @@
618	662	bus_format == MEDIA_BUS_FMT_YUV10_1X30) &&
619	663	(output_mode == ROCKCHIP_OUT_MODE_AAAA \|\|
620	664	output_mode == ROCKCHIP_OUT_MODE_P888)))
	665	+ return true;
	666	+ else
	667	+ return false;
	668	+}
	669	+
	670	+static bool is_rb_swap(uint32_t bus_format, uint32_t output_mode)
	671	+{
	672	+ /*
	673	+ * The default component order of serial formats
	674	+ * is BGR. So it is needed to enable RB swap.
	675	+ */
	676	+ if (bus_format == MEDIA_BUS_FMT_RGB888_3X8 \|\|
	677	+ bus_format == MEDIA_BUS_FMT_RGB888_DUMMY_4X8 \|\|
	678	+ bus_format == MEDIA_BUS_FMT_RGB666_3X6 \|\|
	679	+ bus_format == MEDIA_BUS_FMT_RGB565_2X8_LE)
621	680	return true;
622	681	else
623	682	return false;
..	..	@@ -661,12 +720,15 @@
661	720	{
662	721	switch (format) {
663	722	case DRM_FORMAT_NV12:
664		- case DRM_FORMAT_NV12_10:
	723	+ case DRM_FORMAT_NV15:
665	724	case DRM_FORMAT_NV16:
666		- case DRM_FORMAT_NV16_10:
	725	+ case DRM_FORMAT_NV20:
667	726	case DRM_FORMAT_NV24:
668		- case DRM_FORMAT_NV24_10:
	727	+ case DRM_FORMAT_NV30:
	728	+ case DRM_FORMAT_YVYU:
	729	+ case DRM_FORMAT_VYUY:
669	730	case DRM_FORMAT_YUYV:
	731	+ case DRM_FORMAT_UYVY:
670	732	return true;
671	733	default:
672	734	return false;
..	..	@@ -676,7 +738,10 @@
676	738	static bool is_yuyv_format(uint32_t format)
677	739	{
678	740	switch (format) {
	741	+ case DRM_FORMAT_YVYU:
	742	+ case DRM_FORMAT_VYUY:
679	743	case DRM_FORMAT_YUYV:
	744	+ case DRM_FORMAT_UYVY:
680	745	return true;
681	746	default:
682	747	return false;
..	..	@@ -686,9 +751,9 @@
686	751	static bool is_yuv_10bit(uint32_t format)
687	752	{
688	753	switch (format) {
689		- case DRM_FORMAT_NV12_10:
690		- case DRM_FORMAT_NV16_10:
691		- case DRM_FORMAT_NV24_10:
	754	+ case DRM_FORMAT_NV15:
	755	+ case DRM_FORMAT_NV20:
	756	+ case DRM_FORMAT_NV30:
692	757	return true;
693	758	default:
694	759	return false;
..	..	@@ -704,6 +769,20 @@
704	769	default:
705	770	return false;
706	771	}
	772	+}
	773	+
	774	+static inline bool rockchip_afbc(struct drm_plane *plane, u64 modifier)
	775	+{
	776	+ int i;
	777	+
	778	+ if (modifier == DRM_FORMAT_MOD_LINEAR)
	779	+ return false;
	780	+
	781	+ for (i = 0 ; i < plane->modifier_count; i++)
	782	+ if (plane->modifiers[i] == modifier)
	783	+ break;
	784	+
	785	+ return (i < plane->modifier_count) ? true : false;
707	786	}
708	787
709	788	static uint16_t scl_vop_cal_scale(enum scale_mode mode, uint32_t src,
..	..	@@ -747,9 +826,9 @@
747	826	uint16_t yrgb_hor_scl_mode, yrgb_ver_scl_mode;
748	827	uint16_t cbcr_hor_scl_mode = SCALE_NONE;
749	828	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;
	829	+ const struct drm_format_info *info = drm_format_info(pixel_format);
	830	+ uint8_t hsub = info->hsub;
	831	+ uint8_t vsub = info->vsub;
753	832	bool is_yuv = false;
754	833	uint16_t cbcr_src_w = src_w / hsub;
755	834	uint16_t cbcr_src_h = src_h / vsub;
..	..	@@ -757,17 +836,27 @@
757	836	uint16_t lb_mode;
758	837	uint32_t val;
759	838	const struct vop_data *vop_data = vop->data;
	839	+ struct drm_display_mode *adjusted_mode = &vop->rockchip_crtc.crtc.state->adjusted_mode;
760	840	int vskiplines;
761	841
762	842	if (!win->phy->scl)
763	843	return;
	844	+
	845	+ if ((adjusted_mode->flags & DRM_MODE_FLAG_INTERLACE) && vop->version == VOP_VERSION(2, 2)) {
	846	+ VOP_SCL_SET(vop, win, scale_yrgb_x, ((src_w << 12) / dst_w));
	847	+ VOP_SCL_SET(vop, win, scale_yrgb_y, ((src_h << 12) / dst_h));
	848	+ if (is_yuv) {
	849	+ VOP_SCL_SET(vop, win, scale_cbcr_x, ((cbcr_src_w << 12) / dst_w));
	850	+ VOP_SCL_SET(vop, win, scale_cbcr_y, ((cbcr_src_h << 12) / dst_h));
	851	+ }
	852	+ return;
	853	+ }
764	854
765	855	if (!(vop_data->feature & VOP_FEATURE_ALPHA_SCALE)) {
766	856	if (is_alpha_support(pixel_format) &&
767	857	(src_w != dst_w \|\| src_h != dst_h))
768	858	DRM_ERROR("ERROR: unsupported ppixel alpha&scale\n");
769	859	}
770		- info = drm_format_info(pixel_format);
771	860
772	861	if (info->is_yuv)
773	862	is_yuv = true;
..	..	@@ -1193,7 +1282,7 @@
1193	1282	* UI(rgbx) -> yuv -> rgb ->hdr2sdr -> overlay -> output.
1194	1283	*/
1195	1284	if (s->hdr.hdr2sdr_en &&
1196		- vop_plane_state->eotf == SMPTE_ST2084 &&
	1285	+ vop_plane_state->eotf == HDMI_EOTF_SMPTE_ST2084 &&
1197	1286	!is_yuv_support(pstate->fb->format->format))
1198	1287	vop_plane_state->r2y_en = true;
1199	1288	if (win->feature & WIN_FEATURE_PRE_OVERLAY)
..	..	@@ -1533,6 +1622,18 @@
1533	1622	vop_enable_debug_irq(crtc);
1534	1623	}
1535	1624
	1625	+static void vop_crtc_atomic_disable_for_psr(struct drm_crtc *crtc,
	1626	+ struct drm_crtc_state *old_state)
	1627	+{
	1628	+ struct vop *vop = to_vop(crtc);
	1629	+
	1630	+ vop_disable_all_planes(vop);
	1631	+ drm_crtc_vblank_off(crtc);
	1632	+ vop->aclk_rate = clk_get_rate(vop->aclk);
	1633	+ clk_set_rate(vop->aclk, vop->aclk_rate / 3);
	1634	+ vop->aclk_rate_reset = true;
	1635	+}
	1636	+
1536	1637	static void vop_crtc_atomic_disable(struct drm_crtc *crtc,
1537	1638	struct drm_crtc_state *old_state)
1538	1639	{
..	..	@@ -1541,6 +1642,11 @@
1541	1642	SYS_STATUS_LCDC1 : SYS_STATUS_LCDC0;
1542	1643
1543	1644	WARN_ON(vop->event);
	1645	+
	1646	+ if (crtc->state->self_refresh_active) {
	1647	+ vop_crtc_atomic_disable_for_psr(crtc, old_state);
	1648	+ goto out;
	1649	+ }
1544	1650
1545	1651	vop_lock(vop);
1546	1652	VOP_CTRL_SET(vop, reg_done_frm, 1);
..	..	@@ -1589,6 +1695,7 @@
1589	1695
1590	1696	rockchip_clear_system_status(sys_status);
1591	1697
	1698	+out:
1592	1699	if (crtc->state->event && !crtc->state->active) {
1593	1700	spin_lock_irq(&crtc->dev->event_lock);
1594	1701	drm_crtc_send_vblank_event(crtc, crtc->state->event);
..	..	@@ -1614,6 +1721,21 @@
1614	1721	drm_framebuffer_put(old_state->fb);
1615	1722	}
1616	1723
	1724	+static bool rockchip_vop_mod_supported(struct drm_plane *plane,
	1725	+ u32 format, u64 modifier)
	1726	+{
	1727	+ if (modifier == DRM_FORMAT_MOD_LINEAR)
	1728	+ return true;
	1729	+
	1730	+ if (!rockchip_afbc(plane, modifier)) {
	1731	+ DRM_DEBUG_KMS("Unsupported format modifier 0x%llx\n", modifier);
	1732	+
	1733	+ return false;
	1734	+ }
	1735	+
	1736	+ return vop_convert_afbc_format(format) >= 0;
	1737	+}
	1738	+
1617	1739	static int vop_plane_atomic_check(struct drm_plane *plane,
1618	1740	struct drm_plane_state *state)
1619	1741	{
..	..	@@ -1627,13 +1749,14 @@
1627	1749	int ret;
1628	1750	struct drm_rect *dest = &vop_plane_state->dest;
1629	1751	struct drm_rect *src = &vop_plane_state->src;
	1752	+ struct drm_gem_object obj, uv_obj;
	1753	+ struct rockchip_gem_object rk_obj, rk_uv_obj;
1630	1754	int min_scale = win->phy->scl ? FRAC_16_16(1, 8) :
1631	1755	DRM_PLANE_HELPER_NO_SCALING;
1632	1756	int max_scale = win->phy->scl ? FRAC_16_16(8, 1) :
1633	1757	DRM_PLANE_HELPER_NO_SCALING;
1634	1758	unsigned long offset;
1635	1759	dma_addr_t dma_addr;
1636		- void *kvaddr;
1637	1760
1638	1761	crtc = crtc ? crtc : plane->state->crtc;
1639	1762	if (!crtc \|\| !fb) {
..	..	@@ -1645,14 +1768,8 @@
1645	1768	if (WARN_ON(!crtc_state))
1646	1769	return -EINVAL;
1647	1770
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;
	1771	+ vop_plane_state->zpos = state->zpos;
	1772	+ vop_plane_state->blend_mode = state->pixel_blend_mode;
1656	1773
1657	1774	ret = drm_atomic_helper_check_plane_state(state, crtc_state,
1658	1775	min_scale, max_scale,
..	..	@@ -1660,8 +1777,22 @@
1660	1777	if (ret)
1661	1778	return ret;
1662	1779
1663		- if (!state->visible)
	1780	+ if (!state->visible) {
	1781	+ DRM_ERROR("%s is invisible(src: pos[%d, %d] rect[%d x %d] dst: pos[%d, %d] rect[%d x %d]\n",
	1782	+ plane->name, state->src_x >> 16, state->src_y >> 16, state->src_w >> 16,
	1783	+ state->src_h >> 16, state->crtc_x, state->crtc_y, state->crtc_w,
	1784	+ state->crtc_h);
1664	1785	return 0;
	1786	+ }
	1787	+
	1788	+ src->x1 = state->src.x1;
	1789	+ src->y1 = state->src.y1;
	1790	+ src->x2 = state->src.x2;
	1791	+ src->y2 = state->src.y2;
	1792	+ dest->x1 = state->dst.x1;
	1793	+ dest->y1 = state->dst.y1;
	1794	+ dest->x2 = state->dst.x2;
	1795	+ dest->y2 = state->dst.y2;
1665	1796
1666	1797	vop_plane_state->format = vop_convert_format(fb->format->format);
1667	1798	if (vop_plane_state->format < 0)
..	..	@@ -1670,12 +1801,19 @@
1670	1801	vop = to_vop(crtc);
1671	1802	vop_data = vop->data;
1672	1803
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);
	1804	+ if (VOP_MAJOR(vop->version) == 2 && is_alpha_support(fb->format->format) &&
	1805	+ vop_plane_state->global_alpha != 0xff) {
	1806	+ DRM_ERROR("Pixel alpha and global alpha can't be enabled at the same time\n");
1678	1807	return -EINVAL;
	1808	+ }
	1809	+
	1810	+ if (drm_rect_width(src) >> 16 < 4 \|\| drm_rect_height(src) >> 16 < 4 \|\|
	1811	+ drm_rect_width(dest) < 4 \|\| drm_rect_width(dest) < 4) {
	1812	+ DRM_ERROR("Invalid size: %dx%d->%dx%d, min size is 4x4\n",
	1813	+ drm_rect_width(src) >> 16, drm_rect_height(src) >> 16,
	1814	+ drm_rect_width(dest), drm_rect_height(dest));
	1815	+ state->visible = false;
	1816	+ return 0;
1679	1817	}
1680	1818
1681	1819	if (drm_rect_width(src) >> 16 > vop_data->max_input.width \|\|
..	..	@@ -1702,26 +1840,27 @@
1702	1840	return -EINVAL;
1703	1841	}
1704	1842
1705		- offset = (src->x1 >> 16) * fb->format->bpp[0] / 8;
	1843	+ offset = (src->x1 >> 16) * fb->format->cpp[0];
1706	1844	vop_plane_state->offset = offset + fb->offsets[0];
1707	1845	if (state->rotation & DRM_MODE_REFLECT_Y)
1708	1846	offset += ((src->y2 >> 16) - 1) * fb->pitches[0];
1709	1847	else
1710	1848	offset += (src->y1 >> 16) * fb->pitches[0];
1711	1849
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];
	1850	+ obj = fb->obj[0];
	1851	+ rk_obj = to_rockchip_obj(obj);
	1852	+ vop_plane_state->yrgb_mst = rk_obj->dma_addr + offset + fb->offsets[0];
1716	1853	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);
	1854	+ int hsub = fb->format->hsub;
	1855	+ int vsub = fb->format->vsub;
1719	1856
1720		- offset = (src->x1 >> 16) * fb->format->bpp[1] / hsub / 8;
	1857	+ offset = (src->x1 >> 16) * fb->format->cpp[1] / hsub;
1721	1858	offset += (src->y1 >> 16) * fb->pitches[1] / vsub;
1722	1859
1723		- dma_addr = rockchip_fb_get_dma_addr(fb, 1);
1724		- dma_addr += offset + fb->offsets[1];
	1860	+ uv_obj = fb->obj[1];
	1861	+ rk_uv_obj = to_rockchip_obj(uv_obj);
	1862	+
	1863	+ dma_addr = rk_uv_obj->dma_addr + offset + fb->offsets[1];
1725	1864	vop_plane_state->uv_mst = dma_addr;
1726	1865	}
1727	1866
..	..	@@ -1740,6 +1879,9 @@
1740	1879
1741	1880	if (!old_state->crtc)
1742	1881	return;
	1882	+
	1883	+ rockchip_drm_dbg(vop->dev, VOP_DEBUG_PLANE, "disable win%d-area%d by %s\n",
	1884	+ win->win_id, win->area_id, current->comm);
1743	1885
1744	1886	spin_lock(&vop->reg_lock);
1745	1887
..	..	@@ -1847,20 +1989,19 @@
1847	1989	uint32_t val;
1848	1990	bool rb_swap, global_alpha_en;
1849	1991	int is_yuv = fb->format->is_yuv;
	1992	+ struct drm_format_name_buf format_name;
1850	1993
1851	1994	#if defined(CONFIG_ROCKCHIP_DRM_DEBUG)
1852	1995	bool AFBC_flag = false;
1853	1996	struct vop_dump_list *planlist;
1854	1997	unsigned long num_pages;
1855	1998	struct page **pages;
1856		- struct rockchip_drm_fb *rk_fb;
1857	1999	struct drm_gem_object *obj;
1858	2000	struct rockchip_gem_object *rk_obj;
1859	2001
1860	2002	num_pages = 0;
1861	2003	pages = NULL;
1862		- rk_fb = to_rockchip_fb(fb);
1863		- obj = rk_fb->obj[0];
	2004	+ obj = fb->obj[0];
1864	2005	rk_obj = to_rockchip_obj(obj);
1865	2006	if (rk_obj) {
1866	2007	num_pages = rk_obj->num_pages;
..	..	@@ -1908,6 +2049,8 @@
1908	2049	dsp_h = 4;
1909	2050	actual_h = dsp_h * actual_h / drm_rect_height(dest);
1910	2051	}
	2052	+ if ((adjusted_mode->flags & DRM_MODE_FLAG_INTERLACE) && vop->version == VOP_VERSION(2, 2))
	2053	+ dsp_h = dsp_h / 2;
1911	2054
1912	2055	act_info = (actual_h - 1) << 16 \| ((actual_w - 1) & 0xffff);
1913	2056
..	..	@@ -1916,12 +2059,18 @@
1916	2059
1917	2060	dsp_stx = dest->x1 + mode->crtc_htotal - mode->crtc_hsync_start;
1918	2061	dsp_sty = dest->y1 + mode->crtc_vtotal - mode->crtc_vsync_start;
	2062	+ if ((adjusted_mode->flags & DRM_MODE_FLAG_INTERLACE) && vop->version == VOP_VERSION(2, 2))
	2063	+ dsp_sty = dest->y1 / 2 + mode->crtc_vtotal - mode->crtc_vsync_start;
1919	2064	dsp_st = dsp_sty << 16 \| (dsp_stx & 0xffff);
1920	2065
1921	2066	s = to_rockchip_crtc_state(crtc->state);
1922	2067	spin_lock(&vop->reg_lock);
1923	2068
1924	2069	VOP_WIN_SET(vop, win, format, vop_plane_state->format);
	2070	+
	2071	+ VOP_WIN_SET(vop, win, interlace_read,
	2072	+ (adjusted_mode->flags & DRM_MODE_FLAG_INTERLACE) ? 1 : 0);
	2073	+
1925	2074	VOP_WIN_SET(vop, win, yrgb_vir, DIV_ROUND_UP(fb->pitches[0], 4));
1926	2075	VOP_WIN_SET(vop, win, yrgb_mst, vop_plane_state->yrgb_mst);
1927	2076
..	..	@@ -1939,7 +2088,7 @@
1939	2088
1940	2089	if (win->phy->scl)
1941	2090	scl_vop_cal_scl_fac(vop, win, actual_w, actual_h,
1942		- drm_rect_width(dest), drm_rect_height(dest),
	2091	+ drm_rect_width(dest), dsp_h,
1943	2092	fb->format->format);
1944	2093
1945	2094	if (VOP_WIN_SUPPORT(vop, win, color_key))
..	..	@@ -1970,7 +2119,6 @@
1970	2119	src_blend_m0 = ALPHA_PER_PIX;
1971	2120	else
1972	2121	src_blend_m0 = ALPHA_GLOBAL;
1973		-
1974	2122
1975	2123	if (vop_plane_state->blend_mode == 0 \|\| src_blend_m0 == ALPHA_GLOBAL)
1976	2124	pre_multi_alpha = ALPHA_SRC_NO_PRE_MUL;
..	..	@@ -2006,6 +2154,13 @@
2006	2154	VOP_WIN_SET(vop, win, enable, 1);
2007	2155	VOP_WIN_SET(vop, win, gate, 1);
2008	2156	spin_unlock(&vop->reg_lock);
	2157	+
	2158	+ drm_get_format_name(fb->format->format, &format_name);
	2159	+ rockchip_drm_dbg(vop->dev, VOP_DEBUG_PLANE,
	2160	+ "update win%d-area%d [%dx%d->%dx%d@(%d, %d)] zpos:%d fmt[%s%s] addr[%pad] by %s\n",
	2161	+ win->win_id, win->area_id, actual_w, actual_h,
	2162	+ dsp_w, dsp_h, dsp_stx, dsp_sty, vop_plane_state->zpos, format_name.str,
	2163	+ fb->modifier ? "[AFBC]" : "", &vop_plane_state->yrgb_mst, current->comm);
2009	2164	/*
2010	2165	* spi interface(vop_plane_state->yrgb_kvaddr, fb->pixel_format,
2011	2166	* actual_w, actual_h)
..	..	@@ -2027,17 +2182,17 @@
2027	2182	planlist->dump_info.offset = vop_plane_state->offset;
2028	2183	planlist->dump_info.pitches = fb->pitches[0];
2029	2184	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);
	2185	+ planlist->dump_info.format = fb->format;
	2186	+ list_add_tail(&planlist->entry, &vop->rockchip_crtc.vop_dump_list_head);
2032	2187	vop_plane_state->planlist = planlist;
2033	2188	} else {
2034	2189	DRM_ERROR("can't alloc a node of planlist %p\n", planlist);
2035	2190	return;
2036	2191	}
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--;
	2192	+ if (vop->rockchip_crtc.vop_dump_status == DUMP_KEEP \|\|
	2193	+ vop->rockchip_crtc.vop_dump_times > 0) {
	2194	+ rockchip_drm_dump_plane_buffer(&planlist->dump_info, vop->rockchip_crtc.frame_count);
	2195	+ vop->rockchip_crtc.vop_dump_times--;
2041	2196	}
2042	2197	#endif
2043	2198	}
..	..	@@ -2186,10 +2341,9 @@
2186	2341	if (!vop_plane_state)
2187	2342	return;
2188	2343
2189		- win->state.zpos = win->zpos;
	2344	+ __drm_atomic_helper_plane_reset(plane, &vop_plane_state->base);
	2345	+ vop_plane_state->base.zpos = win->zpos;
2190	2346	vop_plane_state->global_alpha = 0xff;
2191		- plane->state = &vop_plane_state->base;
2192		- plane->state->plane = plane;
2193	2347	}
2194	2348
2195	2349	static struct drm_plane_state *
..	..	@@ -2232,11 +2386,6 @@
2232	2386	struct vop_win *win = to_vop_win(plane);
2233	2387	struct vop_plane_state *plane_state = to_vop_plane_state(state);
2234	2388
2235		- if (property == win->vop->plane_zpos_prop) {
2236		- plane_state->zpos = val;
2237		- return 0;
2238		- }
2239		-
2240	2389	if (property == private->eotf_prop) {
2241	2390	plane_state->eotf = val;
2242	2391	return 0;
..	..	@@ -2244,16 +2393,6 @@
2244	2393
2245	2394	if (property == private->color_space_prop) {
2246	2395	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	2396	return 0;
2258	2397	}
2259	2398
..	..	@@ -2282,11 +2421,6 @@
2282	2421	struct vop_win *win = to_vop_win(plane);
2283	2422	struct rockchip_drm_private *private = plane->dev->dev_private;
2284	2423
2285		- if (property == win->vop->plane_zpos_prop) {
2286		- *val = plane_state->zpos;
2287		- return 0;
2288		- }
2289		-
2290	2424	if (property == private->eotf_prop) {
2291	2425	*val = plane_state->eotf;
2292	2426	return 0;
..	..	@@ -2294,16 +2428,6 @@
2294	2428
2295	2429	if (property == private->color_space_prop) {
2296	2430	*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	2431	return 0;
2308	2432	}
2309	2433
..	..	@@ -2344,6 +2468,7 @@
2344	2468	.atomic_destroy_state = vop_atomic_plane_destroy_state,
2345	2469	.atomic_set_property = vop_atomic_plane_set_property,
2346	2470	.atomic_get_property = vop_atomic_plane_get_property,
	2471	+ .format_mod_supported = rockchip_vop_mod_supported,
2347	2472	};
2348	2473
2349	2474	static int vop_crtc_enable_vblank(struct drm_crtc *crtc)
..	..	@@ -2400,13 +2525,13 @@
2400	2525	if (e && e->base.file_priv == file_priv) {
2401	2526	vop->event = NULL;
2402	2527
2403		- //e->base.destroy(&e->base);//todo
	2528	+ /* e->base.destroy(&e->base);//todo */
2404	2529	file_priv->event_space += sizeof(e->event);
2405	2530	}
2406	2531	spin_unlock_irqrestore(&drm->event_lock, flags);
2407	2532	}
2408	2533
2409		-static int vop_crtc_loader_protect(struct drm_crtc *crtc, bool on)
	2534	+static int vop_crtc_loader_protect(struct drm_crtc crtc, bool on, void data)
2410	2535	{
2411	2536	struct rockchip_drm_private *private = crtc->dev->dev_private;
2412	2537	struct vop *vop = to_vop(crtc);
..	..	@@ -2465,6 +2590,9 @@
2465	2590	struct drm_framebuffer *fb = state->fb;
2466	2591	struct drm_format_name_buf format_name;
2467	2592	int i;
	2593	+ struct drm_gem_object *obj;
	2594	+ struct rockchip_gem_object *rk_obj;
	2595	+ dma_addr_t fb_addr;
2468	2596	u64 afbdc_format =
2469	2597	DRM_FORMAT_MOD_ARM_AFBC(AFBC_FORMAT_MOD_BLOCK_SIZE_16x16);
2470	2598
..	..	@@ -2492,14 +2620,30 @@
2492	2620	DEBUG_PRINT("\tdst: pos[%dx%d] rect[%dx%d]\n", dest->x1, dest->y1,
2493	2621	drm_rect_width(dest), drm_rect_height(dest));
2494	2622
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);
	2623	+ for (i = 0; i < fb->format->num_planes; i++) {
	2624	+ obj = fb->obj[0];
	2625	+ rk_obj = to_rockchip_obj(obj);
	2626	+ fb_addr = rk_obj->dma_addr + fb->offsets[0];
2497	2627
2498	2628	DEBUG_PRINT("\tbuf[%d]: addr: %pad pitch: %d offset: %d\n",
2499	2629	i, &fb_addr, fb->pitches[i], fb->offsets[i]);
2500	2630	}
2501	2631
2502	2632	return 0;
	2633	+}
	2634	+
	2635	+static void vop_dump_connector_on_crtc(struct drm_crtc crtc, struct seq_file s)
	2636	+{
	2637	+ struct drm_connector_list_iter conn_iter;
	2638	+ struct drm_connector *connector;
	2639	+
	2640	+ drm_connector_list_iter_begin(crtc->dev, &conn_iter);
	2641	+ drm_for_each_connector_iter(connector, &conn_iter) {
	2642	+ if (crtc->state->connector_mask & drm_connector_mask(connector))
	2643	+ DEBUG_PRINT(" Connector: %s\n", connector->name);
	2644	+
	2645	+ }
	2646	+ drm_connector_list_iter_end(&conn_iter);
2503	2647	}
2504	2648
2505	2649	static int vop_crtc_debugfs_dump(struct drm_crtc crtc, struct seq_file s)
..	..	@@ -2518,8 +2662,7 @@
2518	2662	if (!crtc_state->active)
2519	2663	return 0;
2520	2664
2521		- DEBUG_PRINT(" Connector: %s\n",
2522		- drm_get_connector_name(state->output_type));
	2665	+ vop_dump_connector_on_crtc(crtc, s);
2523	2666	DEBUG_PRINT("\tbus_format[%x]: %s\n", state->bus_format,
2524	2667	drm_get_bus_format_name(state->bus_format));
2525	2668	DEBUG_PRINT("\toverlay_mode[%d] output_mode[%x]",
..	..	@@ -2613,24 +2756,15 @@
2613	2756	goto remove;
2614	2757	}
2615	2758	#if defined(CONFIG_ROCKCHIP_DRM_DEBUG)
2616		- drm_debugfs_vop_add(crtc, vop->debugfs);
	2759	+ rockchip_drm_add_dump_buffer(crtc, vop->debugfs);
2617	2760	#endif
2618	2761	for (i = 0; i < ARRAY_SIZE(vop_debugfs_files); i++)
2619	2762	vop->debugfs_files[i].data = vop;
2620	2763
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		- }
	2764	+ drm_debugfs_create_files(vop->debugfs_files, ARRAY_SIZE(vop_debugfs_files),
	2765	+ vop->debugfs, minor);
2629	2766
2630	2767	return 0;
2631		-free:
2632		- kfree(vop->debugfs_files);
2633		- vop->debugfs_files = NULL;
2634	2768	remove:
2635	2769	debugfs_remove(vop->debugfs);
2636	2770	vop->debugfs = NULL;
..	..	@@ -2638,10 +2772,10 @@
2638	2772	}
2639	2773
2640	2774	static enum drm_mode_status
2641		-vop_crtc_mode_valid(struct drm_crtc crtc, const struct drm_display_mode mode,
2642		- int output_type)
	2775	+vop_crtc_mode_valid(struct drm_crtc crtc, const struct drm_display_mode mode)
2643	2776	{
2644	2777	struct vop *vop = to_vop(crtc);
	2778	+ struct rockchip_crtc_state *s = to_rockchip_crtc_state(crtc->state);
2645	2779	const struct vop_data *vop_data = vop->data;
2646	2780	int request_clock = mode->clock;
2647	2781	int clock;
..	..	@@ -2654,15 +2788,20 @@
2654	2788	VOP_MINOR(vop->version) <= 2)
2655	2789	return MODE_BAD;
2656	2790
2657		- if (mode->flags & DRM_MODE_FLAG_DBLCLK)
	2791	+ /*
	2792	+ * Dclk need to be double if BT656 interface and vop version >= 2.12.
	2793	+ */
	2794	+ if (mode->flags & DRM_MODE_FLAG_DBLCLK \|\|
	2795	+ (VOP_MAJOR(vop->version) == 2 && VOP_MINOR(vop->version) >= 12 &&
	2796	+ s->output_if & VOP_OUTPUT_IF_BT656))
2658	2797	request_clock *= 2;
2659	2798	clock = clk_round_rate(vop->dclk, request_clock * 1000) / 1000;
2660	2799
2661	2800	/*
2662	2801	* Hdmi or DisplayPort request a Accurate clock.
2663	2802	*/
2664		- if (output_type == DRM_MODE_CONNECTOR_HDMIA \|\|
2665		- output_type == DRM_MODE_CONNECTOR_DisplayPort)
	2803	+ if (s->output_type == DRM_MODE_CONNECTOR_HDMIA \|\|
	2804	+ s->output_type == DRM_MODE_CONNECTOR_DisplayPort)
2666	2805	if (clock != request_clock)
2667	2806	return MODE_CLOCK_RANGE;
2668	2807
..	..	@@ -2692,7 +2831,7 @@
2692	2831	struct drm_framebuffer *fb = pstate->fb;
2693	2832	struct drm_rect *dest = &vop_plane_state->dest;
2694	2833	struct drm_rect *src = &vop_plane_state->src;
2695		- int bpp = fb->format->bpp[0];
	2834	+ int bpp = fb->format->cpp[0] << 3;
2696	2835	int src_width = drm_rect_width(src) >> 16;
2697	2836	int src_height = drm_rect_height(src) >> 16;
2698	2837	int dest_width = drm_rect_width(dest);
..	..	@@ -2741,8 +2880,7 @@
2741	2880
2742	2881	static size_t vop_crtc_bandwidth(struct drm_crtc *crtc,
2743	2882	struct drm_crtc_state *crtc_state,
2744		- size_t *frame_bw_mbyte,
2745		- unsigned int *plane_num_total)
	2883	+ struct dmcfreq_vop_info *vop_bw_info)
2746	2884	{
2747	2885	struct drm_display_mode *adjusted_mode = &crtc_state->adjusted_mode;
2748	2886	u16 htotal = adjusted_mode->crtc_htotal;
..	..	@@ -2752,64 +2890,77 @@
2752	2890	struct drm_plane_state *pstate;
2753	2891	struct vop_bandwidth *pbandwidth;
2754	2892	struct drm_plane *plane;
2755		- u64 bandwidth;
	2893	+ u64 line_bw_mbyte = 0;
2756	2894	int cnt = 0, plane_num = 0;
2757	2895	struct drm_atomic_state *state = crtc_state->state;
2758	2896	#if defined(CONFIG_ROCKCHIP_DRM_DEBUG)
2759	2897	struct vop_dump_list pos, n;
	2898	+ struct vop *vop = to_vop(crtc);
2760	2899	#endif
2761	2900
2762	2901	if (!htotal \|\| !vdisplay)
2763	2902	return 0;
2764	2903
2765	2904	#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;
	2905	+ if (!vop->rockchip_crtc.vop_dump_list_init_flag) {
	2906	+ INIT_LIST_HEAD(&vop->rockchip_crtc.vop_dump_list_head);
	2907	+ vop->rockchip_crtc.vop_dump_list_init_flag = true;
2769	2908	}
2770		- list_for_each_entry_safe(pos, n, &crtc->vop_dump_list_head, entry) {
	2909	+ list_for_each_entry_safe(pos, n, &vop->rockchip_crtc.vop_dump_list_head, entry) {
2771	2910	list_del(&pos->entry);
2772	2911	}
2773		- if (crtc->vop_dump_status == DUMP_KEEP \|\|
2774		- crtc->vop_dump_times > 0) {
2775		- crtc->frame_count++;
	2912	+ if (vop->rockchip_crtc.vop_dump_status == DUMP_KEEP \|\|
	2913	+ vop->rockchip_crtc.vop_dump_times > 0) {
	2914	+ vop->rockchip_crtc.frame_count++;
2776	2915	}
2777	2916	#endif
2778	2917
2779	2918	drm_atomic_crtc_state_for_each_plane(plane, crtc_state)
2780	2919	plane_num++;
2781	2920
2782		- if (plane_num_total)
2783		- *plane_num_total += plane_num;
	2921	+ vop_bw_info->plane_num += plane_num;
2784	2922	pbandwidth = kmalloc_array(plane_num, sizeof(*pbandwidth),
2785	2923	GFP_KERNEL);
2786	2924	if (!pbandwidth)
2787	2925	return -ENOMEM;
2788	2926
2789	2927	drm_atomic_crtc_state_for_each_plane(plane, crtc_state) {
	2928	+ int act_w, act_h, cpp, afbc_fac;
	2929	+
2790	2930	pstate = drm_atomic_get_existing_plane_state(state, plane);
2791	2931	if (pstate->crtc != crtc \|\| !pstate->fb)
2792	2932	continue;
2793	2933
	2934	+ /* This is an empirical value, if it's afbc format, the frame buffer size div 2 */
	2935	+ afbc_fac = rockchip_afbc(plane, pstate->fb->modifier) ? 2 : 1;
	2936	+
2794	2937	vop_plane_state = to_vop_plane_state(pstate);
2795	2938	pbandwidth[cnt].y1 = vop_plane_state->dest.y1;
2796	2939	pbandwidth[cnt].y2 = vop_plane_state->dest.y2;
2797		- pbandwidth[cnt++].bandwidth = vop_plane_line_bandwidth(pstate);
	2940	+ pbandwidth[cnt++].bandwidth = vop_plane_line_bandwidth(pstate) / afbc_fac;
	2941	+
	2942	+ act_w = drm_rect_width(&pstate->src) >> 16;
	2943	+ act_h = drm_rect_height(&pstate->src) >> 16;
	2944	+ cpp = pstate->fb->format->cpp[0];
	2945	+
	2946	+ vop_bw_info->frame_bw_mbyte += act_w * act_h / 1000 * cpp * drm_mode_vrefresh(adjusted_mode) / 1000;
	2947	+
2798	2948	}
2799	2949
2800	2950	sort(pbandwidth, cnt, sizeof(pbandwidth[0]), vop_bandwidth_cmp, NULL);
2801	2951
2802		- bandwidth = vop_calc_max_bandwidth(pbandwidth, 0, cnt, vdisplay);
	2952	+ vop_bw_info->line_bw_mbyte = vop_calc_max_bandwidth(pbandwidth, 0, cnt, vdisplay);
2803	2953	kfree(pbandwidth);
2804	2954	/*
2805		- * bandwidth(MB/s)
	2955	+ * line_bandwidth(MB/s)
2806	2956	* = line_bandwidth / line_time
2807	2957	* = line_bandwidth(Byte) * clock(KHZ) / 1000 / htotal
2808	2958	*/
2809		- bandwidth *= clock;
2810		- do_div(bandwidth, htotal * 1000);
	2959	+ line_bw_mbyte *= clock;
	2960	+ do_div(line_bw_mbyte, htotal * 1000);
	2961	+ vop_bw_info->line_bw_mbyte = line_bw_mbyte;
2811	2962
2812		- return bandwidth;
	2963	+ return vop_bw_info->line_bw_mbyte;
2813	2964	}
2814	2965
2815	2966	static void vop_crtc_close(struct drm_crtc *crtc)
..	..	@@ -2892,16 +3043,50 @@
2892	3043	vop_set_out_mode(vop, state->output_mode);
2893	3044	}
2894	3045
	3046	+static int vop_crtc_wait_vact_end(struct drm_crtc *crtc, unsigned int mstimeout)
	3047	+{
	3048	+ struct vop *vop = to_vop(crtc);
	3049	+ unsigned long jiffies_left;
	3050	+ int ret = 0;
	3051	+
	3052	+ if (!vop->is_enabled)
	3053	+ return -ENODEV;
	3054	+
	3055	+ mutex_lock(&vop->vop_lock);
	3056	+
	3057	+ if (vop_line_flag_irq_is_enabled(vop)) {
	3058	+ ret = -EBUSY;
	3059	+ goto out;
	3060	+ }
	3061	+
	3062	+ reinit_completion(&vop->line_flag_completion);
	3063	+ vop_line_flag_irq_enable(vop);
	3064	+
	3065	+ jiffies_left = wait_for_completion_timeout(&vop->line_flag_completion,
	3066	+ msecs_to_jiffies(mstimeout));
	3067	+ vop_line_flag_irq_disable(vop);
	3068	+
	3069	+ if (jiffies_left == 0) {
	3070	+ DRM_DEV_ERROR(vop->dev, "timeout waiting for lineflag IRQ\n");
	3071	+ ret = -ETIMEDOUT;
	3072	+ goto out;
	3073	+ }
	3074	+
	3075	+out:
	3076	+ mutex_unlock(&vop->vop_lock);
	3077	+ return ret;
	3078	+}
	3079	+
2895	3080	static const struct rockchip_crtc_funcs private_crtc_funcs = {
2896	3081	.loader_protect = vop_crtc_loader_protect,
2897	3082	.cancel_pending_vblank = vop_crtc_cancel_pending_vblank,
2898	3083	.debugfs_init = vop_crtc_debugfs_init,
2899	3084	.debugfs_dump = vop_crtc_debugfs_dump,
2900	3085	.regs_dump = vop_crtc_regs_dump,
2901		- .mode_valid = vop_crtc_mode_valid,
2902	3086	.bandwidth = vop_crtc_bandwidth,
2903	3087	.crtc_close = vop_crtc_close,
2904	3088	.crtc_send_mcu_cmd = vop_crtc_send_mcu_cmd,
	3089	+ .wait_vact_end = vop_crtc_wait_vact_end,
2905	3090	};
2906	3091
2907	3092	static bool vop_crtc_mode_fixup(struct drm_crtc *crtc,
..	..	@@ -2910,6 +3095,8 @@
2910	3095	{
2911	3096	struct vop *vop = to_vop(crtc);
2912	3097	const struct vop_data *vop_data = vop->data;
	3098	+ struct drm_crtc_state *new_crtc_state = container_of(mode, struct drm_crtc_state, mode);
	3099	+ struct rockchip_crtc_state *s = to_rockchip_crtc_state(new_crtc_state);
2913	3100
2914	3101	if (mode->hdisplay > vop_data->max_output.width)
2915	3102	return false;
..	..	@@ -2917,8 +3104,17 @@
2917	3104	drm_mode_set_crtcinfo(adj_mode,
2918	3105	CRTC_INTERLACE_HALVE_V \| CRTC_STEREO_DOUBLE);
2919	3106
2920		- if (mode->flags & DRM_MODE_FLAG_DBLCLK)
	3107	+ /*
	3108	+ * Dclk need to be double if BT656 interface and vop version >= 2.12.
	3109	+ */
	3110	+ if (mode->flags & DRM_MODE_FLAG_DBLCLK \|\|
	3111	+ (VOP_MAJOR(vop->version) == 2 && VOP_MINOR(vop->version) >= 12 &&
	3112	+ s->output_if & VOP_OUTPUT_IF_BT656))
2921	3113	adj_mode->crtc_clock *= 2;
	3114	+
	3115	+ if (vop->mcu_timing.mcu_pix_total)
	3116	+ adj_mode->crtc_clock = rockchip_drm_get_cycles_per_pixel(s->bus_format)
	3117	+ (vop->mcu_timing.mcu_pix_total + 1);
2922	3118
2923	3119	adj_mode->crtc_clock =
2924	3120	DIV_ROUND_UP(clk_round_rate(vop->dclk, adj_mode->crtc_clock * 1000),
..	..	@@ -2943,13 +3139,14 @@
2943	3139
2944	3140	switch (s->bus_format) {
2945	3141	case MEDIA_BUS_FMT_RGB565_1X16:
	3142	+ case MEDIA_BUS_FMT_RGB565_2X8_LE:
2946	3143	VOP_CTRL_SET(vop, dither_down_en, 1);
2947	3144	VOP_CTRL_SET(vop, dither_down_mode, RGB888_TO_RGB565);
2948	3145	break;
2949	3146	case MEDIA_BUS_FMT_RGB666_1X18:
2950	3147	case MEDIA_BUS_FMT_RGB666_1X24_CPADHI:
2951	3148	case MEDIA_BUS_FMT_RGB666_1X7X3_SPWG:
2952		- case MEDIA_BUS_FMT_RGB666_1X7X3_JEIDA:
	3149	+ case MEDIA_BUS_FMT_RGB666_3X6:
2953	3150	VOP_CTRL_SET(vop, dither_down_en, 1);
2954	3151	VOP_CTRL_SET(vop, dither_down_mode, RGB888_TO_RGB666);
2955	3152	break;
..	..	@@ -2963,8 +3160,8 @@
2963	3160	VOP_CTRL_SET(vop, dither_down_en, 0);
2964	3161	VOP_CTRL_SET(vop, pre_dither_down_en, 0);
2965	3162	break;
2966		- case MEDIA_BUS_FMT_SRGB888_3X8:
2967		- case MEDIA_BUS_FMT_SRGB888_DUMMY_4X8:
	3163	+ case MEDIA_BUS_FMT_RGB888_3X8:
	3164	+ case MEDIA_BUS_FMT_RGB888_DUMMY_4X8:
2968	3165	case MEDIA_BUS_FMT_RGB888_1X24:
2969	3166	case MEDIA_BUS_FMT_RGB888_1X7X4_SPWG:
2970	3167	case MEDIA_BUS_FMT_RGB888_1X7X4_JEIDA:
..	..	@@ -2986,12 +3183,15 @@
2986	3183	struct vop *vop = to_vop(crtc);
2987	3184	u32 val;
2988	3185
2989		- if (s->output_mode == ROCKCHIP_OUT_MODE_AAAA &&
2990		- !(vop->data->feature & VOP_FEATURE_OUTPUT_10BIT))
	3186	+ if ((s->output_mode == ROCKCHIP_OUT_MODE_AAAA &&
	3187	+ !(vop->data->feature & VOP_FEATURE_OUTPUT_10BIT)) \|\|
	3188	+ (VOP_MAJOR(vop->version) == 2 && VOP_MINOR(vop->version) >= 12 &&
	3189	+ s->output_if & VOP_OUTPUT_IF_BT656))
2991	3190	s->output_mode = ROCKCHIP_OUT_MODE_P888;
2992	3191
2993		- if (is_uv_swap(s->bus_format, s->output_mode))
2994		- VOP_CTRL_SET(vop, dsp_data_swap, DSP_RB_SWAP);
	3192	+ if (is_uv_swap(s->bus_format, s->output_mode) \|\|
	3193	+ is_rb_swap(s->bus_format, s->output_mode))
	3194	+ VOP_CTRL_SET(vop, dsp_rb_swap, 1);
2995	3195	else
2996	3196	VOP_CTRL_SET(vop, dsp_data_swap, 0);
2997	3197
..	..	@@ -3062,6 +3262,12 @@
3062	3262	{
3063	3263	struct vop *vop = to_vop(crtc);
3064	3264
	3265	+ /*
	3266	+ * If mcu_hold_mode is 1, set 1 to mcu_frame_st will
	3267	+ * refresh one frame from ddr. So mcu_frame_st is needed
	3268	+ * to be initialized as 0.
	3269	+ */
	3270	+ VOP_CTRL_SET(vop, mcu_frame_st, 0);
3065	3271	VOP_CTRL_SET(vop, mcu_clk_sel, 1);
3066	3272	VOP_CTRL_SET(vop, mcu_type, 1);
3067	3273
..	..	@@ -3097,11 +3303,20 @@
3097	3303	int for_ddr_freq = 0;
3098	3304	bool dclk_inv, yc_swap = false;
3099	3305
	3306	+ if (old_state && old_state->self_refresh_active) {
	3307	+ drm_crtc_vblank_on(crtc);
	3308	+ if (vop->aclk_rate_reset)
	3309	+ clk_set_rate(vop->aclk, vop->aclk_rate);
	3310	+ vop->aclk_rate_reset = false;
	3311	+
	3312	+ return;
	3313	+ }
	3314	+
3100	3315	rockchip_set_system_status(sys_status);
3101	3316	vop_lock(vop);
3102	3317	DRM_DEV_INFO(vop->dev, "Update mode to %dx%d%s%d, type: %d\n",
3103	3318	hdisplay, vdisplay, interlaced ? "i" : "p",
3104		- adjusted_mode->vrefresh, s->output_type);
	3319	+ drm_mode_vrefresh(adjusted_mode), s->output_type);
3105	3320	vop_initial(crtc);
3106	3321	vop_disable_allwin(vop);
3107	3322	VOP_CTRL_SET(vop, standby, 0);
..	..	@@ -3118,6 +3333,9 @@
3118	3333	vop_mcu_mode(crtc);
3119	3334
3120	3335	dclk_inv = (s->bus_flags & DRM_BUS_FLAG_PIXDATA_DRIVE_NEGEDGE) ? 1 : 0;
	3336	+ /* For improving signal quality, dclk need to be inverted by default on rv1106. */
	3337	+ if ((VOP_MAJOR(vop->version) == 2 && VOP_MINOR(vop->version) == 12))
	3338	+ dclk_inv = !dclk_inv;
3121	3339
3122	3340	VOP_CTRL_SET(vop, dclk_pol, dclk_inv);
3123	3341	val = (adjusted_mode->flags & DRM_MODE_FLAG_NHSYNC) ?
..	..	@@ -3147,6 +3365,10 @@
3147	3365	yc_swap = is_yc_swap(s->bus_format);
3148	3366	VOP_CTRL_SET(vop, bt1120_yc_swap, yc_swap);
3149	3367	VOP_CTRL_SET(vop, yuv_clip, 1);
	3368	+ } else if (s->output_if & VOP_OUTPUT_IF_BT656) {
	3369	+ VOP_CTRL_SET(vop, bt656_en, 1);
	3370	+ yc_swap = is_yc_swap(s->bus_format);
	3371	+ VOP_CTRL_SET(vop, bt1120_yc_swap, yc_swap);
3150	3372	}
3151	3373	break;
3152	3374	case DRM_MODE_CONNECTOR_eDP:
..	..	@@ -3233,7 +3455,8 @@
3233	3455	VOP_CTRL_SET(vop, vtotal_pw, vtotal << 16 \| vsync_len);
3234	3456
3235	3457	VOP_CTRL_SET(vop, core_dclk_div,
3236		- !!(adjusted_mode->flags & DRM_MODE_FLAG_DBLCLK));
	3458	+ !!(adjusted_mode->flags & DRM_MODE_FLAG_DBLCLK) \|\|
	3459	+ s->output_if & VOP_OUTPUT_IF_BT656);
3237	3460
3238	3461	VOP_CTRL_SET(vop, win_csc_mode_sel, 1);
3239	3462
..	..	@@ -3258,7 +3481,6 @@
3258	3481	struct drm_crtc_state *crtc_state)
3259	3482	{
3260	3483	struct vop *vop = to_vop(crtc);
3261		- const struct vop_data *vop_data = vop->data;
3262	3484	struct rockchip_crtc_state *s = to_rockchip_crtc_state(crtc_state);
3263	3485	struct drm_atomic_state *state = crtc_state->state;
3264	3486	struct drm_plane *plane;
..	..	@@ -3288,8 +3510,8 @@
3288	3510	DRM_FORMAT_MOD_ARM_AFBC(AFBC_FORMAT_MOD_BLOCK_SIZE_16x16))
3289	3511	continue;
3290	3512
3291		- if (!(vop_data->feature & VOP_FEATURE_AFBDC)) {
3292		- DRM_ERROR("not support afbdc\n");
	3513	+ if (!VOP_CTRL_SUPPORT(vop, afbdc_en)) {
	3514	+ DRM_INFO("not support afbdc\n");
3293	3515	return -EINVAL;
3294	3516	}
3295	3517
..	..	@@ -3329,10 +3551,17 @@
3329	3551
3330	3552	if (VOP_CTRL_SUPPORT(vop, afbdc_pic_vir_width)) {
3331	3553	u32 align_x1, align_x2, align_y1, align_y2, align_val;
	3554	+ struct drm_gem_object *obj;
	3555	+ struct rockchip_gem_object *rk_obj;
	3556	+ dma_addr_t fb_addr;
	3557	+
	3558	+ obj = fb->obj[0];
	3559	+ rk_obj = to_rockchip_obj(obj);
	3560	+ fb_addr = rk_obj->dma_addr + fb->offsets[0];
3332	3561
3333	3562	s->afbdc_win_format = afbdc_format;
3334	3563	s->afbdc_win_id = win->win_id;
3335		- s->afbdc_win_ptr = rockchip_fb_get_dma_addr(fb, 0);
	3564	+ s->afbdc_win_ptr = fb_addr;
3336	3565	s->afbdc_win_vir_width = fb->width;
3337	3566	s->afbdc_win_xoffset = (src->x1 >> 16);
3338	3567	s->afbdc_win_yoffset = (src->y1 >> 16);
..	..	@@ -3716,6 +3945,7 @@
3716	3945	struct rockchip_crtc_state *s =
3717	3946	to_rockchip_crtc_state(crtc->state);
3718	3947	struct vop *vop = to_vop(crtc);
	3948	+ const struct vop_data *vop_data = vop->data;
3719	3949
3720	3950	spin_lock(&vop->reg_lock);
3721	3951
..	..	@@ -3743,7 +3973,8 @@
3743	3973	VOP_CTRL_SET(vop, afbdc_en, s->afbdc_en);
3744	3974
3745	3975	VOP_CTRL_SET(vop, dsp_layer_sel, s->dsp_layer_sel);
3746		- vop_post_config(crtc);
	3976	+ if (vop_data->feature & VOP_FEATURE_OVERSCAN)
	3977	+ vop_post_config(crtc);
3747	3978
3748	3979	spin_unlock(&vop->reg_lock);
3749	3980	}
..	..	@@ -3821,6 +4052,7 @@
3821	4052	spin_lock_irqsave(&vop->irq_lock, flags);
3822	4053	vop->pre_overlay = s->hdr.pre_overlay;
3823	4054	vop_cfg_done(vop);
	4055	+ rockchip_drm_dbg(vop->dev, VOP_DEBUG_CFG_DONE, "cfg_done\n\n");
3824	4056	/*
3825	4057	* rk322x and rk332x odd-even field will mistake when in interlace mode.
3826	4058	* we must switch to frame effect before switch screen and switch to
..	..	@@ -3854,21 +4086,6 @@
3854	4086	crtc->state->event = NULL;
3855	4087	}
3856	4088	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	4089	for_each_old_plane_in_state(old_state, plane, old_plane_state, i) {
3873	4090	if (!old_plane_state->fb)
3874	4091	continue;
..	..	@@ -3881,11 +4098,11 @@
3881	4098	drm_flip_work_queue(&vop->fb_unref_work, old_plane_state->fb);
3882	4099	set_bit(VOP_PENDING_FB_UNREF, &vop->pending);
3883	4100	}
3884		-#endif
3885	4101	}
3886	4102
3887	4103	static const struct drm_crtc_helper_funcs vop_crtc_helper_funcs = {
3888	4104	.mode_fixup = vop_crtc_mode_fixup,
	4105	+ .mode_valid = vop_crtc_mode_valid,
3889	4106	.atomic_check = vop_crtc_atomic_check,
3890	4107	.atomic_flush = vop_crtc_atomic_flush,
3891	4108	.atomic_enable = vop_crtc_atomic_enable,
..	..	@@ -3921,6 +4138,9 @@
3921	4138	static struct drm_crtc_state vop_crtc_duplicate_state(struct drm_crtc crtc)
3922	4139	{
3923	4140	struct rockchip_crtc_state rockchip_state, old_state;
	4141	+
	4142	+ if (WARN_ON(!crtc->state))
	4143	+ return NULL;
3924	4144
3925	4145	old_state = to_rockchip_crtc_state(crtc->state);
3926	4146	rockchip_state = kmemdup(old_state, sizeof(*old_state), GFP_KERNEL);
..	..	@@ -4036,8 +4256,19 @@
4036	4256	return 0;
4037	4257	}
4038	4258
4039		- if (property == private->alpha_scale_prop) {
4040		- *val = (vop->data->feature & VOP_FEATURE_ALPHA_SCALE) ? 1 : 0;
	4259	+ if (property == private->aclk_prop) {
	4260	+ /* KHZ, keep align with mode->clock */
	4261	+ *val = clk_get_rate(vop->aclk) / 1000;
	4262	+ return 0;
	4263	+ }
	4264	+
	4265	+ if (property == private->bg_prop) {
	4266	+ *val = vop->background;
	4267	+ return 0;
	4268	+ }
	4269	+
	4270	+ if (property == private->line_flag_prop) {
	4271	+ *val = vop->line_flag;
4041	4272	return 0;
4042	4273	}
4043	4274
..	..	@@ -4051,9 +4282,10 @@
4051	4282	uint64_t val)
4052	4283	{
4053	4284	struct drm_device *drm_dev = crtc->dev;
	4285	+ struct rockchip_drm_private *private = drm_dev->dev_private;
4054	4286	struct drm_mode_config *mode_config = &drm_dev->mode_config;
4055	4287	struct rockchip_crtc_state *s = to_rockchip_crtc_state(state);
4056		- //struct vop *vop = to_vop(crtc);
	4288	+ struct vop *vop = to_vop(crtc);
4057	4289
4058	4290	if (property == mode_config->tv_left_margin_property) {
4059	4291	s->left_margin = val;
..	..	@@ -4072,6 +4304,16 @@
4072	4304
4073	4305	if (property == mode_config->tv_bottom_margin_property) {
4074	4306	s->bottom_margin = val;
	4307	+ return 0;
	4308	+ }
	4309	+
	4310	+ if (property == private->bg_prop) {
	4311	+ vop->background = val;
	4312	+ return 0;
	4313	+ }
	4314	+
	4315	+ if (property == private->line_flag_prop) {
	4316	+ vop->line_flag = val;
4075	4317	return 0;
4076	4318	}
4077	4319
..	..	@@ -4100,14 +4342,14 @@
4100	4342	struct vop *vop = container_of(work, struct vop, fb_unref_work);
4101	4343	struct drm_framebuffer *fb = val;
4102	4344
4103		- drm_crtc_vblank_put(&vop->crtc);
	4345	+ drm_crtc_vblank_put(&vop->rockchip_crtc.crtc);
4104	4346	drm_framebuffer_put(fb);
4105	4347	}
4106	4348
4107	4349	static void vop_handle_vblank(struct vop *vop)
4108	4350	{
4109	4351	struct drm_device *drm = vop->drm_dev;
4110		- struct drm_crtc *crtc = &vop->crtc;
	4352	+ struct drm_crtc *crtc = &vop->rockchip_crtc.crtc;
4111	4353	unsigned long flags;
4112	4354
4113	4355	spin_lock_irqsave(&drm->event_lock, flags);
..	..	@@ -4125,7 +4367,7 @@
4125	4367	static irqreturn_t vop_isr(int irq, void *data)
4126	4368	{
4127	4369	struct vop *vop = data;
4128		- struct drm_crtc *crtc = &vop->crtc;
	4370	+ struct drm_crtc *crtc = &vop->rockchip_crtc.crtc;
4129	4371	uint32_t active_irqs;
4130	4372	unsigned long flags;
4131	4373	int ret = IRQ_NONE;
..	..	@@ -4176,6 +4418,7 @@
4176	4418	* frame effective, but actually it's effective immediately, so
4177	4419	* we config this register at frame start.
4178	4420	*/
	4421	+ rockchip_drm_dbg(vop->dev, VOP_DEBUG_VSYNC, "vsync\n");
4179	4422	spin_lock_irqsave(&vop->irq_lock, flags);
4180	4423	VOP_CTRL_SET(vop, level2_overlay_en, vop->pre_overlay);
4181	4424	VOP_CTRL_SET(vop, alpha_hard_calc, vop->pre_overlay);
..	..	@@ -4222,27 +4465,49 @@
4222	4465
4223	4466	flags \|= (VOP_WIN_SUPPORT(vop, win, xmirror)) ? DRM_MODE_REFLECT_X : 0;
4224	4467	flags \|= (VOP_WIN_SUPPORT(vop, win, ymirror)) ? DRM_MODE_REFLECT_Y : 0;
	4468	+
4225	4469	if (flags)
4226	4470	drm_plane_create_rotation_property(plane, DRM_MODE_ROTATE_0,
4227	4471	DRM_MODE_ROTATE_0 \| flags);
	4472	+}
	4473	+
	4474	+static int vop_plane_create_name_property(struct vop vop, struct vop_win win)
	4475	+{
	4476	+ struct drm_prop_enum_list *props = vop->plane_name_list;
	4477	+ struct drm_property *prop;
	4478	+ uint64_t bits = BIT_ULL(win->plane_id);
	4479	+
	4480	+ prop = drm_property_create_bitmask(vop->drm_dev,
	4481	+ DRM_MODE_PROP_IMMUTABLE, "NAME",
	4482	+ props, vop->num_wins, bits);
	4483	+ if (!prop) {
	4484	+ DRM_DEV_ERROR(vop->dev, "create Name prop for %s failed\n", win->name);
	4485	+ return -ENOMEM;
	4486	+ }
	4487	+ win->name_prop = prop;
	4488	+ drm_object_attach_property(&win->base.base, win->name_prop, bits);
	4489	+
	4490	+ return 0;
4228	4491	}
4229	4492
4230	4493	static int vop_plane_init(struct vop vop, struct vop_win win,
4231	4494	unsigned long possible_crtcs)
4232	4495	{
4233	4496	struct rockchip_drm_private *private = vop->drm_dev->dev_private;
	4497	+ unsigned int blend_caps = BIT(DRM_MODE_BLEND_PIXEL_NONE) \| BIT(DRM_MODE_BLEND_PREMULTI) \|
	4498	+ BIT(DRM_MODE_BLEND_COVERAGE);
	4499	+ const struct vop_data *vop_data = vop->data;
4234	4500	uint64_t feature = 0;
4235	4501	int ret;
4236	4502
4237	4503	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);
	4504	+ win->data_formats, win->nformats, win->format_modifiers,
	4505	+ win->type, win->name);
4239	4506	if (ret) {
4240	4507	DRM_ERROR("failed to initialize plane %d\n", ret);
4241	4508	return ret;
4242	4509	}
4243	4510	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	4511
4247	4512	if (win->phy->scl)
4248	4513	feature \|= BIT(ROCKCHIP_DRM_PLANE_FEATURE_SCALE);
..	..	@@ -4262,15 +4527,9 @@
4262	4527	drm_object_attach_property(&win->base.base,
4263	4528	private->color_space_prop, 0);
4264	4529	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);
	4530	+ drm_plane_create_alpha_property(&win->base);
4269	4531	drm_object_attach_property(&win->base.base,
4270	4532	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	4533
4275	4534	if (win->parent)
4276	4535	drm_object_attach_property(&win->base.base, private->share_id_prop,
..	..	@@ -4278,6 +4537,45 @@
4278	4537	else
4279	4538	drm_object_attach_property(&win->base.base, private->share_id_prop,
4280	4539	win->base.base.id);
	4540	+
	4541	+ drm_plane_create_blend_mode_property(&win->base, blend_caps);
	4542	+ drm_plane_create_zpos_property(&win->base, win->win_id, 0, vop->num_wins - 1);
	4543	+ vop_plane_create_name_property(vop, win);
	4544	+
	4545	+
	4546	+ win->input_width_prop = drm_property_create_range(vop->drm_dev, DRM_MODE_PROP_IMMUTABLE,
	4547	+ "INPUT_WIDTH", 0, vop_data->max_input.width);
	4548	+ win->input_height_prop = drm_property_create_range(vop->drm_dev, DRM_MODE_PROP_IMMUTABLE,
	4549	+ "INPUT_HEIGHT", 0, vop_data->max_input.height);
	4550	+
	4551	+ win->output_width_prop = drm_property_create_range(vop->drm_dev, DRM_MODE_PROP_IMMUTABLE,
	4552	+ "OUTPUT_WIDTH", 0, vop_data->max_input.width);
	4553	+ win->output_height_prop = drm_property_create_range(vop->drm_dev, DRM_MODE_PROP_IMMUTABLE,
	4554	+ "OUTPUT_HEIGHT", 0, vop_data->max_input.height);
	4555	+
	4556	+ win->scale_prop = drm_property_create_range(vop->drm_dev, DRM_MODE_PROP_IMMUTABLE,
	4557	+ "SCALE_RATE", 8, 8);
	4558	+ /*
	4559	+ * Support 24 bit(RGB888) or 16 bit(rgb565) color key.
	4560	+ * Bit 31 is used as a flag to disable (0) or enable
	4561	+ * color keying (1).
	4562	+ */
	4563	+ if (VOP_WIN_SUPPORT(vop, win, color_key))
	4564	+ win->color_key_prop = drm_property_create_range(vop->drm_dev, 0,
	4565	+ "colorkey", 0, 0x80ffffff);
	4566	+ if (!win->input_width_prop \|\| !win->input_height_prop \|\|
	4567	+ !win->scale_prop) {
	4568	+ DRM_ERROR("failed to create property\n");
	4569	+ return -ENOMEM;
	4570	+ }
	4571	+
	4572	+ drm_object_attach_property(&win->base.base, win->input_width_prop, 0);
	4573	+ drm_object_attach_property(&win->base.base, win->input_height_prop, 0);
	4574	+ drm_object_attach_property(&win->base.base, win->output_width_prop, 0);
	4575	+ drm_object_attach_property(&win->base.base, win->output_height_prop, 0);
	4576	+ drm_object_attach_property(&win->base.base, win->scale_prop, 0);
	4577	+ if (VOP_WIN_SUPPORT(vop, win, color_key))
	4578	+ drm_object_attach_property(&win->base.base, win->color_key_prop, 0);
4281	4579
4282	4580	return 0;
4283	4581	}
..	..	@@ -4339,16 +4637,49 @@
4339	4637	return 0;
4340	4638	}
4341	4639
	4640	+static int vop_crtc_create_feature_property(struct vop vop, struct drm_crtc crtc)
	4641	+{
	4642	+ const struct vop_data *vop_data = vop->data;
	4643	+
	4644	+ struct drm_property *prop;
	4645	+ u64 feature = 0;
	4646	+
	4647	+ static const struct drm_prop_enum_list props[] = {
	4648	+ { ROCKCHIP_DRM_CRTC_FEATURE_ALPHA_SCALE, "ALPHA_SCALE" },
	4649	+ { ROCKCHIP_DRM_CRTC_FEATURE_HDR10, "HDR10" },
	4650	+ { ROCKCHIP_DRM_CRTC_FEATURE_NEXT_HDR, "NEXT_HDR" },
	4651	+ };
	4652	+
	4653	+ if (vop_data->feature & VOP_FEATURE_ALPHA_SCALE)
	4654	+ feature \|= BIT(ROCKCHIP_DRM_CRTC_FEATURE_ALPHA_SCALE);
	4655	+ if (vop_data->feature & VOP_FEATURE_HDR10)
	4656	+ feature \|= BIT(ROCKCHIP_DRM_CRTC_FEATURE_HDR10);
	4657	+ if (vop_data->feature & VOP_FEATURE_NEXT_HDR)
	4658	+ feature \|= BIT(ROCKCHIP_DRM_CRTC_FEATURE_NEXT_HDR);
	4659	+
	4660	+ prop = drm_property_create_bitmask(vop->drm_dev,
	4661	+ DRM_MODE_PROP_IMMUTABLE, "FEATURE",
	4662	+ props, ARRAY_SIZE(props),
	4663	+ 0xffffffff);
	4664	+ if (!prop) {
	4665	+ DRM_DEV_ERROR(vop->dev, "create FEATURE prop for vop%d failed\n", vop->id);
	4666	+ return -ENOMEM;
	4667	+ }
	4668	+
	4669	+ vop->feature_prop = prop;
	4670	+ drm_object_attach_property(&crtc->base, vop->feature_prop, feature);
	4671	+
	4672	+ return 0;
	4673	+}
	4674	+
4342	4675	static int vop_create_crtc(struct vop *vop)
4343	4676	{
4344	4677	struct device *dev = vop->dev;
4345		- const struct vop_data *vop_data = vop->data;
4346	4678	struct drm_device *drm_dev = vop->drm_dev;
4347	4679	struct rockchip_drm_private *private = drm_dev->dev_private;
4348	4680	struct drm_plane primary = NULL, cursor = NULL, plane, tmp;
4349		- struct drm_crtc *crtc = &vop->crtc;
	4681	+ struct drm_crtc *crtc = &vop->rockchip_crtc.crtc;
4350	4682	struct device_node *port;
4351		- uint64_t feature = 0;
4352	4683	int ret = 0;
4353	4684	int i;
4354	4685
..	..	@@ -4364,7 +4695,8 @@
4364	4695	win->type != DRM_PLANE_TYPE_CURSOR)
4365	4696	continue;
4366	4697
4367		- if (vop_plane_init(vop, win, 0)) {
	4698	+ ret = vop_plane_init(vop, win, 0);
	4699	+ if (ret) {
4368	4700	DRM_DEV_ERROR(vop->dev, "failed to init plane\n");
4369	4701	goto err_cleanup_planes;
4370	4702	}
..	..	@@ -4394,7 +4726,8 @@
4394	4726	if (win->type != DRM_PLANE_TYPE_OVERLAY)
4395	4727	continue;
4396	4728
4397		- if (vop_plane_init(vop, win, possible_crtcs)) {
	4729	+ ret = vop_plane_init(vop, win, possible_crtcs);
	4730	+ if (ret) {
4398	4731	DRM_DEV_ERROR(vop->dev, "failed to init overlay\n");
4399	4732	goto err_cleanup_crtc;
4400	4733	}
..	..	@@ -4417,6 +4750,12 @@
4417	4750	crtc->port = port;
4418	4751	rockchip_register_crtc_funcs(crtc, &private_crtc_funcs);
4419	4752
	4753	+ drm_object_attach_property(&crtc->base, private->soc_id_prop, vop->soc_id);
	4754	+ drm_object_attach_property(&crtc->base, private->port_id_prop, vop->id);
	4755	+ drm_object_attach_property(&crtc->base, private->aclk_prop, 0);
	4756	+ drm_object_attach_property(&crtc->base, private->bg_prop, 0);
	4757	+ drm_object_attach_property(&crtc->base, private->line_flag_prop, 0);
	4758	+
4420	4759	#define VOP_ATTACH_MODE_CONFIG_PROP(prop, v) \
4421	4760	drm_object_attach_property(&crtc->base, drm_dev->mode_config.prop, v)
4422	4761
..	..	@@ -4424,13 +4763,14 @@
4424	4763	VOP_ATTACH_MODE_CONFIG_PROP(tv_right_margin_property, 100);
4425	4764	VOP_ATTACH_MODE_CONFIG_PROP(tv_top_margin_property, 100);
4426	4765	VOP_ATTACH_MODE_CONFIG_PROP(tv_bottom_margin_property, 100);
4427		-
4428	4766	#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);
	4767	+ vop_crtc_create_feature_property(vop, crtc);
	4768	+ ret = drm_self_refresh_helper_init(crtc);
	4769	+ if (ret)
	4770	+ DRM_DEV_DEBUG_KMS(vop->dev,
	4771	+ "Failed to init %s with SR helpers %d, ignoring\n",
	4772	+ crtc->name, ret);
	4773	+
4434	4774	if (vop->lut_regs) {
4435	4775	u16 r_base, g_base, *b_base;
4436	4776	u32 lut_len = vop->lut_len;
..	..	@@ -4477,9 +4817,11 @@
4477	4817
4478	4818	static void vop_destroy_crtc(struct vop *vop)
4479	4819	{
4480		- struct drm_crtc *crtc = &vop->crtc;
	4820	+ struct drm_crtc *crtc = &vop->rockchip_crtc.crtc;
4481	4821	struct drm_device *drm_dev = vop->drm_dev;
4482	4822	struct drm_plane plane, tmp;
	4823	+
	4824	+ drm_self_refresh_helper_cleanup(crtc);
4483	4825
4484	4826	of_node_put(crtc->port);
4485	4827
..	..	@@ -4531,16 +4873,15 @@
4531	4873	const struct vop_data *vop_data = vop->data;
4532	4874	unsigned int i, j;
4533	4875	unsigned int num_wins = 0;
4534		- struct drm_property *prop;
	4876	+ char name[DRM_PROP_NAME_LEN];
	4877	+ uint8_t plane_id = 0;
	4878	+ struct drm_prop_enum_list *plane_name_list;
4535	4879	static const struct drm_prop_enum_list props[] = {
4536	4880	{ ROCKCHIP_DRM_PLANE_FEATURE_SCALE, "scale" },
4537	4881	{ ROCKCHIP_DRM_PLANE_FEATURE_ALPHA, "alpha" },
4538	4882	{ ROCKCHIP_DRM_PLANE_FEATURE_HDR2SDR, "hdr2sdr" },
4539	4883	{ ROCKCHIP_DRM_PLANE_FEATURE_SDR2HDR, "sdr2hdr" },
4540	4884	{ 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	4885	};
4545	4886
4546	4887	for (i = 0; i < vop_data->win_size; i++) {
..	..	@@ -4556,16 +4897,16 @@
4556	4897	vop_win->type = win_data->type;
4557	4898	vop_win->data_formats = win_data->phy->data_formats;
4558	4899	vop_win->nformats = win_data->phy->nformats;
	4900	+ vop_win->format_modifiers = win_data->format_modifiers;
4559	4901	vop_win->feature = win_data->feature;
4560	4902	vop_win->vop = vop;
4561	4903	vop_win->win_id = i;
4562	4904	vop_win->area_id = 0;
	4905	+ vop_win->plane_id = plane_id++;
	4906	+ snprintf(name, sizeof(name), "VOP%d-win%d-%d", vop->id, vop_win->win_id, vop_win->area_id);
	4907	+ vop_win->name = devm_kstrdup(vop->dev, name, GFP_KERNEL);
4563	4908	vop_win->zpos = vop_plane_get_zpos(win_data->type,
4564	4909	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	4910
4570	4911	num_wins++;
4571	4912
..	..	@@ -4582,22 +4923,18 @@
4582	4923	vop_area->type = DRM_PLANE_TYPE_OVERLAY;
4583	4924	vop_area->data_formats = vop_win->data_formats;
4584	4925	vop_area->nformats = vop_win->nformats;
	4926	+ vop_area->format_modifiers = win_data->format_modifiers;
4585	4927	vop_area->vop = vop;
4586	4928	vop_area->win_id = i;
4587	4929	vop_area->area_id = j + 1;
	4930	+ vop_area->plane_id = plane_id++;
	4931	+ snprintf(name, sizeof(name), "VOP%d-win%d-%d", vop->id, vop_area->win_id, vop_area->area_id);
	4932	+ vop_area->name = devm_kstrdup(vop->dev, name, GFP_KERNEL);
4588	4933	num_wins++;
4589	4934	}
4590	4935	}
4591	4936
4592	4937	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	4938
4602	4939	vop->plane_feature_prop = drm_property_create_bitmask(vop->drm_dev,
4603	4940	DRM_MODE_PROP_IMMUTABLE, "FEATURE",
..	..	@@ -4612,66 +4949,25 @@
4612	4949	return -EINVAL;
4613	4950	}
4614	4951
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;
	4952	+ plane_name_list = devm_kzalloc(vop->dev,
	4953	+ vop->num_wins * sizeof(*plane_name_list),
	4954	+ GFP_KERNEL);
	4955	+ if (!plane_name_list) {
	4956	+ DRM_DEV_ERROR(vop->dev, "failed to alloc memory for plane_name_list\n");
	4957	+ return -ENOMEM;
4622	4958	}
	4959	+
	4960	+ for (i = 0; i < vop->num_wins; i++) {
	4961	+ struct vop_win *vop_win = &vop->win[i];
	4962	+
	4963	+ plane_name_list[i].type = vop_win->plane_id;
	4964	+ plane_name_list[i].name = vop_win->name;
	4965	+ }
	4966	+
	4967	+ vop->plane_name_list = plane_name_list;
4623	4968
4624	4969	return 0;
4625	4970	}
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	4971
4676	4972	static int vop_bind(struct device dev, struct device master, void *data)
4677	4973	{
..	..	@@ -4707,6 +5003,8 @@
4707	5003	vop->drm_dev = drm_dev;
4708	5004	vop->num_wins = num_wins;
4709	5005	vop->version = vop_data->version;
	5006	+ vop->soc_id = vop_data->soc_id;
	5007	+ vop->id = vop_data->vop_id;
4710	5008	dev_set_drvdata(dev, vop);
4711	5009	vop->support_multi_area = of_property_read_bool(dev->of_node, "support-multi-area");
4712	5010