Add qemu 2.4.0
[kvmfornfv.git] / qemu / roms / u-boot / board / BuS / eb_cpux9k2 / cpux9k2.c
diff --git a/qemu/roms/u-boot/board/BuS/eb_cpux9k2/cpux9k2.c b/qemu/roms/u-boot/board/BuS/eb_cpux9k2/cpux9k2.c
new file mode 100644 (file)
index 0000000..5e4778e
--- /dev/null
@@ -0,0 +1,373 @@
+/*
+ * (C) Copyright 2008-2009
+ * BuS Elektronik GmbH & Co. KG <www.bus-elektronik.de>
+ * Jens Scharsig <esw@bus-elektronik.de>
+ *
+ * SPDX-License-Identifier:    GPL-2.0+
+ */
+
+#include <common.h>
+#include <exports.h>
+#include <net.h>
+#include <netdev.h>
+#include <nand.h>
+
+#include <asm/io.h>
+#include <asm/arch/hardware.h>
+#include <asm/arch/at91_pio.h>
+#include <asm/arch/at91_pmc.h>
+#include <asm/arch/at91_mc.h>
+#include <asm/arch/at91_common.h>
+
+#ifdef CONFIG_STATUS_LED
+#include <status_led.h>
+#endif
+
+#ifdef CONFIG_VIDEO
+#include <bus_vcxk.h>
+
+extern unsigned long display_width;
+extern unsigned long display_height;
+#endif
+
+#ifdef CONFIG_CMD_NAND
+void cpux9k2_nand_hw_init(void);
+#endif
+
+DECLARE_GLOBAL_DATA_PTR;
+
+/*
+ * Miscelaneous platform dependent initialisations
+ */
+
+int board_init(void)
+{
+       at91_pio_t *pio = (at91_pio_t *) ATMEL_BASE_PIO;
+
+       /* Correct IRDA resistor problem / Set PA23_TXD in Output */
+       writel(ATMEL_PMX_AA_TXD2, &pio->pioa.oer);
+
+       gd->bd->bi_arch_number = MACH_TYPE_EB_CPUX9K2;
+       /* adress of boot parameters */
+       gd->bd->bi_boot_params = CONFIG_SYS_SDRAM_BASE + 0x100;
+
+#ifdef CONFIG_STATUS_LED
+       status_led_set(STATUS_LED_BOOT, STATUS_LED_ON);
+#endif
+#ifdef CONFIG_CMD_NAND
+       cpux9k2_nand_hw_init();
+#endif
+       return 0;
+}
+
+int board_early_init_f(void)
+{
+       at91_seriald_hw_init();
+       return 0;
+}
+
+#ifdef CONFIG_MISC_INIT_R
+
+int misc_init_r(void)
+{
+       uchar   mac[8];
+       uchar   tm;
+       uchar   midx;
+       uchar   macn6, macn7;
+
+       if (getenv("ethaddr") == NULL) {
+               if (i2c_read(CONFIG_SYS_I2C_EEPROM_ADDR, 0x00,
+                               CONFIG_SYS_I2C_EEPROM_ADDR_LEN,
+                               (uchar *) &mac, sizeof(mac)) != 0) {
+                       puts("Error reading MAC from EEPROM\n");
+               } else {
+                       tm = 0;
+                       macn6 = 0;
+                       macn7 = 0xFF;
+                       for (midx = 0; midx < 6; midx++) {
+                               if ((mac[midx] != 0) && (mac[midx] != 0xFF))
+                                       tm++;
+                               macn6 += mac[midx];
+                               macn7 ^= mac[midx];
+                       }
+                       if ((macn6 != mac[6]) || (macn7 != mac[7]))
+                               tm = 0;
+                       if (tm)
+                               eth_setenv_enetaddr("ethaddr", mac);
+                        else
+                               puts("Error: invalid MAC at EEPROM\n");
+               }
+       }
+       gd->jt[XF_do_reset] = (void *) do_reset;
+
+#ifdef CONFIG_STATUS_LED
+       status_led_set(STATUS_LED_BOOT, STATUS_LED_BLINKING);
+#endif
+       return 0;
+}
+#endif
+
+#ifdef CONFIG_RESET_PHY_R
+void reset_phy(void)
+{
+       udelay(10000);
+       eth_init(gd->bd);
+}
+#endif
+
+/*
+ * DRAM initialisations
+ */
+
+int dram_init(void)
+{
+       gd->ram_size = get_ram_size((long *)CONFIG_SYS_SDRAM_BASE,
+                       CONFIG_SYS_SDRAM_SIZE);
+       return 0;
+}
+
+/*
+ * Ethernet initialisations
+ */
+
+#ifdef CONFIG_DRIVER_AT91EMAC
+int board_eth_init(bd_t *bis)
+{
+       int rc = 0;
+       rc = at91emac_register(bis, (u32) ATMEL_BASE_EMAC);
+       return rc;
+}
+#endif
+
+/*
+ * Disk On Chip (NAND) Millenium initialization.
+ * The NAND lives in the CS2* space
+ */
+#if defined(CONFIG_CMD_NAND)
+
+#define        MASK_ALE        (1 << 22)       /* our ALE is AD22 */
+#define        MASK_CLE        (1 << 21)       /* our CLE is AD21 */
+
+void cpux9k2_nand_hw_init(void)
+{
+       unsigned long csr;
+       at91_pio_t *pio = (at91_pio_t *) ATMEL_BASE_PIO;
+       at91_pmc_t *pmc = (at91_pmc_t *) ATMEL_BASE_PMC;
+       at91_mc_t *mc = (at91_mc_t *) ATMEL_BASE_MC;
+
+       /* Setup Smart Media, fitst enable the address range of CS3 */
+       writel(readl(&mc->ebi.csa) | AT91_EBI_CSA_CS3A, &mc->ebi.csa);
+
+       /* RWH = 1 | RWS = 0 | TDF = 1 | NWS = 3 */
+       csr =   AT91_SMC_CSR_RWHOLD(1) | AT91_SMC_CSR_TDF(1) |
+               AT91_SMC_CSR_NWS(3) |
+               AT91_SMC_CSR_ACSS_STANDARD | AT91_SMC_CSR_DBW_8 |
+               AT91_SMC_CSR_WSEN;
+       writel(csr, &mc->smc.csr[3]);
+
+       writel(ATMEL_PMX_CA_SMOE | ATMEL_PMX_CA_SMWE, &pio->pioc.asr);
+       writel(ATMEL_PMX_CA_BFCK | ATMEL_PMX_CA_SMOE | ATMEL_PMX_CA_SMWE,
+               &pio->pioc.pdr);
+
+       /* Configure PC2 as input (signal Nand READY ) */
+       writel(ATMEL_PMX_CA_BFAVD, &pio->pioc.per);
+       writel(ATMEL_PMX_CA_BFAVD, &pio->pioc.odr); /* disable output */
+       writel(ATMEL_PMX_CA_BFCK, &pio->pioc.codr);
+
+       /* PIOC clock enabling */
+       writel(1 << ATMEL_ID_PIOC, &pmc->pcer);
+}
+
+static void board_nand_hwcontrol(struct mtd_info *mtd,
+       int cmd, unsigned int ctrl)
+{
+       at91_pio_t *pio = (at91_pio_t *) ATMEL_BASE_PIO;
+       struct nand_chip *this = mtd->priv;
+       ulong IO_ADDR_W = (ulong) this->IO_ADDR_W;
+
+       if (ctrl & NAND_CTRL_CHANGE) {
+               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;
+
+               if ((ctrl & NAND_NCE))
+                       writel(1, &pio->pioc.codr);
+               else
+                       writel(1, &pio->pioc.sodr);
+
+               this->IO_ADDR_W = (void *) IO_ADDR_W;
+       }
+       if (cmd != NAND_CMD_NONE)
+               writeb(cmd, this->IO_ADDR_W);
+}
+
+static int board_nand_dev_ready(struct mtd_info *mtd)
+{
+       at91_pio_t *pio = (at91_pio_t *) ATMEL_BASE_PIO;
+       return ((readl(&pio->pioc.pdsr) & (1 << 2)) != 0);
+}
+
+int board_nand_init(struct nand_chip *nand)
+{
+       cpux9k2_nand_hw_init();
+       nand->ecc.mode = NAND_ECC_SOFT;
+       nand->cmd_ctrl = board_nand_hwcontrol;
+       nand->dev_ready = board_nand_dev_ready;
+       nand->chip_delay = 20;
+       return 0;
+}
+
+#endif
+
+#if defined(CONFIG_VIDEO)
+/*
+ * drv_video_init
+ * FUNCTION: initialize VCxK device
+ */
+
+int drv_video_init(void)
+{
+#ifdef CONFIG_SPLASH_SCREEN
+       unsigned long splash;
+#endif
+       char *s;
+       unsigned long csr;
+       at91_pmc_t *pmc = (at91_pmc_t *) ATMEL_BASE_PMC;
+       at91_mc_t *mc = (at91_mc_t *) ATMEL_BASE_MC;
+
+       printf("Init Video as ");
+       s = getenv("displaywidth");
+       if (s != NULL)
+               display_width = simple_strtoul(s, NULL, 10);
+       else
+               display_width = 256;
+       s = getenv("displayheight");
+       if (s != NULL)
+               display_height = simple_strtoul(s, NULL, 10);
+       else
+               display_height = 256;
+       printf("%ld x %ld pixel matrix\n", display_width, display_height);
+
+       /* RWH = 2 | RWS =2  | TDF = 4 | NWS = 0x6 */
+       csr =   AT91_SMC_CSR_RWHOLD(2) | AT91_SMC_CSR_RWSETUP(2) |
+               AT91_SMC_CSR_TDF(4) | AT91_SMC_CSR_NWS(6) |
+               AT91_SMC_CSR_ACSS_STANDARD | AT91_SMC_CSR_DBW_16 |
+               AT91_SMC_CSR_BAT_16 | AT91_SMC_CSR_WSEN;
+       writel(csr, &mc->smc.csr[2]);
+       writel(1 << ATMEL_ID_PIOB, &pmc->pcer);
+
+       vcxk_init(display_width, display_height);
+#ifdef CONFIG_SPLASH_SCREEN
+       s = getenv("splashimage");
+       if (s != NULL) {
+               splash = simple_strtoul(s, NULL, 16);
+               printf("use splashimage: %lx\n", splash);
+               video_display_bitmap(splash, 0, 0);
+       }
+#endif
+       return 0;
+}
+#endif
+
+#ifdef CONFIG_SYS_I2C_SOFT
+
+void i2c_init_board(void)
+{
+       u32 pin;
+       at91_pmc_t *pmc = (at91_pmc_t *) ATMEL_BASE_PMC;
+       at91_pio_t *pio = (at91_pio_t *) ATMEL_BASE_PIO;
+
+       writel(1 << ATMEL_ID_PIOA, &pmc->pcer);
+       pin = ATMEL_PMX_AA_TWD | ATMEL_PMX_AA_TWCK;
+       writel(pin, &pio->pioa.idr);
+       writel(pin, &pio->pioa.pudr);
+       writel(pin, &pio->pioa.per);
+       writel(pin, &pio->pioa.oer);
+       writel(pin, &pio->pioa.sodr);
+}
+
+#endif
+
+/*--------------------------------------------------------------------------*/
+
+#ifdef CONFIG_STATUS_LED
+
+void __led_toggle(led_id_t mask)
+{
+       at91_pio_t *pio = (at91_pio_t *) ATMEL_BASE_PIO;
+
+       if (readl(&pio->piod.odsr) & mask)
+               writel(mask, &pio->piod.codr);
+       else
+               writel(mask, &pio->piod.codr);
+}
+
+void __led_init(led_id_t mask, int state)
+{
+       at91_pmc_t *pmc = (at91_pmc_t *) ATMEL_BASE_PMC;
+       at91_pio_t *pio = (at91_pio_t *) ATMEL_BASE_PIO;
+
+       writel(1 << ATMEL_ID_PIOD, &pmc->pcer); /* Enable PIOB clock */
+       /* Disable peripherals on LEDs */
+       writel(STATUS_LED_BIT | STATUS_LED_BIT1, &pio->piod.per);
+       /* Enable pins as outputs */
+       writel(STATUS_LED_BIT | STATUS_LED_BIT1, &pio->piod.oer);
+       /* Turn all LEDs OFF */
+       writel(STATUS_LED_BIT | STATUS_LED_BIT1, &pio->piod.sodr);
+
+       __led_set(mask, state);
+}
+
+void __led_set(led_id_t mask, int state)
+{
+       at91_pio_t *pio = (at91_pio_t *) ATMEL_BASE_PIO;
+       if (state == STATUS_LED_ON)
+               writel(mask, &pio->piod.codr);
+       else
+               writel(mask, &pio->piod.sodr);
+}
+
+#endif
+
+/*---------------------------------------------------------------------------*/
+
+int do_brightness(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
+{
+       int rcode = 0;
+       ulong side;
+       ulong bright;
+
+       switch (argc) {
+       case 3:
+               side = simple_strtoul(argv[1], NULL, 10);
+               bright = simple_strtoul(argv[2], NULL, 10);
+               if ((side >= 0) && (side <= 3) &&
+                               (bright >= 0) && (bright <= 1000)) {
+                       vcxk_setbrightness(side, bright);
+                       rcode = 0;
+               } else {
+                       printf("parameters out of range\n");
+                       printf("Usage:\n%s\n", cmdtp->usage);
+                       rcode = 1;
+               }
+               break;
+       default:
+               printf("Usage:\n%s\n", cmdtp->usage);
+               rcode = 1;
+               break;
+       }
+       return rcode;
+}
+
+/*---------------------------------------------------------------------------*/
+
+U_BOOT_CMD(
+       bright, 3,      0,      do_brightness,
+       "bright  - sets the display brightness\n",
+       " <side> <0..1000>\n        side: 0/3=both; 1=first; 2=second\n"
+);
+
+/* EOF cpu9k2.c */