[mirror_ubuntu-focal-kernel.git] / arch / ia64 / hp / sim / boot / bootloader.c

/*
 * arch/ia64/hp/sim/boot/bootloader.c
 *
 * Loads an ELF kernel.
 *
 * Copyright (C) 1998-2003 Hewlett-Packard Co
 *	David Mosberger-Tang <davidm@hpl.hp.com>
 *	Stephane Eranian <eranian@hpl.hp.com>
 *
 * 01/07/99 S.Eranian modified to pass command line arguments to kernel
 */
struct task_struct;	/* forward declaration for elf.h */

#include <linux/config.h>
#include <linux/elf.h>
#include <linux/init.h>
#include <linux/kernel.h>

#include <asm/elf.h>
#include <asm/intrinsics.h>
#include <asm/pal.h>
#include <asm/pgtable.h>
#include <asm/sal.h>
#include <asm/system.h>

#include "ssc.h"

struct disk_req {
	unsigned long addr;
	unsigned len;
};

/* SSC_WAIT_COMPLETION appears to want this large alignment.  gcc < 4
 * seems to give it by default, however gcc > 4 is smarter and may
 * not.
 */
struct disk_stat {
	int fd;
	unsigned count;
} __attribute__ ((aligned (16)));

extern void jmp_to_kernel (unsigned long bp, unsigned long e_entry);
extern struct ia64_boot_param *sys_fw_init (const char *args, int arglen);
extern void debug_break (void);

static void
cons_write (const char *buf)
{
	unsigned long ch;

	while ((ch = *buf++) != '\0') {
		ssc(ch, 0, 0, 0, SSC_PUTCHAR);
		if (ch == '\n')
		  ssc('\r', 0, 0, 0, SSC_PUTCHAR);
	}
}

#define MAX_ARGS 32

void
start_bootloader (void)
{
	static char mem[4096];
	static char buffer[1024];
	unsigned long off;
	int fd, i;
	struct disk_req req;
	struct disk_stat stat;
	struct elfhdr *elf;
	struct elf_phdr *elf_phdr;	/* program header */
	unsigned long e_entry, e_phoff, e_phnum;
	register struct ia64_boot_param *bp;
	char *kpath, *args;
	long arglen = 0;

	ssc(0, 0, 0, 0, SSC_CONSOLE_INIT);

	/*
	 * S.Eranian: extract the commandline argument from the simulator
	 *
	 * The expected format is as follows:
         *
	 *	kernelname args...
	 *
	 * Both are optional but you can't have the second one without the first.
	 */
	arglen = ssc((long) buffer, 0, 0, 0, SSC_GET_ARGS);

	kpath = "vmlinux";
	args = buffer;
	if (arglen > 0) {
		kpath = buffer;
		while (*args != ' ' && *args != '\0')
			++args, --arglen;
		if (*args == ' ')
			*args++ = '\0', --arglen;
	}

	if (arglen <= 0) {
		args = "";
		arglen = 1;
	}

	fd = ssc((long) kpath, 1, 0, 0, SSC_OPEN);

	if (fd < 0) {
		cons_write(kpath);
		cons_write(": file not found, reboot now\n");
		for(;;);
	}
	stat.fd = fd;
	off = 0;

	req.len = sizeof(mem);
	req.addr = (long) mem;
	ssc(fd, 1, (long) &req, off, SSC_READ);
	ssc((long) &stat, 0, 0, 0, SSC_WAIT_COMPLETION);

	elf = (struct elfhdr *) mem;
	if (elf->e_ident[0] == 0x7f && strncmp(elf->e_ident + 1, "ELF", 3) != 0) {
		cons_write("not an ELF file\n");
		return;
	}
	if (elf->e_type != ET_EXEC) {
		cons_write("not an ELF executable\n");
		return;
	}
	if (!elf_check_arch(elf)) {
		cons_write("kernel not for this processor\n");
		return;
	}

	e_entry = elf->e_entry;
	e_phnum = elf->e_phnum;
	e_phoff = elf->e_phoff;

	cons_write("loading ");
	cons_write(kpath);
	cons_write("...\n");

	for (i = 0; i < e_phnum; ++i) {
		req.len = sizeof(*elf_phdr);
		req.addr = (long) mem;
		ssc(fd, 1, (long) &req, e_phoff, SSC_READ);
		ssc((long) &stat, 0, 0, 0, SSC_WAIT_COMPLETION);
		if (stat.count != sizeof(*elf_phdr)) {
			cons_write("failed to read phdr\n");
			return;
		}
		e_phoff += sizeof(*elf_phdr);

		elf_phdr = (struct elf_phdr *) mem;

		if (elf_phdr->p_type != PT_LOAD)
			continue;

		req.len = elf_phdr->p_filesz;
		req.addr = __pa(elf_phdr->p_paddr);
		ssc(fd, 1, (long) &req, elf_phdr->p_offset, SSC_READ);
		ssc((long) &stat, 0, 0, 0, SSC_WAIT_COMPLETION);
		memset((char *)__pa(elf_phdr->p_paddr) + elf_phdr->p_filesz, 0,
		       elf_phdr->p_memsz - elf_phdr->p_filesz);
	}
	ssc(fd, 0, 0, 0, SSC_CLOSE);

	cons_write("starting kernel...\n");

	/* fake an I/O base address: */
	ia64_setreg(_IA64_REG_AR_KR0, 0xffffc000000UL);

	bp = sys_fw_init(args, arglen);

	ssc(0, (long) kpath, 0, 0, SSC_LOAD_SYMBOLS);

	debug_break();
	jmp_to_kernel((unsigned long) bp, e_entry);

	cons_write("kernel returned!\n");
	ssc(-1, 0, 0, 0, SSC_EXIT);
}
Commit	Line	Data
1da177e4 LT	1	/*
	2	* arch/ia64/hp/sim/boot/bootloader.c
	3	*
	4	* Loads an ELF kernel.
	5	*
	6	* Copyright (C) 1998-2003 Hewlett-Packard Co
	7	* David Mosberger-Tang <davidm@hpl.hp.com>
	8	* Stephane Eranian <eranian@hpl.hp.com>
	9	*
	10	* 01/07/99 S.Eranian modified to pass command line arguments to kernel
	11	*/
	12	struct task_struct; /* forward declaration for elf.h */
	13
	14	#include <linux/config.h>
	15	#include <linux/elf.h>
	16	#include <linux/init.h>
	17	#include <linux/kernel.h>
	18
	19	#include <asm/elf.h>
	20	#include <asm/intrinsics.h>
	21	#include <asm/pal.h>
	22	#include <asm/pgtable.h>
	23	#include <asm/sal.h>
	24	#include <asm/system.h>
	25
	26	#include "ssc.h"
	27
	28	struct disk_req {
	29	unsigned long addr;
	30	unsigned len;
	31	};
	32
4aec0fb1 IW	33	/* SSC_WAIT_COMPLETION appears to want this large alignment. gcc < 4
	34	* seems to give it by default, however gcc > 4 is smarter and may
	35	* not.
	36	*/
1da177e4 LT	37	struct disk_stat {
	38	int fd;
	39	unsigned count;
4aec0fb1	40	} __attribute__ ((aligned (16)));
1da177e4 LT	41
	42	extern void jmp_to_kernel (unsigned long bp, unsigned long e_entry);
	43	extern struct ia64_boot_param sys_fw_init (const char args, int arglen);
	44	extern void debug_break (void);
	45
	46	static void
	47	cons_write (const char *buf)
	48	{
	49	unsigned long ch;
	50
	51	while ((ch = *buf++) != '\0') {
	52	ssc(ch, 0, 0, 0, SSC_PUTCHAR);
	53	if (ch == '\n')
	54	ssc('\r', 0, 0, 0, SSC_PUTCHAR);
	55	}
	56	}
	57
	58	#define MAX_ARGS 32
	59
	60	void
	61	start_bootloader (void)
	62	{
	63	static char mem[4096];
	64	static char buffer[1024];
	65	unsigned long off;
	66	int fd, i;
	67	struct disk_req req;
	68	struct disk_stat stat;
	69	struct elfhdr *elf;
	70	struct elf_phdr elf_phdr; / program header */
	71	unsigned long e_entry, e_phoff, e_phnum;
	72	register struct ia64_boot_param *bp;
	73	char kpath, args;
	74	long arglen = 0;
	75
	76	ssc(0, 0, 0, 0, SSC_CONSOLE_INIT);
	77
	78	/*
	79	* S.Eranian: extract the commandline argument from the simulator
	80	*
	81	* The expected format is as follows:
	82	*
	83	* kernelname args...
	84	*
	85	* Both are optional but you can't have the second one without the first.
	86	*/
	87	arglen = ssc((long) buffer, 0, 0, 0, SSC_GET_ARGS);
	88
	89	kpath = "vmlinux";
	90	args = buffer;
	91	if (arglen > 0) {
	92	kpath = buffer;
	93	while (args != ' ' && args != '\0')
	94	++args, --arglen;
	95	if (*args == ' ')
	96	*args++ = '\0', --arglen;
	97	}
	98
	99	if (arglen <= 0) {
	100	args = "";
	101	arglen = 1;
	102	}
	103
	104	fd = ssc((long) kpath, 1, 0, 0, SSC_OPEN);
105
106	if (fd < 0) {
107	cons_write(kpath);
108	cons_write(": file not found, reboot now\n");
109	for(;;);
110	}
111	stat.fd = fd;
112	off = 0;
113
114	req.len = sizeof(mem);
115	req.addr = (long) mem;
116	ssc(fd, 1, (long) &req, off, SSC_READ);
117	ssc((long) &stat, 0, 0, 0, SSC_WAIT_COMPLETION);
118
119	elf = (struct elfhdr *) mem;
120	if (elf->e_ident[0] == 0x7f && strncmp(elf->e_ident + 1, "ELF", 3) != 0) {
121	cons_write("not an ELF file\n");
122	return;
123	}
124	if (elf->e_type != ET_EXEC) {
125	cons_write("not an ELF executable\n");
126	return;
127	}
128	if (!elf_check_arch(elf)) {
129	cons_write("kernel not for this processor\n");
130	return;
131	}
132
133	e_entry = elf->e_entry;
134	e_phnum = elf->e_phnum;
135	e_phoff = elf->e_phoff;
136
137	cons_write("loading ");
138	cons_write(kpath);
139	cons_write("...\n");
140
141	for (i = 0; i < e_phnum; ++i) {
142	req.len = sizeof(*elf_phdr);
143	req.addr = (long) mem;
144	ssc(fd, 1, (long) &req, e_phoff, SSC_READ);
145	ssc((long) &stat, 0, 0, 0, SSC_WAIT_COMPLETION);
146	if (stat.count != sizeof(*elf_phdr)) {
147	cons_write("failed to read phdr\n");
148	return;
149	}
150	e_phoff += sizeof(*elf_phdr);
151
152	elf_phdr = (struct elf_phdr *) mem;
153
154	if (elf_phdr->p_type != PT_LOAD)
155	continue;
156
157	req.len = elf_phdr->p_filesz;
158	req.addr = __pa(elf_phdr->p_paddr);
159	ssc(fd, 1, (long) &req, elf_phdr->p_offset, SSC_READ);
160	ssc((long) &stat, 0, 0, 0, SSC_WAIT_COMPLETION);
161	memset((char *)__pa(elf_phdr->p_paddr) + elf_phdr->p_filesz, 0,
162	elf_phdr->p_memsz - elf_phdr->p_filesz);
163	}
164	ssc(fd, 0, 0, 0, SSC_CLOSE);
165
166	cons_write("starting kernel...\n");
167
168	/* fake an I/O base address: */
169	ia64_setreg(_IA64_REG_AR_KR0, 0xffffc000000UL);
170
171	bp = sys_fw_init(args, arglen);
172
173	ssc(0, (long) kpath, 0, 0, SSC_LOAD_SYMBOLS);
174
175	debug_break();
176	jmp_to_kernel((unsigned long) bp, e_entry);
177
178	cons_write("kernel returned!\n");
179	ssc(-1, 0, 0, 0, SSC_EXIT);
180	}