xref: /rk3399_rockchip-uboot/arch/arm/lib/bootm.c (revision 590d3cacb98cb377b127869b58507d2afe9c904a)
1 /*
2  * (C) Copyright 2002
3  * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
4  * Marius Groeger <mgroeger@sysgo.de>
5  *
6  * Copyright (C) 2001  Erik Mouw (J.A.K.Mouw@its.tudelft.nl)
7  *
8  * This program is free software; you can redistribute it and/or modify
9  * it under the terms of the GNU General Public License as published by
10  * the Free Software Foundation; either version 2 of the License, or
11  * (at your option) any later version.
12  *
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.	 See the
16  * GNU General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307	 USA
21  *
22  */
23 
24 #include <common.h>
25 #include <command.h>
26 #include <image.h>
27 #include <u-boot/zlib.h>
28 #include <asm/byteorder.h>
29 #include <fdt.h>
30 #include <libfdt.h>
31 #include <fdt_support.h>
32 
33 DECLARE_GLOBAL_DATA_PTR;
34 
35 #if defined (CONFIG_SETUP_MEMORY_TAGS) || \
36     defined (CONFIG_CMDLINE_TAG) || \
37     defined (CONFIG_INITRD_TAG) || \
38     defined (CONFIG_SERIAL_TAG) || \
39     defined (CONFIG_REVISION_TAG)
40 static void setup_start_tag (bd_t *bd);
41 
42 # ifdef CONFIG_SETUP_MEMORY_TAGS
43 static void setup_memory_tags (bd_t *bd);
44 # endif
45 static void setup_commandline_tag (bd_t *bd, char *commandline);
46 
47 # ifdef CONFIG_INITRD_TAG
48 static void setup_initrd_tag (bd_t *bd, ulong initrd_start,
49 			      ulong initrd_end);
50 # endif
51 static void setup_end_tag (bd_t *bd);
52 
53 static struct tag *params;
54 #endif /* CONFIG_SETUP_MEMORY_TAGS || CONFIG_CMDLINE_TAG || CONFIG_INITRD_TAG */
55 
56 static ulong get_sp(void);
57 #if defined(CONFIG_OF_LIBFDT)
58 static int bootm_linux_fdt(int machid, bootm_headers_t *images);
59 #endif
60 
61 void arch_lmb_reserve(struct lmb *lmb)
62 {
63 	ulong sp;
64 
65 	/*
66 	 * Booting a (Linux) kernel image
67 	 *
68 	 * Allocate space for command line and board info - the
69 	 * address should be as high as possible within the reach of
70 	 * the kernel (see CONFIG_SYS_BOOTMAPSZ settings), but in unused
71 	 * memory, which means far enough below the current stack
72 	 * pointer.
73 	 */
74 	sp = get_sp();
75 	debug("## Current stack ends at 0x%08lx ", sp);
76 
77 	/* adjust sp by 1K to be safe */
78 	sp -= 1024;
79 	lmb_reserve(lmb, sp,
80 		    gd->bd->bi_dram[0].start + gd->bd->bi_dram[0].size - sp);
81 }
82 
83 static void announce_and_cleanup(void)
84 {
85 	printf("\nStarting kernel ...\n\n");
86 
87 #ifdef CONFIG_USB_DEVICE
88 	{
89 		extern void udc_disconnect(void);
90 		udc_disconnect();
91 	}
92 #endif
93 	cleanup_before_linux();
94 }
95 
96 int do_bootm_linux(int flag, int argc, char *argv[], bootm_headers_t *images)
97 {
98 	bd_t	*bd = gd->bd;
99 	char	*s;
100 	int	machid = bd->bi_arch_number;
101 	void	(*kernel_entry)(int zero, int arch, uint params);
102 
103 #ifdef CONFIG_CMDLINE_TAG
104 	char *commandline = getenv ("bootargs");
105 #endif
106 
107 	if ((flag != 0) && (flag != BOOTM_STATE_OS_GO))
108 		return 1;
109 
110 	s = getenv ("machid");
111 	if (s) {
112 		machid = simple_strtoul (s, NULL, 16);
113 		printf ("Using machid 0x%x from environment\n", machid);
114 	}
115 
116 	show_boot_progress (15);
117 
118 #ifdef CONFIG_OF_LIBFDT
119 	if (images->ft_len)
120 		return bootm_linux_fdt(machid, images);
121 #endif
122 
123 	kernel_entry = (void (*)(int, int, uint))images->ep;
124 
125 	debug ("## Transferring control to Linux (at address %08lx) ...\n",
126 	       (ulong) kernel_entry);
127 
128 #if defined (CONFIG_SETUP_MEMORY_TAGS) || \
129     defined (CONFIG_CMDLINE_TAG) || \
130     defined (CONFIG_INITRD_TAG) || \
131     defined (CONFIG_SERIAL_TAG) || \
132     defined (CONFIG_REVISION_TAG)
133 	setup_start_tag (bd);
134 #ifdef CONFIG_SERIAL_TAG
135 	setup_serial_tag (&params);
136 #endif
137 #ifdef CONFIG_REVISION_TAG
138 	setup_revision_tag (&params);
139 #endif
140 #ifdef CONFIG_SETUP_MEMORY_TAGS
141 	setup_memory_tags (bd);
142 #endif
143 #ifdef CONFIG_CMDLINE_TAG
144 	setup_commandline_tag (bd, commandline);
145 #endif
146 #ifdef CONFIG_INITRD_TAG
147 	if (images->rd_start && images->rd_end)
148 		setup_initrd_tag (bd, images->rd_start, images->rd_end);
149 #endif
150 	setup_end_tag(bd);
151 #endif
152 
153 	announce_and_cleanup();
154 
155 	kernel_entry(0, machid, bd->bi_boot_params);
156 	/* does not return */
157 
158 	return 1;
159 }
160 
161 #if defined(CONFIG_OF_LIBFDT)
162 static int fixup_memory_node(void *blob)
163 {
164 	bd_t	*bd = gd->bd;
165 	int bank;
166 	u64 start[CONFIG_NR_DRAM_BANKS];
167 	u64 size[CONFIG_NR_DRAM_BANKS];
168 
169 	for (bank = 0; bank < CONFIG_NR_DRAM_BANKS; bank++) {
170 		start[bank] = bd->bi_dram[bank].start;
171 		size[bank] = bd->bi_dram[bank].size;
172 	}
173 
174 	return fdt_fixup_memory_banks(blob, start, size, CONFIG_NR_DRAM_BANKS);
175 }
176 
177 static int bootm_linux_fdt(int machid, bootm_headers_t *images)
178 {
179 	ulong rd_len;
180 	void (*kernel_entry)(int zero, int dt_machid, void *dtblob);
181 	ulong of_size = images->ft_len;
182 	char **of_flat_tree = &images->ft_addr;
183 	ulong *initrd_start = &images->initrd_start;
184 	ulong *initrd_end = &images->initrd_end;
185 	struct lmb *lmb = &images->lmb;
186 	int ret;
187 
188 	kernel_entry = (void (*)(int, int, void *))images->ep;
189 
190 	rd_len = images->rd_end - images->rd_start;
191 	ret = boot_ramdisk_high(lmb, images->rd_start, rd_len,
192 				initrd_start, initrd_end);
193 	if (ret)
194 		return ret;
195 
196 	ret = boot_relocate_fdt(lmb, of_flat_tree, &of_size);
197 	if (ret)
198 		return ret;
199 
200 	debug("## Transferring control to Linux (at address %08lx) ...\n",
201 	       (ulong) kernel_entry);
202 
203 	fdt_chosen(*of_flat_tree, 1);
204 
205 	fixup_memory_node(*of_flat_tree);
206 
207 	fdt_initrd(*of_flat_tree, *initrd_start, *initrd_end, 1);
208 
209 	announce_and_cleanup();
210 
211 	kernel_entry(0, machid, *of_flat_tree);
212 	/* does not return */
213 
214 	return 1;
215 }
216 #endif
217 
218 #if defined (CONFIG_SETUP_MEMORY_TAGS) || \
219     defined (CONFIG_CMDLINE_TAG) || \
220     defined (CONFIG_INITRD_TAG) || \
221     defined (CONFIG_SERIAL_TAG) || \
222     defined (CONFIG_REVISION_TAG)
223 static void setup_start_tag (bd_t *bd)
224 {
225 	params = (struct tag *) bd->bi_boot_params;
226 
227 	params->hdr.tag = ATAG_CORE;
228 	params->hdr.size = tag_size (tag_core);
229 
230 	params->u.core.flags = 0;
231 	params->u.core.pagesize = 0;
232 	params->u.core.rootdev = 0;
233 
234 	params = tag_next (params);
235 }
236 
237 
238 #ifdef CONFIG_SETUP_MEMORY_TAGS
239 static void setup_memory_tags (bd_t *bd)
240 {
241 	int i;
242 
243 	for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) {
244 		params->hdr.tag = ATAG_MEM;
245 		params->hdr.size = tag_size (tag_mem32);
246 
247 		params->u.mem.start = bd->bi_dram[i].start;
248 		params->u.mem.size = bd->bi_dram[i].size;
249 
250 		params = tag_next (params);
251 	}
252 }
253 #endif /* CONFIG_SETUP_MEMORY_TAGS */
254 
255 
256 static void setup_commandline_tag (bd_t *bd, char *commandline)
257 {
258 	char *p;
259 
260 	if (!commandline)
261 		return;
262 
263 	/* eat leading white space */
264 	for (p = commandline; *p == ' '; p++);
265 
266 	/* skip non-existent command lines so the kernel will still
267 	 * use its default command line.
268 	 */
269 	if (*p == '\0')
270 		return;
271 
272 	params->hdr.tag = ATAG_CMDLINE;
273 	params->hdr.size =
274 		(sizeof (struct tag_header) + strlen (p) + 1 + 4) >> 2;
275 
276 	strcpy (params->u.cmdline.cmdline, p);
277 
278 	params = tag_next (params);
279 }
280 
281 
282 #ifdef CONFIG_INITRD_TAG
283 static void setup_initrd_tag (bd_t *bd, ulong initrd_start, ulong initrd_end)
284 {
285 	/* an ATAG_INITRD node tells the kernel where the compressed
286 	 * ramdisk can be found. ATAG_RDIMG is a better name, actually.
287 	 */
288 	params->hdr.tag = ATAG_INITRD2;
289 	params->hdr.size = tag_size (tag_initrd);
290 
291 	params->u.initrd.start = initrd_start;
292 	params->u.initrd.size = initrd_end - initrd_start;
293 
294 	params = tag_next (params);
295 }
296 #endif /* CONFIG_INITRD_TAG */
297 
298 #ifdef CONFIG_SERIAL_TAG
299 void setup_serial_tag (struct tag **tmp)
300 {
301 	struct tag *params = *tmp;
302 	struct tag_serialnr serialnr;
303 	void get_board_serial(struct tag_serialnr *serialnr);
304 
305 	get_board_serial(&serialnr);
306 	params->hdr.tag = ATAG_SERIAL;
307 	params->hdr.size = tag_size (tag_serialnr);
308 	params->u.serialnr.low = serialnr.low;
309 	params->u.serialnr.high= serialnr.high;
310 	params = tag_next (params);
311 	*tmp = params;
312 }
313 #endif
314 
315 #ifdef CONFIG_REVISION_TAG
316 void setup_revision_tag(struct tag **in_params)
317 {
318 	u32 rev = 0;
319 	u32 get_board_rev(void);
320 
321 	rev = get_board_rev();
322 	params->hdr.tag = ATAG_REVISION;
323 	params->hdr.size = tag_size (tag_revision);
324 	params->u.revision.rev = rev;
325 	params = tag_next (params);
326 }
327 #endif  /* CONFIG_REVISION_TAG */
328 
329 static void setup_end_tag (bd_t *bd)
330 {
331 	params->hdr.tag = ATAG_NONE;
332 	params->hdr.size = 0;
333 }
334 #endif /* CONFIG_SETUP_MEMORY_TAGS || CONFIG_CMDLINE_TAG || CONFIG_INITRD_TAG */
335 
336 static ulong get_sp(void)
337 {
338 	ulong ret;
339 
340 	asm("mov %0, sp" : "=r"(ret) : );
341 	return ret;
342 }
343