arch/arm/mach-at91/spl.c

   1 /*
   2  * Copyright (C) 2013 Atmel Corporation
   3  *                    Bo Shen <voice.shen@atmel.com>
   4  *
   5  * SPDX-License-Identifier:     GPL-2.0+
   6  */
   7
   8 #include <common.h>
   9 #include <asm/io.h>
  10 #include <asm/arch/at91_common.h>
  11 #include <asm/arch/at91_wdt.h>
  12 #include <asm/arch/clk.h>
  13 #include <spl.h>
  14
  15 #if defined(CONFIG_AT91SAM9_WATCHDOG)
  16 void at91_disable_wdt(void) { }
  17 #else
  18 void at91_disable_wdt(void)
  19 {
  20         struct at91_wdt *wdt = (struct at91_wdt *)ATMEL_BASE_WDT;
  21
  22         writel(AT91_WDT_MR_WDDIS, &wdt->mr);
  23 }
  24 #endif
  25
  26 #if defined(CONFIG_SAMA5D2) || defined(CONFIG_SAMA5D3) || \
  27     defined(CONFIG_SAMA5D4)
  28 #include <asm/arch/sama5_boot.h>
  29 struct {
  30         u32     r4;
  31 } bootrom_stash __attribute__((section(".data")));
  32
  33 u32 spl_boot_device(void)
  34 {
  35         u32 dev = (bootrom_stash.r4 >> ATMEL_SAMA5_BOOT_FROM_OFF) &
  36                   ATMEL_SAMA5_BOOT_FROM_MASK;
  37         u32 off = (bootrom_stash.r4 >> ATMEL_SAMA5_BOOT_DEV_ID_OFF) &
  38                   ATMEL_SAMA5_BOOT_DEV_ID_MASK;
  39
  40 #if defined(CONFIG_SYS_USE_MMC)
  41         if (dev == ATMEL_SAMA5_BOOT_FROM_MCI) {
  42                 if (off == 0)
  43                         return BOOT_DEVICE_MMC1;
  44                 if (off == 1)
  45                         return BOOT_DEVICE_MMC2;
  46                 printf("ERROR: MMC controller %i not present!\n", dev);
  47                 hang();
  48         }
  49 #endif
  50
  51 #if defined(CONFIG_SYS_USE_SERIALFLASH) || defined(CONFIG_SYS_USE_SPIFLASH)
  52         if (dev == ATMEL_SAMA5_BOOT_FROM_SPI)
  53                 return BOOT_DEVICE_SPI;
  54 #endif
  55
  56         if (dev == ATMEL_SAMA5_BOOT_FROM_SAMBA)
  57                 return BOOT_DEVICE_USB;
  58
  59         printf("ERROR: SMC/TWI/QSPI boot device not supported!\n"
  60                "       Boot device %i, controller number %i\n", dev, off);
  61
  62         return BOOT_DEVICE_NONE;
  63 }
  64 #else
  65 u32 spl_boot_device(void)
  66 {
  67 #ifdef CONFIG_SYS_USE_MMC
  68         return BOOT_DEVICE_MMC1;
  69 #elif CONFIG_SYS_USE_NANDFLASH
  70         return BOOT_DEVICE_NAND;
  71 #elif CONFIG_SYS_USE_SERIALFLASH || CONFIG_SYS_USE_SPIFLASH
  72         return BOOT_DEVICE_SPI;
  73 #endif
  74         return BOOT_DEVICE_NONE;
  75 }
  76 #endif
  77
  78 u32 spl_boot_mode(const u32 boot_device)
  79 {
  80         switch (spl_boot_device()) {
  81 #ifdef CONFIG_SYS_USE_MMC
  82         case BOOT_DEVICE_MMC1:
  83         case BOOT_DEVICE_MMC2:
  84                 return MMCSD_MODE_FS;
  85                 break;
  86 #endif
  87         case BOOT_DEVICE_NONE:
  88         default:
  89                 hang();
  90         }
  91 }