1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
|
/*
* kexec-netbsd-sh.c - kexec netbsd loader for the SH
* Copyright (C) 2005 kogiidena@eggplant.ddo.jp
*
* This source code is licensed under the GNU General Public License,
* Version 2. See the file COPYING for more details.
*/
#define _GNU_SOURCE
#include <stddef.h>
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <errno.h>
#include <stdint.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <unistd.h>
#include <getopt.h>
#include <elf.h>
#include <boot/elf_boot.h>
#include <ip_checksum.h>
#include "../../kexec.h"
#include "../../kexec-elf.h"
#include <arch/options.h>
static const int probe_debug = 0;
extern const unsigned char netbsd_booter[];
/*
* netbsd_sh_probe - sanity check the elf image
*
* Make sure that the file image has a reasonable chance of working.
*/
int netbsd_sh_probe(const char *buf, off_t UNUSED(len))
{
Elf32_Ehdr *ehdr;
ehdr = (Elf32_Ehdr *)buf;
if(memcmp(buf, ELFMAG, SELFMAG) != 0){
return -1;
}
if (ehdr->e_machine != EM_SH) {
return -1;
}
return 0;
}
void netbsd_sh_usage(void)
{
printf(
" --howto=VALUE NetBSD kernel boot option.\n"
" --miniroot=FILE NetBSD miniroot ramdisk.\n\n");
}
int netbsd_sh_load(int argc, char **argv, const char *buf, off_t UNUSED(len),
struct kexec_info *info)
{
const char *howto, *miniroot;
unsigned long entry, start, size, psz;
char *miniroot_buf;
off_t miniroot_length;
unsigned int howto_value;
unsigned char *param;
unsigned long *paraml;
unsigned char *img;
int opt;
static const struct option options[] = {
KEXEC_ARCH_OPTIONS
{0, 0, 0, 0},
};
static const char short_options[] = KEXEC_ARCH_OPT_STR "";
howto = miniroot = 0;
while ((opt = getopt_long(argc, argv, short_options, options, 0)) != -1) {
switch (opt) {
default:
/* Ignore core options */
if (opt < OPT_ARCH_MAX) {
break;
}
case '?':
usage();
return -1;
case OPT_NBSD_HOWTO:
howto = optarg;
break;
case OPT_NBSD_MROOT:
miniroot = optarg;
break;
}
}
/* howto */
howto_value = 0;
if(howto){
howto_value = strtol(howto, NULL, 0);
}
psz = getpagesize();
/* Parse the Elf file */
{
Elf32_Ehdr *ehdr;
Elf32_Phdr *phdr;
unsigned long bbs;
ehdr = (Elf32_Ehdr *)buf;
phdr = (Elf32_Phdr *)&buf[ehdr->e_phoff];
entry = ehdr->e_entry;
img = (unsigned char *)&buf[phdr->p_offset];
start = (phdr->p_paddr) & 0x1fffffff;
bbs = phdr->p_filesz;
size = phdr->p_memsz;
if(size < bbs){
size = bbs;
}
size = (size + psz - 1) & ~(psz - 1);
memset(&img[bbs], 0, size-bbs);
add_segment(info, img, size, start, size);
start += size;
}
/* miniroot file */
miniroot_buf = 0;
if (miniroot) {
miniroot_buf = slurp_file(miniroot, &miniroot_length);
howto_value |= 0x200;
size = (miniroot_length + psz - 1) & ~(psz - 1);
add_segment(info, miniroot_buf, size, start, size);
start += size;
}
/* howto & bootinfo */
param = xmalloc(4096);
memset(param, 0, 4096);
paraml = (unsigned long *) ¶m[256];
memcpy(param, netbsd_booter, 256);
paraml[0] = entry;
paraml[1] = howto_value;
add_segment(info, param, 4096, start, 4096);
/* For now we don't have arguments to pass :( */
info->entry = (void *) (start | 0xa0000000);
return 0;
}
|
