xref: /rk3399_rockchip-uboot/drivers/video/fsl_dcu_fb.c (revision 3fea95369850987de15a2a0ac009d05e13b90246)
1327def50SWang Huan /*
2327def50SWang Huan  * Copyright 2014 Freescale Semiconductor, Inc.
3327def50SWang Huan  *
4327def50SWang Huan  * FSL DCU Framebuffer driver
5327def50SWang Huan  *
6327def50SWang Huan  * SPDX-License-Identifier:	GPL-2.0+
7327def50SWang Huan  */
8327def50SWang Huan 
9327def50SWang Huan #include <asm/io.h>
10327def50SWang Huan #include <common.h>
1177810e63SStefan Agner #include <fdt_support.h>
12327def50SWang Huan #include <fsl_dcu_fb.h>
13327def50SWang Huan #include <linux/fb.h>
14327def50SWang Huan #include <malloc.h>
15327def50SWang Huan #include <video_fb.h>
16327def50SWang Huan #include "videomodes.h"
17327def50SWang Huan 
18327def50SWang Huan /* Convert the X,Y resolution pair into a single number */
19327def50SWang Huan #define RESOLUTION(x, y) (((u32)(x) << 16) | (y))
20327def50SWang Huan 
21327def50SWang Huan #ifdef CONFIG_SYS_FSL_DCU_LE
22327def50SWang Huan #define	dcu_read32	in_le32
23327def50SWang Huan #define	dcu_write32	out_le32
24327def50SWang Huan #elif defined(CONFIG_SYS_FSL_DCU_BE)
25327def50SWang Huan #define	dcu_read32	in_be32
26327def50SWang Huan #define	dcu_write32	out_be32
27327def50SWang Huan #endif
28327def50SWang Huan 
29327def50SWang Huan #define DCU_MODE_BLEND_ITER(x)          ((x) << 20)
30327def50SWang Huan #define DCU_MODE_RASTER_EN		(1 << 14)
31327def50SWang Huan #define DCU_MODE_NORMAL			1
32327def50SWang Huan #define DCU_MODE_COLORBAR               3
33327def50SWang Huan #define DCU_BGND_R(x)			((x) << 16)
34327def50SWang Huan #define DCU_BGND_G(x)			((x) << 8)
35327def50SWang Huan #define DCU_BGND_B(x)			(x)
36327def50SWang Huan #define DCU_DISP_SIZE_DELTA_Y(x)	((x) << 16)
37327def50SWang Huan #define DCU_DISP_SIZE_DELTA_X(x)	(x)
38327def50SWang Huan #define DCU_HSYN_PARA_BP(x)		((x) << 22)
39327def50SWang Huan #define DCU_HSYN_PARA_PW(x)		((x) << 11)
40327def50SWang Huan #define DCU_HSYN_PARA_FP(x)		(x)
41327def50SWang Huan #define DCU_VSYN_PARA_BP(x)		((x) << 22)
42327def50SWang Huan #define DCU_VSYN_PARA_PW(x)		((x) << 11)
43327def50SWang Huan #define DCU_VSYN_PARA_FP(x)		(x)
4432f26f56SStefan Agner #define DCU_SYN_POL_INV_PXCK_FALL	(1 << 6)
45327def50SWang Huan #define DCU_SYN_POL_NEG_REMAIN		(0 << 5)
46327def50SWang Huan #define DCU_SYN_POL_INV_VS_LOW		(1 << 1)
47327def50SWang Huan #define DCU_SYN_POL_INV_HS_LOW		(1)
48327def50SWang Huan #define DCU_THRESHOLD_LS_BF_VS(x)	((x) << 16)
49327def50SWang Huan #define DCU_THRESHOLD_OUT_BUF_HIGH(x)	((x) << 8)
50327def50SWang Huan #define DCU_THRESHOLD_OUT_BUF_LOW(x)	(x)
51327def50SWang Huan #define DCU_UPDATE_MODE_MODE            (1 << 31)
52327def50SWang Huan #define DCU_UPDATE_MODE_READREG         (1 << 30)
53327def50SWang Huan 
54327def50SWang Huan #define DCU_CTRLDESCLN_1_HEIGHT(x)	((x) << 16)
55327def50SWang Huan #define DCU_CTRLDESCLN_1_WIDTH(x)	(x)
56327def50SWang Huan #define DCU_CTRLDESCLN_2_POSY(x)	((x) << 16)
57327def50SWang Huan #define DCU_CTRLDESCLN_2_POSX(x)	(x)
58327def50SWang Huan #define DCU_CTRLDESCLN_4_EN		(1 << 31)
59327def50SWang Huan #define DCU_CTRLDESCLN_4_TILE_EN	(1 << 30)
60327def50SWang Huan #define DCU_CTRLDESCLN_4_DATA_SEL_CLUT	(1 << 29)
61327def50SWang Huan #define DCU_CTRLDESCLN_4_SAFETY_EN	(1 << 28)
62327def50SWang Huan #define DCU_CTRLDESCLN_4_TRANS(x)	((x) << 20)
63327def50SWang Huan #define DCU_CTRLDESCLN_4_BPP(x)		((x) << 16)
64327def50SWang Huan #define DCU_CTRLDESCLN_4_RLE_EN		(1 << 15)
65327def50SWang Huan #define DCU_CTRLDESCLN_4_LUOFFS(x)	((x) << 4)
66327def50SWang Huan #define DCU_CTRLDESCLN_4_BB_ON		(1 << 2)
67327def50SWang Huan #define DCU_CTRLDESCLN_4_AB(x)		(x)
68327def50SWang Huan #define DCU_CTRLDESCLN_5_CKMAX_R(x)	((x) << 16)
69327def50SWang Huan #define DCU_CTRLDESCLN_5_CKMAX_G(x)	((x) << 8)
70327def50SWang Huan #define DCU_CTRLDESCLN_5_CKMAX_B(x)	(x)
71327def50SWang Huan #define DCU_CTRLDESCLN_6_CKMIN_R(x)	((x) << 16)
72327def50SWang Huan #define DCU_CTRLDESCLN_6_CKMIN_G(x)	((x) << 8)
73327def50SWang Huan #define DCU_CTRLDESCLN_6_CKMIN_B(x)	(x)
74327def50SWang Huan #define DCU_CTRLDESCLN_7_TILE_VER(x)	((x) << 16)
75327def50SWang Huan #define DCU_CTRLDESCLN_7_TILE_HOR(x)	(x)
76327def50SWang Huan #define DCU_CTRLDESCLN_8_FG_FCOLOR(x)	(x)
77327def50SWang Huan #define DCU_CTRLDESCLN_9_BG_BCOLOR(x)	(x)
78327def50SWang Huan 
79327def50SWang Huan #define BPP_16_RGB565			4
80327def50SWang Huan #define BPP_24_RGB888			5
81327def50SWang Huan #define BPP_32_ARGB8888			6
82327def50SWang Huan 
8377810e63SStefan Agner DECLARE_GLOBAL_DATA_PTR;
8477810e63SStefan Agner 
85327def50SWang Huan /*
86327def50SWang Huan  * This setting is used for the TWR_LCD_RGB card
87327def50SWang Huan  */
88327def50SWang Huan static struct fb_videomode fsl_dcu_mode_480_272 = {
89327def50SWang Huan 	.name		= "480x272-60",
90327def50SWang Huan 	.refresh	= 60,
91327def50SWang Huan 	.xres		= 480,
92327def50SWang Huan 	.yres		= 272,
93327def50SWang Huan 	.pixclock	= 91996,
94327def50SWang Huan 	.left_margin	= 2,
95327def50SWang Huan 	.right_margin	= 2,
96327def50SWang Huan 	.upper_margin	= 1,
97327def50SWang Huan 	.lower_margin	= 1,
98327def50SWang Huan 	.hsync_len	= 41,
99327def50SWang Huan 	.vsync_len	= 2,
100327def50SWang Huan 	.sync		= FB_SYNC_COMP_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
101327def50SWang Huan 	.vmode		= FB_VMODE_NONINTERLACED
102327def50SWang Huan };
103327def50SWang Huan 
104327def50SWang Huan /*
105327def50SWang Huan  * This setting is used for Siliconimage SiI9022A HDMI
106327def50SWang Huan  */
107*7a2d533eSStefan Agner static struct fb_videomode fsl_dcu_cea_mode_640_480 = {
108327def50SWang Huan 	.name		= "640x480-60",
109327def50SWang Huan 	.refresh	= 60,
110327def50SWang Huan 	.xres		= 640,
111327def50SWang Huan 	.yres		= 480,
112327def50SWang Huan 	.pixclock	= 39722,
113327def50SWang Huan 	.left_margin	= 48,
114327def50SWang Huan 	.right_margin	= 16,
115327def50SWang Huan 	.upper_margin	= 33,
116327def50SWang Huan 	.lower_margin	= 10,
117327def50SWang Huan 	.hsync_len	= 96,
118327def50SWang Huan 	.vsync_len	= 2,
119327def50SWang Huan 	.sync		= 0,
120327def50SWang Huan 	.vmode		= FB_VMODE_NONINTERLACED,
121327def50SWang Huan };
122327def50SWang Huan 
123*7a2d533eSStefan Agner static struct fb_videomode fsl_dcu_mode_640_480 = {
124*7a2d533eSStefan Agner 	.name		= "640x480-60",
125*7a2d533eSStefan Agner 	.refresh	= 60,
126*7a2d533eSStefan Agner 	.xres		= 640,
127*7a2d533eSStefan Agner 	.yres		= 480,
128*7a2d533eSStefan Agner 	.pixclock	= 25175,
129*7a2d533eSStefan Agner 	.left_margin	= 40,
130*7a2d533eSStefan Agner 	.right_margin	= 24,
131*7a2d533eSStefan Agner 	.upper_margin	= 32,
132*7a2d533eSStefan Agner 	.lower_margin	= 11,
133*7a2d533eSStefan Agner 	.hsync_len	= 96,
134*7a2d533eSStefan Agner 	.vsync_len	= 2,
135*7a2d533eSStefan Agner 	.sync		= 0,
136*7a2d533eSStefan Agner 	.vmode		= FB_VMODE_NONINTERLACED,
137*7a2d533eSStefan Agner };
138*7a2d533eSStefan Agner 
139*7a2d533eSStefan Agner static struct fb_videomode fsl_dcu_mode_800_480 = {
140*7a2d533eSStefan Agner 	.name		= "800x480-60",
141*7a2d533eSStefan Agner 	.refresh	= 60,
142*7a2d533eSStefan Agner 	.xres		= 800,
143*7a2d533eSStefan Agner 	.yres		= 480,
144*7a2d533eSStefan Agner 	.pixclock	= 33260,
145*7a2d533eSStefan Agner 	.left_margin	= 216,
146*7a2d533eSStefan Agner 	.right_margin	= 40,
147*7a2d533eSStefan Agner 	.upper_margin	= 35,
148*7a2d533eSStefan Agner 	.lower_margin	= 10,
149*7a2d533eSStefan Agner 	.hsync_len	= 128,
150*7a2d533eSStefan Agner 	.vsync_len	= 2,
151*7a2d533eSStefan Agner 	.sync		= 0,
152*7a2d533eSStefan Agner 	.vmode		= FB_VMODE_NONINTERLACED,
153*7a2d533eSStefan Agner };
154*7a2d533eSStefan Agner 
155*7a2d533eSStefan Agner static struct fb_videomode fsl_dcu_mode_1024_600 = {
156*7a2d533eSStefan Agner 	.name		= "1024x600-60",
157*7a2d533eSStefan Agner 	.refresh	= 60,
158*7a2d533eSStefan Agner 	.xres		= 1024,
159*7a2d533eSStefan Agner 	.yres		= 600,
160*7a2d533eSStefan Agner 	.pixclock	= 48000,
161*7a2d533eSStefan Agner 	.left_margin	= 104,
162*7a2d533eSStefan Agner 	.right_margin	= 43,
163*7a2d533eSStefan Agner 	.upper_margin	= 24,
164*7a2d533eSStefan Agner 	.lower_margin	= 20,
165*7a2d533eSStefan Agner 	.hsync_len	= 5,
166*7a2d533eSStefan Agner 	.vsync_len	= 5,
167*7a2d533eSStefan Agner 	.sync		= 0,
168*7a2d533eSStefan Agner 	.vmode		= FB_VMODE_NONINTERLACED,
169*7a2d533eSStefan Agner };
170*7a2d533eSStefan Agner 
171327def50SWang Huan /*
172327def50SWang Huan  * DCU register map
173327def50SWang Huan  */
174327def50SWang Huan struct dcu_reg {
175327def50SWang Huan 	u32 desc_cursor[4];
176327def50SWang Huan 	u32 mode;
177327def50SWang Huan 	u32 bgnd;
178327def50SWang Huan 	u32 disp_size;
179327def50SWang Huan 	u32 hsyn_para;
180327def50SWang Huan 	u32 vsyn_para;
181327def50SWang Huan 	u32 synpol;
182327def50SWang Huan 	u32 threshold;
183327def50SWang Huan 	u32 int_status;
184327def50SWang Huan 	u32 int_mask;
185327def50SWang Huan 	u32 colbar[8];
186327def50SWang Huan 	u32 div_ratio;
187327def50SWang Huan 	u32 sign_calc[2];
188327def50SWang Huan 	u32 crc_val;
189327def50SWang Huan 	u8 res_064[0x6c-0x64];
190327def50SWang Huan 	u32 parr_err_status1;
191327def50SWang Huan 	u8 res_070[0x7c-0x70];
192327def50SWang Huan 	u32 parr_err_status3;
193327def50SWang Huan 	u32 mparr_err_status1;
194327def50SWang Huan 	u8 res_084[0x90-0x84];
195327def50SWang Huan 	u32 mparr_err_status3;
196327def50SWang Huan 	u32 threshold_inp_buf[2];
197327def50SWang Huan 	u8 res_09c[0xa0-0x9c];
198327def50SWang Huan 	u32 luma_comp;
199327def50SWang Huan 	u32 chroma_red;
200327def50SWang Huan 	u32 chroma_green;
201327def50SWang Huan 	u32 chroma_blue;
202327def50SWang Huan 	u32 crc_pos;
203327def50SWang Huan 	u32 lyr_intpol_en;
204327def50SWang Huan 	u32 lyr_luma_comp;
205327def50SWang Huan 	u32 lyr_chrm_red;
206327def50SWang Huan 	u32 lyr_chrm_grn;
207327def50SWang Huan 	u32 lyr_chrm_blue;
208327def50SWang Huan 	u8 res_0c4[0xcc-0xc8];
209327def50SWang Huan 	u32 update_mode;
210327def50SWang Huan 	u32 underrun;
211327def50SWang Huan 	u8 res_0d4[0x100-0xd4];
212327def50SWang Huan 	u32 gpr;
213327def50SWang Huan 	u32 slr_l[2];
214327def50SWang Huan 	u32 slr_disp_size;
215327def50SWang Huan 	u32 slr_hvsync_para;
216327def50SWang Huan 	u32 slr_pol;
217327def50SWang Huan 	u32 slr_l_transp[2];
218327def50SWang Huan 	u8 res_120[0x200-0x120];
219327def50SWang Huan 	u32 ctrldescl[DCU_LAYER_MAX_NUM][16];
220327def50SWang Huan };
221327def50SWang Huan 
222327def50SWang Huan static struct fb_info info;
223327def50SWang Huan 
reset_total_layers(void)224327def50SWang Huan static void reset_total_layers(void)
225327def50SWang Huan {
226327def50SWang Huan 	struct dcu_reg *regs = (struct dcu_reg *)CONFIG_SYS_DCU_ADDR;
227327def50SWang Huan 	int i;
228327def50SWang Huan 
229327def50SWang Huan 	for (i = 0; i < DCU_LAYER_MAX_NUM; i++) {
230327def50SWang Huan 		dcu_write32(&regs->ctrldescl[i][0], 0);
231327def50SWang Huan 		dcu_write32(&regs->ctrldescl[i][1], 0);
232327def50SWang Huan 		dcu_write32(&regs->ctrldescl[i][2], 0);
233327def50SWang Huan 		dcu_write32(&regs->ctrldescl[i][3], 0);
234327def50SWang Huan 		dcu_write32(&regs->ctrldescl[i][4], 0);
235327def50SWang Huan 		dcu_write32(&regs->ctrldescl[i][5], 0);
236327def50SWang Huan 		dcu_write32(&regs->ctrldescl[i][6], 0);
237327def50SWang Huan 		dcu_write32(&regs->ctrldescl[i][7], 0);
238327def50SWang Huan 		dcu_write32(&regs->ctrldescl[i][8], 0);
239327def50SWang Huan 		dcu_write32(&regs->ctrldescl[i][9], 0);
240327def50SWang Huan 		dcu_write32(&regs->ctrldescl[i][10], 0);
241327def50SWang Huan 	}
242327def50SWang Huan }
243327def50SWang Huan 
layer_ctrldesc_init(int index,u32 pixel_format)244327def50SWang Huan static int layer_ctrldesc_init(int index, u32 pixel_format)
245327def50SWang Huan {
246327def50SWang Huan 	struct dcu_reg *regs = (struct dcu_reg *)CONFIG_SYS_DCU_ADDR;
247327def50SWang Huan 	unsigned int bpp = BPP_24_RGB888;
248327def50SWang Huan 
249327def50SWang Huan 	dcu_write32(&regs->ctrldescl[index][0],
250327def50SWang Huan 		    DCU_CTRLDESCLN_1_HEIGHT(info.var.yres) |
251327def50SWang Huan 		    DCU_CTRLDESCLN_1_WIDTH(info.var.xres));
252327def50SWang Huan 
253327def50SWang Huan 	dcu_write32(&regs->ctrldescl[index][1],
254327def50SWang Huan 		    DCU_CTRLDESCLN_2_POSY(0) |
255327def50SWang Huan 		    DCU_CTRLDESCLN_2_POSX(0));
256327def50SWang Huan 
257327def50SWang Huan 	dcu_write32(&regs->ctrldescl[index][2], (unsigned int)info.screen_base);
258327def50SWang Huan 
259327def50SWang Huan 	switch (pixel_format) {
260327def50SWang Huan 	case 16:
261327def50SWang Huan 		bpp = BPP_16_RGB565;
262327def50SWang Huan 		break;
263327def50SWang Huan 	case 24:
264327def50SWang Huan 		bpp = BPP_24_RGB888;
265327def50SWang Huan 		break;
266327def50SWang Huan 	case 32:
267327def50SWang Huan 		bpp = BPP_32_ARGB8888;
268327def50SWang Huan 		break;
269327def50SWang Huan 	default:
270327def50SWang Huan 		printf("unsupported color depth: %u\n", pixel_format);
271327def50SWang Huan 	}
272327def50SWang Huan 
273327def50SWang Huan 	dcu_write32(&regs->ctrldescl[index][3],
274327def50SWang Huan 		    DCU_CTRLDESCLN_4_EN |
275327def50SWang Huan 		    DCU_CTRLDESCLN_4_TRANS(0xff) |
276327def50SWang Huan 		    DCU_CTRLDESCLN_4_BPP(bpp) |
277327def50SWang Huan 		    DCU_CTRLDESCLN_4_AB(0));
278327def50SWang Huan 
279327def50SWang Huan 	dcu_write32(&regs->ctrldescl[index][4],
280327def50SWang Huan 		    DCU_CTRLDESCLN_5_CKMAX_R(0xff) |
281327def50SWang Huan 		    DCU_CTRLDESCLN_5_CKMAX_G(0xff) |
282327def50SWang Huan 		    DCU_CTRLDESCLN_5_CKMAX_B(0xff));
283327def50SWang Huan 	dcu_write32(&regs->ctrldescl[index][5],
284327def50SWang Huan 		    DCU_CTRLDESCLN_6_CKMIN_R(0) |
285327def50SWang Huan 		    DCU_CTRLDESCLN_6_CKMIN_G(0) |
286327def50SWang Huan 		    DCU_CTRLDESCLN_6_CKMIN_B(0));
287327def50SWang Huan 
288327def50SWang Huan 	dcu_write32(&regs->ctrldescl[index][6],
289327def50SWang Huan 		    DCU_CTRLDESCLN_7_TILE_VER(0) |
290327def50SWang Huan 		    DCU_CTRLDESCLN_7_TILE_HOR(0));
291327def50SWang Huan 
292327def50SWang Huan 	dcu_write32(&regs->ctrldescl[index][7], DCU_CTRLDESCLN_8_FG_FCOLOR(0));
293327def50SWang Huan 	dcu_write32(&regs->ctrldescl[index][8], DCU_CTRLDESCLN_9_BG_BCOLOR(0));
294327def50SWang Huan 
295327def50SWang Huan 	return 0;
296327def50SWang Huan }
297327def50SWang Huan 
fsl_dcu_init(unsigned int xres,unsigned int yres,unsigned int pixel_format)298327def50SWang Huan int fsl_dcu_init(unsigned int xres, unsigned int yres,
299327def50SWang Huan 		 unsigned int pixel_format)
300327def50SWang Huan {
301327def50SWang Huan 	struct dcu_reg *regs = (struct dcu_reg *)CONFIG_SYS_DCU_ADDR;
302327def50SWang Huan 	unsigned int div, mode;
303327def50SWang Huan 
304327def50SWang Huan 	info.screen_size =
305327def50SWang Huan 		info.var.xres * info.var.yres * (info.var.bits_per_pixel / 8);
30677810e63SStefan Agner 
30777810e63SStefan Agner 	if (info.screen_size > CONFIG_VIDEO_FSL_DCU_MAX_FB_SIZE_MB) {
30877810e63SStefan Agner 		info.screen_size = 0;
30977810e63SStefan Agner 		return -ENOMEM;
31077810e63SStefan Agner 	}
31177810e63SStefan Agner 
31277810e63SStefan Agner 	/* Reserve framebuffer at the end of memory */
31377810e63SStefan Agner 	gd->fb_base = gd->bd->bi_dram[0].start +
31477810e63SStefan Agner 			gd->bd->bi_dram[0].size - info.screen_size;
31577810e63SStefan Agner 	info.screen_base = (char *)gd->fb_base;
31677810e63SStefan Agner 
317327def50SWang Huan 	memset(info.screen_base, 0, info.screen_size);
318327def50SWang Huan 
319327def50SWang Huan 	reset_total_layers();
320327def50SWang Huan 
321327def50SWang Huan 	dcu_write32(&regs->disp_size,
322327def50SWang Huan 		    DCU_DISP_SIZE_DELTA_Y(info.var.yres) |
323327def50SWang Huan 		    DCU_DISP_SIZE_DELTA_X(info.var.xres / 16));
324327def50SWang Huan 
325327def50SWang Huan 	dcu_write32(&regs->hsyn_para,
326327def50SWang Huan 		    DCU_HSYN_PARA_BP(info.var.left_margin) |
327327def50SWang Huan 		    DCU_HSYN_PARA_PW(info.var.hsync_len) |
328327def50SWang Huan 		    DCU_HSYN_PARA_FP(info.var.right_margin));
329327def50SWang Huan 
330327def50SWang Huan 	dcu_write32(&regs->vsyn_para,
331327def50SWang Huan 		    DCU_VSYN_PARA_BP(info.var.upper_margin) |
332327def50SWang Huan 		    DCU_VSYN_PARA_PW(info.var.vsync_len) |
333327def50SWang Huan 		    DCU_VSYN_PARA_FP(info.var.lower_margin));
334327def50SWang Huan 
335327def50SWang Huan 	dcu_write32(&regs->synpol,
336327def50SWang Huan 		    DCU_SYN_POL_INV_PXCK_FALL |
337327def50SWang Huan 		    DCU_SYN_POL_NEG_REMAIN |
338327def50SWang Huan 		    DCU_SYN_POL_INV_VS_LOW |
339327def50SWang Huan 		    DCU_SYN_POL_INV_HS_LOW);
340327def50SWang Huan 
341327def50SWang Huan 	dcu_write32(&regs->bgnd,
342327def50SWang Huan 		    DCU_BGND_R(0) | DCU_BGND_G(0) | DCU_BGND_B(0));
343327def50SWang Huan 
344327def50SWang Huan 	dcu_write32(&regs->mode,
3457ce92a55SStefan Agner 		    DCU_MODE_BLEND_ITER(2) |
346327def50SWang Huan 		    DCU_MODE_RASTER_EN);
347327def50SWang Huan 
348327def50SWang Huan 	dcu_write32(&regs->threshold,
349327def50SWang Huan 		    DCU_THRESHOLD_LS_BF_VS(0x3) |
350327def50SWang Huan 		    DCU_THRESHOLD_OUT_BUF_HIGH(0x78) |
351327def50SWang Huan 		    DCU_THRESHOLD_OUT_BUF_LOW(0));
352327def50SWang Huan 
353327def50SWang Huan 	mode = dcu_read32(&regs->mode);
354327def50SWang Huan 	dcu_write32(&regs->mode, mode | DCU_MODE_NORMAL);
355327def50SWang Huan 
356327def50SWang Huan 	layer_ctrldesc_init(0, pixel_format);
357327def50SWang Huan 
35832f26f56SStefan Agner 	div = dcu_set_pixel_clock(info.var.pixclock);
35932f26f56SStefan Agner 	dcu_write32(&regs->div_ratio, (div - 1));
36032f26f56SStefan Agner 
36132f26f56SStefan Agner 	dcu_write32(&regs->update_mode, DCU_UPDATE_MODE_READREG);
36232f26f56SStefan Agner 
363327def50SWang Huan 	return 0;
364327def50SWang Huan }
365327def50SWang Huan 
board_get_usable_ram_top(ulong total_size)36677810e63SStefan Agner ulong board_get_usable_ram_top(ulong total_size)
36777810e63SStefan Agner {
36877810e63SStefan Agner 	return gd->ram_top - CONFIG_VIDEO_FSL_DCU_MAX_FB_SIZE_MB;
36977810e63SStefan Agner }
37077810e63SStefan Agner 
video_hw_init(void)371327def50SWang Huan void *video_hw_init(void)
372327def50SWang Huan {
373327def50SWang Huan 	static GraphicDevice ctfb;
374327def50SWang Huan 	const char *options;
375327def50SWang Huan 	unsigned int depth = 0, freq = 0;
376327def50SWang Huan 	struct fb_videomode *fsl_dcu_mode_db = &fsl_dcu_mode_480_272;
377327def50SWang Huan 
378327def50SWang Huan 	if (!video_get_video_mode(&ctfb.winSizeX, &ctfb.winSizeY, &depth, &freq,
379327def50SWang Huan 				  &options))
380327def50SWang Huan 		return NULL;
381327def50SWang Huan 
382327def50SWang Huan 	/* Find the monitor port, which is a required option */
383327def50SWang Huan 	if (!options)
384327def50SWang Huan 		return NULL;
385327def50SWang Huan 	if (strncmp(options, "monitor=", 8) != 0)
386327def50SWang Huan 		return NULL;
387327def50SWang Huan 
388327def50SWang Huan 	switch (RESOLUTION(ctfb.winSizeX, ctfb.winSizeY)) {
389327def50SWang Huan 	case RESOLUTION(480, 272):
390327def50SWang Huan 		fsl_dcu_mode_db = &fsl_dcu_mode_480_272;
391327def50SWang Huan 		break;
392327def50SWang Huan 	case RESOLUTION(640, 480):
393*7a2d533eSStefan Agner 		if (!strncmp(options, "monitor=hdmi", 12))
394*7a2d533eSStefan Agner 			fsl_dcu_mode_db = &fsl_dcu_cea_mode_640_480;
395*7a2d533eSStefan Agner 		else
396327def50SWang Huan 			fsl_dcu_mode_db = &fsl_dcu_mode_640_480;
397327def50SWang Huan 		break;
398*7a2d533eSStefan Agner 	case RESOLUTION(800, 480):
399*7a2d533eSStefan Agner 		fsl_dcu_mode_db = &fsl_dcu_mode_800_480;
400*7a2d533eSStefan Agner 		break;
401*7a2d533eSStefan Agner 	case RESOLUTION(1024, 600):
402*7a2d533eSStefan Agner 		fsl_dcu_mode_db = &fsl_dcu_mode_1024_600;
403*7a2d533eSStefan Agner 		break;
404327def50SWang Huan 	default:
405327def50SWang Huan 		printf("unsupported resolution %ux%u\n",
406327def50SWang Huan 		       ctfb.winSizeX, ctfb.winSizeY);
407327def50SWang Huan 	}
408327def50SWang Huan 
409327def50SWang Huan 	info.var.xres = fsl_dcu_mode_db->xres;
410327def50SWang Huan 	info.var.yres = fsl_dcu_mode_db->yres;
411327def50SWang Huan 	info.var.bits_per_pixel = 32;
412327def50SWang Huan 	info.var.pixclock = fsl_dcu_mode_db->pixclock;
413327def50SWang Huan 	info.var.left_margin = fsl_dcu_mode_db->left_margin;
414327def50SWang Huan 	info.var.right_margin = fsl_dcu_mode_db->right_margin;
415327def50SWang Huan 	info.var.upper_margin = fsl_dcu_mode_db->upper_margin;
416327def50SWang Huan 	info.var.lower_margin = fsl_dcu_mode_db->lower_margin;
417327def50SWang Huan 	info.var.hsync_len = fsl_dcu_mode_db->hsync_len;
418327def50SWang Huan 	info.var.vsync_len = fsl_dcu_mode_db->vsync_len;
419327def50SWang Huan 	info.var.sync = fsl_dcu_mode_db->sync;
420327def50SWang Huan 	info.var.vmode = fsl_dcu_mode_db->vmode;
421327def50SWang Huan 	info.fix.line_length = info.var.xres * info.var.bits_per_pixel / 8;
422327def50SWang Huan 
423327def50SWang Huan 	if (platform_dcu_init(ctfb.winSizeX, ctfb.winSizeY,
424327def50SWang Huan 			      options + 8, fsl_dcu_mode_db) < 0)
425327def50SWang Huan 		return NULL;
426327def50SWang Huan 
427327def50SWang Huan 	ctfb.frameAdrs = (unsigned int)info.screen_base;
428327def50SWang Huan 	ctfb.plnSizeX = ctfb.winSizeX;
429327def50SWang Huan 	ctfb.plnSizeY = ctfb.winSizeY;
430327def50SWang Huan 
431327def50SWang Huan 	ctfb.gdfBytesPP = 4;
432327def50SWang Huan 	ctfb.gdfIndex = GDF_32BIT_X888RGB;
433327def50SWang Huan 
434327def50SWang Huan 	ctfb.memSize = info.screen_size;
435327def50SWang Huan 
436327def50SWang Huan 	return &ctfb;
437327def50SWang Huan }
43877810e63SStefan Agner 
43977810e63SStefan Agner #if defined(CONFIG_OF_BOARD_SETUP)
fsl_dcu_fixedfb_setup(void * blob)44077810e63SStefan Agner int fsl_dcu_fixedfb_setup(void *blob)
44177810e63SStefan Agner {
44277810e63SStefan Agner 	u64 start, size;
44377810e63SStefan Agner 	int ret;
44477810e63SStefan Agner 
44577810e63SStefan Agner 	start = gd->bd->bi_dram[0].start;
44677810e63SStefan Agner 	size = gd->bd->bi_dram[0].size - info.screen_size;
44777810e63SStefan Agner 
44877810e63SStefan Agner 	/*
44977810e63SStefan Agner 	 * Align size on section size (1 MiB).
45077810e63SStefan Agner 	 */
45177810e63SStefan Agner 	size &= 0xfff00000;
45277810e63SStefan Agner 	ret = fdt_fixup_memory_banks(blob, &start, &size, 1);
45377810e63SStefan Agner 	if (ret) {
45477810e63SStefan Agner 		eprintf("Cannot setup fb: Error reserving memory\n");
45577810e63SStefan Agner 		return ret;
45677810e63SStefan Agner 	}
45777810e63SStefan Agner 
45877810e63SStefan Agner 	return 0;
45977810e63SStefan Agner }
46077810e63SStefan Agner #endif
461