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