summaryrefslogtreecommitdiff
path: root/target/u-boot
diff options
context:
space:
mode:
authorUlf Samuelsson <ulf.samuelsson@atmel.com>2009-01-06 16:17:43 +0000
committerUlf Samuelsson <ulf.samuelsson@atmel.com>2009-01-06 16:17:43 +0000
commitce5971ecca440d32185c1ec1d5b9c0e670b7e7a8 (patch)
tree904648fbae16800493f7198ff63cec57c239b0e5 /target/u-boot
parentd6afbb99b478ea845ea6a9aea69e1eb306e9c608 (diff)
Add 'mux' command to control ext mux on at91rm9200dk/ek
Diffstat (limited to 'target/u-boot')
-rw-r--r--target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-011-spimux.patch93
-rw-r--r--target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-012-ethinit.patch77
-rw-r--r--target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-013-configs.patch130
-rw-r--r--target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-014-at572d940hfeb.patch3866
-rw-r--r--target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-016-cmd_mem.patch412
5 files changed, 4578 insertions, 0 deletions
diff --git a/target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-011-spimux.patch b/target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-011-spimux.patch
new file mode 100644
index 000000000..8ab469fd8
--- /dev/null
+++ b/target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-011-spimux.patch
@@ -0,0 +1,93 @@
+diff -urN u-boot-2009.01-0rig//common/cmd_mux.c u-boot-2009.01/common/cmd_mux.c
+--- u-boot-2009.01-0rig//common/cmd_mux.c 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01/common/cmd_mux.c 2009-01-04 00:17:19.000000000 +0100
+@@ -0,0 +1,78 @@
++/*
++ * (C) Copyright 2008
++ * Ulf Samuelsson <ulf.samuelsson@atmel.com>
++ *
++ * 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
++ */
++
++#include <common.h>
++#include <command.h>
++#if (defined(CONFIG_AT91RM9200DK) || defined(CONFIG_AT91RM9200EK) || defined(CONFIG_AT91RM9200DF))
++
++#include <asm/arch/AT91RM9200.h>
++#include <dataflash.h>
++#include <at45.h>
++
++
++static int mmc_nspi (const char *s)
++{
++ if (strcmp(s, "mmc") == 0) {
++ return (1);
++ } else if (strcmp(s, "spi") == 0) {
++ return (0);
++ }
++ return (-1);
++}
++
++int do_mux ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
++{
++ switch (argc) {
++ case 2: /* on / off */
++ switch (mmc_nspi(argv[1])) {
++#if 0 /* prevented by varargs handling; FALLTROUGH is harmless, too */
++ default: printf ("Usage:\n%s\n", cmdtp->usage);
++ return;
++#endif
++ case 0: AT91F_SelectSPI ();
++ break;
++ case 1: AT91F_SelectMMC ();
++ break;
++ }
++ /* FALL TROUGH */
++ case 1: /* get status */
++ printf ("Mux is configured to be %s\n",
++ AT91F_GetMuxStatus() ? "MMC" : "SPI");
++ return 0;
++ default:
++ printf ("Usage:\n%s\n", cmdtp->usage);
++ return 1;
++ }
++ return 0;
++}
++
++
++U_BOOT_CMD(
++ mux, 2, 1, do_mux,
++ "mux\t- enable or disable MMC or SPI\n",
++ "[mmc, spi]\n"
++ " - enable or disable MMC or SPI\n"
++);
++
++#endif /* CONFIG_CMD_MUX */
++
+diff -urN u-boot-2009.01-0rig//common/Makefile u-boot-2009.01/common/Makefile
+--- u-boot-2009.01-0rig//common/Makefile 2009-01-04 00:10:28.000000000 +0100
++++ u-boot-2009.01/common/Makefile 2009-01-04 00:20:39.000000000 +0100
+@@ -112,6 +112,7 @@
+ COBJS-$(CONFIG_CMD_MISC) += cmd_misc.o
+ COBJS-$(CONFIG_CMD_MMC) += cmd_mmc.o
+ COBJS-$(CONFIG_MP) += cmd_mp.o
++COBJS-$(CONFIG_CMD_AT91_SPIMUX) += cmd_mux.o
+ COBJS-y += cmd_nand.o
+ COBJS-$(CONFIG_CMD_NET) += cmd_net.o
+ COBJS-$(CONFIG_CMD_ONENAND) += cmd_onenand.o
diff --git a/target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-012-ethinit.patch b/target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-012-ethinit.patch
new file mode 100644
index 000000000..c2f709c70
--- /dev/null
+++ b/target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-012-ethinit.patch
@@ -0,0 +1,77 @@
+diff -urN u-boot-2009.01-0rig//common/cmd_ethinit.c u-boot-2009.01/common/cmd_ethinit.c
+--- u-boot-2009.01-0rig//common/cmd_ethinit.c 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01/common/cmd_ethinit.c 2009-01-04 00:28:39.000000000 +0100
+@@ -0,0 +1,62 @@
++/*
++ * (C) Copyright 2000
++ * 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
++ */
++
++/*
++ * Boot support
++ */
++#include <common.h>
++#include <command.h>
++#include <net.h>
++#ifdef CONFIG_CMD_ETHINIT
++extern int eth_init (bd_t * bd);
++
++static void delay(void)
++{
++}
++/*
++ * This command allows you to delay booting until you have a
++ * valid Ethernet connection.
++ * Neccessary if you want to NFS mount a rootfs etc.
++ * When both this target and the NFS server
++ * are powered on at the same time, then the NFS
++ * server can take a long time to boot.
++ */
++int do_ethinit (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
++{
++ int i;
++ DECLARE_GLOBAL_DATA_PTR;
++ while(eth_init (gd->bd) == 0) {
++ for(i = 0; i < 10000000; i ++) {
++ delay();
++ }
++ }
++ return 0;
++}
++
++U_BOOT_CMD(
++ ethinit, 1, 1, do_ethinit,
++ "ethinit\t- Initialize Ethernet controller\n",
++ "\n"
++);
++
++#endif /* CONFIG_CMD_ETHINIT */
+diff -urN u-boot-2009.01-0rig//common/Makefile u-boot-2009.01/common/Makefile
+--- u-boot-2009.01-0rig//common/Makefile 2009-01-04 00:22:06.000000000 +0100
++++ u-boot-2009.01/common/Makefile 2009-01-04 00:29:46.000000000 +0100
+@@ -83,6 +83,7 @@
+ COBJS-$(CONFIG_ENV_IS_IN_EEPROM) += cmd_eeprom.o
+ COBJS-$(CONFIG_CMD_EEPROM) += cmd_eeprom.o
+ COBJS-$(CONFIG_CMD_ELF) += cmd_elf.o
++COBJS-$(CONFIG_CMD_ETHINIT) += cmd_ethinit.o
+ COBJS-$(CONFIG_CMD_EXT2) += cmd_ext2.o
+ COBJS-$(CONFIG_CMD_FACTORY) += cmd_factory.o
+ COBJS-$(CONFIG_CMD_FAT) += cmd_fat.o
diff --git a/target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-013-configs.patch b/target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-013-configs.patch
new file mode 100644
index 000000000..e65645b69
--- /dev/null
+++ b/target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-013-configs.patch
@@ -0,0 +1,130 @@
+diff -urN u-boot-2009.01-0rig//include/configs/at91cap9adk.h u-boot-2009.01/include/configs/at91cap9adk.h
+--- u-boot-2009.01-0rig//include/configs/at91cap9adk.h 2008-12-16 23:48:27.000000000 +0100
++++ u-boot-2009.01/include/configs/at91cap9adk.h 2009-01-04 00:43:58.000000000 +0100
+@@ -69,7 +69,9 @@
+ #define CONFIG_ATMEL_LCD 1
+ #define CONFIG_ATMEL_LCD_BGR555 1
+ #define CONFIG_SYS_CONSOLE_IS_IN_ENV 1
+-
++#define CONFIG_CMD_FACTORY
++#define CONFIG_CMD_LED
++#define CONFIG_COLOURED_LED
+ #define CONFIG_BOOTDELAY 3
+
+ /*
+diff -urN u-boot-2009.01-0rig//include/configs/at91rm9200df.h u-boot-2009.01/include/configs/at91rm9200df.h
+--- u-boot-2009.01-0rig//include/configs/at91rm9200df.h 2009-01-02 17:37:43.000000000 +0100
++++ u-boot-2009.01/include/configs/at91rm9200df.h 2009-01-04 00:43:33.000000000 +0100
+@@ -123,6 +123,9 @@
+ #define CONFIG_CMD_DHCP
+ #define CONFIG_CMD_MII
+ #define CONFIG_CMD_NAND
++#define CONFIG_CMD_FACTORY
++#define CONFIG_CMD_LED
++#define CONFIG_COLOURED_LED
+ #define CONFIG_CMD_AT91_SPIMUX
+ #define CONFIG_CMD_ETHINIT
+
+diff -urN u-boot-2009.01-0rig//include/configs/at91rm9200dk_df.h u-boot-2009.01/include/configs/at91rm9200dk_df.h
+--- u-boot-2009.01-0rig//include/configs/at91rm9200dk_df.h 2009-01-02 10:03:11.000000000 +0100
++++ u-boot-2009.01/include/configs/at91rm9200dk_df.h 2009-01-04 00:42:52.000000000 +0100
+@@ -122,7 +122,11 @@
+ #define CONFIG_CMD_DHCP
+ #define CONFIG_CMD_MII
+ #define CONFIG_CMD_NAND
++#define CONFIG_CMD_FACTORY
++#define CONFIG_CMD_LED
++#define CONFIG_COLOURED_LED
+ #define CONFIG_CMD_AT91_SPIMUX
++#define CONFIG_CMD_ETHINIT
+
+ #define CONFIG_NAND_LEGACY
+
+diff -urN u-boot-2009.01-0rig//include/configs/at91rm9200dk.h u-boot-2009.01/include/configs/at91rm9200dk.h
+--- u-boot-2009.01-0rig//include/configs/at91rm9200dk.h 2009-01-02 10:03:11.000000000 +0100
++++ u-boot-2009.01/include/configs/at91rm9200dk.h 2009-01-04 00:43:15.000000000 +0100
+@@ -120,7 +120,11 @@
+ #define CONFIG_CMD_DHCP
+ #define CONFIG_CMD_MII
+ #define CONFIG_CMD_NAND
++#define CONFIG_CMD_FACTORY
++#define CONFIG_CMD_LED
++#define CONFIG_COLOURED_LED
+ #define CONFIG_CMD_AT91_SPIMUX
++#define CONFIG_CMD_ETHINIT
+
+ #define CONFIG_NAND_LEGACY
+
+diff -urN u-boot-2009.01-0rig//include/configs/at91rm9200ek.h u-boot-2009.01/include/configs/at91rm9200ek.h
+--- u-boot-2009.01-0rig//include/configs/at91rm9200ek.h 2009-01-02 17:37:43.000000000 +0100
++++ u-boot-2009.01/include/configs/at91rm9200ek.h 2009-01-04 00:42:35.000000000 +0100
+@@ -121,9 +121,11 @@
+ #define CONFIG_CMD_DHCP
+ #define CONFIG_CMD_MII
+ #define CONFIG_CMD_NAND
++#define CONFIG_CMD_FACTORY
++#define CONFIG_CMD_LED
++#define CONFIG_COLOURED_LED
+ #define CONFIG_CMD_AT91_SPIMUX
+ #define CONFIG_CMD_ETHINIT
+-
+ #define CONFIG_NAND_LEGACY
+
+ #define CONFIG_SYS_MAX_NAND_DEVICE 1 /* Max number of NAND devices */
+diff -urN u-boot-2009.01-0rig//include/configs/at91sam9260ek.h u-boot-2009.01/include/configs/at91sam9260ek.h
+--- u-boot-2009.01-0rig//include/configs/at91sam9260ek.h 2008-12-16 23:48:27.000000000 +0100
++++ u-boot-2009.01/include/configs/at91sam9260ek.h 2009-01-04 00:41:56.000000000 +0100
+@@ -74,10 +74,13 @@
+ #include <config_cmd_default.h>
+ #undef CONFIG_CMD_BDI
+ #undef CONFIG_CMD_IMI
+-#undef CONFIG_CMD_AUTOSCRIPT
++#define CONFIG_CMD_AUTOSCRIPT
+ #undef CONFIG_CMD_FPGA
+ #undef CONFIG_CMD_LOADS
+ #undef CONFIG_CMD_IMLS
++#define CONFIG_CMD_FACTORY
++#define CONFIG_CMD_LED
++#define CONFIG_COLOURED_LED
+
+ #define CONFIG_CMD_PING 1
+ #define CONFIG_CMD_DHCP 1
+diff -urN u-boot-2009.01-0rig//include/configs/at91sam9261ek.h u-boot-2009.01/include/configs/at91sam9261ek.h
+--- u-boot-2009.01-0rig//include/configs/at91sam9261ek.h 2008-12-16 23:48:27.000000000 +0100
++++ u-boot-2009.01/include/configs/at91sam9261ek.h 2009-01-04 00:44:11.000000000 +0100
+@@ -68,6 +68,9 @@
+ #define CONFIG_ATMEL_LCD 1
+ #define CONFIG_ATMEL_LCD_BGR555 1
+ #define CONFIG_SYS_CONSOLE_IS_IN_ENV 1
++#define CONFIG_CMD_FACTORY
++#define CONFIG_CMD_LED
++#define CONFIG_COLOURED_LED
+
+ #define CONFIG_BOOTDELAY 3
+
+diff -urN u-boot-2009.01-0rig//include/configs/at91sam9263ek.h u-boot-2009.01/include/configs/at91sam9263ek.h
+--- u-boot-2009.01-0rig//include/configs/at91sam9263ek.h 2008-12-16 23:48:27.000000000 +0100
++++ u-boot-2009.01/include/configs/at91sam9263ek.h 2009-01-04 00:44:34.000000000 +0100
+@@ -69,6 +69,9 @@
+ #define CONFIG_ATMEL_LCD 1
+ #define CONFIG_ATMEL_LCD_BGR555 1
+ #define CONFIG_SYS_CONSOLE_IS_IN_ENV 1
++#define CONFIG_CMD_FACTORY
++#define CONFIG_CMD_LED
++#define CONFIG_COLOURED_LED
+
+ #define CONFIG_BOOTDELAY 3
+
+diff -urN u-boot-2009.01-0rig//include/configs/at91sam9rlek.h u-boot-2009.01/include/configs/at91sam9rlek.h
+--- u-boot-2009.01-0rig//include/configs/at91sam9rlek.h 2008-12-16 23:48:27.000000000 +0100
++++ u-boot-2009.01/include/configs/at91sam9rlek.h 2009-01-04 00:44:54.000000000 +0100
+@@ -68,6 +68,9 @@
+ #define CONFIG_ATMEL_LCD 1
+ #define CONFIG_ATMEL_LCD_RGB565 1
+ #define CONFIG_SYS_CONSOLE_IS_IN_ENV 1
++#define CONFIG_CMD_FACTORY
++#define CONFIG_CMD_LED
++#define CONFIG_COLOURED_LED
+
+ #define CONFIG_BOOTDELAY 3
+
diff --git a/target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-014-at572d940hfeb.patch b/target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-014-at572d940hfeb.patch
new file mode 100644
index 000000000..fd8516319
--- /dev/null
+++ b/target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-014-at572d940hfeb.patch
@@ -0,0 +1,3866 @@
+diff -urN u-boot-2009.01-rc1-0rig//board/atmel/at572d940hfeb/at572d940hfeb.c u-boot-2009.01-rc1/board/atmel/at572d940hfeb/at572d940hfeb.c
+--- u-boot-2009.01-rc1-0rig//board/atmel/at572d940hfeb/at572d940hfeb.c 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/board/atmel/at572d940hfeb/at572d940hfeb.c 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,277 @@
++/* (C) 2008 Copyright Atmel Corporation
++ *
++ * Antonio R. Costa <antonio.costa <at> atmel.com>
++ * <costa.antonior <at> gmail.com>
++ *
++ * (C) Copyright 2007-2008
++ * Stelian Pop <stelian.pop <at> leadtechdesign.com>
++ * Lead Tech Design <www.leadtechdesign.com>
++ *
++ * 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
++ */
++
++#include <common.h>
++#include <asm/arch/at572d940hf.h>
++#include <asm/arch/at572d940hf_matrix.h>
++#include <asm/arch/at572d940hf_mc.h>
++#include <asm/arch/at91_pmc.h>
++#include <asm/arch/at91_rstc.h>
++#include <asm/arch/gpio.h>
++#include <asm/arch/io.h>
++#include <asm/arch/at91_aic.h>
++#include <asm/arch/interrupts.h>
++#if defined(CONFIG_RESET_PHY_R) && defined(CONFIG_MACB)
++#include <net.h>
++#endif
++
++DECLARE_GLOBAL_DATA_PTR;
++
++/* ------------------------------------------------------------------------- */
++/*
++ * Miscelaneous platform dependent initialisations
++ */
++
++static void AT572D940HFEB_serial_hw_init(void)
++{
++#ifdef CONFIG_USART0
++ at91_set_A_periph(AT91_PIN_PA8, 1); /* TXD0 */
++ at91_set_A_periph(AT91_PIN_PA7, 0); /* RXD0 */
++ at91_sys_write(AT91_PMC_PCER, 1 << AT91_ID_US0);
++#endif
++
++#ifdef CONFIG_USART1
++ at91_set_A_periph(AT91_PIN_PC10, 1); /* TXD1 */
++ at91_set_A_periph(AT91_PIN_PC9, 0); /* RXD1 */
++ at91_sys_write(AT91_PMC_PCER, 1 << AT91_ID_US1);
++#endif
++
++#ifdef CONFIG_USART2
++ at91_set_A_periph(AT91_PIN_PC15, 1); /* TXD2 */
++ at91_set_A_periph(AT91_PIN_PC14, 0); /* RXD2 */
++ at91_sys_write(AT91_PMC_PCER, 1 << AT91_ID_US2);
++#endif
++
++#ifdef CONFIG_USART3 /* DBGU */
++ at91_set_A_periph(AT91_PIN_PC30, 0); /* DRXD */
++ at91_set_A_periph(AT91_PIN_PC31, 1); /* DTXD */
++ at91_sys_write(AT91_PMC_PCER, 1 << AT91_ID_SYS);
++#endif
++}
++
++#ifdef CONFIG_CMD_NAND
++static void AT572D940HFEB_nand_hw_init(void)
++{
++ unsigned long csa;
++
++ /* Enable CS3 */
++ csa = at91_sys_read(AT91_MATRIX_EBICSA);
++ at91_sys_write(AT91_MATRIX_EBICSA,
++ csa | AT91_MATRIX_CS3A_SMC_SMARTMEDIA);
++
++ /* Configure SMC CS3 for NAND/SmartMedia */
++ at91_sys_write(AT91_SMC_SETUP(3),
++ AT91_SMC_NWESETUP_(0) | AT91_SMC_NCS_WRSETUP_(0) |
++ AT91_SMC_NRDSETUP_(0) | AT91_SMC_NCS_RDSETUP_(0));
++ at91_sys_write(AT91_SMC_PULSE(3),
++ AT91_SMC_NWEPULSE_(3) | AT91_SMC_NCS_WRPULSE_(3) |
++ AT91_SMC_NRDPULSE_(3) | AT91_SMC_NCS_RDPULSE_(3));
++ at91_sys_write(AT91_SMC_CYCLE(3),
++ AT91_SMC_NWECYCLE_(5) | AT91_SMC_NRDCYCLE_(5));
++ at91_sys_write(AT91_SMC_MODE(3),
++ AT91_SMC_READMODE | AT91_SMC_WRITEMODE |
++ AT91_SMC_EXNWMODE_DISABLE |
++ AT91_SMC_DBW_8 | AT91_SMC_TDF_(2));
++
++ at91_sys_write(AT91_PMC_PCER, 1 << AT572D940HF_ID_PIOC);
++
++ /* Configure RDY/BSY */
++ at91_set_gpio_input(AT91_PIN_PC16, 1);
++
++ /* Enable NandFlash */
++ /* By DIP switch on AT572D940HFEB */
++ at91_set_gpio_output(AT91_PIN_PC14, 1);
++}
++#endif
++
++#ifdef CONFIG_HAS_DATAFLASH
++static void AT572D940HFEB_spi_hw_init(void)
++{
++ at91_set_A_periph(AT91_PIN_PA3, 0); /* SPI0_NPCS0 */
++ at91_set_A_periph(AT91_PIN_PA4, 0); /* SPI0_NPCS1 */
++
++ at91_set_A_periph(AT91_PIN_PA0, 0); /* SPI0_MISO */
++ at91_set_A_periph(AT91_PIN_PA1, 0); /* SPI0_MOSI */
++ at91_set_A_periph(AT91_PIN_PA2, 0); /* SPI0_SPCK */
++
++ /* Enable clock */
++ at91_sys_write(AT91_PMC_PCER, 1 << AT572D940HF_ID_SPI0);
++}
++#endif
++
++#ifdef CONFIG_MACB
++static void AT572D940HFEB_macb_hw_init(void)
++{
++ /* Enable clock */
++ at91_sys_write(AT91_PMC_PCER, 1 << AT572D940HF_ID_EMAC);
++
++ /* Need to reset PHY -> 500ms reset */
++#if 0
++ at91_sys_write(AT91_RSTC_MR, AT91_RSTC_KEY |
++ (AT91_RSTC_ERSTL & (0x0D << 8)) |
++ AT91_RSTC_URSTEN);
++
++ at91_sys_write(AT91_RSTC_CR, AT91_RSTC_KEY | AT91_RSTC_EXTRST);
++
++ /* Wait for end hardware reset */
++ while (!(at91_sys_read(AT91_RSTC_SR) & AT91_RSTC_NRSTL));
++
++ /* Restore NRST value */
++ at91_sys_write(AT91_RSTC_MR, AT91_RSTC_KEY |
++ (AT91_RSTC_ERSTL & (0x0 << 8)) |
++ AT91_RSTC_URSTEN);
++#endif
++
++ at91_set_A_periph(AT91_PIN_PA16, 0); /* ETXCK_EREFCK */
++ at91_set_A_periph(AT91_PIN_PA17, 0); /* ERXDV */
++ at91_set_A_periph(AT91_PIN_PA18, 0); /* ERX0 */
++ at91_set_A_periph(AT91_PIN_PA19, 0); /* ERX1 */
++ at91_set_A_periph(AT91_PIN_PA20, 0); /* ERXER */
++ at91_set_A_periph(AT91_PIN_PA23, 0); /* ETXEN */
++ at91_set_A_periph(AT91_PIN_PA21, 0); /* ETX0 */
++ at91_set_A_periph(AT91_PIN_PA22, 0); /* ETX1 */
++ at91_set_A_periph(AT91_PIN_PA13, 0); /* EMDIO */
++ at91_set_A_periph(AT91_PIN_PA14, 0); /* EMDC */
++ at91_set_A_periph(AT91_PIN_PA15, 0); /* EFCE100 */
++}
++#endif
++
++#ifdef CONFIG_MMC
++static void AT572D940HFEB_mci_hw_init(void)
++{
++ at91_sys_write(AT91_PMC_PCER, (1 << AT572D940HF_ID_MCI));
++
++ at91_set_A_periph(AT91_PIN_PC22,0);
++ at91_set_A_periph(AT91_PIN_PC23,0);
++ at91_set_A_periph(AT91_PIN_PC24,0);
++ at91_set_A_periph(AT91_PIN_PC25,0);
++ at91_set_A_periph(AT91_PIN_PC26,0);
++ at91_set_A_periph(AT91_PIN_PC27,0);
++}
++#endif
++
++#ifdef CONFIG_USBH
++static void AT572D940HFEB_usbh_hw_init(void)
++{
++ at91_sys_write(AT91_PMC_PCER, (1 << AT572D940HF_ID_UHP));
++ at91_sys_write(AT91_PMC_SCER, AT572D940HF_PMC_UHP);
++}
++
++int rstc_init(void)
++{
++ /* Reads the SR to clean from
++ * previous resets
++ */
++ at91_sys_read(AT91_RSTC_SR);
++
++ /* Disble the USR_RST line,
++ * enable USR_RST_INT and
++ * sets the EXT_RST length to 2^14
++ * (500ms needed by the phy)
++ */
++ at91_sys_write(AT91_RSTC_MR, (0xa5<<24) | (13<<8) | AT91_RSTC_URSTIEN);
++ return 0;
++}
++
++int board_init(void)
++{
++
++ /* Init the reset controller */
++ rstc_init();
++
++ /* Init interrupts */
++ interrupts_init();
++
++ /* Enable Ctrlc */
++ console_init_f();
++
++ /* arch number of AT572D940HFEB-Board */
++ gd->bd->bi_arch_number = MACH_TYPE_AT572D940HFEB;
++ /* adress of boot parameters */
++ gd->bd->bi_boot_params = PHYS_SDRAM + 0x100;
++
++ AT572D940HFEB_serial_hw_init();
++
++#ifdef CONFIG_CMD_NAND
++ AT572D940HFEB_nand_hw_init();
++#endif
++
++#ifdef CONFIG_HAS_DATAFLASH
++ AT572D940HFEB_spi_hw_init();
++#endif
++
++#ifdef CONFIG_MACB
++ AT572D940HFEB_macb_hw_init();
++#endif
++
++#ifdef CONFIG_MMC
++ AT572D940HFEB_mci_hw_init();
++#endif
++
++#ifdef CONFIG_USBH
++ AT572D940HFEB_usbh_hw_init();
++#endif
++
++#endif
++ gd->flags |= GD_FLG_RELOC;
++
++ return 0;
++}
++
++int dram_init(void)
++{
++ gd->bd->bi_dram[0].start = PHYS_SDRAM;
++ gd->bd->bi_dram[0].size = PHYS_SDRAM_SIZE;
++ return 0;
++}
++
++#ifdef CONFIG_CMD_NET
++#ifdef CONFIG_RESET_PHY_R
++void reset_phy(void)
++{
++#ifdef CONFIG_MACB
++ /*
++ * Initialize ethernet HW addr prior to starting Linux,
++ * needed for nfsroot
++ */
++ eth_init(gd->bd);
++#endif /* CONFIG_MACB */
++}
++#endif /* CONFIG_RESET_PHY_R */
++
++int board_eth_init(bd_t *bis)
++{
++ int rc = 0;
++#ifdef CONFIG_MACB
++ rc = at572d940hf_eth_initialize(bis);
++#endif
++ return rc;
++}
++
++#endif /* CONFIG_CMD_NET */
++
+diff -urN u-boot-2009.01-rc1-0rig//board/atmel/at572d940hfeb/config.mk u-boot-2009.01-rc1/board/atmel/at572d940hfeb/config.mk
+--- u-boot-2009.01-rc1-0rig//board/atmel/at572d940hfeb/config.mk 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/board/atmel/at572d940hfeb/config.mk 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1 @@
++TEXT_BASE = 0x23f00000
+diff -urN u-boot-2009.01-rc1-0rig//board/atmel/at572d940hfeb/flash.c u-boot-2009.01-rc1/board/atmel/at572d940hfeb/flash.c
+--- u-boot-2009.01-rc1-0rig//board/atmel/at572d940hfeb/flash.c 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/board/atmel/at572d940hfeb/flash.c 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,507 @@
++/*
++ * (C) Copyright 2002
++ * Lineo, Inc. <www.lineo.com>
++ * Bernhard Kuhn <bkuhn@li...>
++ *
++ * (C) Copyright 2002
++ * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
++ * Alex Zuepke <azu@sy...>
++ *
++ * 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
++ */
++
++#include <common.h>
++
++ulong myflush(void);
++
++
++/* Flash Organization Structure */
++typedef struct OrgDef
++{
++ unsigned int sector_number;
++ unsigned int sector_size;
++} OrgDef;
++
++
++/* Flash Organizations */
++
++OrgDef OrgAT49BV642D[] =
++{
++ { 8, 4*1024 },
++ { 58, 32*1024 },
++};
++
++OrgDef OrgAT49BV16x4[] =
++{
++ { 8, 8*1024 }, /* 8 * 8 kBytes sectors */
++ { 2, 32*1024 }, /* 2 * 32 kBytes sectors */
++ { 30, 64*1024 }, /* 30 * 64 kBytes sectors */
++};
++
++OrgDef OrgAT49BV16x4A[] =
++{
++ { 8, 8*1024 }, /* 8 * 8 kBytes sectors */
++ { 31, 64*1024 }, /* 31 * 64 kBytes sectors */
++};
++
++OrgDef OrgAT49BV6416[] =
++{
++ { 8, 8*1024 }, /* 8 * 8 kBytes sectors */
++ { 127, 64*1024 }, /* 127 * 64 kBytes sectors */
++};
++
++flash_info_t flash_info[CONFIG_SYS_MAX_FLASH_BANKS];
++
++/* AT49BV1614A Codes */
++#define FLASH_CODE1 0xAA
++#define FLASH_CODE2 0x55
++#define ID_IN_CODE 0x90
++#define ID_OUT_CODE 0xF0
++
++
++#define CMD_READ_ARRAY 0x00F0
++#define CMD_UNLOCK1 0x00AA
++#define CMD_UNLOCK2 0x0055
++#define CMD_ERASE_SETUP 0x0080
++#define CMD_ERASE_CONFIRM 0x0030
++#define CMD_PROGRAM 0x00A0
++#define CMD_UNLOCK_BYPASS 0x0020
++#define CMD_SECTOR_UNLOCK 0x0070
++
++#define MEM_FLASH_ADDR1 (*(volatile u16 *)(CONFIG_SYS_FLASH_BASE + (0x00005555<<1)))
++#define MEM_FLASH_ADDR2 (*(volatile u16 *)(CONFIG_SYS_FLASH_BASE + (0x00002AAA<<1)))
++
++#define BIT_ERASE_DONE 0x0080
++#define BIT_RDY_MASK 0x0080
++#define BIT_PROGRAM_ERROR 0x0020
++#define BIT_TIMEOUT 0x80000000 /* our flag */
++
++#define READY 1
++#define ERR 2
++#define TMO 4
++
++/*-----------------------------------------------------------------------
++ */
++void flash_identification (flash_info_t * info)
++{
++ volatile u16 manuf_code, device_code, add_device_code;
++
++ MEM_FLASH_ADDR1 = FLASH_CODE1;
++ MEM_FLASH_ADDR2 = FLASH_CODE2;
++ MEM_FLASH_ADDR1 = ID_IN_CODE;
++
++ manuf_code = *(volatile u16 *) CONFIG_SYS_FLASH_BASE;
++ device_code = *(volatile u16 *) (CONFIG_SYS_FLASH_BASE + 2);
++ add_device_code = *(volatile u16 *) (CONFIG_SYS_FLASH_BASE + (3 << 1));
++
++ MEM_FLASH_ADDR1 = FLASH_CODE1;
++ MEM_FLASH_ADDR2 = FLASH_CODE2;
++ MEM_FLASH_ADDR1 = ID_OUT_CODE;
++
++ /* Vendor type */
++ info->flash_id = ATM_MANUFACT & FLASH_VENDMASK;
++ printf ("Atmel: ");
++
++ if ((device_code & FLASH_TYPEMASK) == (ATM_ID_BV1614 & FLASH_TYPEMASK)) {
++
++ if ((add_device_code & FLASH_TYPEMASK) ==
++ (ATM_ID_BV1614A & FLASH_TYPEMASK)) {
++ info->flash_id |= ATM_ID_BV1614A & FLASH_TYPEMASK;
++ printf ("AT49BV1614A (16Mbit)\n");
++ } else { /* AT49BV1614 Flash */
++ info->flash_id |= ATM_ID_BV1614 & FLASH_TYPEMASK;
++ printf ("AT49BV1614 (16Mbit)\n");
++ }
++
++ } else if ((device_code & FLASH_TYPEMASK) == (ATM_ID_BV6416 & FLASH_TYPEMASK)) {
++ info->flash_id |= ATM_ID_BV6416 & FLASH_TYPEMASK;
++ printf ("AT49BV6416 (64Mbit)\n");
++ }
++}
++
++ushort flash_number_sector(OrgDef *pOrgDef, unsigned int nb_blocks)
++{
++ int i, nb_sectors = 0;
++
++ for (i=0; i<nb_blocks; i++){
++ nb_sectors += pOrgDef[i].sector_number;
++ }
++
++ return nb_sectors;
++}
++
++void flash_unlock_sector(flash_info_t * info, unsigned int sector)
++{
++ volatile u16 *addr = (volatile u16 *) (info->start[sector]);
++
++ MEM_FLASH_ADDR1 = CMD_UNLOCK1;
++ *addr = CMD_SECTOR_UNLOCK;
++}
++
++
++ulong flash_init (void)
++{
++ int i, j, k;
++ unsigned int flash_nb_blocks, sector;
++ unsigned int start_address;
++ OrgDef *pOrgDef;
++
++ ulong size = 0;
++
++ for (i = 0; i < CONFIG_SYS_MAX_FLASH_BANKS; i++) {
++ ulong flashbase = 0;
++
++ flash_identification (&flash_info[i]);
++
++ if ((flash_info[i].flash_id & FLASH_TYPEMASK) ==
++ (ATM_ID_BV1614 & FLASH_TYPEMASK)) {
++
++ pOrgDef = OrgAT49BV16x4;
++ flash_nb_blocks = sizeof (OrgAT49BV16x4) / sizeof (OrgDef);
++ } else if ((flash_info[i].flash_id & FLASH_TYPEMASK) ==
++ (ATM_ID_BV1614A & FLASH_TYPEMASK)){ /* AT49BV1614A Flash */
++
++ pOrgDef = OrgAT49BV16x4A;
++ flash_nb_blocks = sizeof (OrgAT49BV16x4A) / sizeof (OrgDef);
++ } else if ((flash_info[i].flash_id & FLASH_TYPEMASK) ==
++ (ATM_ID_BV6416 & FLASH_TYPEMASK)){ /* AT49BV6416 Flash */
++
++ pOrgDef = OrgAT49BV6416;
++ flash_nb_blocks = sizeof (OrgAT49BV6416) / sizeof (OrgDef);
++ } else {
++ flash_nb_blocks = 0;
++ pOrgDef = OrgAT49BV16x4;
++ }
++
++ flash_info[i].sector_count = flash_number_sector(pOrgDef, flash_nb_blocks);
++ memset (flash_info[i].protect, 0, flash_info[i].sector_count);
++
++ if (i == 0)
++ flashbase = PHYS_FLASH_1;
++ else
++ panic ("configured too many flash banks!\n");
++
++ sector = 0;
++ start_address = flashbase;
++ flash_info[i].size = 0;
++
++ for (j = 0; j < flash_nb_blocks; j++) {
++ for (k = 0; k < pOrgDef[j].sector_number; k++) {
++ flash_info[i].start[sector++] = start_address;
++ start_address += pOrgDef[j].sector_size;
++ flash_info[i].size += pOrgDef[j].sector_size;
++ }
++ }
++
++ size += flash_info[i].size;
++
++ if ((flash_info[i].flash_id & FLASH_TYPEMASK) ==
++ (ATM_ID_BV6416 & FLASH_TYPEMASK)){ /* AT49BV6416 Flash */
++
++ /* Unlock all sectors at reset */
++ for (j=0; j<flash_info[i].sector_count; j++){
++ flash_unlock_sector(&flash_info[i], j);
++ }
++ }
++ }
++
++ /* Protect binary boot image */
++ flash_protect (FLAG_PROTECT_SET,
++ CONFIG_SYS_FLASH_BASE,
++ CONFIG_SYS_FLASH_BASE + CONFIG_SYS_BOOT_SIZE - 1, &flash_info[0]);
++
++ /* Protect environment variables */
++ flash_protect (FLAG_PROTECT_SET,
++ CONFIG_ENV_ADDR,
++ CONFIG_ENV_ADDR + CONFIG_ENV_SIZE - 1, &flash_info[0]);
++
++ /* Protect U-Boot gzipped image */
++ flash_protect (FLAG_PROTECT_SET,
++ CONFIG_SYS_U_BOOT_BASE,
++ CONFIG_SYS_U_BOOT_BASE + CONFIG_SYS_U_BOOT_SIZE - 1, &flash_info[0]);
++
++ return size;
++}
++
++/*-----------------------------------------------------------------------*/
++void flash_print_info (flash_info_t * info)
++{
++ int i;
++
++ switch (info->flash_id & FLASH_VENDMASK) {
++ case (ATM_MANUFACT & FLASH_VENDMASK):
++ printf ("Atmel: ");
++ break;
++ default:
++ printf ("Unknown Vendor ");
++ break;
++ }
++
++ switch (info->flash_id & FLASH_TYPEMASK) {
++ case (ATM_ID_BV1614 & FLASH_TYPEMASK):
++ printf ("AT49BV1614 (16Mbit)\n");
++ break;
++ case (ATM_ID_BV1614A & FLASH_TYPEMASK):
++ printf ("AT49BV1614A (16Mbit)\n");
++ break;
++ case (ATM_ID_BV6416 & FLASH_TYPEMASK):
++ printf ("AT49BV6416 (64Mbit)\n");
++ break;
++ default:
++ printf ("Unknown Chip Type\n");
++ return;
++ }
++
++ printf (" Size: %ld MB in %d Sectors\n",
++ info->size >> 20, info->sector_count);
++
++ printf (" Sector Start Addresses:");
++ for (i = 0; i < info->sector_count; i++) {
++ if ((i % 5) == 0) {
++ printf ("\n ");
++ }
++ printf (" %08lX%s", info->start[i],
++ info->protect[i] ? " (RO)" : " ");
++ }
++ printf ("\n");
++}
++
++/*-----------------------------------------------------------------------*/
++
++int flash_erase (flash_info_t * info, int s_first, int s_last)
++{
++ ulong result;
++ int iflag, cflag, prot, sect;
++ int rc = ERR_OK;
++ int chip1;
++
++ /* first look for protection bits */
++
++ if (info->flash_id == FLASH_UNKNOWN)
++ return ERR_UNKNOWN_FLASH_TYPE;
++
++ if ((s_first < 0) || (s_first > s_last)) {
++ return ERR_INVAL;
++ }
++
++ if ((info->flash_id & FLASH_VENDMASK) !=
++ (ATM_MANUFACT & FLASH_VENDMASK)) {
++ return ERR_UNKNOWN_FLASH_VENDOR;
++ }
++
++ prot = 0;
++ for (sect = s_first; sect <= s_last; ++sect) {
++ if (info->protect[sect]) {
++ prot++;
++ }
++ }
++ if (prot)
++ return ERR_PROTECTED;
++
++ /*
++ * Disable interrupts which might cause a timeout
++ * here. Remember that our exception vectors are
++ * at address 0 in the flash, and we don't want a
++ * (ticker) exception to happen while the flash
++ * chip is in programming mode.
++ */
++ cflag = icache_status ();
++ icache_disable ();
++ iflag = disable_interrupts ();
++
++ /* Start erase on unprotected sectors */
++ for (sect = s_first; sect <= s_last && !ctrlc (); sect++) {
++ printf ("Erasing sector %2d ... ", sect);
++
++ /* arm simple, non interrupt dependent timer */
++ reset_timer_masked ();
++
++ if (info->protect[sect] == 0) { /* not protected */
++ volatile u16 *addr = (volatile u16 *) (info->start[sect]);
++
++ MEM_FLASH_ADDR1 = CMD_UNLOCK1;
++ MEM_FLASH_ADDR2 = CMD_UNLOCK2;
++ MEM_FLASH_ADDR1 = CMD_ERASE_SETUP;
++
++ MEM_FLASH_ADDR1 = CMD_UNLOCK1;
++ MEM_FLASH_ADDR2 = CMD_UNLOCK2;
++ *addr = CMD_ERASE_CONFIRM;
++
++ /* wait until flash is ready */
++ chip1 = 0;
++
++ do {
++ result = *addr;
++
++ /* check timeout */
++ if (get_timer_masked () > CONFIG_SYS_FLASH_ERASE_TOUT) {
++ MEM_FLASH_ADDR1 = CMD_READ_ARRAY;
++ chip1 = TMO;
++ break;
++ }
++
++ if (!chip1 && (result & 0xFFFF) & BIT_ERASE_DONE)
++ chip1 = READY;
++
++ } while (!chip1);
++
++ MEM_FLASH_ADDR1 = CMD_READ_ARRAY;
++
++ if (chip1 == ERR) {
++ rc = ERR_PROG_ERROR;
++ goto outahere;
++ }
++ if (chip1 == TMO) {
++ rc = ERR_TIMOUT;
++ goto outahere;
++ }
++
++ printf ("ok.\n");
++ } else { /* it was protected */
++ printf ("protected!\n");
++ }
++ }
++
++ if (ctrlc ())
++ printf ("User Interrupt!\n");
++
++outahere:
++ /* allow flash to settle - wait 10 ms */
++ udelay_masked (10000);
++
++ if (iflag)
++ enable_interrupts ();
++
++ if (cflag)
++ icache_enable ();
++
++ return rc;
++}
++
++/*-----------------------------------------------------------------------
++ * Copy memory to flash
++ */
++
++static int write_word (flash_info_t * info, ulong dest, ulong data)
++{
++ volatile u16 *addr = (volatile u16 *) dest;
++ ulong result;
++ int rc = ERR_OK;
++ int cflag, iflag;
++ int chip1;
++
++ /*
++ * Check if Flash is (sufficiently) erased
++ */
++ result = *addr;
++ if ((result & data) != data)
++ return ERR_NOT_ERASED;
++
++ /*
++ * Disable interrupts which might cause a timeout
++ * here. Remember that our exception vectors are
++ * at address 0 in the flash, and we don't want a
++ * (ticker) exception to happen while the flash
++ * chip is in programming mode.
++ */
++ cflag = icache_status ();
++ icache_disable ();
++ iflag = disable_interrupts ();
++
++ MEM_FLASH_ADDR1 = CMD_UNLOCK1;
++ MEM_FLASH_ADDR2 = CMD_UNLOCK2;
++ MEM_FLASH_ADDR1 = CMD_PROGRAM;
++ *addr = data;
++
++ /* arm simple, non interrupt dependent timer */
++ reset_timer_masked ();
++
++ /* wait until flash is ready */
++ chip1 = 0;
++ do {
++ result = *addr;
++
++ /* check timeout */
++ if (get_timer_masked () > CONFIG_SYS_FLASH_ERASE_TOUT) {
++ chip1 = ERR | TMO;
++ break;
++ }
++ if (!chip1 && ((result & 0x80) == (data & 0x80)))
++ chip1 = READY;
++
++ } while (!chip1);
++
++ *addr = CMD_READ_ARRAY;
++
++ if (chip1 == ERR || *addr != data)
++ rc = ERR_PROG_ERROR;
++
++ if (iflag)
++ enable_interrupts ();
++
++ if (cflag)
++ icache_enable ();
++
++ return rc;
++}
++
++/*-----------------------------------------------------------------------
++ * Copy memory to flash.
++ */
++
++int write_buff (flash_info_t * info, uchar * src, ulong addr, ulong cnt)
++{
++ ulong wp, data;
++ int rc;
++
++ if (addr & 1) {
++ printf ("unaligned destination not supported\n");
++ return ERR_ALIGN;
++ };
++
++ if ((int) src & 1) {
++ printf ("unaligned source not supported\n");
++ return ERR_ALIGN;
++ };
++
++ wp = addr;
++
++ while (cnt >= 2) {
++ data = *((volatile u16 *) src);
++ if ((rc = write_word (info, wp, data)) != 0) {
++ return (rc);
++ }
++ src += 2;
++ wp += 2;
++ cnt -= 2;
++ }
++
++ if (cnt == 1) {
++ data = (*((volatile u8 *) src)) | (*((volatile u8 *) (wp + 1)) << 8);
++ if ((rc = write_word (info, wp, data)) != 0) {
++ return (rc);
++ }
++ src += 1;
++ wp += 1;
++ cnt -= 1;
++ };
++
++ return ERR_OK;
++}
++
+diff -urN u-boot-2009.01-rc1-0rig//board/atmel/at572d940hfeb/interrupts.c u-boot-2009.01-rc1/board/atmel/at572d940hfeb/interrupts.c
+--- u-boot-2009.01-rc1-0rig//board/atmel/at572d940hfeb/interrupts.c 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/board/atmel/at572d940hfeb/interrupts.c 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,83 @@
++/*
++ * board/atmel/at572d940hfeb/interrupts.c
++ * Copyright 2008 (C) ATMEL
++ * Antonio R. Costa <antonio.costa <at> atmel.com>
++ * <costa.antonior <at> gmail.com>
++ *
++ * Advanced Interrupt Controller (AIC).
++ * Based on AT572D940HF datasheet.
++ *
++ * 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.
++ */
++
++#include <common.h>
++#include <asm/arch/at572d940hf.h>
++#include <asm/arch/io.h>
++#include <asm/arch/at91_rstc.h>
++#include <asm/arch/at91_aic.h>
++#include <asm/arch/interrupts.h>
++
++irq_handler_t handler_reset(void)
++{
++ unsigned long rstc_sr=0;
++
++ rstc_sr = at91_sys_read(AT91_RSTC_SR);
++ if(rstc_sr & AT91_RSTC_URSTS) {
++ while(!(at91_sys_read(AT91_RSTC_SR) & (1<<16)));
++ reset_cpu(1);
++ };
++}
++
++irq_handler_t handler_ext1(void)
++{
++ puts("--- EXT1 IRQ ---\n");
++}
++
++
++int reset_irqs(void) {
++ unsigned long ul = 0;
++ volatile unsigned long * psrc = _armboot_start;
++ volatile unsigned long * pdest = 0x0;
++
++ /*
++ * Relocates U-Boot ARM IRQ vectors to 0
++ * This is an ugly way to do it.
++ * More support must be offered by start.S
++ * on symbols and macros performing partial relocation
++ */
++
++ while(ul++ < 16)
++ *pdest++ = *psrc++;
++
++
++ /* Reset IRQ vectors */
++ for(ul=0;ul<32;ul++)
++ RESET_IRQ_HANDLER(ul);
++ return 0;
++}
++
++int interrupts_init(void)
++{
++ reset_irqs();
++ SET_IRQ_HANDLER(1 ,0x27,handler_reset);
++ SET_IRQ_HANDLER(30,0x27,handler_ext1);
++ return 0;
++}
++
++
++void do_irq(struct pt_regs* pregs) {
++
++ unsigned long int ivr = AIC_REG(AIC_IVR);
++ unsigned long int isr = AIC_REG(AIC_ISR);
++ void (*irq_handler)(unsigned long int) = (void(*)(unsigned long int)) ivr;
++
++ irq_handler(isr);
++
++ /* Acknowledges irq */
++ IRQ_ACKNOWLEDGE(ivr);
++
++ return;
++};
+diff -urN u-boot-2009.01-rc1-0rig//board/atmel/at572d940hfeb/Makefile u-boot-2009.01-rc1/board/atmel/at572d940hfeb/Makefile
+--- u-boot-2009.01-rc1-0rig//board/atmel/at572d940hfeb/Makefile 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/board/atmel/at572d940hfeb/Makefile 2009-01-04 22:03:38.000000000 +0100
+@@ -0,0 +1,60 @@
++#
++# (C) Copyright 2003-2008
++# Wolfgang Denk, DENX Software Engineering, wd <at> 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
++#
++
++include $(TOPDIR)/config.mk
++
++LIB = $(obj)lib$(BOARD).a
++
++COBJS-y += at572d940hfeb.o
++#COBJS-y += led.o
++COBJS-y += partition.o
++#COBJS-y += flash.o
++COBJS-$(CONFIG_CMD_NAND) += nand.o
++#COBJS-$(CONFIG_CMD_MMC) += atmel_mci.o
++COBJS-$(CONFIG_USE_IRQ) += interrupts.o
++
++SRCS := $(SOBJS:.o=.S) $(COBJS-y:.o=.c)
++OBJS := $(addprefix $(obj),$(COBJS-y))
++SOBJS := $(addprefix $(obj),$(SOBJS))
++
++$(LIB): $(obj).depend $(OBJS) $(SOBJS)
++ $(AR) $(ARFLAGS) $@ $(OBJS) $(SOBJS)
++
++clean:
++ rm -f $(SOBJS) $(OBJS)
++
++distclean: clean
++ rm -f $(LIB) core *.bak $(obj).depend
++
++#########################################################################
++
++# defines $(obj).depend target
++include $(SRCTREE)/rules.mk
++
++sinclude $(obj).depend
++
++#########################################################################
+diff -urN u-boot-2009.01-rc1-0rig//board/atmel/at572d940hfeb/nand.c u-boot-2009.01-rc1/board/atmel/at572d940hfeb/nand.c
+--- u-boot-2009.01-rc1-0rig//board/atmel/at572d940hfeb/nand.c 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/board/atmel/at572d940hfeb/nand.c 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,78 @@
++/*
++ * (C) Copyright 2007-2008
++ * Stelian Pop <stelian.pop@leadtechdesign.com>
++ * Lead Tech Design <www.leadtechdesign.com>
++ *
++ * (C) Copyright 2006 ATMEL Rousset, Lacressonniere Nicolas
++ *
++ * 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
++ */
++
++#include <common.h>
++#include <asm/arch/at91sam9g20.h>
++#include <asm/arch/gpio.h>
++#include <asm/arch/at91_pio.h>
++
++#include <nand.h>
++
++/*
++ * hardware specific access to control-lines
++ */
++#define MASK_ALE (1 << 21) /* our ALE is AD21 */
++#define MASK_CLE (1 << 22) /* our CLE is AD22 */
++
++static void at572d940hfeb_nand_hwcontrol(struct mtd_info *mtd,
++ int cmd, unsigned int ctrl)
++{
++ struct nand_chip *this = mtd->priv;
++
++ if (ctrl & NAND_CTRL_CHANGE) {
++ ulong IO_ADDR_W = (ulong) this->IO_ADDR_W;
++ IO_ADDR_W &= ~(MASK_ALE | MASK_CLE);
++
++ if (ctrl & NAND_CLE)
++ IO_ADDR_W |= MASK_CLE;
++ if (ctrl & NAND_ALE)
++ IO_ADDR_W |= MASK_ALE;
++
++ at91_set_gpio_value(AT91_PIN_PC14, !(ctrl & NAND_NCE));
++ this->IO_ADDR_W = (void *) IO_ADDR_W;
++ }
++
++ if (cmd != NAND_CMD_NONE)
++ writeb(cmd, this->IO_ADDR_W);
++}
++
++static int at572d940hfeb_nand_ready(struct mtd_info *mtd)
++{
++ return at91_get_gpio_value(AT91_PIN_PC13);
++}
++
++int board_nand_init(struct nand_chip *nand)
++{
++ nand->ecc.mode = NAND_ECC_SOFT;
++#ifdef CONFIG_SYS_NAND_DBW_16
++ nand->options = NAND_BUSWIDTH_16;
++#endif
++ nand->cmd_ctrl = at572d940hfeb_nand_hwcontrol;
++ nand->dev_ready = at572d940hfeb_nand_ready;
++ nand->chip_delay = 20;
++
++ return 0;
++}
+diff -urN u-boot-2009.01-rc1-0rig//board/atmel/at572d940hfeb/partition.c u-boot-2009.01-rc1/board/atmel/at572d940hfeb/partition.c
+--- u-boot-2009.01-rc1-0rig//board/atmel/at572d940hfeb/partition.c 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/board/atmel/at572d940hfeb/partition.c 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,39 @@
++/*
++ *
++ * 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
++ *
++ */
++#include <common.h>
++#include <config.h>
++#include <asm/hardware.h>
++#include <dataflash.h>
++
++AT91S_DATAFLASH_INFO dataflash_info[CONFIG_SYS_MAX_DATAFLASH_BANKS];
++
++struct dataflash_addr cs[CONFIG_SYS_MAX_DATAFLASH_BANKS] = {
++ {CONFIG_SYS_DATAFLASH_LOGIC_ADDR_CS0, 0}, /* Logical adress, CS */
++ {CONFIG_SYS_DATAFLASH_LOGIC_ADDR_CS1, 1}
++};
++
++/*define the area offsets*/
++dataflash_protect_t area_list[NB_DATAFLASH_AREA] = {
++ {0x00000000, 0x000041FF, FLAG_PROTECT_SET, 0, "Bootstrap"},
++ {0x00004200, 0x000083FF, FLAG_PROTECT_CLEAR, 0, "Environment"},
++ {0x00008400, 0x00041FFF, FLAG_PROTECT_SET, 0, "U-Boot"},
++ {0x00042000, 0x00251FFF, FLAG_PROTECT_CLEAR, 0, "Kernel"},
++ {0x00252000, 0xFFFFFFFF, FLAG_PROTECT_CLEAR, 0, "FS"},
++};
++
+diff -urN u-boot-2009.01-rc1-0rig//board/atmel/at572d940hfeb/u-boot.lds u-boot-2009.01-rc1/board/atmel/at572d940hfeb/u-boot.lds
+--- u-boot-2009.01-rc1-0rig//board/atmel/at572d940hfeb/u-boot.lds 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/board/atmel/at572d940hfeb/u-boot.lds 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,58 @@
++/*
++ * (C) Copyright 2002
++ * Gary Jennejohn, DENX Software Engineering, <gj <at> 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
++ */
++
++OUTPUT_FORMAT("elf32-littlearm", "elf32-littlearm", "elf32-littlearm")
++/*OUTPUT_FORMAT("elf32-arm", "elf32-arm", "elf32-arm")*/
++OUTPUT_ARCH(arm)
++ENTRY(_start)
++SECTIONS
++{
++ . = 0x00000000;
++
++ . = ALIGN(4);
++ .text :
++ {
++ cpu/arm926ejs/start.o (.text)
++ *(.text)
++ }
++
++ . = ALIGN(4);
++ .rodata : { *(.rodata) }
++
++ . = ALIGN(4);
++ .data : { *(.data) }
++
++ . = ALIGN(4);
++ .got : { *(.got) }
++
++ . = .;
++ __u_boot_cmd_start = .;
++ .u_boot_cmd : { *(.u_boot_cmd) }
++ __u_boot_cmd_end = .;
++
++ . = ALIGN(4);
++ __bss_start = .;
++ .bss : { *(.bss) }
++ _end = .;
++}
++
+diff -urN u-boot-2009.01-rc1-0rig//cpu/arm926ejs/at572d940hf/config.mk u-boot-2009.01-rc1/cpu/arm926ejs/at572d940hf/config.mk
+--- u-boot-2009.01-rc1-0rig//cpu/arm926ejs/at572d940hf/config.mk 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/cpu/arm926ejs/at572d940hf/config.mk 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,3 @@
++PLATFORM_CPPFLAGS += -march=armv5te
++PLATFORM_CPPFLAGS += $(call cc-option,-mtune=arm926ejs,)
++
+diff -urN u-boot-2009.01-rc1-0rig//cpu/arm926ejs/at572d940hf/ether.c u-boot-2009.01-rc1/cpu/arm926ejs/at572d940hf/ether.c
+--- u-boot-2009.01-rc1-0rig//cpu/arm926ejs/at572d940hf/ether.c 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/cpu/arm926ejs/at572d940hf/ether.c 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,36 @@
++/*
++ * (C) Copyright 2007-2008
++ * Stelian Pop <stelian.pop <at> leadtechdesign.com>
++ * Lead Tech Design <www.leadtechdesign.com>
++ *
++ * 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
++ */
++
++#include <common.h>
++#include <asm/arch/hardware.h>
++
++extern int macb_eth_initialize(int id, void *regs, unsigned int phy_addr);
++
++#if defined(CONFIG_MACB) && defined(CONFIG_CMD_NET)
++void at572d940hf_eth_initialize(bd_t *bi)
++{
++ macb_eth_initialize(0, (void *)AT91_BASE_EMAC, 0x00);
++}
++#endif
++
+diff -urN u-boot-2009.01-rc1-0rig//cpu/arm926ejs/at572d940hf/lowlevel_init.S u-boot-2009.01-rc1/cpu/arm926ejs/at572d940hf/lowlevel_init.S
+--- u-boot-2009.01-rc1-0rig//cpu/arm926ejs/at572d940hf/lowlevel_init.S 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/cpu/arm926ejs/at572d940hf/lowlevel_init.S 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,44 @@
++/*
++ * AT91CAP9/SAM9 setup stuff
++ *
++ * (C) Copyright 2007-2008
++ * Stelian Pop <stelian.pop <at> leadtechdesign.com>
++ * Lead Tech Design <www.leadtechdesign.com>
++ *
++ * 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
++ */
++
++#include <config.h>
++#include <version.h>
++
++#ifndef CONFIG_SKIP_LOWLEVEL_INIT
++
++ .globl lowlevel_init
++
++lowlevel_init:
++
++/*
++ * Clocks/SDRAM initialization is handled by at91bootstrap,
++ * no need to do it here...
++ */
++ mov pc, lr
++
++ .ltorg
++#endif
++
+diff -urN u-boot-2009.01-rc1-0rig//cpu/arm926ejs/at572d940hf/Makefile u-boot-2009.01-rc1/cpu/arm926ejs/at572d940hf/Makefile
+--- u-boot-2009.01-rc1-0rig//cpu/arm926ejs/at572d940hf/Makefile 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/cpu/arm926ejs/at572d940hf/Makefile 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,53 @@
++#
++# (C) Copyright 2000-2008
++# Wolfgang Denk, DENX Software Engineering, wd <at> 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
++#
++
++include $(TOPDIR)/config.mk
++
++LIB = $(obj)lib$(SOC).a
++
++COBJS-y += ether.o
++COBJS-y += timer.o
++COBJS-$(CONFIG_HAS_DATAFLASH) +=spi.o
++COBJS-y += usb.o
++SOBJS = lowlevel_init.o
++
++SRCS := $(SOBJS:.o=.S) $(COBJS-y:.o=.c)
++OBJS := $(addprefix $(obj),$(SOBJS) $(COBJS-y))
++
++all: $(obj).depend $(LIB)
++
++$(LIB): $(OBJS)
++ $(AR) $(ARFLAGS) $@ $(OBJS)
++
++#########################################################################
++
++# defines $(obj).depend target
++include $(SRCTREE)/rules.mk
++
++sinclude $(obj).depend
++
++#########################################################################
+diff -urN u-boot-2009.01-rc1-0rig//cpu/arm926ejs/at572d940hf/spi.c u-boot-2009.01-rc1/cpu/arm926ejs/at572d940hf/spi.c
+--- u-boot-2009.01-rc1-0rig//cpu/arm926ejs/at572d940hf/spi.c 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/cpu/arm926ejs/at572d940hf/spi.c 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,158 @@
++/*
++ * Driver for ATMEL DataFlash support
++ * Author : Hamid Ikdoumi (Atmel)
++ *
++ * 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
++ *
++ */
++
++#include <common.h>
++#include <asm/arch/hardware.h>
++#include <asm/arch/gpio.h>
++#include <asm/arch/io.h>
++#include <asm/arch/at91_pio.h>
++#include <asm/arch/at91_spi.h>
++
++#include <dataflash.h>
++
++#define AT91_SPI_PCS0_DATAFLASH_CARD 0xE /* Chip Select 0: NPCS0%1110 */
++#define AT91_SPI_PCS1_DATAFLASH_CARD 0xD /* Chip Select 0: NPCS0%1101 */
++#define AT91_SPI_PCS3_DATAFLASH_CARD 0x7 /* Chip Select 3: NPCS3%0111 */
++
++void AT91F_SpiInit(void)
++{
++ /* Reset the SPI */
++ writel(AT91_SPI_SWRST, AT91_BASE_SPI + AT91_SPI_CR);
++
++ /* Configure SPI in Master Mode with No CS selected !!! */
++ writel(AT91_SPI_MSTR | AT91_SPI_MODFDIS | AT91_SPI_PCS,
++ AT91_BASE_SPI + AT91_SPI_MR);
++
++ /* Configure CS0 */
++ writel(AT91_SPI_NCPHA |
++ (AT91_SPI_DLYBS & DATAFLASH_TCSS) |
++ (AT91_SPI_DLYBCT & DATAFLASH_TCHS) |
++ ((AT91_MASTER_CLOCK / AT91_SPI_CLK) << 8),
++ AT91_BASE_SPI + AT91_SPI_CSR(0));
++
++#ifdef CONFIG_SYS_DATAFLASH_LOGIC_ADDR_CS1
++ /* Configure CS1 */
++ writel(AT91_SPI_NCPHA |
++ (AT91_SPI_DLYBS & DATAFLASH_TCSS) |
++ (AT91_SPI_DLYBCT & DATAFLASH_TCHS) |
++ ((AT91_MASTER_CLOCK / AT91_SPI_CLK) << 8),
++ AT91_BASE_SPI + AT91_SPI_CSR(1));
++#endif
++
++#ifdef CONFIG_SYS_DATAFLASH_LOGIC_ADDR_CS3
++ /* Configure CS3 */
++ writel(AT91_SPI_NCPHA |
++ (AT91_SPI_DLYBS & DATAFLASH_TCSS) |
++ (AT91_SPI_DLYBCT & DATAFLASH_TCHS) |
++ ((AT91_MASTER_CLOCK / AT91_SPI_CLK) << 8),
++ AT91_BASE_SPI + AT91_SPI_CSR(3));
++#endif
++
++ /* SPI_Enable */
++ writel(AT91_SPI_SPIEN, AT91_BASE_SPI + AT91_SPI_CR);
++
++ while (!(readl(AT91_BASE_SPI + AT91_SPI_SR) & AT91_SPI_SPIENS));
++
++/*
++ * Add tempo to get SPI in a safe state.
++ * Should not be needed for new silicon (Rev B)
++ */
++ udelay(500000);
++ readl(AT91_BASE_SPI + AT91_SPI_SR);
++ readl(AT91_BASE_SPI + AT91_SPI_RDR);
++
++}
++
++void AT91F_SpiEnable(int cs)
++{
++ unsigned long mode;
++
++ switch (cs) {
++ case 0: /* Configure SPI CS0 for Serial DataFlash AT45DBxx */
++ mode = readl(AT91_BASE_SPI + AT91_SPI_MR);
++ mode &= 0xFFF0FFFF;
++ writel(mode | ((AT91_SPI_PCS0_DATAFLASH_CARD<<16) & AT91_SPI_PCS),
++ AT91_BASE_SPI + AT91_SPI_MR);
++ break;
++ case 1: /* Configure SPI CS1 for Serial DataFlash AT45DBxx */
++ mode = readl(AT91_BASE_SPI + AT91_SPI_MR);
++ mode &= 0xFFF0FFFF;
++ writel(mode | ((AT91_SPI_PCS1_DATAFLASH_CARD<<16) & AT91_SPI_PCS),
++ AT91_BASE_SPI + AT91_SPI_MR);
++ break;
++ case 3:
++ mode = readl(AT91_BASE_SPI + AT91_SPI_MR);
++ mode &= 0xFFF0FFFF;
++ writel(mode | ((AT91_SPI_PCS3_DATAFLASH_CARD<<16) & AT91_SPI_PCS),
++ AT91_BASE_SPI + AT91_SPI_MR);
++ break;
++ }
++
++ /* SPI_Enable */
++ writel(AT91_SPI_SPIEN, AT91_BASE_SPI + AT91_SPI_CR);
++}
++
++unsigned int AT91F_SpiWrite1(AT91PS_DataflashDesc pDesc);
++
++unsigned int AT91F_SpiWrite(AT91PS_DataflashDesc pDesc)
++{
++ unsigned int timeout;
++
++ pDesc->state = BUSY;
++
++ writel(AT91_SPI_TXTDIS + AT91_SPI_RXTDIS, AT91_BASE_SPI + AT91_SPI_PTCR);
++
++ /* Initialize the Transmit and Receive Pointer */
++ writel((unsigned int)pDesc->rx_cmd_pt, AT91_BASE_SPI + AT91_SPI_RPR);
++ writel((unsigned int)pDesc->tx_cmd_pt, AT91_BASE_SPI + AT91_SPI_TPR);
++
++ /* Intialize the Transmit and Receive Counters */
++ writel(pDesc->rx_cmd_size, AT91_BASE_SPI + AT91_SPI_RCR);
++ writel(pDesc->tx_cmd_size, AT91_BASE_SPI + AT91_SPI_TCR);
++
++ if (pDesc->tx_data_size != 0) {
++ /* Initialize the Next Transmit and Next Receive Pointer */
++ writel((unsigned int)pDesc->rx_data_pt, AT91_BASE_SPI + AT91_SPI_RNPR);
++ writel((unsigned int)pDesc->tx_data_pt, AT91_BASE_SPI + AT91_SPI_TNPR);
++
++ /* Intialize the Next Transmit and Next Receive Counters */
++ writel(pDesc->rx_data_size, AT91_BASE_SPI + AT91_SPI_RNCR);
++ writel(pDesc->tx_data_size, AT91_BASE_SPI + AT91_SPI_TNCR);
++ }
++
++ /* arm simple, non interrupt dependent timer */
++ reset_timer_masked();
++ timeout = 0;
++
++ writel(AT91_SPI_TXTEN + AT91_SPI_RXTEN, AT91_BASE_SPI + AT91_SPI_PTCR);
++ while (!(readl(AT91_BASE_SPI + AT91_SPI_SR) & AT91_SPI_RXBUFF) &&
++ ((timeout = get_timer_masked()) < CONFIG_SYS_SPI_WRITE_TOUT));
++ writel(AT91_SPI_TXTDIS + AT91_SPI_RXTDIS, AT91_BASE_SPI + AT91_SPI_PTCR);
++ pDesc->state = IDLE;
++
++ if (timeout >= CONFIG_SYS_SPI_WRITE_TOUT) {
++ printf("Error Timeout\n\r");
++ return DATAFLASH_ERROR;
++ }
++
++ return DATAFLASH_OK;
++}
++
+diff -urN u-boot-2009.01-rc1-0rig//cpu/arm926ejs/at572d940hf/timer.c u-boot-2009.01-rc1/cpu/arm926ejs/at572d940hf/timer.c
+--- u-boot-2009.01-rc1-0rig//cpu/arm926ejs/at572d940hf/timer.c 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/cpu/arm926ejs/at572d940hf/timer.c 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,293 @@
++/*
++ * (C) Copyright 2007-2008
++ * Stelian Pop <stelian.pop <at> leadtechdesign.com>
++ * Lead Tech Design <www.leadtechdesign.com>
++ *
++ * 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
++ */
++
++/*
++ * Author: Antonio R. Costa
++ * based upon AT91
++ */
++
++#include <common.h>
++#include <asm/errno.h>
++#include <asm/arch/hardware.h>
++#include <asm/arch/at572d940hf.h>
++#include <asm/arch/at572d940hf_mc.h>
++#include <asm/arch/memory-map.h>
++#include <asm/arch/at91_pit.h>
++#include <asm/arch/at91_pmc.h>
++#include <asm/arch/at91_rstc.h>
++#include <asm/arch/timer.h>
++#include <asm/arch/io.h>
++
++/*
++ * We're using the AT91CAP9/SAM9 PITC in 32 bit mode, by
++ * setting the 20 bit counter period to its maximum (0xfffff).
++ */
++#define TIMER_LOAD_VAL 0xfffff
++#define READ_RESET_TIMER at91_sys_read(AT91_PIT_PIVR)
++#define READ_TIMER at91_sys_read(AT91_PIT_PIIR)
++#define TIMER_FREQ (AT91_MASTER_CLOCK << 4)
++#define TICKS_TO_USEC(ticks) ((ticks) / 6)
++
++ulong get_timer_masked(void);
++ulong resettime;
++
++int sys_get_freq(unsigned long mode, unsigned long *pfreq)
++{
++ unsigned long mckr = (unsigned long) -1;
++ unsigned long clksrc=0;
++ unsigned long clkpre=0;
++ unsigned long clkdiv=0;
++ unsigned long main_clock=0;
++ unsigned long tmode = mode;
++
++
++ /*!This function checks for \c AT91_CLK_DELAY_CYCLES cycles if the main clock is ready.
++ * If it is not it exits with \c -EIO.
++ * Otherwise, assuming a slow clock of \c CONFIG_SLOW_CLK Hz (default 32768 Hz), it computes
++ * the number of main clock cycles occurring in 16 slow clock cycles.
++ * This number multiplied by (_GNAM_SLOW_CLK / 16) results in the
++ * actual frequency of the main clock.
++ */
++ {
++ long tmp = AT91_CLK_DELAY_CYCLES;
++ while(!(at91_sys_read(AT91_CKGR_MCFR) & AT91_PMC_MAINRDY) && (tmp-- > 0));
++ if(tmp <= 0) {
++ *pfreq = 0;
++ return -EIO;
++ }
++ }
++
++ main_clock = (at91_sys_read(AT91_CKGR_MCFR) & AT91_PMC_MAINF) * (CONFIG_SLOW_CLK / 16);
++
++ /*!Depending on the \c mode parameter, this function returns frequencies
++ * for the <b>slow clock</b>, <b>main clock</b>, \b PLLA, \b PLLB or <b>master clock</b>.
++ */
++
++ /*!In the last case the function reads the PMC to find which source
++ * has been selected for the master clock and perform the relevant
++ * computations.
++ */
++
++ if(AT91_SLOW_FREQ == mode) {
++ *pfreq = CONFIG_SLOW_CLK;
++ return 0;
++ }
++
++ /* Little trick: master clock depends on another source,
++ * so here it checks for the selected source and
++ * change the mode param to the master clock source
++ */
++ if((AT91_SYS_FREQ == mode) | (AT91_PROC_FREQ == mode)) {
++ mckr = at91_sys_read(AT91_PMC_MCKR);
++ clksrc = (mckr & AT91_PMC_CSS ) ;
++ clkpre = (mckr & AT91_PMC_PRES) >> 2;
++ clkdiv = (mckr & AT91_PMC_MDIV) >> 8;
++ tmode = clksrc;
++ }
++
++ if(AT91_PMC_CSS_MAIN == tmode)
++ *pfreq = main_clock;
++
++ if(AT91_PMC_CSS_PLLA == tmode) {
++ unsigned long pllar = at91_sys_read(AT91_CKGR_PLLAR);
++ unsigned long mula = (pllar & AT91_PMC_MUL) >> 16;
++ unsigned long diva = (pllar & AT91_PMC_DIV);
++ *pfreq = (diva != 0) ? ((main_clock / diva) * ++mula) : 0;
++ }
++
++ if(AT91_PMC_CSS_PLLB == tmode) {
++ unsigned long pllbr = at91_sys_read(AT91_CKGR_PLLBR);
++ unsigned long mulb = (pllbr & AT91_PMC_MUL) >> 16;
++ unsigned long divb = (pllbr & AT91_PMC_DIV);
++
++ *pfreq = (divb != 0) ? ((main_clock / divb) * ++mulb) : 0;
++ }
++
++ /* If the mode selected is different of
++ * _GNAM_SYS_FREQ or AT91_PROC_FREQ
++ * all is done and frequency can be returned.
++ */
++ if((AT91_SYS_FREQ != mode) & (AT91_PROC_FREQ != mode))
++ return 0;
++
++ /* Here it divides the frequency
++ * by the prescaler factor
++ */
++ *pfreq = *pfreq >> clkpre;
++
++ /* If the selected frequency is AT91_SYS_FREQ
++ * then it must be selected by the clkdiv factor
++ */
++ if(AT91_SYS_FREQ == mode)
++ *pfreq = *pfreq >> clkdiv;
++
++ return 0;
++}
++
++
++/* nothing really to do with interrupts, just starts up a counter. */
++int timer_init(void)
++{
++ /*
++ * Enable PITC Clock
++ * The clock is already enabled for system controller in boot
++ */
++ at91_sys_write(AT91_PMC_PCER, 1 << AT91_ID_SYS);
++
++ /* Enable PITC */
++ at91_sys_write(AT91_PIT_MR, TIMER_LOAD_VAL | AT91_PIT_PITEN);
++
++ reset_timer_masked();
++
++ return 0;
++}
++
++/*
++ * timer without interrupts
++ */
++
++static inline ulong get_timer_raw(void)
++{
++ ulong now = READ_TIMER;
++
++ if (now >= resettime)
++ return now - resettime;
++ else
++ return 0xFFFFFFFFUL - (resettime - now) ;
++}
++
++void reset_timer_masked(void)
++{
++ resettime = READ_TIMER;
++}
++
++ulong get_timer_masked(void)
++{
++ return TICKS_TO_USEC(get_timer_raw());
++
++}
++
++void udelay_masked(unsigned long usec)
++{
++ ulong tmp;
++
++ tmp = get_timer(0);
++ while (get_timer(tmp) < usec) /* our timer works in usecs */
++ ; /* NOP */
++}
++
++void reset_timer(void)
++{
++ reset_timer_masked();
++}
++
++ulong get_timer(ulong base)
++{
++ ulong now = get_timer_masked();
++
++ if (now >= base)
++ return now - base;
++ else
++ return TICKS_TO_USEC(0xFFFFFFFFUL) - (base - now) ;
++}
++
++void udelay(unsigned long usec)
++{
++ udelay_masked(usec);
++}
++
++/*
++ * This function is derived from PowerPC code (read timebase as long long).
++ * On ARM it just returns the timer value.
++ */
++unsigned long long get_ticks(void)
++{
++ return get_timer(0);
++}
++
++/*
++ * This function is derived from PowerPC code (timebase clock frequency).
++ * On ARM it returns the number of timer ticks per second.
++ */
++ulong get_tbclk(void)
++{
++ ulong tbclk;
++
++ tbclk = CONFIG_SYS_HZ;
++ return tbclk;
++}
++
++/*
++ * Reset the cpu by setting up the watchdog timer and let him time out.
++ */
++void reset_cpu(ulong ignored)
++{
++ /* at91_sys_write(AT91_RSTC_MR, AT91_RSTC_KEY | (0x3u << 8) | 0x01); */
++
++ /*
++ * ARC:
++ * This code must be executed in internal RAM
++ * cause the SDRAM is under reset
++ */
++
++ /*
++ * ARC:
++ * Reset SDRAM in safe way
++ */
++ unsigned long reg = at91_sys_read(AT91_SDRAMC_LPR);
++ at91_sys_write(AT91_SDRAMC_LPR, reg | AT91_SDRAMC_LPCB_SELF_REFRESH);
++ at91_sys_write(AT91_SDRAMC_MR, AT91_SDRAMC_MODE_NORMAL);
++ *(volatile unsigned long *) AT572D940_SDRAM_BASE = 0x0;
++
++ /*
++ * ARC
++ * Waits until the reset button has been released.
++ * Unusefull if checked previously.
++ */
++
++ at91_sys_write(AT91_RSTC_CR, AT91_RSTC_KEY | AT91_RSTC_EXTRST);
++
++
++ while(!(at91_sys_read(AT91_RSTC_SR) & (1<<16)));
++
++ {
++ /*
++ * ARC:
++ * i should be register cause SDRAM has been reset
++ */
++ volatile register unsigned int i = 1000000;
++ while(i-->0);
++ };
++
++
++ /* this is the way Linux does it */
++ at91_sys_write(AT91_RSTC_CR, AT91_RSTC_KEY |
++ AT91_RSTC_PROCRST |
++ /* AT91_RSTC_EXTRST */
++ AT91_RSTC_PERRST);
++ return;
++ while (1);
++ /* Never reached */
++}
++
+diff -urN u-boot-2009.01-rc1-0rig//cpu/arm926ejs/at572d940hf/usb.c u-boot-2009.01-rc1/cpu/arm926ejs/at572d940hf/usb.c
+--- u-boot-2009.01-rc1-0rig//cpu/arm926ejs/at572d940hf/usb.c 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/cpu/arm926ejs/at572d940hf/usb.c 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,55 @@
++/*
++ * (C) Copyright 2006
++ * DENX Software Engineering <mk <at> 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
++ */
++
++#include <common.h>
++
++#if defined(CONFIG_USB_OHCI_NEW) && defined(CONFIG_SYS_USB_OHCI_CPU_INIT)
++
++#include <asm/arch/hardware.h>
++#include <asm/arch/io.h>
++#include <asm/arch/at91_pmc.h>
++
++int usb_cpu_init(void)
++{
++ /* Enable USB host clock. */
++ at91_sys_write(AT91_PMC_PCER, 1 << AT91_ID_UHP);
++ at91_sys_write(AT91_PMC_SCER, AT91_PMC_UHP);
++
++ return 0;
++}
++
++int usb_cpu_stop(void)
++{
++ /* Disable USB host clock. */
++ at91_sys_write(AT91_PMC_PCDR, 1 << AT91_ID_UHP);
++ at91_sys_write(AT91_PMC_SCDR, AT91_PMC_UHP);
++ return 0;
++}
++
++int usb_cpu_init_fail(void)
++{
++ return usb_cpu_stop();
++}
++
++#endif /* defined(CONFIG_USB_OHCI) && defined(CONFIG_SYS_USB_OHCI_CPU_INIT) */
++
+diff -urN u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at572d940hf.h u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at572d940hf.h
+--- u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at572d940hf.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at572d940hf.h 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,148 @@
++/*
++ * include/asm-arm/arch-at91/AT572D940HFhf.h
++ *
++ * (C) 2008 Antonio R. Costa
++ *
++ * Common definitions.
++ * Based on AT572D940HFHF datasheet rev A.
++ *
++ * 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.
++ */
++
++#ifndef AT572D940HFHF_H
++#define AT572D940HFHF_H
++
++/*
++ * Peripheral identifiers/interrupts.
++ */
++#define AT91_ID_FIQ 0 /* Advanced Interrupt Controller (FIQ) */
++#define AT91_ID_SYS 1 /* System Peripherals */
++#define AT572D940HF_ID_PIOA 2 /* Parallel IO Controller A */
++#define AT572D940HF_ID_PIOB 3 /* Parallel IO Controller B */
++#define AT572D940HF_ID_PIOC 4 /* Parallel IO Controller C */
++#define AT572D940HF_ID_EMAC 5 /* Ethernet */
++#define AT572D940HF_ID_US0 6 /* USART 0 */
++#define AT572D940HF_ID_US1 7 /* USART 1 */
++#define AT572D940HF_ID_US2 8 /* USART 2 */
++#define AT572D940HF_ID_MCI 9 /* Multimedia Card Interface */
++#define AT572D940HF_ID_UDP 10 /* USB Device Port */
++#define AT572D940HF_ID_TWI 11 /* Two-Wire Interface */
++#define AT572D940HF_ID_TWI0 11 /* Two-Wire Interface */
++#define AT572D940HF_ID_SPI0 12 /* Serial Peripheral Interface 0 */
++#define AT572D940HF_ID_SPI1 13 /* Serial Peripheral Interface 1 */
++#define AT572D940HF_ID_SSC 14 /* Serial Synchronous Controller */
++#define AT572D940HF_ID_SSC0 14 /* Serial Synchronous Controller */
++#define AT572D940HF_ID_SSC1 15 /* Serial Synchronous Controller */
++#define AT572D940HF_ID_SSC2 16 /* Serial Synchronous Controller */
++#define AT572D940HF_ID_TC0 17 /* Timer Counter 0 */
++#define AT572D940HF_ID_TC1 18 /* Timer Counter 1 */
++#define AT572D940HF_ID_TC2 19 /* Timer Counter 2 */
++#define AT572D940HF_ID_UHP 20 /* USB Host port */
++#define AT572D940HF_ID_SSC3 21 /* Serial Synchronous Controller */
++#define AT572D940HF_ID_TWI1 22 /* Two-Wire Interface */
++#define AT572D940HF_ID_CAN0 23 /* CAN Controller */
++#define AT572D940HF_ID_CAN1 24 /* CAN Controller */
++#define AT572D940HF_ID_mHALT 25 /* mAgicV DSP halt int */
++#define AT572D940HF_ID_mSIRQ1 26 /* mAgicV DSP SIRQ1 int */
++#define AT572D940HF_ID_mEXC 27 /* mAgicV DSP Exception int */
++#define AT572D940HF_ID_mEDMA 28 /* mAgicV DSP end of DMA transfer int */
++#define AT572D940HF_ID_IRQ0 29 /* Advanced Interrupt Controller (IRQ0) */
++#define AT572D940HF_ID_IRQ1 30 /* Advanced Interrupt Controller (IRQ1) */
++#define AT572D940HF_ID_IRQ2 31 /* Advanced Interrupt Controller (IRQ2) */
++
++#define AT91_ID_US0 AT572D940HF_ID_US0
++#define AT91_ID_US1 AT572D940HF_ID_US1
++#define AT91_ID_US2 AT572D940HF_ID_US2
++#define AT91_ID_US3 AT572D940HF_ID_US3
++
++#define AT91_ID_UHP AT572D940HF_ID_UHP
++#define AT91_PMC_UHP AT572D940HF_ID_UHP
++
++/*
++ * User Peripheral physical base addresses.
++ */
++#define AT572D940HF_BASE_TCB0 0xfffa0000
++#define AT572D940HF_BASE_TC0 0xfffa0000
++#define AT572D940HF_BASE_TC1 0xfffa0040
++#define AT572D940HF_BASE_TC2 0xfffa0080
++#define AT572D940HF_BASE_UDP 0xfffa4000
++#define AT572D940HF_BASE_MCI 0xfffa8000
++#define AT572D940HF_BASE_TWI 0xfffac000
++#define AT572D940HF_BASE_US0 0xfffb0000
++#define AT572D940HF_BASE_US1 0xfffb4000
++#define AT572D940HF_BASE_US2 0xfffb8000
++#define AT572D940HF_BASE_SSC 0xfffbc000
++#define AT572D940HF_BASE_ISI 0xfffc0000
++#define AT572D940HF_BASE_EMAC 0xfffd8000
++#define AT572D940HF_BASE_SPI0 0xfffc8000
++#define AT572D940HF_BASE_SPI1 0xfffcc000
++#define AT572D940HF_BASE_US3 0xfffd0000
++#define AT572D940HF_BASE_US4 0xfffd4000
++#define AT572D940HF_BASE_US5 0xfffd8000
++#define AT572D940HF_BASE_TCB1 0xfffdc000
++#define AT572D940HF_BASE_TC3 0xfffdc000
++#define AT572D940HF_BASE_TC4 0xfffdc040
++#define AT572D940HF_BASE_TC5 0xfffdc080
++#define AT572D940HF_BASE_ADC 0xfffe0000
++#define AT572D940HF_BASE_RSTC 0xfffffd00
++#define AT91_BASE_SYS 0xffffea00
++
++#define AT91_BASE_EMAC AT572D940HF_BASE_EMAC
++#define AT91_BASE_SPI AT572D940HF_BASE_SPI0
++#define MMCI_BASE AT572D940HF_BASE_MCI
++
++/*
++ * System Peripherals (offset from AT91_BASE_SYS)
++ */
++#define AT91_ECC (0xffffe800 - AT91_BASE_SYS)
++#define AT91_SDRAMC (0xffffea00 - AT91_BASE_SYS)
++#define AT91_SMC (0xffffec00 - AT91_BASE_SYS)
++#define AT91_MATRIX (0xffffee00 - AT91_BASE_SYS)
++#define AT91_CCFG (0xffffef10 - AT91_BASE_SYS)
++#define AT91_AIC (0xfffff000 - AT91_BASE_SYS)
++#define AT91_DBGU (0xfffff200 - AT91_BASE_SYS)
++#define AT91_PIOA (0xfffff400 - AT91_BASE_SYS)
++#define AT91_PIOB (0xfffff600 - AT91_BASE_SYS)
++#define AT91_PIOC (0xfffff800 - AT91_BASE_SYS)
++#define AT91_PMC (0xfffffc00 - AT91_BASE_SYS)
++#define AT91_RSTC (0xfffffd00 - AT91_BASE_SYS)
++#define AT91_SHDWC (0xfffffd10 - AT91_BASE_SYS)
++#define AT91_RTT (0xfffffd20 - AT91_BASE_SYS)
++#define AT91_PIT (0xfffffd30 - AT91_BASE_SYS)
++#define AT91_WDT (0xfffffd40 - AT91_BASE_SYS)
++#define AT91_GPBR (0xfffffd50 - AT91_BASE_SYS)
++
++#define AT91_USART0 AT572D940HF_BASE_US0
++#define AT91_USART1 AT572D940HF_BASE_US1
++#define AT91_USART2 AT572D940HF_BASE_US2
++#define AT91_USART3 AT572D940HF_BASE_US3
++#define AT91_USART4 AT572D940HF_BASE_US4
++#define AT91_USART5 AT572D940HF_BASE_US5
++
++/*
++ * Internal Memory.
++ */
++#define AT572D940HF_ROM_BASE 0x00400000 /* Internal ROM base address */
++#define AT572D940HF_ROM_SIZE SZ_32K /* Internal ROM size (32Kb) */
++
++#define AT572D940HF_SRAM0_BASE 0x00100000 /* Internal SRAM 0 base address */
++#define AT572D940HF_SRAM0_SIZE SZ_16K /* Internal SRAM 0 size (4Kb) */
++#define AT572D940HF_SRAM1_BASE 0x00200000 /* Internal SRAM 0 base address */
++#define AT572D940HF_SRAM1_SIZE SZ_16K /* Internal SRAM 0 size (4Kb) */
++#define AT572D940HF_SRAM2_BASE 0x00300000 /* Internal SRAM 1 base address */
++#define AT572D940HF_SRAM2_SIZE SZ_16K /* Internal SRAM 1 size (4Kb) */
++
++/* SDRAM */
++#define AT572D940HF_SDRAM_BASE 0x20000000
++
++/* USB Host */
++#define AT572D940HF_UHP_BASE 0x00500000 /* USB Host controller */
++
++#define AT91SAM9XE_FLASH_BASE 0x00200000 /* Internal FLASH base address */
++#define AT91SAM9XE_SRAM_BASE 0x00300000 /* Internal SRAM base address */
++
++#endif
++
+diff -urN u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at572d940hf_matrix.h u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at572d940hf_matrix.h
+--- u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at572d940hf_matrix.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at572d940hf_matrix.h 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,78 @@
++/*
++ * include/asm-arm/arch-at91/at91sam9260_matrix.h
++ *
++ * Memory Controllers (MATRIX, EBI) - System peripherals registers.
++ * Based on AT91SAM9260 datasheet revision B.
++ *
++ * 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.
++ */
++
++#ifndef AT91SAM9260_MATRIX_H
++#define AT91SAM9260_MATRIX_H
++
++#define AT91_MATRIX_MCFG0 (AT91_MATRIX + 0x00) /* Master Configuration Register 0 */
++#define AT91_MATRIX_MCFG1 (AT91_MATRIX + 0x04) /* Master Configuration Register 1 */
++#define AT91_MATRIX_MCFG2 (AT91_MATRIX + 0x08) /* Master Configuration Register 2 */
++#define AT91_MATRIX_MCFG3 (AT91_MATRIX + 0x0C) /* Master Configuration Register 3 */
++#define AT91_MATRIX_MCFG4 (AT91_MATRIX + 0x10) /* Master Configuration Register 4 */
++#define AT91_MATRIX_MCFG5 (AT91_MATRIX + 0x14) /* Master Configuration Register 5 */
++#define AT91_MATRIX_ULBT (7 << 0) /* Undefined Length Burst Type */
++#define AT91_MATRIX_ULBT_INFINITE (0 << 0)
++#define AT91_MATRIX_ULBT_SINGLE (1 << 0)
++#define AT91_MATRIX_ULBT_FOUR (2 << 0)
++#define AT91_MATRIX_ULBT_EIGHT (3 << 0)
++#define AT91_MATRIX_ULBT_SIXTEEN (4 << 0)
++
++#define AT91_MATRIX_SCFG0 (AT91_MATRIX + 0x40) /* Slave Configuration Register 0 */
++#define AT91_MATRIX_SCFG1 (AT91_MATRIX + 0x44) /* Slave Configuration Register 1 */
++#define AT91_MATRIX_SCFG2 (AT91_MATRIX + 0x48) /* Slave Configuration Register 2 */
++#define AT91_MATRIX_SCFG3 (AT91_MATRIX + 0x4C) /* Slave Configuration Register 3 */
++#define AT91_MATRIX_SCFG4 (AT91_MATRIX + 0x50) /* Slave Configuration Register 4 */
++#define AT91_MATRIX_SLOT_CYCLE (0xff << 0) /* Maximum Number of Allowed Cycles for a Burst */
++#define AT91_MATRIX_DEFMSTR_TYPE (3 << 16) /* Default Master Type */
++#define AT91_MATRIX_DEFMSTR_TYPE_NONE (0 << 16)
++#define AT91_MATRIX_DEFMSTR_TYPE_LAST (1 << 16)
++#define AT91_MATRIX_DEFMSTR_TYPE_FIXED (2 << 16)
++#define AT91_MATRIX_FIXED_DEFMSTR (7 << 18) /* Fixed Index of Default Master */
++#define AT91_MATRIX_ARBT (3 << 24) /* Arbitration Type */
++#define AT91_MATRIX_ARBT_ROUND_ROBIN (0 << 24)
++#define AT91_MATRIX_ARBT_FIXED_PRIORITY (1 << 24)
++
++#define AT91_MATRIX_PRAS0 (AT91_MATRIX + 0x80) /* Priority Register A for Slave 0 */
++#define AT91_MATRIX_PRAS1 (AT91_MATRIX + 0x88) /* Priority Register A for Slave 1 */
++#define AT91_MATRIX_PRAS2 (AT91_MATRIX + 0x90) /* Priority Register A for Slave 2 */
++#define AT91_MATRIX_PRAS3 (AT91_MATRIX + 0x98) /* Priority Register A for Slave 3 */
++#define AT91_MATRIX_PRAS4 (AT91_MATRIX + 0xA0) /* Priority Register A for Slave 4 */
++#define AT91_MATRIX_M0PR (3 << 0) /* Master 0 Priority */
++#define AT91_MATRIX_M1PR (3 << 4) /* Master 1 Priority */
++#define AT91_MATRIX_M2PR (3 << 8) /* Master 2 Priority */
++#define AT91_MATRIX_M3PR (3 << 12) /* Master 3 Priority */
++#define AT91_MATRIX_M4PR (3 << 16) /* Master 4 Priority */
++#define AT91_MATRIX_M5PR (3 << 20) /* Master 5 Priority */
++
++#define AT91_MATRIX_MRCR (AT91_MATRIX + 0x100) /* Master Remap Control Register */
++#define AT91_MATRIX_RCB0 (1 << 0) /* Remap Command for AHB Master 0 (ARM926EJ-S Instruction Master) */
++#define AT91_MATRIX_RCB1 (1 << 1) /* Remap Command for AHB Master 1 (ARM926EJ-S Data Master) */
++
++#define AT91_MATRIX_EBICSA (AT91_MATRIX + 0x11C) /* EBI Chip Select Assignment Register */
++#define AT91_MATRIX_CS1A (1 << 1) /* Chip Select 1 Assignment */
++#define AT91_MATRIX_CS1A_SMC (0 << 1)
++#define AT91_MATRIX_CS1A_SDRAMC (1 << 1)
++#define AT91_MATRIX_CS3A (1 << 3) /* Chip Select 3 Assignment */
++#define AT91_MATRIX_CS3A_SMC (0 << 3)
++#define AT91_MATRIX_CS3A_SMC_SMARTMEDIA (1 << 3)
++#define AT91_MATRIX_CS4A (1 << 4) /* Chip Select 4 Assignment */
++#define AT91_MATRIX_CS4A_SMC (0 << 4)
++#define AT91_MATRIX_CS4A_SMC_CF1 (1 << 4)
++#define AT91_MATRIX_CS5A (1 << 5) /* Chip Select 5 Assignment */
++#define AT91_MATRIX_CS5A_SMC (0 << 5)
++#define AT91_MATRIX_CS5A_SMC_CF2 (1 << 5)
++#define AT91_MATRIX_DBPUC (1 << 8) /* Data Bus Pull-up Configuration */
++#define AT91_MATRIX_VDDIOMSEL (1 << 16) /* Memory voltage selection */
++#define AT91_MATRIX_VDDIOMSEL_1_8V (0 << 16)
++#define AT91_MATRIX_VDDIOMSEL_3_3V (1 << 16)
++
++#endif
+diff -urN u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at572d940hf_mc.h u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at572d940hf_mc.h
+--- u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at572d940hf_mc.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at572d940hf_mc.h 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,140 @@
++/*
++ * include/asm-arm/arch-at91/at91sam926x_mc.h
++ *
++ * Memory Controllers (SMC, SDRAMC) - System peripherals registers.
++ * Based on AT91SAM9261 datasheet revision D.
++ *
++ * 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.
++*/
++
++#ifndef AT91SAM926x_MC_H
++#define AT91SAM926x_MC_H
++
++/* SDRAM Controller (SDRAMC) registers */
++#define AT91_SDRAMC_MR (AT91_SDRAMC + 0x00) /* SDRAM Controller Mode Register */
++#define AT91_SDRAMC_MODE (0xf << 0) /* Command Mode */
++#define AT91_SDRAMC_MODE_NORMAL 0
++#define AT91_SDRAMC_MODE_NOP 1
++#define AT91_SDRAMC_MODE_PRECHARGE 2
++#define AT91_SDRAMC_MODE_LMR 3
++#define AT91_SDRAMC_MODE_REFRESH 4
++#define AT91_SDRAMC_MODE_EXT_LMR 5
++#define AT91_SDRAMC_MODE_DEEP 6
++
++#define AT91_SDRAMC_TR (AT91_SDRAMC + 0x04) /* SDRAM Controller Refresh Timer Register */
++#define AT91_SDRAMC_COUNT (0xfff << 0) /* Refresh Timer Counter */
++
++#define AT91_SDRAMC_CR (AT91_SDRAMC + 0x08) /* SDRAM Controller Configuration Register */
++#define AT91_SDRAMC_NC (3 << 0) /* Number of Column Bits */
++#define AT91_SDRAMC_NC_8 (0 << 0)
++#define AT91_SDRAMC_NC_9 (1 << 0)
++#define AT91_SDRAMC_NC_10 (2 << 0)
++#define AT91_SDRAMC_NC_11 (3 << 0)
++#define AT91_SDRAMC_NR (3 << 2) /* Number of Row Bits */
++#define AT91_SDRAMC_NR_11 (0 << 2)
++#define AT91_SDRAMC_NR_12 (1 << 2)
++#define AT91_SDRAMC_NR_13 (2 << 2)
++#define AT91_SDRAMC_NB (1 << 4) /* Number of Banks */
++#define AT91_SDRAMC_NB_2 (0 << 4)
++#define AT91_SDRAMC_NB_4 (1 << 4)
++#define AT91_SDRAMC_CAS (3 << 5) /* CAS Latency */
++#define AT91_SDRAMC_CAS_1 (1 << 5)
++#define AT91_SDRAMC_CAS_2 (2 << 5)
++#define AT91_SDRAMC_CAS_3 (3 << 5)
++#define AT91_SDRAMC_DBW (1 << 7) /* Data Bus Width */
++#define AT91_SDRAMC_DBW_32 (0 << 7)
++#define AT91_SDRAMC_DBW_16 (1 << 7)
++#define AT91_SDRAMC_TWR (0xf << 8) /* Write Recovery Delay */
++#define AT91_SDRAMC_TRC (0xf << 12) /* Row Cycle Delay */
++#define AT91_SDRAMC_TRP (0xf << 16) /* Row Precharge Delay */
++#define AT91_SDRAMC_TRCD (0xf << 20) /* Row to Column Delay */
++#define AT91_SDRAMC_TRAS (0xf << 24) /* Active to Precharge Delay */
++#define AT91_SDRAMC_TXSR (0xf << 28) /* Exit Self Refresh to Active Delay */
++
++#define AT91_SDRAMC_LPR (AT91_SDRAMC + 0x10) /* SDRAM Controller Low Power Register */
++#define AT91_SDRAMC_LPCB (3 << 0) /* Low-power Configurations */
++#define AT91_SDRAMC_LPCB_DISABLE 0
++#define AT91_SDRAMC_LPCB_SELF_REFRESH 1
++#define AT91_SDRAMC_LPCB_POWER_DOWN 2
++#define AT91_SDRAMC_LPCB_DEEP_POWER_DOWN 3
++#define AT91_SDRAMC_PASR (7 << 4) /* Partial Array Self Refresh */
++#define AT91_SDRAMC_TCSR (3 << 8) /* Temperature Compensated Self Refresh */
++#define AT91_SDRAMC_DS (3 << 10) /* Drive Strenght */
++#define AT91_SDRAMC_TIMEOUT (3 << 12) /* Time to define when Low Power Mode is enabled */
++#define AT91_SDRAMC_TIMEOUT_0_CLK_CYCLES (0 << 12)
++#define AT91_SDRAMC_TIMEOUT_64_CLK_CYCLES (1 << 12)
++#define AT91_SDRAMC_TIMEOUT_128_CLK_CYCLES (2 << 12)
++
++#define AT91_SDRAMC_IER (AT91_SDRAMC + 0x14) /* SDRAM Controller Interrupt Enable Register */
++#define AT91_SDRAMC_IDR (AT91_SDRAMC + 0x18) /* SDRAM Controller Interrupt Disable Register */
++#define AT91_SDRAMC_IMR (AT91_SDRAMC + 0x1C) /* SDRAM Controller Interrupt Mask Register */
++#define AT91_SDRAMC_ISR (AT91_SDRAMC + 0x20) /* SDRAM Controller Interrupt Status Register */
++#define AT91_SDRAMC_RES (1 << 0) /* Refresh Error Status */
++
++#define AT91_SDRAMC_MDR (AT91_SDRAMC + 0x24) /* SDRAM Memory Device Register */
++#define AT91_SDRAMC_MD (3 << 0) /* Memory Device Type */
++#define AT91_SDRAMC_MD_SDRAM 0
++#define AT91_SDRAMC_MD_LOW_POWER_SDRAM 1
++
++/* Static Memory Controller (SMC) registers */
++#define AT91_SMC_SETUP(n) (AT91_SMC + 0x00 + ((n)*0x10))/* Setup Register for CS n */
++#define AT91_SMC_NWESETUP (0x3f << 0) /* NWE Setup Length */
++#define AT91_SMC_NWESETUP_(x) ((x) << 0)
++#define AT91_SMC_NCS_WRSETUP (0x3f << 8) /* NCS Setup Length in Write Access */
++#define AT91_SMC_NCS_WRSETUP_(x) ((x) << 8)
++#define AT91_SMC_NRDSETUP (0x3f << 16) /* NRD Setup Length */
++#define AT91_SMC_NRDSETUP_(x) ((x) << 16)
++#define AT91_SMC_NCS_RDSETUP (0x3f << 24) /* NCS Setup Length in Read Access */
++#define AT91_SMC_NCS_RDSETUP_(x) ((x) << 24)
++
++#define AT91_SMC_PULSE(n) (AT91_SMC + 0x04 + ((n)*0x10))/* Pulse Register for CS n */
++#define AT91_SMC_NWEPULSE (0x7f << 0) /* NWE Pulse Length */
++#define AT91_SMC_NWEPULSE_(x) ((x) << 0)
++#define AT91_SMC_NCS_WRPULSE (0x7f << 8) /* NCS Pulse Length in Write Access */
++#define AT91_SMC_NCS_WRPULSE_(x)((x) << 8)
++#define AT91_SMC_NRDPULSE (0x7f << 16) /* NRD Pulse Length */
++#define AT91_SMC_NRDPULSE_(x) ((x) << 16)
++#define AT91_SMC_NCS_RDPULSE (0x7f << 24) /* NCS Pulse Length in Read Access */
++#define AT91_SMC_NCS_RDPULSE_(x)((x) << 24)
++
++#define AT91_SMC_CYCLE(n) (AT91_SMC + 0x08 + ((n)*0x10))/* Cycle Register for CS n */
++#define AT91_SMC_NWECYCLE (0x1ff << 0 ) /* Total Write Cycle Length */
++#define AT91_SMC_NWECYCLE_(x) ((x) << 0)
++#define AT91_SMC_NRDCYCLE (0x1ff << 16) /* Total Read Cycle Length */
++#define AT91_SMC_NRDCYCLE_(x) ((x) << 16)
++
++#define AT91_SMC_MODE(n) (AT91_SMC + 0x0c + ((n)*0x10)) /* Mode Register for CS n */
++#define AT91_SMC_READMODE (1 << 0) /* Read Mode */
++#define AT91_SMC_WRITEMODE (1 << 1) /* Write Mode */
++#define AT91_SMC_EXNWMODE (3 << 4) /* NWAIT Mode */
++#define AT91_SMC_EXNWMODE_DISABLE (0 << 4)
++#define AT91_SMC_EXNWMODE_FROZEN (2 << 4)
++#define AT91_SMC_EXNWMODE_READY (3 << 4)
++#define AT91_SMC_BAT (1 << 8) /* Byte Access Type */
++#define AT91_SMC_BAT_SELECT (0 << 8)
++#define AT91_SMC_BAT_WRITE (1 << 8)
++#define AT91_SMC_DBW (3 << 12) /* Data Bus Width */
++#define AT91_SMC_DBW_8 (0 << 12)
++#define AT91_SMC_DBW_16 (1 << 12)
++#define AT91_SMC_DBW_32 (2 << 12)
++#define AT91_SMC_TDF (0xf << 16) /* Data Float Time. */
++#define AT91_SMC_TDF_(x) ((x) << 16)
++#define AT91_SMC_TDFMODE (1 << 20) /* TDF Optimization - Enabled */
++#define AT91_SMC_PMEN (1 << 24) /* Page Mode Enabled */
++#define AT91_SMC_PS (3 << 28) /* Page Size */
++#define AT91_SMC_PS_4 (0 << 28)
++#define AT91_SMC_PS_8 (1 << 28)
++#define AT91_SMC_PS_16 (2 << 28)
++#define AT91_SMC_PS_32 (3 << 28)
++
++#if defined(AT91_SMC1) /* The AT91SAM9263 has 2 Static Memory contollers */
++#define AT91_SMC1_SETUP(n) (AT91_SMC1 + 0x00 + ((n)*0x10)) /* Setup Register for CS n */
++#define AT91_SMC1_PULSE(n) (AT91_SMC1 + 0x04 + ((n)*0x10)) /* Pulse Register for CS n */
++#define AT91_SMC1_CYCLE(n) (AT91_SMC1 + 0x08 + ((n)*0x10)) /* Cycle Register for CS n */
++#define AT91_SMC1_MODE(n) (AT91_SMC1 + 0x0c + ((n)*0x10)) /* Mode Register for CS n */
++#endif
++
++#endif
+diff -urN u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at91_aic.h u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at91_aic.h
+--- u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at91_aic.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at91_aic.h 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,43 @@
++/*
++ * include/asm-arm/arch-at572d940/at91_aic.h
++ *
++ * Copyright (C) ATMEL
++ *
++ * Advanced Interrupt Controller (AIC).
++ * Based on AT572D940 datasheet.
++ *
++ * 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.
++ */
++
++#define AIC_BASE 0xfffff000
++
++#define AIC_SMR0 0x0
++#define AIC_SVR0 0x80
++#define AIC_IVR 0x100
++#define AIC_FIQ 0x104
++#define AIC_ISR 0x108
++#define AIC_IPR 0x10c
++#define AIC_IMR 0x110
++#define AIC_ICR 0x114
++#define AIC_IECR 0x120
++#define AIC_IDCR 0x124
++#define AIC_ICCR 0x128
++#define AIC_ISCR 0x12c
++#define AIC_EOICR 0x130
++#define AIC_SPU 0x134
++
++#define AIC_SMR(n) \
++ ((unsigned long) (((unsigned long*) AIC_SMR0) + (n)))
++#define AIC_SVR(n) \
++ ((unsigned long) (((unsigned long*) AIC_SVR0) + (n)))
++
++#define AIC_WRITE(reg,value) \
++ (*((volatile unsigned long*) (AIC_BASE + (reg))) = value)
++#define AIC_READ(reg,value) \
++ (value = *((volatile unsigned long*) (AIC_BASE + (reg))))
++
++#define AIC_REG(reg) \
++ (*((volatile unsigned long*) (AIC_BASE + (reg))))
+diff -urN u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at91_pio.h u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at91_pio.h
+--- u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at91_pio.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at91_pio.h 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,52 @@
++/*
++ * include/asm-arm/arch-at91/at91_pio.h
++ *
++ * Copyright (C) 2005 Ivan Kokshaysky
++ * Copyright (C) SAN People
++ *
++ * Parallel I/O Controller (PIO) - System peripherals registers.
++ * Based on AT91RM9200 datasheet revision E.
++ *
++ * 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.
++ */
++
++#ifndef AT91_PIO_H
++#define AT91_PIO_H
++
++#include <asm/arch/at572d940hf.h>
++
++#define PIO_PER 0x00 /* Enable Register */
++#define PIO_PDR 0x04 /* Disable Register */
++#define PIO_PSR 0x08 /* Status Register */
++#define PIO_OER 0x10 /* Output Enable Register */
++#define PIO_ODR 0x14 /* Output Disable Register */
++#define PIO_OSR 0x18 /* Output Status Register */
++#define PIO_IFER 0x20 /* Glitch Input Filter Enable */
++#define PIO_IFDR 0x24 /* Glitch Input Filter Disable */
++#define PIO_IFSR 0x28 /* Glitch Input Filter Status */
++#define PIO_SODR 0x30 /* Set Output Data Register */
++#define PIO_CODR 0x34 /* Clear Output Data Register */
++#define PIO_ODSR 0x38 /* Output Data Status Register */
++#define PIO_PDSR 0x3c /* Pin Data Status Register */
++#define PIO_IER 0x40 /* Interrupt Enable Register */
++#define PIO_IDR 0x44 /* Interrupt Disable Register */
++#define PIO_IMR 0x48 /* Interrupt Mask Register */
++#define PIO_ISR 0x4c /* Interrupt Status Register */
++#define PIO_MDER 0x50 /* Multi-driver Enable Register */
++#define PIO_MDDR 0x54 /* Multi-driver Disable Register */
++#define PIO_MDSR 0x58 /* Multi-driver Status Register */
++#define PIO_PUDR 0x60 /* Pull-up Disable Register */
++#define PIO_PUER 0x64 /* Pull-up Enable Register */
++#define PIO_PUSR 0x68 /* Pull-up Status Register */
++#define PIO_ASR 0x70 /* Peripheral A Select Register */
++#define PIO_BSR 0x74 /* Peripheral B Select Register */
++#define PIO_ABSR 0x78 /* AB Status Register */
++#define PIO_OWER 0xa0 /* Output Write Enable Register */
++#define PIO_OWDR 0xa4 /* Output Write Disable Register */
++#define PIO_OWSR 0xa8 /* Output Write Status Register */
++
++#endif
++
+diff -urN u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at91_pit.h u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at91_pit.h
+--- u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at91_pit.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at91_pit.h 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,29 @@
++/*
++ * include/asm-arm/arch-at91/at91_pit.h
++ *
++ * Periodic Interval Timer (PIT) - System peripherals regsters.
++ * Based on AT91SAM9261 datasheet revision D.
++ *
++ * 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.
++ */
++
++#ifndef AT91_PIT_H
++#define AT91_PIT_H
++
++#define AT91_PIT_MR (AT91_PIT + 0x00) /* Mode Register */
++#define AT91_PIT_PITIEN (1 << 25) /* Timer Interrupt Enable */
++#define AT91_PIT_PITEN (1 << 24) /* Timer Enabled */
++#define AT91_PIT_PIV (0xfffff) /* Periodic Interval Value */
++
++#define AT91_PIT_SR (AT91_PIT + 0x04) /* Status Register */
++#define AT91_PIT_PITS (1 << 0) /* Timer Status */
++
++#define AT91_PIT_PIVR (AT91_PIT + 0x08) /* Periodic Interval Value Register */
++#define AT91_PIT_PIIR (AT91_PIT + 0x0c) /* Periodic Interval Image Register */
++#define AT91_PIT_PICNT (0xfff << 20) /* Interval Counter */
++#define AT91_PIT_CPIV (0xfffff) /* Inverval Value */
++
++#endif
+diff -urN u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at91_pmc.h u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at91_pmc.h
+--- u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at91_pmc.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at91_pmc.h 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,102 @@
++/*
++ * include/asm-arm/arch-at91/at91_pmc.h
++ *
++ * Copyright (C) 2005 Ivan Kokshaysky
++ * Copyright (C) SAN People
++ *
++ * Power Management Controller (PMC) - System peripherals registers.
++ * Based on AT91RM9200 datasheet revision E.
++ *
++ * 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.
++ */
++
++#ifndef AT91_PMC_H
++#define AT91_PMC_H
++
++#define AT91_PMC_SCER (AT91_PMC + 0x00) /* System Clock Enable Register */
++#define AT91_PMC_SCDR (AT91_PMC + 0x04) /* System Clock Disable Register */
++
++#define AT91_PMC_SCSR (AT91_PMC + 0x08) /* System Clock Status Register */
++#define AT91_PMC_PCK (1 << 0) /* Processor Clock */
++#define AT91RM9200_PMC_UDP (1 << 1) /* USB Devcice Port Clock [AT91RM9200 only] */
++#define AT91RM9200_PMC_MCKUDP (1 << 2) /* USB Device Port Master Clock Automatic Disable on Suspend [AT91RM9200 only] */
++#define AT91RM9200_PMC_UHP (1 << 4) /* USB Host Port Clock [AT91RM9200 only] */
++#define AT91SAM926x_PMC_UHP (1 << 6) /* USB Host Port Clock [AT91SAM926x only] */
++#define AT91CAP9_PMC_UHP (1 << 6) /* USB Host Port Clock [AT91CAP9 only] */
++#define AT572D940HF_PMC_UHP (1 << 6) /* USB Host Port Clock [AT572D940HF] */
++#define AT572D940HF_PMC_UDP (1 << 7) /* USB Device Port Clock [AT572D940HF] */
++#define AT91SAM926x_PMC_UDP (1 << 7) /* USB Decice Port Clock [AT91SAM926x only] */
++#define AT91_PMC_PCK0 (1 << 8) /* Programmable Clock 0 */
++#define AT91_PMC_PCK1 (1 << 9) /* Programmable Clock 1 */
++#define AT91_PMC_PCK2 (1 << 10) /* Programmable Clock 2 */
++#define AT91_PMC_PCK3 (1 << 11) /* Programmable Clock 3 */
++#define AT91_PMC_HCK0 (1 << 16) /* AHB Clock (USB host) [AT91SAM9261 only] */
++#define AT91_PMC_HCK1 (1 << 17) /* AHB Clock (LCD) [AT91SAM9261 only] */
++
++#define AT91_PMC_PCER (AT91_PMC + 0x10) /* Peripheral Clock Enable Register */
++#define AT91_PMC_PCDR (AT91_PMC + 0x14) /* Peripheral Clock Disable Register */
++#define AT91_PMC_PCSR (AT91_PMC + 0x18) /* Peripheral Clock Status Register */
++
++#define AT91_CKGR_UCKR (AT91_PMC + 0x1C) /* UTMI Clock Register [SAM9RL, CAP9] */
++
++#define AT91_CKGR_MOR (AT91_PMC + 0x20) /* Main Oscillator Register [not on SAM9RL] */
++#define AT91_PMC_MOSCEN (1 << 0) /* Main Oscillator Enable */
++#define AT91_PMC_OSCBYPASS (1 << 1) /* Oscillator Bypass [AT91SAM926x only] */
++#define AT91_PMC_OSCOUNT (0xff << 8) /* Main Oscillator Start-up Time */
++
++#define AT91_CKGR_MCFR (AT91_PMC + 0x24) /* Main Clock Frequency Register */
++#define AT91_PMC_MAINF (0xffff << 0) /* Main Clock Frequency */
++#define AT91_PMC_MAINRDY (1 << 16) /* Main Clock Ready */
++
++#define AT91_CKGR_PLLAR (AT91_PMC + 0x28) /* PLL A Register */
++#define AT91_CKGR_PLLBR (AT91_PMC + 0x2c) /* PLL B Register */
++#define AT91_PMC_DIV (0xff << 0) /* Divider */
++#define AT91_PMC_PLLCOUNT (0x3f << 8) /* PLL Counter */
++#define AT91_PMC_OUT (3 << 14) /* PLL Clock Frequency Range */
++#define AT91_PMC_MUL (0x7ff << 16) /* PLL Multiplier */
++#define AT91_PMC_USBDIV (3 << 28) /* USB Divisor (PLLB only) */
++#define AT91_PMC_USBDIV_1 (0 << 28)
++#define AT91_PMC_USBDIV_2 (1 << 28)
++#define AT91_PMC_USBDIV_4 (2 << 28)
++#define AT91_PMC_USB96M (1 << 28) /* Divider by 2 Enable (PLLB only) */
++
++#define AT91_PMC_MCKR (AT91_PMC + 0x30) /* Master Clock Register */
++#define AT91_PMC_CSS (3 << 0) /* Master Clock Selection */
++#define AT91_PMC_CSS_SLOW (0 << 0)
++#define AT91_PMC_CSS_MAIN (1 << 0)
++#define AT91_PMC_CSS_PLLA (2 << 0)
++#define AT91_PMC_CSS_PLLB (3 << 0)
++#define AT91_PMC_PRES (7 << 2) /* Master Clock Prescaler */
++#define AT91_PMC_PRES_1 (0 << 2)
++#define AT91_PMC_PRES_2 (1 << 2)
++#define AT91_PMC_PRES_4 (2 << 2)
++#define AT91_PMC_PRES_8 (3 << 2)
++#define AT91_PMC_PRES_16 (4 << 2)
++#define AT91_PMC_PRES_32 (5 << 2)
++#define AT91_PMC_PRES_64 (6 << 2)
++#define AT91_PMC_MDIV (3 << 8) /* Master Clock Division */
++#define AT91_PMC_MDIV_1 (0 << 8)
++#define AT91_PMC_MDIV_2 (1 << 8)
++#define AT91_PMC_MDIV_3 (2 << 8)
++#define AT91_PMC_MDIV_4 (3 << 8)
++
++#define AT91_PMC_PCKR(n) (AT91_PMC + 0x40 + ((n) * 4)) /* Programmable Clock 0-3 Registers */
++
++#define AT91_PMC_IER (AT91_PMC + 0x60) /* Interrupt Enable Register */
++#define AT91_PMC_IDR (AT91_PMC + 0x64) /* Interrupt Disable Register */
++#define AT91_PMC_SR (AT91_PMC + 0x68) /* Status Register */
++#define AT91_PMC_MOSCS (1 << 0) /* MOSCS Flag */
++#define AT91_PMC_LOCKA (1 << 1) /* PLLA Lock */
++#define AT91_PMC_LOCKB (1 << 2) /* PLLB Lock */
++#define AT91_PMC_MCKRDY (1 << 3) /* Master Clock */
++#define AT91_PMC_PCK0RDY (1 << 8) /* Programmable Clock 0 */
++#define AT91_PMC_PCK1RDY (1 << 9) /* Programmable Clock 1 */
++#define AT91_PMC_PCK2RDY (1 << 10) /* Programmable Clock 2 */
++#define AT91_PMC_PCK3RDY (1 << 11) /* Programmable Clock 3 */
++#define AT91_PMC_IMR (AT91_PMC + 0x6c) /* Interrupt Mask Register */
++
++#endif
++
+diff -urN u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at91_rstc.h u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at91_rstc.h
+--- u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at91_rstc.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at91_rstc.h 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,38 @@
++/*
++ * include/asm-arm/arch-at91/at91_rstc.h
++ *
++ * Reset Controller (RSTC) - System peripherals regsters.
++ * Based on AT91SAM9261 datasheet revision D.
++ *
++ * 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.
++ */
++
++#ifndef AT91_RSTC_H
++#define AT91_RSTC_H
++
++#define AT91_RSTC_CR (AT91_RSTC + 0x00) /* Reset Controller Control Register */
++#define AT91_RSTC_PROCRST (1 << 0) /* Processor Reset */
++#define AT91_RSTC_PERRST (1 << 2) /* Peripheral Reset */
++#define AT91_RSTC_EXTRST (1 << 3) /* External Reset */
++#define AT91_RSTC_KEY (0xa5 << 24) /* KEY Password */
++
++#define AT91_RSTC_SR (AT91_RSTC + 0x04) /* Reset Controller Status Register */
++#define AT91_RSTC_URSTS (1 << 0) /* User Reset Status */
++#define AT91_RSTC_RSTTYP (7 << 8) /* Reset Type */
++#define AT91_RSTC_RSTTYP_GENERAL (0 << 8)
++#define AT91_RSTC_RSTTYP_WAKEUP (1 << 8)
++#define AT91_RSTC_RSTTYP_WATCHDOG (2 << 8)
++#define AT91_RSTC_RSTTYP_SOFTWARE (3 << 8)
++#define AT91_RSTC_RSTTYP_USER (4 << 8)
++#define AT91_RSTC_NRSTL (1 << 16) /* NRST Pin Level */
++#define AT91_RSTC_SRCMP (1 << 17) /* Software Reset Command in Progress */
++
++#define AT91_RSTC_MR (AT91_RSTC + 0x08) /* Reset Controller Mode Register */
++#define AT91_RSTC_URSTEN (1 << 0) /* User Reset Enable */
++#define AT91_RSTC_URSTIEN (1 << 4) /* User Reset Interrupt Enable */
++#define AT91_RSTC_ERSTL (0xf << 8) /* External Reset Length */
++
++#endif
+diff -urN u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at91_spi.h u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at91_spi.h
+--- u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/at91_spi.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/at91_spi.h 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,106 @@
++/*
++ * include/asm-arm/arch-at91/at91_spi.h
++ *
++ * Copyright (C) 2005 Ivan Kokshaysky
++ * Copyright (C) SAN People
++ *
++ * Serial Peripheral Interface (SPI) registers.
++ * Based on AT91RM9200 datasheet revision E.
++ *
++ * 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.
++ */
++
++#ifndef AT91_SPI_H
++#define AT91_SPI_H
++
++#define AT91_SPI_CR 0x00 /* Control Register */
++#define AT91_SPI_SPIEN (1 << 0) /* SPI Enable */
++#define AT91_SPI_SPIDIS (1 << 1) /* SPI Disable */
++#define AT91_SPI_SWRST (1 << 7) /* SPI Software Reset */
++#define AT91_SPI_LASTXFER (1 << 24) /* Last Transfer [SAM9261 only] */
++
++#define AT91_SPI_MR 0x04 /* Mode Register */
++#define AT91_SPI_MSTR (1 << 0) /* Master/Slave Mode */
++#define AT91_SPI_PS (1 << 1) /* Peripheral Select */
++#define AT91_SPI_PS_FIXED (0 << 1)
++#define AT91_SPI_PS_VARIABLE (1 << 1)
++#define AT91_SPI_PCSDEC (1 << 2) /* Chip Select Decode */
++#define AT91_SPI_DIV32 (1 << 3) /* Clock Selection [AT91RM9200 only] */
++#define AT91_SPI_MODFDIS (1 << 4) /* Mode Fault Detection */
++#define AT91_SPI_LLB (1 << 7) /* Local Loopback Enable */
++#define AT91_SPI_PCS (0xf << 16) /* Peripheral Chip Select */
++#define AT91_SPI_DLYBCS (0xff << 24) /* Delay Between Chip Selects */
++
++#define AT91_SPI_RDR 0x08 /* Receive Data Register */
++#define AT91_SPI_RD (0xffff << 0) /* Receive Data */
++#define AT91_SPI_PCS (0xf << 16) /* Peripheral Chip Select */
++
++#define AT91_SPI_TDR 0x0c /* Transmit Data Register */
++#define AT91_SPI_TD (0xffff << 0) /* Transmit Data */
++#define AT91_SPI_PCS (0xf << 16) /* Peripheral Chip Select */
++#define AT91_SPI_LASTXFER (1 << 24) /* Last Transfer [SAM9261 only] */
++
++#define AT91_SPI_SR 0x10 /* Status Register */
++#define AT91_SPI_RDRF (1 << 0) /* Receive Data Register Full */
++#define AT91_SPI_TDRE (1 << 1) /* Transmit Data Register Full */
++#define AT91_SPI_MODF (1 << 2) /* Mode Fault Error */
++#define AT91_SPI_OVRES (1 << 3) /* Overrun Error Status */
++#define AT91_SPI_ENDRX (1 << 4) /* End of RX buffer */
++#define AT91_SPI_ENDTX (1 << 5) /* End of TX buffer */
++#define AT91_SPI_RXBUFF (1 << 6) /* RX Buffer Full */
++#define AT91_SPI_TXBUFE (1 << 7) /* TX Buffer Empty */
++#define AT91_SPI_NSSR (1 << 8) /* NSS Rising [SAM9261 only] */
++#define AT91_SPI_TXEMPTY (1 << 9) /* Transmission Register Empty [SAM9261 only] */
++#define AT91_SPI_SPIENS (1 << 16) /* SPI Enable Status */
++
++#define AT91_SPI_IER 0x14 /* Interrupt Enable Register */
++#define AT91_SPI_IDR 0x18 /* Interrupt Disable Register */
++#define AT91_SPI_IMR 0x1c /* Interrupt Mask Register */
++
++#define AT91_SPI_CSR(n) (0x30 + ((n) * 4))/* Chip Select Registers 0-3 */
++#define AT91_SPI_CPOL (1 << 0) /* Clock Polarity */
++#define AT91_SPI_NCPHA (1 << 1) /* Clock Phase */
++#define AT91_SPI_CSAAT (1 << 3) /* Chip Select Active After Transfer [SAM9261 only] */
++#define AT91_SPI_BITS (0xf << 4) /* Bits Per Transfer */
++#define AT91_SPI_BITS_8 (0 << 4)
++#define AT91_SPI_BITS_9 (1 << 4)
++#define AT91_SPI_BITS_10 (2 << 4)
++#define AT91_SPI_BITS_11 (3 << 4)
++#define AT91_SPI_BITS_12 (4 << 4)
++#define AT91_SPI_BITS_13 (5 << 4)
++#define AT91_SPI_BITS_14 (6 << 4)
++#define AT91_SPI_BITS_15 (7 << 4)
++#define AT91_SPI_BITS_16 (8 << 4)
++#define AT91_SPI_SCBR (0xff << 8) /* Serial Clock Baud Rate */
++#define AT91_SPI_DLYBS (0xff << 16) /* Delay before SPCK */
++#define AT91_SPI_DLYBCT (0xff << 24) /* Delay between Consecutive Transfers */
++
++#define AT91_SPI_RPR 0x0100 /* Receive Pointer Register */
++
++#define AT91_SPI_RCR 0x0104 /* Receive Counter Register */
++
++#define AT91_SPI_TPR 0x0108 /* Transmit Pointer Register */
++
++#define AT91_SPI_TCR 0x010c /* Transmit Counter Register */
++
++#define AT91_SPI_RNPR 0x0110 /* Receive Next Pointer Register */
++
++#define AT91_SPI_RNCR 0x0114 /* Receive Next Counter Register */
++
++#define AT91_SPI_TNPR 0x0118 /* Transmit Next Pointer Register */
++
++#define AT91_SPI_TNCR 0x011c /* Transmit Next Counter Register */
++
++#define AT91_SPI_PTCR 0x0120 /* PDC Transfer Control Register */
++#define AT91_SPI_RXTEN (0x1 << 0) /* Receiver Transfer Enable */
++#define AT91_SPI_RXTDIS (0x1 << 1) /* Receiver Transfer Disable */
++#define AT91_SPI_TXTEN (0x1 << 8) /* Transmitter Transfer Enable */
++#define AT91_SPI_TXTDIS (0x1 << 9) /* Transmitter Transfer Disable */
++
++#define AT91_SPI_PTSR 0x0124 /* PDC Transfer Status Register */
++
++#endif
++
+diff -urN u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/clk.h u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/clk.h
+--- u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/clk.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/clk.h 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,45 @@
++/*
++ * (C) Copyright 2007
++ * Stelian Pop <stelian.pop <at> leadtechdesign.com>
++ * Lead Tech Design <www.leadtechdesign.com>
++ *
++ * 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
++ */
++#ifndef __ASM_ARM_ARCH_CLK_H__
++#define __ASM_ARM_ARCH_CLK_H__
++
++#include <asm/arch/hardware.h>
++
++static inline unsigned long get_macb_pclk_rate(unsigned int dev_id)
++{
++ return AT91_MASTER_CLOCK;
++}
++
++static inline unsigned long get_usart_clk_rate(unsigned int dev_id)
++{
++ return AT91_MASTER_CLOCK;
++}
++
++static inline unsigned long get_mci_clk_rate(void)
++{
++ return AT91_MASTER_CLOCK;
++}
++
++#endif /* __ASM_ARM_ARCH_CLK_H__ */
++
+diff -urN u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/gpio.h u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/gpio.h
+--- u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/gpio.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/gpio.h 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,367 @@
++/*
++ * include/asm-arm/arch-at91/gpio.h
++ *
++ * Copyright (C) 2005 HP Labs
++ *
++ * 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.
++ *
++ */
++
++#ifndef __ASM_ARCH_AT91_GPIO_H
++#define __ASM_ARCH_AT91_GPIO_H
++
++#include <asm/io.h>
++#include <asm/errno.h>
++#include <asm/arch/at91_pio.h>
++
++#define PIN_BASE 32
++
++#define MAX_GPIO_BANKS 5
++
++/* these pin numbers double as IRQ numbers, like AT91xxx_ID_* values */
++
++#define AT91_PIN_PA0 (PIN_BASE + 0x00 + 0)
++#define AT91_PIN_PA1 (PIN_BASE + 0x00 + 1)
++#define AT91_PIN_PA2 (PIN_BASE + 0x00 + 2)
++#define AT91_PIN_PA3 (PIN_BASE + 0x00 + 3)
++#define AT91_PIN_PA4 (PIN_BASE + 0x00 + 4)
++#define AT91_PIN_PA5 (PIN_BASE + 0x00 + 5)
++#define AT91_PIN_PA6 (PIN_BASE + 0x00 + 6)
++#define AT91_PIN_PA7 (PIN_BASE + 0x00 + 7)
++#define AT91_PIN_PA8 (PIN_BASE + 0x00 + 8)
++#define AT91_PIN_PA9 (PIN_BASE + 0x00 + 9)
++#define AT91_PIN_PA10 (PIN_BASE + 0x00 + 10)
++#define AT91_PIN_PA11 (PIN_BASE + 0x00 + 11)
++#define AT91_PIN_PA12 (PIN_BASE + 0x00 + 12)
++#define AT91_PIN_PA13 (PIN_BASE + 0x00 + 13)
++#define AT91_PIN_PA14 (PIN_BASE + 0x00 + 14)
++#define AT91_PIN_PA15 (PIN_BASE + 0x00 + 15)
++#define AT91_PIN_PA16 (PIN_BASE + 0x00 + 16)
++#define AT91_PIN_PA17 (PIN_BASE + 0x00 + 17)
++#define AT91_PIN_PA18 (PIN_BASE + 0x00 + 18)
++#define AT91_PIN_PA19 (PIN_BASE + 0x00 + 19)
++#define AT91_PIN_PA20 (PIN_BASE + 0x00 + 20)
++#define AT91_PIN_PA21 (PIN_BASE + 0x00 + 21)
++#define AT91_PIN_PA22 (PIN_BASE + 0x00 + 22)
++#define AT91_PIN_PA23 (PIN_BASE + 0x00 + 23)
++#define AT91_PIN_PA24 (PIN_BASE + 0x00 + 24)
++#define AT91_PIN_PA25 (PIN_BASE + 0x00 + 25)
++#define AT91_PIN_PA26 (PIN_BASE + 0x00 + 26)
++#define AT91_PIN_PA27 (PIN_BASE + 0x00 + 27)
++#define AT91_PIN_PA28 (PIN_BASE + 0x00 + 28)
++#define AT91_PIN_PA29 (PIN_BASE + 0x00 + 29)
++#define AT91_PIN_PA30 (PIN_BASE + 0x00 + 30)
++#define AT91_PIN_PA31 (PIN_BASE + 0x00 + 31)
++
++#define AT91_PIN_PB0 (PIN_BASE + 0x20 + 0)
++#define AT91_PIN_PB1 (PIN_BASE + 0x20 + 1)
++#define AT91_PIN_PB2 (PIN_BASE + 0x20 + 2)
++#define AT91_PIN_PB3 (PIN_BASE + 0x20 + 3)
++#define AT91_PIN_PB4 (PIN_BASE + 0x20 + 4)
++#define AT91_PIN_PB5 (PIN_BASE + 0x20 + 5)
++#define AT91_PIN_PB6 (PIN_BASE + 0x20 + 6)
++#define AT91_PIN_PB7 (PIN_BASE + 0x20 + 7)
++#define AT91_PIN_PB8 (PIN_BASE + 0x20 + 8)
++#define AT91_PIN_PB9 (PIN_BASE + 0x20 + 9)
++#define AT91_PIN_PB10 (PIN_BASE + 0x20 + 10)
++#define AT91_PIN_PB11 (PIN_BASE + 0x20 + 11)
++#define AT91_PIN_PB12 (PIN_BASE + 0x20 + 12)
++#define AT91_PIN_PB13 (PIN_BASE + 0x20 + 13)
++#define AT91_PIN_PB14 (PIN_BASE + 0x20 + 14)
++#define AT91_PIN_PB15 (PIN_BASE + 0x20 + 15)
++#define AT91_PIN_PB16 (PIN_BASE + 0x20 + 16)
++#define AT91_PIN_PB17 (PIN_BASE + 0x20 + 17)
++#define AT91_PIN_PB18 (PIN_BASE + 0x20 + 18)
++#define AT91_PIN_PB19 (PIN_BASE + 0x20 + 19)
++#define AT91_PIN_PB20 (PIN_BASE + 0x20 + 20)
++#define AT91_PIN_PB21 (PIN_BASE + 0x20 + 21)
++#define AT91_PIN_PB22 (PIN_BASE + 0x20 + 22)
++#define AT91_PIN_PB23 (PIN_BASE + 0x20 + 23)
++#define AT91_PIN_PB24 (PIN_BASE + 0x20 + 24)
++#define AT91_PIN_PB25 (PIN_BASE + 0x20 + 25)
++#define AT91_PIN_PB26 (PIN_BASE + 0x20 + 26)
++#define AT91_PIN_PB27 (PIN_BASE + 0x20 + 27)
++#define AT91_PIN_PB28 (PIN_BASE + 0x20 + 28)
++#define AT91_PIN_PB29 (PIN_BASE + 0x20 + 29)
++#define AT91_PIN_PB30 (PIN_BASE + 0x20 + 30)
++#define AT91_PIN_PB31 (PIN_BASE + 0x20 + 31)
++
++#define AT91_PIN_PC0 (PIN_BASE + 0x40 + 0)
++#define AT91_PIN_PC1 (PIN_BASE + 0x40 + 1)
++#define AT91_PIN_PC2 (PIN_BASE + 0x40 + 2)
++#define AT91_PIN_PC3 (PIN_BASE + 0x40 + 3)
++#define AT91_PIN_PC4 (PIN_BASE + 0x40 + 4)
++#define AT91_PIN_PC5 (PIN_BASE + 0x40 + 5)
++#define AT91_PIN_PC6 (PIN_BASE + 0x40 + 6)
++#define AT91_PIN_PC7 (PIN_BASE + 0x40 + 7)
++#define AT91_PIN_PC8 (PIN_BASE + 0x40 + 8)
++#define AT91_PIN_PC9 (PIN_BASE + 0x40 + 9)
++#define AT91_PIN_PC10 (PIN_BASE + 0x40 + 10)
++#define AT91_PIN_PC11 (PIN_BASE + 0x40 + 11)
++#define AT91_PIN_PC12 (PIN_BASE + 0x40 + 12)
++#define AT91_PIN_PC13 (PIN_BASE + 0x40 + 13)
++#define AT91_PIN_PC14 (PIN_BASE + 0x40 + 14)
++#define AT91_PIN_PC15 (PIN_BASE + 0x40 + 15)
++#define AT91_PIN_PC16 (PIN_BASE + 0x40 + 16)
++#define AT91_PIN_PC17 (PIN_BASE + 0x40 + 17)
++#define AT91_PIN_PC18 (PIN_BASE + 0x40 + 18)
++#define AT91_PIN_PC19 (PIN_BASE + 0x40 + 19)
++#define AT91_PIN_PC20 (PIN_BASE + 0x40 + 20)
++#define AT91_PIN_PC21 (PIN_BASE + 0x40 + 21)
++#define AT91_PIN_PC22 (PIN_BASE + 0x40 + 22)
++#define AT91_PIN_PC23 (PIN_BASE + 0x40 + 23)
++#define AT91_PIN_PC24 (PIN_BASE + 0x40 + 24)
++#define AT91_PIN_PC25 (PIN_BASE + 0x40 + 25)
++#define AT91_PIN_PC26 (PIN_BASE + 0x40 + 26)
++#define AT91_PIN_PC27 (PIN_BASE + 0x40 + 27)
++#define AT91_PIN_PC28 (PIN_BASE + 0x40 + 28)
++#define AT91_PIN_PC29 (PIN_BASE + 0x40 + 29)
++#define AT91_PIN_PC30 (PIN_BASE + 0x40 + 30)
++#define AT91_PIN_PC31 (PIN_BASE + 0x40 + 31)
++
++#define AT91_PIN_PD0 (PIN_BASE + 0x60 + 0)
++#define AT91_PIN_PD1 (PIN_BASE + 0x60 + 1)
++#define AT91_PIN_PD2 (PIN_BASE + 0x60 + 2)
++#define AT91_PIN_PD3 (PIN_BASE + 0x60 + 3)
++#define AT91_PIN_PD4 (PIN_BASE + 0x60 + 4)
++#define AT91_PIN_PD5 (PIN_BASE + 0x60 + 5)
++#define AT91_PIN_PD6 (PIN_BASE + 0x60 + 6)
++#define AT91_PIN_PD7 (PIN_BASE + 0x60 + 7)
++#define AT91_PIN_PD8 (PIN_BASE + 0x60 + 8)
++#define AT91_PIN_PD9 (PIN_BASE + 0x60 + 9)
++#define AT91_PIN_PD10 (PIN_BASE + 0x60 + 10)
++#define AT91_PIN_PD11 (PIN_BASE + 0x60 + 11)
++#define AT91_PIN_PD12 (PIN_BASE + 0x60 + 12)
++#define AT91_PIN_PD13 (PIN_BASE + 0x60 + 13)
++#define AT91_PIN_PD14 (PIN_BASE + 0x60 + 14)
++#define AT91_PIN_PD15 (PIN_BASE + 0x60 + 15)
++#define AT91_PIN_PD16 (PIN_BASE + 0x60 + 16)
++#define AT91_PIN_PD17 (PIN_BASE + 0x60 + 17)
++#define AT91_PIN_PD18 (PIN_BASE + 0x60 + 18)
++#define AT91_PIN_PD19 (PIN_BASE + 0x60 + 19)
++#define AT91_PIN_PD20 (PIN_BASE + 0x60 + 20)
++#define AT91_PIN_PD21 (PIN_BASE + 0x60 + 21)
++#define AT91_PIN_PD22 (PIN_BASE + 0x60 + 22)
++#define AT91_PIN_PD23 (PIN_BASE + 0x60 + 23)
++#define AT91_PIN_PD24 (PIN_BASE + 0x60 + 24)
++#define AT91_PIN_PD25 (PIN_BASE + 0x60 + 25)
++#define AT91_PIN_PD26 (PIN_BASE + 0x60 + 26)
++#define AT91_PIN_PD27 (PIN_BASE + 0x60 + 27)
++#define AT91_PIN_PD28 (PIN_BASE + 0x60 + 28)
++#define AT91_PIN_PD29 (PIN_BASE + 0x60 + 29)
++#define AT91_PIN_PD30 (PIN_BASE + 0x60 + 30)
++#define AT91_PIN_PD31 (PIN_BASE + 0x60 + 31)
++
++#define AT91_PIN_PE0 (PIN_BASE + 0x80 + 0)
++#define AT91_PIN_PE1 (PIN_BASE + 0x80 + 1)
++#define AT91_PIN_PE2 (PIN_BASE + 0x80 + 2)
++#define AT91_PIN_PE3 (PIN_BASE + 0x80 + 3)
++#define AT91_PIN_PE4 (PIN_BASE + 0x80 + 4)
++#define AT91_PIN_PE5 (PIN_BASE + 0x80 + 5)
++#define AT91_PIN_PE6 (PIN_BASE + 0x80 + 6)
++#define AT91_PIN_PE7 (PIN_BASE + 0x80 + 7)
++#define AT91_PIN_PE8 (PIN_BASE + 0x80 + 8)
++#define AT91_PIN_PE9 (PIN_BASE + 0x80 + 9)
++#define AT91_PIN_PE10 (PIN_BASE + 0x80 + 10)
++#define AT91_PIN_PE11 (PIN_BASE + 0x80 + 11)
++#define AT91_PIN_PE12 (PIN_BASE + 0x80 + 12)
++#define AT91_PIN_PE13 (PIN_BASE + 0x80 + 13)
++#define AT91_PIN_PE14 (PIN_BASE + 0x80 + 14)
++#define AT91_PIN_PE15 (PIN_BASE + 0x80 + 15)
++#define AT91_PIN_PE16 (PIN_BASE + 0x80 + 16)
++#define AT91_PIN_PE17 (PIN_BASE + 0x80 + 17)
++#define AT91_PIN_PE18 (PIN_BASE + 0x80 + 18)
++#define AT91_PIN_PE19 (PIN_BASE + 0x80 + 19)
++#define AT91_PIN_PE20 (PIN_BASE + 0x80 + 20)
++#define AT91_PIN_PE21 (PIN_BASE + 0x80 + 21)
++#define AT91_PIN_PE22 (PIN_BASE + 0x80 + 22)
++#define AT91_PIN_PE23 (PIN_BASE + 0x80 + 23)
++#define AT91_PIN_PE24 (PIN_BASE + 0x80 + 24)
++#define AT91_PIN_PE25 (PIN_BASE + 0x80 + 25)
++#define AT91_PIN_PE26 (PIN_BASE + 0x80 + 26)
++#define AT91_PIN_PE27 (PIN_BASE + 0x80 + 27)
++#define AT91_PIN_PE28 (PIN_BASE + 0x80 + 28)
++#define AT91_PIN_PE29 (PIN_BASE + 0x80 + 29)
++#define AT91_PIN_PE30 (PIN_BASE + 0x80 + 30)
++#define AT91_PIN_PE31 (PIN_BASE + 0x80 + 31)
++
++static unsigned long at91_pios[] = {
++ AT91_PIOA,
++ AT91_PIOB,
++ AT91_PIOC,
++#ifdef AT91_PIOD
++ AT91_PIOD,
++#ifdef AT91_PIOE
++ AT91_PIOE
++#endif
++#endif
++};
++
++static inline void *pin_to_controller(unsigned pin)
++{
++ pin -= PIN_BASE;
++ pin /= 32;
++ return (void *)(AT91_BASE_SYS + at91_pios[pin]);
++}
++
++static inline unsigned pin_to_mask(unsigned pin)
++{
++ pin -= PIN_BASE;
++ return 1 << (pin % 32);
++}
++
++/*
++ * mux the pin to the "GPIO" peripheral role.
++ */
++static inline int at91_set_GPIO_periph(unsigned pin, int use_pullup)
++{
++ void *pio = pin_to_controller(pin);
++ unsigned mask = pin_to_mask(pin);
++
++ __raw_writel(mask, pio + PIO_IDR);
++ __raw_writel(mask, pio + (use_pullup ? PIO_PUER : PIO_PUDR));
++ __raw_writel(mask, pio + PIO_PER);
++ return 0;
++}
++
++/*
++ * mux the pin to the "A" internal peripheral role.
++ */
++static inline int at91_set_A_periph(unsigned pin, int use_pullup)
++{
++ void *pio = pin_to_controller(pin);
++ unsigned mask = pin_to_mask(pin);
++
++ __raw_writel(mask, pio + PIO_IDR);
++ __raw_writel(mask, pio + (use_pullup ? PIO_PUER : PIO_PUDR));
++ __raw_writel(mask, pio + PIO_ASR);
++ __raw_writel(mask, pio + PIO_PDR);
++ return 0;
++}
++
++/*
++ * mux the pin to the "B" internal peripheral role.
++ */
++static inline int at91_set_B_periph(unsigned pin, int use_pullup)
++{
++ void *pio = pin_to_controller(pin);
++ unsigned mask = pin_to_mask(pin);
++
++ __raw_writel(mask, pio + PIO_IDR);
++ __raw_writel(mask, pio + (use_pullup ? PIO_PUER : PIO_PUDR));
++ __raw_writel(mask, pio + PIO_BSR);
++ __raw_writel(mask, pio + PIO_PDR);
++ return 0;
++}
++
++/*
++ * mux the pin to the gpio controller (instead of "A" or "B" peripheral), and
++ * configure it for an input.
++ */
++static inline int at91_set_gpio_input(unsigned pin, int use_pullup)
++{
++ void *pio = pin_to_controller(pin);
++ unsigned mask = pin_to_mask(pin);
++
++ __raw_writel(mask, pio + PIO_IDR);
++ __raw_writel(mask, pio + (use_pullup ? PIO_PUER : PIO_PUDR));
++ __raw_writel(mask, pio + PIO_ODR);
++ __raw_writel(mask, pio + PIO_PER);
++ return 0;
++}
++
++/*
++ * mux the pin to the gpio controller (instead of "A" or "B" peripheral),
++ * and configure it for an output.
++ */
++static inline int at91_set_gpio_output(unsigned pin, int value)
++{
++ void *pio = pin_to_controller(pin);
++ unsigned mask = pin_to_mask(pin);
++
++ __raw_writel(mask, pio + PIO_IDR);
++ __raw_writel(mask, pio + PIO_PUDR);
++ __raw_writel(mask, pio + (value ? PIO_SODR : PIO_CODR));
++ __raw_writel(mask, pio + PIO_OER);
++ __raw_writel(mask, pio + PIO_PER);
++ return 0;
++}
++
++/*
++ * enable/disable the glitch filter; mostly used with IRQ handling.
++ */
++static inline int at91_set_deglitch(unsigned pin, int is_on)
++{
++ void *pio = pin_to_controller(pin);
++ unsigned mask = pin_to_mask(pin);
++
++ __raw_writel(mask, pio + (is_on ? PIO_IFER : PIO_IFDR));
++ return 0;
++}
++
++/*
++ * enable/disable the multi-driver; This is only valid for output and
++ * allows the output pin to run as an open collector output.
++ */
++static inline int at91_set_multi_drive(unsigned pin, int is_on)
++{
++ void *pio = pin_to_controller(pin);
++ unsigned mask = pin_to_mask(pin);
++
++ __raw_writel(mask, pio + (is_on ? PIO_MDER : PIO_MDDR));
++ return 0;
++}
++
++static inline int gpio_direction_input(unsigned pin)
++{
++ void *pio = pin_to_controller(pin);
++ unsigned mask = pin_to_mask(pin);
++
++ if (!(__raw_readl(pio + PIO_PSR) & mask))
++ return -EINVAL;
++ __raw_writel(mask, pio + PIO_ODR);
++ return 0;
++}
++
++static inline int gpio_direction_output(unsigned pin, int value)
++{
++ void *pio = pin_to_controller(pin);
++ unsigned mask = pin_to_mask(pin);
++
++ if (!(__raw_readl(pio + PIO_PSR) & mask))
++ return -EINVAL;
++ __raw_writel(mask, pio + (value ? PIO_SODR : PIO_CODR));
++ __raw_writel(mask, pio + PIO_OER);
++ return 0;
++}
++
++/*
++ * assuming the pin is muxed as a gpio output, set its value.
++ */
++static inline int at91_set_gpio_value(unsigned pin, int value)
++{
++ void *pio = pin_to_controller(pin);
++ unsigned mask = pin_to_mask(pin);
++
++ __raw_writel(mask, pio + (value ? PIO_SODR : PIO_CODR));
++ return 0;
++}
++
++/*
++ * read the pin's value (works even if it's not muxed as a gpio).
++ */
++static inline int at91_get_gpio_value(unsigned pin)
++{
++ void *pio = pin_to_controller(pin);
++ unsigned mask = pin_to_mask(pin);
++ u32 pdsr;
++
++ pdsr = __raw_readl(pio + PIO_PDSR);
++ return (pdsr & mask) != 0;
++}
++
++#endif
++
+diff -urN u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/hardware.h u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/hardware.h
+--- u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/hardware.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/hardware.h 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,37 @@
++/*
++ * include/asm-arm/arch-at91/hardware.h
++ *
++ * Copyright (C) 2003 SAN People
++ * Copyright (C) 2003 ATMEL
++ *
++ * 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.
++ *
++ */
++
++#ifndef __ASM_ARCH_HARDWARE_H
++#define __ASM_ARCH_HARDWARE_H
++
++#include <asm/sizes.h>
++
++#if defined(CONFIG_AT572D940HF)
++#include <asm/arch/at572d940hf.h>
++#else
++#error "Unsupported AT572D940HF processor"
++#endif
++
++/*
++ * container_of - cast a member of a structure out to the containing structure
++ *
++ * @ptr: the pointer to the member.
++ * @type: the type of the container struct this is embedded in.
++ * @member: the name of the member within the struct.
++ */
++#define container_of(ptr, type, member) ({ \
++ const typeof(((type *)0)->member) *__mptr = (ptr); \
++ (type *)((char *)__mptr - offsetof(type, member)); })
++
++#endif
++
+diff -urN u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/interrupts.h u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/interrupts.h
+--- u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/interrupts.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/interrupts.h 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,40 @@
++/*
++ * include/asm-arm/arch-at572d940/at91_aic.h
++ *
++ * Copyright (C) 2008 Antonio R. Costa
++ * Copyright (C) ATMEL
++ *
++ * Advanced Interrupt Controller (AIC).
++ * Based on AT572D940 datasheet.
++ *
++ * 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.
++ */
++
++#ifndef __AT572D940_INTERRUPTS_H__
++#define __AT572D940_INTERRUPTS_H__
++
++#include <asm/arch/at91_aic.h>
++
++typedef void (*irq_handler_t) (unsigned long int);
++
++#define SET_IRQ_HANDLER(s,m,h) \
++do { \
++ AIC_WRITE(AIC_SMR(s),m); \
++ AIC_WRITE(AIC_SVR(s),h); \
++ AIC_WRITE(AIC_IECR,(1<<s)); \
++} while(0)
++
++#define RESET_IRQ_HANDLER(s) \
++do { \
++ AIC_WRITE(AIC_SMR(s),0); \
++ AIC_WRITE(AIC_SVR(s),0); \
++ AIC_WRITE(AIC_IDCR,(1<<s)); \
++} while(0)
++
++#define IRQ_ACKNOWLEDGE(n) AIC_WRITE(AIC_EOICR,(n))
++
++extern reset_irqs(void);
++#endif /* __AT572D940_INTERRUPTS_H__ */
+diff -urN u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/io.h u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/io.h
+--- u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/io.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/io.h 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,41 @@
++/*
++ * include/asm-arm/arch-at91/io.h
++ *
++ * Copyright (C) 2003 SAN People
++ *
++ * 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
++ */
++
++#ifndef __ASM_ARCH_IO_H
++#define __ASM_ARCH_IO_H
++
++#include <asm/io.h>
++
++static inline unsigned int at91_sys_read(unsigned int reg_offset)
++{
++ void *addr = (void *)AT91_BASE_SYS;
++
++ return __raw_readl(addr + reg_offset);
++}
++
++static inline void at91_sys_write(unsigned int reg_offset, unsigned long value)
++{
++ void *addr = (void *)AT91_BASE_SYS;
++
++ __raw_writel(value, addr + reg_offset);
++}
++
++#endif
++
+diff -urN u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/memory-map.h u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/memory-map.h
+--- u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/memory-map.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/memory-map.h 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,37 @@
++/*
++ * (C) Copyright 2007-2008
++ * Stelian Pop <stelian.pop <at> leadtechdesign.com>
++ * Lead Tech Design <www.leadtechdesign.com>
++ *
++ * 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
++ */
++#ifndef __ASM_ARM_ARCH_MEMORYMAP_H__
++#define __ASM_ARM_ARCH_MEMORYMAP_H__
++
++#include <asm/arch/hardware.h>
++
++#define USART0_BASE AT91_USART0
++#define USART1_BASE AT91_USART1
++#define USART2_BASE AT91_USART2
++#define USART3_BASE (AT91_BASE_SYS + AT91_DBGU)
++
++#define AT572D940_SDRAM_BASE 0x20000000
++
++#endif /* __ASM_ARM_ARCH_MEMORYMAP_H__ */
++
+diff -urN u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/mmc.h u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/mmc.h
+--- u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/mmc.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/mmc.h 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,355 @@
++/*
++ * Copyright (C) 2008 Atmel Corporation
++ *
++ * Antonio R. Costa <antonio.costa <at> atmel.com>
++ * <costa.antonior <at> gmail.com>
++ *
++ * 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
++ */
++
++#ifndef __ASM_AT572D940_MMC_H
++#define __ASM_AT572D940_MMC_H
++
++struct mmc_cid {
++ unsigned long psn;
++ unsigned short oid;
++ unsigned char mid;
++ unsigned char prv;
++ unsigned char mdt;
++ char pnm[7];
++};
++
++/*
++ * Bitfileds are ugly and not portable,
++ * So lets redefine the CSD
++ */
++
++typedef unsigned long mmc_csd_t[4];
++typedef unsigned long sd_csd_t[4];
++
++/*
++ * CSD ver: 2.0 manipulation macros
++ */
++
++/*
++ * Masks
++ */
++
++#define CSD_2x_VER_MASK 0x3
++#define CSD_2x_RSVD1_MASK 0x3f
++#define CSD_2x_TAAC_MASK 0xff
++#define CSD_2x_NSAC_MASK 0xff
++#define CSD_2x_TRANSPEED_MASK 0xff
++
++#define CSD_2x_CCC_MASK 0xfff
++#define CSD_2x_RBLEN_MASK 0xff
++#define CSD_2x_RBP_MASK 0x1
++#define CSD_2x_WBM_MASK 0x1
++#define CSD_2x_RBM_MASK 0x1
++#define CSD_2x_DSRIMP_MASK 0x1
++#define CSD_2x_RSVD2_MASK 0x3f
++#define CSD_2x_CSIZE_H_MASK 0x3f
++
++#define CSD_2x_CSIZE_MASK 0xffff
++#define CSD_2x_RSVD3_MASK 0x1
++#define CSD_2x_ERBL_MASK 0x1
++#define CSD_2x_SECSIZE_MASK 0x7f
++#define CSD_2x_WPGS_MASK 0x7f
++
++#define CSD_2x_WPGE_MASK 0x1
++#define CSD_2x_RSVD4_MASK 0x3
++#define CSD_2x_R2WF_MASK 0x7
++#define CSD_2x_WBL_MASK 0xf
++#define CSD_2x_WBP_MASK 0x1
++#define CSD_2x_RSVD5_MASK 0x1f
++#define CSD_2x_FFG_MASK 0x1
++#define CSD_2x_COPY_MASK 0x1
++#define CSD_2x_PWP_MASK 0x1
++#define CSD_2x_TWP_MASK 0x1
++#define CSD_2x_FF_MASK 0x3
++#define CSD_2x_RSVD6_MASK 0x3
++#define CSD_2x_CRC_MASK 0x7f
++#define CSD_2x_ONE_MASK 0x1
++
++/*
++ * Offsets inside the single word
++ */
++
++#define CSD_2x_VER_OFF 30
++#define CSD_2x_RSVD1_OFF 24
++#define CSD_2x_TAAC_OFF 16
++#define CSD_2x_NSAC_OFF 8
++#define CSD_2x_TRANSPEED_OFF 0
++
++#define CSD_2x_CCC_OFF 20
++#define CSD_2x_RBLEN_OFF 16
++#define CSD_2x_RBP_OFF 15
++#define CSD_2x_WBM_OFF 14
++#define CSD_2x_RBM_OFF 13
++#define CSD_2x_DSRIMP_OFF 12
++#define CSD_2x_RSVD2_OFF 6
++#define CSD_2x_CSIZE_H_OFF 0
++
++#define CSD_2x_CSIZE_OFF 16
++#define CSD_2x_RSVD3_OFF 15
++#define CSD_2x_ERBL_OFF 14
++#define CSD_2x_SECSIZE_OFF 7
++#define CSD_2x_WPGS_OFF 0
++
++#define CSD_2x_WPGE_OFF 31
++#define CSD_2x_RSVD4_OFF 29
++#define CSD_2x_R2WF_OFF 26
++#define CSD_2x_WBL_OFF 22
++#define CSD_2x_WBP_OFF 21
++#define CSD_2x_RSVD5_OFF 16
++#define CSD_2x_FFG_OFF 15
++#define CSD_2x_COPY_OFF 14
++#define CSD_2x_PWP_OFF 13
++#define CSD_2x_TWP_OFF 12
++#define CSD_2x_FF_OFF 10
++#define CSD_2x_RSVD6_OFF 8
++#define CSD_2x_CRC_OFF 1
++#define CSD_2x_ONE_OFF 0
++
++/*
++ * Word in which the field is placed
++ */
++
++#define CSD_2x_VER_W 0
++#define CSD_2x_RSVD1_W 0
++#define CSD_2x_TAAC_W 0
++#define CSD_2x_NSAC_W 0
++#define CSD_2x_TRANSPEED_W 0
++
++#define CSD_2x_CCC_W 1
++#define CSD_2x_RBLEN_W 1
++#define CSD_2x_RBP_W 1
++#define CSD_2x_WBM_W 1
++#define CSD_2x_RBM_W 1
++#define CSD_2x_DSRIMP_W 1
++#define CSD_2x_RSVD2_W 1
++#define CSD_2x_CSIZE_H_W 1
++
++#define CSD_2x_CSIZE_W 2
++#define CSD_2x_RSVD3_W 2
++#define CSD_2x_ERBL_W 2
++#define CSD_2x_SECSIZE_W 2
++#define CSD_2x_WPGS_W 2
++
++#define CSD_2x_WPGE_W 3
++#define CSD_2x_RSVD4_W 3
++#define CSD_2x_R2WF_W 3
++#define CSD_2x_WBL_W 3
++#define CSD_2x_WBP_W 3
++#define CSD_2x_RSVD5_W 3
++#define CSD_2x_FFG_W 3
++#define CSD_2x_COPY_W 3
++#define CSD_2x_PWP_W 3
++#define CSD_2x_TWP_W 3
++#define CSD_2x_FF_W 3
++#define CSD_2x_RSVD6_W 3
++#define CSD_2x_CRC_W 3
++#define CSD_2x_ONE_W 3
++
++/*
++ * ARC:
++ * Please note that CSIZE field crosses the word boundary,
++ * anyway since SD spec 2.0 states that the highest 6 bits
++ * shall be set to 0s the following macro still works
++ */
++
++#define SD_CSD_2x_CSIZE(pcsd) \
++ (((unsigned long long) SD_CSD_2x_FIELD(CSIZE,pcsd)) | \
++ (((unsigned long long) SD_CSD_2x_FIELD(CSIZE_H,pcsd)) << 16))
++
++#define SD_CSD_2x_FIELD(name,pcsd) \
++ ((((unsigned long *)pcsd)[CSD_2x_## name ##_W] >> \
++ CSD_2x_## name ##_OFF) & CSD_2x_## name ##_MASK)
++
++#define CSD_1x_VER_MASK 0x3
++#define CSD_1x_RSVD1_MASK 0x3f
++#define CSD_1x_TAAC_MASK 0xff
++#define CSD_1x_NSAC_MASK 0xff
++#define CSD_1x_TRANSPEED_MASK 0xff
++
++#define CSD_1x_CCC_MASK 0xfff
++#define CSD_1x_RBLEN_MASK 0xf
++#define CSD_1x_RBP_MASK 0x1
++#define CSD_1x_WBM_MASK 0x1
++#define CSD_1x_RBM_MASK 0x1
++#define CSD_1x_DSRIMP_MASK 0x1
++#define CSD_1x_RSVD2_MASK 0x3
++#define CSD_1x_CSIZE_H_MASK 0x3ff
++
++#define CSD_1x_CSIZE_MASK 0x3
++#define CSD_1x_RCMIN_MASK 0x7
++#define CSD_1x_RCMAX_MASK 0x7
++#define CSD_1x_WCMIN_MASK 0x7
++#define CSD_1x_WCMAX_MASK 0x7
++#define CSD_1x_CSMUL_MASK 0x7
++#define CSD_1x_ESBE_MASK 0x1
++#define CSD_1x_SEC_SIZE_MASK 0x7ff
++
++#define CSD_1x_WPGS_MASK 0x7ff
++#define CSD_1x_WPGE_MASK 0x1
++#define CSD_1x_RSVD4_MASK 0x3
++#define CSD_1x_R2WF_MASK 0x7
++#define CSD_1x_WBL_MASK 0xf
++#define CSD_1x_WBP_MASK 0x1
++#define CSD_1x_RSVD5_MASK 0x1f
++#define CSD_1x_FFG_MASK 0x1
++#define CSD_1x_COPY_MASK 0x1
++#define CSD_1x_PWP_MASK 0x1
++#define CSD_1x_TWP_MASK 0x1
++#define CSD_1x_FF_MASK 0x3
++#define CSD_1x_RSVD6_MASK 0x3
++#define CSD_1x_CRC_MASK 0x7f
++#define CSD_1x_ONE_MASK 0x1
++
++/*
++ * Offsets inside the single word
++ */
++
++#define CSD_1x_VER_OFF 30
++#define CSD_1x_RSVD1_OFF 24
++#define CSD_1x_TAAC_OFF 16
++#define CSD_1x_NSAC_OFF 8
++#define CSD_1x_TRANSPEED_OFF 0
++
++#define CSD_1x_CCC_OFF 20
++#define CSD_1x_RBLEN_OFF 16
++#define CSD_1x_RBP_OFF 15
++#define CSD_1x_WBM_OFF 14
++#define CSD_1x_RBM_OFF 13
++#define CSD_1x_DSRIMP_OFF 12
++#define CSD_1x_RSVD2_OFF 10
++#define CSD_1x_CSIZE_H_OFF 0
++
++#define CSD_1x_CSIZE_OFF 30
++#define CSD_1x_RCMIN_OFF 27
++#define CSD_1x_RCMAX_OFF 24
++#define CSD_1x_WCMIN_OFF 21
++#define CSD_1x_WCMAX_OFF 18
++#define CSD_1x_CSMUL_OFF 15
++#define CSD_1x_ERBL_OFF 14
++#define CSD_1x_SECSIZE_OFF 7
++#define CSD_1x_WPGS_OFF 0
++
++#define CSD_1x_WPGE_OFF 31
++#define CSD_1x_RSVD4_OFF 29
++#define CSD_1x_R2WF_OFF 26
++#define CSD_1x_WBL_OFF 22
++#define CSD_1x_WBP_OFF 21
++#define CSD_1x_RSVD5_OFF 16
++#define CSD_1x_FFG_OFF 15
++#define CSD_1x_COPY_OFF 14
++#define CSD_1x_PWP_OFF 13
++#define CSD_1x_TWP_OFF 12
++#define CSD_1x_FF_OFF 10
++#define CSD_1x_RSVD6_OFF 8
++#define CSD_1x_CRC_OFF 1
++#define CSD_1x_ONE_OFF 0
++
++/*
++ * Word in which the field is placed
++ */
++
++#define CSD_1x_VER_W 0
++#define CSD_1x_RSVD1_W 0
++#define CSD_1x_TAAC_W 0
++#define CSD_1x_NSAC_W 0
++#define CSD_1x_TRANSPEED_W 0
++
++#define CSD_1x_CCC_W 1
++#define CSD_1x_RBLEN_W 1
++#define CSD_1x_RBP_W 1
++#define CSD_1x_WBM_W 1
++#define CSD_1x_RBM_W 1
++#define CSD_1x_DSRIMP_W 1
++#define CSD_1x_RSVD2_W 1
++#define CSD_1x_CSIZE_H_W 1
++
++#define CSD_1x_CSIZE_W 2
++#define CSD_1x_RCMIN_W 2
++#define CSD_1x_RCMAX_W 2
++#define CSD_1x_WCMIN_W 2
++#define CSD_1x_WCMAX_W 2
++#define CSD_1x_CSMUL_W 2
++#define CSD_1x_ERBL_W 2
++#define CSD_1x_SECSIZE_W 2
++#define CSD_1x_WPGS_W 2
++
++#define CSD_1x_WPGE_W 3
++#define CSD_1x_RSVD4_W 3
++#define CSD_1x_R2WF_W 3
++#define CSD_1x_WBL_W 3
++#define CSD_1x_WBP_W 3
++#define CSD_1x_RSVD5_W 3
++#define CSD_1x_FFG_W 3
++#define CSD_1x_COPY_W 3
++#define CSD_1x_PWP_W 3
++#define CSD_1x_TWP_W 3
++#define CSD_1x_FF_W 3
++#define CSD_1x_RSVD6_W 3
++#define CSD_1x_CRC_W 3
++#define CSD_1x_ONE_W 3
++
++#define SD_CSD_1x_FIELD(name,pcsd) \
++ ((((unsigned long *)pcsd)[CSD_1x_## name ##_W] >> \
++ CSD_1x_## name ##_OFF) & CSD_1x_## name ##_MASK)
++
++#define SD_CSD_FIELD(name,pcsd) \
++ ((SD_CSD_1x_FIELD(VER,pcsd) == 0x0) ? \
++ SD_CSD_1x_FIELD(name,pcsd) : SD_CSD_2x_FIELD(name,pcsd))
++
++#define SD_CSD_1x_CSIZE(pcsd) \
++ (SD_CSD_1x_FIELD(CSIZE,pcsd)+(SD_CSD_1x_FIELD(CSIZE_H,pcsd) << 2))
++
++#define SD_CSD_VER(pcsd) \
++ (SD_CSD_1x_FIELD(VER,pcsd))
++
++#define MMC_CSD_VER(pcsd) SD_CSD_VER(pcsd)
++#define MMC_CSD_FIELD(name,pcsd) SD_CSD_1x_FIELD(name,pcsd)
++
++/* MMC Command numbers */
++#define MMC_CMD_GO_IDLE_STATE 0
++#define MMC_CMD_SEND_OP_COND 1
++#define MMC_CMD_ALL_SEND_CID 2
++#define MMC_CMD_SET_RELATIVE_ADDR 3
++#define MMC_CMD_SD_SEND_RELATIVE_ADDR 3
++#define MMC_CMD_SET_DSR 4
++#define MMC_CMD_SELECT_CARD 7
++#define MMC_CMD_IF_COND 8
++#define MMC_CMD_SEND_CSD 9
++#define MMC_CMD_SEND_CID 10
++#define MMC_CMD_SEND_STATUS 13
++#define MMC_CMD_SET_BLOCKLEN 16
++#define MMC_CMD_READ_SINGLE_BLOCK 17
++#define MMC_CMD_READ_MULTIPLE_BLOCK 18
++#define MMC_CMD_WRITE_BLOCK 24
++#define MMC_CMD_APP_CMD 55
++
++#define MMC_ACMD_BUS_WIDTH 6
++#define MMC_ACMD_SD_SEND_OP_COND 41
++
++#define R1_ILLEGAL_COMMAND (1 << 22)
++#define R1_APP_CMD (1 << 5)
++
++#endif /* __ASM_AT572D940_MMC_H */
++
+diff -urN u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/timer.h u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/timer.h
+--- u-boot-2009.01-rc1-0rig//include/asm-arm/arch-at572d940hf/timer.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/asm-arm/arch-at572d940hf/timer.h 2009-01-04 22:02:50.000000000 +0100
+@@ -0,0 +1,30 @@
++/*
++ * Copyright (C) 2005-2006 Atmel Corporation
++ *
++ * 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
++ */
++
++/*
++ * Author: Antonio R. Costa
++ */
++
++#ifndef _AT91_TIMER_H_
++#define _AT91_TIMER_H_
++#endif
++
+diff -urN u-boot-2009.01-rc1-0rig//include/configs/at572d940hfeb.h u-boot-2009.01-rc1/include/configs/at572d940hfeb.h
+--- u-boot-2009.01-rc1-0rig//include/configs/at572d940hfeb.h 1970-01-01 01:00:00.000000000 +0100
++++ u-boot-2009.01-rc1/include/configs/at572d940hfeb.h 2009-01-04 22:04:18.000000000 +0100
+@@ -0,0 +1,285 @@
++/*
++ * (C) Copyright 2008
++ * Antonio R. Costa <antonio.costa <at> atmel.com>
++ * ATMEL CORP <www.atmel.com>
++ *
++ * Configuation settings for the AT572D940HFEB board.
++ *
++ * 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
++ */
++
++#ifndef __CONFIG_H
++#define __CONFIG_H
++
++/* ARM asynchronous clock */
++/* Miniloader */
++#define AT91_MAIN_CLOCK 160000000 /* from 12 MHz crystal */
++#define AT91_MASTER_CLOCK 80000000 /* peripheral = main / 2 */
++
++/* ROM Boot */
++//#define AT91_MAIN_CLOCK 96000000 /* from 18.432 MHz crystal */
++//#define AT91_MASTER_CLOCK 48000000 /* peripheral = main / 2 */
++
++#define CONFIG_SYS_HZ 1000000 /* 1us resolution */
++
++#define AT91_CLK_DELAY_CYCLES 256
++#define AT91_SLOW_CLOCK 32768 /* slow clock */
++#define CONFIG_SLOW_CLK AT91_SLOW_CLOCK
++
++#define AT91_SLOW_FREQ 0
++#define AT91_SYS_FREQ 1
++#define AT91_PROC_FREQ 2
++#define AT91_MASTER_FREQ 3
++
++#define CONFIG_ARM926EJS 1 /* This is an ARM926EJS Core */
++#define CONFIG_AT572D940HF 1 /* It's an Atmel AT572D940HF SoC */
++#define CONFIG_AT572D940HFEB 1 /* on an AT572D940HFEB Board */
++#define CONFIG_MACH_AT572D940HFEB 1
++#define CONFIG_USE_IRQ 1
++
++#define CONFIG_CMDLINE_TAG 1 /* enable passing of ATAGs */
++#define CONFIG_SETUP_MEMORY_TAGS 1
++#define CONFIG_INITRD_TAG 1
++
++#define CONFIG_SKIP_LOWLEVEL_INIT 1
++#define CONFIG_SKIP_RELOCATE_UBOOT 1
++
++/*
++ * Hardware drivers
++ */
++#define CONFIG_ATMEL_USART 1
++#undef CONFIG_USART0
++#undef CONFIG_USART1
++#undef CONFIG_USART2
++#define CONFIG_USART3 1 /* USART 3 is DBGU */
++#define CONFIG_ATMEL_MCI 1
++#define CONFIG_BOOTDELAY 3
++/*
++ * #define CONFIG_BOOTARGS "console=ttyS0,115200 " \
++ * "root=/dev/mtdblock0 rw rootfstype=jffs2"
++ */
++
++#undef CONFIG_HWFLOW /* don't include RTS/CTS flow control support */
++
++#define CONFIG_ENV_OVERWRITE 1
++
++/*
++ * BOOTP options
++ */
++#define CONFIG_BOOTP_BOOTFILESIZE 1
++#define CONFIG_BOOTP_BOOTPATH 1
++#define CONFIG_BOOTP_GATEWAY 1
++#define CONFIG_BOOTP_HOSTNAME 1
++
++/*
++ * Command line configuration.
++ */
++#include <config_cmd_default.h>
++//#undef CONFIG_CMD_BDI
++//#undef CONFIG_CMD_IMI
++//#undef CONFIG_CMD_NET
++//#undef CONFIG_CMD_PING
++
++#define CONFIG_AUTO_COMPLETE 1
++#define CONFIG_CMDLINE_EDITING 1
++
++#undef CONFIG_CMD_FPGA
++#undef CONFIG_CMD_LOADS
++#undef CONFIG_CMD_IMLS
++#undef CONFIG_CMD_FLASH
++
++#define CONFIG_CMD_PING 1
++#define CONFIG_CMD_DHCP 1
++#undef CONFIG_CMD_NAND 1
++#define CONFIG_CMD_USB 1
++#define CONFIG_CMD_MMC 1
++// #undef CONFIG_CMD_I2C
++// #undef CONFIG_CMD_SPI
++// #define CONFIG_CMD_AT91_SPIMUX 1
++#define CONFIG_CMD_FAT 1
++#define CONFIG_CMD_EXT2 1
++#define CONFIG_CMD_JFFS2 1
++
++/* SDRAM */
++#define CONFIG_NR_DRAM_BANKS 1
++#define PHYS_SDRAM 0x20000000
++#define PHYS_SDRAM_SIZE 0x04000000 /* 64 megs */
++
++/* DataFlash */
++#define CONFIG_HAS_DATAFLASH 1
++#define CONFIG_SYS_SPI_WRITE_TOUT (5*CONFIG_SYS_HZ)
++#define CONFIG_SYS_MAX_DATAFLASH_BANKS 2
++#define CONFIG_SYS_DATAFLASH_LOGIC_ADDR_CS0 0xC0000000 /* CS0 */
++#define CONFIG_SYS_DATAFLASH_LOGIC_ADDR_CS1 0xD0000000 /* CS1 */
++#define AT91_SPI_CLK 33000000
++#define DATAFLASH_TCSS (0x1a << 16)
++#define DATAFLASH_TCHS (0x01 << 24)
++
++/* NAND flash */
++#define NAND_MAX_CHIPS 1
++#define CONFIG_SYS_MAX_NAND_DEVICE 1
++#define CONFIG_SYS_NAND_BASE 0x40000000
++#define CONFIG_SYS_NAND_DBW_8 1
++
++#define CONFIG_SYS_FLASH_BASE 0x10000000
++#define CONFIG_SYS_BOOT_SIZE (7 * 0x1000) /* 7 4K sectors */
++#define CONFIG_SYS_ENV_ADDR 0x10007000
++#define CONFIG_SYS_ENV_SIZE 0x1000 /* 4K */
++
++#define CONFIG_U_BOOT_BASE 0x10008000
++#define CONFIG_U_BOOT_SIZE (10 * 0x1000) /* 10 4K sectors */
++
++#define CONFIG_MAX_FLASH_SECT 135
++#define CONFIG_MAX_FLASH_BANKS 1
++#define CONFIG_FLASH_ERASE_TOUT 120000
++#define CONFIG_FLASH_WRITE_TOUT 500
++#define CONFIG_USE_BUFFER_WRITE 1
++
++#undef CONFIG_ENV_IS_IN_NVRAM
++#undef CONFIG_ENV_IS_IN_EEPROM
++#undef CONFIG_ENV_IS_IN_FLASH
++#undef CONFIG_ENV_IS_IN_DATAFLASH
++#undef CONFIG_ENV_IS_IN_NAND
++#undef CONFIG_ENV_IS_IN_ONENAND
++
++#define CONFIG_ENV_IS_NOWHERE 1
++
++#define PHYS_FLASH_1 CONFIG_FLASH_BASE
++
++/* NOR flash - no real flash on this board */
++#define CONFIG_SYS_NO_FLASH 1
++#define CONFIG_SYS_MAX_FLASH_SECT 16
++#define CONFIG_SYS_MAX_FLASH_BANKS 1
++#define CONFIG_SYS_BOOT_SIZE 16384
++#define CONFIG_SYS_U_BOOT_BASE 0x00000000
++#define CONFIG_SYS_FLASH_ERASE_TOUT 10
++
++/* Ethernet */
++
++#define CONFIG_MACB 1
++#define CONFIG_RMII 1
++#define CONFIG_NET_MULTI 1
++#define CONFIG_NET_RETRY_COUNT 20
++#define CONFIG_RESET_PHY_R 1
++#define CONFIG_ETHADDR 00:11:22:33:AA:BB
++#define CONFIG_IPADDR 172.16.1.187
++#define CONFIG_NETMASK 255.255.0.0
++#define CONFIG_HOSTNAME D940DEB
++#define CONFIG_SERVERIP 172.16.1.30
++#define CONFIG_BOOTFILE d940deb.bin
++
++/* USB */
++#define CONFIG_USBH 1
++#define CONFIG_USB_OHCI_NEW 1
++#define LITTLEENDIAN 1
++#define CONFIG_DOS_PARTITION 1
++#define CONFIG_SYS_USB_OHCI_CPU_INIT 1
++#define CONFIG_SYS_USB_OHCI_REGS_BASE 0x00500000 /* AT572D940_UHP_BASE */
++#define CONFIG_SYS_USB_OHCI_SLOT_NAME "at572d940"
++#define CONFIG_SYS_USB_OHCI_MAX_ROOT_PORTS 2
++#define CONFIG_SYS_USB_STORAGE 1
++
++#define CONFIG_SYS_LOAD_ADDR 0x22000000 /* load address */
++
++#define CONFIG_SYS_MEMTEST_START PHYS_SDRAM
++#define CONFIG_SYS_MEMTEST_END 0x23e00000
++
++#undef CONFIG_USE_DATAFLASH_CS0
++#undef CONFIG_USE_DATAFLASH_CS1
++#undef CONFIG_USE_NANDFLASH
++#define CONFIG_USE_SD 1
++
++#ifdef CONFIG_USE_DATAFLASH_CS0
++
++/* bootstrap + u-boot + env + linux in dataflash on CS0 */
++#define CONFIG_ENV_IS_IN_DATAFLASH 1
++#define CONFIG_SYS_MONITOR_BASE (CONFIG_DATAFLASH_LOGIC_ADDR_CS0 + 0x8400)
++#define CONFIG_ENV_OFFSET 0x4200
++#define CONFIG_ENV_ADDR (CONFIG_DATAFLASH_LOGIC_ADDR_CS0 + CONFIG_ENV_OFFSET)
++#define CONFIG_ENV_SIZE 0x4200
++#define CONFIG_BOOTCOMMAND "cp.b 0xC003DE00 0x22000000 0x200040; bootm"
++
++#elif CONFIG_USE_DATAFLASH_CS1
++
++/* bootstrap + u-boot + env + linux in dataflash on CS1 */
++#define CONFIG_ENV_IS_IN_DATAFLASH 1
++#define CONFIG_MONITOR_BASE (CONFIG_DATAFLASH_LOGIC_ADDR_CS1 + 0x8400)
++#define CONFIG_ENV_OFFSET 0x4200
++#define CONFIG_ENV_ADDR (CONFIG_DATAFLASH_LOGIC_ADDR_CS1 + CONFIG_ENV_OFFSET)
++#define CONFIG_ENV_SIZE 0x4200
++#define CONFIG_BOOTCOMMAND "cp.b 0xD003DE00 0x22000000 0x200040; bootm"
++
++#elif CONFIG_USE_NANDFLASH
++
++/* bootstrap + u-boot + env + linux in nandflash */
++#define CONFIG_ENV_IS_IN_NAND 1
++#define CONFIG_ENV_OFFSET 0x60000
++#define CONFIG_ENV_OFFSET_REDUND 0x80000
++#define CONFIG_ENV_SIZE 0x20000 /* 1 sector = 128 kB */
++#define CONFIG_BOOTCOMMAND "nand read 0x22000000 0xA0000 0x200000; bootm"
++
++#elif CONFIG_USE_SD
++//#define CONFIG_ENV_IS_IN_DATAFLASH 1
++#define CONFIG_MONITOR_BASE (CONFIG_DATAFLASH_LOGIC_ADDR_CS1 + 0x8400)
++#define CONFIG_ENV_OFFSET 0x4200
++#define CONFIG_ENV_ADDR (CONFIG_DATAFLASH_LOGIC_ADDR_CS1 + CONFIG_ENV_OFFSET)
++#define CONFIG_ENV_SIZE 0x4200
++
++#define CONFIG_MMC 1
++#define CONFIG_SD_CARD_BOOT 1
++
++//#define CONFIG_MMC_CLK_OD 1500000
++//#define CONFIG_MMC_CLK_PP 1500000
++#define CONFIG_MMC_CLK_OD 20000000
++#define CONFIG_MMC_CLK_PP 20000000
++#define CONFIG_MMC_OP_COND (0x401f8000) /* SDHC + voltage rage 2.7-3.3 */
++
++#define CONFIG_BOOTCOMMAND "mmcinit; fatload mmc 0:1 0x21400000 uLinux.img; fatload mmc 0:1 0x21100000 initrd.img; bootm 0x21400000"
++#else
++#define CONFIG_ENV_SIZE 0x1000
++
++#endif
++
++#define CONFIG_BAUDRATE 115200
++#define CONFIG_SYS_BAUDRATE_TABLE {115200 , 19200, 38400, 57600, 9600 }
++
++#define CONFIG_SYS_PROMPT "Diopsis U-Boot> "
++#define CONFIG_SYS_CBSIZE 256
++#define CONFIG_SYS_MAXARGS 16
++#define CONFIG_SYS_PBSIZE (CONFIG_SYS_CBSIZE + sizeof(CONFIG_SYS_PROMPT) + 16)
++#define CONFIG_SYS_LONGHELP 1
++#define CONFIG_CMDLINE_EDITING 1
++
++#define ROUND(A, B) (((A) + (B)) & ~((B) - 1))
++/*
++ * Size of malloc() pool
++ */
++#define CONFIG_SYS_MALLOC_LEN ROUND(3 * CONFIG_ENV_SIZE + 128*1024, 0x1000)
++#define CONFIG_SYS_GBL_DATA_SIZE 128 /* 128 bytes for initial data */
++
++#define CONFIG_STACKSIZE (32*1024) /* regular stack */
++
++#ifdef CONFIG_USE_IRQ
++#define CONFIG_STACKSIZE_IRQ 4096
++#define CONFIG_STACKSIZE_FIQ 4096
++//#error CONFIG_USE_IRQ not supported
++#endif
++
++#endif
++
+diff -urN u-boot-2009.01-rc1-0rig//Makefile u-boot-2009.01-rc1/Makefile
+--- u-boot-2009.01-rc1-0rig//Makefile 2009-01-04 22:02:22.000000000 +0100
++++ u-boot-2009.01-rc1/Makefile 2009-01-04 22:02:50.000000000 +0100
+@@ -2702,6 +2702,12 @@
+ @$(MKCONFIG) -a at91sam9rlek arm arm926ejs at91sam9rlek atmel at91
+
+ ########################################################################
++# AT572D940HF
++########################################################################
++#
++at572d940hfeb_config : unconfig
++ @$(MKCONFIG) $(@:_config=) arm arm926ejs at572d940hfeb atmel at572d940hf
++
+ ## ARM Integrator boards - see doc/README-integrator for more info.
+ integratorap_config \
+ ap_config \
diff --git a/target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-016-cmd_mem.patch b/target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-016-cmd_mem.patch
new file mode 100644
index 000000000..bac2f935f
--- /dev/null
+++ b/target/u-boot/2009.01-rc1/u-boot-2009.01-rc1-016-cmd_mem.patch
@@ -0,0 +1,412 @@
+diff -urN u-boot-2009.01-0rig//common/cmd_mem.c u-boot-2009.01/common/cmd_mem.c
+--- u-boot-2009.01-0rig//common/cmd_mem.c 2008-12-16 23:48:27.000000000 +0100
++++ u-boot-2009.01/common/cmd_mem.c 2009-01-04 13:27:03.000000000 +0100
+@@ -37,11 +37,120 @@
+ #endif
+ #include <watchdog.h>
+
++#include <flash.h>
++#ifdef CONFIG_SYS_NO_FLASH
++#define in_flash(x) 0
++#else
++#define in_flash(x) (addr2info(x)!=NULL)
++#endif
++
++#ifdef CONFIG_HAS_DATAFLASH
++#define in_dataflash(x) addr_dataflash(x)
++#else
++#define in_dataflash(x) 0
++#endif
++
++#ifdef CONFIG_CMD_MMC
++#define in_SD_card(x) (mmc2info(x) != 0)
++#else
++#define in_SD_card(x) 0
++#endif
++
++
+ #ifdef CMD_MEM_DEBUG
+ #define PRINTF(fmt,args...) printf (fmt ,##args)
+ #else
+ #define PRINTF(fmt,args...)
+ #endif
++#if defined(CONFIG_HAS_DATAFLASH)
++#define DF_PAGE_VALID 0x01
++#define CONFIG_SYS_DATAFLASH_PAGE_SIZE 1056
++typedef char dfpagebuf[CONFIG_SYS_DATAFLASH_PAGE_SIZE];
++dfpagebuf dfcache[3]; // Cache buffers for dataflash
++unsigned char dfvalid[3]; // if DF_PAGE_VALID is set, then the, cache buffer contents are valid
++unsigned char dflru[3]; // Least recently used algorithm to determine which buffer to reuse
++unsigned int dfpage[3]; // TLB for cache, tells which page is loaded into dfcache
++
++
++void flush_mem_cache(void)
++{
++ dfvalid[0] = dfvalid[1] = dfvalid[2] = 0;
++ dflru[0] = 0;
++ dflru[1] = 1;
++ dflru[2] = 2;
++}
++
++typedef union {
++ uchar byte[4];
++ ulong word;
++} reg;
++
++unsigned int replace(char *p, unsigned int data)
++{
++ ulong i;
++ reg in;
++ reg out;
++
++ in.word = data;
++ for(i = 0; i <= 3; i++) {
++ out.byte[0] = *p;
++ *p++ = in.byte[0];
++ }
++ return out.word;
++}
++
++ulong translate(unsigned int addr)
++{
++ unsigned int page = (addr) / CONFIG_SYS_DATAFLASH_PAGE_SIZE;
++ unsigned int index = (addr) - (page * CONFIG_SYS_DATAFLASH_PAGE_SIZE);
++ unsigned int i,rc;
++ for(i = 0; i < 2; i++) {
++ if((page == dfpage[i]) && (dfvalid[i] & DF_PAGE_VALID)) {
++ if(dflru[0] == i) {
++ // nothing
++ } else if(dflru[1] == i) {
++ // swap with 0
++ dflru[1] = dflru[0];
++ dflru[0] = i;
++ } else {
++ // shift down
++ dflru[2] = dflru[1];
++ dflru[1] = dflru[0];
++ dflru[0] = i;
++ }
++ return (unsigned int) &dfcache[i][index];
++ }
++ }
++ // not found
++ // use buffer found in dflru[2]
++ i = dflru[2];
++ if ((rc = read_dataflash(addr, CONFIG_SYS_DATAFLASH_PAGE_SIZE, dfcache[i])) == DATAFLASH_OK){
++ dflru[2] = dflru[1];
++ dflru[1] = dflru[0];
++ dflru[0] = i;
++ dfvalid[i] |= DF_PAGE_VALID;
++ return (unsigned int) &dfcache[i][index];
++ }
++ return 0;
++}
++
++
++
++void df_writed(unsigned char *ldest, ulong laddr)
++{
++
++}
++void df_writew(unsigned char *ldest,ushort laddr) {}
++void df_writeb(unsigned char *ldest, u_char laddr) {}
++#endif
++
++#if defined(CONFIG_HAS_DATAFLASH)
++void flush_mem_cache(void);
++ulong translate(unsigned int addr);
++#else
++#define flush_mem_cache(x)
++#define translate(x) x
++#endif
+
+ static int mod_mem(cmd_tbl_t *, int, int, int, char *[]);
+
+@@ -67,7 +176,8 @@
+ ulong nbytes, linebytes;
+ #endif
+ int size;
+- int rc = 0;
++ int rc = 0;
++ int done = 0;
+
+ /* We use the last specified parameters, unless new ones are
+ * entered.
+@@ -106,26 +216,29 @@
+ * We buffer all read data, so we can make sure data is read only
+ * once, and all accesses are with the specified bus width.
+ */
+- nbytes = length * size;
+- do {
+- char linebuf[DISP_LINE_LEN];
+- void* p;
+- linebytes = (nbytes>DISP_LINE_LEN)?DISP_LINE_LEN:nbytes;
+-
+- rc = read_dataflash(addr, (linebytes/size)*size, linebuf);
+- p = (rc == DATAFLASH_OK) ? linebuf : (void*)addr;
+- print_buffer(addr, p, size, linebytes/size, DISP_LINE_LEN/size);
+-
+- nbytes -= linebytes;
+- addr += linebytes;
+- if (ctrlc()) {
+- rc = 1;
+- break;
+- }
+- } while (nbytes > 0);
+-#else
++ if(in_dataflash(addr)) {
++ nbytes = length * size;
++ do {
++ char linebuf[DISP_LINE_LEN];
++ void* p;
++ linebytes = (nbytes>DISP_LINE_LEN)?DISP_LINE_LEN:nbytes;
++
++ rc = read_dataflash(addr, (linebytes/size)*size, linebuf);
++ p = (rc == DATAFLASH_OK) ? linebuf : (void*)addr;
++ print_buffer(addr, p, size, linebytes/size, DISP_LINE_LEN/size);
++
++ nbytes -= linebytes;
++ addr += linebytes;
++ if (ctrlc()) {
++ rc = 1;
++ break;
++ }
++ } while (nbytes > 0);
++ done = 1;
++ }
++#endif
+
+-# if defined(CONFIG_BLACKFIN)
++#if defined(CONFIG_BLACKFIN)
+ /* See if we're trying to display L1 inst */
+ if (addr_bfin_on_chip_mem(addr)) {
+ char linebuf[DISP_LINE_LEN];
+@@ -142,15 +255,15 @@
+ break;
+ }
+ } while (nbytes > 0);
+- } else
+-# endif
++ done = 1;
++ }
++#endif
+
+- {
++ if (!done) {
+ /* Print the lines. */
+ print_buffer(addr, (void*)addr, size, length, DISP_LINE_LEN/size);
+ addr += size*length;
+ }
+-#endif
+
+ dp_last_addr = addr;
+ dp_last_length = length;
+@@ -273,6 +386,8 @@
+ int do_mem_cmp (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
+ {
+ ulong addr1, addr2, count, ngood;
++ ulong laddr1, laddr2;
++
+ int size;
+ int rcode = 0;
+
+@@ -294,12 +409,6 @@
+
+ count = simple_strtoul(argv[3], NULL, 16);
+
+-#ifdef CONFIG_HAS_DATAFLASH
+- if (addr_dataflash(addr1) | addr_dataflash(addr2)){
+- puts ("Comparison with DataFlash space not supported.\n\r");
+- return 0;
+- }
+-#endif
+
+ #ifdef CONFIG_BLACKFIN
+ if (addr_bfin_on_chip_mem(addr1) || addr_bfin_on_chip_mem(addr2)) {
+@@ -308,9 +417,12 @@
+ }
+ #endif
+
++ flush_mem_cache();
+ ngood = 0;
+
+ while (count-- > 0) {
++ laddr1 = translate((ulong) addr1);
++ laddr2 = translate((ulong) addr2);
+ if (size == 4) {
+ ulong word1 = *(ulong *)addr1;
+ ulong word2 = *(ulong *)addr2;
+@@ -359,6 +471,14 @@
+ {
+ ulong addr, dest, count;
+ int size;
++#ifdef CONFIG_HAS_DATAFLASH
++ int rc;
++ unsigned int crc,oldcrc,use_crc;
++ unsigned int olddata;
++ char *p;
++ char *env_crc_check;
++
++#endif
+
+ if (argc != 4) {
+ printf ("Usage:\n%s\n", cmdtp->usage);
+@@ -385,13 +505,14 @@
+
+ #ifndef CONFIG_SYS_NO_FLASH
+ /* check if we are copying to Flash */
+- if ( (addr2info(dest) != NULL)
+-#ifdef CONFIG_HAS_DATAFLASH
+- && (!addr_dataflash(dest))
+-#endif
+- ) {
++ if (in_flash(dest)) {
+ int rc;
+-
++#if defined(CONFIG_HAS_DATAFLASH) || defined(CONFIG_CMD_MMC)
++ if(in_dataflash(addr) || in_SD_card(addr)) {
++ puts ("Cannot copy to flash from storage...\n");
++ return 1;
++ }
++#endif
+ puts ("Copy to Flash... ");
+
+ rc = flash_write ((char *)addr, dest, count*size);
+@@ -405,9 +526,15 @@
+ #endif
+
+ #if defined(CONFIG_CMD_MMC)
+- if (mmc2info(dest)) {
++ if (in_SD_card(dest)) {
+ int rc;
+
++#if defined(CONFIG_HAS_DATAFLASH)
++ if(in_dataflash(addr) || in_SD_card(addr)) {
++ puts ("Cannot copy to flash-card from another storage location...\n");
++ return 1;
++ }
++#endif
+ puts ("Copy to MMC... ");
+ switch (rc = mmc_write ((uchar *)addr, dest, count*size)) {
+ case 0:
+@@ -424,9 +551,12 @@
+ return 0;
+ }
+
+- if (mmc2info(addr)) {
++ if (in_SD_card(addr)) {
+ int rc;
+-
++ if(in_flash(dest) || in_dataflash(dest) || in_SD_card(dest)) {
++ puts ("Cannot copy from flash-card from another storage location...\n");
++ return 1;
++ }
+ puts ("Copy from MMC... ");
+ switch (rc = mmc_read (addr, (uchar *)dest, count*size)) {
+ case 0:
+@@ -445,39 +575,64 @@
+ #endif
+
+ #ifdef CONFIG_HAS_DATAFLASH
+- /* Check if we are copying from RAM or Flash to DataFlash */
+- if (addr_dataflash(dest) && !addr_dataflash(addr)){
+- int rc;
+-
+- puts ("Copy to DataFlash... ");
+-
+- rc = write_dataflash (dest, addr, count*size);
+-
++ /* Check if we are copying from Dataflash to RAM */
++ /* Note: Cannot copy from Dataflash to Flash directly */
++ env_crc_check = getenv("crc-check");
++ use_crc = (strcmp(env_crc_check, "on") == 0);
++ if (in_dataflash(addr)) {
++ if(in_dataflash(dest) || in_flash(dest) || in_SD_card(dest)) {
++ puts ("Cannot copy to dataflash from another storage location...\n");
++ return 1;
++ }
++ puts ("Copy from DataFlash...");
++ rc = read_dataflash(addr, count * size, (char *) dest);
+ if (rc != 1) {
+ dataflash_perror (rc);
+ return (1);
+ }
+- puts ("done\n");
+- return 0;
+- }
+
+- /* Check if we are copying from DataFlash to RAM */
+- if (addr_dataflash(addr) && !addr_dataflash(dest)
+-#ifndef CONFIG_SYS_NO_FLASH
+- && (addr2info(dest) == NULL)
+-#endif
+- ){
+- int rc;
+- rc = read_dataflash(addr, count * size, (char *) dest);
++ if (use_crc) {
++ puts ("(Calculating CRC) ... ");
++ p = (char *) dest + (count * size) + 3;
++ olddata = replace(p,0);
++ rc = read_dataflash(addr, (count * size)+4, (char *) dest);
++ oldcrc = replace(p,olddata);
++ crc = crc32 (0, (const uchar *) dest, count*size);
++ if(crc != oldcrc) {
++ printf("\n\rBad CRC, %x expected, found %x... \n\r",oldcrc,crc);
++ return 1;
++ } else {
++ printf("[0x%x]",crc);
++ }
++ }
++ puts ("done\n\r");
++ return 0;
++ } else if (!in_dataflash(addr) && in_dataflash(dest)) {
++ if(in_dataflash(addr) || in_SD_card(addr)) {
++ puts ("Cannot copy to dataflash from another storage location...\n");
++ return 1;
++ }
++ puts ("Copy to DataFlash... ");
++ if (use_crc) {
++ puts ("(Calulating CRC) ... ");
++ crc = crc32 (0, (const uchar *) addr, count*size);
++ // Save CRC in small endian format
++ printf("= 0x%08x written to [%08x] ... ",crc,(unsigned int) (dest + count * size));
++ p = (char *) addr+(count*size);
++ olddata = replace(p,crc);
++ rc = write_dataflash (dest, addr, count*size+4);
++ crc = replace((char *) addr+(count*size),olddata);
++ } else {
++ rc = write_dataflash (dest, addr, count*size);
++ }
+ if (rc != 1) {
+ dataflash_perror (rc);
+ return (1);
+ }
++ puts ("done\n");
+ return 0;
+- }
+-
+- if (addr_dataflash(addr) && addr_dataflash(dest)){
+- puts ("Unsupported combination of source/destination.\n\r");
++ } else if (in_dataflash(addr) && in_dataflash(dest)){
++ puts ("Cannot copy between two dataflash areas\n\r");
+ return 1;
+ }
+ #endif
+@@ -490,6 +645,7 @@
+ }
+ #endif
+
++ /* Copy between RAM locations, or parallell flash to RAM */
+ while (count-- > 0) {
+ if (size == 4)
+ *((ulong *)dest) = *((ulong *)addr);
+@@ -1011,7 +1167,7 @@
+ }
+
+ #ifdef CONFIG_HAS_DATAFLASH
+- if (addr_dataflash(addr)){
++ if (in_dataflash(addr)){
+ puts ("Can't modify DataFlash in place. Use cp instead.\n\r");
+ return 0;
+ }
+