3 * Paolo Scaffardi, AIRVENT SAM s.p.a - RIMINI(ITALY), arsenio@tin.it
5 * Wolfgang Denk, wd@denx.de
7 * SPDX-License-Identifier: GPL-2.0+
12 /************************************************************************/
14 /************************************************************************/
21 #include <linux/types.h>
22 #include <stdio_dev.h>
26 DECLARE_GLOBAL_DATA_PTR;
28 /************************************************************************/
29 /* ** DEBUG SETTINGS */
30 /************************************************************************/
33 #define VIDEO_DEBUG_COLORBARS /* Force colorbars output */
36 /************************************************************************/
37 /* ** VIDEO MODE SETTINGS */
38 /************************************************************************/
41 #define VIDEO_MODE_EXTENDED /* Allow screen size bigger than visible area */
42 #define VIDEO_MODE_NTSC
45 #define VIDEO_MODE_PAL
48 #define VIDEO_BLINK /* This enables cursor blinking (under construction) */
51 #define VIDEO_INFO /* Show U-Boot information */
52 #define VIDEO_INFO_X VIDEO_LOGO_WIDTH+8
53 #define VIDEO_INFO_Y 16
55 /************************************************************************/
56 /* ** VIDEO ENCODER CONSTANTS */
57 /************************************************************************/
59 #ifdef CONFIG_VIDEO_ENCODER_AD7176
61 #include <video_ad7176.h> /* Sets encoder data, mode, and visible and active area */
64 #define VIDEO_I2C_ADDR CONFIG_VIDEO_ENCODER_AD7176_ADDR
67 #ifdef CONFIG_VIDEO_ENCODER_AD7177
69 #include <video_ad7177.h> /* Sets encoder data, mode, and visible and active area */
72 #define VIDEO_I2C_ADDR CONFIG_VIDEO_ENCODER_AD7177_ADDR
75 #ifdef CONFIG_VIDEO_ENCODER_AD7179
77 #include <video_ad7179.h> /* Sets encoder data, mode, and visible and active area */
80 #define VIDEO_I2C_ADDR CONFIG_VIDEO_ENCODER_AD7179_ADDR
83 /************************************************************************/
84 /* ** VIDEO MODE CONSTANTS */
85 /************************************************************************/
87 #ifdef VIDEO_MODE_EXTENDED
88 #define VIDEO_COLS VIDEO_ACTIVE_COLS
89 #define VIDEO_ROWS VIDEO_ACTIVE_ROWS
91 #define VIDEO_COLS VIDEO_VISIBLE_COLS
92 #define VIDEO_ROWS VIDEO_VISIBLE_ROWS
95 #define VIDEO_PIXEL_SIZE (VIDEO_MODE_BPP/8)
96 #define VIDEO_SIZE (VIDEO_ROWS*VIDEO_COLS*VIDEO_PIXEL_SIZE) /* Total size of buffer */
97 #define VIDEO_PIX_BLOCKS (VIDEO_SIZE >> 2) /* Number of ints */
98 #define VIDEO_LINE_LEN (VIDEO_COLS*VIDEO_PIXEL_SIZE) /* Number of bytes per line */
99 #define VIDEO_BURST_LEN (VIDEO_COLS/8)
101 #ifdef VIDEO_MODE_YUYV
102 #define VIDEO_BG_COL 0x80D880D8 /* Background color in YUYV format */
104 #define VIDEO_BG_COL 0xF8F8F8F8 /* Background color in RGB format */
107 /************************************************************************/
108 /* ** FONT AND LOGO DATA */
109 /************************************************************************/
111 #include <video_font.h> /* Get font data, width and height */
112 #include <video_font_data.h>
114 #ifdef CONFIG_VIDEO_LOGO
115 #include <video_logo.h> /* Get logo data, width and height */
117 #define VIDEO_LOGO_WIDTH DEF_U_BOOT_LOGO_WIDTH
118 #define VIDEO_LOGO_HEIGHT DEF_U_BOOT_LOGO_HEIGHT
119 #define VIDEO_LOGO_ADDR &u_boot_logo
122 /************************************************************************/
123 /* ** VIDEO CONTROLLER CONSTANTS */
124 /************************************************************************/
126 /* VCCR - VIDEO CONTROLLER CONFIGURATION REGISTER */
128 #define VIDEO_VCCR_VON 0 /* Video controller ON */
129 #define VIDEO_VCCR_CSRC 1 /* Clock source */
130 #define VIDEO_VCCR_PDF 13 /* Pixel display format */
131 #define VIDEO_VCCR_IEN 11 /* Interrupt enable */
133 /* VSR - VIDEO STATUS REGISTER */
135 #define VIDEO_VSR_CAS 6 /* Active set */
136 #define VIDEO_VSR_EOF 0 /* End of frame */
138 /* VCMR - VIDEO COMMAND REGISTER */
140 #define VIDEO_VCMR_BD 0 /* Blank display */
141 #define VIDEO_VCMR_ASEL 1 /* Active set selection */
143 /* VBCB - VIDEO BACKGROUND COLOR BUFFER REGISTER */
145 #define VIDEO_BCSR4_RESET_BIT 21 /* BCSR4 - Extern video encoder reset */
146 #define VIDEO_BCSR4_EXTCLK_BIT 22 /* BCSR4 - Extern clock enable */
147 #define VIDEO_BCSR4_VIDLED_BIT 23 /* BCSR4 - Video led disable */
149 /************************************************************************/
150 /* ** CONSOLE CONSTANTS */
151 /************************************************************************/
153 #ifdef CONFIG_VIDEO_LOGO
154 #define CONSOLE_ROWS ((VIDEO_ROWS - VIDEO_LOGO_HEIGHT) / VIDEO_FONT_HEIGHT)
155 #define VIDEO_LOGO_SKIP (VIDEO_COLS - VIDEO_LOGO_WIDTH)
157 #define CONSOLE_ROWS (VIDEO_ROWS / VIDEO_FONT_HEIGHT)
160 #define CONSOLE_COLS (VIDEO_COLS / VIDEO_FONT_WIDTH)
161 #define CONSOLE_ROW_SIZE (VIDEO_FONT_HEIGHT * VIDEO_LINE_LEN)
162 #define CONSOLE_ROW_FIRST (video_console_address)
163 #define CONSOLE_ROW_SECOND (video_console_address + CONSOLE_ROW_SIZE)
164 #define CONSOLE_ROW_LAST (video_console_address + CONSOLE_SIZE - CONSOLE_ROW_SIZE)
165 #define CONSOLE_SIZE (CONSOLE_ROW_SIZE * CONSOLE_ROWS)
166 #define CONSOLE_SCROLL_SIZE (CONSOLE_SIZE - CONSOLE_ROW_SIZE)
169 * Simple color definitions
171 #define CONSOLE_COLOR_BLACK 0
172 #define CONSOLE_COLOR_RED 1
173 #define CONSOLE_COLOR_GREEN 2
174 #define CONSOLE_COLOR_YELLOW 3
175 #define CONSOLE_COLOR_BLUE 4
176 #define CONSOLE_COLOR_MAGENTA 5
177 #define CONSOLE_COLOR_CYAN 6
178 #define CONSOLE_COLOR_GREY 13
179 #define CONSOLE_COLOR_GREY2 14
180 #define CONSOLE_COLOR_WHITE 15 /* Must remain last / highest */
182 /************************************************************************/
183 /* ** BITOPS MACROS */
184 /************************************************************************/
186 #define HISHORT(i) ((i >> 16)&0xffff)
187 #define LOSHORT(i) (i & 0xffff)
188 #define HICHAR(s) ((i >> 8)&0xff)
189 #define LOCHAR(s) (i & 0xff)
190 #define HI(c) ((c >> 4)&0xf)
191 #define LO(c) (c & 0xf)
192 #define SWAPINT(i) (HISHORT(i) | (LOSHORT(i) << 16))
193 #define SWAPSHORT(s) (HICHAR(s) | (LOCHAR(s) << 8))
194 #define SWAPCHAR(c) (HI(c) | (LO(c) << 4))
195 #define BITMASK(b) (1 << (b))
196 #define GETBIT(v,b) (((v) & BITMASK(b)) > 0)
197 #define SETBIT(v,b,d) (v = (((d)>0) ? (v) | BITMASK(b): (v) & ~BITMASK(b)))
199 /************************************************************************/
201 /************************************************************************/
204 unsigned char V, Y1, U, Y2;
207 /* This structure is based on the Video Ram in the MPC823. */
208 typedef struct VRAM {
209 unsigned hx:2, /* Horizontal sync */
210 vx:2, /* Vertical sync */
213 res1:6, /* Reserved */
214 vds:2, /* Video Data Select */
215 inter:1, /* Interrupt */
216 res2:2, /* Reserved */
217 lcyc:11, /* Loop/video cycles */
218 lp:1, /* Loop start/end */
219 lst:1; /* Last entry */
222 /************************************************************************/
224 /************************************************************************/
227 video_panning_range_x = 0, /* Video mode invisible pixels x range */
228 video_panning_range_y = 0, /* Video mode invisible pixels y range */
229 video_panning_value_x = 0, /* Video mode x panning value (absolute) */
230 video_panning_value_y = 0, /* Video mode y panning value (absolute) */
231 video_panning_factor_x = 0, /* Video mode x panning value (-127 +127) */
232 video_panning_factor_y = 0, /* Video mode y panning value (-127 +127) */
233 console_col = 0, /* Cursor col */
234 console_row = 0, /* Cursor row */
235 video_palette[16]; /* Our palette */
237 static const int video_font_draw_table[] =
238 { 0x00000000, 0x0000ffff, 0xffff0000, 0xffffffff };
241 video_color_fg = 0, /* Current fg color index (0-15) */
242 video_color_bg = 0, /* Current bg color index (0-15) */
243 video_enable = 0; /* Video has been initialized? */
246 *video_fb_address, /* Frame buffer address */
247 *video_console_address; /* Console frame buffer start address */
249 /************************************************************************/
250 /* ** MEMORY FUNCTIONS (32bit) */
251 /************************************************************************/
253 static void memsetl (int *p, int c, int v)
259 static void memcpyl (int *d, int *s, int c)
265 /************************************************************************/
266 /* ** VIDEO DRAWING AND COLOR FUNCTIONS */
267 /************************************************************************/
269 static int video_maprgb (int r, int g, int b)
271 #ifdef VIDEO_MODE_YUYV
272 unsigned int pR, pG, pB;
274 unsigned int *ret = (unsigned int *) &YUYV;
276 /* Transform (0-255) components to (0-100) */
282 /* Calculate YUV values (0-255) from RGB beetween 0-100 */
284 YUYV.Y1 = YUYV.Y2 = 209 * (pR + pG + pB) / 300 + 16;
285 YUYV.U = pR - (pG * 3 / 4) - (pB / 4) + 128;
286 YUYV.V = pB - (pR / 4) - (pG * 3 / 4) + 128;
289 #ifdef VIDEO_MODE_RGB
290 return ((r >> 3) << 11) | ((g > 2) << 6) | (b >> 3);
294 static void video_setpalette (int color, int r, int g, int b)
298 video_palette[color] = video_maprgb (r, g, b);
300 /* Swap values if our panning offset is odd */
301 if (video_panning_value_x & 1)
302 video_palette[color] = SWAPINT (video_palette[color]);
305 static void video_fill (int color)
307 memsetl (video_fb_address, VIDEO_PIX_BLOCKS, color);
310 static void video_setfgcolor (int i)
312 video_color_fg = i & 0xf;
315 static void video_setbgcolor (int i)
317 video_color_bg = i & 0xf;
320 static int video_pickcolor (int i)
322 return video_palette[i & 0xf];
325 /* Absolute console plotting functions */
328 static void video_revchar (int xx, int yy)
333 dest = video_fb_address + yy * VIDEO_LINE_LEN + xx * 2;
335 for (rows = VIDEO_FONT_HEIGHT; rows--; dest += VIDEO_LINE_LEN) {
336 switch (VIDEO_FONT_WIDTH) {
338 ((u32 *) dest)[6] ^= 0xffffffff;
339 ((u32 *) dest)[7] ^= 0xffffffff;
342 ((u32 *) dest)[4] ^= 0xffffffff;
343 ((u32 *) dest)[5] ^= 0xffffffff;
346 ((u32 *) dest)[2] ^= 0xffffffff;
347 ((u32 *) dest)[3] ^= 0xffffffff;
350 ((u32 *) dest)[0] ^= 0xffffffff;
351 ((u32 *) dest)[1] ^= 0xffffffff;
357 static void video_drawchars (int xx, int yy, unsigned char *s, int count)
359 u8 *cdat, *dest, *dest0;
363 offset = yy * VIDEO_LINE_LEN + xx * 2;
364 dest0 = video_fb_address + offset;
366 fgx = video_pickcolor (video_color_fg);
367 bgx = video_pickcolor (video_color_bg);
376 switch (VIDEO_FONT_WIDTH) {
381 cdat = video_fontdata + c * VIDEO_FONT_HEIGHT;
382 for (rows = VIDEO_FONT_HEIGHT, dest = dest0;
384 dest += VIDEO_LINE_LEN) {
388 (video_font_draw_table[bits >> 6] & eorx) ^ bgx;
390 (video_font_draw_table[bits >> 4 & 3] & eorx) ^ bgx;
391 if (VIDEO_FONT_WIDTH == 8) {
393 (video_font_draw_table[bits >> 2 & 3] & eorx) ^ bgx;
395 (video_font_draw_table[bits & 3] & eorx) ^ bgx;
398 dest0 += VIDEO_FONT_WIDTH * 2;
405 cdat = video_fontdata + (*s) * (VIDEO_FONT_HEIGHT << 1);
406 for (rows = VIDEO_FONT_HEIGHT, dest = dest0; rows--;
407 dest += VIDEO_LINE_LEN) {
411 (video_font_draw_table[bits >> 6] & eorx) ^ bgx;
413 (video_font_draw_table[bits >> 4 & 3] & eorx) ^ bgx;
415 (video_font_draw_table[bits >> 2 & 3] & eorx) ^ bgx;
417 (video_font_draw_table[bits & 3] & eorx) ^ bgx;
420 (video_font_draw_table[bits >> 6] & eorx) ^ bgx;
422 (video_font_draw_table[bits >> 4 & 3] & eorx) ^ bgx;
423 if (VIDEO_FONT_WIDTH == 16) {
425 (video_font_draw_table[bits >> 2 & 3] & eorx) ^ bgx;
427 (video_font_draw_table[bits & 3] & eorx) ^ bgx;
431 dest0 += VIDEO_FONT_WIDTH * 2;
437 static inline void video_drawstring (int xx, int yy, char *s)
439 video_drawchars (xx, yy, (unsigned char *)s, strlen (s));
442 /* Relative to console plotting functions */
444 static void video_putchars (int xx, int yy, unsigned char *s, int count)
446 #ifdef CONFIG_VIDEO_LOGO
447 video_drawchars (xx, yy + VIDEO_LOGO_HEIGHT, s, count);
449 video_drawchars (xx, yy, s, count);
453 static void video_putchar (int xx, int yy, unsigned char c)
455 #ifdef CONFIG_VIDEO_LOGO
456 video_drawchars (xx, yy + VIDEO_LOGO_HEIGHT, &c, 1);
458 video_drawchars (xx, yy, &c, 1);
462 static inline void video_putstring (int xx, int yy, unsigned char *s)
464 video_putchars (xx, yy, (unsigned char *)s, strlen ((char *)s));
467 /************************************************************************/
468 /* ** VIDEO CONTROLLER LOW-LEVEL FUNCTIONS */
469 /************************************************************************/
471 #if !defined(CONFIG_RRVISION)
472 static void video_mode_dupefield (VRAM * source, VRAM * dest, int entries)
476 for (i = 0; i < entries; i++) {
477 dest[i] = source[i]; /* Copy the entire record */
478 dest[i].fx = (!dest[i].fx) * 3; /* Negate field bit */
481 dest[0].lcyc++; /* Add a cycle to the first entry */
482 dest[entries - 1].lst = 1; /* Set end of ram entries */
486 static void inline video_mode_addentry (VRAM * vr,
487 int Hx, int Vx, int Fx, int Bx,
488 int VDS, int INT, int LCYC, int LP, int LST)
501 #define ADDENTRY(a,b,c,d,e,f,g,h,i) video_mode_addentry(&vr[entry++],a,b,c,d,e,f,g,h,i)
503 static int video_mode_generate (void)
505 immap_t *immap = (immap_t *) CONFIG_SYS_IMMR;
506 VRAM *vr = (VRAM *) (((void *) immap) + 0xb00); /* Pointer to the VRAM table */
507 int DX, X1, X2, DY, Y1, Y2, entry = 0, fifo;
509 /* CHECKING PARAMETERS */
511 if (video_panning_factor_y < -128)
512 video_panning_factor_y = -128;
514 if (video_panning_factor_y > 128)
515 video_panning_factor_y = 128;
517 if (video_panning_factor_x < -128)
518 video_panning_factor_x = -128;
520 if (video_panning_factor_x > 128)
521 video_panning_factor_x = 128;
523 /* Setting panning */
525 DX = video_panning_range_x = (VIDEO_ACTIVE_COLS - VIDEO_COLS) * 2;
526 DY = video_panning_range_y = (VIDEO_ACTIVE_ROWS - VIDEO_ROWS) / 2;
528 video_panning_value_x = (video_panning_factor_x + 128) * DX / 256;
529 video_panning_value_y = (video_panning_factor_y + 128) * DY / 256;
531 /* We assume these are burst units (multiplied by 2, we need it pari) */
532 X1 = video_panning_value_x & 0xfffe;
535 /* We assume these are field line units (divided by 2, we need it pari) */
536 Y1 = video_panning_value_y & 0xfffe;
539 debug("X1=%d, X2=%d, Y1=%d, Y2=%d, DX=%d, DY=%d VIDEO_COLS=%d \n",
540 X1, X2, Y1, Y2, DX, DY, VIDEO_COLS);
542 #ifdef VIDEO_MODE_NTSC
544 * Hx Vx Fx Bx VDS INT LCYC LP LST
548 ADDENTRY (0, 0, 3, 0, 1, 0, 3, 1, 0);
549 ADDENTRY (3, 0, 3, 0, 1, 0, 243, 0, 0);
550 ADDENTRY (3, 0, 3, 0, 1, 0, 1440, 0, 0);
551 ADDENTRY (3, 0, 3, 0, 1, 0, 32, 1, 0);
555 ADDENTRY (0, 0, 0, 0, 1, 0, 18, 1, 0);
556 ADDENTRY (3, 0, 0, 0, 1, 0, 243, 0, 0);
557 ADDENTRY (3, 0, 0, 0, 1, 0, 1440, 0, 0);
558 ADDENTRY (3, 0, 0, 0, 1, 0, 32, 1, 0);
560 * Odd field active area (TOP)
563 ADDENTRY (0, 0, 0, 0, 1, 0, Y1, 1, 0);
564 ADDENTRY (3, 0, 0, 0, 1, 0, 235, 0, 0);
565 ADDENTRY (3, 0, 0, 3, 1, 0, 1448, 0, 0);
566 ADDENTRY (3, 0, 0, 0, 1, 0, 32, 1, 0);
569 * Odd field active area
571 ADDENTRY (0, 0, 0, 0, 1, 0, 240 - DY, 1, 0);
572 ADDENTRY (3, 0, 0, 0, 1, 0, 235, 0, 0);
573 ADDENTRY (3, 0, 0, 3, 1, 0, 8 + X1, 0, 0);
574 ADDENTRY (3, 0, 0, 3, 0, 0, VIDEO_COLS * 2, 0, 0);
577 ADDENTRY (3, 0, 0, 3, 1, 0, X2, 0, 0);
579 ADDENTRY (3, 0, 0, 0, 1, 0, 32, 1, 0);
582 * Odd field active area (BOTTOM)
585 ADDENTRY (0, 0, 0, 0, 1, 0, Y2, 1, 0);
586 ADDENTRY (3, 0, 0, 0, 1, 0, 235, 0, 0);
587 ADDENTRY (3, 0, 0, 3, 1, 0, 1448, 0, 0);
588 ADDENTRY (3, 0, 0, 0, 1, 0, 32, 1, 0);
593 ADDENTRY (0, 0, 0, 0, 1, 0, 4, 1, 0);
594 ADDENTRY (3, 0, 0, 0, 1, 0, 243, 0, 0);
595 ADDENTRY (3, 0, 0, 0, 1, 0, 1440, 0, 0);
596 ADDENTRY (3, 0, 0, 0, 1, 0, 32, 1, 0);
600 ADDENTRY (0, 0, 3, 0, 1, 0, 19, 1, 0);
601 ADDENTRY (3, 0, 3, 0, 1, 0, 243, 0, 0);
602 ADDENTRY (3, 0, 3, 0, 1, 0, 1440, 0, 0);
603 ADDENTRY (3, 0, 3, 0, 1, 0, 32, 1, 0);
605 * Even field active area (TOP)
608 ADDENTRY (0, 0, 3, 0, 1, 0, Y1, 1, 0);
609 ADDENTRY (3, 0, 3, 0, 1, 0, 235, 0, 0);
610 ADDENTRY (3, 0, 3, 3, 1, 0, 1448, 0, 0);
611 ADDENTRY (3, 0, 3, 0, 1, 0, 32, 1, 0);
614 * Even field active area (CENTER)
616 ADDENTRY (0, 0, 3, 0, 1, 0, 240 - DY, 1, 0);
617 ADDENTRY (3, 0, 3, 0, 1, 0, 235, 0, 0);
618 ADDENTRY (3, 0, 3, 3, 1, 0, 8 + X1, 0, 0);
619 ADDENTRY (3, 0, 3, 3, 0, 0, VIDEO_COLS * 2, 0, 0);
622 ADDENTRY (3, 0, 3, 3, 1, 0, X2, 0, 0);
624 ADDENTRY (3, 0, 3, 0, 1, 0, 32, 1, 0);
626 * Even field active area (BOTTOM)
629 ADDENTRY (0, 0, 3, 0, 1, 0, Y2, 1, 0);
630 ADDENTRY (3, 0, 3, 0, 1, 0, 235, 0, 0);
631 ADDENTRY (3, 0, 3, 3, 1, 0, 1448, 0, 0);
632 ADDENTRY (3, 0, 3, 0, 1, 0, 32, 1, 0);
637 ADDENTRY (0, 0, 3, 0, 1, 0, 1, 1, 0);
638 ADDENTRY (3, 0, 3, 0, 1, 0, 243, 0, 0);
639 ADDENTRY (3, 0, 3, 0, 1, 0, 1440, 0, 0);
640 ADDENTRY (3, 0, 3, 0, 1, 1, 32, 1, 1);
643 #ifdef VIDEO_MODE_PAL
645 #if defined(CONFIG_RRVISION)
647 #define HPW 160 /* horizontal pulse width (was 139) */
648 #define VPW 2 /* vertical pulse width */
649 #define HBP 104 /* horizontal back porch (was 112) */
650 #define VBP 19 /* vertical back porch (was 19) */
651 #define VID_R 240 /* number of rows */
653 debug ("[VIDEO CTRL] Starting to add controller entries...");
657 ADDENTRY (0, 3, 0, 3, 1, 0, 2, 0, 0);
658 ADDENTRY (0, 0, 0, 3, 1, 0, HPW, 0, 0);
659 ADDENTRY (3, 0, 0, 3, 1, 0, HBP + (VIDEO_COLS * 2) + 72, 0, 0);
661 ADDENTRY (0, 0, 0, 3, 1, 0, VPW, 1, 0);
662 ADDENTRY (0, 0, 0, 3, 1, 0, HPW-1, 0, 0);
663 ADDENTRY (3, 0, 0, 3, 1, 0, HBP + (VIDEO_COLS * 2) + 72, 1, 0);
665 ADDENTRY (0, 3, 0, 3, 1, 0, VBP, 1, 0);
666 ADDENTRY (0, 3, 0, 3, 1, 0, HPW-1, 0, 0);
667 ADDENTRY (3, 3, 0, 3, 1, 0, HBP + (VIDEO_COLS * 2) + 72, 1, 0);
671 ADDENTRY (0, 3, 0, 3, 1, 0, VID_R , 1, 0);
672 ADDENTRY (0, 3, 0, 3, 1, 0, HPW-1, 0, 0);
673 ADDENTRY (3, 3, 0, 3, 1, 0, HBP, 0, 0);
674 ADDENTRY (3, 3, 0, 3, 0, 0, VIDEO_COLS*2, 0, 0);
675 ADDENTRY (3, 3, 0, 3, 1, 0, 72, 1, 1);
677 ADDENTRY (0, 3, 0, 3, 1, 0, 51, 1, 0);
678 ADDENTRY (0, 3, 0, 3, 1, 0, HPW-1, 0, 0);
679 ADDENTRY (3, 3, 0, 3, 1, 0, HBP +(VIDEO_COLS * 2) + 72 , 1, 0);
683 ADDENTRY (0, 3, 0, 3, 1, 0, 2, 0, 0);
684 ADDENTRY (0, 0, 0, 3, 1, 0, HPW, 0, 0);
685 ADDENTRY (3, 0, 0, 3, 1, 0, HBP + (VIDEO_COLS * 2) + 72, 0, 0);
687 ADDENTRY (0, 0, 0, 3, 1, 0, VPW+1, 1, 0);
688 ADDENTRY (0, 0, 0, 3, 1, 0, HPW-1, 0, 0);
689 ADDENTRY (3, 0, 0, 3, 1, 0, HBP + (VIDEO_COLS * 2) + 72, 1, 0);
691 ADDENTRY (0, 3, 0, 3, 1, 0, VBP, 1, 0);
692 ADDENTRY (0, 3, 0, 3, 1, 0, HPW-1, 0, 0);
693 ADDENTRY (3, 3, 0, 3, 1, 0, HBP + (VIDEO_COLS * 2) + 72, 1, 0);
697 ADDENTRY (0, 3, 0, 3, 1, 0, VID_R , 1, 0);
698 ADDENTRY (0, 3, 0, 3, 1, 0, HPW-1, 0, 0);
699 ADDENTRY (3, 3, 0, 3, 1, 0, HBP, 0, 0);
700 ADDENTRY (3, 3, 0, 3, 0, 0, VIDEO_COLS*2, 0, 0);
701 ADDENTRY (3, 3, 0, 3, 1, 0, 72, 1, 1);
703 ADDENTRY (0, 3, 0, 3, 1, 0, 51, 1, 0);
704 ADDENTRY (0, 3, 0, 3, 1, 0, HPW-1, 0, 0);
705 ADDENTRY (3, 3, 0, 3, 1, 0, HBP +(VIDEO_COLS * 2) + 72 , 1, 0);
709 #else /* !CONFIG_RRVISION */
712 * Hx Vx Fx Bx VDS INT LCYC LP LST
716 ADDENTRY (0, 0, 0, 0, 1, 0, 22, 1, 0);
717 ADDENTRY (3, 0, 0, 0, 1, 0, 263, 0, 0);
718 ADDENTRY (3, 0, 0, 0, 1, 0, 1440, 0, 0);
719 ADDENTRY (3, 0, 0, 0, 1, 0, 24, 1, 0);
724 ADDENTRY (0, 0, 0, 0, 1, 0, Y1, 1, 0); /* 11? */
725 ADDENTRY (3, 0, 0, 0, 1, 0, 255, 0, 0);
726 ADDENTRY (3, 0, 0, 3, 1, 0, 1448, 0, 0);
727 ADDENTRY (3, 0, 0, 0, 1, 0, 24, 1, 0);
730 * field active area (CENTER)
732 ADDENTRY (0, 0, 0, 0, 1, 0, 288 - DY, 1, 0); /* 265? */
733 ADDENTRY (3, 0, 0, 0, 1, 0, 255, 0, 0);
734 ADDENTRY (3, 0, 0, 3, 1, 0, 8 + X1, 0, 0);
735 ADDENTRY (3, 0, 0, 3, 0, 0, VIDEO_COLS * 2, 0, 0);
738 ADDENTRY (3, 0, 0, 1, 1, 0, X2, 0, 0);
740 ADDENTRY (3, 0, 0, 0, 1, 0, 24, 1, 0);
742 * field active area (BOTTOM)
745 ADDENTRY (0, 0, 0, 0, 1, 0, Y2, 1, 0); /* 12? */
746 ADDENTRY (3, 0, 0, 0, 1, 0, 255, 0, 0);
747 ADDENTRY (3, 0, 0, 3, 1, 0, 1448, 0, 0);
748 ADDENTRY (3, 0, 0, 0, 1, 0, 24, 1, 0);
751 * field vertical; blanking
753 ADDENTRY (0, 0, 0, 0, 1, 0, 2, 1, 0);
754 ADDENTRY (3, 0, 0, 0, 1, 0, 263, 0, 0);
755 ADDENTRY (3, 0, 0, 0, 1, 0, 1440, 0, 0);
756 ADDENTRY (3, 0, 0, 0, 1, 0, 24, 1, 0);
758 * Create the other field (like this, but whit other field selected,
759 * one more cycle loop and a last identifier)
761 video_mode_dupefield (vr, &vr[entry], entry);
762 #endif /* CONFIG_RRVISION */
764 #endif /* VIDEO_MODE_PAL */
766 /* See what FIFO are we using */
767 fifo = GETBIT (immap->im_vid.vid_vsr, VIDEO_VSR_CAS);
769 /* Set number of lines and burst (only one frame for now) */
771 immap->im_vid.vid_vfcr0 = VIDEO_BURST_LEN |
772 (VIDEO_BURST_LEN << 8) | ((VIDEO_ROWS / 2) << 19);
774 immap->im_vid.vid_vfcr1 = VIDEO_BURST_LEN |
775 (VIDEO_BURST_LEN << 8) | ((VIDEO_ROWS / 2) << 19);
778 SETBIT (immap->im_vid.vid_vcmr, VIDEO_VCMR_ASEL, !fifo);
781 * Wait until changes are applied (not done)
782 * while (GETBIT(immap->im_vid.vid_vsr, VIDEO_VSR_CAS) == fifo) ;
785 /* Return number of VRAM entries */
789 static void video_encoder_init (void)
794 /* Initialize the I2C */
795 debug ("[VIDEO ENCODER] Initializing I2C bus...\n");
796 #ifdef CONFIG_SYS_I2C
799 i2c_init (CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
803 /* Reset ADV7176 chip */
804 debug ("[VIDEO ENCODER] Resetting encoder...\n");
805 (*(int *) BCSR4) &= ~(1 << 21);
807 /* Wait for 5 ms inside the reset */
808 debug ("[VIDEO ENCODER] Waiting for encoder reset...\n");
811 /* Take ADV7176 out of reset */
812 (*(int *) BCSR4) |= 1 << 21;
814 /* Wait for 5 ms after the reset */
816 #endif /* CONFIG_FADS */
818 /* Send configuration */
823 puts ("[VIDEO ENCODER] Configuring the encoder...\n");
825 printf ("Sending %zu bytes (@ %08lX) to I2C 0x%lX:\n ",
826 sizeof(video_encoder_data),
827 (ulong)video_encoder_data,
828 (ulong)VIDEO_I2C_ADDR);
829 for (i=0; i<sizeof(video_encoder_data); ++i) {
830 printf(" %02X", video_encoder_data[i]);
836 if ((rc = i2c_write (VIDEO_I2C_ADDR, 0, 1,
838 sizeof(video_encoder_data))) != 0) {
839 printf ("i2c_send error: rc=%d\n", rc);
842 #endif /* VIDEO_I2C */
846 static void video_ctrl_init (void *memptr)
848 immap_t *immap = (immap_t *) CONFIG_SYS_IMMR;
850 video_fb_address = memptr;
853 debug ("[VIDEO CTRL] Setting background color...\n");
854 immap->im_vid.vid_vbcb = VIDEO_BG_COL;
856 /* Show the background */
857 debug ("[VIDEO CTRL] Forcing background...\n");
858 SETBIT (immap->im_vid.vid_vcmr, VIDEO_VCMR_BD, 1);
860 /* Turn off video controller */
861 debug ("[VIDEO CTRL] Turning off video controller...\n");
862 SETBIT (immap->im_vid.vid_vccr, VIDEO_VCCR_VON, 0);
865 /* Turn on Video Port LED */
866 debug ("[VIDEO CTRL] Turning off video port led...\n");
867 SETBIT (*(int *) BCSR4, VIDEO_BCSR4_VIDLED_BIT, 1);
869 /* Disable internal clock */
870 debug ("[VIDEO CTRL] Disabling internal clock...\n");
871 SETBIT (*(int *) BCSR4, VIDEO_BCSR4_EXTCLK_BIT, 0);
874 /* Generate and make active a new video mode */
875 debug ("[VIDEO CTRL] Generating video mode...\n");
876 video_mode_generate ();
878 /* Start of frame buffer (even and odd frame, to make it working with */
879 /* any selected active set) */
880 debug ("[VIDEO CTRL] Setting frame buffer address...\n");
881 immap->im_vid.vid_vfaa1 =
882 immap->im_vid.vid_vfaa0 = (u32) video_fb_address;
883 immap->im_vid.vid_vfba1 =
884 immap->im_vid.vid_vfba0 =
885 (u32) video_fb_address + VIDEO_LINE_LEN;
887 /* YUV, Big endian, SHIFT/CLK/CLK input (BEFORE ENABLING 27MHZ EXT CLOCK) */
888 debug ("[VIDEO CTRL] Setting pixel mode and clocks...\n");
889 immap->im_vid.vid_vccr = 0x2042;
891 /* Configure port pins */
892 debug ("[VIDEO CTRL] Configuring input/output pins...\n");
893 immap->im_ioport.iop_pdpar = 0x1fff;
894 immap->im_ioport.iop_pddir = 0x0000;
897 /* Turn on Video Port Clock - ONLY AFTER SET VCCR TO ENABLE EXTERNAL CLOCK */
898 debug ("[VIDEO CTRL] Turning on video clock...\n");
899 SETBIT (*(int *) BCSR4, VIDEO_BCSR4_EXTCLK_BIT, 1);
901 /* Turn on Video Port LED */
902 debug ("[VIDEO CTRL] Turning on video port led...\n");
903 SETBIT (*(int *) BCSR4, VIDEO_BCSR4_VIDLED_BIT, 0);
905 #ifdef CONFIG_RRVISION
906 debug ("PC5->Output(1): enable PAL clock");
907 immap->im_ioport.iop_pcpar &= ~(0x0400);
908 immap->im_ioport.iop_pcdir |= 0x0400 ;
909 immap->im_ioport.iop_pcdat |= 0x0400 ;
910 debug ("PDPAR=0x%04X PDDIR=0x%04X PDDAT=0x%04X\n",
911 immap->im_ioport.iop_pdpar,
912 immap->im_ioport.iop_pddir,
913 immap->im_ioport.iop_pddat);
914 debug ("PCPAR=0x%04X PCDIR=0x%04X PCDAT=0x%04X\n",
915 immap->im_ioport.iop_pcpar,
916 immap->im_ioport.iop_pcdir,
917 immap->im_ioport.iop_pcdat);
918 #endif /* CONFIG_RRVISION */
920 /* Blanking the screen. */
921 debug ("[VIDEO CTRL] Blanking the screen...\n");
922 video_fill (VIDEO_BG_COL);
925 * Turns on Aggressive Mode. Normally, turning on the caches
926 * will cause the screen to flicker when the caches try to
927 * fill. This gives the FIFO's for the Video Controller
928 * higher priority and prevents flickering because of
929 * underrun. This may still be an issue when using FLASH,
930 * since accessing data from Flash is so slow.
932 debug ("[VIDEO CTRL] Turning on aggressive mode...\n");
933 immap->im_siu_conf.sc_sdcr = 0x40;
935 /* Turn on video controller */
936 debug ("[VIDEO CTRL] Turning on video controller...\n");
937 SETBIT (immap->im_vid.vid_vccr, VIDEO_VCCR_VON, 1);
939 /* Show the display */
940 debug ("[VIDEO CTRL] Enabling the video...\n");
941 SETBIT (immap->im_vid.vid_vcmr, VIDEO_VCMR_BD, 0);
944 /************************************************************************/
945 /* ** CONSOLE FUNCTIONS */
946 /************************************************************************/
948 static void console_scrollup (void)
950 /* Copy up rows ignoring the first one */
951 memcpyl (CONSOLE_ROW_FIRST, CONSOLE_ROW_SECOND, CONSOLE_SCROLL_SIZE >> 2);
953 /* Clear the last one */
954 memsetl (CONSOLE_ROW_LAST, CONSOLE_ROW_SIZE >> 2, VIDEO_BG_COL);
957 static inline void console_back (void)
961 if (console_col < 0) {
962 console_col = CONSOLE_COLS - 1;
968 video_putchar ( console_col * VIDEO_FONT_WIDTH,
969 console_row * VIDEO_FONT_HEIGHT, ' ');
972 static inline void console_newline (void)
977 /* Check if we need to scroll the terminal */
978 if (console_row >= CONSOLE_ROWS) {
979 /* Scroll everything up */
982 /* Decrement row number */
987 void video_putc (const char c)
995 case 13: /* Simply ignore this */
998 case '\n': /* Next line, please */
1002 case 9: /* Tab (8 chars alignment) */
1003 console_col |= 0x0008; /* Next 8 chars boundary */
1004 console_col &= ~0x0007; /* Set this bit to zero */
1006 if (console_col >= CONSOLE_COLS)
1010 case 8: /* Eat last character */
1014 default: /* Add to the console */
1015 video_putchar ( console_col * VIDEO_FONT_WIDTH,
1016 console_row * VIDEO_FONT_HEIGHT, c);
1018 /* Check if we need to go to next row */
1019 if (console_col >= CONSOLE_COLS)
1024 void video_puts (const char *s)
1026 int count = strlen (s);
1036 /************************************************************************/
1037 /* ** CURSOR BLINKING FUNCTIONS */
1038 /************************************************************************/
1042 #define BLINK_TIMER_ID 0
1043 #define BLINK_TIMER_HZ 2
1045 static unsigned char blink_enabled = 0;
1046 static timer_t blink_timer;
1048 static void blink_update (void)
1050 static int blink_row = -1, blink_col = -1, blink_old = 0;
1052 /* Check if we have a new position to invert */
1053 if ((console_row != blink_row) || (console_col != blink_col)) {
1054 /* Check if we need to reverse last character */
1056 video_revchar ( blink_col * VIDEO_FONT_WIDTH,
1058 #ifdef CONFIG_VIDEO_LOGO
1061 ) * VIDEO_FONT_HEIGHT);
1064 blink_row = console_row;
1065 blink_col = console_col;
1069 /* Reverse this character */
1070 blink_old = !blink_old;
1071 video_revchar ( console_col * VIDEO_FONT_WIDTH,
1073 #ifdef CONFIG_VIDEO_LOGO
1076 ) * VIDEO_FONT_HEIGHT);
1081 * Handler for blinking cursor
1083 static void blink_handler (void *arg)
1088 timer_ack (&blink_timer);
1091 int blink_set (int blink)
1093 int ret = blink_enabled;
1096 timer_enable (&blink_timer);
1098 timer_disable (&blink_timer);
1100 blink_enabled = blink;
1105 static inline void blink_close (void)
1107 timer_close (&blink_timer);
1110 static inline void blink_init (void)
1112 timer_init (&blink_timer,
1113 BLINK_TIMER_ID, BLINK_TIMER_HZ,
1118 /************************************************************************/
1119 /* ** LOGO PLOTTING FUNCTIONS */
1120 /************************************************************************/
1122 #ifdef CONFIG_VIDEO_LOGO
1123 void easylogo_plot (fastimage_t * image, void *screen, int width, int x,
1126 int skip = width - image->width, xcount, ycount = image->height;
1128 #ifdef VIDEO_MODE_YUYV
1129 ushort *source = (ushort *) image->data;
1130 ushort *dest = (ushort *) screen + y * width + x;
1133 xcount = image->width;
1135 *dest++ = *source++;
1139 #ifdef VIDEO_MODE_RGB
1141 *source = (unsigned short *) image->data,
1142 *dest = (unsigned short *) screen + ((y * width) + x) * 3;
1145 xcount = image->width * 3;
1146 memcpy (dest, source, xcount);
1153 static void *video_logo (void)
1155 u16 *screen = video_fb_address, width = VIDEO_COLS;
1157 # ifndef CONFIG_FADS
1161 #endif /* VIDEO_INFO */
1163 easylogo_plot (VIDEO_LOGO_ADDR, screen, width, 0, 0);
1166 sprintf (info, "%s (%s - %s) ",
1167 U_BOOT_VERSION, U_BOOT_DATE, U_BOOT_TIME);
1168 video_drawstring (VIDEO_INFO_X, VIDEO_INFO_Y, info);
1170 sprintf (info, "(C) 2002 DENX Software Engineering");
1171 video_drawstring (VIDEO_INFO_X, VIDEO_INFO_Y + VIDEO_FONT_HEIGHT,
1174 sprintf (info, " Wolfgang DENK, wd@denx.de");
1175 video_drawstring (VIDEO_INFO_X, VIDEO_INFO_Y + VIDEO_FONT_HEIGHT * 2,
1177 #ifndef CONFIG_FADS /* all normal boards */
1178 /* leave one blank line */
1180 sprintf (info, "MPC823 CPU at %s MHz, %ld MB RAM, %ld MB Flash",
1181 strmhz(temp, gd->cpu_clk),
1183 gd->bd->bi_flashsize >> 20 );
1184 video_drawstring (VIDEO_INFO_X, VIDEO_INFO_Y + VIDEO_FONT_HEIGHT * 4,
1186 #else /* FADS :-( */
1187 sprintf (info, "MPC823 CPU at 50 MHz on FADS823 board");
1188 video_drawstring (VIDEO_INFO_X, VIDEO_INFO_Y + VIDEO_FONT_HEIGHT,
1191 sprintf (info, "2MB FLASH - 8MB DRAM - 4MB SRAM");
1192 video_drawstring (VIDEO_INFO_X, VIDEO_INFO_Y + VIDEO_FONT_HEIGHT * 2,
1197 return video_fb_address + VIDEO_LOGO_HEIGHT * VIDEO_LINE_LEN;
1201 /************************************************************************/
1202 /* ** VIDEO HIGH-LEVEL FUNCTIONS */
1203 /************************************************************************/
1205 static int video_init (void *videobase)
1207 /* Initialize the encoder */
1208 debug ("[VIDEO] Initializing video encoder...\n");
1209 video_encoder_init ();
1211 /* Initialize the video controller */
1212 debug ("[VIDEO] Initializing video controller at %08x...\n",
1214 video_ctrl_init (videobase);
1216 /* Setting the palette */
1217 video_setpalette (CONSOLE_COLOR_BLACK, 0, 0, 0);
1218 video_setpalette (CONSOLE_COLOR_RED, 0xFF, 0, 0);
1219 video_setpalette (CONSOLE_COLOR_GREEN, 0, 0xFF, 0);
1220 video_setpalette (CONSOLE_COLOR_YELLOW, 0xFF, 0xFF, 0);
1221 video_setpalette (CONSOLE_COLOR_BLUE, 0, 0, 0xFF);
1222 video_setpalette (CONSOLE_COLOR_MAGENTA, 0xFF, 0, 0xFF);
1223 video_setpalette (CONSOLE_COLOR_CYAN, 0, 0xFF, 0xFF);
1224 video_setpalette (CONSOLE_COLOR_GREY, 0xAA, 0xAA, 0xAA);
1225 video_setpalette (CONSOLE_COLOR_GREY2, 0xF8, 0xF8, 0xF8);
1226 video_setpalette (CONSOLE_COLOR_WHITE, 0xFF, 0xFF, 0xFF);
1228 #ifndef CONFIG_SYS_WHITE_ON_BLACK
1229 video_setfgcolor (CONSOLE_COLOR_BLACK);
1230 video_setbgcolor (CONSOLE_COLOR_GREY2);
1232 video_setfgcolor (CONSOLE_COLOR_GREY2);
1233 video_setbgcolor (CONSOLE_COLOR_BLACK);
1234 #endif /* CONFIG_SYS_WHITE_ON_BLACK */
1236 #ifdef CONFIG_VIDEO_LOGO
1237 /* Paint the logo and retrieve tv base address */
1238 debug ("[VIDEO] Drawing the logo...\n");
1239 video_console_address = video_logo ();
1241 video_console_address = video_fb_address;
1245 /* Enable the blinking (under construction) */
1247 blink_set (0); /* To Fix! */
1250 /* Initialize the console */
1255 #ifdef VIDEO_MODE_PAL
1256 # define VIDEO_MODE_TMP1 "PAL"
1258 #ifdef VIDEO_MODE_NTSC
1259 # define VIDEO_MODE_TMP1 "NTSC"
1261 #ifdef VIDEO_MODE_YUYV
1262 # define VIDEO_MODE_TMP2 "YCbYCr"
1264 #ifdef VIDEO_MODE_RGB
1265 # define VIDEO_MODE_TMP2 "RGB"
1267 debug ( VIDEO_MODE_TMP1
1268 " %dx%dx%d (" VIDEO_MODE_TMP2 ") on %s - console %dx%d\n",
1269 VIDEO_COLS, VIDEO_ROWS, VIDEO_MODE_BPP,
1270 VIDEO_ENCODER_NAME, CONSOLE_COLS, CONSOLE_ROWS);
1274 int drv_video_init (void)
1276 int error, devices = 1;
1278 struct stdio_dev videodev;
1280 video_init ((void *)(gd->fb_base)); /* Video initialization */
1282 /* Device initialization */
1284 memset (&videodev, 0, sizeof (videodev));
1286 strcpy (videodev.name, "video");
1287 videodev.ext = DEV_EXT_VIDEO; /* Video extensions */
1288 videodev.flags = DEV_FLAGS_OUTPUT; /* Output only */
1289 videodev.putc = video_putc; /* 'putc' function */
1290 videodev.puts = video_puts; /* 'puts' function */
1292 error = stdio_register (&videodev);
1294 return (error == 0) ? devices : error;
1297 /************************************************************************/
1298 /* ** ROM capable initialization part - needed to reserve FB memory */
1299 /************************************************************************/
1302 * This is called early in the system initialization to grab memory
1303 * for the video controller.
1304 * Returns new address for monitor, after reserving video buffer memory
1306 * Note that this is running from ROM, so no write access to global data.
1308 ulong video_setmem (ulong addr)
1310 /* Allocate pages for the frame buffer. */
1313 debug ("Reserving %dk for Video Framebuffer at: %08lx\n",
1314 VIDEO_SIZE>>10, addr);