mirror of
				https://source.denx.de/u-boot/u-boot.git
				synced 2025-11-04 10:21:25 +01:00 
			
		
		
		
	Fixed some broken instances of "#ifdef CMD_CFG_IDE" too. Those always evaluated TRUE, and thus were always compiled even when IDE really wasn't defined/wanted. Signed-off-by: Jon Loeliger <jdl@freescale.com>
		
			
				
	
	
		
			1275 lines
		
	
	
		
			37 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			1275 lines
		
	
	
		
			37 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * (C) Copyright 2002 ELTEC Elektronik AG
 | 
						|
 * Frank Gottschling <fgottschling@eltec.de>
 | 
						|
 *
 | 
						|
 * See file CREDITS for list of people who contributed to this
 | 
						|
 * project.
 | 
						|
 *
 | 
						|
 * This program is free software; you can redistribute it and/or
 | 
						|
 * modify it under the terms of the GNU General Public License as
 | 
						|
 * published by the Free Software Foundation; either version 2 of
 | 
						|
 * the License, or (at your option) any later version.
 | 
						|
 *
 | 
						|
 * This program is distributed in the hope that it will be useful,
 | 
						|
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
						|
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.	 See the
 | 
						|
 * GNU General Public License for more details.
 | 
						|
 *
 | 
						|
 * You should have received a copy of the GNU General Public License
 | 
						|
 * along with this program; if not, write to the Free Software
 | 
						|
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 | 
						|
 * MA 02111-1307 USA
 | 
						|
 */
 | 
						|
 | 
						|
/*
 | 
						|
 * cfb_console.c
 | 
						|
 *
 | 
						|
 * Color Framebuffer Console driver for 8/15/16/24/32 bits per pixel.
 | 
						|
 *
 | 
						|
 * At the moment only the 8x16 font is tested and the font fore- and
 | 
						|
 * background color is limited to black/white/gray colors. The Linux
 | 
						|
 * logo can be placed in the upper left corner and additional board
 | 
						|
 * information strings (that normaly goes to serial port) can be drawed.
 | 
						|
 *
 | 
						|
 * The console driver can use the standard PC keyboard interface (i8042)
 | 
						|
 * for character input. Character output goes to a memory mapped video
 | 
						|
 * framebuffer with little or big-endian organisation.
 | 
						|
 * With environment setting 'console=serial' the console i/o can be
 | 
						|
 * forced to serial port.
 | 
						|
 | 
						|
 The driver uses graphic specific defines/parameters/functions:
 | 
						|
 | 
						|
 (for SMI LynxE graphic chip)
 | 
						|
 | 
						|
 CONFIG_VIDEO_SMI_LYNXEM - use graphic driver for SMI 710,712,810
 | 
						|
 VIDEO_FB_LITTLE_ENDIAN	 - framebuffer organisation default: big endian
 | 
						|
 VIDEO_HW_RECTFILL	 - graphic driver supports hardware rectangle fill
 | 
						|
 VIDEO_HW_BITBLT	 - graphic driver supports hardware bit blt
 | 
						|
 | 
						|
 Console Parameters are set by graphic drivers global struct:
 | 
						|
 | 
						|
 VIDEO_VISIBLE_COLS	     - x resolution
 | 
						|
 VIDEO_VISIBLE_ROWS	     - y resolution
 | 
						|
 VIDEO_PIXEL_SIZE	     - storage size in byte per pixel
 | 
						|
 VIDEO_DATA_FORMAT	     - graphical data format GDF
 | 
						|
 VIDEO_FB_ADRS		     - start of video memory
 | 
						|
 | 
						|
 CONFIG_I8042_KBD	     - AT Keyboard driver for i8042
 | 
						|
 VIDEO_KBD_INIT_FCT	     - init function for keyboard
 | 
						|
 VIDEO_TSTC_FCT		     - keyboard_tstc function
 | 
						|
 VIDEO_GETC_FCT		     - keyboard_getc function
 | 
						|
 | 
						|
 CONFIG_CONSOLE_CURSOR	     - on/off drawing cursor is done with delay
 | 
						|
			       loop in VIDEO_TSTC_FCT (i8042)
 | 
						|
 CFG_CONSOLE_BLINK_COUNT     - value for delay loop - blink rate
 | 
						|
 CONFIG_CONSOLE_TIME	     - display time/date in upper right corner,
 | 
						|
			       needs CONFIG_CMD_DATE and CONFIG_CONSOLE_CURSOR
 | 
						|
 CONFIG_VIDEO_LOGO	     - display Linux Logo in upper left corner
 | 
						|
 CONFIG_VIDEO_BMP_LOGO	     - use bmp_logo instead of linux_logo
 | 
						|
 CONFIG_CONSOLE_EXTRA_INFO   - display additional board information strings
 | 
						|
			       that normaly goes to serial port. This define
 | 
						|
			       requires a board specific function:
 | 
						|
			       video_drawstring (VIDEO_INFO_X,
 | 
						|
						 VIDEO_INFO_Y + i*VIDEO_FONT_HEIGHT,
 | 
						|
						 info);
 | 
						|
			       that fills a info buffer at i=row.
 | 
						|
			       s.a: board/eltec/bab7xx.
 | 
						|
CONFIG_VGA_AS_SINGLE_DEVICE  - If set the framebuffer device will be initialised
 | 
						|
			       as an output only device. The Keyboard driver
 | 
						|
			       will not be set-up. This may be used, if you
 | 
						|
			       have none or more than one Keyboard devices
 | 
						|
			       (USB Keyboard, AT Keyboard).
 | 
						|
 | 
						|
CONFIG_VIDEO_SW_CURSOR:	     - Draws a cursor after the last character. No
 | 
						|
			       blinking is provided. Uses the macros CURSOR_SET
 | 
						|
			       and CURSOR_OFF.
 | 
						|
CONFIG_VIDEO_HW_CURSOR:	     - Uses the hardware cursor capability of the
 | 
						|
			       graphic chip. Uses the macro CURSOR_SET.
 | 
						|
			       ATTENTION: If booting an OS, the display driver
 | 
						|
			       must disable the hardware register of the graphic
 | 
						|
			       chip. Otherwise a blinking field is displayed
 | 
						|
*/
 | 
						|
 | 
						|
#include <common.h>
 | 
						|
 | 
						|
#ifdef CONFIG_CFB_CONSOLE
 | 
						|
 | 
						|
#include <malloc.h>
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
/* Console device defines with SMI graphic				     */
 | 
						|
/* Any other graphic must change this section				     */
 | 
						|
/*****************************************************************************/
 | 
						|
 | 
						|
#ifdef	CONFIG_VIDEO_SMI_LYNXEM
 | 
						|
 | 
						|
#define VIDEO_FB_LITTLE_ENDIAN
 | 
						|
#define VIDEO_HW_RECTFILL
 | 
						|
#define VIDEO_HW_BITBLT
 | 
						|
#endif
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
/* Defines for the CT69000 driver					     */
 | 
						|
/*****************************************************************************/
 | 
						|
#ifdef	CONFIG_VIDEO_CT69000
 | 
						|
 | 
						|
#define VIDEO_FB_LITTLE_ENDIAN
 | 
						|
#define VIDEO_HW_RECTFILL
 | 
						|
#define VIDEO_HW_BITBLT
 | 
						|
#endif
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
/* Defines for the SED13806 driver					     */
 | 
						|
/*****************************************************************************/
 | 
						|
#ifdef CONFIG_VIDEO_SED13806
 | 
						|
 | 
						|
#ifndef CONFIG_TOTAL5200
 | 
						|
#define VIDEO_FB_LITTLE_ENDIAN
 | 
						|
#endif
 | 
						|
#define VIDEO_HW_RECTFILL
 | 
						|
#define VIDEO_HW_BITBLT
 | 
						|
#endif
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
/* Defines for the SED13806 driver					     */
 | 
						|
/*****************************************************************************/
 | 
						|
#ifdef CONFIG_VIDEO_SM501
 | 
						|
 | 
						|
#ifdef CONFIG_HH405
 | 
						|
#define VIDEO_FB_LITTLE_ENDIAN
 | 
						|
#endif
 | 
						|
#endif
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
/* Include video_fb.h after definitions of VIDEO_HW_RECTFILL etc	     */
 | 
						|
/*****************************************************************************/
 | 
						|
#include <video_fb.h>
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
/* some Macros								     */
 | 
						|
/*****************************************************************************/
 | 
						|
#define VIDEO_VISIBLE_COLS	(pGD->winSizeX)
 | 
						|
#define VIDEO_VISIBLE_ROWS	(pGD->winSizeY)
 | 
						|
#define VIDEO_PIXEL_SIZE	(pGD->gdfBytesPP)
 | 
						|
#define VIDEO_DATA_FORMAT	(pGD->gdfIndex)
 | 
						|
#define VIDEO_FB_ADRS		(pGD->frameAdrs)
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
/* Console device defines with i8042 keyboard controller		     */
 | 
						|
/* Any other keyboard controller must change this section		     */
 | 
						|
/*****************************************************************************/
 | 
						|
 | 
						|
#ifdef	CONFIG_I8042_KBD
 | 
						|
#include <i8042.h>
 | 
						|
 | 
						|
#define VIDEO_KBD_INIT_FCT	i8042_kbd_init()
 | 
						|
#define VIDEO_TSTC_FCT		i8042_tstc
 | 
						|
#define VIDEO_GETC_FCT		i8042_getc
 | 
						|
#endif
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
/* Console device							     */
 | 
						|
/*****************************************************************************/
 | 
						|
 | 
						|
#include <version.h>
 | 
						|
#include <linux/types.h>
 | 
						|
#include <devices.h>
 | 
						|
#include <video_font.h>
 | 
						|
 | 
						|
#if defined(CONFIG_CMD_DATE)
 | 
						|
#include <rtc.h>
 | 
						|
#endif
 | 
						|
 | 
						|
#if defined(CONFIG_CMD_BMP) || defined(CONFIG_SPLASH_SCREEN)
 | 
						|
#include <watchdog.h>
 | 
						|
#include <bmp_layout.h>
 | 
						|
#endif
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
/* Cursor definition:							     */
 | 
						|
/* CONFIG_CONSOLE_CURSOR:  Uses a timer function (see drivers/i8042.c) to    */
 | 
						|
/*			   let the cursor blink. Uses the macros CURSOR_OFF  */
 | 
						|
/*			   and CURSOR_ON.				     */
 | 
						|
/* CONFIG_VIDEO_SW_CURSOR: Draws a cursor after the last character. No	     */
 | 
						|
/*			   blinking is provided. Uses the macros CURSOR_SET  */
 | 
						|
/*			   and CURSOR_OFF.				     */
 | 
						|
/* CONFIG_VIDEO_HW_CURSOR: Uses the hardware cursor capability of the	     */
 | 
						|
/*			   graphic chip. Uses the macro CURSOR_SET.	     */
 | 
						|
/*			   ATTENTION: If booting an OS, the display driver   */
 | 
						|
/*			   must disable the hardware register of the graphic */
 | 
						|
/*			   chip. Otherwise a blinking field is displayed     */
 | 
						|
/*****************************************************************************/
 | 
						|
#if !defined(CONFIG_CONSOLE_CURSOR) && \
 | 
						|
    !defined(CONFIG_VIDEO_SW_CURSOR) && \
 | 
						|
    !defined(CONFIG_VIDEO_HW_CURSOR)
 | 
						|
/* no Cursor defined */
 | 
						|
#define CURSOR_ON
 | 
						|
#define CURSOR_OFF
 | 
						|
#define CURSOR_SET
 | 
						|
#endif
 | 
						|
 | 
						|
#ifdef	CONFIG_CONSOLE_CURSOR
 | 
						|
#ifdef	CURSOR_ON
 | 
						|
#error	only one of CONFIG_CONSOLE_CURSOR,CONFIG_VIDEO_SW_CURSOR,CONFIG_VIDEO_HW_CURSOR can be defined
 | 
						|
#endif
 | 
						|
void	console_cursor (int state);
 | 
						|
#define CURSOR_ON  console_cursor(1);
 | 
						|
#define CURSOR_OFF console_cursor(0);
 | 
						|
#define CURSOR_SET
 | 
						|
#ifndef CONFIG_I8042_KBD
 | 
						|
#warning Cursor drawing on/off needs timer function s.a. drivers/i8042.c
 | 
						|
#endif
 | 
						|
#else
 | 
						|
#ifdef	CONFIG_CONSOLE_TIME
 | 
						|
#error	CONFIG_CONSOLE_CURSOR must be defined for CONFIG_CONSOLE_TIME
 | 
						|
#endif
 | 
						|
#endif /* CONFIG_CONSOLE_CURSOR */
 | 
						|
 | 
						|
#ifdef	CONFIG_VIDEO_SW_CURSOR
 | 
						|
#ifdef	CURSOR_ON
 | 
						|
#error	only one of CONFIG_CONSOLE_CURSOR,CONFIG_VIDEO_SW_CURSOR,CONFIG_VIDEO_HW_CURSOR can be defined
 | 
						|
#endif
 | 
						|
#define CURSOR_ON
 | 
						|
#define CURSOR_OFF video_putchar(console_col * VIDEO_FONT_WIDTH,\
 | 
						|
				 console_row * VIDEO_FONT_HEIGHT, ' ');
 | 
						|
#define CURSOR_SET video_set_cursor();
 | 
						|
#endif /* CONFIG_VIDEO_SW_CURSOR */
 | 
						|
 | 
						|
 | 
						|
#ifdef CONFIG_VIDEO_HW_CURSOR
 | 
						|
#ifdef	CURSOR_ON
 | 
						|
#error	only one of CONFIG_CONSOLE_CURSOR,CONFIG_VIDEO_SW_CURSOR,CONFIG_VIDEO_HW_CURSOR can be defined
 | 
						|
#endif
 | 
						|
#define CURSOR_ON
 | 
						|
#define CURSOR_OFF
 | 
						|
#define CURSOR_SET video_set_hw_cursor(console_col * VIDEO_FONT_WIDTH, \
 | 
						|
		  (console_row * VIDEO_FONT_HEIGHT) + VIDEO_LOGO_HEIGHT);
 | 
						|
#endif	/* CONFIG_VIDEO_HW_CURSOR */
 | 
						|
 | 
						|
#ifdef	CONFIG_VIDEO_LOGO
 | 
						|
#ifdef	CONFIG_VIDEO_BMP_LOGO
 | 
						|
#include <bmp_logo.h>
 | 
						|
#define VIDEO_LOGO_WIDTH	BMP_LOGO_WIDTH
 | 
						|
#define VIDEO_LOGO_HEIGHT	BMP_LOGO_HEIGHT
 | 
						|
#define VIDEO_LOGO_LUT_OFFSET	BMP_LOGO_OFFSET
 | 
						|
#define VIDEO_LOGO_COLORS	BMP_LOGO_COLORS
 | 
						|
 | 
						|
#else	/* CONFIG_VIDEO_BMP_LOGO */
 | 
						|
#define LINUX_LOGO_WIDTH	80
 | 
						|
#define LINUX_LOGO_HEIGHT	80
 | 
						|
#define LINUX_LOGO_COLORS	214
 | 
						|
#define LINUX_LOGO_LUT_OFFSET	0x20
 | 
						|
#define __initdata
 | 
						|
#include <linux_logo.h>
 | 
						|
#define VIDEO_LOGO_WIDTH	LINUX_LOGO_WIDTH
 | 
						|
#define VIDEO_LOGO_HEIGHT	LINUX_LOGO_HEIGHT
 | 
						|
#define VIDEO_LOGO_LUT_OFFSET	LINUX_LOGO_LUT_OFFSET
 | 
						|
#define VIDEO_LOGO_COLORS	LINUX_LOGO_COLORS
 | 
						|
#endif	/* CONFIG_VIDEO_BMP_LOGO */
 | 
						|
#define VIDEO_INFO_X		(VIDEO_LOGO_WIDTH)
 | 
						|
#define VIDEO_INFO_Y		(VIDEO_FONT_HEIGHT/2)
 | 
						|
#else	/* CONFIG_VIDEO_LOGO */
 | 
						|
#define VIDEO_LOGO_WIDTH	0
 | 
						|
#define VIDEO_LOGO_HEIGHT	0
 | 
						|
#endif	/* CONFIG_VIDEO_LOGO */
 | 
						|
 | 
						|
#define VIDEO_COLS		VIDEO_VISIBLE_COLS
 | 
						|
#define VIDEO_ROWS		VIDEO_VISIBLE_ROWS
 | 
						|
#define VIDEO_SIZE		(VIDEO_ROWS*VIDEO_COLS*VIDEO_PIXEL_SIZE)
 | 
						|
#define VIDEO_PIX_BLOCKS	(VIDEO_SIZE >> 2)
 | 
						|
#define VIDEO_LINE_LEN		(VIDEO_COLS*VIDEO_PIXEL_SIZE)
 | 
						|
#define VIDEO_BURST_LEN		(VIDEO_COLS/8)
 | 
						|
 | 
						|
#ifdef	CONFIG_VIDEO_LOGO
 | 
						|
#define CONSOLE_ROWS		((VIDEO_ROWS - VIDEO_LOGO_HEIGHT) / VIDEO_FONT_HEIGHT)
 | 
						|
#else
 | 
						|
#define CONSOLE_ROWS		(VIDEO_ROWS / VIDEO_FONT_HEIGHT)
 | 
						|
#endif
 | 
						|
 | 
						|
#define CONSOLE_COLS		(VIDEO_COLS / VIDEO_FONT_WIDTH)
 | 
						|
#define CONSOLE_ROW_SIZE	(VIDEO_FONT_HEIGHT * VIDEO_LINE_LEN)
 | 
						|
#define CONSOLE_ROW_FIRST	(video_console_address)
 | 
						|
#define CONSOLE_ROW_SECOND	(video_console_address + CONSOLE_ROW_SIZE)
 | 
						|
#define CONSOLE_ROW_LAST	(video_console_address + CONSOLE_SIZE - CONSOLE_ROW_SIZE)
 | 
						|
#define CONSOLE_SIZE		(CONSOLE_ROW_SIZE * CONSOLE_ROWS)
 | 
						|
#define CONSOLE_SCROLL_SIZE	(CONSOLE_SIZE - CONSOLE_ROW_SIZE)
 | 
						|
 | 
						|
/* Macros */
 | 
						|
#ifdef	VIDEO_FB_LITTLE_ENDIAN
 | 
						|
#define SWAP16(x)	 ((((x) & 0x00ff) << 8) | ( (x) >> 8))
 | 
						|
#define SWAP32(x)	 ((((x) & 0x000000ff) << 24) | (((x) & 0x0000ff00) << 8)|\
 | 
						|
			  (((x) & 0x00ff0000) >>  8) | (((x) & 0xff000000) >> 24) )
 | 
						|
#define SHORTSWAP32(x)	 ((((x) & 0x000000ff) <<  8) | (((x) & 0x0000ff00) >> 8)|\
 | 
						|
			  (((x) & 0x00ff0000) <<  8) | (((x) & 0xff000000) >> 8) )
 | 
						|
#else
 | 
						|
#define SWAP16(x)	 (x)
 | 
						|
#define SWAP32(x)	 (x)
 | 
						|
#define SHORTSWAP32(x)	 (x)
 | 
						|
#endif
 | 
						|
 | 
						|
#if defined(DEBUG) || defined(DEBUG_CFB_CONSOLE)
 | 
						|
#define PRINTD(x)	  printf(x)
 | 
						|
#else
 | 
						|
#define PRINTD(x)
 | 
						|
#endif
 | 
						|
 | 
						|
 | 
						|
#ifdef CONFIG_CONSOLE_EXTRA_INFO
 | 
						|
extern void video_get_info_str (    /* setup a board string: type, speed, etc. */
 | 
						|
    int line_number,	    /* location to place info string beside logo */
 | 
						|
    char *info		    /* buffer for info string */
 | 
						|
    );
 | 
						|
 | 
						|
#endif
 | 
						|
 | 
						|
/* Locals */
 | 
						|
static GraphicDevice *pGD;	/* Pointer to Graphic array */
 | 
						|
 | 
						|
static void *video_fb_address;		/* frame buffer address */
 | 
						|
static void *video_console_address;	/* console buffer start address */
 | 
						|
 | 
						|
static int console_col = 0; /* cursor col */
 | 
						|
static int console_row = 0; /* cursor row */
 | 
						|
 | 
						|
static u32 eorx, fgx, bgx;  /* color pats */
 | 
						|
 | 
						|
static const int video_font_draw_table8[] = {
 | 
						|
	    0x00000000, 0x000000ff, 0x0000ff00, 0x0000ffff,
 | 
						|
	    0x00ff0000, 0x00ff00ff, 0x00ffff00, 0x00ffffff,
 | 
						|
	    0xff000000, 0xff0000ff, 0xff00ff00, 0xff00ffff,
 | 
						|
	    0xffff0000, 0xffff00ff, 0xffffff00, 0xffffffff };
 | 
						|
 | 
						|
static const int video_font_draw_table15[] = {
 | 
						|
	    0x00000000, 0x00007fff, 0x7fff0000, 0x7fff7fff };
 | 
						|
 | 
						|
static const int video_font_draw_table16[] = {
 | 
						|
	    0x00000000, 0x0000ffff, 0xffff0000, 0xffffffff };
 | 
						|
 | 
						|
static const int video_font_draw_table24[16][3] = {
 | 
						|
	    { 0x00000000, 0x00000000, 0x00000000 },
 | 
						|
	    { 0x00000000, 0x00000000, 0x00ffffff },
 | 
						|
	    { 0x00000000, 0x0000ffff, 0xff000000 },
 | 
						|
	    { 0x00000000, 0x0000ffff, 0xffffffff },
 | 
						|
	    { 0x000000ff, 0xffff0000, 0x00000000 },
 | 
						|
	    { 0x000000ff, 0xffff0000, 0x00ffffff },
 | 
						|
	    { 0x000000ff, 0xffffffff, 0xff000000 },
 | 
						|
	    { 0x000000ff, 0xffffffff, 0xffffffff },
 | 
						|
	    { 0xffffff00, 0x00000000, 0x00000000 },
 | 
						|
	    { 0xffffff00, 0x00000000, 0x00ffffff },
 | 
						|
	    { 0xffffff00, 0x0000ffff, 0xff000000 },
 | 
						|
	    { 0xffffff00, 0x0000ffff, 0xffffffff },
 | 
						|
	    { 0xffffffff, 0xffff0000, 0x00000000 },
 | 
						|
	    { 0xffffffff, 0xffff0000, 0x00ffffff },
 | 
						|
	    { 0xffffffff, 0xffffffff, 0xff000000 },
 | 
						|
	    { 0xffffffff, 0xffffffff, 0xffffffff } };
 | 
						|
 | 
						|
static const int video_font_draw_table32[16][4] = {
 | 
						|
	    { 0x00000000, 0x00000000, 0x00000000, 0x00000000 },
 | 
						|
	    { 0x00000000, 0x00000000, 0x00000000, 0x00ffffff },
 | 
						|
	    { 0x00000000, 0x00000000, 0x00ffffff, 0x00000000 },
 | 
						|
	    { 0x00000000, 0x00000000, 0x00ffffff, 0x00ffffff },
 | 
						|
	    { 0x00000000, 0x00ffffff, 0x00000000, 0x00000000 },
 | 
						|
	    { 0x00000000, 0x00ffffff, 0x00000000, 0x00ffffff },
 | 
						|
	    { 0x00000000, 0x00ffffff, 0x00ffffff, 0x00000000 },
 | 
						|
	    { 0x00000000, 0x00ffffff, 0x00ffffff, 0x00ffffff },
 | 
						|
	    { 0x00ffffff, 0x00000000, 0x00000000, 0x00000000 },
 | 
						|
	    { 0x00ffffff, 0x00000000, 0x00000000, 0x00ffffff },
 | 
						|
	    { 0x00ffffff, 0x00000000, 0x00ffffff, 0x00000000 },
 | 
						|
	    { 0x00ffffff, 0x00000000, 0x00ffffff, 0x00ffffff },
 | 
						|
	    { 0x00ffffff, 0x00ffffff, 0x00000000, 0x00000000 },
 | 
						|
	    { 0x00ffffff, 0x00ffffff, 0x00000000, 0x00ffffff },
 | 
						|
	    { 0x00ffffff, 0x00ffffff, 0x00ffffff, 0x00000000 },
 | 
						|
	    { 0x00ffffff, 0x00ffffff, 0x00ffffff, 0x00ffffff } };
 | 
						|
 | 
						|
 | 
						|
int gunzip(void *, int, unsigned char *, unsigned long *);
 | 
						|
 | 
						|
/******************************************************************************/
 | 
						|
 | 
						|
static void video_drawchars (int xx, int yy, unsigned char *s, int count)
 | 
						|
{
 | 
						|
	u8 *cdat, *dest, *dest0;
 | 
						|
	int rows, offset, c;
 | 
						|
 | 
						|
	offset = yy * VIDEO_LINE_LEN + xx * VIDEO_PIXEL_SIZE;
 | 
						|
	dest0 = video_fb_address + offset;
 | 
						|
 | 
						|
	switch (VIDEO_DATA_FORMAT) {
 | 
						|
	case GDF__8BIT_INDEX:
 | 
						|
	case GDF__8BIT_332RGB:
 | 
						|
		while (count--) {
 | 
						|
			c = *s;
 | 
						|
			cdat = video_fontdata + c * VIDEO_FONT_HEIGHT;
 | 
						|
			for (rows = VIDEO_FONT_HEIGHT, dest = dest0;
 | 
						|
			     rows--;
 | 
						|
			     dest += VIDEO_LINE_LEN) {
 | 
						|
				u8 bits = *cdat++;
 | 
						|
 | 
						|
				((u32 *) dest)[0] = (video_font_draw_table8[bits >> 4] & eorx) ^ bgx;
 | 
						|
				((u32 *) dest)[1] = (video_font_draw_table8[bits & 15] & eorx) ^ bgx;
 | 
						|
			}
 | 
						|
			dest0 += VIDEO_FONT_WIDTH * VIDEO_PIXEL_SIZE;
 | 
						|
			s++;
 | 
						|
		}
 | 
						|
		break;
 | 
						|
 | 
						|
	case GDF_15BIT_555RGB:
 | 
						|
		while (count--) {
 | 
						|
			c = *s;
 | 
						|
			cdat = video_fontdata + c * VIDEO_FONT_HEIGHT;
 | 
						|
			for (rows = VIDEO_FONT_HEIGHT, dest = dest0;
 | 
						|
			     rows--;
 | 
						|
			     dest += VIDEO_LINE_LEN) {
 | 
						|
				u8 bits = *cdat++;
 | 
						|
 | 
						|
				((u32 *) dest)[0] = SHORTSWAP32 ((video_font_draw_table15 [bits >> 6] & eorx) ^ bgx);
 | 
						|
				((u32 *) dest)[1] = SHORTSWAP32 ((video_font_draw_table15 [bits >> 4 & 3] & eorx) ^ bgx);
 | 
						|
				((u32 *) dest)[2] = SHORTSWAP32 ((video_font_draw_table15 [bits >> 2 & 3] & eorx) ^ bgx);
 | 
						|
				((u32 *) dest)[3] = SHORTSWAP32 ((video_font_draw_table15 [bits & 3] & eorx) ^ bgx);
 | 
						|
			}
 | 
						|
			dest0 += VIDEO_FONT_WIDTH * VIDEO_PIXEL_SIZE;
 | 
						|
			s++;
 | 
						|
		}
 | 
						|
		break;
 | 
						|
 | 
						|
	case GDF_16BIT_565RGB:
 | 
						|
		while (count--) {
 | 
						|
			c = *s;
 | 
						|
			cdat = video_fontdata + c * VIDEO_FONT_HEIGHT;
 | 
						|
			for (rows = VIDEO_FONT_HEIGHT, dest = dest0;
 | 
						|
			     rows--;
 | 
						|
			     dest += VIDEO_LINE_LEN) {
 | 
						|
				u8 bits = *cdat++;
 | 
						|
 | 
						|
				((u32 *) dest)[0] = SHORTSWAP32 ((video_font_draw_table16 [bits >> 6] & eorx) ^ bgx);
 | 
						|
				((u32 *) dest)[1] = SHORTSWAP32 ((video_font_draw_table16 [bits >> 4 & 3] & eorx) ^ bgx);
 | 
						|
				((u32 *) dest)[2] = SHORTSWAP32 ((video_font_draw_table16 [bits >> 2 & 3] & eorx) ^ bgx);
 | 
						|
				((u32 *) dest)[3] = SHORTSWAP32 ((video_font_draw_table16 [bits & 3] & eorx) ^ bgx);
 | 
						|
			}
 | 
						|
			dest0 += VIDEO_FONT_WIDTH * VIDEO_PIXEL_SIZE;
 | 
						|
			s++;
 | 
						|
		}
 | 
						|
		break;
 | 
						|
 | 
						|
	case GDF_32BIT_X888RGB:
 | 
						|
		while (count--) {
 | 
						|
			c = *s;
 | 
						|
			cdat = video_fontdata + c * VIDEO_FONT_HEIGHT;
 | 
						|
			for (rows = VIDEO_FONT_HEIGHT, dest = dest0;
 | 
						|
			     rows--;
 | 
						|
			     dest += VIDEO_LINE_LEN) {
 | 
						|
				u8 bits = *cdat++;
 | 
						|
 | 
						|
				((u32 *) dest)[0] = SWAP32 ((video_font_draw_table32 [bits >> 4][0] & eorx) ^ bgx);
 | 
						|
				((u32 *) dest)[1] = SWAP32 ((video_font_draw_table32 [bits >> 4][1] & eorx) ^ bgx);
 | 
						|
				((u32 *) dest)[2] = SWAP32 ((video_font_draw_table32 [bits >> 4][2] & eorx) ^ bgx);
 | 
						|
				((u32 *) dest)[3] = SWAP32 ((video_font_draw_table32 [bits >> 4][3] & eorx) ^ bgx);
 | 
						|
				((u32 *) dest)[4] = SWAP32 ((video_font_draw_table32 [bits & 15][0] & eorx) ^ bgx);
 | 
						|
				((u32 *) dest)[5] = SWAP32 ((video_font_draw_table32 [bits & 15][1] & eorx) ^ bgx);
 | 
						|
				((u32 *) dest)[6] = SWAP32 ((video_font_draw_table32 [bits & 15][2] & eorx) ^ bgx);
 | 
						|
				((u32 *) dest)[7] = SWAP32 ((video_font_draw_table32 [bits & 15][3] & eorx) ^ bgx);
 | 
						|
			}
 | 
						|
			dest0 += VIDEO_FONT_WIDTH * VIDEO_PIXEL_SIZE;
 | 
						|
			s++;
 | 
						|
		}
 | 
						|
		break;
 | 
						|
 | 
						|
	case GDF_24BIT_888RGB:
 | 
						|
		while (count--) {
 | 
						|
			c = *s;
 | 
						|
			cdat = video_fontdata + c * VIDEO_FONT_HEIGHT;
 | 
						|
			for (rows = VIDEO_FONT_HEIGHT, dest = dest0;
 | 
						|
			     rows--;
 | 
						|
			     dest += VIDEO_LINE_LEN) {
 | 
						|
				u8 bits = *cdat++;
 | 
						|
 | 
						|
				((u32 *) dest)[0] = (video_font_draw_table24[bits >> 4][0] & eorx) ^ bgx;
 | 
						|
				((u32 *) dest)[1] = (video_font_draw_table24[bits >> 4][1] & eorx) ^ bgx;
 | 
						|
				((u32 *) dest)[2] = (video_font_draw_table24[bits >> 4][2] & eorx) ^ bgx;
 | 
						|
				((u32 *) dest)[3] = (video_font_draw_table24[bits & 15][0] & eorx) ^ bgx;
 | 
						|
				((u32 *) dest)[4] = (video_font_draw_table24[bits & 15][1] & eorx) ^ bgx;
 | 
						|
				((u32 *) dest)[5] = (video_font_draw_table24[bits & 15][2] & eorx) ^ bgx;
 | 
						|
			}
 | 
						|
			dest0 += VIDEO_FONT_WIDTH * VIDEO_PIXEL_SIZE;
 | 
						|
			s++;
 | 
						|
		}
 | 
						|
		break;
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
 | 
						|
static inline void video_drawstring (int xx, int yy, unsigned char *s)
 | 
						|
{
 | 
						|
	video_drawchars (xx, yy, s, strlen ((char *)s));
 | 
						|
}
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
 | 
						|
static void video_putchar (int xx, int yy, unsigned char c)
 | 
						|
{
 | 
						|
	video_drawchars (xx, yy + VIDEO_LOGO_HEIGHT, &c, 1);
 | 
						|
}
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
#if defined(CONFIG_CONSOLE_CURSOR) || defined(CONFIG_VIDEO_SW_CURSOR)
 | 
						|
static void video_set_cursor (void)
 | 
						|
{
 | 
						|
	/* swap drawing colors */
 | 
						|
	eorx = fgx;
 | 
						|
	fgx = bgx;
 | 
						|
	bgx = eorx;
 | 
						|
	eorx = fgx ^ bgx;
 | 
						|
	/* draw cursor */
 | 
						|
	video_putchar (console_col * VIDEO_FONT_WIDTH,
 | 
						|
		       console_row * VIDEO_FONT_HEIGHT,
 | 
						|
		       ' ');
 | 
						|
	/* restore drawing colors */
 | 
						|
	eorx = fgx;
 | 
						|
	fgx = bgx;
 | 
						|
	bgx = eorx;
 | 
						|
	eorx = fgx ^ bgx;
 | 
						|
}
 | 
						|
#endif
 | 
						|
/*****************************************************************************/
 | 
						|
#ifdef CONFIG_CONSOLE_CURSOR
 | 
						|
void console_cursor (int state)
 | 
						|
{
 | 
						|
	static int last_state = 0;
 | 
						|
 | 
						|
#ifdef CONFIG_CONSOLE_TIME
 | 
						|
	struct rtc_time tm;
 | 
						|
	char info[16];
 | 
						|
 | 
						|
	/* time update only if cursor is on (faster scroll) */
 | 
						|
	if (state) {
 | 
						|
		rtc_get (&tm);
 | 
						|
 | 
						|
		sprintf (info, " %02d:%02d:%02d ", tm.tm_hour, tm.tm_min,
 | 
						|
			 tm.tm_sec);
 | 
						|
		video_drawstring (VIDEO_VISIBLE_COLS - 10 * VIDEO_FONT_WIDTH,
 | 
						|
				  VIDEO_INFO_Y, (uchar *)info);
 | 
						|
 | 
						|
		sprintf (info, "%02d.%02d.%04d", tm.tm_mday, tm.tm_mon,
 | 
						|
			 tm.tm_year);
 | 
						|
		video_drawstring (VIDEO_VISIBLE_COLS - 10 * VIDEO_FONT_WIDTH,
 | 
						|
				  VIDEO_INFO_Y + 1 * VIDEO_FONT_HEIGHT, (uchar *)info);
 | 
						|
	}
 | 
						|
#endif
 | 
						|
 | 
						|
	if (state && (last_state != state)) {
 | 
						|
		video_set_cursor ();
 | 
						|
	}
 | 
						|
 | 
						|
	if (!state && (last_state != state)) {
 | 
						|
		/* clear cursor */
 | 
						|
		video_putchar (console_col * VIDEO_FONT_WIDTH,
 | 
						|
			       console_row * VIDEO_FONT_HEIGHT,
 | 
						|
			       ' ');
 | 
						|
	}
 | 
						|
 | 
						|
	last_state = state;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
 | 
						|
#ifndef VIDEO_HW_RECTFILL
 | 
						|
static void memsetl (int *p, int c, int v)
 | 
						|
{
 | 
						|
	while (c--)
 | 
						|
		*(p++) = v;
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
 | 
						|
#ifndef VIDEO_HW_BITBLT
 | 
						|
static void memcpyl (int *d, int *s, int c)
 | 
						|
{
 | 
						|
	while (c--)
 | 
						|
		*(d++) = *(s++);
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
 | 
						|
static void console_scrollup (void)
 | 
						|
{
 | 
						|
	/* copy up rows ignoring the first one */
 | 
						|
 | 
						|
#ifdef VIDEO_HW_BITBLT
 | 
						|
	video_hw_bitblt (VIDEO_PIXEL_SIZE,	/* bytes per pixel */
 | 
						|
			 0,	/* source pos x */
 | 
						|
			 VIDEO_LOGO_HEIGHT + VIDEO_FONT_HEIGHT, /* source pos y */
 | 
						|
			 0,	/* dest pos x */
 | 
						|
			 VIDEO_LOGO_HEIGHT,	/* dest pos y */
 | 
						|
			 VIDEO_VISIBLE_COLS,	/* frame width */
 | 
						|
			 VIDEO_VISIBLE_ROWS - VIDEO_LOGO_HEIGHT - VIDEO_FONT_HEIGHT	/* frame height */
 | 
						|
		);
 | 
						|
#else
 | 
						|
	memcpyl (CONSOLE_ROW_FIRST, CONSOLE_ROW_SECOND,
 | 
						|
		 CONSOLE_SCROLL_SIZE >> 2);
 | 
						|
#endif
 | 
						|
 | 
						|
	/* clear the last one */
 | 
						|
#ifdef VIDEO_HW_RECTFILL
 | 
						|
	video_hw_rectfill (VIDEO_PIXEL_SIZE,	/* bytes per pixel */
 | 
						|
			   0,	/* dest pos x */
 | 
						|
			   VIDEO_VISIBLE_ROWS - VIDEO_FONT_HEIGHT,	/* dest pos y */
 | 
						|
			   VIDEO_VISIBLE_COLS,	/* frame width */
 | 
						|
			   VIDEO_FONT_HEIGHT,	/* frame height */
 | 
						|
			   CONSOLE_BG_COL	/* fill color */
 | 
						|
		);
 | 
						|
#else
 | 
						|
	memsetl (CONSOLE_ROW_LAST, CONSOLE_ROW_SIZE >> 2, CONSOLE_BG_COL);
 | 
						|
#endif
 | 
						|
}
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
 | 
						|
static void console_back (void)
 | 
						|
{
 | 
						|
	CURSOR_OFF console_col--;
 | 
						|
 | 
						|
	if (console_col < 0) {
 | 
						|
		console_col = CONSOLE_COLS - 1;
 | 
						|
		console_row--;
 | 
						|
		if (console_row < 0)
 | 
						|
			console_row = 0;
 | 
						|
	}
 | 
						|
	video_putchar (console_col * VIDEO_FONT_WIDTH,
 | 
						|
		       console_row * VIDEO_FONT_HEIGHT,
 | 
						|
		       ' ');
 | 
						|
}
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
 | 
						|
static void console_newline (void)
 | 
						|
{
 | 
						|
	CURSOR_OFF console_row++;
 | 
						|
	console_col = 0;
 | 
						|
 | 
						|
	/* Check if we need to scroll the terminal */
 | 
						|
	if (console_row >= CONSOLE_ROWS) {
 | 
						|
		/* Scroll everything up */
 | 
						|
		console_scrollup ();
 | 
						|
 | 
						|
		/* Decrement row number */
 | 
						|
		console_row--;
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
 | 
						|
void video_putc (const char c)
 | 
						|
{
 | 
						|
	switch (c) {
 | 
						|
	case 13:		/* ignore */
 | 
						|
		break;
 | 
						|
 | 
						|
	case '\n':		/* next line */
 | 
						|
		console_newline ();
 | 
						|
		break;
 | 
						|
 | 
						|
	case 9:		/* tab 8 */
 | 
						|
		CURSOR_OFF console_col |= 0x0008;
 | 
						|
		console_col &= ~0x0007;
 | 
						|
 | 
						|
		if (console_col >= CONSOLE_COLS)
 | 
						|
			console_newline ();
 | 
						|
		break;
 | 
						|
 | 
						|
	case 8:		/* backspace */
 | 
						|
		console_back ();
 | 
						|
		break;
 | 
						|
 | 
						|
	default:		/* draw the char */
 | 
						|
		video_putchar (console_col * VIDEO_FONT_WIDTH,
 | 
						|
			       console_row * VIDEO_FONT_HEIGHT,
 | 
						|
			       c);
 | 
						|
		console_col++;
 | 
						|
 | 
						|
		/* check for newline */
 | 
						|
		if (console_col >= CONSOLE_COLS)
 | 
						|
			console_newline ();
 | 
						|
	}
 | 
						|
CURSOR_SET}
 | 
						|
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
 | 
						|
void video_puts (const char *s)
 | 
						|
{
 | 
						|
	int count = strlen (s);
 | 
						|
 | 
						|
	while (count--)
 | 
						|
		video_putc (*s++);
 | 
						|
}
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
 | 
						|
#if defined(CONFIG_CMD_BMP) || defined(CONFIG_SPLASH_SCREEN)
 | 
						|
 | 
						|
#define FILL_8BIT_332RGB(r,g,b)	{			\
 | 
						|
	*fb = ((r>>5)<<5) | ((g>>5)<<2) | (b>>6);	\
 | 
						|
	fb ++;						\
 | 
						|
}
 | 
						|
 | 
						|
#define FILL_15BIT_555RGB(r,g,b) {			\
 | 
						|
	*(unsigned short *)fb = SWAP16((unsigned short)(((r>>3)<<10) | ((g>>3)<<5) | (b>>3))); \
 | 
						|
	fb += 2;					\
 | 
						|
}
 | 
						|
 | 
						|
#define FILL_16BIT_565RGB(r,g,b) {			\
 | 
						|
	*(unsigned short *)fb = SWAP16((unsigned short)((((r)>>3)<<11) | (((g)>>2)<<5) | ((b)>>3))); \
 | 
						|
	fb += 2;					\
 | 
						|
}
 | 
						|
 | 
						|
#define FILL_32BIT_X888RGB(r,g,b) {			\
 | 
						|
	*(unsigned long *)fb = SWAP32((unsigned long)(((r<<16) | (g<<8) | b))); \
 | 
						|
	fb += 4;					\
 | 
						|
}
 | 
						|
 | 
						|
#ifdef VIDEO_FB_LITTLE_ENDIAN
 | 
						|
#define FILL_24BIT_888RGB(r,g,b) {			\
 | 
						|
	fb[0] = b;					\
 | 
						|
	fb[1] = g;					\
 | 
						|
	fb[2] = r;					\
 | 
						|
	fb += 3;					\
 | 
						|
}
 | 
						|
#else
 | 
						|
#define FILL_24BIT_888RGB(r,g,b) {			\
 | 
						|
	fb[0] = r;					\
 | 
						|
	fb[1] = g;					\
 | 
						|
	fb[2] = b;					\
 | 
						|
	fb += 3;					\
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
 | 
						|
/*
 | 
						|
 * Display the BMP file located at address bmp_image.
 | 
						|
 * Only uncompressed
 | 
						|
 */
 | 
						|
int video_display_bitmap (ulong bmp_image, int x, int y)
 | 
						|
{
 | 
						|
	ushort xcount, ycount;
 | 
						|
	uchar *fb;
 | 
						|
	bmp_image_t *bmp = (bmp_image_t *) bmp_image;
 | 
						|
	uchar *bmap;
 | 
						|
	ushort padded_line;
 | 
						|
	unsigned long width, height, bpp;
 | 
						|
	unsigned colors;
 | 
						|
	unsigned long compression;
 | 
						|
	bmp_color_table_entry_t cte;
 | 
						|
#ifdef CONFIG_VIDEO_BMP_GZIP
 | 
						|
	unsigned char *dst = NULL;
 | 
						|
	ulong len;
 | 
						|
#endif
 | 
						|
 | 
						|
	WATCHDOG_RESET ();
 | 
						|
 | 
						|
	if (!((bmp->header.signature[0] == 'B') &&
 | 
						|
	      (bmp->header.signature[1] == 'M'))) {
 | 
						|
 | 
						|
#ifdef CONFIG_VIDEO_BMP_GZIP
 | 
						|
		/*
 | 
						|
		 * Could be a gzipped bmp image, try to decrompress...
 | 
						|
		 */
 | 
						|
		len = CFG_VIDEO_LOGO_MAX_SIZE;
 | 
						|
		dst = malloc(CFG_VIDEO_LOGO_MAX_SIZE);
 | 
						|
		if (dst == NULL) {
 | 
						|
			printf("Error: malloc in gunzip failed!\n");
 | 
						|
			return(1);
 | 
						|
		}
 | 
						|
		if (gunzip(dst, CFG_VIDEO_LOGO_MAX_SIZE, (uchar *)bmp_image, &len) != 0) {
 | 
						|
			printf ("Error: no valid bmp or bmp.gz image at %lx\n", bmp_image);
 | 
						|
			free(dst);
 | 
						|
			return 1;
 | 
						|
		}
 | 
						|
		if (len == CFG_VIDEO_LOGO_MAX_SIZE) {
 | 
						|
			printf("Image could be truncated (increase CFG_VIDEO_LOGO_MAX_SIZE)!\n");
 | 
						|
		}
 | 
						|
 | 
						|
		/*
 | 
						|
		 * Set addr to decompressed image
 | 
						|
		 */
 | 
						|
		bmp = (bmp_image_t *)dst;
 | 
						|
 | 
						|
		if (!((bmp->header.signature[0] == 'B') &&
 | 
						|
		      (bmp->header.signature[1] == 'M'))) {
 | 
						|
			printf ("Error: no valid bmp.gz image at %lx\n", bmp_image);
 | 
						|
			return 1;
 | 
						|
		}
 | 
						|
#else
 | 
						|
		printf ("Error: no valid bmp image at %lx\n", bmp_image);
 | 
						|
		return 1;
 | 
						|
#endif /* CONFIG_VIDEO_BMP_GZIP */
 | 
						|
	}
 | 
						|
 | 
						|
	width = le32_to_cpu (bmp->header.width);
 | 
						|
	height = le32_to_cpu (bmp->header.height);
 | 
						|
	bpp = le16_to_cpu (bmp->header.bit_count);
 | 
						|
	colors = le32_to_cpu (bmp->header.colors_used);
 | 
						|
	compression = le32_to_cpu (bmp->header.compression);
 | 
						|
 | 
						|
	debug ("Display-bmp: %d x %d  with %d colors\n",
 | 
						|
	       width, height, colors);
 | 
						|
 | 
						|
	if (compression != BMP_BI_RGB) {
 | 
						|
		printf ("Error: compression type %ld not supported\n",
 | 
						|
			compression);
 | 
						|
		return 1;
 | 
						|
	}
 | 
						|
 | 
						|
	padded_line = (((width * bpp + 7) / 8) + 3) & ~0x3;
 | 
						|
 | 
						|
	if ((x + width) > VIDEO_VISIBLE_COLS)
 | 
						|
		width = VIDEO_VISIBLE_COLS - x;
 | 
						|
	if ((y + height) > VIDEO_VISIBLE_ROWS)
 | 
						|
		height = VIDEO_VISIBLE_ROWS - y;
 | 
						|
 | 
						|
	bmap = (uchar *) bmp + le32_to_cpu (bmp->header.data_offset);
 | 
						|
	fb = (uchar *) (video_fb_address +
 | 
						|
			((y + height - 1) * VIDEO_COLS * VIDEO_PIXEL_SIZE) +
 | 
						|
			x * VIDEO_PIXEL_SIZE);
 | 
						|
 | 
						|
	/* We handle only 8bpp or 24 bpp bitmap */
 | 
						|
	switch (le16_to_cpu (bmp->header.bit_count)) {
 | 
						|
	case 8:
 | 
						|
		padded_line -= width;
 | 
						|
		if (VIDEO_DATA_FORMAT == GDF__8BIT_INDEX) {
 | 
						|
			/* Copy colormap					     */
 | 
						|
			for (xcount = 0; xcount < colors; ++xcount) {
 | 
						|
				cte = bmp->color_table[xcount];
 | 
						|
				video_set_lut (xcount, cte.red, cte.green, cte.blue);
 | 
						|
			}
 | 
						|
		}
 | 
						|
		ycount = height;
 | 
						|
		switch (VIDEO_DATA_FORMAT) {
 | 
						|
		case GDF__8BIT_INDEX:
 | 
						|
			while (ycount--) {
 | 
						|
				WATCHDOG_RESET ();
 | 
						|
				xcount = width;
 | 
						|
				while (xcount--) {
 | 
						|
					*fb++ = *bmap++;
 | 
						|
				}
 | 
						|
				bmap += padded_line;
 | 
						|
				fb -= (VIDEO_VISIBLE_COLS + width) * VIDEO_PIXEL_SIZE;
 | 
						|
			}
 | 
						|
			break;
 | 
						|
		case GDF__8BIT_332RGB:
 | 
						|
			while (ycount--) {
 | 
						|
				WATCHDOG_RESET ();
 | 
						|
				xcount = width;
 | 
						|
				while (xcount--) {
 | 
						|
					cte = bmp->color_table[*bmap++];
 | 
						|
					FILL_8BIT_332RGB (cte.red, cte.green, cte.blue);
 | 
						|
				}
 | 
						|
				bmap += padded_line;
 | 
						|
				fb -= (VIDEO_VISIBLE_COLS + width) * VIDEO_PIXEL_SIZE;
 | 
						|
			}
 | 
						|
			break;
 | 
						|
		case GDF_15BIT_555RGB:
 | 
						|
			while (ycount--) {
 | 
						|
				WATCHDOG_RESET ();
 | 
						|
				xcount = width;
 | 
						|
				while (xcount--) {
 | 
						|
					cte = bmp->color_table[*bmap++];
 | 
						|
					FILL_15BIT_555RGB (cte.red, cte.green, cte.blue);
 | 
						|
				}
 | 
						|
				bmap += padded_line;
 | 
						|
				fb -= (VIDEO_VISIBLE_COLS + width) * VIDEO_PIXEL_SIZE;
 | 
						|
			}
 | 
						|
			break;
 | 
						|
		case GDF_16BIT_565RGB:
 | 
						|
			while (ycount--) {
 | 
						|
				WATCHDOG_RESET ();
 | 
						|
				xcount = width;
 | 
						|
				while (xcount--) {
 | 
						|
					cte = bmp->color_table[*bmap++];
 | 
						|
					FILL_16BIT_565RGB (cte.red, cte.green, cte.blue);
 | 
						|
				}
 | 
						|
				bmap += padded_line;
 | 
						|
				fb -= (VIDEO_VISIBLE_COLS + width) * VIDEO_PIXEL_SIZE;
 | 
						|
			}
 | 
						|
			break;
 | 
						|
		case GDF_32BIT_X888RGB:
 | 
						|
			while (ycount--) {
 | 
						|
				WATCHDOG_RESET ();
 | 
						|
				xcount = width;
 | 
						|
				while (xcount--) {
 | 
						|
					cte = bmp->color_table[*bmap++];
 | 
						|
					FILL_32BIT_X888RGB (cte.red, cte.green, cte.blue);
 | 
						|
				}
 | 
						|
				bmap += padded_line;
 | 
						|
				fb -= (VIDEO_VISIBLE_COLS + width) * VIDEO_PIXEL_SIZE;
 | 
						|
			}
 | 
						|
			break;
 | 
						|
		case GDF_24BIT_888RGB:
 | 
						|
			while (ycount--) {
 | 
						|
				WATCHDOG_RESET ();
 | 
						|
				xcount = width;
 | 
						|
				while (xcount--) {
 | 
						|
					cte = bmp->color_table[*bmap++];
 | 
						|
					FILL_24BIT_888RGB (cte.red, cte.green, cte.blue);
 | 
						|
				}
 | 
						|
				bmap += padded_line;
 | 
						|
				fb -= (VIDEO_VISIBLE_COLS + width) * VIDEO_PIXEL_SIZE;
 | 
						|
			}
 | 
						|
			break;
 | 
						|
		}
 | 
						|
		break;
 | 
						|
	case 24:
 | 
						|
		padded_line -= 3 * width;
 | 
						|
		ycount = height;
 | 
						|
		switch (VIDEO_DATA_FORMAT) {
 | 
						|
		case GDF__8BIT_332RGB:
 | 
						|
			while (ycount--) {
 | 
						|
				WATCHDOG_RESET ();
 | 
						|
				xcount = width;
 | 
						|
				while (xcount--) {
 | 
						|
					FILL_8BIT_332RGB (bmap[2], bmap[1], bmap[0]);
 | 
						|
					bmap += 3;
 | 
						|
				}
 | 
						|
				bmap += padded_line;
 | 
						|
				fb -= (VIDEO_VISIBLE_COLS + width) * VIDEO_PIXEL_SIZE;
 | 
						|
			}
 | 
						|
			break;
 | 
						|
		case GDF_15BIT_555RGB:
 | 
						|
			while (ycount--) {
 | 
						|
				WATCHDOG_RESET ();
 | 
						|
				xcount = width;
 | 
						|
				while (xcount--) {
 | 
						|
					FILL_15BIT_555RGB (bmap[2], bmap[1], bmap[0]);
 | 
						|
					bmap += 3;
 | 
						|
				}
 | 
						|
				bmap += padded_line;
 | 
						|
				fb -= (VIDEO_VISIBLE_COLS + width) * VIDEO_PIXEL_SIZE;
 | 
						|
			}
 | 
						|
			break;
 | 
						|
		case GDF_16BIT_565RGB:
 | 
						|
			while (ycount--) {
 | 
						|
				WATCHDOG_RESET ();
 | 
						|
				xcount = width;
 | 
						|
				while (xcount--) {
 | 
						|
					FILL_16BIT_565RGB (bmap[2], bmap[1], bmap[0]);
 | 
						|
					bmap += 3;
 | 
						|
				}
 | 
						|
				bmap += padded_line;
 | 
						|
				fb -= (VIDEO_VISIBLE_COLS + width) * VIDEO_PIXEL_SIZE;
 | 
						|
			}
 | 
						|
			break;
 | 
						|
		case GDF_32BIT_X888RGB:
 | 
						|
			while (ycount--) {
 | 
						|
				WATCHDOG_RESET ();
 | 
						|
				xcount = width;
 | 
						|
				while (xcount--) {
 | 
						|
					FILL_32BIT_X888RGB (bmap[2], bmap[1], bmap[0]);
 | 
						|
					bmap += 3;
 | 
						|
				}
 | 
						|
				bmap += padded_line;
 | 
						|
				fb -= (VIDEO_VISIBLE_COLS + width) * VIDEO_PIXEL_SIZE;
 | 
						|
			}
 | 
						|
			break;
 | 
						|
		case GDF_24BIT_888RGB:
 | 
						|
			while (ycount--) {
 | 
						|
				WATCHDOG_RESET ();
 | 
						|
				xcount = width;
 | 
						|
				while (xcount--) {
 | 
						|
					FILL_24BIT_888RGB (bmap[2], bmap[1], bmap[0]);
 | 
						|
					bmap += 3;
 | 
						|
				}
 | 
						|
				bmap += padded_line;
 | 
						|
				fb -= (VIDEO_VISIBLE_COLS + width) * VIDEO_PIXEL_SIZE;
 | 
						|
			}
 | 
						|
			break;
 | 
						|
		default:
 | 
						|
			printf ("Error: 24 bits/pixel bitmap incompatible with current video mode\n");
 | 
						|
			break;
 | 
						|
		}
 | 
						|
		break;
 | 
						|
	default:
 | 
						|
		printf ("Error: %d bit/pixel bitmaps not supported by U-Boot\n",
 | 
						|
			le16_to_cpu (bmp->header.bit_count));
 | 
						|
		break;
 | 
						|
	}
 | 
						|
 | 
						|
#ifdef CONFIG_VIDEO_BMP_GZIP
 | 
						|
	if (dst) {
 | 
						|
		free(dst);
 | 
						|
	}
 | 
						|
#endif
 | 
						|
 | 
						|
	return (0);
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
 | 
						|
#ifdef CONFIG_VIDEO_LOGO
 | 
						|
void logo_plot (void *screen, int width, int x, int y)
 | 
						|
{
 | 
						|
 | 
						|
	int xcount, i;
 | 
						|
	int skip   = (width - VIDEO_LOGO_WIDTH) * VIDEO_PIXEL_SIZE;
 | 
						|
	int ycount = VIDEO_LOGO_HEIGHT;
 | 
						|
	unsigned char r, g, b, *logo_red, *logo_blue, *logo_green;
 | 
						|
	unsigned char *source;
 | 
						|
	unsigned char *dest = (unsigned char *)screen + ((y * width * VIDEO_PIXEL_SIZE) + x);
 | 
						|
 | 
						|
#ifdef CONFIG_VIDEO_BMP_LOGO
 | 
						|
	source = bmp_logo_bitmap;
 | 
						|
 | 
						|
	/* Allocate temporary space for computing colormap			 */
 | 
						|
	logo_red = malloc (BMP_LOGO_COLORS);
 | 
						|
	logo_green = malloc (BMP_LOGO_COLORS);
 | 
						|
	logo_blue = malloc (BMP_LOGO_COLORS);
 | 
						|
	/* Compute color map							 */
 | 
						|
	for (i = 0; i < VIDEO_LOGO_COLORS; i++) {
 | 
						|
		logo_red[i] = (bmp_logo_palette[i] & 0x0f00) >> 4;
 | 
						|
		logo_green[i] = (bmp_logo_palette[i] & 0x00f0);
 | 
						|
		logo_blue[i] = (bmp_logo_palette[i] & 0x000f) << 4;
 | 
						|
	}
 | 
						|
#else
 | 
						|
	source = linux_logo;
 | 
						|
	logo_red = linux_logo_red;
 | 
						|
	logo_green = linux_logo_green;
 | 
						|
	logo_blue = linux_logo_blue;
 | 
						|
#endif
 | 
						|
 | 
						|
	if (VIDEO_DATA_FORMAT == GDF__8BIT_INDEX) {
 | 
						|
		for (i = 0; i < VIDEO_LOGO_COLORS; i++) {
 | 
						|
			video_set_lut (i + VIDEO_LOGO_LUT_OFFSET,
 | 
						|
				       logo_red[i], logo_green[i], logo_blue[i]);
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	while (ycount--) {
 | 
						|
		xcount = VIDEO_LOGO_WIDTH;
 | 
						|
		while (xcount--) {
 | 
						|
			r = logo_red[*source - VIDEO_LOGO_LUT_OFFSET];
 | 
						|
			g = logo_green[*source - VIDEO_LOGO_LUT_OFFSET];
 | 
						|
			b = logo_blue[*source - VIDEO_LOGO_LUT_OFFSET];
 | 
						|
 | 
						|
			switch (VIDEO_DATA_FORMAT) {
 | 
						|
			case GDF__8BIT_INDEX:
 | 
						|
				*dest = *source;
 | 
						|
				break;
 | 
						|
			case GDF__8BIT_332RGB:
 | 
						|
				*dest = ((r >> 5) << 5) | ((g >> 5) << 2) | (b >> 6);
 | 
						|
				break;
 | 
						|
			case GDF_15BIT_555RGB:
 | 
						|
				*(unsigned short *) dest =
 | 
						|
					SWAP16 ((unsigned short) (((r >> 3) << 10) | ((g >> 3) << 5) | (b >> 3)));
 | 
						|
				break;
 | 
						|
			case GDF_16BIT_565RGB:
 | 
						|
				*(unsigned short *) dest =
 | 
						|
					SWAP16 ((unsigned short) (((r >> 3) << 11) | ((g >> 2) << 5) | (b >> 3)));
 | 
						|
				break;
 | 
						|
			case GDF_32BIT_X888RGB:
 | 
						|
				*(unsigned long *) dest =
 | 
						|
					SWAP32 ((unsigned long) ((r << 16) | (g << 8) | b));
 | 
						|
				break;
 | 
						|
			case GDF_24BIT_888RGB:
 | 
						|
#ifdef VIDEO_FB_LITTLE_ENDIAN
 | 
						|
				dest[0] = b;
 | 
						|
				dest[1] = g;
 | 
						|
				dest[2] = r;
 | 
						|
#else
 | 
						|
				dest[0] = r;
 | 
						|
				dest[1] = g;
 | 
						|
				dest[2] = b;
 | 
						|
#endif
 | 
						|
				break;
 | 
						|
			}
 | 
						|
			source++;
 | 
						|
			dest += VIDEO_PIXEL_SIZE;
 | 
						|
		}
 | 
						|
		dest += skip;
 | 
						|
	}
 | 
						|
#ifdef CONFIG_VIDEO_BMP_LOGO
 | 
						|
	free (logo_red);
 | 
						|
	free (logo_green);
 | 
						|
	free (logo_blue);
 | 
						|
#endif
 | 
						|
}
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
 | 
						|
static void *video_logo (void)
 | 
						|
{
 | 
						|
	char info[128];
 | 
						|
	extern char version_string;
 | 
						|
 | 
						|
#ifdef CONFIG_SPLASH_SCREEN
 | 
						|
	char *s;
 | 
						|
	ulong addr;
 | 
						|
 | 
						|
	if ((s = getenv ("splashimage")) != NULL) {
 | 
						|
		addr = simple_strtoul (s, NULL, 16);
 | 
						|
 | 
						|
		if (video_display_bitmap (addr, 0, 0) == 0) {
 | 
						|
			return ((void *) (video_fb_address));
 | 
						|
		}
 | 
						|
	}
 | 
						|
#endif /* CONFIG_SPLASH_SCREEN */
 | 
						|
 | 
						|
	logo_plot (video_fb_address, VIDEO_COLS, 0, 0);
 | 
						|
 | 
						|
	sprintf (info, " %s", &version_string);
 | 
						|
	video_drawstring (VIDEO_INFO_X, VIDEO_INFO_Y, (uchar *)info);
 | 
						|
 | 
						|
#ifdef CONFIG_CONSOLE_EXTRA_INFO
 | 
						|
	{
 | 
						|
		int i, n = ((VIDEO_LOGO_HEIGHT - VIDEO_FONT_HEIGHT) / VIDEO_FONT_HEIGHT);
 | 
						|
 | 
						|
		for (i = 1; i < n; i++) {
 | 
						|
			video_get_info_str (i, info);
 | 
						|
			if (*info)
 | 
						|
				video_drawstring (VIDEO_INFO_X,
 | 
						|
						  VIDEO_INFO_Y + i * VIDEO_FONT_HEIGHT,
 | 
						|
						  (uchar *)info);
 | 
						|
		}
 | 
						|
	}
 | 
						|
#endif
 | 
						|
 | 
						|
	return (video_fb_address + VIDEO_LOGO_HEIGHT * VIDEO_LINE_LEN);
 | 
						|
}
 | 
						|
#endif
 | 
						|
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
 | 
						|
static int video_init (void)
 | 
						|
{
 | 
						|
	unsigned char color8;
 | 
						|
 | 
						|
	if ((pGD = video_hw_init ()) == NULL)
 | 
						|
		return -1;
 | 
						|
 | 
						|
	video_fb_address = (void *) VIDEO_FB_ADRS;
 | 
						|
#ifdef CONFIG_VIDEO_HW_CURSOR
 | 
						|
	video_init_hw_cursor (VIDEO_FONT_WIDTH, VIDEO_FONT_HEIGHT);
 | 
						|
#endif
 | 
						|
 | 
						|
	/* Init drawing pats */
 | 
						|
	switch (VIDEO_DATA_FORMAT) {
 | 
						|
	case GDF__8BIT_INDEX:
 | 
						|
		video_set_lut (0x01, CONSOLE_FG_COL, CONSOLE_FG_COL, CONSOLE_FG_COL);
 | 
						|
		video_set_lut (0x00, CONSOLE_BG_COL, CONSOLE_BG_COL, CONSOLE_BG_COL);
 | 
						|
		fgx = 0x01010101;
 | 
						|
		bgx = 0x00000000;
 | 
						|
		break;
 | 
						|
	case GDF__8BIT_332RGB:
 | 
						|
		color8 = ((CONSOLE_FG_COL & 0xe0) |
 | 
						|
			  ((CONSOLE_FG_COL >> 3) & 0x1c) | CONSOLE_FG_COL >> 6);
 | 
						|
		fgx = (color8 << 24) | (color8 << 16) | (color8 << 8) | color8;
 | 
						|
		color8 = ((CONSOLE_BG_COL & 0xe0) |
 | 
						|
			  ((CONSOLE_BG_COL >> 3) & 0x1c) | CONSOLE_BG_COL >> 6);
 | 
						|
		bgx = (color8 << 24) | (color8 << 16) | (color8 << 8) | color8;
 | 
						|
		break;
 | 
						|
	case GDF_15BIT_555RGB:
 | 
						|
		fgx = (((CONSOLE_FG_COL >> 3) << 26) |
 | 
						|
		       ((CONSOLE_FG_COL >> 3) << 21) | ((CONSOLE_FG_COL >> 3) << 16) |
 | 
						|
		       ((CONSOLE_FG_COL >> 3) << 10) | ((CONSOLE_FG_COL >> 3) << 5) |
 | 
						|
		       (CONSOLE_FG_COL >> 3));
 | 
						|
		bgx = (((CONSOLE_BG_COL >> 3) << 26) |
 | 
						|
		       ((CONSOLE_BG_COL >> 3) << 21) | ((CONSOLE_BG_COL >> 3) << 16) |
 | 
						|
		       ((CONSOLE_BG_COL >> 3) << 10) | ((CONSOLE_BG_COL >> 3) << 5) |
 | 
						|
		       (CONSOLE_BG_COL >> 3));
 | 
						|
		break;
 | 
						|
	case GDF_16BIT_565RGB:
 | 
						|
		fgx = (((CONSOLE_FG_COL >> 3) << 27) |
 | 
						|
		       ((CONSOLE_FG_COL >> 2) << 21) | ((CONSOLE_FG_COL >> 3) << 16) |
 | 
						|
		       ((CONSOLE_FG_COL >> 3) << 11) | ((CONSOLE_FG_COL >> 2) << 5) |
 | 
						|
		       (CONSOLE_FG_COL >> 3));
 | 
						|
		bgx = (((CONSOLE_BG_COL >> 3) << 27) |
 | 
						|
		       ((CONSOLE_BG_COL >> 2) << 21) | ((CONSOLE_BG_COL >> 3) << 16) |
 | 
						|
		       ((CONSOLE_BG_COL >> 3) << 11) | ((CONSOLE_BG_COL >> 2) << 5) |
 | 
						|
		       (CONSOLE_BG_COL >> 3));
 | 
						|
		break;
 | 
						|
	case GDF_32BIT_X888RGB:
 | 
						|
		fgx = (CONSOLE_FG_COL << 16) | (CONSOLE_FG_COL << 8) | CONSOLE_FG_COL;
 | 
						|
		bgx = (CONSOLE_BG_COL << 16) | (CONSOLE_BG_COL << 8) | CONSOLE_BG_COL;
 | 
						|
		break;
 | 
						|
	case GDF_24BIT_888RGB:
 | 
						|
		fgx = (CONSOLE_FG_COL << 24) | (CONSOLE_FG_COL << 16) |
 | 
						|
			(CONSOLE_FG_COL << 8) | CONSOLE_FG_COL;
 | 
						|
		bgx = (CONSOLE_BG_COL << 24) | (CONSOLE_BG_COL << 16) |
 | 
						|
			(CONSOLE_BG_COL << 8) | CONSOLE_BG_COL;
 | 
						|
		break;
 | 
						|
	}
 | 
						|
	eorx = fgx ^ bgx;
 | 
						|
 | 
						|
#ifdef CONFIG_VIDEO_LOGO
 | 
						|
	/* Plot the logo and get start point of console */
 | 
						|
	PRINTD ("Video: Drawing the logo ...\n");
 | 
						|
	video_console_address = video_logo ();
 | 
						|
#else
 | 
						|
	video_console_address = video_fb_address;
 | 
						|
#endif
 | 
						|
 | 
						|
	/* Initialize the console */
 | 
						|
	console_col = 0;
 | 
						|
	console_row = 0;
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
/*****************************************************************************/
 | 
						|
 | 
						|
int drv_video_init (void)
 | 
						|
{
 | 
						|
	int skip_dev_init;
 | 
						|
	device_t console_dev;
 | 
						|
 | 
						|
	skip_dev_init = 0;
 | 
						|
 | 
						|
	/* Init video chip - returns with framebuffer cleared */
 | 
						|
	if (video_init () == -1)
 | 
						|
		skip_dev_init = 1;
 | 
						|
 | 
						|
#ifdef CONFIG_VGA_AS_SINGLE_DEVICE
 | 
						|
	/* Devices VGA and Keyboard will be assigned seperately */
 | 
						|
	/* Init vga device */
 | 
						|
	if (!skip_dev_init) {
 | 
						|
		memset (&console_dev, 0, sizeof (console_dev));
 | 
						|
		strcpy (console_dev.name, "vga");
 | 
						|
		console_dev.ext = DEV_EXT_VIDEO;	/* Video extensions */
 | 
						|
		console_dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_SYSTEM;
 | 
						|
		console_dev.putc = video_putc;	/* 'putc' function */
 | 
						|
		console_dev.puts = video_puts;	/* 'puts' function */
 | 
						|
		console_dev.tstc = NULL;	/* 'tstc' function */
 | 
						|
		console_dev.getc = NULL;	/* 'getc' function */
 | 
						|
 | 
						|
		if (device_register (&console_dev) == 0)
 | 
						|
			return 1;
 | 
						|
	}
 | 
						|
#else
 | 
						|
	PRINTD ("KBD: Keyboard init ...\n");
 | 
						|
	if (VIDEO_KBD_INIT_FCT == -1)
 | 
						|
		skip_dev_init = 1;
 | 
						|
 | 
						|
	/* Init console device */
 | 
						|
	if (!skip_dev_init) {
 | 
						|
		memset (&console_dev, 0, sizeof (console_dev));
 | 
						|
		strcpy (console_dev.name, "vga");
 | 
						|
		console_dev.ext = DEV_EXT_VIDEO;	/* Video extensions */
 | 
						|
		console_dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT | DEV_FLAGS_SYSTEM;
 | 
						|
		console_dev.putc = video_putc;	/* 'putc' function */
 | 
						|
		console_dev.puts = video_puts;	/* 'puts' function */
 | 
						|
		console_dev.tstc = VIDEO_TSTC_FCT;	/* 'tstc' function */
 | 
						|
		console_dev.getc = VIDEO_GETC_FCT;	/* 'getc' function */
 | 
						|
 | 
						|
		if (device_register (&console_dev) == 0)
 | 
						|
			return 1;
 | 
						|
	}
 | 
						|
#endif /* CONFIG_VGA_AS_SINGLE_DEVICE */
 | 
						|
	/* No console dev available */
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
#endif /* CONFIG_CFB_CONSOLE */
 |