|  | /* | 
|  | * (C) Copyright 2001-2002 | 
|  | * Wolfgang Denk, DENX Software Engineering -- wd@denx.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 | 
|  | */ | 
|  |  | 
|  | /************************************************************************/ | 
|  | /* ** HEADER FILES							*/ | 
|  | /************************************************************************/ | 
|  |  | 
|  | /* #define DEBUG */ | 
|  |  | 
|  | #include <config.h> | 
|  | #include <common.h> | 
|  | #include <command.h> | 
|  | #include <watchdog.h> | 
|  | #include <version.h> | 
|  | #include <stdarg.h> | 
|  | #include <lcdvideo.h> | 
|  | #include <linux/types.h> | 
|  | #include <devices.h> | 
|  | #if defined(CONFIG_POST) | 
|  | #include <post.h> | 
|  | #endif | 
|  | #include <lcd.h> | 
|  |  | 
|  | #ifdef CONFIG_LCD | 
|  |  | 
|  | /************************************************************************/ | 
|  | /* ** CONFIG STUFF -- should be moved to board config file		*/ | 
|  | /************************************************************************/ | 
|  | #ifndef CONFIG_LCD_INFO | 
|  | #define CONFIG_LCD_INFO		/* Display Logo, (C) and system info	*/ | 
|  | #endif | 
|  |  | 
|  | #if defined(CONFIG_V37) || defined(CONFIG_EDT32F10) | 
|  | #undef CONFIG_LCD_LOGO | 
|  | #undef CONFIG_LCD_INFO | 
|  | #endif | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  | #ifdef CONFIG_KYOCERA_KCS057QV1AJ | 
|  | /* | 
|  | *  Kyocera KCS057QV1AJ-G23. Passive, color, single scan. | 
|  | */ | 
|  | #define LCD_BPP	LCD_COLOR4 | 
|  |  | 
|  | vidinfo_t panel_info = { | 
|  | 640, 480, 132, 99, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH, | 
|  | LCD_BPP, 1, 0, 1, 0,  5, 0, 0, 0 | 
|  | /* wbl, vpw, lcdac, wbf */ | 
|  | }; | 
|  | #endif /* CONFIG_KYOCERA_KCS057QV1AJ */ | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  | #ifdef CONFIG_HITACHI_SP19X001_Z1A | 
|  | /* | 
|  | *  Hitachi SP19X001-. Active, color, single scan. | 
|  | */ | 
|  | vidinfo_t panel_info = { | 
|  | 640, 480, 154, 116, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH, | 
|  | LCD_COLOR8, 1, 0, 1, 0, 0, 0, 0, 0 | 
|  | /* wbl, vpw, lcdac, wbf */ | 
|  | }; | 
|  | #endif /* CONFIG_HITACHI_SP19X001_Z1A */ | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  | #ifdef CONFIG_NEC_NL6448AC33 | 
|  | /* | 
|  | *  NEC NL6448AC33-18. Active, color, single scan. | 
|  | */ | 
|  | vidinfo_t panel_info = { | 
|  | 640, 480, 132, 99, CFG_HIGH, CFG_HIGH, CFG_LOW, CFG_LOW, CFG_HIGH, | 
|  | 3, 0, 0, 1, 1, 144, 2, 0, 33 | 
|  | /* wbl, vpw, lcdac, wbf */ | 
|  | }; | 
|  | #endif /* CONFIG_NEC_NL6448AC33 */ | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | #ifdef CONFIG_NEC_NL6448BC20 | 
|  | /* | 
|  | *  NEC NL6448BC20-08.  6.5", 640x480. Active, color, single scan. | 
|  | */ | 
|  | vidinfo_t panel_info = { | 
|  | 640, 480, 132, 99, CFG_HIGH, CFG_HIGH, CFG_LOW, CFG_LOW, CFG_HIGH, | 
|  | 3, 0, 0, 1, 1, 144, 2, 0, 33 | 
|  | /* wbl, vpw, lcdac, wbf */ | 
|  | }; | 
|  | #endif /* CONFIG_NEC_NL6448BC20 */ | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | #ifdef CONFIG_NEC_NL6448BC33_54 | 
|  | /* | 
|  | *  NEC NL6448BC33-54. 10.4", 640x480. Active, color, single scan. | 
|  | */ | 
|  | vidinfo_t panel_info = { | 
|  | 640, 480, 212, 158, CFG_HIGH, CFG_HIGH, CFG_LOW, CFG_LOW, CFG_HIGH, | 
|  | 3, 0, 0, 1, 1, 144, 2, 0, 33 | 
|  | /* wbl, vpw, lcdac, wbf */ | 
|  | }; | 
|  | #endif /* CONFIG_NEC_NL6448BC33_54 */ | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | #ifdef CONFIG_SHARP_LQ104V7DS01 | 
|  | /* | 
|  | *  SHARP LQ104V7DS01. 6.5", 640x480. Active, color, single scan. | 
|  | */ | 
|  | vidinfo_t panel_info = { | 
|  | 640, 480, 132, 99, CFG_HIGH, CFG_HIGH, CFG_LOW, CFG_LOW, CFG_LOW, | 
|  | 3, 0, 0, 1, 1, 25, 1, 0, 33 | 
|  | /* wbl, vpw, lcdac, wbf */ | 
|  | }; | 
|  | #endif /* CONFIG_SHARP_LQ104V7DS01 */ | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | #ifdef CONFIG_SHARP_16x9 | 
|  | /* | 
|  | * Sharp 320x240. Active, color, single scan.  It isn't 16x9, and I am | 
|  | * not sure what it is....... | 
|  | */ | 
|  | vidinfo_t panel_info = { | 
|  | 320, 240, 0, 0, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH, | 
|  | 3, 0, 0, 1, 1, 15, 4, 0, 3 | 
|  | }; | 
|  | #endif /* CONFIG_SHARP_16x9 */ | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | #ifdef CONFIG_SHARP_LQ057Q3DC02 | 
|  | /* | 
|  | * Sharp LQ057Q3DC02 display. Active, color, single scan. | 
|  | */ | 
|  | #undef LCD_DF | 
|  | #define LCD_DF 12 | 
|  |  | 
|  | vidinfo_t panel_info = { | 
|  | 320, 240, 0, 0, CFG_HIGH, CFG_HIGH, CFG_LOW, CFG_LOW, CFG_HIGH, | 
|  | 3, 0, 0, 1, 1, 15, 4, 0, 3 | 
|  | /* wbl, vpw, lcdac, wbf */ | 
|  | }; | 
|  | #define CONFIG_LCD_INFO_BELOW_LOGO | 
|  | #endif /* CONFIG_SHARP_LQ057Q3DC02 */ | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | #ifdef CONFIG_SHARP_LQ64D341 | 
|  | /* | 
|  | * Sharp LQ64D341 display, 640x480. Active, color, single scan. | 
|  | */ | 
|  | vidinfo_t panel_info = { | 
|  | 640, 480, 0, 0, CFG_HIGH, CFG_HIGH, CFG_LOW, CFG_LOW, CFG_HIGH, | 
|  | 3, 0, 0, 1, 1, 128, 16, 0, 32 | 
|  | /* wbl, vpw, lcdac, wbf */ | 
|  | }; | 
|  | #endif /* CONFIG_SHARP_LQ64D341 */ | 
|  |  | 
|  | #ifdef CONFIG_SHARP_LQ065T9DR51U | 
|  | /* | 
|  | * Sharp LQ065T9DR51U display, 400x240. Active, color, single scan. | 
|  | */ | 
|  | vidinfo_t panel_info = { | 
|  | 400, 240, 143, 79, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH, | 
|  | 3, 0, 0, 1, 1, 248, 4, 0, 35 | 
|  | /* wbl, vpw, lcdac, wbf */ | 
|  | }; | 
|  | #define CONFIG_LCD_INFO_BELOW_LOGO | 
|  | #endif /* CONFIG_SHARP_LQ065T9DR51U */ | 
|  |  | 
|  | #ifdef CONFIG_SHARP_LQ084V1DG21 | 
|  | /* | 
|  | * Sharp LQ084V1DG21 display, 640x480. Active, color, single scan. | 
|  | */ | 
|  | vidinfo_t panel_info = { | 
|  | 640, 480, 171, 129, CFG_HIGH, CFG_HIGH, CFG_LOW, CFG_LOW, CFG_LOW, | 
|  | 3, 0, 0, 1, 1, 160, 3, 0, 48 | 
|  | /* wbl, vpw, lcdac, wbf */ | 
|  | }; | 
|  | #endif /* CONFIG_SHARP_LQ084V1DG21 */ | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | #ifdef CONFIG_HLD1045 | 
|  | /* | 
|  | * HLD1045 display, 640x480. Active, color, single scan. | 
|  | */ | 
|  | vidinfo_t panel_info = { | 
|  | 640, 480, 0, 0, CFG_HIGH, CFG_HIGH, CFG_LOW, CFG_LOW, CFG_HIGH, | 
|  | 3, 0, 0, 1, 1, 160, 3, 0, 48 | 
|  | /* wbl, vpw, lcdac, wbf */ | 
|  | }; | 
|  | #endif /* CONFIG_HLD1045 */ | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | #ifdef CONFIG_PRIMEVIEW_V16C6448AC | 
|  | /* | 
|  | * Prime View V16C6448AC | 
|  | */ | 
|  | vidinfo_t panel_info = { | 
|  | 640, 480, 130, 98, CFG_HIGH, CFG_HIGH, CFG_LOW, CFG_LOW, CFG_HIGH, | 
|  | 3, 0, 0, 1, 1, 144, 2, 0, 35 | 
|  | /* wbl, vpw, lcdac, wbf */ | 
|  | }; | 
|  | #endif /* CONFIG_PRIMEVIEW_V16C6448AC */ | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | #ifdef CONFIG_OPTREX_BW | 
|  | /* | 
|  | * Optrex   CBL50840-2 NF-FW 99 22 M5 | 
|  | * or | 
|  | * Hitachi  LMG6912RPFC-00T | 
|  | * or | 
|  | * Hitachi  SP14Q002 | 
|  | * | 
|  | * 320x240. Black & white. | 
|  | */ | 
|  | #define OPTREX_BPP	0	/* 0 - monochrome,     1 bpp */ | 
|  | /* 1 -  4 grey levels, 2 bpp */ | 
|  | /* 2 - 16 grey levels, 4 bpp */ | 
|  | vidinfo_t panel_info = { | 
|  | 320, 240, 0, 0, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_LOW, | 
|  | OPTREX_BPP, 0, 0, 0, 0, 0, 0, 0, 0, 4 | 
|  | }; | 
|  | #endif /* CONFIG_OPTREX_BW */ | 
|  |  | 
|  | /*-----------------------------------------------------------------*/ | 
|  | #ifdef CONFIG_EDT32F10 | 
|  | /* | 
|  | * Emerging Display Technologies 320x240. Passive, monochrome, single scan. | 
|  | */ | 
|  | #define LCD_BPP		LCD_MONOCHROME | 
|  | #define LCD_DF		10 | 
|  |  | 
|  | vidinfo_t panel_info = { | 
|  | 320, 240, 0, 0, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_HIGH, CFG_LOW, | 
|  | LCD_BPP,  0, 0, 0, 0, 33, 0, 0, 0 | 
|  | }; | 
|  | #endif | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  |  | 
|  | int lcd_line_length; | 
|  |  | 
|  | int lcd_color_fg; | 
|  | int lcd_color_bg; | 
|  |  | 
|  | /* | 
|  | * Frame buffer memory information | 
|  | */ | 
|  | void *lcd_base;			/* Start of framebuffer memory	*/ | 
|  | void *lcd_console_address;	/* Start of console buffer	*/ | 
|  |  | 
|  | short console_col; | 
|  | short console_row; | 
|  |  | 
|  | /************************************************************************/ | 
|  |  | 
|  | void lcd_ctrl_init (void *lcdbase); | 
|  | void lcd_enable (void); | 
|  | #if LCD_BPP == LCD_COLOR8 | 
|  | void lcd_setcolreg (ushort regno, | 
|  | ushort red, ushort green, ushort blue); | 
|  | #endif | 
|  | #if LCD_BPP == LCD_MONOCHROME | 
|  | void lcd_initcolregs (void); | 
|  | #endif | 
|  |  | 
|  | #if defined(CONFIG_RBC823) | 
|  | void lcd_disable (void); | 
|  | #endif | 
|  |  | 
|  | /************************************************************************/ | 
|  |  | 
|  | /************************************************************************/ | 
|  | /* ----------------- chipset specific functions ----------------------- */ | 
|  | /************************************************************************/ | 
|  |  | 
|  | /* | 
|  | * Calculate fb size for VIDEOLFB_ATAG. | 
|  | */ | 
|  | ulong calc_fbsize (void) | 
|  | { | 
|  | ulong size; | 
|  | int line_length = (panel_info.vl_col * NBITS (panel_info.vl_bpix)) / 8; | 
|  |  | 
|  | size = line_length * panel_info.vl_row; | 
|  |  | 
|  | return size; | 
|  | } | 
|  |  | 
|  | void lcd_ctrl_init (void *lcdbase) | 
|  | { | 
|  | volatile immap_t *immr = (immap_t *) CFG_IMMR; | 
|  | volatile lcd823_t *lcdp = &immr->im_lcd; | 
|  |  | 
|  | uint lccrtmp; | 
|  | uint lchcr_hpc_tmp; | 
|  |  | 
|  | /* Initialize the LCD control register according to the LCD | 
|  | * parameters defined.  We do everything here but enable | 
|  | * the controller. | 
|  | */ | 
|  |  | 
|  | #ifdef CONFIG_RPXLITE | 
|  | /* This is special for RPXlite_DW Software Development Platform **[Sam]** */ | 
|  | panel_info.vl_dp = CFG_LOW; | 
|  | #endif | 
|  |  | 
|  | lccrtmp  = LCDBIT (LCCR_BNUM_BIT, | 
|  | (((panel_info.vl_row * panel_info.vl_col) * (1 << LCD_BPP)) / 128)); | 
|  |  | 
|  | lccrtmp |= LCDBIT (LCCR_CLKP_BIT, panel_info.vl_clkp)	| | 
|  | LCDBIT (LCCR_OEP_BIT,  panel_info.vl_oep)	| | 
|  | LCDBIT (LCCR_HSP_BIT,  panel_info.vl_hsp)	| | 
|  | LCDBIT (LCCR_VSP_BIT,  panel_info.vl_vsp)	| | 
|  | LCDBIT (LCCR_DP_BIT,   panel_info.vl_dp)	| | 
|  | LCDBIT (LCCR_BPIX_BIT, panel_info.vl_bpix)	| | 
|  | LCDBIT (LCCR_LBW_BIT,  panel_info.vl_lbw)	| | 
|  | LCDBIT (LCCR_SPLT_BIT, panel_info.vl_splt)	| | 
|  | LCDBIT (LCCR_CLOR_BIT, panel_info.vl_clor)	| | 
|  | LCDBIT (LCCR_TFT_BIT,  panel_info.vl_tft); | 
|  |  | 
|  | #if 0 | 
|  | lccrtmp |= ((SIU_LEVEL5 / 2) << 12); | 
|  | lccrtmp |= LCCR_EIEN; | 
|  | #endif | 
|  |  | 
|  | lcdp->lcd_lccr = lccrtmp; | 
|  | lcdp->lcd_lcsr = 0xFF;		/* Clear pending interrupts */ | 
|  |  | 
|  | /* Initialize LCD controller bus priorities. | 
|  | */ | 
|  | #ifdef CONFIG_RBC823 | 
|  | immr->im_siu_conf.sc_sdcr = (immr->im_siu_conf.sc_sdcr & ~0x0f) | 1;	/* RAID = 01, LAID = 00 */ | 
|  | #else | 
|  | immr->im_siu_conf.sc_sdcr &= ~0x0f;	/* RAID = LAID = 0 */ | 
|  |  | 
|  | /* set SHFT/CLOCK division factor 4 | 
|  | * This needs to be set based upon display type and processor | 
|  | * speed.  The TFT displays run about 20 to 30 MHz. | 
|  | * I was running 64 MHz processor speed. | 
|  | * The value for this divider must be chosen so the result is | 
|  | * an integer of the processor speed (i.e., divide by 3 with | 
|  | * 64 MHz would be bad). | 
|  | */ | 
|  | immr->im_clkrst.car_sccr &= ~0x1F; | 
|  | immr->im_clkrst.car_sccr |= LCD_DF;	/* was 8 */ | 
|  |  | 
|  | #endif /* CONFIG_RBC823 */ | 
|  |  | 
|  | #if defined(CONFIG_RBC823) | 
|  | /* Enable LCD on port D. | 
|  | */ | 
|  | immr->im_ioport.iop_pddat &= 0x0300; | 
|  | immr->im_ioport.iop_pdpar |= 0x1CFF; | 
|  | immr->im_ioport.iop_pddir |= 0x1CFF; | 
|  |  | 
|  | /* Configure LCD_ON, VEE_ON, CCFL_ON on port B. | 
|  | */ | 
|  | immr->im_cpm.cp_pbdat &= ~0x00005001; | 
|  | immr->im_cpm.cp_pbpar &= ~0x00005001; | 
|  | immr->im_cpm.cp_pbdir |=  0x00005001; | 
|  | #elif !defined(CONFIG_EDT32F10) | 
|  | /* Enable LCD on port D. | 
|  | */ | 
|  | immr->im_ioport.iop_pdpar |= 0x1FFF; | 
|  | immr->im_ioport.iop_pddir |= 0x1FFF; | 
|  |  | 
|  | /* Enable LCD_A/B/C on port B. | 
|  | */ | 
|  | immr->im_cpm.cp_pbpar |= 0x00005001; | 
|  | immr->im_cpm.cp_pbdir |= 0x00005001; | 
|  | #else | 
|  | /* Enable LCD on port D. | 
|  | */ | 
|  | immr->im_ioport.iop_pdpar |= 0x1DFF; | 
|  | immr->im_ioport.iop_pdpar &= ~0x0200; | 
|  | immr->im_ioport.iop_pddir |= 0x1FFF; | 
|  | immr->im_ioport.iop_pddat |= 0x0200; | 
|  | #endif | 
|  |  | 
|  | /* Load the physical address of the linear frame buffer | 
|  | * into the LCD controller. | 
|  | * BIG NOTE:  This has to be modified to load A and B depending | 
|  | * upon the split mode of the LCD. | 
|  | */ | 
|  | lcdp->lcd_lcfaa = (ulong)lcd_base; | 
|  | lcdp->lcd_lcfba = (ulong)lcd_base; | 
|  |  | 
|  | /* MORE HACKS...This must be updated according to 823 manual | 
|  | * for different panels. | 
|  | * Udi Finkelstein - done - see below: | 
|  | * Note: You better not try unsupported combinations such as | 
|  | * 4-bit wide passive dual scan LCD at 4/8 Bit color. | 
|  | */ | 
|  | lchcr_hpc_tmp = | 
|  | (panel_info.vl_col * | 
|  | (panel_info.vl_tft ? 8 : | 
|  | (((2 - panel_info.vl_lbw) << /* 4 bit=2, 8-bit = 1 */ | 
|  | /* use << to mult by: single scan = 1, dual scan = 2 */ | 
|  | panel_info.vl_splt) * | 
|  | (panel_info.vl_bpix | 1)))) >> 3; /* 2/4 BPP = 1, 8/16 BPP = 3 */ | 
|  |  | 
|  | lcdp->lcd_lchcr = LCHCR_BO | | 
|  | LCDBIT (LCHCR_AT_BIT, 4) | | 
|  | LCDBIT (LCHCR_HPC_BIT, lchcr_hpc_tmp) | | 
|  | panel_info.vl_wbl; | 
|  |  | 
|  | lcdp->lcd_lcvcr = LCDBIT (LCVCR_VPW_BIT, panel_info.vl_vpw) | | 
|  | LCDBIT (LCVCR_LCD_AC_BIT, panel_info.vl_lcdac) | | 
|  | LCDBIT (LCVCR_VPC_BIT, panel_info.vl_row) | | 
|  | panel_info.vl_wbf; | 
|  |  | 
|  | } | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | #ifdef	NOT_USED_SO_FAR | 
|  | static void | 
|  | lcd_getcolreg (ushort regno, ushort *red, ushort *green, ushort *blue) | 
|  | { | 
|  | volatile immap_t *immr = (immap_t *) CFG_IMMR; | 
|  | volatile cpm8xx_t *cp = &(immr->im_cpm); | 
|  | unsigned short colreg, *cmap_ptr; | 
|  |  | 
|  | cmap_ptr = (unsigned short *)&cp->lcd_cmap[regno * 2]; | 
|  |  | 
|  | colreg = *cmap_ptr; | 
|  | #ifdef	CFG_INVERT_COLORS | 
|  | colreg ^= 0x0FFF; | 
|  | #endif | 
|  |  | 
|  | *red   = (colreg >> 8) & 0x0F; | 
|  | *green = (colreg >> 4) & 0x0F; | 
|  | *blue  =  colreg       & 0x0F; | 
|  | } | 
|  | #endif	/* NOT_USED_SO_FAR */ | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | #if LCD_BPP == LCD_COLOR8 | 
|  | void | 
|  | lcd_setcolreg (ushort regno, ushort red, ushort green, ushort blue) | 
|  | { | 
|  | volatile immap_t *immr = (immap_t *) CFG_IMMR; | 
|  | volatile cpm8xx_t *cp = &(immr->im_cpm); | 
|  | unsigned short colreg, *cmap_ptr; | 
|  |  | 
|  | cmap_ptr = (unsigned short *)&cp->lcd_cmap[regno * 2]; | 
|  |  | 
|  | colreg = ((red   & 0x0F) << 8) | | 
|  | ((green & 0x0F) << 4) | | 
|  | (blue  & 0x0F) ; | 
|  | #ifdef	CFG_INVERT_COLORS | 
|  | colreg ^= 0x0FFF; | 
|  | #endif | 
|  | *cmap_ptr = colreg; | 
|  |  | 
|  | debug ("setcolreg: reg %2d @ %p: R=%02X G=%02X B=%02X => %02X%02X\n", | 
|  | regno, &(cp->lcd_cmap[regno * 2]), | 
|  | red, green, blue, | 
|  | cp->lcd_cmap[ regno * 2 ], cp->lcd_cmap[(regno * 2) + 1]); | 
|  | } | 
|  | #endif	/* LCD_COLOR8 */ | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | #if LCD_BPP == LCD_MONOCHROME | 
|  | static | 
|  | void lcd_initcolregs (void) | 
|  | { | 
|  | volatile immap_t *immr = (immap_t *) CFG_IMMR; | 
|  | volatile cpm8xx_t *cp = &(immr->im_cpm); | 
|  | ushort regno; | 
|  |  | 
|  | for (regno = 0; regno < 16; regno++) { | 
|  | cp->lcd_cmap[regno * 2] = 0; | 
|  | cp->lcd_cmap[(regno * 2) + 1] = regno & 0x0f; | 
|  | } | 
|  | } | 
|  | #endif | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | void lcd_enable (void) | 
|  | { | 
|  | volatile immap_t *immr = (immap_t *) CFG_IMMR; | 
|  | volatile lcd823_t *lcdp = &immr->im_lcd; | 
|  |  | 
|  | /* Enable the LCD panel */ | 
|  | #ifndef CONFIG_RBC823 | 
|  | immr->im_siu_conf.sc_sdcr |= (1 << (31 - 25));		/* LAM = 1 */ | 
|  | #endif | 
|  | lcdp->lcd_lccr |= LCCR_PON; | 
|  |  | 
|  | #ifdef CONFIG_V37 | 
|  | /* Turn on display backlight */ | 
|  | immr->im_cpm.cp_pbpar |= 0x00008000; | 
|  | immr->im_cpm.cp_pbdir |= 0x00008000; | 
|  | #elif defined(CONFIG_RBC823) | 
|  | /* Turn on display backlight */ | 
|  | immr->im_cpm.cp_pbdat |= 0x00004000; | 
|  | #endif | 
|  |  | 
|  | #if defined(CONFIG_LWMON) | 
|  | {	uchar c = pic_read (0x60); | 
|  | #if defined(CONFIG_LCD) && defined(CONFIG_LWMON) && (CONFIG_POST & CFG_POST_SYSMON) | 
|  | /* Enable LCD later in sysmon test, only if temperature is OK */ | 
|  | #else | 
|  | c |= 0x07;	/* Power on CCFL, Enable CCFL, Chip Enable LCD */ | 
|  | #endif | 
|  | pic_write (0x60, c); | 
|  | } | 
|  | #endif /* CONFIG_LWMON */ | 
|  |  | 
|  | #if defined(CONFIG_R360MPI) | 
|  | { | 
|  | extern void r360_i2c_lcd_write (uchar data0, uchar data1); | 
|  | unsigned long bgi, ctr; | 
|  | char *p; | 
|  |  | 
|  | if ((p = getenv("lcdbgi")) != NULL) { | 
|  | bgi = simple_strtoul (p, 0, 10) & 0xFFF; | 
|  | } else { | 
|  | bgi = 0xFFF; | 
|  | } | 
|  |  | 
|  | if ((p = getenv("lcdctr")) != NULL) { | 
|  | ctr = simple_strtoul (p, 0, 10) & 0xFFF; | 
|  | } else { | 
|  | ctr=0x7FF; | 
|  | } | 
|  |  | 
|  | r360_i2c_lcd_write(0x10, 0x01); | 
|  | r360_i2c_lcd_write(0x20, 0x01); | 
|  | r360_i2c_lcd_write(0x30 | ((bgi>>8) & 0xF), bgi & 0xFF); | 
|  | r360_i2c_lcd_write(0x40 | ((ctr>>8) & 0xF), ctr & 0xFF); | 
|  | } | 
|  | #endif /* CONFIG_R360MPI */ | 
|  | #ifdef CONFIG_RBC823 | 
|  | udelay(200000); /* wait 200ms */ | 
|  | /* Turn VEE_ON first */ | 
|  | immr->im_cpm.cp_pbdat |= 0x00000001; | 
|  | udelay(200000); /* wait 200ms */ | 
|  | /* Now turn on LCD_ON */ | 
|  | immr->im_cpm.cp_pbdat |= 0x00001000; | 
|  | #endif | 
|  | #ifdef CONFIG_RRVISION | 
|  | debug ("PC4->Output(1): enable LVDS\n"); | 
|  | debug ("PC5->Output(0): disable PAL clock\n"); | 
|  | immr->im_ioport.iop_pddir |=  0x1000; | 
|  | immr->im_ioport.iop_pcpar &= ~(0x0C00); | 
|  | immr->im_ioport.iop_pcdir |=   0x0C00 ; | 
|  | immr->im_ioport.iop_pcdat |=   0x0800 ; | 
|  | immr->im_ioport.iop_pcdat &= ~(0x0400); | 
|  | debug ("PDPAR=0x%04X PDDIR=0x%04X PDDAT=0x%04X\n", | 
|  | immr->im_ioport.iop_pdpar, | 
|  | immr->im_ioport.iop_pddir, | 
|  | immr->im_ioport.iop_pddat); | 
|  | debug ("PCPAR=0x%04X PCDIR=0x%04X PCDAT=0x%04X\n", | 
|  | immr->im_ioport.iop_pcpar, | 
|  | immr->im_ioport.iop_pcdir, | 
|  | immr->im_ioport.iop_pcdat); | 
|  | #endif | 
|  | } | 
|  |  | 
|  | /*----------------------------------------------------------------------*/ | 
|  |  | 
|  | #if defined (CONFIG_RBC823) | 
|  | void lcd_disable (void) | 
|  | { | 
|  | volatile immap_t *immr = (immap_t *) CFG_IMMR; | 
|  | volatile lcd823_t *lcdp = &immr->im_lcd; | 
|  |  | 
|  | #if defined(CONFIG_LWMON) | 
|  | {	uchar c = pic_read (0x60); | 
|  | c &= ~0x07;	/* Power off CCFL, Disable CCFL, Chip Disable LCD */ | 
|  | pic_write (0x60, c); | 
|  | } | 
|  | #elif defined(CONFIG_R360MPI) | 
|  | { | 
|  | extern void r360_i2c_lcd_write (uchar data0, uchar data1); | 
|  |  | 
|  | r360_i2c_lcd_write(0x10, 0x00); | 
|  | r360_i2c_lcd_write(0x20, 0x00); | 
|  | r360_i2c_lcd_write(0x30, 0x00); | 
|  | r360_i2c_lcd_write(0x40, 0x00); | 
|  | } | 
|  | #endif /* CONFIG_LWMON */ | 
|  | /* Disable the LCD panel */ | 
|  | lcdp->lcd_lccr &= ~LCCR_PON; | 
|  | #ifdef CONFIG_RBC823 | 
|  | /* Turn off display backlight, VEE and LCD_ON */ | 
|  | immr->im_cpm.cp_pbdat &= ~0x00005001; | 
|  | #else | 
|  | immr->im_siu_conf.sc_sdcr &= ~(1 << (31 - 25));	/* LAM = 0 */ | 
|  | #endif /* CONFIG_RBC823 */ | 
|  | } | 
|  | #endif	/* NOT_USED_SO_FAR || CONFIG_RBC823 */ | 
|  |  | 
|  |  | 
|  | /************************************************************************/ | 
|  |  | 
|  | #endif /* CONFIG_LCD */ |