kexec-tools: Add sh support

Patch found on 
http://eggplant.ddo.jp/www/download/debian26/source/kexec-tools/kexec-tools_1.101-2sh.diff.gz

According to Paul Mundt <lethal@linux-sh.org> it was originally by
kogiidena <kogiidena@eggplant.ddo.jp>

Signed-off-by: Simon Horman <horms@verge.net.au>
Acked-by: Magnus Damm <magnus.damm@gmail.com>

1 files changed, 153 insertions, 0 deletions

diff --git a/kexec/arch/sh/kexec-netbsd-sh.c b/kexec/arch/sh/kexec-netbsd-sh.c
new file mode 100644
index 0000000..935338e
--- /dev/null
+++ b/kexec/arch/sh/kexec-netbsd-sh.c
@@ -0,0 +1,153 @@
+/*
+ * 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 <sys/mman.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>
+#include <asm/page.h>
+
+static const int probe_debug = 0;
+const extern unsigned char netbsd_booter[];
+
+#define PAGE_ALIGN(addr)        (((addr)+PAGE_SIZE-1)&PAGE_MASK)
+
+/*
+ * 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 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 len,
+	struct kexec_info *info)
+{
+	const char *howto, *miniroot;
+	unsigned long entry, start, size;
+	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);
+	}
+
+	/* 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  = PAGE_ALIGN(size);
+		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 = PAGE_ALIGN(miniroot_length);
+		add_segment(info, miniroot_buf, size, start, size);
+		start += size;
+	}
+
+	/* howto & bootinfo */
+	param  = xmalloc(4096);
+	memset(param, 0, 4096);
+	paraml = (unsigned long *) &param[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;
+}