]>
Commit | Line | Data |
---|---|---|
86a20fb9 MF |
1 | /* |
2 | * U-boot - bootldr.c | |
3 | * | |
4 | * Copyright (c) 2005-2008 Analog Devices Inc. | |
5 | * | |
6 | * See file CREDITS for list of people who contributed to this | |
7 | * project. | |
8 | * | |
9 | * Licensed under the GPL-2 or later. | |
10 | */ | |
11 | ||
12 | #include <config.h> | |
13 | #include <common.h> | |
14 | #include <command.h> | |
15 | ||
16 | #include <asm/blackfin.h> | |
17 | #include <asm/mach-common/bits/bootrom.h> | |
18 | ||
29d4ea0a MF |
19 | /* Simple sanity check on the specified address to make sure it contains |
20 | * an LDR image of some sort. | |
21 | */ | |
22 | static bool ldr_valid_signature(uint8_t *data) | |
23 | { | |
24 | #if defined(__ADSPBF561__) | |
25 | ||
26 | /* BF56x has a 4 byte global header */ | |
31488a6f | 27 | if (data[3] == (GFLAG_56X_SIGN_MAGIC << (GFLAG_56X_SIGN_SHIFT - 24))) |
29d4ea0a MF |
28 | return true; |
29 | ||
30 | #elif defined(__ADSPBF531__) || defined(__ADSPBF532__) || defined(__ADSPBF533__) || \ | |
31 | defined(__ADSPBF534__) || defined(__ADSPBF536__) || defined(__ADSPBF537__) || \ | |
32 | defined(__ADSPBF538__) || defined(__ADSPBF539__) | |
33 | ||
34 | /* all the BF53x should start at this address mask */ | |
35 | uint32_t addr; | |
36 | memmove(&addr, data, sizeof(addr)); | |
37 | if ((addr & 0xFF0FFF0F) == 0xFF000000) | |
38 | return true; | |
39 | #else | |
40 | ||
41 | /* everything newer has a magic byte */ | |
42 | uint32_t count; | |
43 | memmove(&count, data + 8, sizeof(count)); | |
44 | if (data[3] == 0xAD && count == 0) | |
45 | return true; | |
46 | ||
47 | #endif | |
48 | ||
49 | return false; | |
50 | } | |
51 | ||
52 | /* If the Blackfin is new enough, the Blackfin on-chip ROM supports loading | |
53 | * LDRs from random memory addresses. So whenever possible, use that. In | |
54 | * the older cases (BF53x/BF561), parse the LDR format ourselves. | |
55 | */ | |
29d4ea0a MF |
56 | static void ldr_load(uint8_t *base_addr) |
57 | { | |
58 | #if defined(__ADSPBF531__) || defined(__ADSPBF532__) || defined(__ADSPBF533__) || \ | |
59 | /*defined(__ADSPBF534__) || defined(__ADSPBF536__) || defined(__ADSPBF537__) ||*/\ | |
60 | defined(__ADSPBF538__) || defined(__ADSPBF539__) || defined(__ADSPBF561__) | |
61 | ||
29d4ea0a MF |
62 | uint32_t addr; |
63 | uint32_t count; | |
64 | uint16_t flags; | |
65 | ||
66 | /* the bf56x has a 4 byte global header ... but it is useless to | |
67 | * us when booting an LDR from a memory address, so skip it | |
68 | */ | |
69 | # ifdef __ADSPBF561__ | |
70 | base_addr += 4; | |
71 | # endif | |
72 | ||
73 | memmove(&flags, base_addr + 8, sizeof(flags)); | |
31488a6f | 74 | bfin_write_EVT1(flags & BFLAG_53X_RESVECT ? 0xFFA00000 : 0xFFA08000); |
29d4ea0a MF |
75 | |
76 | do { | |
77 | /* block header may not be aligned */ | |
78 | memmove(&addr, base_addr, sizeof(addr)); | |
79 | memmove(&count, base_addr+4, sizeof(count)); | |
80 | memmove(&flags, base_addr+8, sizeof(flags)); | |
81 | base_addr += sizeof(addr) + sizeof(count) + sizeof(flags); | |
82 | ||
31488a6f | 83 | printf("loading to 0x%08x (%#x bytes) flags: 0x%04x\n", |
29d4ea0a MF |
84 | addr, count, flags); |
85 | ||
31488a6f MF |
86 | if (!(flags & BFLAG_53X_IGNORE)) { |
87 | if (flags & BFLAG_53X_ZEROFILL) | |
29d4ea0a MF |
88 | memset((void *)addr, 0x00, count); |
89 | else | |
90 | memcpy((void *)addr, base_addr, count); | |
91 | ||
31488a6f | 92 | if (flags & BFLAG_53X_INIT) { |
29d4ea0a MF |
93 | void (*init)(void) = (void *)addr; |
94 | init(); | |
95 | } | |
96 | } | |
97 | ||
31488a6f | 98 | if (!(flags & BFLAG_53X_ZEROFILL)) |
29d4ea0a | 99 | base_addr += count; |
31488a6f | 100 | } while (!(flags & BFLAG_53X_FINAL)); |
29d4ea0a MF |
101 | |
102 | #endif | |
103 | } | |
104 | ||
105 | /* For BF537, we use the _BOOTROM_BOOT_DXE_FLASH funky ROM function. | |
106 | * For all other BF53x/BF56x, we just call the entry point. | |
107 | * For everything else (newer), we use _BOOTROM_MEMBOOT ROM function. | |
108 | */ | |
109 | static void ldr_exec(void *addr) | |
110 | { | |
111 | #if defined(__ADSPBF534__) || defined(__ADSPBF536__) || defined(__ADSPBF537__) | |
112 | ||
113 | /* restore EVT1 to reset value as this is what the bootrom uses as | |
114 | * the default entry point when booting the final block of LDRs | |
115 | */ | |
116 | bfin_write_EVT1(L1_INST_SRAM); | |
117 | __asm__("call (%0);" : : "a"(_BOOTROM_MEMBOOT), "q7"(addr) : "RETS", "memory"); | |
118 | ||
119 | #elif defined(__ADSPBF531__) || defined(__ADSPBF532__) || defined(__ADSPBF533__) || \ | |
120 | defined(__ADSPBF538__) || defined(__ADSPBF539__) || defined(__ADSPBF561__) | |
121 | ||
fe033ad6 | 122 | void (*ldr_entry)(void) = (void *)bfin_read_EVT1(); |
29d4ea0a MF |
123 | ldr_entry(); |
124 | ||
125 | #else | |
126 | ||
127 | int32_t (*BOOTROM_MEM)(void *, int32_t, int32_t, void *) = (void *)_BOOTROM_MEMBOOT; | |
128 | BOOTROM_MEM(addr, 0, 0, NULL); | |
129 | ||
130 | #endif | |
131 | } | |
132 | ||
86a20fb9 MF |
133 | /* |
134 | * the bootldr command loads an address, checks to see if there | |
135 | * is a Boot stream that the on-chip BOOTROM can understand, | |
136 | * and loads it via the BOOTROM Callback. It is possible | |
137 | * to also add booting from SPI, or TWI, but this function does | |
138 | * not currently support that. | |
139 | */ | |
54841ab5 | 140 | int do_bootldr(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) |
86a20fb9 MF |
141 | { |
142 | void *addr; | |
86a20fb9 MF |
143 | |
144 | /* Get the address */ | |
145 | if (argc < 2) | |
146 | addr = (void *)load_addr; | |
147 | else | |
148 | addr = (void *)simple_strtoul(argv[1], NULL, 16); | |
149 | ||
150 | /* Check if it is a LDR file */ | |
29d4ea0a | 151 | if (ldr_valid_signature(addr)) { |
86a20fb9 | 152 | printf("## Booting ldr image at 0x%p ...\n", addr); |
29d4ea0a | 153 | ldr_load(addr); |
86a20fb9 MF |
154 | |
155 | icache_disable(); | |
156 | dcache_disable(); | |
157 | ||
29d4ea0a | 158 | ldr_exec(addr); |
86a20fb9 MF |
159 | } else |
160 | printf("## No ldr image at address 0x%p\n", addr); | |
161 | ||
162 | return 0; | |
163 | } | |
164 | ||
388a29d0 FM |
165 | U_BOOT_CMD( |
166 | bootldr, 2, 0, do_bootldr, | |
2fb2604d | 167 | "boot ldr image from memory", |
86a20fb9 | 168 | "[addr]\n" |
a89c33db WD |
169 | "" |
170 | ); |