bootm: refactor entry point code
[platform/kernel/u-boot.git] / lib_arm / bootm.c
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 <zlib.h>
28 #include <asm/byteorder.h>
29
30 DECLARE_GLOBAL_DATA_PTR;
31
32 #if defined (CONFIG_SETUP_MEMORY_TAGS) || \
33     defined (CONFIG_CMDLINE_TAG) || \
34     defined (CONFIG_INITRD_TAG) || \
35     defined (CONFIG_SERIAL_TAG) || \
36     defined (CONFIG_REVISION_TAG) || \
37     defined (CONFIG_VFD) || \
38     defined (CONFIG_LCD)
39 static void setup_start_tag (bd_t *bd);
40
41 # ifdef CONFIG_SETUP_MEMORY_TAGS
42 static void setup_memory_tags (bd_t *bd);
43 # endif
44 static void setup_commandline_tag (bd_t *bd, char *commandline);
45
46 # ifdef CONFIG_INITRD_TAG
47 static void setup_initrd_tag (bd_t *bd, ulong initrd_start,
48                               ulong initrd_end);
49 # endif
50 static void setup_end_tag (bd_t *bd);
51
52 # if defined (CONFIG_VFD) || defined (CONFIG_LCD)
53 static void setup_videolfb_tag (gd_t *gd);
54 # endif
55
56 static struct tag *params;
57 #endif /* CONFIG_SETUP_MEMORY_TAGS || CONFIG_CMDLINE_TAG || CONFIG_INITRD_TAG */
58
59 extern int do_reset (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]);
60
61 void do_bootm_linux (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[],
62                      bootm_headers_t *images)
63 {
64         ulong   initrd_start, initrd_end;
65         bd_t    *bd = gd->bd;
66         char    *s;
67         int     machid = bd->bi_arch_number;
68         void    (*theKernel)(int zero, int arch, uint params);
69         int     ret;
70
71 #ifdef CONFIG_CMDLINE_TAG
72         char *commandline = getenv ("bootargs");
73 #endif
74
75         theKernel = (void (*)(int, int, uint))images->ep;
76
77         s = getenv ("machid");
78         if (s) {
79                 machid = simple_strtoul (s, NULL, 16);
80                 printf ("Using machid 0x%x from environment\n", machid);
81         }
82
83         ret = boot_get_ramdisk (argc, argv, images, IH_ARCH_ARM,
84                         &initrd_start, &initrd_end);
85         if (ret)
86                 goto error;
87
88         show_boot_progress (15);
89
90         debug ("## Transferring control to Linux (at address %08lx) ...\n",
91                (ulong) theKernel);
92
93 #if defined (CONFIG_SETUP_MEMORY_TAGS) || \
94     defined (CONFIG_CMDLINE_TAG) || \
95     defined (CONFIG_INITRD_TAG) || \
96     defined (CONFIG_SERIAL_TAG) || \
97     defined (CONFIG_REVISION_TAG) || \
98     defined (CONFIG_LCD) || \
99     defined (CONFIG_VFD)
100         setup_start_tag (bd);
101 #ifdef CONFIG_SERIAL_TAG
102         setup_serial_tag (&params);
103 #endif
104 #ifdef CONFIG_REVISION_TAG
105         setup_revision_tag (&params);
106 #endif
107 #ifdef CONFIG_SETUP_MEMORY_TAGS
108         setup_memory_tags (bd);
109 #endif
110 #ifdef CONFIG_CMDLINE_TAG
111         setup_commandline_tag (bd, commandline);
112 #endif
113 #ifdef CONFIG_INITRD_TAG
114         if (initrd_start && initrd_end)
115                 setup_initrd_tag (bd, initrd_start, initrd_end);
116 #endif
117 #if defined (CONFIG_VFD) || defined (CONFIG_LCD)
118         setup_videolfb_tag ((gd_t *) gd);
119 #endif
120         setup_end_tag (bd);
121 #endif
122
123         /* we assume that the kernel is in place */
124         printf ("\nStarting kernel ...\n\n");
125
126 #ifdef CONFIG_USB_DEVICE
127         {
128                 extern void udc_disconnect (void);
129                 udc_disconnect ();
130         }
131 #endif
132
133         cleanup_before_linux ();
134
135         theKernel (0, machid, bd->bi_boot_params);
136         /* does not return */
137         return;
138
139 error:
140         do_reset (cmdtp, flag, argc, argv);
141         return;
142 }
143
144
145 #if defined (CONFIG_SETUP_MEMORY_TAGS) || \
146     defined (CONFIG_CMDLINE_TAG) || \
147     defined (CONFIG_INITRD_TAG) || \
148     defined (CONFIG_SERIAL_TAG) || \
149     defined (CONFIG_REVISION_TAG) || \
150     defined (CONFIG_LCD) || \
151     defined (CONFIG_VFD)
152 static void setup_start_tag (bd_t *bd)
153 {
154         params = (struct tag *) bd->bi_boot_params;
155
156         params->hdr.tag = ATAG_CORE;
157         params->hdr.size = tag_size (tag_core);
158
159         params->u.core.flags = 0;
160         params->u.core.pagesize = 0;
161         params->u.core.rootdev = 0;
162
163         params = tag_next (params);
164 }
165
166
167 #ifdef CONFIG_SETUP_MEMORY_TAGS
168 static void setup_memory_tags (bd_t *bd)
169 {
170         int i;
171
172         for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) {
173                 params->hdr.tag = ATAG_MEM;
174                 params->hdr.size = tag_size (tag_mem32);
175
176                 params->u.mem.start = bd->bi_dram[i].start;
177                 params->u.mem.size = bd->bi_dram[i].size;
178
179                 params = tag_next (params);
180         }
181 }
182 #endif /* CONFIG_SETUP_MEMORY_TAGS */
183
184
185 static void setup_commandline_tag (bd_t *bd, char *commandline)
186 {
187         char *p;
188
189         if (!commandline)
190                 return;
191
192         /* eat leading white space */
193         for (p = commandline; *p == ' '; p++);
194
195         /* skip non-existent command lines so the kernel will still
196          * use its default command line.
197          */
198         if (*p == '\0')
199                 return;
200
201         params->hdr.tag = ATAG_CMDLINE;
202         params->hdr.size =
203                 (sizeof (struct tag_header) + strlen (p) + 1 + 4) >> 2;
204
205         strcpy (params->u.cmdline.cmdline, p);
206
207         params = tag_next (params);
208 }
209
210
211 #ifdef CONFIG_INITRD_TAG
212 static void setup_initrd_tag (bd_t *bd, ulong initrd_start, ulong initrd_end)
213 {
214         /* an ATAG_INITRD node tells the kernel where the compressed
215          * ramdisk can be found. ATAG_RDIMG is a better name, actually.
216          */
217         params->hdr.tag = ATAG_INITRD2;
218         params->hdr.size = tag_size (tag_initrd);
219
220         params->u.initrd.start = initrd_start;
221         params->u.initrd.size = initrd_end - initrd_start;
222
223         params = tag_next (params);
224 }
225 #endif /* CONFIG_INITRD_TAG */
226
227
228 #if defined (CONFIG_VFD) || defined (CONFIG_LCD)
229 extern ulong calc_fbsize (void);
230 static void setup_videolfb_tag (gd_t *gd)
231 {
232         /* An ATAG_VIDEOLFB node tells the kernel where and how large
233          * the framebuffer for video was allocated (among other things).
234          * Note that a _physical_ address is passed !
235          *
236          * We only use it to pass the address and size, the other entries
237          * in the tag_videolfb are not of interest.
238          */
239         params->hdr.tag = ATAG_VIDEOLFB;
240         params->hdr.size = tag_size (tag_videolfb);
241
242         params->u.videolfb.lfb_base = (u32) gd->fb_base;
243         /* Fb size is calculated according to parameters for our panel
244          */
245         params->u.videolfb.lfb_size = calc_fbsize();
246
247         params = tag_next (params);
248 }
249 #endif /* CONFIG_VFD || CONFIG_LCD */
250
251 #ifdef CONFIG_SERIAL_TAG
252 void setup_serial_tag (struct tag **tmp)
253 {
254         struct tag *params = *tmp;
255         struct tag_serialnr serialnr;
256         void get_board_serial(struct tag_serialnr *serialnr);
257
258         get_board_serial(&serialnr);
259         params->hdr.tag = ATAG_SERIAL;
260         params->hdr.size = tag_size (tag_serialnr);
261         params->u.serialnr.low = serialnr.low;
262         params->u.serialnr.high= serialnr.high;
263         params = tag_next (params);
264         *tmp = params;
265 }
266 #endif
267
268 #ifdef CONFIG_REVISION_TAG
269 void setup_revision_tag(struct tag **in_params)
270 {
271         u32 rev = 0;
272         u32 get_board_rev(void);
273
274         rev = get_board_rev();
275         params->hdr.tag = ATAG_REVISION;
276         params->hdr.size = tag_size (tag_revision);
277         params->u.revision.rev = rev;
278         params = tag_next (params);
279 }
280 #endif  /* CONFIG_REVISION_TAG */
281
282
283 static void setup_end_tag (bd_t *bd)
284 {
285         params->hdr.tag = ATAG_NONE;
286         params->hdr.size = 0;
287 }
288
289 #endif /* CONFIG_SETUP_MEMORY_TAGS || CONFIG_CMDLINE_TAG || CONFIG_INITRD_TAG */