10f8bc283SHeiko Schocher /* 20f8bc283SHeiko Schocher * Board functions for Siemens TAURUS (AT91SAM9G20) based boards 30f8bc283SHeiko Schocher * (C) Copyright Siemens AG 40f8bc283SHeiko Schocher * 50f8bc283SHeiko Schocher * Based on: 60f8bc283SHeiko Schocher * U-Boot file: board/atmel/at91sam9260ek/at91sam9260ek.c 70f8bc283SHeiko Schocher * 80f8bc283SHeiko Schocher * (C) Copyright 2007-2008 90f8bc283SHeiko Schocher * Stelian Pop <stelian@popies.net> 100f8bc283SHeiko Schocher * Lead Tech Design <www.leadtechdesign.com> 110f8bc283SHeiko Schocher * 120f8bc283SHeiko Schocher * SPDX-License-Identifier: GPL-2.0+ 130f8bc283SHeiko Schocher */ 140f8bc283SHeiko Schocher 1540540823SHeiko Schocher #include <command.h> 160f8bc283SHeiko Schocher #include <common.h> 170f8bc283SHeiko Schocher #include <asm/io.h> 180f8bc283SHeiko Schocher #include <asm/arch/at91sam9260_matrix.h> 190f8bc283SHeiko Schocher #include <asm/arch/at91sam9_smc.h> 200f8bc283SHeiko Schocher #include <asm/arch/at91_common.h> 210f8bc283SHeiko Schocher #include <asm/arch/at91_rstc.h> 220f8bc283SHeiko Schocher #include <asm/arch/gpio.h> 230f8bc283SHeiko Schocher #include <asm/arch/at91sam9_sdramc.h> 24237e3793SHeiko Schocher #include <asm/arch/clk.h> 25237e3793SHeiko Schocher #include <linux/mtd/nand.h> 260f8bc283SHeiko Schocher #include <atmel_mci.h> 2750921cdcSHeiko Schocher #include <asm/arch/at91_spi.h> 2850921cdcSHeiko Schocher #include <spi.h> 290f8bc283SHeiko Schocher 300f8bc283SHeiko Schocher #include <net.h> 310f8bc283SHeiko Schocher #include <netdev.h> 320f8bc283SHeiko Schocher 330f8bc283SHeiko Schocher DECLARE_GLOBAL_DATA_PTR; 340f8bc283SHeiko Schocher 350f8bc283SHeiko Schocher static void taurus_nand_hw_init(void) 360f8bc283SHeiko Schocher { 370f8bc283SHeiko Schocher struct at91_smc *smc = (struct at91_smc *)ATMEL_BASE_SMC; 380f8bc283SHeiko Schocher struct at91_matrix *matrix = (struct at91_matrix *)ATMEL_BASE_MATRIX; 390f8bc283SHeiko Schocher unsigned long csa; 400f8bc283SHeiko Schocher 410f8bc283SHeiko Schocher /* Assign CS3 to NAND/SmartMedia Interface */ 420f8bc283SHeiko Schocher csa = readl(&matrix->ebicsa); 430f8bc283SHeiko Schocher csa |= AT91_MATRIX_CS3A_SMC_SMARTMEDIA; 440f8bc283SHeiko Schocher writel(csa, &matrix->ebicsa); 450f8bc283SHeiko Schocher 460f8bc283SHeiko Schocher /* Configure SMC CS3 for NAND/SmartMedia */ 470f8bc283SHeiko Schocher writel(AT91_SMC_SETUP_NWE(2) | AT91_SMC_SETUP_NCS_WR(0) | 480f8bc283SHeiko Schocher AT91_SMC_SETUP_NRD(2) | AT91_SMC_SETUP_NCS_RD(0), 490f8bc283SHeiko Schocher &smc->cs[3].setup); 500f8bc283SHeiko Schocher writel(AT91_SMC_PULSE_NWE(4) | AT91_SMC_PULSE_NCS_WR(3) | 510f8bc283SHeiko Schocher AT91_SMC_PULSE_NRD(4) | AT91_SMC_PULSE_NCS_RD(3), 520f8bc283SHeiko Schocher &smc->cs[3].pulse); 530f8bc283SHeiko Schocher writel(AT91_SMC_CYCLE_NWE(7) | AT91_SMC_CYCLE_NRD(7), 540f8bc283SHeiko Schocher &smc->cs[3].cycle); 550f8bc283SHeiko Schocher writel(AT91_SMC_MODE_RM_NRD | AT91_SMC_MODE_WM_NWE | 560f8bc283SHeiko Schocher AT91_SMC_MODE_EXNW_DISABLE | 570f8bc283SHeiko Schocher AT91_SMC_MODE_DBW_8 | 580f8bc283SHeiko Schocher AT91_SMC_MODE_TDF_CYCLE(3), 590f8bc283SHeiko Schocher &smc->cs[3].mode); 600f8bc283SHeiko Schocher 610f8bc283SHeiko Schocher /* Configure RDY/BSY */ 620f8bc283SHeiko Schocher at91_set_gpio_input(CONFIG_SYS_NAND_READY_PIN, 1); 630f8bc283SHeiko Schocher 640f8bc283SHeiko Schocher /* Enable NandFlash */ 650f8bc283SHeiko Schocher at91_set_gpio_output(CONFIG_SYS_NAND_ENABLE_PIN, 1); 660f8bc283SHeiko Schocher } 67237e3793SHeiko Schocher 68237e3793SHeiko Schocher #if defined(CONFIG_SPL_BUILD) 69237e3793SHeiko Schocher #include <spl.h> 70237e3793SHeiko Schocher #include <nand.h> 71a1655bb2SHeiko Schocher #include <spi_flash.h> 72237e3793SHeiko Schocher 73237e3793SHeiko Schocher void matrix_init(void) 74237e3793SHeiko Schocher { 75237e3793SHeiko Schocher struct at91_matrix *mat = (struct at91_matrix *)ATMEL_BASE_MATRIX; 76237e3793SHeiko Schocher 77237e3793SHeiko Schocher writel((readl(&mat->scfg[3]) & (~AT91_MATRIX_SLOT_CYCLE)) 78237e3793SHeiko Schocher | AT91_MATRIX_SLOT_CYCLE_(0x40), 79237e3793SHeiko Schocher &mat->scfg[3]); 80237e3793SHeiko Schocher } 81237e3793SHeiko Schocher 8240540823SHeiko Schocher #if defined(CONFIG_BOARD_AXM) 8340540823SHeiko Schocher static int at91_is_recovery(void) 8440540823SHeiko Schocher { 8540540823SHeiko Schocher if ((at91_get_gpio_value(AT91_PIN_PA26) == 0) && 8640540823SHeiko Schocher (at91_get_gpio_value(AT91_PIN_PA27) == 0)) 8740540823SHeiko Schocher return 1; 8840540823SHeiko Schocher 8940540823SHeiko Schocher return 0; 9040540823SHeiko Schocher } 9140540823SHeiko Schocher #elif defined(CONFIG_BOARD_TAURUS) 9240540823SHeiko Schocher static int at91_is_recovery(void) 9340540823SHeiko Schocher { 9440540823SHeiko Schocher if (at91_get_gpio_value(AT91_PIN_PA31) == 0) 9540540823SHeiko Schocher return 1; 9640540823SHeiko Schocher 9740540823SHeiko Schocher return 0; 9840540823SHeiko Schocher } 9940540823SHeiko Schocher #endif 10040540823SHeiko Schocher 1010ed366ffSHeiko Schocher void spl_board_init(void) 102237e3793SHeiko Schocher { 103237e3793SHeiko Schocher taurus_nand_hw_init(); 104a1655bb2SHeiko Schocher at91_spi0_hw_init(TAURUS_SPI_MASK); 105237e3793SHeiko Schocher 10640540823SHeiko Schocher #if defined(CONFIG_BOARD_AXM) 10740540823SHeiko Schocher /* Configure LED PINs */ 10840540823SHeiko Schocher at91_set_gpio_output(AT91_PIN_PA6, 0); 10940540823SHeiko Schocher at91_set_gpio_output(AT91_PIN_PA8, 0); 11040540823SHeiko Schocher at91_set_gpio_output(AT91_PIN_PA9, 0); 11140540823SHeiko Schocher at91_set_gpio_output(AT91_PIN_PA10, 0); 11240540823SHeiko Schocher at91_set_gpio_output(AT91_PIN_PA11, 0); 11340540823SHeiko Schocher at91_set_gpio_output(AT91_PIN_PA12, 0); 114237e3793SHeiko Schocher 11540540823SHeiko Schocher /* Configure recovery button PINs */ 11640540823SHeiko Schocher at91_set_gpio_input(AT91_PIN_PA26, 1); 11740540823SHeiko Schocher at91_set_gpio_input(AT91_PIN_PA27, 1); 11840540823SHeiko Schocher #elif defined(CONFIG_BOARD_TAURUS) 11940540823SHeiko Schocher at91_set_gpio_input(AT91_PIN_PA31, 1); 12040540823SHeiko Schocher #endif 12140540823SHeiko Schocher 12240540823SHeiko Schocher /* check for recovery mode */ 12340540823SHeiko Schocher if (at91_is_recovery() == 1) { 124a1655bb2SHeiko Schocher struct spi_flash *flash; 125237e3793SHeiko Schocher 1260ed366ffSHeiko Schocher puts("Recovery button pressed\n"); 127237e3793SHeiko Schocher nand_init(); 128237e3793SHeiko Schocher spl_nand_erase_one(0, 0); 129a1655bb2SHeiko Schocher flash = spi_flash_probe(CONFIG_SF_DEFAULT_BUS, 130a1655bb2SHeiko Schocher 0, 131a1655bb2SHeiko Schocher CONFIG_SF_DEFAULT_SPEED, 1320ed366ffSHeiko Schocher CONFIG_SF_DEFAULT_MODE); 133a1655bb2SHeiko Schocher if (!flash) { 134a1655bb2SHeiko Schocher puts("no flash\n"); 135a1655bb2SHeiko Schocher } else { 136a1655bb2SHeiko Schocher puts("erase spi flash sector 0\n"); 137a1655bb2SHeiko Schocher spi_flash_erase(flash, 0, 138a1655bb2SHeiko Schocher CONFIG_SYS_NAND_U_BOOT_SIZE); 139237e3793SHeiko Schocher } 140237e3793SHeiko Schocher } 141237e3793SHeiko Schocher } 142237e3793SHeiko Schocher 14340540823SHeiko Schocher #define SDRAM_BASE_CONF (AT91_SDRAMC_NR_13 | AT91_SDRAMC_CAS_3 \ 14440540823SHeiko Schocher |AT91_SDRAMC_NB_4 | AT91_SDRAMC_DBW_32 \ 14540540823SHeiko Schocher | AT91_SDRAMC_TWR_VAL(3) | AT91_SDRAMC_TRC_VAL(9) \ 14640540823SHeiko Schocher | AT91_SDRAMC_TRP_VAL(3) | AT91_SDRAMC_TRCD_VAL(3) \ 14740540823SHeiko Schocher | AT91_SDRAMC_TRAS_VAL(6) | AT91_SDRAMC_TXSR_VAL(10)) 14840540823SHeiko Schocher 14940540823SHeiko Schocher void sdramc_configure(unsigned int mask) 150237e3793SHeiko Schocher { 151237e3793SHeiko Schocher struct at91_matrix *ma = (struct at91_matrix *)ATMEL_BASE_MATRIX; 152237e3793SHeiko Schocher struct sdramc_reg setting; 153237e3793SHeiko Schocher 154237e3793SHeiko Schocher at91_sdram_hw_init(); 15540540823SHeiko Schocher setting.cr = SDRAM_BASE_CONF | mask; 156237e3793SHeiko Schocher setting.mdr = AT91_SDRAMC_MD_SDRAM; 157237e3793SHeiko Schocher setting.tr = (CONFIG_SYS_MASTER_CLOCK * 7) / 1000000; 158237e3793SHeiko Schocher 159237e3793SHeiko Schocher writel(readl(&ma->ebicsa) | AT91_MATRIX_CS1A_SDRAMC | 160237e3793SHeiko Schocher AT91_MATRIX_VDDIOMSEL_3_3V | AT91_MATRIX_EBI_IOSR_SEL, 161237e3793SHeiko Schocher &ma->ebicsa); 16240540823SHeiko Schocher 163237e3793SHeiko Schocher sdramc_initialize(ATMEL_BASE_CS1, &setting); 164237e3793SHeiko Schocher } 16540540823SHeiko Schocher 16640540823SHeiko Schocher void mem_init(void) 16740540823SHeiko Schocher { 16840540823SHeiko Schocher unsigned int ram_size = 0; 16940540823SHeiko Schocher 17040540823SHeiko Schocher /* Configure SDRAM for 128MB */ 17140540823SHeiko Schocher sdramc_configure(AT91_SDRAMC_NC_10); 17240540823SHeiko Schocher 17340540823SHeiko Schocher /* Do memtest for 128MB */ 17440540823SHeiko Schocher ram_size = get_ram_size((void *)CONFIG_SYS_SDRAM_BASE, 17540540823SHeiko Schocher CONFIG_SYS_SDRAM_SIZE); 17640540823SHeiko Schocher 17740540823SHeiko Schocher /* 17840540823SHeiko Schocher * If 32MB or 16MB should be supported check also for 17940540823SHeiko Schocher * expected mirroring at A16 and A17 18040540823SHeiko Schocher * To find mirror addresses depends how the collumns are connected 18140540823SHeiko Schocher * at RAM (internaly or externaly) 18240540823SHeiko Schocher * If the collumns are not in inverted order the mirror size effect 18340540823SHeiko Schocher * behaves like normal SRAM with A0,A1,A2,etc. connected incremantal 18440540823SHeiko Schocher */ 18540540823SHeiko Schocher 18640540823SHeiko Schocher /* Mirrors at A15 on ATMEL G20 SDRAM Controller with 64MB*/ 18740540823SHeiko Schocher if (ram_size == 0x800) { 18840540823SHeiko Schocher printf("\n\r 64MB"); 18940540823SHeiko Schocher sdramc_configure(AT91_SDRAMC_NC_9); 19040540823SHeiko Schocher } else { 19140540823SHeiko Schocher /* Size already initialized */ 19240540823SHeiko Schocher printf("\n\r 128MB"); 19340540823SHeiko Schocher } 19440540823SHeiko Schocher } 1950f8bc283SHeiko Schocher #endif 1960f8bc283SHeiko Schocher 1970f8bc283SHeiko Schocher #ifdef CONFIG_MACB 19840540823SHeiko Schocher static void siemens_phy_reset(void) 19940540823SHeiko Schocher { 20040540823SHeiko Schocher /* 20140540823SHeiko Schocher * we need to reset PHY for 200us 20240540823SHeiko Schocher * because of bug in ATMEL G20 CPU (undefined initial state of GPIO) 20340540823SHeiko Schocher */ 20440540823SHeiko Schocher if ((readl(AT91_ASM_RSTC_SR) & AT91_RSTC_RSTTYP) == 20540540823SHeiko Schocher AT91_RSTC_RSTTYP_GENERAL) 20640540823SHeiko Schocher at91_set_gpio_value(AT91_PIN_PA25, 0); /* reset eth switch */ 20740540823SHeiko Schocher } 20840540823SHeiko Schocher 2090f8bc283SHeiko Schocher static void taurus_macb_hw_init(void) 2100f8bc283SHeiko Schocher { 2110f8bc283SHeiko Schocher /* Enable EMAC clock */ 212237e3793SHeiko Schocher at91_periph_clk_enable(ATMEL_ID_EMAC0); 2130f8bc283SHeiko Schocher 2140f8bc283SHeiko Schocher /* 2150f8bc283SHeiko Schocher * Disable pull-up on: 2160f8bc283SHeiko Schocher * RXDV (PA17) => PHY normal mode (not Test mode) 2170f8bc283SHeiko Schocher * ERX0 (PA14) => PHY ADDR0 2180f8bc283SHeiko Schocher * ERX1 (PA15) => PHY ADDR1 2190f8bc283SHeiko Schocher * ERX2 (PA25) => PHY ADDR2 2200f8bc283SHeiko Schocher * ERX3 (PA26) => PHY ADDR3 2210f8bc283SHeiko Schocher * ECRS (PA28) => PHY ADDR4 => PHYADDR = 0x0 2220f8bc283SHeiko Schocher * 2230f8bc283SHeiko Schocher * PHY has internal pull-down 2240f8bc283SHeiko Schocher */ 2250f8bc283SHeiko Schocher at91_set_pio_pullup(AT91_PIO_PORTA, 14, 0); 2260f8bc283SHeiko Schocher at91_set_pio_pullup(AT91_PIO_PORTA, 15, 0); 2270f8bc283SHeiko Schocher at91_set_pio_pullup(AT91_PIO_PORTA, 17, 0); 2280f8bc283SHeiko Schocher at91_set_pio_pullup(AT91_PIO_PORTA, 25, 0); 2290f8bc283SHeiko Schocher at91_set_pio_pullup(AT91_PIO_PORTA, 26, 0); 2300f8bc283SHeiko Schocher at91_set_pio_pullup(AT91_PIO_PORTA, 28, 0); 2310f8bc283SHeiko Schocher 23240540823SHeiko Schocher siemens_phy_reset(); 23340540823SHeiko Schocher 2340f8bc283SHeiko Schocher at91_phy_reset(); 2350f8bc283SHeiko Schocher 2360f8bc283SHeiko Schocher at91_set_gpio_input(AT91_PIN_PA25, 1); /* ERST tri-state */ 2370f8bc283SHeiko Schocher 2380f8bc283SHeiko Schocher /* Re-enable pull-up */ 2390f8bc283SHeiko Schocher at91_set_pio_pullup(AT91_PIO_PORTA, 14, 1); 2400f8bc283SHeiko Schocher at91_set_pio_pullup(AT91_PIO_PORTA, 15, 1); 2410f8bc283SHeiko Schocher at91_set_pio_pullup(AT91_PIO_PORTA, 17, 1); 2420f8bc283SHeiko Schocher at91_set_pio_pullup(AT91_PIO_PORTA, 25, 1); 2430f8bc283SHeiko Schocher at91_set_pio_pullup(AT91_PIO_PORTA, 26, 1); 2440f8bc283SHeiko Schocher at91_set_pio_pullup(AT91_PIO_PORTA, 28, 1); 2450f8bc283SHeiko Schocher 2460f8bc283SHeiko Schocher /* Initialize EMAC=MACB hardware */ 2470f8bc283SHeiko Schocher at91_macb_hw_init(); 2480f8bc283SHeiko Schocher } 2490f8bc283SHeiko Schocher #endif 2500f8bc283SHeiko Schocher 2510f8bc283SHeiko Schocher #ifdef CONFIG_GENERIC_ATMEL_MCI 2520f8bc283SHeiko Schocher int board_mmc_init(bd_t *bd) 2530f8bc283SHeiko Schocher { 2540f8bc283SHeiko Schocher at91_mci_hw_init(); 2550f8bc283SHeiko Schocher 2560f8bc283SHeiko Schocher return atmel_mci_init((void *)ATMEL_BASE_MCI); 2570f8bc283SHeiko Schocher } 2580f8bc283SHeiko Schocher #endif 2590f8bc283SHeiko Schocher 2600f8bc283SHeiko Schocher int board_early_init_f(void) 2610f8bc283SHeiko Schocher { 2620f8bc283SHeiko Schocher /* Enable clocks for all PIOs */ 263237e3793SHeiko Schocher at91_periph_clk_enable(ATMEL_ID_PIOA); 264237e3793SHeiko Schocher at91_periph_clk_enable(ATMEL_ID_PIOB); 265237e3793SHeiko Schocher at91_periph_clk_enable(ATMEL_ID_PIOC); 266237e3793SHeiko Schocher 267237e3793SHeiko Schocher at91_seriald_hw_init(); 2680f8bc283SHeiko Schocher 2690f8bc283SHeiko Schocher return 0; 2700f8bc283SHeiko Schocher } 2710f8bc283SHeiko Schocher 27250921cdcSHeiko Schocher int spi_cs_is_valid(unsigned int bus, unsigned int cs) 27350921cdcSHeiko Schocher { 27450921cdcSHeiko Schocher return bus == 0 && cs == 0; 27550921cdcSHeiko Schocher } 27650921cdcSHeiko Schocher 27750921cdcSHeiko Schocher void spi_cs_activate(struct spi_slave *slave) 27850921cdcSHeiko Schocher { 27950921cdcSHeiko Schocher at91_set_gpio_value(TAURUS_SPI_CS_PIN, 0); 28050921cdcSHeiko Schocher } 28150921cdcSHeiko Schocher 28250921cdcSHeiko Schocher void spi_cs_deactivate(struct spi_slave *slave) 28350921cdcSHeiko Schocher { 28450921cdcSHeiko Schocher at91_set_gpio_value(TAURUS_SPI_CS_PIN, 1); 28550921cdcSHeiko Schocher } 28650921cdcSHeiko Schocher 287e8b81eefSHeiko Schocher #ifdef CONFIG_USB_GADGET_AT91 288e8b81eefSHeiko Schocher #include <linux/usb/at91_udc.h> 289e8b81eefSHeiko Schocher 290e8b81eefSHeiko Schocher void at91_udp_hw_init(void) 291e8b81eefSHeiko Schocher { 292e8b81eefSHeiko Schocher at91_pmc_t *pmc = (at91_pmc_t *)ATMEL_BASE_PMC; 293e8b81eefSHeiko Schocher 294e8b81eefSHeiko Schocher /* Enable PLLB */ 295e8b81eefSHeiko Schocher writel(get_pllb_init(), &pmc->pllbr); 296e8b81eefSHeiko Schocher while ((readl(&pmc->sr) & AT91_PMC_LOCKB) != AT91_PMC_LOCKB) 297e8b81eefSHeiko Schocher ; 298e8b81eefSHeiko Schocher 299e8b81eefSHeiko Schocher /* Enable UDPCK clock, MCK is enabled in at91_clock_init() */ 300e8b81eefSHeiko Schocher at91_periph_clk_enable(ATMEL_ID_UDP); 301e8b81eefSHeiko Schocher 302*70341e2eSWenyou Yang at91_system_clk_enable(AT91SAM926x_PMC_UDP); 303e8b81eefSHeiko Schocher } 304e8b81eefSHeiko Schocher 305e8b81eefSHeiko Schocher struct at91_udc_data board_udc_data = { 306e8b81eefSHeiko Schocher .baseaddr = ATMEL_BASE_UDP0, 307e8b81eefSHeiko Schocher }; 308e8b81eefSHeiko Schocher #endif 309e8b81eefSHeiko Schocher 3100f8bc283SHeiko Schocher int board_init(void) 3110f8bc283SHeiko Schocher { 3120f8bc283SHeiko Schocher /* adress of boot parameters */ 3130f8bc283SHeiko Schocher gd->bd->bi_boot_params = CONFIG_SYS_SDRAM_BASE + 0x100; 3140f8bc283SHeiko Schocher 3150f8bc283SHeiko Schocher #ifdef CONFIG_CMD_NAND 3160f8bc283SHeiko Schocher taurus_nand_hw_init(); 3170f8bc283SHeiko Schocher #endif 3180f8bc283SHeiko Schocher #ifdef CONFIG_MACB 3190f8bc283SHeiko Schocher taurus_macb_hw_init(); 3200f8bc283SHeiko Schocher #endif 32150921cdcSHeiko Schocher at91_spi0_hw_init(TAURUS_SPI_MASK); 322e8b81eefSHeiko Schocher #ifdef CONFIG_USB_GADGET_AT91 323e8b81eefSHeiko Schocher at91_udp_hw_init(); 324e8b81eefSHeiko Schocher at91_udc_probe(&board_udc_data); 325e8b81eefSHeiko Schocher #endif 3260f8bc283SHeiko Schocher 3270f8bc283SHeiko Schocher return 0; 3280f8bc283SHeiko Schocher } 3290f8bc283SHeiko Schocher 3300f8bc283SHeiko Schocher int dram_init(void) 3310f8bc283SHeiko Schocher { 3320f8bc283SHeiko Schocher gd->ram_size = get_ram_size((void *)CONFIG_SYS_SDRAM_BASE, 3330f8bc283SHeiko Schocher CONFIG_SYS_SDRAM_SIZE); 3340f8bc283SHeiko Schocher return 0; 3350f8bc283SHeiko Schocher } 3360f8bc283SHeiko Schocher 3370f8bc283SHeiko Schocher int board_eth_init(bd_t *bis) 3380f8bc283SHeiko Schocher { 3390f8bc283SHeiko Schocher int rc = 0; 3400f8bc283SHeiko Schocher #ifdef CONFIG_MACB 3410f8bc283SHeiko Schocher rc = macb_eth_initialize(0, (void *)ATMEL_BASE_EMAC0, 0x00); 3420f8bc283SHeiko Schocher #endif 3430f8bc283SHeiko Schocher return rc; 3440f8bc283SHeiko Schocher } 34540540823SHeiko Schocher 34640540823SHeiko Schocher #if !defined(CONFIG_SPL_BUILD) 34740540823SHeiko Schocher #if defined(CONFIG_BOARD_AXM) 34840540823SHeiko Schocher /* 34940540823SHeiko Schocher * Booting the Fallback Image. 35040540823SHeiko Schocher * 35140540823SHeiko Schocher * The function is used to provide and 35240540823SHeiko Schocher * boot the image with the fallback 35340540823SHeiko Schocher * parameters, incase if the faulty image 35440540823SHeiko Schocher * in upgraded over the base firmware. 35540540823SHeiko Schocher * 35640540823SHeiko Schocher */ 35740540823SHeiko Schocher static int upgrade_failure_fallback(void) 35840540823SHeiko Schocher { 35940540823SHeiko Schocher char *partitionset_active = NULL; 36040540823SHeiko Schocher char *rootfs = NULL; 36140540823SHeiko Schocher char *rootfs_fallback = NULL; 36240540823SHeiko Schocher char *kern_off; 36340540823SHeiko Schocher char *kern_off_fb; 36440540823SHeiko Schocher char *kern_size; 36540540823SHeiko Schocher char *kern_size_fb; 36640540823SHeiko Schocher 36740540823SHeiko Schocher partitionset_active = getenv("partitionset_active"); 36840540823SHeiko Schocher if (partitionset_active) { 36940540823SHeiko Schocher if (partitionset_active[0] == 'A') 37040540823SHeiko Schocher setenv("partitionset_active", "B"); 37140540823SHeiko Schocher else 37240540823SHeiko Schocher setenv("partitionset_active", "A"); 37340540823SHeiko Schocher } else { 37440540823SHeiko Schocher printf("partitionset_active missing.\n"); 37540540823SHeiko Schocher return -ENOENT; 37640540823SHeiko Schocher } 37740540823SHeiko Schocher 37840540823SHeiko Schocher rootfs = getenv("rootfs"); 37940540823SHeiko Schocher rootfs_fallback = getenv("rootfs_fallback"); 38040540823SHeiko Schocher setenv("rootfs", rootfs_fallback); 38140540823SHeiko Schocher setenv("rootfs_fallback", rootfs); 38240540823SHeiko Schocher 38340540823SHeiko Schocher kern_size = getenv("kernel_size"); 38440540823SHeiko Schocher kern_size_fb = getenv("kernel_size_fallback"); 38540540823SHeiko Schocher setenv("kernel_size", kern_size_fb); 38640540823SHeiko Schocher setenv("kernel_size_fallback", kern_size); 38740540823SHeiko Schocher 38840540823SHeiko Schocher kern_off = getenv("kernel_Off"); 38940540823SHeiko Schocher kern_off_fb = getenv("kernel_Off_fallback"); 39040540823SHeiko Schocher setenv("kernel_Off", kern_off_fb); 39140540823SHeiko Schocher setenv("kernel_Off_fallback", kern_off); 39240540823SHeiko Schocher 39340540823SHeiko Schocher setenv("bootargs", '\0'); 39440540823SHeiko Schocher setenv("upgrade_available", '\0'); 39540540823SHeiko Schocher setenv("boot_retries", '\0'); 39640540823SHeiko Schocher saveenv(); 39740540823SHeiko Schocher 39840540823SHeiko Schocher return 0; 39940540823SHeiko Schocher } 40040540823SHeiko Schocher 40140540823SHeiko Schocher static int do_upgrade_available(cmd_tbl_t *cmdtp, int flag, int argc, 40240540823SHeiko Schocher char * const argv[]) 40340540823SHeiko Schocher { 40440540823SHeiko Schocher unsigned long upgrade_available = 0; 40540540823SHeiko Schocher unsigned long boot_retry = 0; 40640540823SHeiko Schocher char boot_buf[10]; 40740540823SHeiko Schocher 40840540823SHeiko Schocher upgrade_available = simple_strtoul(getenv("upgrade_available"), NULL, 40940540823SHeiko Schocher 10); 41040540823SHeiko Schocher if (upgrade_available) { 41140540823SHeiko Schocher boot_retry = simple_strtoul(getenv("boot_retries"), NULL, 10); 41240540823SHeiko Schocher boot_retry++; 41340540823SHeiko Schocher sprintf(boot_buf, "%lx", boot_retry); 41440540823SHeiko Schocher setenv("boot_retries", boot_buf); 41540540823SHeiko Schocher saveenv(); 41640540823SHeiko Schocher 41740540823SHeiko Schocher /* 41840540823SHeiko Schocher * Here the boot_retries count is checked, and if the 41940540823SHeiko Schocher * count becomes greater than 2 switch back to the 42040540823SHeiko Schocher * fallback, and reset the board. 42140540823SHeiko Schocher */ 42240540823SHeiko Schocher 42340540823SHeiko Schocher if (boot_retry > 2) { 42440540823SHeiko Schocher if (upgrade_failure_fallback() == 0) 42540540823SHeiko Schocher do_reset(NULL, 0, 0, NULL); 42640540823SHeiko Schocher return -1; 42740540823SHeiko Schocher } 42840540823SHeiko Schocher } 42940540823SHeiko Schocher return 0; 43040540823SHeiko Schocher } 43140540823SHeiko Schocher 43240540823SHeiko Schocher U_BOOT_CMD( 43340540823SHeiko Schocher upgrade_available, 1, 1, do_upgrade_available, 43440540823SHeiko Schocher "check Siemens update", 43540540823SHeiko Schocher "no parameters" 43640540823SHeiko Schocher ); 43740540823SHeiko Schocher #endif 43840540823SHeiko Schocher #endif 439