]> git.sur5r.net Git - u-boot/blobdiff - board/esd/hh405/hh405.c
move prototypes for gunzip() and zunzip() to common.h
[u-boot] / board / esd / hh405 / hh405.c
index 5c0d070a7f669816798bf1129b51dfd8682f0541..4251d51b2eeab2c018598e1bfe682db86f2fa957 100644 (file)
@@ -5,6 +5,9 @@
  * (C) Copyright 2005
  * Stefan Roese, DENX Software Engineering, sr@denx.de.
  *
+ * (C) Copyright 2006-2007
+ * Matthias Fuchs, esd GmbH, matthias.fuchs@esd-electronics.com
+ *
  * See file CREDITS for list of people who contributed to this
  * project.
  *
 
 #include <common.h>
 #include <asm/processor.h>
+#include <asm/io.h>
 #include <command.h>
 #include <malloc.h>
 #include <pci.h>
 #include <sm501.h>
 
+DECLARE_GLOBAL_DATA_PTR;
+
+/* FPGA internal regs */
+#define FPGA_CTRL      ((u16 *)(CONFIG_SYS_FPGA_BASE_ADDR + 0x000))
+#define FPGA_STATUS    ((u16 *)(CONFIG_SYS_FPGA_BASE_ADDR + 0x002))
+#define FPGA_CTR       ((u16 *)(CONFIG_SYS_FPGA_BASE_ADDR + 0x004))
+#define FPGA_BL                ((u16 *)(CONFIG_SYS_FPGA_BASE_ADDR + 0x006))
+
+/* FPGA Control Reg */
+#define FPGA_CTRL_REV0      0x0001
+#define FPGA_CTRL_REV1      0x0002
+#define FPGA_CTRL_VGA0_BL   0x0004
+#define FPGA_CTRL_VGA0_BL_MODE 0x0008
+#define FPGA_CTRL_CF_RESET  0x0040
+#define FPGA_CTRL_PS2_PWR   0x0080
+#define FPGA_CTRL_CF_PWRN   0x0100      /* low active */
+#define FPGA_CTRL_CF_BUS_EN 0x0200
+#define FPGA_CTRL_LCD_CLK   0x7000      /* mask for lcd clock */
+#define FPGA_CTRL_OW_ENABLE 0x8000
+
+#define FPGA_STATUS_CF_DETECT 0x8000
 
 #ifdef CONFIG_VIDEO_SM501
 
@@ -66,10 +91,12 @@ static const SMI_REGS init_regs_800x600 [] =
        {0x00040, SWAP32(0x00021807)},
        {0x00044, SWAP32(0x221a0a01)},
        {0x00054, SWAP32(0x00000000)},
+       /* GPIO */
+       {0x1000c, SWAP32(0xfffffff0)}, /* GPIO32..63 direction */
        /* panel control regs... */
        {0x80000, SWAP32(0x0f013105)}, /* panel display control: 16-bit RGB 5:6:5 mode */
        {0x80004, SWAP32(0xc428bb17)}, /* panel panning control ??? */
-       {0x8000C, SWAP32(0x00000000)}, /* panel fb address */
+       {0x8000C, SWAP32(0x00010000)}, /* panel fb address */
        {0x80010, SWAP32(0x06400640)}, /* panel fb offset/window width */
        {0x80014, SWAP32(0x03200000)}, /* panel fb width (0x320=800) */
        {0x80018, SWAP32(0x02580000)}, /* panel fb height (0x258=600) */
@@ -100,10 +127,12 @@ static const SMI_REGS init_regs_1024x768 [] =
        {0x00040, SWAP32(0x00021807)},
        {0x00044, SWAP32(0x011a0a01)},
        {0x00054, SWAP32(0x00000000)},
+       /* GPIO */
+       {0x1000c, SWAP32(0xfffffff0)}, /* GPIO32..63 direction */
        /* panel control regs... */
        {0x80000, SWAP32(0x0f013105)}, /* panel display control: 16-bit RGB 5:6:5 mode */
        {0x80004, SWAP32(0xc428bb17)}, /* panel panning control ??? */
-       {0x8000C, SWAP32(0x00000000)}, /* panel fb address */
+       {0x8000C, SWAP32(0x00010000)}, /* panel fb address */
        {0x80010, SWAP32(0x08000800)}, /* panel fb offset/window width */
        {0x80014, SWAP32(0x04000000)}, /* panel fb width (0x400=1024) */
        {0x80018, SWAP32(0x03000000)}, /* panel fb height (0x300=768) */
@@ -144,10 +173,12 @@ static const SMI_REGS init_regs_800x600 [] =
        {0x00040, SWAP32(0x00021807)},
        {0x00044, SWAP32(0x221a0a01)},
        {0x00054, SWAP32(0x00000000)},
+       /* GPIO */
+       {0x1000c, SWAP32(0xfffffff0)}, /* GPIO32..63 direction */
        /* panel control regs... */
        {0x80000, SWAP32(0x0f013106)}, /* panel display control: 32-bit RGB 8:8:8 mode */
        {0x80004, SWAP32(0xc428bb17)}, /* panel panning control ??? */
-       {0x8000C, SWAP32(0x00000000)}, /* panel fb address */
+       {0x8000C, SWAP32(0x00010000)}, /* panel fb address */
        {0x80010, SWAP32(0x0c800c80)}, /* panel fb offset/window width */
        {0x80014, SWAP32(0x03200000)}, /* panel fb width (0x320=800) */
        {0x80018, SWAP32(0x02580000)}, /* panel fb height (0x258=600) */
@@ -178,10 +209,12 @@ static const SMI_REGS init_regs_1024x768 [] =
        {0x00040, SWAP32(0x00021807)},
        {0x00044, SWAP32(0x011a0a01)},
        {0x00054, SWAP32(0x00000000)},
+       /* GPIO */
+       {0x1000c, SWAP32(0xfffffff0)}, /* GPIO32..63 direction */
        /* panel control regs... */
        {0x80000, SWAP32(0x0f013106)}, /* panel display control: 32-bit RGB 8:8:8 mode */
        {0x80004, SWAP32(0xc428bb17)}, /* panel panning control ??? */
-       {0x8000C, SWAP32(0x00000000)}, /* panel fb address */
+       {0x8000C, SWAP32(0x00010000)}, /* panel fb address */
        {0x80010, SWAP32(0x10001000)}, /* panel fb offset/window width */
        {0x80014, SWAP32(0x04000000)}, /* panel fb width (0x400=1024) */
        {0x80018, SWAP32(0x03000000)}, /* panel fb height (0x300=768) */
@@ -218,10 +251,6 @@ const unsigned char fpgadata[] =
 #include "../common/fpga.c"
 
 
-/* Prototypes */
-int gunzip(void *, int, unsigned char *, unsigned long *);
-
-
 /* logo bitmap data - gzip compressed and generated by bin2c */
 unsigned char logo_bmp_320[] =
 {
@@ -263,7 +292,7 @@ unsigned char logo_bmp_1024[] =
 au_image_t au_image[] = {
        {"hh405/preinst.img", 0, -1, AU_SCRIPT},
        {"hh405/u-boot.img", 0xfff80000, 0x00080000, AU_FIRMWARE},
-       {"hh405/pImage_$(bd_type)", 0x00000000, 0x00100000, AU_NAND},
+       {"hh405/pImage_${bd_type}", 0x00000000, 0x00100000, AU_NAND},
        {"hh405/pImage.initrd", 0x00100000, 0x00200000, AU_NAND},
        {"hh405/yaffsmt2.img", 0x00300000, 0x01c00000, AU_NAND},
        {"hh405/postinst.img", 0, 0, AU_SCRIPT},
@@ -272,6 +301,9 @@ au_image_t au_image[] = {
 int N_AU_IMAGES = (sizeof(au_image) / sizeof(au_image[0]));
 
 
+/*
+ * Get version of HH405 board from GPIO's
+ */
 int board_revision(void)
 {
        unsigned long osrh_reg;
@@ -279,41 +311,35 @@ int board_revision(void)
        unsigned long tcr_reg;
        unsigned long value;
 
-       /*
-        * Get version of HH405 board from GPIO's
-        */
-
        /*
         * Setup GPIO pins (BLAST/GPIO0 and GPIO9 as GPIO)
         */
-       osrh_reg = in32(GPIO0_OSRH);
-       isr1h_reg = in32(GPIO0_ISR1H);
-       tcr_reg = in32(GPIO0_TCR);
-       out32(GPIO0_OSRH, osrh_reg & ~0xC0003000);     /* output select */
-       out32(GPIO0_ISR1H, isr1h_reg | 0xC0003000);    /* input select  */
-       out32(GPIO0_TCR, tcr_reg & ~0x80400000);       /* select input  */
+       osrh_reg = in_be32((void *)GPIO0_OSRH);
+       isr1h_reg = in_be32((void *)GPIO0_ISR1H);
+       tcr_reg = in_be32((void *)GPIO0_TCR);
+       out_be32((void *)GPIO0_OSRH, osrh_reg & ~0xC0003000);     /* output select */
+       out_be32((void *)GPIO0_ISR1H, isr1h_reg | 0xC0003000);    /* input select  */
+       out_be32((void *)GPIO0_TCR, tcr_reg & ~0x80400000);       /* select input  */
 
        udelay(1000);            /* wait some time before reading input */
-       value = in32(GPIO0_IR) & 0x80400000;         /* get config bits */
+       value = in_be32((void *)GPIO0_IR) & 0x80400000;         /* get config bits */
 
        /*
         * Restore GPIO settings
         */
-       out32(GPIO0_OSRH, osrh_reg);                   /* output select */
-       out32(GPIO0_ISR1H, isr1h_reg);                 /* input select  */
-       out32(GPIO0_TCR, tcr_reg);  /* enable output driver for outputs */
+       out_be32((void *)GPIO0_OSRH, osrh_reg);                   /* output select */
+       out_be32((void *)GPIO0_ISR1H, isr1h_reg);                 /* input select  */
+       out_be32((void *)GPIO0_TCR, tcr_reg);  /* enable output driver for outputs */
 
        if (value & 0x80000000) {
                /* Revision 1.0 or 1.1 detected */
-               return 0x0101;
+               return 1;
        } else {
                if (value & 0x00400000) {
                        /* unused */
-                       return 0x0103;
+                       return 3;
                } else {
-                       /* Revision >= 2.0 detected */
-                       /* rev. 2.x uses four SM501 GPIOs for revision coding */
-                       return 0x0200;
+                       return 2;
                }
        }
 }
@@ -333,33 +359,54 @@ int board_early_init_f (void)
         * IRQ 30 (EXT IRQ 5) PCI INTA; active low; level sensitive
         * IRQ 31 (EXT IRQ 6) COMPACT FLASH; active high; level sensitive
         */
-       mtdcr(uicsr, 0xFFFFFFFF);       /* clear all ints */
-       mtdcr(uicer, 0x00000000);       /* disable all ints */
-       mtdcr(uiccr, 0x00000000);       /* set all to be non-critical*/
-       mtdcr(uicpr, CFG_UIC0_POLARITY);/* set int polarities */
-       mtdcr(uictr, 0x10000000);       /* set int trigger levels */
-       mtdcr(uicvcr, 0x00000001);      /* set vect base=0,INT0 highest priority*/
-       mtdcr(uicsr, 0xFFFFFFFF);       /* clear all ints */
+       mtdcr(UIC0SR, 0xFFFFFFFF);       /* clear all ints */
+       mtdcr(UIC0ER, 0x00000000);       /* disable all ints */
+       mtdcr(UIC0CR, 0x00000000);       /* set all to be non-critical*/
+       mtdcr(UIC0PR, CONFIG_SYS_UIC0_POLARITY);/* set int polarities */
+       mtdcr(UIC0TR, 0x10000000);       /* set int trigger levels */
+       mtdcr(UIC0VCR, 0x00000001);      /* set vect base=0,INT0 highest priority*/
+       mtdcr(UIC0SR, 0xFFFFFFFF);       /* clear all ints */
 
        /*
         * EBC Configuration Register: set ready timeout to 512 ebc-clks -> ca. 15 us
         */
-       mtebc (epcr, 0xa8400000); /* ebc always driven */
+       mtebc(EBC0_CFG, 0xa8400000); /* ebc always driven */
 
        return 0;
 }
 
+int cf_enable(void)
+{
+       int i;
+
+       if (gd->board_type >= 2) {
+               if (in_be16(FPGA_STATUS) & FPGA_STATUS_CF_DETECT) {
+                       if (!(in_be16(FPGA_CTRL) & FPGA_CTRL_CF_BUS_EN)) {
+                               out_be16(FPGA_CTRL,
+                                        in_be16(FPGA_CTRL) & ~FPGA_CTRL_CF_PWRN);
+
+                               for (i=0; i<300; i++)
+                                       udelay(1000);
+
+                               out_be16(FPGA_CTRL,
+                                        in_be16(FPGA_CTRL) | FPGA_CTRL_CF_BUS_EN);
+
+                               for (i=0; i<20; i++)
+                                       udelay(1000);
+                       }
+               } else {
+                       out_be16(FPGA_CTRL,
+                                in_be16(FPGA_CTRL) & ~FPGA_CTRL_CF_BUS_EN);
+                       out_be16(FPGA_CTRL,
+                                in_be16(FPGA_CTRL) | FPGA_CTRL_CF_PWRN);
+               }
+       }
+
+       return 0;
+}
 
 int misc_init_r (void)
 {
-       DECLARE_GLOBAL_DATA_PTR;
-
-       volatile unsigned short *fpga_ctrl =
-               (unsigned short *)((ulong)CFG_FPGA_BASE_ADDR + CFG_FPGA_CTRL);
-       volatile unsigned short *lcd_contrast =
-               (unsigned short *)((ulong)CFG_FPGA_BASE_ADDR + CFG_FPGA_CTRL + 4);
-       volatile unsigned short *lcd_backlight =
-               (unsigned short *)((ulong)CFG_FPGA_BASE_ADDR + CFG_FPGA_CTRL + 6);
        unsigned char *dst;
        ulong len = sizeof(fpgadata);
        int status;
@@ -368,8 +415,8 @@ int misc_init_r (void)
        char *str;
        unsigned long contrast0 = 0xffffffff;
 
-       dst = malloc(CFG_FPGA_MAX_SIZE);
-       if (gunzip (dst, CFG_FPGA_MAX_SIZE, (uchar *)fpgadata, &len) != 0) {
+       dst = malloc(CONFIG_SYS_FPGA_MAX_SIZE);
+       if (gunzip (dst, CONFIG_SYS_FPGA_MAX_SIZE, (uchar *)fpgadata, &len) != 0) {
                printf ("GUNZIP ERROR - must RESET board to recover\n");
                do_reset (NULL, 0, 0, NULL);
        }
@@ -423,45 +470,43 @@ int misc_init_r (void)
        /*
         * Reset FPGA via FPGA_INIT pin
         */
-       out32(GPIO0_TCR, in32(GPIO0_TCR) | FPGA_INIT); /* setup FPGA_INIT as output */
-       out32(GPIO0_OR, in32(GPIO0_OR) & ~FPGA_INIT);  /* reset low */
+       /* setup FPGA_INIT as output */
+       out_be32((void *)GPIO0_TCR,
+                in_be32((void *)GPIO0_TCR) | FPGA_INIT);
+       out_be32((void *)GPIO0_OR,
+                in_be32((void *)GPIO0_OR) & ~FPGA_INIT);  /* reset low */
        udelay(1000); /* wait 1ms */
-       out32(GPIO0_OR, in32(GPIO0_OR) | FPGA_INIT);   /* reset high */
+       out_be32((void *)GPIO0_OR,
+                in_be32((void *)GPIO0_OR) | FPGA_INIT);   /* reset high */
        udelay(1000); /* wait 1ms */
 
        /*
         * Write Board revision into FPGA
         */
-       *fpga_ctrl |= gd->board_type & 0x0003;
-       if (gd->board_type >= 0x0200) {
-               *fpga_ctrl |= CFG_FPGA_CTRL_CF_BUS_EN;
-       }
-
-       /*
-        * Setup and enable EEPROM write protection
-        */
-       out32(GPIO0_OR, in32(GPIO0_OR) | CFG_EEPROM_WP);
+       out_be16(FPGA_CTRL, in_be16(FPGA_CTRL) | (gd->board_type & 0x0003));
 
        /*
-        * Set NAND-FLASH GPIO signals to default
+        * Setup and enable EEPROM write protection
         */
-       out32(GPIO0_OR, in32(GPIO0_OR) & ~(CFG_NAND_CLE | CFG_NAND_ALE));
-       out32(GPIO0_OR, in32(GPIO0_OR) | CFG_NAND_CE);
+       out_be32((void *)GPIO0_OR,
+                in_be32((void *)GPIO0_OR) | CONFIG_SYS_EEPROM_WP);
 
        /*
         * Reset touch-screen controller
         */
-       out32(GPIO0_OR, in32(GPIO0_OR) & ~CFG_TOUCH_RST);
+       out_be32((void *)GPIO0_OR,
+                in_be32((void *)GPIO0_OR) & ~CONFIG_SYS_TOUCH_RST);
        udelay(1000);
-       out32(GPIO0_OR, in32(GPIO0_OR) | CFG_TOUCH_RST);
+       out_be32((void *)GPIO0_OR,
+                in_be32((void *)GPIO0_OR) | CONFIG_SYS_TOUCH_RST);
 
        /*
         * Enable power on PS/2 interface (with reset)
         */
-       *fpga_ctrl &= ~(CFG_FPGA_CTRL_PS2_PWR);
+       out_be16(FPGA_CTRL, in_be16(FPGA_CTRL) & ~FPGA_CTRL_PS2_PWR);
        for (i=0;i<500;i++)
                udelay(1000);
-       *fpga_ctrl |= (CFG_FPGA_CTRL_PS2_PWR);
+       out_be16(FPGA_CTRL, in_be16(FPGA_CTRL) | FPGA_CTRL_PS2_PWR);
 
        /*
         * Get contrast value from environment variable
@@ -470,8 +515,9 @@ int misc_init_r (void)
        if (str) {
                contrast0 = simple_strtol(str, NULL, 16);
                if (contrast0 > 255) {
-                       printf("ERROR: contrast0 value too high (0x%lx)!\n", contrast0);
-                       contrast0 = 0;
+                       printf("ERROR: contrast0 value too high (0x%lx)!\n",
+                              contrast0);
+                       contrast0 = 0xffffffff;
                }
        }
 
@@ -484,11 +530,12 @@ int misc_init_r (void)
                /*
                 * Switch backlight on
                 */
-               *fpga_ctrl |= CFG_FPGA_CTRL_VGA0_BL;
-               *lcd_backlight = 0x0000;
+               out_be16(FPGA_CTRL,
+                        in_be16(FPGA_CTRL) | FPGA_CTRL_VGA0_BL);
+               out_be16(FPGA_BL, 0x0000);
 
                lcd_setup(1, 0);
-               lcd_init((uchar *)CFG_LCD_BIG_REG, (uchar *)CFG_LCD_BIG_MEM,
+               lcd_init((uchar *)CONFIG_SYS_LCD_BIG_REG, (uchar *)CONFIG_SYS_LCD_BIG_MEM,
                         regs_13806_1024_768_8bpp,
                         sizeof(regs_13806_1024_768_8bpp)/sizeof(regs_13806_1024_768_8bpp[0]),
                         logo_bmp_1024, sizeof(logo_bmp_1024));
@@ -496,11 +543,12 @@ int misc_init_r (void)
                /*
                 * Switch backlight on
                 */
-               *fpga_ctrl &= ~CFG_FPGA_CTRL_VGA0_BL;
-               *lcd_backlight = 0x0000;
+               out_be16(FPGA_CTRL,
+                        in_be16(FPGA_CTRL) & ~FPGA_CTRL_VGA0_BL);
+               out_be16(FPGA_BL, 0x0000);
 
                lcd_setup(1, 0);
-               lcd_init((uchar *)CFG_LCD_BIG_REG, (uchar *)CFG_LCD_BIG_MEM,
+               lcd_init((uchar *)CONFIG_SYS_LCD_BIG_REG, (uchar *)CONFIG_SYS_LCD_BIG_MEM,
                         regs_13806_640_480_16bpp,
                         sizeof(regs_13806_640_480_16bpp)/sizeof(regs_13806_640_480_16bpp[0]),
                         logo_bmp_640, sizeof(logo_bmp_640));
@@ -509,23 +557,26 @@ int misc_init_r (void)
                 * Set default display contrast voltage
                 */
                if (contrast0 == 0xffffffff) {
-                       *lcd_contrast = 0x0082;
+                       out_be16(FPGA_CTR, 0x0082);
                } else {
-                       *lcd_contrast = contrast0;
+                       out_be16(FPGA_CTR, contrast0);
                }
-               *lcd_backlight = 0xffff;
+               out_be16(FPGA_BL, 0xffff);
                /*
                 * Switch backlight on
                 */
-               *fpga_ctrl |= CFG_FPGA_CTRL_VGA0_BL | CFG_FPGA_CTRL_VGA0_BL_MODE;
+               out_be16(FPGA_CTRL,
+                        in_be16(FPGA_CTRL) |
+                        FPGA_CTRL_VGA0_BL |
+                        FPGA_CTRL_VGA0_BL_MODE);
                /*
                 * Set lcd clock (small epson)
                 */
-               *fpga_ctrl |= LCD_CLK_06250;
+               out_be16(FPGA_CTRL, in_be16(FPGA_CTRL) | LCD_CLK_06250);
                udelay(100);               /* wait for 100 us */
 
                lcd_setup(0, 1);
-               lcd_init((uchar *)CFG_LCD_SMALL_REG, (uchar *)CFG_LCD_SMALL_MEM,
+               lcd_init((uchar *)CONFIG_SYS_LCD_SMALL_REG, (uchar *)CONFIG_SYS_LCD_SMALL_MEM,
                         regs_13705_320_240_8bpp,
                         sizeof(regs_13705_320_240_8bpp)/sizeof(regs_13705_320_240_8bpp[0]),
                         logo_bmp_320_8bpp, sizeof(logo_bmp_320_8bpp));
@@ -534,22 +585,28 @@ int misc_init_r (void)
                 * Set default display contrast voltage
                 */
                if (contrast0 == 0xffffffff) {
-                       *lcd_contrast = 0x0060;
+                       out_be16(FPGA_CTR, 0x0060);
                } else {
-                       *lcd_contrast = contrast0;
+                       out_be16(FPGA_CTR, contrast0);
                }
-               *lcd_backlight = 0xffff;
+               out_be16(FPGA_BL, 0xffff);
                /*
                 * Switch backlight on
                 */
-               *fpga_ctrl |= CFG_FPGA_CTRL_VGA0_BL | CFG_FPGA_CTRL_VGA0_BL_MODE;
+               out_be16(FPGA_CTRL,
+                        in_be16(FPGA_CTRL) |
+                        FPGA_CTRL_VGA0_BL |
+                        FPGA_CTRL_VGA0_BL_MODE);
                /*
-                * Set lcd clock (small epson)
+                * Set lcd clock (small epson), enable 1-wire interface
                 */
-               *fpga_ctrl |= LCD_CLK_08330;
+               out_be16(FPGA_CTRL,
+                        in_be16(FPGA_CTRL) |
+                        LCD_CLK_08330 |
+                        FPGA_CTRL_OW_ENABLE);
 
                lcd_setup(0, 1);
-               lcd_init((uchar *)CFG_LCD_SMALL_REG, (uchar *)CFG_LCD_SMALL_MEM,
+               lcd_init((uchar *)CONFIG_SYS_LCD_SMALL_REG, (uchar *)CONFIG_SYS_LCD_SMALL_MEM,
                         regs_13704_320_240_4bpp,
                         sizeof(regs_13704_320_240_4bpp)/sizeof(regs_13704_320_240_4bpp[0]),
                         logo_bmp_320, sizeof(logo_bmp_320));
@@ -565,8 +622,10 @@ int misc_init_r (void)
                        puts("VGA:   SM501 with 8 MB ");
                        if (strcmp(str, "ppc221") == 0) {
                                printf("(800*600, %dbpp)\n", BPP);
+                               out_be16(FPGA_BL, 0x002d); /* max. allowed brightness */
                        } else if (strcmp(str, "ppc231") == 0) {
                                printf("(1024*768, %dbpp)\n", BPP);
+                               out_be16(FPGA_BL, 0x0000);
                        } else {
                                printf("Unsupported bd_type defined (%s) -> No display configured!\n", str);
                                return 0;
@@ -578,6 +637,8 @@ int misc_init_r (void)
 #endif /* CONFIG_VIDEO_SM501 */
        }
 
+       cf_enable();
+
        return (0);
 }
 
@@ -588,9 +649,7 @@ int misc_init_r (void)
 
 int checkboard (void)
 {
-       DECLARE_GLOBAL_DATA_PTR;
-
-       unsigned char str[64];
+       char str[64];
        int i = getenv_r ("serial#", str, sizeof(str));
 
        puts ("Board: ");
@@ -608,77 +667,36 @@ int checkboard (void)
        }
 
        gd->board_type = board_revision();
-       printf(", Rev %ld.%ld)\n",
-              (gd->board_type >> 8) & 0xff,
-              gd->board_type & 0xff);
-
-       /*
-        * Disable sleep mode in LXT971
-        */
-       lxt971_no_sleep();
+       printf(", Rev %ld.x)\n", gd->board_type);
 
        return 0;
 }
 
-
-long int initdram (int board_type)
-{
-       unsigned long val;
-
-       mtdcr(memcfga, mem_mb0cf);
-       val = mfdcr(memcfgd);
-
-#if 0
-       printf("\nmb0cf=%x\n", val); /* test-only */
-       printf("strap=%x\n", mfdcr(strap)); /* test-only */
-#endif
-
-       return (4*1024*1024 << ((val & 0x000e0000) >> 17));
-}
-
-
-int testdram (void)
-{
-       /* TODO: XXX XXX XXX */
-       printf ("test: 16 MB - ok\n");
-
-       return (0);
-}
-
-
 #ifdef CONFIG_IDE_RESET
 void ide_set_reset(int on)
 {
-       volatile unsigned short *fpga_mode =
-               (unsigned short *)((ulong)CFG_FPGA_BASE_ADDR + CFG_FPGA_CTRL);
-
-       /*
-        * Assert or deassert CompactFlash Reset Pin
-        */
-       if (on) {               /* assert RESET */
-               *fpga_mode &= ~(CFG_FPGA_CTRL_CF_RESET);
-       } else {                /* release RESET */
-               *fpga_mode |= CFG_FPGA_CTRL_CF_RESET;
+       if (((gd->board_type >= 2) &&
+            (in_be16(FPGA_STATUS) & FPGA_STATUS_CF_DETECT)) ||
+           (gd->board_type < 2)) {
+               /*
+                * Assert or deassert CompactFlash Reset Pin
+                */
+               if (on) {               /* assert RESET */
+                       cf_enable();
+                       out_be16(FPGA_CTRL,
+                                in_be16(FPGA_CTRL) &
+                                ~FPGA_CTRL_CF_RESET);
+               } else {                /* release RESET */
+                       out_be16(FPGA_CTRL,
+                                in_be16(FPGA_CTRL) |
+                                FPGA_CTRL_CF_RESET);
+               }
        }
 }
 #endif /* CONFIG_IDE_RESET */
 
 
-#if (CONFIG_COMMANDS & CFG_CMD_NAND)
-#include <linux/mtd/nand.h>
-extern struct nand_chip nand_dev_desc[CFG_MAX_NAND_DEVICE];
-
-void nand_init(void)
-{
-       nand_probe(CFG_NAND_BASE);
-       if (nand_dev_desc[0].ChipID != NAND_ChipID_UNKNOWN) {
-               print_size(nand_dev_desc[0].totlen, "\n");
-       }
-}
-#endif
-
-
-#if defined(CFG_EEPROM_WREN)
+#if defined(CONFIG_SYS_EEPROM_WREN)
 /* Input: <dev_addr>  I2C address of EEPROM device to enable.
  *         <state>     -1: deliver current state
  *                    0: disable write
@@ -689,23 +707,26 @@ void nand_init(void)
  */
 int eeprom_write_enable (unsigned dev_addr, int state)
 {
-       if (CFG_I2C_EEPROM_ADDR != dev_addr) {
+       if (CONFIG_SYS_I2C_EEPROM_ADDR != dev_addr) {
                return -1;
        } else {
                switch (state) {
                case 1:
                        /* Enable write access, clear bit GPIO_SINT2. */
-                       out32(GPIO0_OR, in32(GPIO0_OR) & ~CFG_EEPROM_WP);
+                       out_be32((void *)GPIO0_OR,
+                                in_be32((void *)GPIO0_OR) & ~CONFIG_SYS_EEPROM_WP);
                        state = 0;
                        break;
                case 0:
                        /* Disable write access, set bit GPIO_SINT2. */
-                       out32(GPIO0_OR, in32(GPIO0_OR) | CFG_EEPROM_WP);
+                       out_be32((void *)GPIO0_OR,
+                                in_be32((void *)GPIO0_OR) | CONFIG_SYS_EEPROM_WP);
                        state = 0;
                        break;
                default:
                        /* Read current status back. */
-                       state = (0 == (in32(GPIO0_OR) & CFG_EEPROM_WP));
+                       state = (0 == (in_be32((void *)GPIO0_OR) &
+                                      CONFIG_SYS_EEPROM_WP));
                        break;
                }
        }
@@ -719,21 +740,21 @@ int do_eep_wren (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 
        if (query) {
                /* Query write access state. */
-               state = eeprom_write_enable (CFG_I2C_EEPROM_ADDR, -1);
+               state = eeprom_write_enable (CONFIG_SYS_I2C_EEPROM_ADDR, -1);
                if (state < 0) {
                        puts ("Query of write access state failed.\n");
                } else {
                        printf ("Write access for device 0x%0x is %sabled.\n",
-                               CFG_I2C_EEPROM_ADDR, state ? "en" : "dis");
+                               CONFIG_SYS_I2C_EEPROM_ADDR, state ? "en" : "dis");
                        state = 0;
                }
        } else {
                if ('0' == argv[1][0]) {
                        /* Disable write access. */
-                       state = eeprom_write_enable (CFG_I2C_EEPROM_ADDR, 0);
+                       state = eeprom_write_enable (CONFIG_SYS_I2C_EEPROM_ADDR, 0);
                } else {
                        /* Enable write access. */
-                       state = eeprom_write_enable (CFG_I2C_EEPROM_ADDR, 1);
+                       state = eeprom_write_enable (CONFIG_SYS_I2C_EEPROM_ADDR, 1);
                }
                if (state < 0) {
                        puts ("Setup of write access state failed.\n");
@@ -744,9 +765,10 @@ int do_eep_wren (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
 }
 
 U_BOOT_CMD(eepwren,    2,      0,      do_eep_wren,
-          "eepwren - Enable / disable / query EEPROM write access\n",
-          NULL);
-#endif /* #if defined(CFG_EEPROM_WREN) */
+       "Enable / disable / query EEPROM write access",
+       ""
+);
+#endif /* #if defined(CONFIG_SYS_EEPROM_WREN) */
 
 
 #ifdef CONFIG_VIDEO_SM501
@@ -756,8 +778,6 @@ U_BOOT_CMD(eepwren, 2,      0,      do_eep_wren,
  */
 void video_get_info_str (int line_number, char *info)
 {
-       DECLARE_GLOBAL_DATA_PTR;
-
        char str[64];
        char str2[64];
        int i = getenv_r("serial#", str2, sizeof(str));
@@ -778,8 +798,7 @@ void video_get_info_str (int line_number, char *info)
                        strcat(str, " (Missing bd_type!");
                }
 
-               sprintf(str2, ", Rev %ld.%ld)",
-                      (gd->board_type >> 8) & 0xff, gd->board_type & 0xff);
+               sprintf(str2, ", Rev %ld.x)", gd->board_type);
                strcat(str, str2);
                strcpy(info, str);
        } else {
@@ -822,7 +841,11 @@ unsigned int board_video_get_fb (void)
        devbusfn = pci_find_device(PCI_VENDOR_SM, PCI_DEVICE_SM501, 0);
        if (devbusfn != -1) {
                pci_read_config_dword(devbusfn, PCI_BASE_ADDRESS_0, (u32 *)&addr);
-               return (addr & 0xfffffffe);
+               addr &= 0xfffffffe;
+#ifdef CONFIG_VIDEO_SM501_FBMEM_OFFSET
+               addr += CONFIG_VIDEO_SM501_FBMEM_OFFSET;
+#endif
+               return addr;
        }
 
        return 0;
@@ -875,3 +898,15 @@ int board_get_height (void)
 }
 
 #endif /* CONFIG_VIDEO_SM501 */
+
+
+void reset_phy(void)
+{
+#ifdef CONFIG_LXT971_NO_SLEEP
+
+       /*
+        * Disable sleep mode in LXT971
+        */
+       lxt971_no_sleep();
+#endif
+}