1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Copyright (C) 2011 Andes Technology Corporation
4 * Shawn Lin, Andes Technology Corporation <nobuhiro@andestech.com>
5 * Macpaul Lin, Andes Technology Corporation <macpaul@andestech.com>
6 */
7
8 #include <common.h>
9 #include <bootstage.h>
10 #include <command.h>
11 #include <env.h>
12 #include <hang.h>
13 #include <image.h>
14 #include <log.h>
15 #include <asm/global_data.h>
16 #include <u-boot/zlib.h>
17 #include <asm/byteorder.h>
18 #include <asm/bootm.h>
19
20 DECLARE_GLOBAL_DATA_PTR;
21
22 #if defined(CONFIG_SETUP_MEMORY_TAGS) || \
23 defined(CONFIG_CMDLINE_TAG) || \
24 defined(CONFIG_INITRD_TAG) || \
25 defined(CONFIG_SERIAL_TAG) || \
26 defined(CONFIG_REVISION_TAG)
27 static void setup_start_tag(struct bd_info *bd);
28
29 # ifdef CONFIG_SETUP_MEMORY_TAGS
30 static void setup_memory_tags(struct bd_info *bd);
31 # endif
32 static void setup_commandline_tag(struct bd_info *bd, char *commandline);
33
34 # ifdef CONFIG_INITRD_TAG
35 static void setup_initrd_tag(struct bd_info *bd, ulong initrd_start,
36 ulong initrd_end);
37 # endif
38 static void setup_end_tag(struct bd_info *bd);
39
40 static struct tag *params;
41 #endif /* CONFIG_SETUP_MEMORY_TAGS || CONFIG_CMDLINE_TAG || CONFIG_INITRD_TAG */
42
do_bootm_linux(int flag,int argc,char * argv[],bootm_headers_t * images)43 int do_bootm_linux(int flag, int argc, char *argv[], bootm_headers_t *images)
44 {
45 struct bd_info *bd = gd->bd;
46 char *s;
47 int machid = bd->bi_arch_number;
48 void (*theKernel)(int zero, int arch, uint params);
49
50 #ifdef CONFIG_CMDLINE_TAG
51 char *commandline = env_get("bootargs");
52 #endif
53
54 /*
55 * allow the PREP bootm subcommand, it is required for bootm to work
56 */
57 if (flag & BOOTM_STATE_OS_PREP)
58 return 0;
59
60 if ((flag != 0) && (flag != BOOTM_STATE_OS_GO))
61 return 1;
62
63 theKernel = (void (*)(int, int, uint))images->ep;
64
65 s = env_get("machid");
66 if (s) {
67 machid = simple_strtoul(s, NULL, 16);
68 printf("Using machid 0x%x from environment\n", machid);
69 }
70
71 bootstage_mark(BOOTSTAGE_ID_RUN_OS);
72
73 debug("## Transferring control to Linux (at address %08lx) ...\n",
74 (ulong)theKernel);
75
76 if (IMAGE_ENABLE_OF_LIBFDT && images->ft_len) {
77 #ifdef CONFIG_OF_LIBFDT
78 debug("using: FDT\n");
79 if (image_setup_linux(images)) {
80 printf("FDT creation failed! hanging...");
81 hang();
82 }
83 #endif
84 } else if (BOOTM_ENABLE_TAGS) {
85 #if defined(CONFIG_SETUP_MEMORY_TAGS) || \
86 defined(CONFIG_CMDLINE_TAG) || \
87 defined(CONFIG_INITRD_TAG) || \
88 defined(CONFIG_SERIAL_TAG) || \
89 defined(CONFIG_REVISION_TAG)
90 setup_start_tag(bd);
91 #ifdef CONFIG_SERIAL_TAG
92 setup_serial_tag(¶ms);
93 #endif
94 #ifdef CONFIG_REVISION_TAG
95 setup_revision_tag(¶ms);
96 #endif
97 #ifdef CONFIG_SETUP_MEMORY_TAGS
98 setup_memory_tags(bd);
99 #endif
100 #ifdef CONFIG_CMDLINE_TAG
101 setup_commandline_tag(bd, commandline);
102 #endif
103 #ifdef CONFIG_INITRD_TAG
104 if (images->rd_start && images->rd_end)
105 setup_initrd_tag(bd, images->rd_start, images->rd_end);
106 #endif
107 setup_end_tag(bd);
108 #endif
109
110 /* we assume that the kernel is in place */
111 printf("\nStarting kernel ...\n\n");
112
113 #ifdef CONFIG_USB_DEVICE
114 {
115 extern void udc_disconnect(void);
116 udc_disconnect();
117 }
118 #endif
119 }
120 cleanup_before_linux();
121 if (IMAGE_ENABLE_OF_LIBFDT && images->ft_len)
122 theKernel(0, machid, (unsigned long)images->ft_addr);
123 else
124 theKernel(0, machid, bd->bi_boot_params);
125 /* does not return */
126
127 return 1;
128 }
129
130 #if defined(CONFIG_SETUP_MEMORY_TAGS) || \
131 defined(CONFIG_CMDLINE_TAG) || \
132 defined(CONFIG_INITRD_TAG) || \
133 defined(CONFIG_SERIAL_TAG) || \
134 defined(CONFIG_REVISION_TAG)
setup_start_tag(struct bd_info * bd)135 static void setup_start_tag(struct bd_info *bd)
136 {
137 params = (struct tag *)bd->bi_boot_params;
138
139 params->hdr.tag = ATAG_CORE;
140 params->hdr.size = tag_size(tag_core);
141
142 params->u.core.flags = 0;
143 params->u.core.pagesize = 0;
144 params->u.core.rootdev = 0;
145
146 params = tag_next(params);
147 }
148
149 #ifdef CONFIG_SETUP_MEMORY_TAGS
setup_memory_tags(struct bd_info * bd)150 static void setup_memory_tags(struct bd_info *bd)
151 {
152 int i;
153
154 for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) {
155 params->hdr.tag = ATAG_MEM;
156 params->hdr.size = tag_size(tag_mem32);
157
158 params->u.mem.start = bd->bi_dram[i].start;
159 params->u.mem.size = bd->bi_dram[i].size;
160
161 params = tag_next(params);
162 }
163 }
164 #endif /* CONFIG_SETUP_MEMORY_TAGS */
165
setup_commandline_tag(struct bd_info * bd,char * commandline)166 static void setup_commandline_tag(struct bd_info *bd, char *commandline)
167 {
168 char *p;
169
170 if (!commandline)
171 return;
172
173 /* eat leading white space */
174 for (p = commandline; *p == ' '; p++)
175 ;
176
177 /* skip non-existent command lines so the kernel will still
178 * use its default command line.
179 */
180 if (*p == '\0')
181 return;
182
183 params->hdr.tag = ATAG_CMDLINE;
184 params->hdr.size =
185 (sizeof(struct tag_header) + strlen(p) + 1 + 4) >> 2;
186
187 strcpy(params->u.cmdline.cmdline, p)
188 ;
189
190 params = tag_next(params);
191 }
192
193 #ifdef CONFIG_INITRD_TAG
setup_initrd_tag(struct bd_info * bd,ulong initrd_start,ulong initrd_end)194 static void setup_initrd_tag(struct bd_info *bd, ulong initrd_start,
195 ulong initrd_end)
196 {
197 /* an ATAG_INITRD node tells the kernel where the compressed
198 * ramdisk can be found. ATAG_RDIMG is a better name, actually.
199 */
200 params->hdr.tag = ATAG_INITRD2;
201 params->hdr.size = tag_size(tag_initrd);
202
203 params->u.initrd.start = initrd_start;
204 params->u.initrd.size = initrd_end - initrd_start;
205
206 params = tag_next(params);
207 }
208 #endif /* CONFIG_INITRD_TAG */
209
210 #ifdef CONFIG_SERIAL_TAG
setup_serial_tag(struct tag ** tmp)211 void setup_serial_tag(struct tag **tmp)
212 {
213 struct tag *params = *tmp;
214 struct tag_serialnr serialnr;
215 void get_board_serial(struct tag_serialnr *serialnr);
216
217 get_board_serial(&serialnr);
218 params->hdr.tag = ATAG_SERIAL;
219 params->hdr.size = tag_size(tag_serialnr);
220 params->u.serialnr.low = serialnr.low;
221 params->u.serialnr.high = serialnr.high;
222 params = tag_next(params);
223 *tmp = params;
224 }
225 #endif
226
227 #ifdef CONFIG_REVISION_TAG
setup_revision_tag(struct tag ** in_params)228 void setup_revision_tag(struct tag **in_params)
229 {
230 u32 rev = 0;
231 u32 get_board_rev(void);
232
233 rev = get_board_rev();
234 params->hdr.tag = ATAG_REVISION;
235 params->hdr.size = tag_size(tag_revision);
236 params->u.revision.rev = rev;
237 params = tag_next(params);
238 }
239 #endif /* CONFIG_REVISION_TAG */
240
setup_end_tag(struct bd_info * bd)241 static void setup_end_tag(struct bd_info *bd)
242 {
243 params->hdr.tag = ATAG_NONE;
244 params->hdr.size = 0;
245 }
246
247 #endif /* CONFIG_SETUP_MEMORY_TAGS || CONFIG_CMDLINE_TAG || CONFIG_INITRD_TAG */
248