diff options
Diffstat (limited to 'board/highbank/highbank.c')
| -rw-r--r-- | board/highbank/highbank.c | 23 |
1 files changed, 23 insertions, 0 deletions
diff --git a/board/highbank/highbank.c b/board/highbank/highbank.c index b0aa182a81..f41bf05a51 100644 --- a/board/highbank/highbank.c +++ b/board/highbank/highbank.c @@ -17,9 +17,18 @@ #include <common.h> #include <ahci.h> +#include <netdev.h> #include <scsi.h> #include <asm/sizes.h> +#include <asm/io.h> + +#define HB_SREG_A9_PWR_REQ 0xfff3cf00 +#define HB_SREG_A9_BOOT_SRC_STAT 0xfff3cf04 +#define HB_PWR_SUSPEND 0 +#define HB_PWR_SOFT_RESET 1 +#define HB_PWR_HARD_RESET 2 +#define HB_PWR_SHUTDOWN 3 DECLARE_GLOBAL_DATA_PTR; @@ -47,8 +56,20 @@ int board_eth_init(bd_t *bis) int misc_init_r(void) { + char envbuffer[16]; + u32 boot_choice; + ahci_init(0xffe08000); scsi_scan(1); + + boot_choice = readl(HB_SREG_A9_BOOT_SRC_STAT) & 0xff; + sprintf(envbuffer, "bootcmd%d", boot_choice); + if (getenv(envbuffer)) { + sprintf(envbuffer, "run bootcmd%d", boot_choice); + setenv("bootcmd", envbuffer); + } else + setenv("bootcmd", ""); + return 0; } @@ -66,4 +87,6 @@ void dram_init_banksize(void) void reset_cpu(ulong addr) { + writel(HB_PWR_HARD_RESET, HB_SREG_A9_PWR_REQ); + asm(" wfi"); } |