zimage.c 6.07 KB
Newer Older
1 2 3
/*
 * (C) Copyright 2002
 * Daniel Engstrm, Omicron Ceti AB, daniel@omicron.se
wdenk's avatar
wdenk committed
4
 *
5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
 * See file CREDITS for list of people who contributed to this
 * project.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of
 * the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 * MA 02111-1307 USA
 */

wdenk's avatar
wdenk committed
24
/*
25
 * Linux i386 zImage and bzImage loading
wdenk's avatar
wdenk committed
26 27
 *
 * based on the procdure described in
28 29 30 31 32 33 34 35 36 37 38 39
 * linux/Documentation/i386/boot.txt
 */

#include <common.h>
#include <asm/io.h>
#include <asm/ptrace.h>
#include <asm/zimage.h>
#include <asm/realmode.h>
#include <asm/byteorder.h>

/*
 * Memory lay-out:
wdenk's avatar
wdenk committed
40
 *
41
 * relative to setup_base (which is 0x90000 currently)
wdenk's avatar
wdenk committed
42 43
 *
 *	0x0000-0x7FFF	Real mode kernel
44 45 46 47 48 49 50 51 52 53 54 55
 *	0x8000-0x8FFF	Stack and heap
 *	0x9000-0x90FF	Kernel command line
 */
#define DEFAULT_SETUP_BASE  0x90000
#define COMMAND_LINE_OFFSET 0x9000
#define HEAP_END_OFFSET     0x8e00

#define COMMAND_LINE_SIZE   2048

static void build_command_line(char *command_line, int auto_boot)
{
	char *env_command_line;
wdenk's avatar
wdenk committed
56

57
	command_line[0] = '\0';
wdenk's avatar
wdenk committed
58

59
	env_command_line =  getenv("bootargs");
wdenk's avatar
wdenk committed
60

61 62 63
	/* set console= argument if we use a serial console */
	if (NULL == strstr(env_command_line, "console=")) {
		if (0==strcmp(getenv("stdout"), "serial")) {
wdenk's avatar
wdenk committed
64

65
			/* We seem to use serial console */
wdenk's avatar
wdenk committed
66
			sprintf(command_line, "console=ttyS0,%s ",
67 68 69
				 getenv("baudrate"));
		}
	}
wdenk's avatar
wdenk committed
70

71 72 73
	if (auto_boot) {
		strcat(command_line, "auto ");
	}
wdenk's avatar
wdenk committed
74

75 76
	if (NULL != env_command_line) {
		strcat(command_line, env_command_line);
wdenk's avatar
wdenk committed
77 78 79
	}


80 81 82
	printf("Kernel command line: \"%s\"\n", command_line);
}

wdenk's avatar
wdenk committed
83
void *load_zimage(char *image, unsigned long kernel_size,
84 85 86
		  unsigned long initrd_addr, unsigned long initrd_size,
		  int auto_boot)
{
wdenk's avatar
wdenk committed
87
	void *setup_base;
88 89 90 91
	int setup_size;
	int bootproto;
	int big_image;
	void *load_address;
wdenk's avatar
wdenk committed
92 93


94
	setup_base = (void*)DEFAULT_SETUP_BASE;	/* base address for real-mode segment */
wdenk's avatar
wdenk committed
95 96

	if (KERNEL_MAGIC != *(u16*)(image + BOOT_FLAG_OFF)) {
97 98 99 100
		printf("Error: Invalid kernel magic (found 0x%04x, expected 0xaa55)\n",
		       *(u16*)(image + BOOT_FLAG_OFF));
		return 0;
	}
wdenk's avatar
wdenk committed
101 102


103 104 105 106 107 108 109
	/* determine boot protocol version */
	if (KERNEL_V2_MAGIC == *(u32*)(image+HEADER_OFF)) {
		bootproto = *(u16*)(image+VERSION_OFF);
	} else {
		/* Very old kernel */
		bootproto = 0x0100;
	}
wdenk's avatar
wdenk committed
110

111 112 113 114 115 116
	/* determine size of setup */
	if (0 == *(u8*)(image + SETUP_SECTS_OFF)) {
		setup_size = 5 * 512;
	} else {
		setup_size = (*(u8*)(image + SETUP_SECTS_OFF) + 1) * 512;
	}
wdenk's avatar
wdenk committed
117

118 119 120
	if (setup_size > SETUP_MAX_SIZE) {
		printf("Error: Setup is too large (%d bytes)\n", setup_size);
	}
wdenk's avatar
wdenk committed
121

122
	/* Determine image type */
wdenk's avatar
wdenk committed
123 124
	big_image = (bootproto >= 0x0200) && (*(u8*)(image + LOADFLAGS_OFF) & BIG_KERNEL_FLAG);

125 126
	/* Derermine load address */
	load_address = (void*)(big_image ? BZIMAGE_LOAD_ADDR:ZIMAGE_LOAD_ADDR);
wdenk's avatar
wdenk committed
127

128 129
	/* load setup */
	memmove(setup_base, image, setup_size);
wdenk's avatar
wdenk committed
130 131

	printf("Using boot protocol version %x.%02x\n",
132
	       (bootproto & 0xff00) >> 8, bootproto & 0xff);
wdenk's avatar
wdenk committed
133 134 135 136


	if (bootproto == 0x0100) {

137
		*(u16*)(setup_base + CMD_LINE_MAGIC_OFF) = COMMAND_LINE_MAGIC;
wdenk's avatar
wdenk committed
138 139
		*(u16*)(setup_base + CMD_LINE_OFFSET_OFF) = COMMAND_LINE_OFFSET;

140 141
		/* A very old kernel MUST have its real-mode code
		 * loaded at 0x90000 */
wdenk's avatar
wdenk committed
142

143 144 145 146
		if ((u32)setup_base != 0x90000) {
			/* Copy the real-mode kernel */
			memmove((void*)0x90000, setup_base, setup_size);
			/* Copy the command line */
wdenk's avatar
wdenk committed
147
			memmove((void*)0x99000, setup_base+COMMAND_LINE_OFFSET,
148
			       COMMAND_LINE_SIZE);
wdenk's avatar
wdenk committed
149

150 151
			setup_base = (void*)0x90000;		 /* Relocated */
		}
wdenk's avatar
wdenk committed
152

153 154 155
		/* It is recommended to clear memory up to the 32K mark */
		memset((void*)0x90000 + setup_size, 0, SETUP_MAX_SIZE-setup_size);
	}
wdenk's avatar
wdenk committed
156

157 158
	if (bootproto >= 0x0200) {
		*(u8*)(setup_base + TYPE_OF_LOADER_OFF) = 0xff;
wdenk's avatar
wdenk committed
159 160
		printf("Linux kernel version %s\n",
		       (char*)(setup_base + SETUP_START_OFFSET +
161
			       *(u16*)(setup_base + START_SYS_OFF + 2)));
wdenk's avatar
wdenk committed
162

163 164 165
		if (initrd_addr) {
			printf("Initial RAM disk at linear address 0x%08lx, size %ld bytes\n",
			       initrd_addr, initrd_size);
wdenk's avatar
wdenk committed
166

167 168 169 170
			*(u32*)(setup_base + RAMDISK_IMAGE_OFF) = initrd_addr;
			*(u32*)(setup_base + RAMDISK_SIZE_OFF)=initrd_size;
		}
	}
wdenk's avatar
wdenk committed
171

172 173
	if (bootproto >= 0x0201) {
		*(u16*)(setup_base + HEAP_END_PTR_OFF) = HEAP_END_OFFSET;
wdenk's avatar
wdenk committed
174

175
		/* CAN_USE_HEAP */
wdenk's avatar
wdenk committed
176
		*(u8*)(setup_base + LOADFLAGS_OFF) =
177 178
			*(u8*)(setup_base + LOADFLAGS_OFF) | HEAP_FLAG;
	}
wdenk's avatar
wdenk committed
179

180 181 182 183
	if (bootproto >= 0x0202) {
		*(u32*)(setup_base + CMD_LINE_PTR_OFF) = (u32)setup_base + COMMAND_LINE_OFFSET;
	} else if (bootproto >= 0x0200) {
		*(u16*)(setup_base + CMD_LINE_MAGIC_OFF) = COMMAND_LINE_MAGIC;
wdenk's avatar
wdenk committed
184
		*(u16*)(setup_base + CMD_LINE_OFFSET_OFF) = COMMAND_LINE_OFFSET;
185 186 187
		*(u16*)(setup_base + SETUP_MOVE_SIZE_OFF) = 0x9100;
	}

wdenk's avatar
wdenk committed
188

189
	if (big_image) {
wdenk's avatar
wdenk committed
190
		if ((kernel_size - setup_size) > BZIMAGE_MAX_SIZE) {
191 192 193 194
			printf("Error: bzImage kernel too big! (size: %ld, max: %d)\n",
			       kernel_size - setup_size, BZIMAGE_MAX_SIZE);
			return 0;
		}
wdenk's avatar
wdenk committed
195

196 197 198 199 200
	} else if ((kernel_size - setup_size) > ZIMAGE_MAX_SIZE) {
		printf("Error: zImage kernel too big! (size: %ld, max: %d)\n",
		       kernel_size - setup_size, ZIMAGE_MAX_SIZE);
		return 0;
	}
wdenk's avatar
wdenk committed
201

202 203
	/* build command line at COMMAND_LINE_OFFSET */
	build_command_line(setup_base + COMMAND_LINE_OFFSET, auto_boot);
wdenk's avatar
wdenk committed
204 205

	printf("Loading %czImage at address 0x%08x (%ld bytes)\n", big_image ? 'b' : ' ',
206 207
	       (u32)load_address, kernel_size - setup_size);

wdenk's avatar
wdenk committed
208

209
	memmove(load_address, image + setup_size, kernel_size - setup_size);
wdenk's avatar
wdenk committed
210

211 212 213 214 215 216 217
	/* ready for booting */
	return setup_base;
}

void boot_zimage(void *setup_base)
{
	struct pt_regs regs;
wdenk's avatar
wdenk committed
218

219 220
	memset(&regs, 0, sizeof(struct pt_regs));
	regs.xds = (u32)setup_base >> 4;
wdenk's avatar
wdenk committed
221 222
	regs.xss = 0x9000;
	regs.esp = 0x9000;
223 224 225
	regs.eflags = 0;
	enter_realmode(((u32)setup_base+SETUP_START_OFFSET)>>4, 0, &regs, &regs);
}