Commit | Line | Data |
---|---|---|
327def50 WH |
1 | /* |
2 | * Copyright 2014 Freescale Semiconductor, Inc. | |
3 | * | |
4 | * FSL DCU Framebuffer driver | |
5 | * | |
6 | * SPDX-License-Identifier: GPL-2.0+ | |
7 | */ | |
8 | ||
9 | #include <asm/io.h> | |
10 | #include <common.h> | |
11 | #include <fsl_dcu_fb.h> | |
12 | #include <linux/fb.h> | |
13 | #include <malloc.h> | |
14 | #include <video_fb.h> | |
15 | #include "videomodes.h" | |
16 | ||
17 | /* Convert the X,Y resolution pair into a single number */ | |
18 | #define RESOLUTION(x, y) (((u32)(x) << 16) | (y)) | |
19 | ||
20 | #ifdef CONFIG_SYS_FSL_DCU_LE | |
21 | #define dcu_read32 in_le32 | |
22 | #define dcu_write32 out_le32 | |
23 | #elif defined(CONFIG_SYS_FSL_DCU_BE) | |
24 | #define dcu_read32 in_be32 | |
25 | #define dcu_write32 out_be32 | |
26 | #endif | |
27 | ||
28 | #define DCU_MODE_BLEND_ITER(x) ((x) << 20) | |
29 | #define DCU_MODE_RASTER_EN (1 << 14) | |
30 | #define DCU_MODE_NORMAL 1 | |
31 | #define DCU_MODE_COLORBAR 3 | |
32 | #define DCU_BGND_R(x) ((x) << 16) | |
33 | #define DCU_BGND_G(x) ((x) << 8) | |
34 | #define DCU_BGND_B(x) (x) | |
35 | #define DCU_DISP_SIZE_DELTA_Y(x) ((x) << 16) | |
36 | #define DCU_DISP_SIZE_DELTA_X(x) (x) | |
37 | #define DCU_HSYN_PARA_BP(x) ((x) << 22) | |
38 | #define DCU_HSYN_PARA_PW(x) ((x) << 11) | |
39 | #define DCU_HSYN_PARA_FP(x) (x) | |
40 | #define DCU_VSYN_PARA_BP(x) ((x) << 22) | |
41 | #define DCU_VSYN_PARA_PW(x) ((x) << 11) | |
42 | #define DCU_VSYN_PARA_FP(x) (x) | |
43 | #define DCU_SYN_POL_INV_PXCK_FALL (0 << 6) | |
44 | #define DCU_SYN_POL_NEG_REMAIN (0 << 5) | |
45 | #define DCU_SYN_POL_INV_VS_LOW (1 << 1) | |
46 | #define DCU_SYN_POL_INV_HS_LOW (1) | |
47 | #define DCU_THRESHOLD_LS_BF_VS(x) ((x) << 16) | |
48 | #define DCU_THRESHOLD_OUT_BUF_HIGH(x) ((x) << 8) | |
49 | #define DCU_THRESHOLD_OUT_BUF_LOW(x) (x) | |
50 | #define DCU_UPDATE_MODE_MODE (1 << 31) | |
51 | #define DCU_UPDATE_MODE_READREG (1 << 30) | |
52 | ||
53 | #define DCU_CTRLDESCLN_1_HEIGHT(x) ((x) << 16) | |
54 | #define DCU_CTRLDESCLN_1_WIDTH(x) (x) | |
55 | #define DCU_CTRLDESCLN_2_POSY(x) ((x) << 16) | |
56 | #define DCU_CTRLDESCLN_2_POSX(x) (x) | |
57 | #define DCU_CTRLDESCLN_4_EN (1 << 31) | |
58 | #define DCU_CTRLDESCLN_4_TILE_EN (1 << 30) | |
59 | #define DCU_CTRLDESCLN_4_DATA_SEL_CLUT (1 << 29) | |
60 | #define DCU_CTRLDESCLN_4_SAFETY_EN (1 << 28) | |
61 | #define DCU_CTRLDESCLN_4_TRANS(x) ((x) << 20) | |
62 | #define DCU_CTRLDESCLN_4_BPP(x) ((x) << 16) | |
63 | #define DCU_CTRLDESCLN_4_RLE_EN (1 << 15) | |
64 | #define DCU_CTRLDESCLN_4_LUOFFS(x) ((x) << 4) | |
65 | #define DCU_CTRLDESCLN_4_BB_ON (1 << 2) | |
66 | #define DCU_CTRLDESCLN_4_AB(x) (x) | |
67 | #define DCU_CTRLDESCLN_5_CKMAX_R(x) ((x) << 16) | |
68 | #define DCU_CTRLDESCLN_5_CKMAX_G(x) ((x) << 8) | |
69 | #define DCU_CTRLDESCLN_5_CKMAX_B(x) (x) | |
70 | #define DCU_CTRLDESCLN_6_CKMIN_R(x) ((x) << 16) | |
71 | #define DCU_CTRLDESCLN_6_CKMIN_G(x) ((x) << 8) | |
72 | #define DCU_CTRLDESCLN_6_CKMIN_B(x) (x) | |
73 | #define DCU_CTRLDESCLN_7_TILE_VER(x) ((x) << 16) | |
74 | #define DCU_CTRLDESCLN_7_TILE_HOR(x) (x) | |
75 | #define DCU_CTRLDESCLN_8_FG_FCOLOR(x) (x) | |
76 | #define DCU_CTRLDESCLN_9_BG_BCOLOR(x) (x) | |
77 | ||
78 | #define BPP_16_RGB565 4 | |
79 | #define BPP_24_RGB888 5 | |
80 | #define BPP_32_ARGB8888 6 | |
81 | ||
82 | /* | |
83 | * This setting is used for the TWR_LCD_RGB card | |
84 | */ | |
85 | static struct fb_videomode fsl_dcu_mode_480_272 = { | |
86 | .name = "480x272-60", | |
87 | .refresh = 60, | |
88 | .xres = 480, | |
89 | .yres = 272, | |
90 | .pixclock = 91996, | |
91 | .left_margin = 2, | |
92 | .right_margin = 2, | |
93 | .upper_margin = 1, | |
94 | .lower_margin = 1, | |
95 | .hsync_len = 41, | |
96 | .vsync_len = 2, | |
97 | .sync = FB_SYNC_COMP_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, | |
98 | .vmode = FB_VMODE_NONINTERLACED | |
99 | }; | |
100 | ||
101 | /* | |
102 | * This setting is used for Siliconimage SiI9022A HDMI | |
103 | */ | |
104 | static struct fb_videomode fsl_dcu_mode_640_480 = { | |
105 | .name = "640x480-60", | |
106 | .refresh = 60, | |
107 | .xres = 640, | |
108 | .yres = 480, | |
109 | .pixclock = 39722, | |
110 | .left_margin = 48, | |
111 | .right_margin = 16, | |
112 | .upper_margin = 33, | |
113 | .lower_margin = 10, | |
114 | .hsync_len = 96, | |
115 | .vsync_len = 2, | |
116 | .sync = 0, | |
117 | .vmode = FB_VMODE_NONINTERLACED, | |
118 | }; | |
119 | ||
120 | /* | |
121 | * DCU register map | |
122 | */ | |
123 | struct dcu_reg { | |
124 | u32 desc_cursor[4]; | |
125 | u32 mode; | |
126 | u32 bgnd; | |
127 | u32 disp_size; | |
128 | u32 hsyn_para; | |
129 | u32 vsyn_para; | |
130 | u32 synpol; | |
131 | u32 threshold; | |
132 | u32 int_status; | |
133 | u32 int_mask; | |
134 | u32 colbar[8]; | |
135 | u32 div_ratio; | |
136 | u32 sign_calc[2]; | |
137 | u32 crc_val; | |
138 | u8 res_064[0x6c-0x64]; | |
139 | u32 parr_err_status1; | |
140 | u8 res_070[0x7c-0x70]; | |
141 | u32 parr_err_status3; | |
142 | u32 mparr_err_status1; | |
143 | u8 res_084[0x90-0x84]; | |
144 | u32 mparr_err_status3; | |
145 | u32 threshold_inp_buf[2]; | |
146 | u8 res_09c[0xa0-0x9c]; | |
147 | u32 luma_comp; | |
148 | u32 chroma_red; | |
149 | u32 chroma_green; | |
150 | u32 chroma_blue; | |
151 | u32 crc_pos; | |
152 | u32 lyr_intpol_en; | |
153 | u32 lyr_luma_comp; | |
154 | u32 lyr_chrm_red; | |
155 | u32 lyr_chrm_grn; | |
156 | u32 lyr_chrm_blue; | |
157 | u8 res_0c4[0xcc-0xc8]; | |
158 | u32 update_mode; | |
159 | u32 underrun; | |
160 | u8 res_0d4[0x100-0xd4]; | |
161 | u32 gpr; | |
162 | u32 slr_l[2]; | |
163 | u32 slr_disp_size; | |
164 | u32 slr_hvsync_para; | |
165 | u32 slr_pol; | |
166 | u32 slr_l_transp[2]; | |
167 | u8 res_120[0x200-0x120]; | |
168 | u32 ctrldescl[DCU_LAYER_MAX_NUM][16]; | |
169 | }; | |
170 | ||
171 | static struct fb_info info; | |
172 | ||
173 | static void reset_total_layers(void) | |
174 | { | |
175 | struct dcu_reg *regs = (struct dcu_reg *)CONFIG_SYS_DCU_ADDR; | |
176 | int i; | |
177 | ||
178 | for (i = 0; i < DCU_LAYER_MAX_NUM; i++) { | |
179 | dcu_write32(®s->ctrldescl[i][0], 0); | |
180 | dcu_write32(®s->ctrldescl[i][1], 0); | |
181 | dcu_write32(®s->ctrldescl[i][2], 0); | |
182 | dcu_write32(®s->ctrldescl[i][3], 0); | |
183 | dcu_write32(®s->ctrldescl[i][4], 0); | |
184 | dcu_write32(®s->ctrldescl[i][5], 0); | |
185 | dcu_write32(®s->ctrldescl[i][6], 0); | |
186 | dcu_write32(®s->ctrldescl[i][7], 0); | |
187 | dcu_write32(®s->ctrldescl[i][8], 0); | |
188 | dcu_write32(®s->ctrldescl[i][9], 0); | |
189 | dcu_write32(®s->ctrldescl[i][10], 0); | |
190 | } | |
191 | ||
192 | dcu_write32(®s->update_mode, DCU_UPDATE_MODE_READREG); | |
193 | } | |
194 | ||
195 | static int layer_ctrldesc_init(int index, u32 pixel_format) | |
196 | { | |
197 | struct dcu_reg *regs = (struct dcu_reg *)CONFIG_SYS_DCU_ADDR; | |
198 | unsigned int bpp = BPP_24_RGB888; | |
199 | ||
200 | dcu_write32(®s->ctrldescl[index][0], | |
201 | DCU_CTRLDESCLN_1_HEIGHT(info.var.yres) | | |
202 | DCU_CTRLDESCLN_1_WIDTH(info.var.xres)); | |
203 | ||
204 | dcu_write32(®s->ctrldescl[index][1], | |
205 | DCU_CTRLDESCLN_2_POSY(0) | | |
206 | DCU_CTRLDESCLN_2_POSX(0)); | |
207 | ||
208 | dcu_write32(®s->ctrldescl[index][2], (unsigned int)info.screen_base); | |
209 | ||
210 | switch (pixel_format) { | |
211 | case 16: | |
212 | bpp = BPP_16_RGB565; | |
213 | break; | |
214 | case 24: | |
215 | bpp = BPP_24_RGB888; | |
216 | break; | |
217 | case 32: | |
218 | bpp = BPP_32_ARGB8888; | |
219 | break; | |
220 | default: | |
221 | printf("unsupported color depth: %u\n", pixel_format); | |
222 | } | |
223 | ||
224 | dcu_write32(®s->ctrldescl[index][3], | |
225 | DCU_CTRLDESCLN_4_EN | | |
226 | DCU_CTRLDESCLN_4_TRANS(0xff) | | |
227 | DCU_CTRLDESCLN_4_BPP(bpp) | | |
228 | DCU_CTRLDESCLN_4_AB(0)); | |
229 | ||
230 | dcu_write32(®s->ctrldescl[index][4], | |
231 | DCU_CTRLDESCLN_5_CKMAX_R(0xff) | | |
232 | DCU_CTRLDESCLN_5_CKMAX_G(0xff) | | |
233 | DCU_CTRLDESCLN_5_CKMAX_B(0xff)); | |
234 | dcu_write32(®s->ctrldescl[index][5], | |
235 | DCU_CTRLDESCLN_6_CKMIN_R(0) | | |
236 | DCU_CTRLDESCLN_6_CKMIN_G(0) | | |
237 | DCU_CTRLDESCLN_6_CKMIN_B(0)); | |
238 | ||
239 | dcu_write32(®s->ctrldescl[index][6], | |
240 | DCU_CTRLDESCLN_7_TILE_VER(0) | | |
241 | DCU_CTRLDESCLN_7_TILE_HOR(0)); | |
242 | ||
243 | dcu_write32(®s->ctrldescl[index][7], DCU_CTRLDESCLN_8_FG_FCOLOR(0)); | |
244 | dcu_write32(®s->ctrldescl[index][8], DCU_CTRLDESCLN_9_BG_BCOLOR(0)); | |
245 | ||
246 | dcu_write32(®s->update_mode, DCU_UPDATE_MODE_READREG); | |
247 | ||
248 | return 0; | |
249 | } | |
250 | ||
251 | int fsl_dcu_init(unsigned int xres, unsigned int yres, | |
252 | unsigned int pixel_format) | |
253 | { | |
254 | struct dcu_reg *regs = (struct dcu_reg *)CONFIG_SYS_DCU_ADDR; | |
255 | unsigned int div, mode; | |
256 | ||
257 | /* Memory allocation for framebuffer */ | |
258 | info.screen_size = | |
259 | info.var.xres * info.var.yres * (info.var.bits_per_pixel / 8); | |
260 | info.screen_base = (char *)memalign(ARCH_DMA_MINALIGN, | |
261 | roundup(info.screen_size, ARCH_DMA_MINALIGN)); | |
262 | memset(info.screen_base, 0, info.screen_size); | |
263 | ||
264 | reset_total_layers(); | |
265 | div = dcu_set_pixel_clock(info.var.pixclock); | |
266 | dcu_write32(®s->div_ratio, (div - 1)); | |
267 | ||
268 | dcu_write32(®s->disp_size, | |
269 | DCU_DISP_SIZE_DELTA_Y(info.var.yres) | | |
270 | DCU_DISP_SIZE_DELTA_X(info.var.xres / 16)); | |
271 | ||
272 | dcu_write32(®s->hsyn_para, | |
273 | DCU_HSYN_PARA_BP(info.var.left_margin) | | |
274 | DCU_HSYN_PARA_PW(info.var.hsync_len) | | |
275 | DCU_HSYN_PARA_FP(info.var.right_margin)); | |
276 | ||
277 | dcu_write32(®s->vsyn_para, | |
278 | DCU_VSYN_PARA_BP(info.var.upper_margin) | | |
279 | DCU_VSYN_PARA_PW(info.var.vsync_len) | | |
280 | DCU_VSYN_PARA_FP(info.var.lower_margin)); | |
281 | ||
282 | dcu_write32(®s->synpol, | |
283 | DCU_SYN_POL_INV_PXCK_FALL | | |
284 | DCU_SYN_POL_NEG_REMAIN | | |
285 | DCU_SYN_POL_INV_VS_LOW | | |
286 | DCU_SYN_POL_INV_HS_LOW); | |
287 | ||
288 | dcu_write32(®s->bgnd, | |
289 | DCU_BGND_R(0) | DCU_BGND_G(0) | DCU_BGND_B(0)); | |
290 | ||
291 | dcu_write32(®s->mode, | |
292 | DCU_MODE_BLEND_ITER(DCU_LAYER_MAX_NUM) | | |
293 | DCU_MODE_RASTER_EN); | |
294 | ||
295 | dcu_write32(®s->threshold, | |
296 | DCU_THRESHOLD_LS_BF_VS(0x3) | | |
297 | DCU_THRESHOLD_OUT_BUF_HIGH(0x78) | | |
298 | DCU_THRESHOLD_OUT_BUF_LOW(0)); | |
299 | ||
300 | mode = dcu_read32(®s->mode); | |
301 | dcu_write32(®s->mode, mode | DCU_MODE_NORMAL); | |
302 | ||
303 | layer_ctrldesc_init(0, pixel_format); | |
304 | ||
305 | return 0; | |
306 | } | |
307 | ||
308 | void *video_hw_init(void) | |
309 | { | |
310 | static GraphicDevice ctfb; | |
311 | const char *options; | |
312 | unsigned int depth = 0, freq = 0; | |
313 | struct fb_videomode *fsl_dcu_mode_db = &fsl_dcu_mode_480_272; | |
314 | ||
315 | if (!video_get_video_mode(&ctfb.winSizeX, &ctfb.winSizeY, &depth, &freq, | |
316 | &options)) | |
317 | return NULL; | |
318 | ||
319 | /* Find the monitor port, which is a required option */ | |
320 | if (!options) | |
321 | return NULL; | |
322 | if (strncmp(options, "monitor=", 8) != 0) | |
323 | return NULL; | |
324 | ||
325 | switch (RESOLUTION(ctfb.winSizeX, ctfb.winSizeY)) { | |
326 | case RESOLUTION(480, 272): | |
327 | fsl_dcu_mode_db = &fsl_dcu_mode_480_272; | |
328 | break; | |
329 | case RESOLUTION(640, 480): | |
330 | fsl_dcu_mode_db = &fsl_dcu_mode_640_480; | |
331 | break; | |
332 | default: | |
333 | printf("unsupported resolution %ux%u\n", | |
334 | ctfb.winSizeX, ctfb.winSizeY); | |
335 | } | |
336 | ||
337 | info.var.xres = fsl_dcu_mode_db->xres; | |
338 | info.var.yres = fsl_dcu_mode_db->yres; | |
339 | info.var.bits_per_pixel = 32; | |
340 | info.var.pixclock = fsl_dcu_mode_db->pixclock; | |
341 | info.var.left_margin = fsl_dcu_mode_db->left_margin; | |
342 | info.var.right_margin = fsl_dcu_mode_db->right_margin; | |
343 | info.var.upper_margin = fsl_dcu_mode_db->upper_margin; | |
344 | info.var.lower_margin = fsl_dcu_mode_db->lower_margin; | |
345 | info.var.hsync_len = fsl_dcu_mode_db->hsync_len; | |
346 | info.var.vsync_len = fsl_dcu_mode_db->vsync_len; | |
347 | info.var.sync = fsl_dcu_mode_db->sync; | |
348 | info.var.vmode = fsl_dcu_mode_db->vmode; | |
349 | info.fix.line_length = info.var.xres * info.var.bits_per_pixel / 8; | |
350 | ||
351 | if (platform_dcu_init(ctfb.winSizeX, ctfb.winSizeY, | |
352 | options + 8, fsl_dcu_mode_db) < 0) | |
353 | return NULL; | |
354 | ||
355 | ctfb.frameAdrs = (unsigned int)info.screen_base; | |
356 | ctfb.plnSizeX = ctfb.winSizeX; | |
357 | ctfb.plnSizeY = ctfb.winSizeY; | |
358 | ||
359 | ctfb.gdfBytesPP = 4; | |
360 | ctfb.gdfIndex = GDF_32BIT_X888RGB; | |
361 | ||
362 | ctfb.memSize = info.screen_size; | |
363 | ||
364 | return &ctfb; | |
365 | } |