Initial linux protocol support
diff --git a/bochsrc b/bochsrc
index 9201dec8..8b69e354 100644
--- a/bochsrc
+++ b/bochsrc
@@ -6,7 +6,7 @@ megs: 512
clock: sync=realtime, time0=local
-ata0-master: type=disk, path="qloader2.bin", mode=flat
+ata0-master: type=disk, path="test.img", mode=flat
boot: c
diff --git a/src/main.c b/src/main.c
index c1fd277a..4afcc2d8 100644
--- a/src/main.c
+++ b/src/main.c
@@ -15,6 +15,7 @@ asm (
#include <sys/interrupt.h>
#include <lib/elf.h>
#include <protos/stivale.h>
+#include <protos/linux.h>
extern symbol bss_begin;
extern symbol bss_end;
@@ -89,6 +90,8 @@ void main(int boot_drive) {
if (!strcmp(proto, "stivale")) {
stivale_load(&f, cmdline);
+ } else if (!strcmp(proto, "linux")) {
+ linux_load(&f, cmdline);
} else if (!strcmp(proto, "qword")) {
fread(&f, (void *)0x100000, 0, f.size);
// Boot the kernel.
diff --git a/src/protos/linux.c b/src/protos/linux.c
new file mode 100644
index 00000000..91900bef
--- /dev/null
+++ b/src/protos/linux.c
@@ -0,0 +1,142 @@
+#include <stdint.h>
+#include <stddef.h>
+#include <protos/linux.h>
+#include <fs/file.h>
+#include <lib/blib.h>
+#include <lib/real.h>
+
+void linux_load(struct file_handle *fd, char *cmdline) {
+ uint32_t signature;
+ fread(fd, &signature, 0x202, sizeof(uint32_t));
+
+ // validate signature
+ if (signature != 0x53726448) {
+ panic("Invalid Linux kernel signature");
+ }
+
+ size_t setup_code_size = 0;
+ fread(fd, &setup_code_size, 0x1f1, 1);
+
+ if (setup_code_size == 0)
+ setup_code_size = 4;
+
+ setup_code_size *= 512;
+
+ print("linux: Setup code size: %x\n", setup_code_size);
+
+ size_t real_mode_code_size = 512 + setup_code_size;
+
+ print("linux: Real Mode code size: %x\n", real_mode_code_size);
+
+ void *real_mode_code = balloc_aligned(real_mode_code_size, 0x1000);
+
+ fread(fd, real_mode_code, 0, real_mode_code_size);
+
+ size_t heap_end_ptr = ((real_mode_code_size & 0x0f) + 0x10) - 0x200;
+ *((uint16_t *)(real_mode_code + 0x224)) = (uint16_t)heap_end_ptr;
+
+ // vid_mode. 0xffff means "normal"
+ *((uint16_t *)(real_mode_code + 0x1fa)) = 0xffff;
+
+ uint16_t boot_protocol_ver;
+ boot_protocol_ver = *((uint16_t *)(real_mode_code + 0x206));
+
+ print("linux: Boot protocol: %u.%u\n",
+ boot_protocol_ver >> 8, boot_protocol_ver & 0xff);
+
+ char *kernel_version;
+ kernel_version = real_mode_code + *((uint16_t *)(real_mode_code + 0x20e)) + 0x200;
+
+ if (kernel_version) {
+ print("linux: Kernel version: %s\n", kernel_version);
+ }
+
+ // set type of loader
+ *((uint8_t *)(real_mode_code + 0x210)) = 0xff;
+
+ uint8_t loadflags;
+ loadflags = *((uint8_t *)(real_mode_code + 0x211));
+
+ loadflags |= (1 << 0); // kernel is loaded at 0x100000
+ loadflags &= ~(1 << 5); // print early messages
+ loadflags |= (1 << 7); // can use heap
+
+ *((uint8_t *)(real_mode_code + 0x211)) = loadflags;
+
+ // cmdline
+ *((uint32_t *)(real_mode_code + 0x228)) = (uint32_t)cmdline;
+
+ // load kernel
+ print("Loading kernel...\n");
+ fread(fd, (void *)0x100000, real_mode_code_size, fd->size - real_mode_code_size);
+
+ char initrd_path[64];
+ if (!config_get_value(initrd_path, 0, 64, "INITRD_PATH"))
+ panic("INITRD_PATH not specified");
+
+ int initrd_part; {
+ char buf[32];
+ config_get_value(buf, 0, 32, "INITRD_PARTITION");
+ initrd_part = (int)strtoui(buf);
+ }
+
+ struct file_handle initrd;
+ if (fopen(&initrd, fd->disk, initrd_part, initrd_path)) {
+ panic("Failed to open initrd");
+ }
+
+ print("Loading initrd...\n");
+ size_t initrd_addr = 0x1000000;
+ fread(&initrd, (void *)initrd_addr, 0, initrd.size);
+
+ *((uint32_t *)(real_mode_code + 0x218)) = (uint32_t)initrd_addr;
+ *((uint32_t *)(real_mode_code + 0x21c)) = (uint32_t)initrd.size;
+
+ uint16_t real_mode_code_seg = rm_seg(real_mode_code);
+ uint16_t kernel_entry_seg = real_mode_code_seg + 0x20;
+
+ asm volatile (
+ "cli\n\t"
+ "cld\n\t"
+
+ "mov dx, 0x21\n\t"
+ "mov al, byte ptr ds:[rm_pic0_mask]\n\t"
+ "out dx, al\n\t"
+ "mov dx, 0xa1\n\t"
+ "mov al, byte ptr ds:[rm_pic1_mask]\n\t"
+ "out dx, al\n\t"
+
+ "lidt [3f]\n\t"
+
+ "jmp 0x08:1f\n\t"
+ "1: .code16\n\t"
+ "mov ax, 0x10\n\t"
+ "mov ds, ax\n\t"
+ "mov es, ax\n\t"
+ "mov fs, ax\n\t"
+ "mov gs, ax\n\t"
+ "mov ss, ax\n\t"
+ "mov eax, cr0\n\t"
+ "and al, 0xfe\n\t"
+ "mov cr0, eax\n\t"
+ "jmp 0:2f\n\t"
+ "2:\n\t"
+ "mov ds, bx\n\t"
+ "mov es, bx\n\t"
+ "mov fs, bx\n\t"
+ "mov gs, bx\n\t"
+ "mov ss, bx\n\t"
+
+ "mov sp, 0xfdf0\n\t"
+
+ "push cx\n\t"
+ "push 0\n\t"
+ "retf\n\t"
+
+ // rmode IDT
+ "3: .short 0x3ff\n\t"
+ " .long 0\n\t"
+ :
+ : "b" (real_mode_code_seg), "c" (kernel_entry_seg)
+ );
+}
diff --git a/src/protos/linux.h b/src/protos/linux.h
new file mode 100644
index 00000000..3e41f041
--- /dev/null
+++ b/src/protos/linux.h
@@ -0,0 +1,8 @@
+#ifndef __PROTOS__LINUX_H__
+#define __PROTOS__LINUX_H__
+
+#include <fs/file.h>
+
+void linux_load(struct file_handle *fd, char *cmdline);
+
+#endif
