xref: /OK3568_Linux_fs/kernel/drivers/gpu/drm/exynos/exynos_drm_gsc.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Copyright (C) 2012 Samsung Electronics Co.Ltd
4*4882a593Smuzhiyun  * Authors:
5*4882a593Smuzhiyun  *	Eunchul Kim <chulspro.kim@samsung.com>
6*4882a593Smuzhiyun  *	Jinyoung Jeon <jy0.jeon@samsung.com>
7*4882a593Smuzhiyun  *	Sangmin Lee <lsmin.lee@samsung.com>
8*4882a593Smuzhiyun  */
9*4882a593Smuzhiyun 
10*4882a593Smuzhiyun #include <linux/clk.h>
11*4882a593Smuzhiyun #include <linux/component.h>
12*4882a593Smuzhiyun #include <linux/kernel.h>
13*4882a593Smuzhiyun #include <linux/mfd/syscon.h>
14*4882a593Smuzhiyun #include <linux/of_device.h>
15*4882a593Smuzhiyun #include <linux/platform_device.h>
16*4882a593Smuzhiyun #include <linux/pm_runtime.h>
17*4882a593Smuzhiyun #include <linux/regmap.h>
18*4882a593Smuzhiyun 
19*4882a593Smuzhiyun #include <drm/drm_fourcc.h>
20*4882a593Smuzhiyun #include <drm/drm_print.h>
21*4882a593Smuzhiyun #include <drm/exynos_drm.h>
22*4882a593Smuzhiyun 
23*4882a593Smuzhiyun #include "exynos_drm_drv.h"
24*4882a593Smuzhiyun #include "exynos_drm_ipp.h"
25*4882a593Smuzhiyun #include "regs-gsc.h"
26*4882a593Smuzhiyun 
27*4882a593Smuzhiyun /*
28*4882a593Smuzhiyun  * GSC stands for General SCaler and
29*4882a593Smuzhiyun  * supports image scaler/rotator and input/output DMA operations.
30*4882a593Smuzhiyun  * input DMA reads image data from the memory.
31*4882a593Smuzhiyun  * output DMA writes image data to memory.
32*4882a593Smuzhiyun  * GSC supports image rotation and image effect functions.
33*4882a593Smuzhiyun  */
34*4882a593Smuzhiyun 
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun #define GSC_MAX_CLOCKS	8
37*4882a593Smuzhiyun #define GSC_MAX_SRC		4
38*4882a593Smuzhiyun #define GSC_MAX_DST		16
39*4882a593Smuzhiyun #define GSC_RESET_TIMEOUT	50
40*4882a593Smuzhiyun #define GSC_BUF_STOP	1
41*4882a593Smuzhiyun #define GSC_BUF_START	2
42*4882a593Smuzhiyun #define GSC_REG_SZ		16
43*4882a593Smuzhiyun #define GSC_WIDTH_ITU_709	1280
44*4882a593Smuzhiyun #define GSC_SC_UP_MAX_RATIO		65536
45*4882a593Smuzhiyun #define GSC_SC_DOWN_RATIO_7_8		74898
46*4882a593Smuzhiyun #define GSC_SC_DOWN_RATIO_6_8		87381
47*4882a593Smuzhiyun #define GSC_SC_DOWN_RATIO_5_8		104857
48*4882a593Smuzhiyun #define GSC_SC_DOWN_RATIO_4_8		131072
49*4882a593Smuzhiyun #define GSC_SC_DOWN_RATIO_3_8		174762
50*4882a593Smuzhiyun #define GSC_SC_DOWN_RATIO_2_8		262144
51*4882a593Smuzhiyun #define GSC_CROP_MAX	8192
52*4882a593Smuzhiyun #define GSC_CROP_MIN	32
53*4882a593Smuzhiyun #define GSC_SCALE_MAX	4224
54*4882a593Smuzhiyun #define GSC_SCALE_MIN	32
55*4882a593Smuzhiyun #define GSC_COEF_RATIO	7
56*4882a593Smuzhiyun #define GSC_COEF_PHASE	9
57*4882a593Smuzhiyun #define GSC_COEF_ATTR	16
58*4882a593Smuzhiyun #define GSC_COEF_H_8T	8
59*4882a593Smuzhiyun #define GSC_COEF_V_4T	4
60*4882a593Smuzhiyun #define GSC_COEF_DEPTH	3
61*4882a593Smuzhiyun #define GSC_AUTOSUSPEND_DELAY		2000
62*4882a593Smuzhiyun 
63*4882a593Smuzhiyun #define get_gsc_context(dev)	dev_get_drvdata(dev)
64*4882a593Smuzhiyun #define gsc_read(offset)		readl(ctx->regs + (offset))
65*4882a593Smuzhiyun #define gsc_write(cfg, offset)	writel(cfg, ctx->regs + (offset))
66*4882a593Smuzhiyun 
67*4882a593Smuzhiyun /*
68*4882a593Smuzhiyun  * A structure of scaler.
69*4882a593Smuzhiyun  *
70*4882a593Smuzhiyun  * @range: narrow, wide.
71*4882a593Smuzhiyun  * @pre_shfactor: pre sclaer shift factor.
72*4882a593Smuzhiyun  * @pre_hratio: horizontal ratio of the prescaler.
73*4882a593Smuzhiyun  * @pre_vratio: vertical ratio of the prescaler.
74*4882a593Smuzhiyun  * @main_hratio: the main scaler's horizontal ratio.
75*4882a593Smuzhiyun  * @main_vratio: the main scaler's vertical ratio.
76*4882a593Smuzhiyun  */
77*4882a593Smuzhiyun struct gsc_scaler {
78*4882a593Smuzhiyun 	bool	range;
79*4882a593Smuzhiyun 	u32	pre_shfactor;
80*4882a593Smuzhiyun 	u32	pre_hratio;
81*4882a593Smuzhiyun 	u32	pre_vratio;
82*4882a593Smuzhiyun 	unsigned long main_hratio;
83*4882a593Smuzhiyun 	unsigned long main_vratio;
84*4882a593Smuzhiyun };
85*4882a593Smuzhiyun 
86*4882a593Smuzhiyun /*
87*4882a593Smuzhiyun  * A structure of gsc context.
88*4882a593Smuzhiyun  *
89*4882a593Smuzhiyun  * @regs_res: register resources.
90*4882a593Smuzhiyun  * @regs: memory mapped io registers.
91*4882a593Smuzhiyun  * @gsc_clk: gsc gate clock.
92*4882a593Smuzhiyun  * @sc: scaler infomations.
93*4882a593Smuzhiyun  * @id: gsc id.
94*4882a593Smuzhiyun  * @irq: irq number.
95*4882a593Smuzhiyun  * @rotation: supports rotation of src.
96*4882a593Smuzhiyun  */
97*4882a593Smuzhiyun struct gsc_context {
98*4882a593Smuzhiyun 	struct exynos_drm_ipp ipp;
99*4882a593Smuzhiyun 	struct drm_device *drm_dev;
100*4882a593Smuzhiyun 	void		*dma_priv;
101*4882a593Smuzhiyun 	struct device	*dev;
102*4882a593Smuzhiyun 	struct exynos_drm_ipp_task	*task;
103*4882a593Smuzhiyun 	struct exynos_drm_ipp_formats	*formats;
104*4882a593Smuzhiyun 	unsigned int			num_formats;
105*4882a593Smuzhiyun 
106*4882a593Smuzhiyun 	struct resource	*regs_res;
107*4882a593Smuzhiyun 	void __iomem	*regs;
108*4882a593Smuzhiyun 	const char	**clk_names;
109*4882a593Smuzhiyun 	struct clk	*clocks[GSC_MAX_CLOCKS];
110*4882a593Smuzhiyun 	int		num_clocks;
111*4882a593Smuzhiyun 	struct gsc_scaler	sc;
112*4882a593Smuzhiyun 	int	id;
113*4882a593Smuzhiyun 	int	irq;
114*4882a593Smuzhiyun 	bool	rotation;
115*4882a593Smuzhiyun };
116*4882a593Smuzhiyun 
117*4882a593Smuzhiyun /**
118*4882a593Smuzhiyun  * struct gsc_driverdata - per device type driver data for init time.
119*4882a593Smuzhiyun  *
120*4882a593Smuzhiyun  * @limits: picture size limits array
121*4882a593Smuzhiyun  * @clk_names: names of clocks needed by this variant
122*4882a593Smuzhiyun  * @num_clocks: the number of clocks needed by this variant
123*4882a593Smuzhiyun  */
124*4882a593Smuzhiyun struct gsc_driverdata {
125*4882a593Smuzhiyun 	const struct drm_exynos_ipp_limit *limits;
126*4882a593Smuzhiyun 	int		num_limits;
127*4882a593Smuzhiyun 	const char	*clk_names[GSC_MAX_CLOCKS];
128*4882a593Smuzhiyun 	int		num_clocks;
129*4882a593Smuzhiyun };
130*4882a593Smuzhiyun 
131*4882a593Smuzhiyun /* 8-tap Filter Coefficient */
132*4882a593Smuzhiyun static const int h_coef_8t[GSC_COEF_RATIO][GSC_COEF_ATTR][GSC_COEF_H_8T] = {
133*4882a593Smuzhiyun 	{	/* Ratio <= 65536 (~8:8) */
134*4882a593Smuzhiyun 		{  0,  0,   0, 128,   0,   0,  0,  0 },
135*4882a593Smuzhiyun 		{ -1,  2,  -6, 127,   7,  -2,  1,  0 },
136*4882a593Smuzhiyun 		{ -1,  4, -12, 125,  16,  -5,  1,  0 },
137*4882a593Smuzhiyun 		{ -1,  5, -15, 120,  25,  -8,  2,  0 },
138*4882a593Smuzhiyun 		{ -1,  6, -18, 114,  35, -10,  3, -1 },
139*4882a593Smuzhiyun 		{ -1,  6, -20, 107,  46, -13,  4, -1 },
140*4882a593Smuzhiyun 		{ -2,  7, -21,  99,  57, -16,  5, -1 },
141*4882a593Smuzhiyun 		{ -1,  6, -20,  89,  68, -18,  5, -1 },
142*4882a593Smuzhiyun 		{ -1,  6, -20,  79,  79, -20,  6, -1 },
143*4882a593Smuzhiyun 		{ -1,  5, -18,  68,  89, -20,  6, -1 },
144*4882a593Smuzhiyun 		{ -1,  5, -16,  57,  99, -21,  7, -2 },
145*4882a593Smuzhiyun 		{ -1,  4, -13,  46, 107, -20,  6, -1 },
146*4882a593Smuzhiyun 		{ -1,  3, -10,  35, 114, -18,  6, -1 },
147*4882a593Smuzhiyun 		{  0,  2,  -8,  25, 120, -15,  5, -1 },
148*4882a593Smuzhiyun 		{  0,  1,  -5,  16, 125, -12,  4, -1 },
149*4882a593Smuzhiyun 		{  0,  1,  -2,   7, 127,  -6,  2, -1 }
150*4882a593Smuzhiyun 	}, {	/* 65536 < Ratio <= 74898 (~8:7) */
151*4882a593Smuzhiyun 		{  3, -8,  14, 111,  13,  -8,  3,  0 },
152*4882a593Smuzhiyun 		{  2, -6,   7, 112,  21, -10,  3, -1 },
153*4882a593Smuzhiyun 		{  2, -4,   1, 110,  28, -12,  4, -1 },
154*4882a593Smuzhiyun 		{  1, -2,  -3, 106,  36, -13,  4, -1 },
155*4882a593Smuzhiyun 		{  1, -1,  -7, 103,  44, -15,  4, -1 },
156*4882a593Smuzhiyun 		{  1,  1, -11,  97,  53, -16,  4, -1 },
157*4882a593Smuzhiyun 		{  0,  2, -13,  91,  61, -16,  4, -1 },
158*4882a593Smuzhiyun 		{  0,  3, -15,  85,  69, -17,  4, -1 },
159*4882a593Smuzhiyun 		{  0,  3, -16,  77,  77, -16,  3,  0 },
160*4882a593Smuzhiyun 		{ -1,  4, -17,  69,  85, -15,  3,  0 },
161*4882a593Smuzhiyun 		{ -1,  4, -16,  61,  91, -13,  2,  0 },
162*4882a593Smuzhiyun 		{ -1,  4, -16,  53,  97, -11,  1,  1 },
163*4882a593Smuzhiyun 		{ -1,  4, -15,  44, 103,  -7, -1,  1 },
164*4882a593Smuzhiyun 		{ -1,  4, -13,  36, 106,  -3, -2,  1 },
165*4882a593Smuzhiyun 		{ -1,  4, -12,  28, 110,   1, -4,  2 },
166*4882a593Smuzhiyun 		{ -1,  3, -10,  21, 112,   7, -6,  2 }
167*4882a593Smuzhiyun 	}, {	/* 74898 < Ratio <= 87381 (~8:6) */
168*4882a593Smuzhiyun 		{ 2, -11,  25,  96, 25, -11,   2,  0 },
169*4882a593Smuzhiyun 		{ 2, -10,  19,  96, 31, -12,   2,  0 },
170*4882a593Smuzhiyun 		{ 2,  -9,  14,  94, 37, -12,   2,  0 },
171*4882a593Smuzhiyun 		{ 2,  -8,  10,  92, 43, -12,   1,  0 },
172*4882a593Smuzhiyun 		{ 2,  -7,   5,  90, 49, -12,   1,  0 },
173*4882a593Smuzhiyun 		{ 2,  -5,   1,  86, 55, -12,   0,  1 },
174*4882a593Smuzhiyun 		{ 2,  -4,  -2,  82, 61, -11,  -1,  1 },
175*4882a593Smuzhiyun 		{ 1,  -3,  -5,  77, 67,  -9,  -1,  1 },
176*4882a593Smuzhiyun 		{ 1,  -2,  -7,  72, 72,  -7,  -2,  1 },
177*4882a593Smuzhiyun 		{ 1,  -1,  -9,  67, 77,  -5,  -3,  1 },
178*4882a593Smuzhiyun 		{ 1,  -1, -11,  61, 82,  -2,  -4,  2 },
179*4882a593Smuzhiyun 		{ 1,   0, -12,  55, 86,   1,  -5,  2 },
180*4882a593Smuzhiyun 		{ 0,   1, -12,  49, 90,   5,  -7,  2 },
181*4882a593Smuzhiyun 		{ 0,   1, -12,  43, 92,  10,  -8,  2 },
182*4882a593Smuzhiyun 		{ 0,   2, -12,  37, 94,  14,  -9,  2 },
183*4882a593Smuzhiyun 		{ 0,   2, -12,  31, 96,  19, -10,  2 }
184*4882a593Smuzhiyun 	}, {	/* 87381 < Ratio <= 104857 (~8:5) */
185*4882a593Smuzhiyun 		{ -1,  -8, 33,  80, 33,  -8,  -1,  0 },
186*4882a593Smuzhiyun 		{ -1,  -8, 28,  80, 37,  -7,  -2,  1 },
187*4882a593Smuzhiyun 		{  0,  -8, 24,  79, 41,  -7,  -2,  1 },
188*4882a593Smuzhiyun 		{  0,  -8, 20,  78, 46,  -6,  -3,  1 },
189*4882a593Smuzhiyun 		{  0,  -8, 16,  76, 50,  -4,  -3,  1 },
190*4882a593Smuzhiyun 		{  0,  -7, 13,  74, 54,  -3,  -4,  1 },
191*4882a593Smuzhiyun 		{  1,  -7, 10,  71, 58,  -1,  -5,  1 },
192*4882a593Smuzhiyun 		{  1,  -6,  6,  68, 62,   1,  -5,  1 },
193*4882a593Smuzhiyun 		{  1,  -6,  4,  65, 65,   4,  -6,  1 },
194*4882a593Smuzhiyun 		{  1,  -5,  1,  62, 68,   6,  -6,  1 },
195*4882a593Smuzhiyun 		{  1,  -5, -1,  58, 71,  10,  -7,  1 },
196*4882a593Smuzhiyun 		{  1,  -4, -3,  54, 74,  13,  -7,  0 },
197*4882a593Smuzhiyun 		{  1,  -3, -4,  50, 76,  16,  -8,  0 },
198*4882a593Smuzhiyun 		{  1,  -3, -6,  46, 78,  20,  -8,  0 },
199*4882a593Smuzhiyun 		{  1,  -2, -7,  41, 79,  24,  -8,  0 },
200*4882a593Smuzhiyun 		{  1,  -2, -7,  37, 80,  28,  -8, -1 }
201*4882a593Smuzhiyun 	}, {	/* 104857 < Ratio <= 131072 (~8:4) */
202*4882a593Smuzhiyun 		{ -3,   0, 35,  64, 35,   0,  -3,  0 },
203*4882a593Smuzhiyun 		{ -3,  -1, 32,  64, 38,   1,  -3,  0 },
204*4882a593Smuzhiyun 		{ -2,  -2, 29,  63, 41,   2,  -3,  0 },
205*4882a593Smuzhiyun 		{ -2,  -3, 27,  63, 43,   4,  -4,  0 },
206*4882a593Smuzhiyun 		{ -2,  -3, 24,  61, 46,   6,  -4,  0 },
207*4882a593Smuzhiyun 		{ -2,  -3, 21,  60, 49,   7,  -4,  0 },
208*4882a593Smuzhiyun 		{ -1,  -4, 19,  59, 51,   9,  -4, -1 },
209*4882a593Smuzhiyun 		{ -1,  -4, 16,  57, 53,  12,  -4, -1 },
210*4882a593Smuzhiyun 		{ -1,  -4, 14,  55, 55,  14,  -4, -1 },
211*4882a593Smuzhiyun 		{ -1,  -4, 12,  53, 57,  16,  -4, -1 },
212*4882a593Smuzhiyun 		{ -1,  -4,  9,  51, 59,  19,  -4, -1 },
213*4882a593Smuzhiyun 		{  0,  -4,  7,  49, 60,  21,  -3, -2 },
214*4882a593Smuzhiyun 		{  0,  -4,  6,  46, 61,  24,  -3, -2 },
215*4882a593Smuzhiyun 		{  0,  -4,  4,  43, 63,  27,  -3, -2 },
216*4882a593Smuzhiyun 		{  0,  -3,  2,  41, 63,  29,  -2, -2 },
217*4882a593Smuzhiyun 		{  0,  -3,  1,  38, 64,  32,  -1, -3 }
218*4882a593Smuzhiyun 	}, {	/* 131072 < Ratio <= 174762 (~8:3) */
219*4882a593Smuzhiyun 		{ -1,   8, 33,  48, 33,   8,  -1,  0 },
220*4882a593Smuzhiyun 		{ -1,   7, 31,  49, 35,   9,  -1, -1 },
221*4882a593Smuzhiyun 		{ -1,   6, 30,  49, 36,  10,  -1, -1 },
222*4882a593Smuzhiyun 		{ -1,   5, 28,  48, 38,  12,  -1, -1 },
223*4882a593Smuzhiyun 		{ -1,   4, 26,  48, 39,  13,   0, -1 },
224*4882a593Smuzhiyun 		{ -1,   3, 24,  47, 41,  15,   0, -1 },
225*4882a593Smuzhiyun 		{ -1,   2, 23,  47, 42,  16,   0, -1 },
226*4882a593Smuzhiyun 		{ -1,   2, 21,  45, 43,  18,   1, -1 },
227*4882a593Smuzhiyun 		{ -1,   1, 19,  45, 45,  19,   1, -1 },
228*4882a593Smuzhiyun 		{ -1,   1, 18,  43, 45,  21,   2, -1 },
229*4882a593Smuzhiyun 		{ -1,   0, 16,  42, 47,  23,   2, -1 },
230*4882a593Smuzhiyun 		{ -1,   0, 15,  41, 47,  24,   3, -1 },
231*4882a593Smuzhiyun 		{ -1,   0, 13,  39, 48,  26,   4, -1 },
232*4882a593Smuzhiyun 		{ -1,  -1, 12,  38, 48,  28,   5, -1 },
233*4882a593Smuzhiyun 		{ -1,  -1, 10,  36, 49,  30,   6, -1 },
234*4882a593Smuzhiyun 		{ -1,  -1,  9,  35, 49,  31,   7, -1 }
235*4882a593Smuzhiyun 	}, {	/* 174762 < Ratio <= 262144 (~8:2) */
236*4882a593Smuzhiyun 		{  2,  13, 30,  38, 30,  13,   2,  0 },
237*4882a593Smuzhiyun 		{  2,  12, 29,  38, 30,  14,   3,  0 },
238*4882a593Smuzhiyun 		{  2,  11, 28,  38, 31,  15,   3,  0 },
239*4882a593Smuzhiyun 		{  2,  10, 26,  38, 32,  16,   4,  0 },
240*4882a593Smuzhiyun 		{  1,  10, 26,  37, 33,  17,   4,  0 },
241*4882a593Smuzhiyun 		{  1,   9, 24,  37, 34,  18,   5,  0 },
242*4882a593Smuzhiyun 		{  1,   8, 24,  37, 34,  19,   5,  0 },
243*4882a593Smuzhiyun 		{  1,   7, 22,  36, 35,  20,   6,  1 },
244*4882a593Smuzhiyun 		{  1,   6, 21,  36, 36,  21,   6,  1 },
245*4882a593Smuzhiyun 		{  1,   6, 20,  35, 36,  22,   7,  1 },
246*4882a593Smuzhiyun 		{  0,   5, 19,  34, 37,  24,   8,  1 },
247*4882a593Smuzhiyun 		{  0,   5, 18,  34, 37,  24,   9,  1 },
248*4882a593Smuzhiyun 		{  0,   4, 17,  33, 37,  26,  10,  1 },
249*4882a593Smuzhiyun 		{  0,   4, 16,  32, 38,  26,  10,  2 },
250*4882a593Smuzhiyun 		{  0,   3, 15,  31, 38,  28,  11,  2 },
251*4882a593Smuzhiyun 		{  0,   3, 14,  30, 38,  29,  12,  2 }
252*4882a593Smuzhiyun 	}
253*4882a593Smuzhiyun };
254*4882a593Smuzhiyun 
255*4882a593Smuzhiyun /* 4-tap Filter Coefficient */
256*4882a593Smuzhiyun static const int v_coef_4t[GSC_COEF_RATIO][GSC_COEF_ATTR][GSC_COEF_V_4T] = {
257*4882a593Smuzhiyun 	{	/* Ratio <= 65536 (~8:8) */
258*4882a593Smuzhiyun 		{  0, 128,   0,  0 },
259*4882a593Smuzhiyun 		{ -4, 127,   5,  0 },
260*4882a593Smuzhiyun 		{ -6, 124,  11, -1 },
261*4882a593Smuzhiyun 		{ -8, 118,  19, -1 },
262*4882a593Smuzhiyun 		{ -8, 111,  27, -2 },
263*4882a593Smuzhiyun 		{ -8, 102,  37, -3 },
264*4882a593Smuzhiyun 		{ -8,  92,  48, -4 },
265*4882a593Smuzhiyun 		{ -7,  81,  59, -5 },
266*4882a593Smuzhiyun 		{ -6,  70,  70, -6 },
267*4882a593Smuzhiyun 		{ -5,  59,  81, -7 },
268*4882a593Smuzhiyun 		{ -4,  48,  92, -8 },
269*4882a593Smuzhiyun 		{ -3,  37, 102, -8 },
270*4882a593Smuzhiyun 		{ -2,  27, 111, -8 },
271*4882a593Smuzhiyun 		{ -1,  19, 118, -8 },
272*4882a593Smuzhiyun 		{ -1,  11, 124, -6 },
273*4882a593Smuzhiyun 		{  0,   5, 127, -4 }
274*4882a593Smuzhiyun 	}, {	/* 65536 < Ratio <= 74898 (~8:7) */
275*4882a593Smuzhiyun 		{  8, 112,   8,  0 },
276*4882a593Smuzhiyun 		{  4, 111,  14, -1 },
277*4882a593Smuzhiyun 		{  1, 109,  20, -2 },
278*4882a593Smuzhiyun 		{ -2, 105,  27, -2 },
279*4882a593Smuzhiyun 		{ -3, 100,  34, -3 },
280*4882a593Smuzhiyun 		{ -5,  93,  43, -3 },
281*4882a593Smuzhiyun 		{ -5,  86,  51, -4 },
282*4882a593Smuzhiyun 		{ -5,  77,  60, -4 },
283*4882a593Smuzhiyun 		{ -5,  69,  69, -5 },
284*4882a593Smuzhiyun 		{ -4,  60,  77, -5 },
285*4882a593Smuzhiyun 		{ -4,  51,  86, -5 },
286*4882a593Smuzhiyun 		{ -3,  43,  93, -5 },
287*4882a593Smuzhiyun 		{ -3,  34, 100, -3 },
288*4882a593Smuzhiyun 		{ -2,  27, 105, -2 },
289*4882a593Smuzhiyun 		{ -2,  20, 109,  1 },
290*4882a593Smuzhiyun 		{ -1,  14, 111,  4 }
291*4882a593Smuzhiyun 	}, {	/* 74898 < Ratio <= 87381 (~8:6) */
292*4882a593Smuzhiyun 		{ 16,  96,  16,  0 },
293*4882a593Smuzhiyun 		{ 12,  97,  21, -2 },
294*4882a593Smuzhiyun 		{  8,  96,  26, -2 },
295*4882a593Smuzhiyun 		{  5,  93,  32, -2 },
296*4882a593Smuzhiyun 		{  2,  89,  39, -2 },
297*4882a593Smuzhiyun 		{  0,  84,  46, -2 },
298*4882a593Smuzhiyun 		{ -1,  79,  53, -3 },
299*4882a593Smuzhiyun 		{ -2,  73,  59, -2 },
300*4882a593Smuzhiyun 		{ -2,  66,  66, -2 },
301*4882a593Smuzhiyun 		{ -2,  59,  73, -2 },
302*4882a593Smuzhiyun 		{ -3,  53,  79, -1 },
303*4882a593Smuzhiyun 		{ -2,  46,  84,  0 },
304*4882a593Smuzhiyun 		{ -2,  39,  89,  2 },
305*4882a593Smuzhiyun 		{ -2,  32,  93,  5 },
306*4882a593Smuzhiyun 		{ -2,  26,  96,  8 },
307*4882a593Smuzhiyun 		{ -2,  21,  97, 12 }
308*4882a593Smuzhiyun 	}, {	/* 87381 < Ratio <= 104857 (~8:5) */
309*4882a593Smuzhiyun 		{ 22,  84,  22,  0 },
310*4882a593Smuzhiyun 		{ 18,  85,  26, -1 },
311*4882a593Smuzhiyun 		{ 14,  84,  31, -1 },
312*4882a593Smuzhiyun 		{ 11,  82,  36, -1 },
313*4882a593Smuzhiyun 		{  8,  79,  42, -1 },
314*4882a593Smuzhiyun 		{  6,  76,  47, -1 },
315*4882a593Smuzhiyun 		{  4,  72,  52,  0 },
316*4882a593Smuzhiyun 		{  2,  68,  58,  0 },
317*4882a593Smuzhiyun 		{  1,  63,  63,  1 },
318*4882a593Smuzhiyun 		{  0,  58,  68,  2 },
319*4882a593Smuzhiyun 		{  0,  52,  72,  4 },
320*4882a593Smuzhiyun 		{ -1,  47,  76,  6 },
321*4882a593Smuzhiyun 		{ -1,  42,  79,  8 },
322*4882a593Smuzhiyun 		{ -1,  36,  82, 11 },
323*4882a593Smuzhiyun 		{ -1,  31,  84, 14 },
324*4882a593Smuzhiyun 		{ -1,  26,  85, 18 }
325*4882a593Smuzhiyun 	}, {	/* 104857 < Ratio <= 131072 (~8:4) */
326*4882a593Smuzhiyun 		{ 26,  76,  26,  0 },
327*4882a593Smuzhiyun 		{ 22,  76,  30,  0 },
328*4882a593Smuzhiyun 		{ 19,  75,  34,  0 },
329*4882a593Smuzhiyun 		{ 16,  73,  38,  1 },
330*4882a593Smuzhiyun 		{ 13,  71,  43,  1 },
331*4882a593Smuzhiyun 		{ 10,  69,  47,  2 },
332*4882a593Smuzhiyun 		{  8,  66,  51,  3 },
333*4882a593Smuzhiyun 		{  6,  63,  55,  4 },
334*4882a593Smuzhiyun 		{  5,  59,  59,  5 },
335*4882a593Smuzhiyun 		{  4,  55,  63,  6 },
336*4882a593Smuzhiyun 		{  3,  51,  66,  8 },
337*4882a593Smuzhiyun 		{  2,  47,  69, 10 },
338*4882a593Smuzhiyun 		{  1,  43,  71, 13 },
339*4882a593Smuzhiyun 		{  1,  38,  73, 16 },
340*4882a593Smuzhiyun 		{  0,  34,  75, 19 },
341*4882a593Smuzhiyun 		{  0,  30,  76, 22 }
342*4882a593Smuzhiyun 	}, {	/* 131072 < Ratio <= 174762 (~8:3) */
343*4882a593Smuzhiyun 		{ 29,  70,  29,  0 },
344*4882a593Smuzhiyun 		{ 26,  68,  32,  2 },
345*4882a593Smuzhiyun 		{ 23,  67,  36,  2 },
346*4882a593Smuzhiyun 		{ 20,  66,  39,  3 },
347*4882a593Smuzhiyun 		{ 17,  65,  43,  3 },
348*4882a593Smuzhiyun 		{ 15,  63,  46,  4 },
349*4882a593Smuzhiyun 		{ 12,  61,  50,  5 },
350*4882a593Smuzhiyun 		{ 10,  58,  53,  7 },
351*4882a593Smuzhiyun 		{  8,  56,  56,  8 },
352*4882a593Smuzhiyun 		{  7,  53,  58, 10 },
353*4882a593Smuzhiyun 		{  5,  50,  61, 12 },
354*4882a593Smuzhiyun 		{  4,  46,  63, 15 },
355*4882a593Smuzhiyun 		{  3,  43,  65, 17 },
356*4882a593Smuzhiyun 		{  3,  39,  66, 20 },
357*4882a593Smuzhiyun 		{  2,  36,  67, 23 },
358*4882a593Smuzhiyun 		{  2,  32,  68, 26 }
359*4882a593Smuzhiyun 	}, {	/* 174762 < Ratio <= 262144 (~8:2) */
360*4882a593Smuzhiyun 		{ 32,  64,  32,  0 },
361*4882a593Smuzhiyun 		{ 28,  63,  34,  3 },
362*4882a593Smuzhiyun 		{ 25,  62,  37,  4 },
363*4882a593Smuzhiyun 		{ 22,  62,  40,  4 },
364*4882a593Smuzhiyun 		{ 19,  61,  43,  5 },
365*4882a593Smuzhiyun 		{ 17,  59,  46,  6 },
366*4882a593Smuzhiyun 		{ 15,  58,  48,  7 },
367*4882a593Smuzhiyun 		{ 13,  55,  51,  9 },
368*4882a593Smuzhiyun 		{ 11,  53,  53, 11 },
369*4882a593Smuzhiyun 		{  9,  51,  55, 13 },
370*4882a593Smuzhiyun 		{  7,  48,  58, 15 },
371*4882a593Smuzhiyun 		{  6,  46,  59, 17 },
372*4882a593Smuzhiyun 		{  5,  43,  61, 19 },
373*4882a593Smuzhiyun 		{  4,  40,  62, 22 },
374*4882a593Smuzhiyun 		{  4,  37,  62, 25 },
375*4882a593Smuzhiyun 		{  3,  34,  63, 28 }
376*4882a593Smuzhiyun 	}
377*4882a593Smuzhiyun };
378*4882a593Smuzhiyun 
gsc_sw_reset(struct gsc_context * ctx)379*4882a593Smuzhiyun static int gsc_sw_reset(struct gsc_context *ctx)
380*4882a593Smuzhiyun {
381*4882a593Smuzhiyun 	u32 cfg;
382*4882a593Smuzhiyun 	int count = GSC_RESET_TIMEOUT;
383*4882a593Smuzhiyun 
384*4882a593Smuzhiyun 	/* s/w reset */
385*4882a593Smuzhiyun 	cfg = (GSC_SW_RESET_SRESET);
386*4882a593Smuzhiyun 	gsc_write(cfg, GSC_SW_RESET);
387*4882a593Smuzhiyun 
388*4882a593Smuzhiyun 	/* wait s/w reset complete */
389*4882a593Smuzhiyun 	while (count--) {
390*4882a593Smuzhiyun 		cfg = gsc_read(GSC_SW_RESET);
391*4882a593Smuzhiyun 		if (!cfg)
392*4882a593Smuzhiyun 			break;
393*4882a593Smuzhiyun 		usleep_range(1000, 2000);
394*4882a593Smuzhiyun 	}
395*4882a593Smuzhiyun 
396*4882a593Smuzhiyun 	if (cfg) {
397*4882a593Smuzhiyun 		DRM_DEV_ERROR(ctx->dev, "failed to reset gsc h/w.\n");
398*4882a593Smuzhiyun 		return -EBUSY;
399*4882a593Smuzhiyun 	}
400*4882a593Smuzhiyun 
401*4882a593Smuzhiyun 	/* reset sequence */
402*4882a593Smuzhiyun 	cfg = gsc_read(GSC_IN_BASE_ADDR_Y_MASK);
403*4882a593Smuzhiyun 	cfg |= (GSC_IN_BASE_ADDR_MASK |
404*4882a593Smuzhiyun 		GSC_IN_BASE_ADDR_PINGPONG(0));
405*4882a593Smuzhiyun 	gsc_write(cfg, GSC_IN_BASE_ADDR_Y_MASK);
406*4882a593Smuzhiyun 	gsc_write(cfg, GSC_IN_BASE_ADDR_CB_MASK);
407*4882a593Smuzhiyun 	gsc_write(cfg, GSC_IN_BASE_ADDR_CR_MASK);
408*4882a593Smuzhiyun 
409*4882a593Smuzhiyun 	cfg = gsc_read(GSC_OUT_BASE_ADDR_Y_MASK);
410*4882a593Smuzhiyun 	cfg |= (GSC_OUT_BASE_ADDR_MASK |
411*4882a593Smuzhiyun 		GSC_OUT_BASE_ADDR_PINGPONG(0));
412*4882a593Smuzhiyun 	gsc_write(cfg, GSC_OUT_BASE_ADDR_Y_MASK);
413*4882a593Smuzhiyun 	gsc_write(cfg, GSC_OUT_BASE_ADDR_CB_MASK);
414*4882a593Smuzhiyun 	gsc_write(cfg, GSC_OUT_BASE_ADDR_CR_MASK);
415*4882a593Smuzhiyun 
416*4882a593Smuzhiyun 	return 0;
417*4882a593Smuzhiyun }
418*4882a593Smuzhiyun 
gsc_handle_irq(struct gsc_context * ctx,bool enable,bool overflow,bool done)419*4882a593Smuzhiyun static void gsc_handle_irq(struct gsc_context *ctx, bool enable,
420*4882a593Smuzhiyun 		bool overflow, bool done)
421*4882a593Smuzhiyun {
422*4882a593Smuzhiyun 	u32 cfg;
423*4882a593Smuzhiyun 
424*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "enable[%d]overflow[%d]level[%d]\n",
425*4882a593Smuzhiyun 			  enable, overflow, done);
426*4882a593Smuzhiyun 
427*4882a593Smuzhiyun 	cfg = gsc_read(GSC_IRQ);
428*4882a593Smuzhiyun 	cfg |= (GSC_IRQ_OR_MASK | GSC_IRQ_FRMDONE_MASK);
429*4882a593Smuzhiyun 
430*4882a593Smuzhiyun 	if (enable)
431*4882a593Smuzhiyun 		cfg |= GSC_IRQ_ENABLE;
432*4882a593Smuzhiyun 	else
433*4882a593Smuzhiyun 		cfg &= ~GSC_IRQ_ENABLE;
434*4882a593Smuzhiyun 
435*4882a593Smuzhiyun 	if (overflow)
436*4882a593Smuzhiyun 		cfg &= ~GSC_IRQ_OR_MASK;
437*4882a593Smuzhiyun 	else
438*4882a593Smuzhiyun 		cfg |= GSC_IRQ_OR_MASK;
439*4882a593Smuzhiyun 
440*4882a593Smuzhiyun 	if (done)
441*4882a593Smuzhiyun 		cfg &= ~GSC_IRQ_FRMDONE_MASK;
442*4882a593Smuzhiyun 	else
443*4882a593Smuzhiyun 		cfg |= GSC_IRQ_FRMDONE_MASK;
444*4882a593Smuzhiyun 
445*4882a593Smuzhiyun 	gsc_write(cfg, GSC_IRQ);
446*4882a593Smuzhiyun }
447*4882a593Smuzhiyun 
448*4882a593Smuzhiyun 
gsc_src_set_fmt(struct gsc_context * ctx,u32 fmt,bool tiled)449*4882a593Smuzhiyun static void gsc_src_set_fmt(struct gsc_context *ctx, u32 fmt, bool tiled)
450*4882a593Smuzhiyun {
451*4882a593Smuzhiyun 	u32 cfg;
452*4882a593Smuzhiyun 
453*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "fmt[0x%x]\n", fmt);
454*4882a593Smuzhiyun 
455*4882a593Smuzhiyun 	cfg = gsc_read(GSC_IN_CON);
456*4882a593Smuzhiyun 	cfg &= ~(GSC_IN_RGB_TYPE_MASK | GSC_IN_YUV422_1P_ORDER_MASK |
457*4882a593Smuzhiyun 		 GSC_IN_CHROMA_ORDER_MASK | GSC_IN_FORMAT_MASK |
458*4882a593Smuzhiyun 		 GSC_IN_TILE_TYPE_MASK | GSC_IN_TILE_MODE |
459*4882a593Smuzhiyun 		 GSC_IN_CHROM_STRIDE_SEL_MASK | GSC_IN_RB_SWAP_MASK);
460*4882a593Smuzhiyun 
461*4882a593Smuzhiyun 	switch (fmt) {
462*4882a593Smuzhiyun 	case DRM_FORMAT_RGB565:
463*4882a593Smuzhiyun 		cfg |= GSC_IN_RGB565;
464*4882a593Smuzhiyun 		break;
465*4882a593Smuzhiyun 	case DRM_FORMAT_XRGB8888:
466*4882a593Smuzhiyun 	case DRM_FORMAT_ARGB8888:
467*4882a593Smuzhiyun 		cfg |= GSC_IN_XRGB8888;
468*4882a593Smuzhiyun 		break;
469*4882a593Smuzhiyun 	case DRM_FORMAT_BGRX8888:
470*4882a593Smuzhiyun 		cfg |= (GSC_IN_XRGB8888 | GSC_IN_RB_SWAP);
471*4882a593Smuzhiyun 		break;
472*4882a593Smuzhiyun 	case DRM_FORMAT_YUYV:
473*4882a593Smuzhiyun 		cfg |= (GSC_IN_YUV422_1P |
474*4882a593Smuzhiyun 			GSC_IN_YUV422_1P_ORDER_LSB_Y |
475*4882a593Smuzhiyun 			GSC_IN_CHROMA_ORDER_CBCR);
476*4882a593Smuzhiyun 		break;
477*4882a593Smuzhiyun 	case DRM_FORMAT_YVYU:
478*4882a593Smuzhiyun 		cfg |= (GSC_IN_YUV422_1P |
479*4882a593Smuzhiyun 			GSC_IN_YUV422_1P_ORDER_LSB_Y |
480*4882a593Smuzhiyun 			GSC_IN_CHROMA_ORDER_CRCB);
481*4882a593Smuzhiyun 		break;
482*4882a593Smuzhiyun 	case DRM_FORMAT_UYVY:
483*4882a593Smuzhiyun 		cfg |= (GSC_IN_YUV422_1P |
484*4882a593Smuzhiyun 			GSC_IN_YUV422_1P_OEDER_LSB_C |
485*4882a593Smuzhiyun 			GSC_IN_CHROMA_ORDER_CBCR);
486*4882a593Smuzhiyun 		break;
487*4882a593Smuzhiyun 	case DRM_FORMAT_VYUY:
488*4882a593Smuzhiyun 		cfg |= (GSC_IN_YUV422_1P |
489*4882a593Smuzhiyun 			GSC_IN_YUV422_1P_OEDER_LSB_C |
490*4882a593Smuzhiyun 			GSC_IN_CHROMA_ORDER_CRCB);
491*4882a593Smuzhiyun 		break;
492*4882a593Smuzhiyun 	case DRM_FORMAT_NV21:
493*4882a593Smuzhiyun 		cfg |= (GSC_IN_CHROMA_ORDER_CRCB | GSC_IN_YUV420_2P);
494*4882a593Smuzhiyun 		break;
495*4882a593Smuzhiyun 	case DRM_FORMAT_NV61:
496*4882a593Smuzhiyun 		cfg |= (GSC_IN_CHROMA_ORDER_CRCB | GSC_IN_YUV422_2P);
497*4882a593Smuzhiyun 		break;
498*4882a593Smuzhiyun 	case DRM_FORMAT_YUV422:
499*4882a593Smuzhiyun 		cfg |= GSC_IN_YUV422_3P;
500*4882a593Smuzhiyun 		break;
501*4882a593Smuzhiyun 	case DRM_FORMAT_YUV420:
502*4882a593Smuzhiyun 		cfg |= (GSC_IN_CHROMA_ORDER_CBCR | GSC_IN_YUV420_3P);
503*4882a593Smuzhiyun 		break;
504*4882a593Smuzhiyun 	case DRM_FORMAT_YVU420:
505*4882a593Smuzhiyun 		cfg |= (GSC_IN_CHROMA_ORDER_CRCB | GSC_IN_YUV420_3P);
506*4882a593Smuzhiyun 		break;
507*4882a593Smuzhiyun 	case DRM_FORMAT_NV12:
508*4882a593Smuzhiyun 		cfg |= (GSC_IN_CHROMA_ORDER_CBCR | GSC_IN_YUV420_2P);
509*4882a593Smuzhiyun 		break;
510*4882a593Smuzhiyun 	case DRM_FORMAT_NV16:
511*4882a593Smuzhiyun 		cfg |= (GSC_IN_CHROMA_ORDER_CBCR | GSC_IN_YUV422_2P);
512*4882a593Smuzhiyun 		break;
513*4882a593Smuzhiyun 	}
514*4882a593Smuzhiyun 
515*4882a593Smuzhiyun 	if (tiled)
516*4882a593Smuzhiyun 		cfg |= (GSC_IN_TILE_C_16x8 | GSC_IN_TILE_MODE);
517*4882a593Smuzhiyun 
518*4882a593Smuzhiyun 	gsc_write(cfg, GSC_IN_CON);
519*4882a593Smuzhiyun }
520*4882a593Smuzhiyun 
gsc_src_set_transf(struct gsc_context * ctx,unsigned int rotation)521*4882a593Smuzhiyun static void gsc_src_set_transf(struct gsc_context *ctx, unsigned int rotation)
522*4882a593Smuzhiyun {
523*4882a593Smuzhiyun 	unsigned int degree = rotation & DRM_MODE_ROTATE_MASK;
524*4882a593Smuzhiyun 	u32 cfg;
525*4882a593Smuzhiyun 
526*4882a593Smuzhiyun 	cfg = gsc_read(GSC_IN_CON);
527*4882a593Smuzhiyun 	cfg &= ~GSC_IN_ROT_MASK;
528*4882a593Smuzhiyun 
529*4882a593Smuzhiyun 	switch (degree) {
530*4882a593Smuzhiyun 	case DRM_MODE_ROTATE_0:
531*4882a593Smuzhiyun 		if (rotation & DRM_MODE_REFLECT_X)
532*4882a593Smuzhiyun 			cfg |= GSC_IN_ROT_XFLIP;
533*4882a593Smuzhiyun 		if (rotation & DRM_MODE_REFLECT_Y)
534*4882a593Smuzhiyun 			cfg |= GSC_IN_ROT_YFLIP;
535*4882a593Smuzhiyun 		break;
536*4882a593Smuzhiyun 	case DRM_MODE_ROTATE_90:
537*4882a593Smuzhiyun 		cfg |= GSC_IN_ROT_90;
538*4882a593Smuzhiyun 		if (rotation & DRM_MODE_REFLECT_X)
539*4882a593Smuzhiyun 			cfg |= GSC_IN_ROT_XFLIP;
540*4882a593Smuzhiyun 		if (rotation & DRM_MODE_REFLECT_Y)
541*4882a593Smuzhiyun 			cfg |= GSC_IN_ROT_YFLIP;
542*4882a593Smuzhiyun 		break;
543*4882a593Smuzhiyun 	case DRM_MODE_ROTATE_180:
544*4882a593Smuzhiyun 		cfg |= GSC_IN_ROT_180;
545*4882a593Smuzhiyun 		if (rotation & DRM_MODE_REFLECT_X)
546*4882a593Smuzhiyun 			cfg &= ~GSC_IN_ROT_XFLIP;
547*4882a593Smuzhiyun 		if (rotation & DRM_MODE_REFLECT_Y)
548*4882a593Smuzhiyun 			cfg &= ~GSC_IN_ROT_YFLIP;
549*4882a593Smuzhiyun 		break;
550*4882a593Smuzhiyun 	case DRM_MODE_ROTATE_270:
551*4882a593Smuzhiyun 		cfg |= GSC_IN_ROT_270;
552*4882a593Smuzhiyun 		if (rotation & DRM_MODE_REFLECT_X)
553*4882a593Smuzhiyun 			cfg &= ~GSC_IN_ROT_XFLIP;
554*4882a593Smuzhiyun 		if (rotation & DRM_MODE_REFLECT_Y)
555*4882a593Smuzhiyun 			cfg &= ~GSC_IN_ROT_YFLIP;
556*4882a593Smuzhiyun 		break;
557*4882a593Smuzhiyun 	}
558*4882a593Smuzhiyun 
559*4882a593Smuzhiyun 	gsc_write(cfg, GSC_IN_CON);
560*4882a593Smuzhiyun 
561*4882a593Smuzhiyun 	ctx->rotation = (cfg & GSC_IN_ROT_90) ? 1 : 0;
562*4882a593Smuzhiyun }
563*4882a593Smuzhiyun 
gsc_src_set_size(struct gsc_context * ctx,struct exynos_drm_ipp_buffer * buf)564*4882a593Smuzhiyun static void gsc_src_set_size(struct gsc_context *ctx,
565*4882a593Smuzhiyun 			     struct exynos_drm_ipp_buffer *buf)
566*4882a593Smuzhiyun {
567*4882a593Smuzhiyun 	struct gsc_scaler *sc = &ctx->sc;
568*4882a593Smuzhiyun 	u32 cfg;
569*4882a593Smuzhiyun 
570*4882a593Smuzhiyun 	/* pixel offset */
571*4882a593Smuzhiyun 	cfg = (GSC_SRCIMG_OFFSET_X(buf->rect.x) |
572*4882a593Smuzhiyun 		GSC_SRCIMG_OFFSET_Y(buf->rect.y));
573*4882a593Smuzhiyun 	gsc_write(cfg, GSC_SRCIMG_OFFSET);
574*4882a593Smuzhiyun 
575*4882a593Smuzhiyun 	/* cropped size */
576*4882a593Smuzhiyun 	cfg = (GSC_CROPPED_WIDTH(buf->rect.w) |
577*4882a593Smuzhiyun 		GSC_CROPPED_HEIGHT(buf->rect.h));
578*4882a593Smuzhiyun 	gsc_write(cfg, GSC_CROPPED_SIZE);
579*4882a593Smuzhiyun 
580*4882a593Smuzhiyun 	/* original size */
581*4882a593Smuzhiyun 	cfg = gsc_read(GSC_SRCIMG_SIZE);
582*4882a593Smuzhiyun 	cfg &= ~(GSC_SRCIMG_HEIGHT_MASK |
583*4882a593Smuzhiyun 		GSC_SRCIMG_WIDTH_MASK);
584*4882a593Smuzhiyun 
585*4882a593Smuzhiyun 	cfg |= (GSC_SRCIMG_WIDTH(buf->buf.pitch[0] / buf->format->cpp[0]) |
586*4882a593Smuzhiyun 		GSC_SRCIMG_HEIGHT(buf->buf.height));
587*4882a593Smuzhiyun 
588*4882a593Smuzhiyun 	gsc_write(cfg, GSC_SRCIMG_SIZE);
589*4882a593Smuzhiyun 
590*4882a593Smuzhiyun 	cfg = gsc_read(GSC_IN_CON);
591*4882a593Smuzhiyun 	cfg &= ~GSC_IN_RGB_TYPE_MASK;
592*4882a593Smuzhiyun 
593*4882a593Smuzhiyun 	if (buf->rect.w >= GSC_WIDTH_ITU_709)
594*4882a593Smuzhiyun 		if (sc->range)
595*4882a593Smuzhiyun 			cfg |= GSC_IN_RGB_HD_WIDE;
596*4882a593Smuzhiyun 		else
597*4882a593Smuzhiyun 			cfg |= GSC_IN_RGB_HD_NARROW;
598*4882a593Smuzhiyun 	else
599*4882a593Smuzhiyun 		if (sc->range)
600*4882a593Smuzhiyun 			cfg |= GSC_IN_RGB_SD_WIDE;
601*4882a593Smuzhiyun 		else
602*4882a593Smuzhiyun 			cfg |= GSC_IN_RGB_SD_NARROW;
603*4882a593Smuzhiyun 
604*4882a593Smuzhiyun 	gsc_write(cfg, GSC_IN_CON);
605*4882a593Smuzhiyun }
606*4882a593Smuzhiyun 
gsc_src_set_buf_seq(struct gsc_context * ctx,u32 buf_id,bool enqueue)607*4882a593Smuzhiyun static void gsc_src_set_buf_seq(struct gsc_context *ctx, u32 buf_id,
608*4882a593Smuzhiyun 			       bool enqueue)
609*4882a593Smuzhiyun {
610*4882a593Smuzhiyun 	bool masked = !enqueue;
611*4882a593Smuzhiyun 	u32 cfg;
612*4882a593Smuzhiyun 	u32 mask = 0x00000001 << buf_id;
613*4882a593Smuzhiyun 
614*4882a593Smuzhiyun 	/* mask register set */
615*4882a593Smuzhiyun 	cfg = gsc_read(GSC_IN_BASE_ADDR_Y_MASK);
616*4882a593Smuzhiyun 
617*4882a593Smuzhiyun 	/* sequence id */
618*4882a593Smuzhiyun 	cfg &= ~mask;
619*4882a593Smuzhiyun 	cfg |= masked << buf_id;
620*4882a593Smuzhiyun 	gsc_write(cfg, GSC_IN_BASE_ADDR_Y_MASK);
621*4882a593Smuzhiyun 	gsc_write(cfg, GSC_IN_BASE_ADDR_CB_MASK);
622*4882a593Smuzhiyun 	gsc_write(cfg, GSC_IN_BASE_ADDR_CR_MASK);
623*4882a593Smuzhiyun }
624*4882a593Smuzhiyun 
gsc_src_set_addr(struct gsc_context * ctx,u32 buf_id,struct exynos_drm_ipp_buffer * buf)625*4882a593Smuzhiyun static void gsc_src_set_addr(struct gsc_context *ctx, u32 buf_id,
626*4882a593Smuzhiyun 			    struct exynos_drm_ipp_buffer *buf)
627*4882a593Smuzhiyun {
628*4882a593Smuzhiyun 	/* address register set */
629*4882a593Smuzhiyun 	gsc_write(buf->dma_addr[0], GSC_IN_BASE_ADDR_Y(buf_id));
630*4882a593Smuzhiyun 	gsc_write(buf->dma_addr[1], GSC_IN_BASE_ADDR_CB(buf_id));
631*4882a593Smuzhiyun 	gsc_write(buf->dma_addr[2], GSC_IN_BASE_ADDR_CR(buf_id));
632*4882a593Smuzhiyun 
633*4882a593Smuzhiyun 	gsc_src_set_buf_seq(ctx, buf_id, true);
634*4882a593Smuzhiyun }
635*4882a593Smuzhiyun 
gsc_dst_set_fmt(struct gsc_context * ctx,u32 fmt,bool tiled)636*4882a593Smuzhiyun static void gsc_dst_set_fmt(struct gsc_context *ctx, u32 fmt, bool tiled)
637*4882a593Smuzhiyun {
638*4882a593Smuzhiyun 	u32 cfg;
639*4882a593Smuzhiyun 
640*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "fmt[0x%x]\n", fmt);
641*4882a593Smuzhiyun 
642*4882a593Smuzhiyun 	cfg = gsc_read(GSC_OUT_CON);
643*4882a593Smuzhiyun 	cfg &= ~(GSC_OUT_RGB_TYPE_MASK | GSC_OUT_YUV422_1P_ORDER_MASK |
644*4882a593Smuzhiyun 		 GSC_OUT_CHROMA_ORDER_MASK | GSC_OUT_FORMAT_MASK |
645*4882a593Smuzhiyun 		 GSC_OUT_CHROM_STRIDE_SEL_MASK | GSC_OUT_RB_SWAP_MASK |
646*4882a593Smuzhiyun 		 GSC_OUT_GLOBAL_ALPHA_MASK);
647*4882a593Smuzhiyun 
648*4882a593Smuzhiyun 	switch (fmt) {
649*4882a593Smuzhiyun 	case DRM_FORMAT_RGB565:
650*4882a593Smuzhiyun 		cfg |= GSC_OUT_RGB565;
651*4882a593Smuzhiyun 		break;
652*4882a593Smuzhiyun 	case DRM_FORMAT_ARGB8888:
653*4882a593Smuzhiyun 	case DRM_FORMAT_XRGB8888:
654*4882a593Smuzhiyun 		cfg |= (GSC_OUT_XRGB8888 | GSC_OUT_GLOBAL_ALPHA(0xff));
655*4882a593Smuzhiyun 		break;
656*4882a593Smuzhiyun 	case DRM_FORMAT_BGRX8888:
657*4882a593Smuzhiyun 		cfg |= (GSC_OUT_XRGB8888 | GSC_OUT_RB_SWAP);
658*4882a593Smuzhiyun 		break;
659*4882a593Smuzhiyun 	case DRM_FORMAT_YUYV:
660*4882a593Smuzhiyun 		cfg |= (GSC_OUT_YUV422_1P |
661*4882a593Smuzhiyun 			GSC_OUT_YUV422_1P_ORDER_LSB_Y |
662*4882a593Smuzhiyun 			GSC_OUT_CHROMA_ORDER_CBCR);
663*4882a593Smuzhiyun 		break;
664*4882a593Smuzhiyun 	case DRM_FORMAT_YVYU:
665*4882a593Smuzhiyun 		cfg |= (GSC_OUT_YUV422_1P |
666*4882a593Smuzhiyun 			GSC_OUT_YUV422_1P_ORDER_LSB_Y |
667*4882a593Smuzhiyun 			GSC_OUT_CHROMA_ORDER_CRCB);
668*4882a593Smuzhiyun 		break;
669*4882a593Smuzhiyun 	case DRM_FORMAT_UYVY:
670*4882a593Smuzhiyun 		cfg |= (GSC_OUT_YUV422_1P |
671*4882a593Smuzhiyun 			GSC_OUT_YUV422_1P_OEDER_LSB_C |
672*4882a593Smuzhiyun 			GSC_OUT_CHROMA_ORDER_CBCR);
673*4882a593Smuzhiyun 		break;
674*4882a593Smuzhiyun 	case DRM_FORMAT_VYUY:
675*4882a593Smuzhiyun 		cfg |= (GSC_OUT_YUV422_1P |
676*4882a593Smuzhiyun 			GSC_OUT_YUV422_1P_OEDER_LSB_C |
677*4882a593Smuzhiyun 			GSC_OUT_CHROMA_ORDER_CRCB);
678*4882a593Smuzhiyun 		break;
679*4882a593Smuzhiyun 	case DRM_FORMAT_NV21:
680*4882a593Smuzhiyun 		cfg |= (GSC_OUT_CHROMA_ORDER_CRCB | GSC_OUT_YUV420_2P);
681*4882a593Smuzhiyun 		break;
682*4882a593Smuzhiyun 	case DRM_FORMAT_NV61:
683*4882a593Smuzhiyun 		cfg |= (GSC_OUT_CHROMA_ORDER_CRCB | GSC_OUT_YUV422_2P);
684*4882a593Smuzhiyun 		break;
685*4882a593Smuzhiyun 	case DRM_FORMAT_YUV422:
686*4882a593Smuzhiyun 		cfg |= GSC_OUT_YUV422_3P;
687*4882a593Smuzhiyun 		break;
688*4882a593Smuzhiyun 	case DRM_FORMAT_YUV420:
689*4882a593Smuzhiyun 		cfg |= (GSC_OUT_CHROMA_ORDER_CBCR | GSC_OUT_YUV420_3P);
690*4882a593Smuzhiyun 		break;
691*4882a593Smuzhiyun 	case DRM_FORMAT_YVU420:
692*4882a593Smuzhiyun 		cfg |= (GSC_OUT_CHROMA_ORDER_CRCB | GSC_OUT_YUV420_3P);
693*4882a593Smuzhiyun 		break;
694*4882a593Smuzhiyun 	case DRM_FORMAT_NV12:
695*4882a593Smuzhiyun 		cfg |= (GSC_OUT_CHROMA_ORDER_CBCR | GSC_OUT_YUV420_2P);
696*4882a593Smuzhiyun 		break;
697*4882a593Smuzhiyun 	case DRM_FORMAT_NV16:
698*4882a593Smuzhiyun 		cfg |= (GSC_OUT_CHROMA_ORDER_CBCR | GSC_OUT_YUV422_2P);
699*4882a593Smuzhiyun 		break;
700*4882a593Smuzhiyun 	}
701*4882a593Smuzhiyun 
702*4882a593Smuzhiyun 	if (tiled)
703*4882a593Smuzhiyun 		cfg |= (GSC_IN_TILE_C_16x8 | GSC_OUT_TILE_MODE);
704*4882a593Smuzhiyun 
705*4882a593Smuzhiyun 	gsc_write(cfg, GSC_OUT_CON);
706*4882a593Smuzhiyun }
707*4882a593Smuzhiyun 
gsc_get_ratio_shift(struct gsc_context * ctx,u32 src,u32 dst,u32 * ratio)708*4882a593Smuzhiyun static int gsc_get_ratio_shift(struct gsc_context *ctx, u32 src, u32 dst,
709*4882a593Smuzhiyun 			       u32 *ratio)
710*4882a593Smuzhiyun {
711*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "src[%d]dst[%d]\n", src, dst);
712*4882a593Smuzhiyun 
713*4882a593Smuzhiyun 	if (src >= dst * 8) {
714*4882a593Smuzhiyun 		DRM_DEV_ERROR(ctx->dev, "failed to make ratio and shift.\n");
715*4882a593Smuzhiyun 		return -EINVAL;
716*4882a593Smuzhiyun 	} else if (src >= dst * 4)
717*4882a593Smuzhiyun 		*ratio = 4;
718*4882a593Smuzhiyun 	else if (src >= dst * 2)
719*4882a593Smuzhiyun 		*ratio = 2;
720*4882a593Smuzhiyun 	else
721*4882a593Smuzhiyun 		*ratio = 1;
722*4882a593Smuzhiyun 
723*4882a593Smuzhiyun 	return 0;
724*4882a593Smuzhiyun }
725*4882a593Smuzhiyun 
gsc_get_prescaler_shfactor(u32 hratio,u32 vratio,u32 * shfactor)726*4882a593Smuzhiyun static void gsc_get_prescaler_shfactor(u32 hratio, u32 vratio, u32 *shfactor)
727*4882a593Smuzhiyun {
728*4882a593Smuzhiyun 	if (hratio == 4 && vratio == 4)
729*4882a593Smuzhiyun 		*shfactor = 4;
730*4882a593Smuzhiyun 	else if ((hratio == 4 && vratio == 2) ||
731*4882a593Smuzhiyun 		 (hratio == 2 && vratio == 4))
732*4882a593Smuzhiyun 		*shfactor = 3;
733*4882a593Smuzhiyun 	else if ((hratio == 4 && vratio == 1) ||
734*4882a593Smuzhiyun 		 (hratio == 1 && vratio == 4) ||
735*4882a593Smuzhiyun 		 (hratio == 2 && vratio == 2))
736*4882a593Smuzhiyun 		*shfactor = 2;
737*4882a593Smuzhiyun 	else if (hratio == 1 && vratio == 1)
738*4882a593Smuzhiyun 		*shfactor = 0;
739*4882a593Smuzhiyun 	else
740*4882a593Smuzhiyun 		*shfactor = 1;
741*4882a593Smuzhiyun }
742*4882a593Smuzhiyun 
gsc_set_prescaler(struct gsc_context * ctx,struct gsc_scaler * sc,struct drm_exynos_ipp_task_rect * src,struct drm_exynos_ipp_task_rect * dst)743*4882a593Smuzhiyun static int gsc_set_prescaler(struct gsc_context *ctx, struct gsc_scaler *sc,
744*4882a593Smuzhiyun 			     struct drm_exynos_ipp_task_rect *src,
745*4882a593Smuzhiyun 			     struct drm_exynos_ipp_task_rect *dst)
746*4882a593Smuzhiyun {
747*4882a593Smuzhiyun 	u32 cfg;
748*4882a593Smuzhiyun 	u32 src_w, src_h, dst_w, dst_h;
749*4882a593Smuzhiyun 	int ret = 0;
750*4882a593Smuzhiyun 
751*4882a593Smuzhiyun 	src_w = src->w;
752*4882a593Smuzhiyun 	src_h = src->h;
753*4882a593Smuzhiyun 
754*4882a593Smuzhiyun 	if (ctx->rotation) {
755*4882a593Smuzhiyun 		dst_w = dst->h;
756*4882a593Smuzhiyun 		dst_h = dst->w;
757*4882a593Smuzhiyun 	} else {
758*4882a593Smuzhiyun 		dst_w = dst->w;
759*4882a593Smuzhiyun 		dst_h = dst->h;
760*4882a593Smuzhiyun 	}
761*4882a593Smuzhiyun 
762*4882a593Smuzhiyun 	ret = gsc_get_ratio_shift(ctx, src_w, dst_w, &sc->pre_hratio);
763*4882a593Smuzhiyun 	if (ret) {
764*4882a593Smuzhiyun 		DRM_DEV_ERROR(ctx->dev, "failed to get ratio horizontal.\n");
765*4882a593Smuzhiyun 		return ret;
766*4882a593Smuzhiyun 	}
767*4882a593Smuzhiyun 
768*4882a593Smuzhiyun 	ret = gsc_get_ratio_shift(ctx, src_h, dst_h, &sc->pre_vratio);
769*4882a593Smuzhiyun 	if (ret) {
770*4882a593Smuzhiyun 		DRM_DEV_ERROR(ctx->dev, "failed to get ratio vertical.\n");
771*4882a593Smuzhiyun 		return ret;
772*4882a593Smuzhiyun 	}
773*4882a593Smuzhiyun 
774*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "pre_hratio[%d]pre_vratio[%d]\n",
775*4882a593Smuzhiyun 			  sc->pre_hratio, sc->pre_vratio);
776*4882a593Smuzhiyun 
777*4882a593Smuzhiyun 	sc->main_hratio = (src_w << 16) / dst_w;
778*4882a593Smuzhiyun 	sc->main_vratio = (src_h << 16) / dst_h;
779*4882a593Smuzhiyun 
780*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "main_hratio[%ld]main_vratio[%ld]\n",
781*4882a593Smuzhiyun 			  sc->main_hratio, sc->main_vratio);
782*4882a593Smuzhiyun 
783*4882a593Smuzhiyun 	gsc_get_prescaler_shfactor(sc->pre_hratio, sc->pre_vratio,
784*4882a593Smuzhiyun 		&sc->pre_shfactor);
785*4882a593Smuzhiyun 
786*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "pre_shfactor[%d]\n", sc->pre_shfactor);
787*4882a593Smuzhiyun 
788*4882a593Smuzhiyun 	cfg = (GSC_PRESC_SHFACTOR(sc->pre_shfactor) |
789*4882a593Smuzhiyun 		GSC_PRESC_H_RATIO(sc->pre_hratio) |
790*4882a593Smuzhiyun 		GSC_PRESC_V_RATIO(sc->pre_vratio));
791*4882a593Smuzhiyun 	gsc_write(cfg, GSC_PRE_SCALE_RATIO);
792*4882a593Smuzhiyun 
793*4882a593Smuzhiyun 	return ret;
794*4882a593Smuzhiyun }
795*4882a593Smuzhiyun 
gsc_set_h_coef(struct gsc_context * ctx,unsigned long main_hratio)796*4882a593Smuzhiyun static void gsc_set_h_coef(struct gsc_context *ctx, unsigned long main_hratio)
797*4882a593Smuzhiyun {
798*4882a593Smuzhiyun 	int i, j, k, sc_ratio;
799*4882a593Smuzhiyun 
800*4882a593Smuzhiyun 	if (main_hratio <= GSC_SC_UP_MAX_RATIO)
801*4882a593Smuzhiyun 		sc_ratio = 0;
802*4882a593Smuzhiyun 	else if (main_hratio <= GSC_SC_DOWN_RATIO_7_8)
803*4882a593Smuzhiyun 		sc_ratio = 1;
804*4882a593Smuzhiyun 	else if (main_hratio <= GSC_SC_DOWN_RATIO_6_8)
805*4882a593Smuzhiyun 		sc_ratio = 2;
806*4882a593Smuzhiyun 	else if (main_hratio <= GSC_SC_DOWN_RATIO_5_8)
807*4882a593Smuzhiyun 		sc_ratio = 3;
808*4882a593Smuzhiyun 	else if (main_hratio <= GSC_SC_DOWN_RATIO_4_8)
809*4882a593Smuzhiyun 		sc_ratio = 4;
810*4882a593Smuzhiyun 	else if (main_hratio <= GSC_SC_DOWN_RATIO_3_8)
811*4882a593Smuzhiyun 		sc_ratio = 5;
812*4882a593Smuzhiyun 	else
813*4882a593Smuzhiyun 		sc_ratio = 6;
814*4882a593Smuzhiyun 
815*4882a593Smuzhiyun 	for (i = 0; i < GSC_COEF_PHASE; i++)
816*4882a593Smuzhiyun 		for (j = 0; j < GSC_COEF_H_8T; j++)
817*4882a593Smuzhiyun 			for (k = 0; k < GSC_COEF_DEPTH; k++)
818*4882a593Smuzhiyun 				gsc_write(h_coef_8t[sc_ratio][i][j],
819*4882a593Smuzhiyun 					GSC_HCOEF(i, j, k));
820*4882a593Smuzhiyun }
821*4882a593Smuzhiyun 
gsc_set_v_coef(struct gsc_context * ctx,unsigned long main_vratio)822*4882a593Smuzhiyun static void gsc_set_v_coef(struct gsc_context *ctx, unsigned long main_vratio)
823*4882a593Smuzhiyun {
824*4882a593Smuzhiyun 	int i, j, k, sc_ratio;
825*4882a593Smuzhiyun 
826*4882a593Smuzhiyun 	if (main_vratio <= GSC_SC_UP_MAX_RATIO)
827*4882a593Smuzhiyun 		sc_ratio = 0;
828*4882a593Smuzhiyun 	else if (main_vratio <= GSC_SC_DOWN_RATIO_7_8)
829*4882a593Smuzhiyun 		sc_ratio = 1;
830*4882a593Smuzhiyun 	else if (main_vratio <= GSC_SC_DOWN_RATIO_6_8)
831*4882a593Smuzhiyun 		sc_ratio = 2;
832*4882a593Smuzhiyun 	else if (main_vratio <= GSC_SC_DOWN_RATIO_5_8)
833*4882a593Smuzhiyun 		sc_ratio = 3;
834*4882a593Smuzhiyun 	else if (main_vratio <= GSC_SC_DOWN_RATIO_4_8)
835*4882a593Smuzhiyun 		sc_ratio = 4;
836*4882a593Smuzhiyun 	else if (main_vratio <= GSC_SC_DOWN_RATIO_3_8)
837*4882a593Smuzhiyun 		sc_ratio = 5;
838*4882a593Smuzhiyun 	else
839*4882a593Smuzhiyun 		sc_ratio = 6;
840*4882a593Smuzhiyun 
841*4882a593Smuzhiyun 	for (i = 0; i < GSC_COEF_PHASE; i++)
842*4882a593Smuzhiyun 		for (j = 0; j < GSC_COEF_V_4T; j++)
843*4882a593Smuzhiyun 			for (k = 0; k < GSC_COEF_DEPTH; k++)
844*4882a593Smuzhiyun 				gsc_write(v_coef_4t[sc_ratio][i][j],
845*4882a593Smuzhiyun 					GSC_VCOEF(i, j, k));
846*4882a593Smuzhiyun }
847*4882a593Smuzhiyun 
gsc_set_scaler(struct gsc_context * ctx,struct gsc_scaler * sc)848*4882a593Smuzhiyun static void gsc_set_scaler(struct gsc_context *ctx, struct gsc_scaler *sc)
849*4882a593Smuzhiyun {
850*4882a593Smuzhiyun 	u32 cfg;
851*4882a593Smuzhiyun 
852*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "main_hratio[%ld]main_vratio[%ld]\n",
853*4882a593Smuzhiyun 			  sc->main_hratio, sc->main_vratio);
854*4882a593Smuzhiyun 
855*4882a593Smuzhiyun 	gsc_set_h_coef(ctx, sc->main_hratio);
856*4882a593Smuzhiyun 	cfg = GSC_MAIN_H_RATIO_VALUE(sc->main_hratio);
857*4882a593Smuzhiyun 	gsc_write(cfg, GSC_MAIN_H_RATIO);
858*4882a593Smuzhiyun 
859*4882a593Smuzhiyun 	gsc_set_v_coef(ctx, sc->main_vratio);
860*4882a593Smuzhiyun 	cfg = GSC_MAIN_V_RATIO_VALUE(sc->main_vratio);
861*4882a593Smuzhiyun 	gsc_write(cfg, GSC_MAIN_V_RATIO);
862*4882a593Smuzhiyun }
863*4882a593Smuzhiyun 
gsc_dst_set_size(struct gsc_context * ctx,struct exynos_drm_ipp_buffer * buf)864*4882a593Smuzhiyun static void gsc_dst_set_size(struct gsc_context *ctx,
865*4882a593Smuzhiyun 			     struct exynos_drm_ipp_buffer *buf)
866*4882a593Smuzhiyun {
867*4882a593Smuzhiyun 	struct gsc_scaler *sc = &ctx->sc;
868*4882a593Smuzhiyun 	u32 cfg;
869*4882a593Smuzhiyun 
870*4882a593Smuzhiyun 	/* pixel offset */
871*4882a593Smuzhiyun 	cfg = (GSC_DSTIMG_OFFSET_X(buf->rect.x) |
872*4882a593Smuzhiyun 		GSC_DSTIMG_OFFSET_Y(buf->rect.y));
873*4882a593Smuzhiyun 	gsc_write(cfg, GSC_DSTIMG_OFFSET);
874*4882a593Smuzhiyun 
875*4882a593Smuzhiyun 	/* scaled size */
876*4882a593Smuzhiyun 	if (ctx->rotation)
877*4882a593Smuzhiyun 		cfg = (GSC_SCALED_WIDTH(buf->rect.h) |
878*4882a593Smuzhiyun 		       GSC_SCALED_HEIGHT(buf->rect.w));
879*4882a593Smuzhiyun 	else
880*4882a593Smuzhiyun 		cfg = (GSC_SCALED_WIDTH(buf->rect.w) |
881*4882a593Smuzhiyun 		       GSC_SCALED_HEIGHT(buf->rect.h));
882*4882a593Smuzhiyun 	gsc_write(cfg, GSC_SCALED_SIZE);
883*4882a593Smuzhiyun 
884*4882a593Smuzhiyun 	/* original size */
885*4882a593Smuzhiyun 	cfg = gsc_read(GSC_DSTIMG_SIZE);
886*4882a593Smuzhiyun 	cfg &= ~(GSC_DSTIMG_HEIGHT_MASK | GSC_DSTIMG_WIDTH_MASK);
887*4882a593Smuzhiyun 	cfg |= GSC_DSTIMG_WIDTH(buf->buf.pitch[0] / buf->format->cpp[0]) |
888*4882a593Smuzhiyun 	       GSC_DSTIMG_HEIGHT(buf->buf.height);
889*4882a593Smuzhiyun 	gsc_write(cfg, GSC_DSTIMG_SIZE);
890*4882a593Smuzhiyun 
891*4882a593Smuzhiyun 	cfg = gsc_read(GSC_OUT_CON);
892*4882a593Smuzhiyun 	cfg &= ~GSC_OUT_RGB_TYPE_MASK;
893*4882a593Smuzhiyun 
894*4882a593Smuzhiyun 	if (buf->rect.w >= GSC_WIDTH_ITU_709)
895*4882a593Smuzhiyun 		if (sc->range)
896*4882a593Smuzhiyun 			cfg |= GSC_OUT_RGB_HD_WIDE;
897*4882a593Smuzhiyun 		else
898*4882a593Smuzhiyun 			cfg |= GSC_OUT_RGB_HD_NARROW;
899*4882a593Smuzhiyun 	else
900*4882a593Smuzhiyun 		if (sc->range)
901*4882a593Smuzhiyun 			cfg |= GSC_OUT_RGB_SD_WIDE;
902*4882a593Smuzhiyun 		else
903*4882a593Smuzhiyun 			cfg |= GSC_OUT_RGB_SD_NARROW;
904*4882a593Smuzhiyun 
905*4882a593Smuzhiyun 	gsc_write(cfg, GSC_OUT_CON);
906*4882a593Smuzhiyun }
907*4882a593Smuzhiyun 
gsc_dst_get_buf_seq(struct gsc_context * ctx)908*4882a593Smuzhiyun static int gsc_dst_get_buf_seq(struct gsc_context *ctx)
909*4882a593Smuzhiyun {
910*4882a593Smuzhiyun 	u32 cfg, i, buf_num = GSC_REG_SZ;
911*4882a593Smuzhiyun 	u32 mask = 0x00000001;
912*4882a593Smuzhiyun 
913*4882a593Smuzhiyun 	cfg = gsc_read(GSC_OUT_BASE_ADDR_Y_MASK);
914*4882a593Smuzhiyun 
915*4882a593Smuzhiyun 	for (i = 0; i < GSC_REG_SZ; i++)
916*4882a593Smuzhiyun 		if (cfg & (mask << i))
917*4882a593Smuzhiyun 			buf_num--;
918*4882a593Smuzhiyun 
919*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "buf_num[%d]\n", buf_num);
920*4882a593Smuzhiyun 
921*4882a593Smuzhiyun 	return buf_num;
922*4882a593Smuzhiyun }
923*4882a593Smuzhiyun 
gsc_dst_set_buf_seq(struct gsc_context * ctx,u32 buf_id,bool enqueue)924*4882a593Smuzhiyun static void gsc_dst_set_buf_seq(struct gsc_context *ctx, u32 buf_id,
925*4882a593Smuzhiyun 				bool enqueue)
926*4882a593Smuzhiyun {
927*4882a593Smuzhiyun 	bool masked = !enqueue;
928*4882a593Smuzhiyun 	u32 cfg;
929*4882a593Smuzhiyun 	u32 mask = 0x00000001 << buf_id;
930*4882a593Smuzhiyun 
931*4882a593Smuzhiyun 	/* mask register set */
932*4882a593Smuzhiyun 	cfg = gsc_read(GSC_OUT_BASE_ADDR_Y_MASK);
933*4882a593Smuzhiyun 
934*4882a593Smuzhiyun 	/* sequence id */
935*4882a593Smuzhiyun 	cfg &= ~mask;
936*4882a593Smuzhiyun 	cfg |= masked << buf_id;
937*4882a593Smuzhiyun 	gsc_write(cfg, GSC_OUT_BASE_ADDR_Y_MASK);
938*4882a593Smuzhiyun 	gsc_write(cfg, GSC_OUT_BASE_ADDR_CB_MASK);
939*4882a593Smuzhiyun 	gsc_write(cfg, GSC_OUT_BASE_ADDR_CR_MASK);
940*4882a593Smuzhiyun 
941*4882a593Smuzhiyun 	/* interrupt enable */
942*4882a593Smuzhiyun 	if (enqueue && gsc_dst_get_buf_seq(ctx) >= GSC_BUF_START)
943*4882a593Smuzhiyun 		gsc_handle_irq(ctx, true, false, true);
944*4882a593Smuzhiyun 
945*4882a593Smuzhiyun 	/* interrupt disable */
946*4882a593Smuzhiyun 	if (!enqueue && gsc_dst_get_buf_seq(ctx) <= GSC_BUF_STOP)
947*4882a593Smuzhiyun 		gsc_handle_irq(ctx, false, false, true);
948*4882a593Smuzhiyun }
949*4882a593Smuzhiyun 
gsc_dst_set_addr(struct gsc_context * ctx,u32 buf_id,struct exynos_drm_ipp_buffer * buf)950*4882a593Smuzhiyun static void gsc_dst_set_addr(struct gsc_context *ctx,
951*4882a593Smuzhiyun 			     u32 buf_id, struct exynos_drm_ipp_buffer *buf)
952*4882a593Smuzhiyun {
953*4882a593Smuzhiyun 	/* address register set */
954*4882a593Smuzhiyun 	gsc_write(buf->dma_addr[0], GSC_OUT_BASE_ADDR_Y(buf_id));
955*4882a593Smuzhiyun 	gsc_write(buf->dma_addr[1], GSC_OUT_BASE_ADDR_CB(buf_id));
956*4882a593Smuzhiyun 	gsc_write(buf->dma_addr[2], GSC_OUT_BASE_ADDR_CR(buf_id));
957*4882a593Smuzhiyun 
958*4882a593Smuzhiyun 	gsc_dst_set_buf_seq(ctx, buf_id, true);
959*4882a593Smuzhiyun }
960*4882a593Smuzhiyun 
gsc_get_src_buf_index(struct gsc_context * ctx)961*4882a593Smuzhiyun static int gsc_get_src_buf_index(struct gsc_context *ctx)
962*4882a593Smuzhiyun {
963*4882a593Smuzhiyun 	u32 cfg, curr_index, i;
964*4882a593Smuzhiyun 	u32 buf_id = GSC_MAX_SRC;
965*4882a593Smuzhiyun 
966*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "gsc id[%d]\n", ctx->id);
967*4882a593Smuzhiyun 
968*4882a593Smuzhiyun 	cfg = gsc_read(GSC_IN_BASE_ADDR_Y_MASK);
969*4882a593Smuzhiyun 	curr_index = GSC_IN_CURR_GET_INDEX(cfg);
970*4882a593Smuzhiyun 
971*4882a593Smuzhiyun 	for (i = curr_index; i < GSC_MAX_SRC; i++) {
972*4882a593Smuzhiyun 		if (!((cfg >> i) & 0x1)) {
973*4882a593Smuzhiyun 			buf_id = i;
974*4882a593Smuzhiyun 			break;
975*4882a593Smuzhiyun 		}
976*4882a593Smuzhiyun 	}
977*4882a593Smuzhiyun 
978*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "cfg[0x%x]curr_index[%d]buf_id[%d]\n", cfg,
979*4882a593Smuzhiyun 			  curr_index, buf_id);
980*4882a593Smuzhiyun 
981*4882a593Smuzhiyun 	if (buf_id == GSC_MAX_SRC) {
982*4882a593Smuzhiyun 		DRM_DEV_ERROR(ctx->dev, "failed to get in buffer index.\n");
983*4882a593Smuzhiyun 		return -EINVAL;
984*4882a593Smuzhiyun 	}
985*4882a593Smuzhiyun 
986*4882a593Smuzhiyun 	gsc_src_set_buf_seq(ctx, buf_id, false);
987*4882a593Smuzhiyun 
988*4882a593Smuzhiyun 	return buf_id;
989*4882a593Smuzhiyun }
990*4882a593Smuzhiyun 
gsc_get_dst_buf_index(struct gsc_context * ctx)991*4882a593Smuzhiyun static int gsc_get_dst_buf_index(struct gsc_context *ctx)
992*4882a593Smuzhiyun {
993*4882a593Smuzhiyun 	u32 cfg, curr_index, i;
994*4882a593Smuzhiyun 	u32 buf_id = GSC_MAX_DST;
995*4882a593Smuzhiyun 
996*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "gsc id[%d]\n", ctx->id);
997*4882a593Smuzhiyun 
998*4882a593Smuzhiyun 	cfg = gsc_read(GSC_OUT_BASE_ADDR_Y_MASK);
999*4882a593Smuzhiyun 	curr_index = GSC_OUT_CURR_GET_INDEX(cfg);
1000*4882a593Smuzhiyun 
1001*4882a593Smuzhiyun 	for (i = curr_index; i < GSC_MAX_DST; i++) {
1002*4882a593Smuzhiyun 		if (!((cfg >> i) & 0x1)) {
1003*4882a593Smuzhiyun 			buf_id = i;
1004*4882a593Smuzhiyun 			break;
1005*4882a593Smuzhiyun 		}
1006*4882a593Smuzhiyun 	}
1007*4882a593Smuzhiyun 
1008*4882a593Smuzhiyun 	if (buf_id == GSC_MAX_DST) {
1009*4882a593Smuzhiyun 		DRM_DEV_ERROR(ctx->dev, "failed to get out buffer index.\n");
1010*4882a593Smuzhiyun 		return -EINVAL;
1011*4882a593Smuzhiyun 	}
1012*4882a593Smuzhiyun 
1013*4882a593Smuzhiyun 	gsc_dst_set_buf_seq(ctx, buf_id, false);
1014*4882a593Smuzhiyun 
1015*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "cfg[0x%x]curr_index[%d]buf_id[%d]\n", cfg,
1016*4882a593Smuzhiyun 			  curr_index, buf_id);
1017*4882a593Smuzhiyun 
1018*4882a593Smuzhiyun 	return buf_id;
1019*4882a593Smuzhiyun }
1020*4882a593Smuzhiyun 
gsc_irq_handler(int irq,void * dev_id)1021*4882a593Smuzhiyun static irqreturn_t gsc_irq_handler(int irq, void *dev_id)
1022*4882a593Smuzhiyun {
1023*4882a593Smuzhiyun 	struct gsc_context *ctx = dev_id;
1024*4882a593Smuzhiyun 	u32 status;
1025*4882a593Smuzhiyun 	int err = 0;
1026*4882a593Smuzhiyun 
1027*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(ctx->dev, "gsc id[%d]\n", ctx->id);
1028*4882a593Smuzhiyun 
1029*4882a593Smuzhiyun 	status = gsc_read(GSC_IRQ);
1030*4882a593Smuzhiyun 	if (status & GSC_IRQ_STATUS_OR_IRQ) {
1031*4882a593Smuzhiyun 		dev_err(ctx->dev, "occurred overflow at %d, status 0x%x.\n",
1032*4882a593Smuzhiyun 			ctx->id, status);
1033*4882a593Smuzhiyun 		err = -EINVAL;
1034*4882a593Smuzhiyun 	}
1035*4882a593Smuzhiyun 
1036*4882a593Smuzhiyun 	if (status & GSC_IRQ_STATUS_OR_FRM_DONE) {
1037*4882a593Smuzhiyun 		int src_buf_id, dst_buf_id;
1038*4882a593Smuzhiyun 
1039*4882a593Smuzhiyun 		dev_dbg(ctx->dev, "occurred frame done at %d, status 0x%x.\n",
1040*4882a593Smuzhiyun 			ctx->id, status);
1041*4882a593Smuzhiyun 
1042*4882a593Smuzhiyun 		src_buf_id = gsc_get_src_buf_index(ctx);
1043*4882a593Smuzhiyun 		dst_buf_id = gsc_get_dst_buf_index(ctx);
1044*4882a593Smuzhiyun 
1045*4882a593Smuzhiyun 		DRM_DEV_DEBUG_KMS(ctx->dev, "buf_id_src[%d]buf_id_dst[%d]\n",
1046*4882a593Smuzhiyun 				  src_buf_id, dst_buf_id);
1047*4882a593Smuzhiyun 
1048*4882a593Smuzhiyun 		if (src_buf_id < 0 || dst_buf_id < 0)
1049*4882a593Smuzhiyun 			err = -EINVAL;
1050*4882a593Smuzhiyun 	}
1051*4882a593Smuzhiyun 
1052*4882a593Smuzhiyun 	if (ctx->task) {
1053*4882a593Smuzhiyun 		struct exynos_drm_ipp_task *task = ctx->task;
1054*4882a593Smuzhiyun 
1055*4882a593Smuzhiyun 		ctx->task = NULL;
1056*4882a593Smuzhiyun 		pm_runtime_mark_last_busy(ctx->dev);
1057*4882a593Smuzhiyun 		pm_runtime_put_autosuspend(ctx->dev);
1058*4882a593Smuzhiyun 		exynos_drm_ipp_task_done(task, err);
1059*4882a593Smuzhiyun 	}
1060*4882a593Smuzhiyun 
1061*4882a593Smuzhiyun 	return IRQ_HANDLED;
1062*4882a593Smuzhiyun }
1063*4882a593Smuzhiyun 
gsc_reset(struct gsc_context * ctx)1064*4882a593Smuzhiyun static int gsc_reset(struct gsc_context *ctx)
1065*4882a593Smuzhiyun {
1066*4882a593Smuzhiyun 	struct gsc_scaler *sc = &ctx->sc;
1067*4882a593Smuzhiyun 	int ret;
1068*4882a593Smuzhiyun 
1069*4882a593Smuzhiyun 	/* reset h/w block */
1070*4882a593Smuzhiyun 	ret = gsc_sw_reset(ctx);
1071*4882a593Smuzhiyun 	if (ret < 0) {
1072*4882a593Smuzhiyun 		dev_err(ctx->dev, "failed to reset hardware.\n");
1073*4882a593Smuzhiyun 		return ret;
1074*4882a593Smuzhiyun 	}
1075*4882a593Smuzhiyun 
1076*4882a593Smuzhiyun 	/* scaler setting */
1077*4882a593Smuzhiyun 	memset(&ctx->sc, 0x0, sizeof(ctx->sc));
1078*4882a593Smuzhiyun 	sc->range = true;
1079*4882a593Smuzhiyun 
1080*4882a593Smuzhiyun 	return 0;
1081*4882a593Smuzhiyun }
1082*4882a593Smuzhiyun 
gsc_start(struct gsc_context * ctx)1083*4882a593Smuzhiyun static void gsc_start(struct gsc_context *ctx)
1084*4882a593Smuzhiyun {
1085*4882a593Smuzhiyun 	u32 cfg;
1086*4882a593Smuzhiyun 
1087*4882a593Smuzhiyun 	gsc_handle_irq(ctx, true, false, true);
1088*4882a593Smuzhiyun 
1089*4882a593Smuzhiyun 	/* enable one shot */
1090*4882a593Smuzhiyun 	cfg = gsc_read(GSC_ENABLE);
1091*4882a593Smuzhiyun 	cfg &= ~(GSC_ENABLE_ON_CLEAR_MASK |
1092*4882a593Smuzhiyun 		GSC_ENABLE_CLK_GATE_MODE_MASK);
1093*4882a593Smuzhiyun 	cfg |= GSC_ENABLE_ON_CLEAR_ONESHOT;
1094*4882a593Smuzhiyun 	gsc_write(cfg, GSC_ENABLE);
1095*4882a593Smuzhiyun 
1096*4882a593Smuzhiyun 	/* src dma memory */
1097*4882a593Smuzhiyun 	cfg = gsc_read(GSC_IN_CON);
1098*4882a593Smuzhiyun 	cfg &= ~(GSC_IN_PATH_MASK | GSC_IN_LOCAL_SEL_MASK);
1099*4882a593Smuzhiyun 	cfg |= GSC_IN_PATH_MEMORY;
1100*4882a593Smuzhiyun 	gsc_write(cfg, GSC_IN_CON);
1101*4882a593Smuzhiyun 
1102*4882a593Smuzhiyun 	/* dst dma memory */
1103*4882a593Smuzhiyun 	cfg = gsc_read(GSC_OUT_CON);
1104*4882a593Smuzhiyun 	cfg |= GSC_OUT_PATH_MEMORY;
1105*4882a593Smuzhiyun 	gsc_write(cfg, GSC_OUT_CON);
1106*4882a593Smuzhiyun 
1107*4882a593Smuzhiyun 	gsc_set_scaler(ctx, &ctx->sc);
1108*4882a593Smuzhiyun 
1109*4882a593Smuzhiyun 	cfg = gsc_read(GSC_ENABLE);
1110*4882a593Smuzhiyun 	cfg |= GSC_ENABLE_ON;
1111*4882a593Smuzhiyun 	gsc_write(cfg, GSC_ENABLE);
1112*4882a593Smuzhiyun }
1113*4882a593Smuzhiyun 
gsc_commit(struct exynos_drm_ipp * ipp,struct exynos_drm_ipp_task * task)1114*4882a593Smuzhiyun static int gsc_commit(struct exynos_drm_ipp *ipp,
1115*4882a593Smuzhiyun 			  struct exynos_drm_ipp_task *task)
1116*4882a593Smuzhiyun {
1117*4882a593Smuzhiyun 	struct gsc_context *ctx = container_of(ipp, struct gsc_context, ipp);
1118*4882a593Smuzhiyun 	int ret;
1119*4882a593Smuzhiyun 
1120*4882a593Smuzhiyun 	pm_runtime_get_sync(ctx->dev);
1121*4882a593Smuzhiyun 	ctx->task = task;
1122*4882a593Smuzhiyun 
1123*4882a593Smuzhiyun 	ret = gsc_reset(ctx);
1124*4882a593Smuzhiyun 	if (ret) {
1125*4882a593Smuzhiyun 		pm_runtime_put_autosuspend(ctx->dev);
1126*4882a593Smuzhiyun 		ctx->task = NULL;
1127*4882a593Smuzhiyun 		return ret;
1128*4882a593Smuzhiyun 	}
1129*4882a593Smuzhiyun 
1130*4882a593Smuzhiyun 	gsc_src_set_fmt(ctx, task->src.buf.fourcc, task->src.buf.modifier);
1131*4882a593Smuzhiyun 	gsc_src_set_transf(ctx, task->transform.rotation);
1132*4882a593Smuzhiyun 	gsc_src_set_size(ctx, &task->src);
1133*4882a593Smuzhiyun 	gsc_src_set_addr(ctx, 0, &task->src);
1134*4882a593Smuzhiyun 	gsc_dst_set_fmt(ctx, task->dst.buf.fourcc, task->dst.buf.modifier);
1135*4882a593Smuzhiyun 	gsc_dst_set_size(ctx, &task->dst);
1136*4882a593Smuzhiyun 	gsc_dst_set_addr(ctx, 0, &task->dst);
1137*4882a593Smuzhiyun 	gsc_set_prescaler(ctx, &ctx->sc, &task->src.rect, &task->dst.rect);
1138*4882a593Smuzhiyun 	gsc_start(ctx);
1139*4882a593Smuzhiyun 
1140*4882a593Smuzhiyun 	return 0;
1141*4882a593Smuzhiyun }
1142*4882a593Smuzhiyun 
gsc_abort(struct exynos_drm_ipp * ipp,struct exynos_drm_ipp_task * task)1143*4882a593Smuzhiyun static void gsc_abort(struct exynos_drm_ipp *ipp,
1144*4882a593Smuzhiyun 			  struct exynos_drm_ipp_task *task)
1145*4882a593Smuzhiyun {
1146*4882a593Smuzhiyun 	struct gsc_context *ctx =
1147*4882a593Smuzhiyun 			container_of(ipp, struct gsc_context, ipp);
1148*4882a593Smuzhiyun 
1149*4882a593Smuzhiyun 	gsc_reset(ctx);
1150*4882a593Smuzhiyun 	if (ctx->task) {
1151*4882a593Smuzhiyun 		struct exynos_drm_ipp_task *task = ctx->task;
1152*4882a593Smuzhiyun 
1153*4882a593Smuzhiyun 		ctx->task = NULL;
1154*4882a593Smuzhiyun 		pm_runtime_mark_last_busy(ctx->dev);
1155*4882a593Smuzhiyun 		pm_runtime_put_autosuspend(ctx->dev);
1156*4882a593Smuzhiyun 		exynos_drm_ipp_task_done(task, -EIO);
1157*4882a593Smuzhiyun 	}
1158*4882a593Smuzhiyun }
1159*4882a593Smuzhiyun 
1160*4882a593Smuzhiyun static struct exynos_drm_ipp_funcs ipp_funcs = {
1161*4882a593Smuzhiyun 	.commit = gsc_commit,
1162*4882a593Smuzhiyun 	.abort = gsc_abort,
1163*4882a593Smuzhiyun };
1164*4882a593Smuzhiyun 
gsc_bind(struct device * dev,struct device * master,void * data)1165*4882a593Smuzhiyun static int gsc_bind(struct device *dev, struct device *master, void *data)
1166*4882a593Smuzhiyun {
1167*4882a593Smuzhiyun 	struct gsc_context *ctx = dev_get_drvdata(dev);
1168*4882a593Smuzhiyun 	struct drm_device *drm_dev = data;
1169*4882a593Smuzhiyun 	struct exynos_drm_ipp *ipp = &ctx->ipp;
1170*4882a593Smuzhiyun 
1171*4882a593Smuzhiyun 	ctx->drm_dev = drm_dev;
1172*4882a593Smuzhiyun 	ctx->drm_dev = drm_dev;
1173*4882a593Smuzhiyun 	exynos_drm_register_dma(drm_dev, dev, &ctx->dma_priv);
1174*4882a593Smuzhiyun 
1175*4882a593Smuzhiyun 	exynos_drm_ipp_register(dev, ipp, &ipp_funcs,
1176*4882a593Smuzhiyun 			DRM_EXYNOS_IPP_CAP_CROP | DRM_EXYNOS_IPP_CAP_ROTATE |
1177*4882a593Smuzhiyun 			DRM_EXYNOS_IPP_CAP_SCALE | DRM_EXYNOS_IPP_CAP_CONVERT,
1178*4882a593Smuzhiyun 			ctx->formats, ctx->num_formats, "gsc");
1179*4882a593Smuzhiyun 
1180*4882a593Smuzhiyun 	dev_info(dev, "The exynos gscaler has been probed successfully\n");
1181*4882a593Smuzhiyun 
1182*4882a593Smuzhiyun 	return 0;
1183*4882a593Smuzhiyun }
1184*4882a593Smuzhiyun 
gsc_unbind(struct device * dev,struct device * master,void * data)1185*4882a593Smuzhiyun static void gsc_unbind(struct device *dev, struct device *master,
1186*4882a593Smuzhiyun 			void *data)
1187*4882a593Smuzhiyun {
1188*4882a593Smuzhiyun 	struct gsc_context *ctx = dev_get_drvdata(dev);
1189*4882a593Smuzhiyun 	struct drm_device *drm_dev = data;
1190*4882a593Smuzhiyun 	struct exynos_drm_ipp *ipp = &ctx->ipp;
1191*4882a593Smuzhiyun 
1192*4882a593Smuzhiyun 	exynos_drm_ipp_unregister(dev, ipp);
1193*4882a593Smuzhiyun 	exynos_drm_unregister_dma(drm_dev, dev, &ctx->dma_priv);
1194*4882a593Smuzhiyun }
1195*4882a593Smuzhiyun 
1196*4882a593Smuzhiyun static const struct component_ops gsc_component_ops = {
1197*4882a593Smuzhiyun 	.bind	= gsc_bind,
1198*4882a593Smuzhiyun 	.unbind = gsc_unbind,
1199*4882a593Smuzhiyun };
1200*4882a593Smuzhiyun 
1201*4882a593Smuzhiyun static const unsigned int gsc_formats[] = {
1202*4882a593Smuzhiyun 	DRM_FORMAT_ARGB8888,
1203*4882a593Smuzhiyun 	DRM_FORMAT_XRGB8888, DRM_FORMAT_RGB565, DRM_FORMAT_BGRX8888,
1204*4882a593Smuzhiyun 	DRM_FORMAT_NV12, DRM_FORMAT_NV16, DRM_FORMAT_NV21, DRM_FORMAT_NV61,
1205*4882a593Smuzhiyun 	DRM_FORMAT_UYVY, DRM_FORMAT_VYUY, DRM_FORMAT_YUYV, DRM_FORMAT_YVYU,
1206*4882a593Smuzhiyun 	DRM_FORMAT_YUV420, DRM_FORMAT_YVU420, DRM_FORMAT_YUV422,
1207*4882a593Smuzhiyun };
1208*4882a593Smuzhiyun 
1209*4882a593Smuzhiyun static const unsigned int gsc_tiled_formats[] = {
1210*4882a593Smuzhiyun 	DRM_FORMAT_NV12, DRM_FORMAT_NV21,
1211*4882a593Smuzhiyun };
1212*4882a593Smuzhiyun 
gsc_probe(struct platform_device * pdev)1213*4882a593Smuzhiyun static int gsc_probe(struct platform_device *pdev)
1214*4882a593Smuzhiyun {
1215*4882a593Smuzhiyun 	struct device *dev = &pdev->dev;
1216*4882a593Smuzhiyun 	struct gsc_driverdata *driver_data;
1217*4882a593Smuzhiyun 	struct exynos_drm_ipp_formats *formats;
1218*4882a593Smuzhiyun 	struct gsc_context *ctx;
1219*4882a593Smuzhiyun 	struct resource *res;
1220*4882a593Smuzhiyun 	int num_formats, ret, i, j;
1221*4882a593Smuzhiyun 
1222*4882a593Smuzhiyun 	ctx = devm_kzalloc(dev, sizeof(*ctx), GFP_KERNEL);
1223*4882a593Smuzhiyun 	if (!ctx)
1224*4882a593Smuzhiyun 		return -ENOMEM;
1225*4882a593Smuzhiyun 
1226*4882a593Smuzhiyun 	driver_data = (struct gsc_driverdata *)of_device_get_match_data(dev);
1227*4882a593Smuzhiyun 	ctx->dev = dev;
1228*4882a593Smuzhiyun 	ctx->num_clocks = driver_data->num_clocks;
1229*4882a593Smuzhiyun 	ctx->clk_names = driver_data->clk_names;
1230*4882a593Smuzhiyun 
1231*4882a593Smuzhiyun 	/* construct formats/limits array */
1232*4882a593Smuzhiyun 	num_formats = ARRAY_SIZE(gsc_formats) + ARRAY_SIZE(gsc_tiled_formats);
1233*4882a593Smuzhiyun 	formats = devm_kcalloc(dev, num_formats, sizeof(*formats), GFP_KERNEL);
1234*4882a593Smuzhiyun 	if (!formats)
1235*4882a593Smuzhiyun 		return -ENOMEM;
1236*4882a593Smuzhiyun 
1237*4882a593Smuzhiyun 	/* linear formats */
1238*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(gsc_formats); i++) {
1239*4882a593Smuzhiyun 		formats[i].fourcc = gsc_formats[i];
1240*4882a593Smuzhiyun 		formats[i].type = DRM_EXYNOS_IPP_FORMAT_SOURCE |
1241*4882a593Smuzhiyun 				  DRM_EXYNOS_IPP_FORMAT_DESTINATION;
1242*4882a593Smuzhiyun 		formats[i].limits = driver_data->limits;
1243*4882a593Smuzhiyun 		formats[i].num_limits = driver_data->num_limits;
1244*4882a593Smuzhiyun 	}
1245*4882a593Smuzhiyun 
1246*4882a593Smuzhiyun 	/* tiled formats */
1247*4882a593Smuzhiyun 	for (j = i, i = 0; i < ARRAY_SIZE(gsc_tiled_formats); j++, i++) {
1248*4882a593Smuzhiyun 		formats[j].fourcc = gsc_tiled_formats[i];
1249*4882a593Smuzhiyun 		formats[j].modifier = DRM_FORMAT_MOD_SAMSUNG_16_16_TILE;
1250*4882a593Smuzhiyun 		formats[j].type = DRM_EXYNOS_IPP_FORMAT_SOURCE |
1251*4882a593Smuzhiyun 				  DRM_EXYNOS_IPP_FORMAT_DESTINATION;
1252*4882a593Smuzhiyun 		formats[j].limits = driver_data->limits;
1253*4882a593Smuzhiyun 		formats[j].num_limits = driver_data->num_limits;
1254*4882a593Smuzhiyun 	}
1255*4882a593Smuzhiyun 
1256*4882a593Smuzhiyun 	ctx->formats = formats;
1257*4882a593Smuzhiyun 	ctx->num_formats = num_formats;
1258*4882a593Smuzhiyun 
1259*4882a593Smuzhiyun 	/* clock control */
1260*4882a593Smuzhiyun 	for (i = 0; i < ctx->num_clocks; i++) {
1261*4882a593Smuzhiyun 		ctx->clocks[i] = devm_clk_get(dev, ctx->clk_names[i]);
1262*4882a593Smuzhiyun 		if (IS_ERR(ctx->clocks[i])) {
1263*4882a593Smuzhiyun 			dev_err(dev, "failed to get clock: %s\n",
1264*4882a593Smuzhiyun 				ctx->clk_names[i]);
1265*4882a593Smuzhiyun 			return PTR_ERR(ctx->clocks[i]);
1266*4882a593Smuzhiyun 		}
1267*4882a593Smuzhiyun 	}
1268*4882a593Smuzhiyun 
1269*4882a593Smuzhiyun 	/* resource memory */
1270*4882a593Smuzhiyun 	ctx->regs_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1271*4882a593Smuzhiyun 	ctx->regs = devm_ioremap_resource(dev, ctx->regs_res);
1272*4882a593Smuzhiyun 	if (IS_ERR(ctx->regs))
1273*4882a593Smuzhiyun 		return PTR_ERR(ctx->regs);
1274*4882a593Smuzhiyun 
1275*4882a593Smuzhiyun 	/* resource irq */
1276*4882a593Smuzhiyun 	res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
1277*4882a593Smuzhiyun 	if (!res) {
1278*4882a593Smuzhiyun 		dev_err(dev, "failed to request irq resource.\n");
1279*4882a593Smuzhiyun 		return -ENOENT;
1280*4882a593Smuzhiyun 	}
1281*4882a593Smuzhiyun 
1282*4882a593Smuzhiyun 	ctx->irq = res->start;
1283*4882a593Smuzhiyun 	ret = devm_request_irq(dev, ctx->irq, gsc_irq_handler, 0,
1284*4882a593Smuzhiyun 			       dev_name(dev), ctx);
1285*4882a593Smuzhiyun 	if (ret < 0) {
1286*4882a593Smuzhiyun 		dev_err(dev, "failed to request irq.\n");
1287*4882a593Smuzhiyun 		return ret;
1288*4882a593Smuzhiyun 	}
1289*4882a593Smuzhiyun 
1290*4882a593Smuzhiyun 	/* context initailization */
1291*4882a593Smuzhiyun 	ctx->id = pdev->id;
1292*4882a593Smuzhiyun 
1293*4882a593Smuzhiyun 	platform_set_drvdata(pdev, ctx);
1294*4882a593Smuzhiyun 
1295*4882a593Smuzhiyun 	pm_runtime_use_autosuspend(dev);
1296*4882a593Smuzhiyun 	pm_runtime_set_autosuspend_delay(dev, GSC_AUTOSUSPEND_DELAY);
1297*4882a593Smuzhiyun 	pm_runtime_enable(dev);
1298*4882a593Smuzhiyun 
1299*4882a593Smuzhiyun 	ret = component_add(dev, &gsc_component_ops);
1300*4882a593Smuzhiyun 	if (ret)
1301*4882a593Smuzhiyun 		goto err_pm_dis;
1302*4882a593Smuzhiyun 
1303*4882a593Smuzhiyun 	dev_info(dev, "drm gsc registered successfully.\n");
1304*4882a593Smuzhiyun 
1305*4882a593Smuzhiyun 	return 0;
1306*4882a593Smuzhiyun 
1307*4882a593Smuzhiyun err_pm_dis:
1308*4882a593Smuzhiyun 	pm_runtime_dont_use_autosuspend(dev);
1309*4882a593Smuzhiyun 	pm_runtime_disable(dev);
1310*4882a593Smuzhiyun 	return ret;
1311*4882a593Smuzhiyun }
1312*4882a593Smuzhiyun 
gsc_remove(struct platform_device * pdev)1313*4882a593Smuzhiyun static int gsc_remove(struct platform_device *pdev)
1314*4882a593Smuzhiyun {
1315*4882a593Smuzhiyun 	struct device *dev = &pdev->dev;
1316*4882a593Smuzhiyun 
1317*4882a593Smuzhiyun 	component_del(dev, &gsc_component_ops);
1318*4882a593Smuzhiyun 	pm_runtime_dont_use_autosuspend(dev);
1319*4882a593Smuzhiyun 	pm_runtime_disable(dev);
1320*4882a593Smuzhiyun 
1321*4882a593Smuzhiyun 	return 0;
1322*4882a593Smuzhiyun }
1323*4882a593Smuzhiyun 
gsc_runtime_suspend(struct device * dev)1324*4882a593Smuzhiyun static int __maybe_unused gsc_runtime_suspend(struct device *dev)
1325*4882a593Smuzhiyun {
1326*4882a593Smuzhiyun 	struct gsc_context *ctx = get_gsc_context(dev);
1327*4882a593Smuzhiyun 	int i;
1328*4882a593Smuzhiyun 
1329*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(dev, "id[%d]\n", ctx->id);
1330*4882a593Smuzhiyun 
1331*4882a593Smuzhiyun 	for (i = ctx->num_clocks - 1; i >= 0; i--)
1332*4882a593Smuzhiyun 		clk_disable_unprepare(ctx->clocks[i]);
1333*4882a593Smuzhiyun 
1334*4882a593Smuzhiyun 	return 0;
1335*4882a593Smuzhiyun }
1336*4882a593Smuzhiyun 
gsc_runtime_resume(struct device * dev)1337*4882a593Smuzhiyun static int __maybe_unused gsc_runtime_resume(struct device *dev)
1338*4882a593Smuzhiyun {
1339*4882a593Smuzhiyun 	struct gsc_context *ctx = get_gsc_context(dev);
1340*4882a593Smuzhiyun 	int i, ret;
1341*4882a593Smuzhiyun 
1342*4882a593Smuzhiyun 	DRM_DEV_DEBUG_KMS(dev, "id[%d]\n", ctx->id);
1343*4882a593Smuzhiyun 
1344*4882a593Smuzhiyun 	for (i = 0; i < ctx->num_clocks; i++) {
1345*4882a593Smuzhiyun 		ret = clk_prepare_enable(ctx->clocks[i]);
1346*4882a593Smuzhiyun 		if (ret) {
1347*4882a593Smuzhiyun 			while (--i > 0)
1348*4882a593Smuzhiyun 				clk_disable_unprepare(ctx->clocks[i]);
1349*4882a593Smuzhiyun 			return ret;
1350*4882a593Smuzhiyun 		}
1351*4882a593Smuzhiyun 	}
1352*4882a593Smuzhiyun 	return 0;
1353*4882a593Smuzhiyun }
1354*4882a593Smuzhiyun 
1355*4882a593Smuzhiyun static const struct dev_pm_ops gsc_pm_ops = {
1356*4882a593Smuzhiyun 	SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
1357*4882a593Smuzhiyun 				pm_runtime_force_resume)
1358*4882a593Smuzhiyun 	SET_RUNTIME_PM_OPS(gsc_runtime_suspend, gsc_runtime_resume, NULL)
1359*4882a593Smuzhiyun };
1360*4882a593Smuzhiyun 
1361*4882a593Smuzhiyun static const struct drm_exynos_ipp_limit gsc_5250_limits[] = {
1362*4882a593Smuzhiyun 	{ IPP_SIZE_LIMIT(BUFFER, .h = { 32, 4800, 8 }, .v = { 16, 3344, 8 }) },
1363*4882a593Smuzhiyun 	{ IPP_SIZE_LIMIT(AREA, .h = { 16, 4800, 2 }, .v = { 8, 3344, 2 }) },
1364*4882a593Smuzhiyun 	{ IPP_SIZE_LIMIT(ROTATED, .h = { 32, 2048 }, .v = { 16, 2048 }) },
1365*4882a593Smuzhiyun 	{ IPP_SCALE_LIMIT(.h = { (1 << 16) / 16, (1 << 16) * 8 },
1366*4882a593Smuzhiyun 			  .v = { (1 << 16) / 16, (1 << 16) * 8 }) },
1367*4882a593Smuzhiyun };
1368*4882a593Smuzhiyun 
1369*4882a593Smuzhiyun static const struct drm_exynos_ipp_limit gsc_5420_limits[] = {
1370*4882a593Smuzhiyun 	{ IPP_SIZE_LIMIT(BUFFER, .h = { 32, 4800, 8 }, .v = { 16, 3344, 8 }) },
1371*4882a593Smuzhiyun 	{ IPP_SIZE_LIMIT(AREA, .h = { 16, 4800, 2 }, .v = { 8, 3344, 2 }) },
1372*4882a593Smuzhiyun 	{ IPP_SIZE_LIMIT(ROTATED, .h = { 16, 2016 }, .v = { 8, 2016 }) },
1373*4882a593Smuzhiyun 	{ IPP_SCALE_LIMIT(.h = { (1 << 16) / 16, (1 << 16) * 8 },
1374*4882a593Smuzhiyun 			  .v = { (1 << 16) / 16, (1 << 16) * 8 }) },
1375*4882a593Smuzhiyun };
1376*4882a593Smuzhiyun 
1377*4882a593Smuzhiyun static const struct drm_exynos_ipp_limit gsc_5433_limits[] = {
1378*4882a593Smuzhiyun 	{ IPP_SIZE_LIMIT(BUFFER, .h = { 32, 8191, 16 }, .v = { 16, 8191, 2 }) },
1379*4882a593Smuzhiyun 	{ IPP_SIZE_LIMIT(AREA, .h = { 16, 4800, 1 }, .v = { 8, 3344, 1 }) },
1380*4882a593Smuzhiyun 	{ IPP_SIZE_LIMIT(ROTATED, .h = { 32, 2047 }, .v = { 8, 8191 }) },
1381*4882a593Smuzhiyun 	{ IPP_SCALE_LIMIT(.h = { (1 << 16) / 16, (1 << 16) * 8 },
1382*4882a593Smuzhiyun 			  .v = { (1 << 16) / 16, (1 << 16) * 8 }) },
1383*4882a593Smuzhiyun };
1384*4882a593Smuzhiyun 
1385*4882a593Smuzhiyun static struct gsc_driverdata gsc_exynos5250_drvdata = {
1386*4882a593Smuzhiyun 	.clk_names = {"gscl"},
1387*4882a593Smuzhiyun 	.num_clocks = 1,
1388*4882a593Smuzhiyun 	.limits = gsc_5250_limits,
1389*4882a593Smuzhiyun 	.num_limits = ARRAY_SIZE(gsc_5250_limits),
1390*4882a593Smuzhiyun };
1391*4882a593Smuzhiyun 
1392*4882a593Smuzhiyun static struct gsc_driverdata gsc_exynos5420_drvdata = {
1393*4882a593Smuzhiyun 	.clk_names = {"gscl"},
1394*4882a593Smuzhiyun 	.num_clocks = 1,
1395*4882a593Smuzhiyun 	.limits = gsc_5420_limits,
1396*4882a593Smuzhiyun 	.num_limits = ARRAY_SIZE(gsc_5420_limits),
1397*4882a593Smuzhiyun };
1398*4882a593Smuzhiyun 
1399*4882a593Smuzhiyun static struct gsc_driverdata gsc_exynos5433_drvdata = {
1400*4882a593Smuzhiyun 	.clk_names = {"pclk", "aclk", "aclk_xiu", "aclk_gsclbend"},
1401*4882a593Smuzhiyun 	.num_clocks = 4,
1402*4882a593Smuzhiyun 	.limits = gsc_5433_limits,
1403*4882a593Smuzhiyun 	.num_limits = ARRAY_SIZE(gsc_5433_limits),
1404*4882a593Smuzhiyun };
1405*4882a593Smuzhiyun 
1406*4882a593Smuzhiyun static const struct of_device_id exynos_drm_gsc_of_match[] = {
1407*4882a593Smuzhiyun 	{
1408*4882a593Smuzhiyun 		.compatible = "samsung,exynos5-gsc",
1409*4882a593Smuzhiyun 		.data = &gsc_exynos5250_drvdata,
1410*4882a593Smuzhiyun 	}, {
1411*4882a593Smuzhiyun 		.compatible = "samsung,exynos5250-gsc",
1412*4882a593Smuzhiyun 		.data = &gsc_exynos5250_drvdata,
1413*4882a593Smuzhiyun 	}, {
1414*4882a593Smuzhiyun 		.compatible = "samsung,exynos5420-gsc",
1415*4882a593Smuzhiyun 		.data = &gsc_exynos5420_drvdata,
1416*4882a593Smuzhiyun 	}, {
1417*4882a593Smuzhiyun 		.compatible = "samsung,exynos5433-gsc",
1418*4882a593Smuzhiyun 		.data = &gsc_exynos5433_drvdata,
1419*4882a593Smuzhiyun 	}, {
1420*4882a593Smuzhiyun 	},
1421*4882a593Smuzhiyun };
1422*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, exynos_drm_gsc_of_match);
1423*4882a593Smuzhiyun 
1424*4882a593Smuzhiyun struct platform_driver gsc_driver = {
1425*4882a593Smuzhiyun 	.probe		= gsc_probe,
1426*4882a593Smuzhiyun 	.remove		= gsc_remove,
1427*4882a593Smuzhiyun 	.driver		= {
1428*4882a593Smuzhiyun 		.name	= "exynos-drm-gsc",
1429*4882a593Smuzhiyun 		.owner	= THIS_MODULE,
1430*4882a593Smuzhiyun 		.pm	= &gsc_pm_ops,
1431*4882a593Smuzhiyun 		.of_match_table = of_match_ptr(exynos_drm_gsc_of_match),
1432*4882a593Smuzhiyun 	},
1433*4882a593Smuzhiyun };
1434