xref: /OK3568_Linux_fs/kernel/drivers/gpu/drm/meson/meson_viu.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Copyright (C) 2016 BayLibre, SAS
4*4882a593Smuzhiyun  * Author: Neil Armstrong <narmstrong@baylibre.com>
5*4882a593Smuzhiyun  * Copyright (C) 2015 Amlogic, Inc. All rights reserved.
6*4882a593Smuzhiyun  * Copyright (C) 2014 Endless Mobile
7*4882a593Smuzhiyun  */
8*4882a593Smuzhiyun 
9*4882a593Smuzhiyun #include <linux/export.h>
10*4882a593Smuzhiyun #include <linux/bitfield.h>
11*4882a593Smuzhiyun 
12*4882a593Smuzhiyun #include <drm/drm_fourcc.h>
13*4882a593Smuzhiyun 
14*4882a593Smuzhiyun #include "meson_drv.h"
15*4882a593Smuzhiyun #include "meson_viu.h"
16*4882a593Smuzhiyun #include "meson_registers.h"
17*4882a593Smuzhiyun 
18*4882a593Smuzhiyun /**
19*4882a593Smuzhiyun  * DOC: Video Input Unit
20*4882a593Smuzhiyun  *
21*4882a593Smuzhiyun  * VIU Handles the Pixel scanout and the basic Colorspace conversions
22*4882a593Smuzhiyun  * We handle the following features :
23*4882a593Smuzhiyun  *
24*4882a593Smuzhiyun  * - OSD1 RGB565/RGB888/xRGB8888 scanout
25*4882a593Smuzhiyun  * - RGB conversion to x/cb/cr
26*4882a593Smuzhiyun  * - Progressive or Interlace buffer scanout
27*4882a593Smuzhiyun  * - OSD1 Commit on Vsync
28*4882a593Smuzhiyun  * - HDR OSD matrix for GXL/GXM
29*4882a593Smuzhiyun  *
30*4882a593Smuzhiyun  * What is missing :
31*4882a593Smuzhiyun  *
32*4882a593Smuzhiyun  * - BGR888/xBGR8888/BGRx8888/BGRx8888 modes
33*4882a593Smuzhiyun  * - YUV4:2:2 Y0CbY1Cr scanout
34*4882a593Smuzhiyun  * - Conversion to YUV 4:4:4 from 4:2:2 input
35*4882a593Smuzhiyun  * - Colorkey Alpha matching
36*4882a593Smuzhiyun  * - Big endian scanout
37*4882a593Smuzhiyun  * - X/Y reverse scanout
38*4882a593Smuzhiyun  * - Global alpha setup
39*4882a593Smuzhiyun  * - OSD2 support, would need interlace switching on vsync
40*4882a593Smuzhiyun  * - OSD1 full scaling to support TV overscan
41*4882a593Smuzhiyun  */
42*4882a593Smuzhiyun 
43*4882a593Smuzhiyun /* OSD csc defines */
44*4882a593Smuzhiyun 
45*4882a593Smuzhiyun enum viu_matrix_sel_e {
46*4882a593Smuzhiyun 	VIU_MATRIX_OSD_EOTF = 0,
47*4882a593Smuzhiyun 	VIU_MATRIX_OSD,
48*4882a593Smuzhiyun };
49*4882a593Smuzhiyun 
50*4882a593Smuzhiyun enum viu_lut_sel_e {
51*4882a593Smuzhiyun 	VIU_LUT_OSD_EOTF = 0,
52*4882a593Smuzhiyun 	VIU_LUT_OSD_OETF,
53*4882a593Smuzhiyun };
54*4882a593Smuzhiyun 
55*4882a593Smuzhiyun #define COEFF_NORM(a) ((int)((((a) * 2048.0) + 1) / 2))
56*4882a593Smuzhiyun #define MATRIX_5X3_COEF_SIZE 24
57*4882a593Smuzhiyun 
58*4882a593Smuzhiyun #define EOTF_COEFF_NORM(a) ((int)((((a) * 4096.0) + 1) / 2))
59*4882a593Smuzhiyun #define EOTF_COEFF_SIZE 10
60*4882a593Smuzhiyun #define EOTF_COEFF_RIGHTSHIFT 1
61*4882a593Smuzhiyun 
62*4882a593Smuzhiyun static int RGB709_to_YUV709l_coeff[MATRIX_5X3_COEF_SIZE] = {
63*4882a593Smuzhiyun 	0, 0, 0, /* pre offset */
64*4882a593Smuzhiyun 	COEFF_NORM(0.181873),	COEFF_NORM(0.611831),	COEFF_NORM(0.061765),
65*4882a593Smuzhiyun 	COEFF_NORM(-0.100251),	COEFF_NORM(-0.337249),	COEFF_NORM(0.437500),
66*4882a593Smuzhiyun 	COEFF_NORM(0.437500),	COEFF_NORM(-0.397384),	COEFF_NORM(-0.040116),
67*4882a593Smuzhiyun 	0, 0, 0, /* 10'/11'/12' */
68*4882a593Smuzhiyun 	0, 0, 0, /* 20'/21'/22' */
69*4882a593Smuzhiyun 	64, 512, 512, /* offset */
70*4882a593Smuzhiyun 	0, 0, 0 /* mode, right_shift, clip_en */
71*4882a593Smuzhiyun };
72*4882a593Smuzhiyun 
73*4882a593Smuzhiyun /*  eotf matrix: bypass */
74*4882a593Smuzhiyun static int eotf_bypass_coeff[EOTF_COEFF_SIZE] = {
75*4882a593Smuzhiyun 	EOTF_COEFF_NORM(1.0),	EOTF_COEFF_NORM(0.0),	EOTF_COEFF_NORM(0.0),
76*4882a593Smuzhiyun 	EOTF_COEFF_NORM(0.0),	EOTF_COEFF_NORM(1.0),	EOTF_COEFF_NORM(0.0),
77*4882a593Smuzhiyun 	EOTF_COEFF_NORM(0.0),	EOTF_COEFF_NORM(0.0),	EOTF_COEFF_NORM(1.0),
78*4882a593Smuzhiyun 	EOTF_COEFF_RIGHTSHIFT /* right shift */
79*4882a593Smuzhiyun };
80*4882a593Smuzhiyun 
meson_viu_set_g12a_osd1_matrix(struct meson_drm * priv,int * m,bool csc_on)81*4882a593Smuzhiyun static void meson_viu_set_g12a_osd1_matrix(struct meson_drm *priv,
82*4882a593Smuzhiyun 					   int *m, bool csc_on)
83*4882a593Smuzhiyun {
84*4882a593Smuzhiyun 	/* VPP WRAP OSD1 matrix */
85*4882a593Smuzhiyun 	writel(((m[0] & 0xfff) << 16) | (m[1] & 0xfff),
86*4882a593Smuzhiyun 		priv->io_base + _REG(VPP_WRAP_OSD1_MATRIX_PRE_OFFSET0_1));
87*4882a593Smuzhiyun 	writel(m[2] & 0xfff,
88*4882a593Smuzhiyun 		priv->io_base + _REG(VPP_WRAP_OSD1_MATRIX_PRE_OFFSET2));
89*4882a593Smuzhiyun 	writel(((m[3] & 0x1fff) << 16) | (m[4] & 0x1fff),
90*4882a593Smuzhiyun 		priv->io_base + _REG(VPP_WRAP_OSD1_MATRIX_COEF00_01));
91*4882a593Smuzhiyun 	writel(((m[5] & 0x1fff) << 16) | (m[6] & 0x1fff),
92*4882a593Smuzhiyun 		priv->io_base + _REG(VPP_WRAP_OSD1_MATRIX_COEF02_10));
93*4882a593Smuzhiyun 	writel(((m[7] & 0x1fff) << 16) | (m[8] & 0x1fff),
94*4882a593Smuzhiyun 		priv->io_base + _REG(VPP_WRAP_OSD1_MATRIX_COEF11_12));
95*4882a593Smuzhiyun 	writel(((m[9] & 0x1fff) << 16) | (m[10] & 0x1fff),
96*4882a593Smuzhiyun 		priv->io_base + _REG(VPP_WRAP_OSD1_MATRIX_COEF20_21));
97*4882a593Smuzhiyun 	writel((m[11] & 0x1fff),
98*4882a593Smuzhiyun 		priv->io_base +	_REG(VPP_WRAP_OSD1_MATRIX_COEF22));
99*4882a593Smuzhiyun 
100*4882a593Smuzhiyun 	writel(((m[18] & 0xfff) << 16) | (m[19] & 0xfff),
101*4882a593Smuzhiyun 		priv->io_base + _REG(VPP_WRAP_OSD1_MATRIX_OFFSET0_1));
102*4882a593Smuzhiyun 	writel(m[20] & 0xfff,
103*4882a593Smuzhiyun 		priv->io_base + _REG(VPP_WRAP_OSD1_MATRIX_OFFSET2));
104*4882a593Smuzhiyun 
105*4882a593Smuzhiyun 	writel_bits_relaxed(BIT(0), csc_on ? BIT(0) : 0,
106*4882a593Smuzhiyun 		priv->io_base + _REG(VPP_WRAP_OSD1_MATRIX_EN_CTRL));
107*4882a593Smuzhiyun }
108*4882a593Smuzhiyun 
meson_viu_set_osd_matrix(struct meson_drm * priv,enum viu_matrix_sel_e m_select,int * m,bool csc_on)109*4882a593Smuzhiyun static void meson_viu_set_osd_matrix(struct meson_drm *priv,
110*4882a593Smuzhiyun 				     enum viu_matrix_sel_e m_select,
111*4882a593Smuzhiyun 			      int *m, bool csc_on)
112*4882a593Smuzhiyun {
113*4882a593Smuzhiyun 	if (m_select == VIU_MATRIX_OSD) {
114*4882a593Smuzhiyun 		/* osd matrix, VIU_MATRIX_0 */
115*4882a593Smuzhiyun 		writel(((m[0] & 0xfff) << 16) | (m[1] & 0xfff),
116*4882a593Smuzhiyun 			priv->io_base + _REG(VIU_OSD1_MATRIX_PRE_OFFSET0_1));
117*4882a593Smuzhiyun 		writel(m[2] & 0xfff,
118*4882a593Smuzhiyun 			priv->io_base + _REG(VIU_OSD1_MATRIX_PRE_OFFSET2));
119*4882a593Smuzhiyun 		writel(((m[3] & 0x1fff) << 16) | (m[4] & 0x1fff),
120*4882a593Smuzhiyun 			priv->io_base + _REG(VIU_OSD1_MATRIX_COEF00_01));
121*4882a593Smuzhiyun 		writel(((m[5] & 0x1fff) << 16) | (m[6] & 0x1fff),
122*4882a593Smuzhiyun 			priv->io_base + _REG(VIU_OSD1_MATRIX_COEF02_10));
123*4882a593Smuzhiyun 		writel(((m[7] & 0x1fff) << 16) | (m[8] & 0x1fff),
124*4882a593Smuzhiyun 			priv->io_base + _REG(VIU_OSD1_MATRIX_COEF11_12));
125*4882a593Smuzhiyun 		writel(((m[9] & 0x1fff) << 16) | (m[10] & 0x1fff),
126*4882a593Smuzhiyun 			priv->io_base + _REG(VIU_OSD1_MATRIX_COEF20_21));
127*4882a593Smuzhiyun 
128*4882a593Smuzhiyun 		if (m[21]) {
129*4882a593Smuzhiyun 			writel(((m[11] & 0x1fff) << 16) | (m[12] & 0x1fff),
130*4882a593Smuzhiyun 				priv->io_base +
131*4882a593Smuzhiyun 					_REG(VIU_OSD1_MATRIX_COEF22_30));
132*4882a593Smuzhiyun 			writel(((m[13] & 0x1fff) << 16) | (m[14] & 0x1fff),
133*4882a593Smuzhiyun 				priv->io_base +
134*4882a593Smuzhiyun 					_REG(VIU_OSD1_MATRIX_COEF31_32));
135*4882a593Smuzhiyun 			writel(((m[15] & 0x1fff) << 16) | (m[16] & 0x1fff),
136*4882a593Smuzhiyun 				priv->io_base +
137*4882a593Smuzhiyun 					_REG(VIU_OSD1_MATRIX_COEF40_41));
138*4882a593Smuzhiyun 			writel(m[17] & 0x1fff, priv->io_base +
139*4882a593Smuzhiyun 				_REG(VIU_OSD1_MATRIX_COLMOD_COEF42));
140*4882a593Smuzhiyun 		} else
141*4882a593Smuzhiyun 			writel((m[11] & 0x1fff) << 16, priv->io_base +
142*4882a593Smuzhiyun 				_REG(VIU_OSD1_MATRIX_COEF22_30));
143*4882a593Smuzhiyun 
144*4882a593Smuzhiyun 		writel(((m[18] & 0xfff) << 16) | (m[19] & 0xfff),
145*4882a593Smuzhiyun 			priv->io_base + _REG(VIU_OSD1_MATRIX_OFFSET0_1));
146*4882a593Smuzhiyun 		writel(m[20] & 0xfff,
147*4882a593Smuzhiyun 			priv->io_base + _REG(VIU_OSD1_MATRIX_OFFSET2));
148*4882a593Smuzhiyun 
149*4882a593Smuzhiyun 		writel_bits_relaxed(3 << 30, m[21] << 30,
150*4882a593Smuzhiyun 			priv->io_base + _REG(VIU_OSD1_MATRIX_COLMOD_COEF42));
151*4882a593Smuzhiyun 		writel_bits_relaxed(7 << 16, m[22] << 16,
152*4882a593Smuzhiyun 			priv->io_base + _REG(VIU_OSD1_MATRIX_COLMOD_COEF42));
153*4882a593Smuzhiyun 
154*4882a593Smuzhiyun 		/* 23 reserved for clipping control */
155*4882a593Smuzhiyun 		writel_bits_relaxed(BIT(0), csc_on ? BIT(0) : 0,
156*4882a593Smuzhiyun 			priv->io_base + _REG(VIU_OSD1_MATRIX_CTRL));
157*4882a593Smuzhiyun 		writel_bits_relaxed(BIT(1), 0,
158*4882a593Smuzhiyun 			priv->io_base + _REG(VIU_OSD1_MATRIX_CTRL));
159*4882a593Smuzhiyun 	} else if (m_select == VIU_MATRIX_OSD_EOTF) {
160*4882a593Smuzhiyun 		int i;
161*4882a593Smuzhiyun 
162*4882a593Smuzhiyun 		/* osd eotf matrix, VIU_MATRIX_OSD_EOTF */
163*4882a593Smuzhiyun 		for (i = 0; i < 5; i++)
164*4882a593Smuzhiyun 			writel(((m[i * 2] & 0x1fff) << 16) |
165*4882a593Smuzhiyun 				(m[i * 2 + 1] & 0x1fff), priv->io_base +
166*4882a593Smuzhiyun 				_REG(VIU_OSD1_EOTF_CTL + i + 1));
167*4882a593Smuzhiyun 
168*4882a593Smuzhiyun 		writel_bits_relaxed(BIT(30), csc_on ? BIT(30) : 0,
169*4882a593Smuzhiyun 			priv->io_base + _REG(VIU_OSD1_EOTF_CTL));
170*4882a593Smuzhiyun 		writel_bits_relaxed(BIT(31), csc_on ? BIT(31) : 0,
171*4882a593Smuzhiyun 			priv->io_base + _REG(VIU_OSD1_EOTF_CTL));
172*4882a593Smuzhiyun 	}
173*4882a593Smuzhiyun }
174*4882a593Smuzhiyun 
175*4882a593Smuzhiyun #define OSD_EOTF_LUT_SIZE 33
176*4882a593Smuzhiyun #define OSD_OETF_LUT_SIZE 41
177*4882a593Smuzhiyun 
178*4882a593Smuzhiyun static void
meson_viu_set_osd_lut(struct meson_drm * priv,enum viu_lut_sel_e lut_sel,unsigned int * r_map,unsigned int * g_map,unsigned int * b_map,bool csc_on)179*4882a593Smuzhiyun meson_viu_set_osd_lut(struct meson_drm *priv, enum viu_lut_sel_e lut_sel,
180*4882a593Smuzhiyun 		      unsigned int *r_map, unsigned int *g_map,
181*4882a593Smuzhiyun 		      unsigned int *b_map, bool csc_on)
182*4882a593Smuzhiyun {
183*4882a593Smuzhiyun 	unsigned int addr_port;
184*4882a593Smuzhiyun 	unsigned int data_port;
185*4882a593Smuzhiyun 	unsigned int ctrl_port;
186*4882a593Smuzhiyun 	int i;
187*4882a593Smuzhiyun 
188*4882a593Smuzhiyun 	if (lut_sel == VIU_LUT_OSD_EOTF) {
189*4882a593Smuzhiyun 		addr_port = VIU_OSD1_EOTF_LUT_ADDR_PORT;
190*4882a593Smuzhiyun 		data_port = VIU_OSD1_EOTF_LUT_DATA_PORT;
191*4882a593Smuzhiyun 		ctrl_port = VIU_OSD1_EOTF_CTL;
192*4882a593Smuzhiyun 	} else if (lut_sel == VIU_LUT_OSD_OETF) {
193*4882a593Smuzhiyun 		addr_port = VIU_OSD1_OETF_LUT_ADDR_PORT;
194*4882a593Smuzhiyun 		data_port = VIU_OSD1_OETF_LUT_DATA_PORT;
195*4882a593Smuzhiyun 		ctrl_port = VIU_OSD1_OETF_CTL;
196*4882a593Smuzhiyun 	} else
197*4882a593Smuzhiyun 		return;
198*4882a593Smuzhiyun 
199*4882a593Smuzhiyun 	if (lut_sel == VIU_LUT_OSD_OETF) {
200*4882a593Smuzhiyun 		writel(0, priv->io_base + _REG(addr_port));
201*4882a593Smuzhiyun 
202*4882a593Smuzhiyun 		for (i = 0; i < (OSD_OETF_LUT_SIZE / 2); i++)
203*4882a593Smuzhiyun 			writel(r_map[i * 2] | (r_map[i * 2 + 1] << 16),
204*4882a593Smuzhiyun 				priv->io_base + _REG(data_port));
205*4882a593Smuzhiyun 
206*4882a593Smuzhiyun 		writel(r_map[OSD_OETF_LUT_SIZE - 1] | (g_map[0] << 16),
207*4882a593Smuzhiyun 			priv->io_base + _REG(data_port));
208*4882a593Smuzhiyun 
209*4882a593Smuzhiyun 		for (i = 0; i < (OSD_OETF_LUT_SIZE / 2); i++)
210*4882a593Smuzhiyun 			writel(g_map[i * 2 + 1] | (g_map[i * 2 + 2] << 16),
211*4882a593Smuzhiyun 				priv->io_base + _REG(data_port));
212*4882a593Smuzhiyun 
213*4882a593Smuzhiyun 		for (i = 0; i < (OSD_OETF_LUT_SIZE / 2); i++)
214*4882a593Smuzhiyun 			writel(b_map[i * 2] | (b_map[i * 2 + 1] << 16),
215*4882a593Smuzhiyun 				priv->io_base + _REG(data_port));
216*4882a593Smuzhiyun 
217*4882a593Smuzhiyun 		writel(b_map[OSD_OETF_LUT_SIZE - 1],
218*4882a593Smuzhiyun 			priv->io_base + _REG(data_port));
219*4882a593Smuzhiyun 
220*4882a593Smuzhiyun 		if (csc_on)
221*4882a593Smuzhiyun 			writel_bits_relaxed(0x7 << 29, 7 << 29,
222*4882a593Smuzhiyun 					    priv->io_base + _REG(ctrl_port));
223*4882a593Smuzhiyun 		else
224*4882a593Smuzhiyun 			writel_bits_relaxed(0x7 << 29, 0,
225*4882a593Smuzhiyun 					    priv->io_base + _REG(ctrl_port));
226*4882a593Smuzhiyun 	} else if (lut_sel == VIU_LUT_OSD_EOTF) {
227*4882a593Smuzhiyun 		writel(0, priv->io_base + _REG(addr_port));
228*4882a593Smuzhiyun 
229*4882a593Smuzhiyun 		for (i = 0; i < (OSD_EOTF_LUT_SIZE / 2); i++)
230*4882a593Smuzhiyun 			writel(r_map[i * 2] | (r_map[i * 2 + 1] << 16),
231*4882a593Smuzhiyun 				priv->io_base + _REG(data_port));
232*4882a593Smuzhiyun 
233*4882a593Smuzhiyun 		writel(r_map[OSD_EOTF_LUT_SIZE - 1] | (g_map[0] << 16),
234*4882a593Smuzhiyun 			priv->io_base + _REG(data_port));
235*4882a593Smuzhiyun 
236*4882a593Smuzhiyun 		for (i = 0; i < (OSD_EOTF_LUT_SIZE / 2); i++)
237*4882a593Smuzhiyun 			writel(g_map[i * 2 + 1] | (g_map[i * 2 + 2] << 16),
238*4882a593Smuzhiyun 				priv->io_base + _REG(data_port));
239*4882a593Smuzhiyun 
240*4882a593Smuzhiyun 		for (i = 0; i < (OSD_EOTF_LUT_SIZE / 2); i++)
241*4882a593Smuzhiyun 			writel(b_map[i * 2] | (b_map[i * 2 + 1] << 16),
242*4882a593Smuzhiyun 				priv->io_base + _REG(data_port));
243*4882a593Smuzhiyun 
244*4882a593Smuzhiyun 		writel(b_map[OSD_EOTF_LUT_SIZE - 1],
245*4882a593Smuzhiyun 			priv->io_base + _REG(data_port));
246*4882a593Smuzhiyun 
247*4882a593Smuzhiyun 		if (csc_on)
248*4882a593Smuzhiyun 			writel_bits_relaxed(7 << 27, 7 << 27,
249*4882a593Smuzhiyun 					    priv->io_base + _REG(ctrl_port));
250*4882a593Smuzhiyun 		else
251*4882a593Smuzhiyun 			writel_bits_relaxed(7 << 27, 0,
252*4882a593Smuzhiyun 					    priv->io_base + _REG(ctrl_port));
253*4882a593Smuzhiyun 
254*4882a593Smuzhiyun 		writel_bits_relaxed(BIT(31), BIT(31),
255*4882a593Smuzhiyun 				    priv->io_base + _REG(ctrl_port));
256*4882a593Smuzhiyun 	}
257*4882a593Smuzhiyun }
258*4882a593Smuzhiyun 
259*4882a593Smuzhiyun /* eotf lut: linear */
260*4882a593Smuzhiyun static unsigned int eotf_33_linear_mapping[OSD_EOTF_LUT_SIZE] = {
261*4882a593Smuzhiyun 	0x0000,	0x0200,	0x0400, 0x0600,
262*4882a593Smuzhiyun 	0x0800, 0x0a00, 0x0c00, 0x0e00,
263*4882a593Smuzhiyun 	0x1000, 0x1200, 0x1400, 0x1600,
264*4882a593Smuzhiyun 	0x1800, 0x1a00, 0x1c00, 0x1e00,
265*4882a593Smuzhiyun 	0x2000, 0x2200, 0x2400, 0x2600,
266*4882a593Smuzhiyun 	0x2800, 0x2a00, 0x2c00, 0x2e00,
267*4882a593Smuzhiyun 	0x3000, 0x3200, 0x3400, 0x3600,
268*4882a593Smuzhiyun 	0x3800, 0x3a00, 0x3c00, 0x3e00,
269*4882a593Smuzhiyun 	0x4000
270*4882a593Smuzhiyun };
271*4882a593Smuzhiyun 
272*4882a593Smuzhiyun /* osd oetf lut: linear */
273*4882a593Smuzhiyun static unsigned int oetf_41_linear_mapping[OSD_OETF_LUT_SIZE] = {
274*4882a593Smuzhiyun 	0, 0, 0, 0,
275*4882a593Smuzhiyun 	0, 32, 64, 96,
276*4882a593Smuzhiyun 	128, 160, 196, 224,
277*4882a593Smuzhiyun 	256, 288, 320, 352,
278*4882a593Smuzhiyun 	384, 416, 448, 480,
279*4882a593Smuzhiyun 	512, 544, 576, 608,
280*4882a593Smuzhiyun 	640, 672, 704, 736,
281*4882a593Smuzhiyun 	768, 800, 832, 864,
282*4882a593Smuzhiyun 	896, 928, 960, 992,
283*4882a593Smuzhiyun 	1023, 1023, 1023, 1023,
284*4882a593Smuzhiyun 	1023
285*4882a593Smuzhiyun };
286*4882a593Smuzhiyun 
meson_viu_load_matrix(struct meson_drm * priv)287*4882a593Smuzhiyun static void meson_viu_load_matrix(struct meson_drm *priv)
288*4882a593Smuzhiyun {
289*4882a593Smuzhiyun 	/* eotf lut bypass */
290*4882a593Smuzhiyun 	meson_viu_set_osd_lut(priv, VIU_LUT_OSD_EOTF,
291*4882a593Smuzhiyun 			      eotf_33_linear_mapping, /* R */
292*4882a593Smuzhiyun 			      eotf_33_linear_mapping, /* G */
293*4882a593Smuzhiyun 			      eotf_33_linear_mapping, /* B */
294*4882a593Smuzhiyun 			      false);
295*4882a593Smuzhiyun 
296*4882a593Smuzhiyun 	/* eotf matrix bypass */
297*4882a593Smuzhiyun 	meson_viu_set_osd_matrix(priv, VIU_MATRIX_OSD_EOTF,
298*4882a593Smuzhiyun 				 eotf_bypass_coeff,
299*4882a593Smuzhiyun 				 false);
300*4882a593Smuzhiyun 
301*4882a593Smuzhiyun 	/* oetf lut bypass */
302*4882a593Smuzhiyun 	meson_viu_set_osd_lut(priv, VIU_LUT_OSD_OETF,
303*4882a593Smuzhiyun 			      oetf_41_linear_mapping, /* R */
304*4882a593Smuzhiyun 			      oetf_41_linear_mapping, /* G */
305*4882a593Smuzhiyun 			      oetf_41_linear_mapping, /* B */
306*4882a593Smuzhiyun 			      false);
307*4882a593Smuzhiyun 
308*4882a593Smuzhiyun 	/* osd matrix RGB709 to YUV709 limit */
309*4882a593Smuzhiyun 	meson_viu_set_osd_matrix(priv, VIU_MATRIX_OSD,
310*4882a593Smuzhiyun 				 RGB709_to_YUV709l_coeff,
311*4882a593Smuzhiyun 				 true);
312*4882a593Smuzhiyun }
313*4882a593Smuzhiyun 
314*4882a593Smuzhiyun /* VIU OSD1 Reset as workaround for GXL+ Alpha OSD Bug */
meson_viu_osd1_reset(struct meson_drm * priv)315*4882a593Smuzhiyun void meson_viu_osd1_reset(struct meson_drm *priv)
316*4882a593Smuzhiyun {
317*4882a593Smuzhiyun 	uint32_t osd1_fifo_ctrl_stat, osd1_ctrl_stat2;
318*4882a593Smuzhiyun 
319*4882a593Smuzhiyun 	/* Save these 2 registers state */
320*4882a593Smuzhiyun 	osd1_fifo_ctrl_stat = readl_relaxed(
321*4882a593Smuzhiyun 				priv->io_base + _REG(VIU_OSD1_FIFO_CTRL_STAT));
322*4882a593Smuzhiyun 	osd1_ctrl_stat2 = readl_relaxed(
323*4882a593Smuzhiyun 				priv->io_base + _REG(VIU_OSD1_CTRL_STAT2));
324*4882a593Smuzhiyun 
325*4882a593Smuzhiyun 	/* Reset OSD1 */
326*4882a593Smuzhiyun 	writel_bits_relaxed(VIU_SW_RESET_OSD1, VIU_SW_RESET_OSD1,
327*4882a593Smuzhiyun 			    priv->io_base + _REG(VIU_SW_RESET));
328*4882a593Smuzhiyun 	writel_bits_relaxed(VIU_SW_RESET_OSD1, 0,
329*4882a593Smuzhiyun 			    priv->io_base + _REG(VIU_SW_RESET));
330*4882a593Smuzhiyun 
331*4882a593Smuzhiyun 	/* Rewrite these registers state lost in the reset */
332*4882a593Smuzhiyun 	writel_relaxed(osd1_fifo_ctrl_stat,
333*4882a593Smuzhiyun 		       priv->io_base + _REG(VIU_OSD1_FIFO_CTRL_STAT));
334*4882a593Smuzhiyun 	writel_relaxed(osd1_ctrl_stat2,
335*4882a593Smuzhiyun 		       priv->io_base + _REG(VIU_OSD1_CTRL_STAT2));
336*4882a593Smuzhiyun 
337*4882a593Smuzhiyun 	/* Reload the conversion matrix */
338*4882a593Smuzhiyun 	meson_viu_load_matrix(priv);
339*4882a593Smuzhiyun }
340*4882a593Smuzhiyun 
341*4882a593Smuzhiyun #define OSD1_MALI_ORDER_ABGR				\
342*4882a593Smuzhiyun 	(FIELD_PREP(VIU_OSD1_MALI_AFBCD_A_REORDER,	\
343*4882a593Smuzhiyun 		    VIU_OSD1_MALI_REORDER_A) |		\
344*4882a593Smuzhiyun 	 FIELD_PREP(VIU_OSD1_MALI_AFBCD_B_REORDER,	\
345*4882a593Smuzhiyun 		    VIU_OSD1_MALI_REORDER_B) |		\
346*4882a593Smuzhiyun 	 FIELD_PREP(VIU_OSD1_MALI_AFBCD_G_REORDER,	\
347*4882a593Smuzhiyun 		    VIU_OSD1_MALI_REORDER_G) |		\
348*4882a593Smuzhiyun 	 FIELD_PREP(VIU_OSD1_MALI_AFBCD_R_REORDER,	\
349*4882a593Smuzhiyun 		    VIU_OSD1_MALI_REORDER_R))
350*4882a593Smuzhiyun 
351*4882a593Smuzhiyun #define OSD1_MALI_ORDER_ARGB				\
352*4882a593Smuzhiyun 	(FIELD_PREP(VIU_OSD1_MALI_AFBCD_A_REORDER,	\
353*4882a593Smuzhiyun 		    VIU_OSD1_MALI_REORDER_A) |		\
354*4882a593Smuzhiyun 	 FIELD_PREP(VIU_OSD1_MALI_AFBCD_B_REORDER,	\
355*4882a593Smuzhiyun 		    VIU_OSD1_MALI_REORDER_R) |		\
356*4882a593Smuzhiyun 	 FIELD_PREP(VIU_OSD1_MALI_AFBCD_G_REORDER,	\
357*4882a593Smuzhiyun 		    VIU_OSD1_MALI_REORDER_G) |		\
358*4882a593Smuzhiyun 	 FIELD_PREP(VIU_OSD1_MALI_AFBCD_R_REORDER,	\
359*4882a593Smuzhiyun 		    VIU_OSD1_MALI_REORDER_B))
360*4882a593Smuzhiyun 
meson_viu_g12a_enable_osd1_afbc(struct meson_drm * priv)361*4882a593Smuzhiyun void meson_viu_g12a_enable_osd1_afbc(struct meson_drm *priv)
362*4882a593Smuzhiyun {
363*4882a593Smuzhiyun 	u32 afbc_order = OSD1_MALI_ORDER_ARGB;
364*4882a593Smuzhiyun 
365*4882a593Smuzhiyun 	/* Enable Mali AFBC Unpack */
366*4882a593Smuzhiyun 	writel_bits_relaxed(VIU_OSD1_MALI_UNPACK_EN,
367*4882a593Smuzhiyun 			    VIU_OSD1_MALI_UNPACK_EN,
368*4882a593Smuzhiyun 			    priv->io_base + _REG(VIU_OSD1_MALI_UNPACK_CTRL));
369*4882a593Smuzhiyun 
370*4882a593Smuzhiyun 	switch (priv->afbcd.format) {
371*4882a593Smuzhiyun 	case DRM_FORMAT_XBGR8888:
372*4882a593Smuzhiyun 	case DRM_FORMAT_ABGR8888:
373*4882a593Smuzhiyun 		afbc_order = OSD1_MALI_ORDER_ABGR;
374*4882a593Smuzhiyun 		break;
375*4882a593Smuzhiyun 	}
376*4882a593Smuzhiyun 
377*4882a593Smuzhiyun 	/* Setup RGBA Reordering */
378*4882a593Smuzhiyun 	writel_bits_relaxed(VIU_OSD1_MALI_AFBCD_A_REORDER |
379*4882a593Smuzhiyun 			    VIU_OSD1_MALI_AFBCD_B_REORDER |
380*4882a593Smuzhiyun 			    VIU_OSD1_MALI_AFBCD_G_REORDER |
381*4882a593Smuzhiyun 			    VIU_OSD1_MALI_AFBCD_R_REORDER,
382*4882a593Smuzhiyun 			    afbc_order,
383*4882a593Smuzhiyun 			    priv->io_base + _REG(VIU_OSD1_MALI_UNPACK_CTRL));
384*4882a593Smuzhiyun 
385*4882a593Smuzhiyun 	/* Select AFBCD path for OSD1 */
386*4882a593Smuzhiyun 	writel_bits_relaxed(OSD_PATH_OSD_AXI_SEL_OSD1_AFBCD,
387*4882a593Smuzhiyun 			    OSD_PATH_OSD_AXI_SEL_OSD1_AFBCD,
388*4882a593Smuzhiyun 			    priv->io_base + _REG(OSD_PATH_MISC_CTRL));
389*4882a593Smuzhiyun }
390*4882a593Smuzhiyun 
meson_viu_g12a_disable_osd1_afbc(struct meson_drm * priv)391*4882a593Smuzhiyun void meson_viu_g12a_disable_osd1_afbc(struct meson_drm *priv)
392*4882a593Smuzhiyun {
393*4882a593Smuzhiyun 	/* Disable AFBCD path for OSD1 */
394*4882a593Smuzhiyun 	writel_bits_relaxed(OSD_PATH_OSD_AXI_SEL_OSD1_AFBCD, 0,
395*4882a593Smuzhiyun 			    priv->io_base + _REG(OSD_PATH_MISC_CTRL));
396*4882a593Smuzhiyun 
397*4882a593Smuzhiyun 	/* Disable AFBCD unpack */
398*4882a593Smuzhiyun 	writel_bits_relaxed(VIU_OSD1_MALI_UNPACK_EN, 0,
399*4882a593Smuzhiyun 			    priv->io_base + _REG(VIU_OSD1_MALI_UNPACK_CTRL));
400*4882a593Smuzhiyun }
401*4882a593Smuzhiyun 
meson_viu_gxm_enable_osd1_afbc(struct meson_drm * priv)402*4882a593Smuzhiyun void meson_viu_gxm_enable_osd1_afbc(struct meson_drm *priv)
403*4882a593Smuzhiyun {
404*4882a593Smuzhiyun 	writel_bits_relaxed(MALI_AFBC_MISC, FIELD_PREP(MALI_AFBC_MISC, 0x90),
405*4882a593Smuzhiyun 			    priv->io_base + _REG(VIU_MISC_CTRL1));
406*4882a593Smuzhiyun }
407*4882a593Smuzhiyun 
meson_viu_gxm_disable_osd1_afbc(struct meson_drm * priv)408*4882a593Smuzhiyun void meson_viu_gxm_disable_osd1_afbc(struct meson_drm *priv)
409*4882a593Smuzhiyun {
410*4882a593Smuzhiyun 	writel_bits_relaxed(MALI_AFBC_MISC, FIELD_PREP(MALI_AFBC_MISC, 0x00),
411*4882a593Smuzhiyun 			    priv->io_base + _REG(VIU_MISC_CTRL1));
412*4882a593Smuzhiyun }
413*4882a593Smuzhiyun 
meson_viu_init(struct meson_drm * priv)414*4882a593Smuzhiyun void meson_viu_init(struct meson_drm *priv)
415*4882a593Smuzhiyun {
416*4882a593Smuzhiyun 	uint32_t reg;
417*4882a593Smuzhiyun 
418*4882a593Smuzhiyun 	/* Disable OSDs */
419*4882a593Smuzhiyun 	writel_bits_relaxed(VIU_OSD1_OSD_BLK_ENABLE | VIU_OSD1_OSD_ENABLE, 0,
420*4882a593Smuzhiyun 			    priv->io_base + _REG(VIU_OSD1_CTRL_STAT));
421*4882a593Smuzhiyun 	writel_bits_relaxed(VIU_OSD1_OSD_BLK_ENABLE | VIU_OSD1_OSD_ENABLE, 0,
422*4882a593Smuzhiyun 			    priv->io_base + _REG(VIU_OSD2_CTRL_STAT));
423*4882a593Smuzhiyun 
424*4882a593Smuzhiyun 	/* On GXL/GXM, Use the 10bit HDR conversion matrix */
425*4882a593Smuzhiyun 	if (meson_vpu_is_compatible(priv, VPU_COMPATIBLE_GXM) ||
426*4882a593Smuzhiyun 	    meson_vpu_is_compatible(priv, VPU_COMPATIBLE_GXL))
427*4882a593Smuzhiyun 		meson_viu_load_matrix(priv);
428*4882a593Smuzhiyun 	else if (meson_vpu_is_compatible(priv, VPU_COMPATIBLE_G12A)) {
429*4882a593Smuzhiyun 		meson_viu_set_g12a_osd1_matrix(priv, RGB709_to_YUV709l_coeff,
430*4882a593Smuzhiyun 					       true);
431*4882a593Smuzhiyun 		/* fix green/pink color distortion from vendor u-boot */
432*4882a593Smuzhiyun 		writel_bits_relaxed(OSD1_HDR2_CTRL_REG_ONLY_MAT |
433*4882a593Smuzhiyun 				OSD1_HDR2_CTRL_VDIN0_HDR2_TOP_EN, 0,
434*4882a593Smuzhiyun 				priv->io_base + _REG(OSD1_HDR2_CTRL));
435*4882a593Smuzhiyun 	}
436*4882a593Smuzhiyun 
437*4882a593Smuzhiyun 	/* Initialize OSD1 fifo control register */
438*4882a593Smuzhiyun 	reg = VIU_OSD_DDR_PRIORITY_URGENT |
439*4882a593Smuzhiyun 		VIU_OSD_HOLD_FIFO_LINES(31) |
440*4882a593Smuzhiyun 		VIU_OSD_FIFO_DEPTH_VAL(32) | /* fifo_depth_val: 32*8=256 */
441*4882a593Smuzhiyun 		VIU_OSD_WORDS_PER_BURST(4) | /* 4 words in 1 burst */
442*4882a593Smuzhiyun 		VIU_OSD_FIFO_LIMITS(2);      /* fifo_lim: 2*16=32 */
443*4882a593Smuzhiyun 
444*4882a593Smuzhiyun 	if (meson_vpu_is_compatible(priv, VPU_COMPATIBLE_G12A))
445*4882a593Smuzhiyun 		reg |= VIU_OSD_BURST_LENGTH_32;
446*4882a593Smuzhiyun 	else
447*4882a593Smuzhiyun 		reg |= VIU_OSD_BURST_LENGTH_64;
448*4882a593Smuzhiyun 
449*4882a593Smuzhiyun 	writel_relaxed(reg, priv->io_base + _REG(VIU_OSD1_FIFO_CTRL_STAT));
450*4882a593Smuzhiyun 	writel_relaxed(reg, priv->io_base + _REG(VIU_OSD2_FIFO_CTRL_STAT));
451*4882a593Smuzhiyun 
452*4882a593Smuzhiyun 	/* Set OSD alpha replace value */
453*4882a593Smuzhiyun 	writel_bits_relaxed(0xff << OSD_REPLACE_SHIFT,
454*4882a593Smuzhiyun 			    0xff << OSD_REPLACE_SHIFT,
455*4882a593Smuzhiyun 			    priv->io_base + _REG(VIU_OSD1_CTRL_STAT2));
456*4882a593Smuzhiyun 	writel_bits_relaxed(0xff << OSD_REPLACE_SHIFT,
457*4882a593Smuzhiyun 			    0xff << OSD_REPLACE_SHIFT,
458*4882a593Smuzhiyun 			    priv->io_base + _REG(VIU_OSD2_CTRL_STAT2));
459*4882a593Smuzhiyun 
460*4882a593Smuzhiyun 	/* Disable VD1 AFBC */
461*4882a593Smuzhiyun 	/* di_mif0_en=0 mif0_to_vpp_en=0 di_mad_en=0 and afbc vd1 set=0*/
462*4882a593Smuzhiyun 	writel_bits_relaxed(VIU_CTRL0_VD1_AFBC_MASK, 0,
463*4882a593Smuzhiyun 			    priv->io_base + _REG(VIU_MISC_CTRL0));
464*4882a593Smuzhiyun 	writel_relaxed(0, priv->io_base + _REG(AFBC_ENABLE));
465*4882a593Smuzhiyun 
466*4882a593Smuzhiyun 	writel_relaxed(0x00FF00C0,
467*4882a593Smuzhiyun 			priv->io_base + _REG(VD1_IF0_LUMA_FIFO_SIZE));
468*4882a593Smuzhiyun 	writel_relaxed(0x00FF00C0,
469*4882a593Smuzhiyun 			priv->io_base + _REG(VD2_IF0_LUMA_FIFO_SIZE));
470*4882a593Smuzhiyun 
471*4882a593Smuzhiyun 	if (meson_vpu_is_compatible(priv, VPU_COMPATIBLE_G12A)) {
472*4882a593Smuzhiyun 		u32 val = (u32)VIU_OSD_BLEND_REORDER(0, 1) |
473*4882a593Smuzhiyun 			  (u32)VIU_OSD_BLEND_REORDER(1, 0) |
474*4882a593Smuzhiyun 			  (u32)VIU_OSD_BLEND_REORDER(2, 0) |
475*4882a593Smuzhiyun 			  (u32)VIU_OSD_BLEND_REORDER(3, 0) |
476*4882a593Smuzhiyun 			  (u32)VIU_OSD_BLEND_DIN_EN(1) |
477*4882a593Smuzhiyun 			  (u32)VIU_OSD_BLEND1_DIN3_BYPASS_TO_DOUT1 |
478*4882a593Smuzhiyun 			  (u32)VIU_OSD_BLEND1_DOUT_BYPASS_TO_BLEND2 |
479*4882a593Smuzhiyun 			  (u32)VIU_OSD_BLEND_DIN0_BYPASS_TO_DOUT0 |
480*4882a593Smuzhiyun 			  (u32)VIU_OSD_BLEND_BLEN2_PREMULT_EN(1) |
481*4882a593Smuzhiyun 			  (u32)VIU_OSD_BLEND_HOLD_LINES(4);
482*4882a593Smuzhiyun 		writel_relaxed(val, priv->io_base + _REG(VIU_OSD_BLEND_CTRL));
483*4882a593Smuzhiyun 
484*4882a593Smuzhiyun 		writel_relaxed(OSD_BLEND_PATH_SEL_ENABLE,
485*4882a593Smuzhiyun 			       priv->io_base + _REG(OSD1_BLEND_SRC_CTRL));
486*4882a593Smuzhiyun 		writel_relaxed(OSD_BLEND_PATH_SEL_ENABLE,
487*4882a593Smuzhiyun 			       priv->io_base + _REG(OSD2_BLEND_SRC_CTRL));
488*4882a593Smuzhiyun 		writel_relaxed(0, priv->io_base + _REG(VD1_BLEND_SRC_CTRL));
489*4882a593Smuzhiyun 		writel_relaxed(0, priv->io_base + _REG(VD2_BLEND_SRC_CTRL));
490*4882a593Smuzhiyun 		writel_relaxed(0,
491*4882a593Smuzhiyun 				priv->io_base + _REG(VIU_OSD_BLEND_DUMMY_DATA0));
492*4882a593Smuzhiyun 		writel_relaxed(0,
493*4882a593Smuzhiyun 				priv->io_base + _REG(VIU_OSD_BLEND_DUMMY_ALPHA));
494*4882a593Smuzhiyun 
495*4882a593Smuzhiyun 		writel_bits_relaxed(DOLBY_BYPASS_EN(0xc), DOLBY_BYPASS_EN(0xc),
496*4882a593Smuzhiyun 				    priv->io_base + _REG(DOLBY_PATH_CTRL));
497*4882a593Smuzhiyun 
498*4882a593Smuzhiyun 		meson_viu_g12a_disable_osd1_afbc(priv);
499*4882a593Smuzhiyun 	}
500*4882a593Smuzhiyun 
501*4882a593Smuzhiyun 	if (meson_vpu_is_compatible(priv, VPU_COMPATIBLE_GXM))
502*4882a593Smuzhiyun 		meson_viu_gxm_disable_osd1_afbc(priv);
503*4882a593Smuzhiyun 
504*4882a593Smuzhiyun 	priv->viu.osd1_enabled = false;
505*4882a593Smuzhiyun 	priv->viu.osd1_commit = false;
506*4882a593Smuzhiyun 	priv->viu.osd1_interlace = false;
507*4882a593Smuzhiyun }
508