mirror of
https://git.stationery.faith/corn/corn.git
synced 2024-09-19 21:21:41 +00:00
fix whitespace
This commit is contained in:
parent
50fee8495e
commit
690210c944
GPG key ID:
744AB800E383AE52
9 changed files with 381 additions and 384 deletions
4
grub.cfg
4
grub.cfg
|
|
@ -2,6 +2,6 @@ set timeout=1
|
||||||
set default=0
|
set default=0
|
||||||
|
|
||||||
menuentry "corn" {
|
menuentry "corn" {
|
||||||
multiboot2 /boot/kernel.bin
|
multiboot2 /boot/kernel.bin
|
||||||
boot
|
boot
|
||||||
}
|
}
|
||||||
|
|
|
||||||
|
|
@ -1,3 +0,0 @@
|
||||||
#pragma once
|
|
||||||
|
|
||||||
|
|
||||||
|
|
@ -65,79 +65,79 @@ struct xsdt {
|
||||||
|
|
||||||
// generic address structure
|
// generic address structure
|
||||||
struct gas {
|
struct gas {
|
||||||
uint8_t address_space;
|
uint8_t address_space;
|
||||||
uint8_t bit_width;
|
uint8_t bit_width;
|
||||||
uint8_t bit_offset;
|
uint8_t bit_offset;
|
||||||
uint8_t access_size;
|
uint8_t access_size;
|
||||||
uint64_t address;
|
uint64_t address;
|
||||||
};
|
};
|
||||||
|
|
||||||
// fixed acpi description table
|
// fixed acpi description table
|
||||||
struct fadt {
|
struct fadt {
|
||||||
struct acpi_header h;
|
struct acpi_header h;
|
||||||
uint32_t firmware_ctrl;
|
uint32_t firmware_ctrl;
|
||||||
uint32_t dsdt;
|
uint32_t dsdt;
|
||||||
|
|
||||||
// field used in ACPI 1.0; no longer in use, for compatibility only
|
// field used in ACPI 1.0; no longer in use, for compatibility only
|
||||||
uint8_t reserved;
|
uint8_t reserved;
|
||||||
|
|
||||||
uint8_t preferred_power_management_profile;
|
uint8_t preferred_power_management_profile;
|
||||||
uint16_t sci_interrupt;
|
uint16_t sci_interrupt;
|
||||||
uint32_t smi_command_port;
|
uint32_t smi_command_port;
|
||||||
uint8_t acpi_enable;
|
uint8_t acpi_enable;
|
||||||
uint8_t acpi_disable;
|
uint8_t acpi_disable;
|
||||||
uint8_t s4bios_req;
|
uint8_t s4bios_req;
|
||||||
uint8_t pstate_control;
|
uint8_t pstate_control;
|
||||||
uint32_t pm1_a_event_block;
|
uint32_t pm1_a_event_block;
|
||||||
uint32_t pm1_b_event_block;
|
uint32_t pm1_b_event_block;
|
||||||
uint32_t pm1_a_control_block;
|
uint32_t pm1_a_control_block;
|
||||||
uint32_t pm1_b_control_block;
|
uint32_t pm1_b_control_block;
|
||||||
uint32_t pm2_control_block;
|
uint32_t pm2_control_block;
|
||||||
uint32_t pm_timer_block;
|
uint32_t pm_timer_block;
|
||||||
uint32_t gpe0_block;
|
uint32_t gpe0_block;
|
||||||
uint32_t gpe1_block;
|
uint32_t gpe1_block;
|
||||||
uint8_t pm1_event_length;
|
uint8_t pm1_event_length;
|
||||||
uint8_t pm1_control_length;
|
uint8_t pm1_control_length;
|
||||||
uint8_t pm2_control_length;
|
uint8_t pm2_control_length;
|
||||||
uint8_t pm_timer_length;
|
uint8_t pm_timer_length;
|
||||||
uint8_t gpe0_length;
|
uint8_t gpe0_length;
|
||||||
uint8_t gpe1_length;
|
uint8_t gpe1_length;
|
||||||
uint8_t gpe1_base;
|
uint8_t gpe1_base;
|
||||||
uint8_t cstate_control;
|
uint8_t cstate_control;
|
||||||
uint16_t worst_c2_latency;
|
uint16_t worst_c2_latency;
|
||||||
uint16_t worst_c3_latency;
|
uint16_t worst_c3_latency;
|
||||||
uint16_t flush_size;
|
uint16_t flush_size;
|
||||||
uint16_t flush_stride;
|
uint16_t flush_stride;
|
||||||
uint8_t duty_offset;
|
uint8_t duty_offset;
|
||||||
uint8_t duty_width;
|
uint8_t duty_width;
|
||||||
uint8_t day_alarm;
|
uint8_t day_alarm;
|
||||||
uint8_t month_alarm;
|
uint8_t month_alarm;
|
||||||
uint8_t century;
|
uint8_t century;
|
||||||
|
|
||||||
// reserved in ACPI 1.0; used since ACPI 2.0+
|
// reserved in ACPI 1.0; used since ACPI 2.0+
|
||||||
uint16_t boot_architecture_flags;
|
uint16_t boot_architecture_flags;
|
||||||
|
|
||||||
uint8_t reserved_2;
|
uint8_t reserved_2;
|
||||||
uint32_t flags;
|
uint32_t flags;
|
||||||
|
|
||||||
// 12 byte structure; see below for details
|
// 12 byte structure; see below for details
|
||||||
struct gas reset_reg;
|
struct gas reset_reg;
|
||||||
|
|
||||||
uint8_t reset_value;
|
uint8_t reset_value;
|
||||||
uint8_t reserved_3[3];
|
uint8_t reserved_3[3];
|
||||||
|
|
||||||
// 64bit pointers - Available on ACPI 2.0+
|
// 64bit pointers - Available on ACPI 2.0+
|
||||||
uint64_t x_firmware_control;
|
uint64_t x_firmware_control;
|
||||||
uint64_t x_dsdt;
|
uint64_t x_dsdt;
|
||||||
|
|
||||||
struct gas x_pm1_a_event_block;
|
struct gas x_pm1_a_event_block;
|
||||||
struct gas x_pm1_b_event_block;
|
struct gas x_pm1_b_event_block;
|
||||||
struct gas x_pm1_a_control_block;
|
struct gas x_pm1_a_control_block;
|
||||||
struct gas x_pm1_b_control_block;
|
struct gas x_pm1_b_control_block;
|
||||||
struct gas x_pm2_control_block;
|
struct gas x_pm2_control_block;
|
||||||
struct gas x_pm_timer_block;
|
struct gas x_pm_timer_block;
|
||||||
struct gas x_gpe0_block;
|
struct gas x_gpe0_block;
|
||||||
struct gas x_gpe1_block;
|
struct gas x_gpe1_block;
|
||||||
};
|
};
|
||||||
|
|
||||||
struct acpi_state {
|
struct acpi_state {
|
||||||
|
|
@ -154,49 +154,49 @@ struct acpi_state {
|
||||||
};
|
};
|
||||||
|
|
||||||
static bool checksum(uint8_t *data, size_t len) {
|
static bool checksum(uint8_t *data, size_t len) {
|
||||||
unsigned char sum = 0;
|
unsigned char sum = 0;
|
||||||
for (size_t i = 0; i < len; i++)
|
for (size_t i = 0; i < len; i++)
|
||||||
sum += data[i];
|
sum += data[i];
|
||||||
return sum == 0;
|
return sum == 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int read_s5_addr(struct acpi_state *state) {
|
static int read_s5_addr(struct acpi_state *state) {
|
||||||
serial_out_str("a");
|
serial_out_str("a");
|
||||||
uintptr_t ptr = state->fadt.dsdt;
|
uintptr_t ptr = state->fadt.dsdt;
|
||||||
char *s5_addr = (void*) (ptr + 36);
|
char *s5_addr = (void*) (ptr + 36);
|
||||||
serial_out_str("a");
|
serial_out_str("a");
|
||||||
|
|
||||||
int dsdt_len = *((int*) (ptr+1)) - 36;
|
int dsdt_len = *((int*) (ptr+1)) - 36;
|
||||||
while (0 < dsdt_len--) {
|
while (0 < dsdt_len--) {
|
||||||
if ( memcmp(s5_addr, "_S5_", 4) == 0)
|
if ( memcmp(s5_addr, "_S5_", 4) == 0)
|
||||||
break;
|
break;
|
||||||
s5_addr++;
|
s5_addr++;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (dsdt_len > 0) {
|
if (dsdt_len > 0) {
|
||||||
// check for valid AML structure
|
// check for valid AML structure
|
||||||
if ( ( *(s5_addr-1) == 0x08 || ( *(s5_addr-2) == 0x08 && *(s5_addr-1) == '\\') ) && *(s5_addr+4) == 0x12 ) {
|
if ( ( *(s5_addr-1) == 0x08 || ( *(s5_addr-2) == 0x08 && *(s5_addr-1) == '\\') ) && *(s5_addr+4) == 0x12 ) {
|
||||||
s5_addr += 5;
|
s5_addr += 5;
|
||||||
s5_addr += ((*s5_addr &0xC0)>>6) +2; // calculate PkgLength size
|
s5_addr += ((*s5_addr &0xC0)>>6) +2; // calculate PkgLength size
|
||||||
|
|
||||||
if (*s5_addr == 0x0A)
|
if (*s5_addr == 0x0A)
|
||||||
s5_addr++; // skip byteprefix
|
s5_addr++; // skip byteprefix
|
||||||
state->SLP_TYPa = *(s5_addr)<<10;
|
state->SLP_TYPa = *(s5_addr)<<10;
|
||||||
s5_addr++;
|
s5_addr++;
|
||||||
|
|
||||||
if (*s5_addr == 0x0A)
|
if (*s5_addr == 0x0A)
|
||||||
s5_addr++; // skip byteprefix
|
s5_addr++; // skip byteprefix
|
||||||
state->SLP_TYPb = *(s5_addr)<<10;
|
state->SLP_TYPb = *(s5_addr)<<10;
|
||||||
|
|
||||||
state->SLP_EN = 1<<13;
|
state->SLP_EN = 1<<13;
|
||||||
state->SCI_EN = 1;
|
state->SCI_EN = 1;
|
||||||
|
|
||||||
} else {
|
} else {
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
@ -302,12 +302,12 @@ int acpi_init(void *rootsdp) {
|
||||||
if (!ret)
|
if (!ret)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
outb(state.fadt.smi_command_port,state.fadt.acpi_enable);
|
outb(state.fadt.smi_command_port,state.fadt.acpi_enable);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
int acpi_shutdown(void) {
|
int acpi_shutdown(void) {
|
||||||
outw((unsigned int) state.fadt.pm1_a_control_block, state.SLP_TYPb | state.SLP_EN);
|
outw((unsigned int) state.fadt.pm1_a_control_block, state.SLP_TYPb | state.SLP_EN);
|
||||||
return -1;
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
|
||||||
|
|
@ -26,17 +26,17 @@ mb_end:
|
||||||
|
|
||||||
section .bss
|
section .bss
|
||||||
align 4096
|
align 4096
|
||||||
kernel_pml4: ; reserve memory for initial 512 pml4 entires
|
kernel_pml4: ; reserve memory for initial 512 pml4 entires
|
||||||
resb 4096
|
resb 4096
|
||||||
kernel_pdpt_0: ; reserve memory for initial 512 pdpt entires
|
kernel_pdpt_0: ; reserve memory for initial 512 pdpt entires
|
||||||
resb 4096
|
resb 4096
|
||||||
kernel_pd_0: ; reserve memory for initial 512 pd entries
|
kernel_pd_0: ; reserve memory for initial 512 pd entries
|
||||||
resb 4096
|
resb 4096
|
||||||
kernel_pt_0: ; reserve memory for initial 512 pt entries
|
kernel_pt_0: ; reserve memory for initial 512 pt entries
|
||||||
resb 4096
|
resb 4096
|
||||||
paging_pt: ; reserve pages for pager mappings
|
paging_pt: ; reserve pages for pager mappings
|
||||||
resb 4096
|
resb 4096
|
||||||
bootstrap_pt: ; reserve pages to bootstrap pager
|
bootstrap_pt: ; reserve pages to bootstrap pager
|
||||||
resb 4096
|
resb 4096
|
||||||
|
|
||||||
align 16
|
align 16
|
||||||
|
|
@ -60,26 +60,26 @@ SZ_32 equ 1 << 6
|
||||||
LONG_MODE equ 1 << 5
|
LONG_MODE equ 1 << 5
|
||||||
|
|
||||||
GDT:
|
GDT:
|
||||||
.Null: equ $ - GDT
|
.Null: equ $ - GDT
|
||||||
dq 0
|
dq 0
|
||||||
.Code: equ $ - GDT
|
.Code: equ $ - GDT
|
||||||
dd 0xFFFF ; Limit & Base (low, bits 0-15)
|
dd 0xFFFF ; Limit & Base (low, bits 0-15)
|
||||||
db 0 ; Base (mid, bits 16-23)
|
db 0 ; Base (mid, bits 16-23)
|
||||||
db PRESENT | NOT_SYS | EXEC | RW ; Access
|
db PRESENT | NOT_SYS | EXEC | RW ; Access
|
||||||
db GRAN_4K | LONG_MODE | 0xF ; Flags & Limit (high, bits 16-19)
|
db GRAN_4K | LONG_MODE | 0xF ; Flags & Limit (high, bits 16-19)
|
||||||
db 0 ; Base (high, bits 24-31)
|
db 0 ; Base (high, bits 24-31)
|
||||||
.Data: equ $ - GDT
|
.Data: equ $ - GDT
|
||||||
dd 0xFFFF ; Limit & Base (low, bits 0-15)
|
dd 0xFFFF ; Limit & Base (low, bits 0-15)
|
||||||
db 0 ; Base (mid, bits 16-23)
|
db 0 ; Base (mid, bits 16-23)
|
||||||
db PRESENT | NOT_SYS | RW ; Access
|
db PRESENT | NOT_SYS | RW ; Access
|
||||||
db GRAN_4K | SZ_32 | 0xF ; Flags & Limit (high, bits 16-19)
|
db GRAN_4K | SZ_32 | 0xF ; Flags & Limit (high, bits 16-19)
|
||||||
db 0 ; Base (high, bits 24-31)
|
db 0 ; Base (high, bits 24-31)
|
||||||
.TSS: equ $ - GDT
|
.TSS: equ $ - GDT
|
||||||
dd 0x00000068
|
dd 0x00000068
|
||||||
dd 0x00CF8900
|
dd 0x00CF8900
|
||||||
.Pointer:
|
.Pointer:
|
||||||
dw $ - GDT - 1
|
dw $ - GDT - 1
|
||||||
dq GDT
|
dq GDT
|
||||||
|
|
||||||
section .text
|
section .text
|
||||||
align 8
|
align 8
|
||||||
|
|
|
||||||
|
|
@ -7,39 +7,39 @@ extern idt_pic_mouse
|
||||||
extern idt_pic_eoi
|
extern idt_pic_eoi
|
||||||
|
|
||||||
%macro PUSHALL 0
|
%macro PUSHALL 0
|
||||||
push rax
|
push rax
|
||||||
push rbx
|
push rbx
|
||||||
push rcx
|
push rcx
|
||||||
push rdx
|
push rdx
|
||||||
push rbp
|
push rbp
|
||||||
push rdi
|
push rdi
|
||||||
push rsi
|
push rsi
|
||||||
push r8
|
push r8
|
||||||
push r9
|
push r9
|
||||||
push r10
|
push r10
|
||||||
push r11
|
push r11
|
||||||
push r12
|
push r12
|
||||||
push r13
|
push r13
|
||||||
push r14
|
push r14
|
||||||
push r15
|
push r15
|
||||||
%endmacro
|
%endmacro
|
||||||
|
|
||||||
%macro POPALL 0
|
%macro POPALL 0
|
||||||
pop r15
|
pop r15
|
||||||
pop r14
|
pop r14
|
||||||
pop r13
|
pop r13
|
||||||
pop r12
|
pop r12
|
||||||
pop r11
|
pop r11
|
||||||
pop r10
|
pop r10
|
||||||
pop r9
|
pop r9
|
||||||
pop r8
|
pop r8
|
||||||
pop rsi
|
pop rsi
|
||||||
pop rdi
|
pop rdi
|
||||||
pop rbp
|
pop rbp
|
||||||
pop rdx
|
pop rdx
|
||||||
pop rcx
|
pop rcx
|
||||||
pop rbx
|
pop rbx
|
||||||
pop rax
|
pop rax
|
||||||
%endmacro
|
%endmacro
|
||||||
|
|
||||||
; call the exception handler with the interrupt number
|
; call the exception handler with the interrupt number
|
||||||
|
|
@ -47,15 +47,15 @@ extern idt_pic_eoi
|
||||||
%macro ISRException 1
|
%macro ISRException 1
|
||||||
align 8
|
align 8
|
||||||
isr_stub_%+%1:
|
isr_stub_%+%1:
|
||||||
PUSHALL
|
PUSHALL
|
||||||
cld
|
cld
|
||||||
mov rdi, %1 ; exception number
|
mov rdi, %1 ; exception number
|
||||||
mov rsi, 0 ; placeholder error code
|
mov rsi, 0 ; placeholder error code
|
||||||
mov rdx, [rsp + 15 * 8] ; instruction pointer
|
mov rdx, [rsp + 15 * 8] ; instruction pointer
|
||||||
mov rcx, rbp ; base pointer for stack trace
|
mov rcx, rbp ; base pointer for stack trace
|
||||||
call idt_exception_handler
|
call idt_exception_handler
|
||||||
POPALL
|
POPALL
|
||||||
iretq
|
iretq
|
||||||
%endmacro
|
%endmacro
|
||||||
|
|
||||||
; call the exception handler with the interrupt number
|
; call the exception handler with the interrupt number
|
||||||
|
|
@ -64,59 +64,59 @@ isr_stub_%+%1:
|
||||||
%macro ISRExceptionCode 1
|
%macro ISRExceptionCode 1
|
||||||
align 8
|
align 8
|
||||||
isr_stub_%+%1:
|
isr_stub_%+%1:
|
||||||
PUSHALL
|
PUSHALL
|
||||||
cld
|
cld
|
||||||
mov rdi, %1 ; exception number
|
mov rdi, %1 ; exception number
|
||||||
mov rsi, [rsp + 15 * 8] ; error code
|
mov rsi, [rsp + 15 * 8] ; error code
|
||||||
mov rdx, [rsp + 16 * 8] ; instruction pointer
|
mov rdx, [rsp + 16 * 8] ; instruction pointer
|
||||||
mov rcx, rbp ; base pointer for stack trace
|
mov rcx, rbp ; base pointer for stack trace
|
||||||
call idt_exception_handler
|
call idt_exception_handler
|
||||||
POPALL
|
POPALL
|
||||||
sub rsp, 8 ; discard error code
|
sub rsp, 8 ; discard error code
|
||||||
iretq
|
iretq
|
||||||
%endmacro
|
%endmacro
|
||||||
|
|
||||||
%macro PICGeneric 1
|
%macro PICGeneric 1
|
||||||
isr_stub_%+%1:
|
isr_stub_%+%1:
|
||||||
PUSHALL
|
PUSHALL
|
||||||
cld
|
cld
|
||||||
mov rdi, %1
|
mov rdi, %1
|
||||||
call idt_pic_eoi
|
call idt_pic_eoi
|
||||||
POPALL
|
POPALL
|
||||||
iretq
|
iretq
|
||||||
%endmacro
|
%endmacro
|
||||||
|
|
||||||
%macro PICTimer 1
|
%macro PICTimer 1
|
||||||
isr_stub_%+%1:
|
isr_stub_%+%1:
|
||||||
PUSHALL
|
PUSHALL
|
||||||
cld
|
cld
|
||||||
call idt_pic_timer
|
call idt_pic_timer
|
||||||
mov rdi, %1
|
mov rdi, %1
|
||||||
call idt_pic_eoi
|
call idt_pic_eoi
|
||||||
POPALL
|
POPALL
|
||||||
iretq
|
iretq
|
||||||
%endmacro
|
%endmacro
|
||||||
|
|
||||||
%macro PICKeyboard 1
|
%macro PICKeyboard 1
|
||||||
isr_stub_%+%1:
|
isr_stub_%+%1:
|
||||||
PUSHALL
|
PUSHALL
|
||||||
cld
|
cld
|
||||||
call idt_pic_keyboard
|
call idt_pic_keyboard
|
||||||
mov rdi, %1
|
mov rdi, %1
|
||||||
call idt_pic_eoi
|
call idt_pic_eoi
|
||||||
POPALL
|
POPALL
|
||||||
iretq
|
iretq
|
||||||
%endmacro
|
%endmacro
|
||||||
|
|
||||||
%macro PICMouse 1
|
%macro PICMouse 1
|
||||||
isr_stub_%+%1:
|
isr_stub_%+%1:
|
||||||
PUSHALL
|
PUSHALL
|
||||||
cld
|
cld
|
||||||
call idt_pic_mouse
|
call idt_pic_mouse
|
||||||
mov rdi, %1
|
mov rdi, %1
|
||||||
call idt_pic_eoi
|
call idt_pic_eoi
|
||||||
POPALL
|
POPALL
|
||||||
iretq
|
iretq
|
||||||
%endmacro
|
%endmacro
|
||||||
|
|
||||||
; do nothing
|
; do nothing
|
||||||
|
|
@ -124,7 +124,7 @@ isr_stub_%+%1:
|
||||||
%macro ISRIgnore 1
|
%macro ISRIgnore 1
|
||||||
align 8
|
align 8
|
||||||
isr_stub_%+%1:
|
isr_stub_%+%1:
|
||||||
iretq
|
iretq
|
||||||
%endmacro
|
%endmacro
|
||||||
|
|
||||||
; isr stubs
|
; isr stubs
|
||||||
|
|
@ -184,8 +184,8 @@ PICGeneric 47 ; 15
|
||||||
; ignore other interrupts
|
; ignore other interrupts
|
||||||
%assign i 48
|
%assign i 48
|
||||||
%rep 256 - i
|
%rep 256 - i
|
||||||
ISRIgnore i
|
ISRIgnore i
|
||||||
%assign i i+1
|
%assign i i+1
|
||||||
%endrep
|
%endrep
|
||||||
|
|
||||||
; isr stub table
|
; isr stub table
|
||||||
|
|
@ -196,6 +196,6 @@ align 16
|
||||||
isr_stub_table:
|
isr_stub_table:
|
||||||
%assign i 0
|
%assign i 0
|
||||||
%rep 256
|
%rep 256
|
||||||
dq isr_stub_%+i
|
dq isr_stub_%+i
|
||||||
%assign i i+1
|
%assign i i+1
|
||||||
%endrep
|
%endrep
|
||||||
|
|
|
||||||
|
|
@ -1,38 +1,38 @@
|
||||||
ENTRY(start)
|
ENTRY(start)
|
||||||
|
|
||||||
PHDRS {
|
PHDRS {
|
||||||
loadable PT_LOAD FLAGS(7) ;
|
loadable PT_LOAD FLAGS(7) ;
|
||||||
}
|
}
|
||||||
|
|
||||||
SECTIONS {
|
SECTIONS {
|
||||||
. = 1M;
|
. = 1M;
|
||||||
|
|
||||||
kernel_start = .;
|
kernel_start = .;
|
||||||
|
|
||||||
.boot BLOCK(4K) : ALIGN(4K)
|
.boot BLOCK(4K) : ALIGN(4K)
|
||||||
{
|
{
|
||||||
*(.multiboot)
|
*(.multiboot)
|
||||||
}
|
}
|
||||||
|
|
||||||
.rodata BLOCK(4K) : ALIGN(4K)
|
.rodata BLOCK(4K) : ALIGN(4K)
|
||||||
{
|
{
|
||||||
*(.rodata)
|
*(.rodata)
|
||||||
}
|
}
|
||||||
|
|
||||||
.text BLOCK(4K) : ALIGN(4K)
|
.text BLOCK(4K) : ALIGN(4K)
|
||||||
{
|
{
|
||||||
*(.text)
|
*(.text)
|
||||||
}
|
}
|
||||||
|
|
||||||
.bss BLOCK(4K) : ALIGN(4K)
|
.bss BLOCK(4K) : ALIGN(4K)
|
||||||
{
|
{
|
||||||
*(.bss)
|
*(.bss)
|
||||||
}
|
}
|
||||||
|
|
||||||
.symtab : {
|
.symtab : {
|
||||||
symtab = .;
|
symtab = .;
|
||||||
*(.symtab)
|
*(.symtab)
|
||||||
} :loadable
|
} :loadable
|
||||||
|
|
||||||
kernel_end = .;
|
kernel_end = .;
|
||||||
}
|
}
|
||||||
|
|
|
||||||
|
|
@ -133,10 +133,10 @@ static void read_cmdline(
|
||||||
struct mboot_cmdline *cmdline
|
struct mboot_cmdline *cmdline
|
||||||
) {
|
) {
|
||||||
mboot_uint32_t size = cmdline->size - 8;
|
mboot_uint32_t size = cmdline->size - 8;
|
||||||
if (size >= CMDLINE_MAX)
|
if (size >= CMDLINE_MAX)
|
||||||
size = CMDLINE_MAX; // truncate :(
|
size = CMDLINE_MAX; // truncate :(
|
||||||
memcpy(shim_info->cmdline, cmdline->cmdline, size);
|
memcpy(shim_info->cmdline, cmdline->cmdline, size);
|
||||||
shim_info->cmdline[size] = '\0';
|
shim_info->cmdline[size] = '\0';
|
||||||
}
|
}
|
||||||
|
|
||||||
static void read_memorymap(
|
static void read_memorymap(
|
||||||
|
|
@ -146,8 +146,8 @@ static void read_memorymap(
|
||||||
int size = map->size - sizeof(mboot_uint32_t) * 4;
|
int size = map->size - sizeof(mboot_uint32_t) * 4;
|
||||||
int count = size / map->entry_size;
|
int count = size / map->entry_size;
|
||||||
|
|
||||||
shim_info->map.entry_count = count;
|
shim_info->map.entry_count = count;
|
||||||
shim_info->map.entry_length = map->entry_size;
|
shim_info->map.entry_length = map->entry_size;
|
||||||
shim_info->map.entries = map->entries;
|
shim_info->map.entries = map->entries;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -157,19 +157,19 @@ static void read_rsdp(
|
||||||
) {
|
) {
|
||||||
if (shim_info->acpi_table != NULL)
|
if (shim_info->acpi_table != NULL)
|
||||||
return; // xsdp is newer and has been loaded
|
return; // xsdp is newer and has been loaded
|
||||||
shim_info->acpi_table = rsdp->rsdp;
|
shim_info->acpi_table = rsdp->rsdp;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void read_xsdp(
|
static void read_xsdp(
|
||||||
struct boot_info *shim_info,
|
struct boot_info *shim_info,
|
||||||
struct mboot_xsdp *xsdp
|
struct mboot_xsdp *xsdp
|
||||||
) {
|
) {
|
||||||
shim_info->acpi_table = xsdp->xsdp;
|
shim_info->acpi_table = xsdp->xsdp;
|
||||||
}
|
}
|
||||||
|
|
||||||
void mboot_load_info(
|
void mboot_load_info(
|
||||||
const void *mboot_data_ptr,
|
const void *mboot_data_ptr,
|
||||||
struct boot_info *shim_info
|
struct boot_info *shim_info
|
||||||
) {
|
) {
|
||||||
|
|
||||||
memset(shim_info, 0, sizeof(struct boot_info));
|
memset(shim_info, 0, sizeof(struct boot_info));
|
||||||
|
|
@ -180,41 +180,41 @@ void mboot_load_info(
|
||||||
char *tag_ptr = mboot_info->tags;
|
char *tag_ptr = mboot_info->tags;
|
||||||
|
|
||||||
while (tag_ptr < mboot_end) {
|
while (tag_ptr < mboot_end) {
|
||||||
struct mboot_tag *tag = (struct mboot_tag *) tag_ptr;
|
struct mboot_tag *tag = (struct mboot_tag *) tag_ptr;
|
||||||
|
|
||||||
switch (tag->type) {
|
switch (tag->type) {
|
||||||
case MBOOT_CMDLINE:
|
case MBOOT_CMDLINE:
|
||||||
read_cmdline(
|
read_cmdline(
|
||||||
shim_info,
|
shim_info,
|
||||||
(struct mboot_cmdline *) tag
|
(struct mboot_cmdline *) tag
|
||||||
);
|
);
|
||||||
break;
|
break;
|
||||||
case MBOOT_MEMORYMAP:
|
case MBOOT_MEMORYMAP:
|
||||||
read_memorymap(
|
read_memorymap(
|
||||||
shim_info,
|
shim_info,
|
||||||
(struct mboot_memory_map *) tag
|
(struct mboot_memory_map *) tag
|
||||||
);
|
);
|
||||||
break;
|
break;
|
||||||
case MBOOT_SYMBOLS:
|
case MBOOT_SYMBOLS:
|
||||||
read_symbols(
|
read_symbols(
|
||||||
shim_info,
|
shim_info,
|
||||||
(struct mboot_elf_header_layout *) tag
|
(struct mboot_elf_header_layout *) tag
|
||||||
);
|
);
|
||||||
break;
|
break;
|
||||||
case MBOOT_RSDP:
|
case MBOOT_RSDP:
|
||||||
read_rsdp(
|
read_rsdp(
|
||||||
shim_info,
|
shim_info,
|
||||||
(struct mboot_rsdp *) tag
|
(struct mboot_rsdp *) tag
|
||||||
);
|
);
|
||||||
break;
|
break;
|
||||||
case MBOOT_XSDP:
|
case MBOOT_XSDP:
|
||||||
read_xsdp(
|
read_xsdp(
|
||||||
shim_info,
|
shim_info,
|
||||||
(struct mboot_xsdp *) tag
|
(struct mboot_xsdp *) tag
|
||||||
);
|
);
|
||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
int size = tag->size;
|
int size = tag->size;
|
||||||
|
|
|
||||||
256
src/lib.c
256
src/lib.c
|
|
@ -3,37 +3,37 @@
|
||||||
#include <stddef.h>
|
#include <stddef.h>
|
||||||
|
|
||||||
int memcmp(const void *restrict vl, const void *restrict vr, unsigned long n) {
|
int memcmp(const void *restrict vl, const void *restrict vr, unsigned long n) {
|
||||||
const unsigned char *l = vl, *r = vr;
|
const unsigned char *l = vl, *r = vr;
|
||||||
for (; n && *l == *r; n--, l++, r++);
|
for (; n && *l == *r; n--, l++, r++);
|
||||||
return n ? *l-*r : 0;
|
return n ? *l-*r : 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
void *memcpy(void *restrict dest, const void *restrict src, unsigned long n) {
|
void *memcpy(void *restrict dest, const void *restrict src, unsigned long n) {
|
||||||
char *d = dest;
|
char *d = dest;
|
||||||
const char *s = src;
|
const char *s = src;
|
||||||
for (; n; n--) *d++ = *s++;
|
for (; n; n--) *d++ = *s++;
|
||||||
return dest;
|
return dest;
|
||||||
}
|
}
|
||||||
|
|
||||||
void *memmove(void *dest, const void *src, unsigned long n) {
|
void *memmove(void *dest, const void *src, unsigned long n) {
|
||||||
char *d = dest;
|
char *d = dest;
|
||||||
const char *s = src;
|
const char *s = src;
|
||||||
|
|
||||||
if (d==s) return d;
|
if (d==s) return d;
|
||||||
|
|
||||||
if (d<s) {
|
if (d<s) {
|
||||||
for (; n; n--) *d++ = *s++;
|
for (; n; n--) *d++ = *s++;
|
||||||
} else {
|
} else {
|
||||||
while (n) n--, d[n] = s[n];
|
while (n) n--, d[n] = s[n];
|
||||||
}
|
}
|
||||||
|
|
||||||
return dest;
|
return dest;
|
||||||
}
|
}
|
||||||
|
|
||||||
void *memset(void *restrict dest, int c, unsigned long n) {
|
void *memset(void *restrict dest, int c, unsigned long n) {
|
||||||
unsigned char *d = dest;
|
unsigned char *d = dest;
|
||||||
for (; n; n--) *d++ = c;
|
for (; n; n--) *d++ = c;
|
||||||
return dest;
|
return dest;
|
||||||
}
|
}
|
||||||
|
|
||||||
int strncmp(const char *restrict lhs, const char *restrict rhs, unsigned long n) {
|
int strncmp(const char *restrict lhs, const char *restrict rhs, unsigned long n) {
|
||||||
|
|
@ -55,55 +55,55 @@ char *strncpy(char *restrict dest, const char *restrict src, unsigned long n) {
|
||||||
}
|
}
|
||||||
|
|
||||||
size_t strlen(const char *str) {
|
size_t strlen(const char *str) {
|
||||||
const char *p;
|
const char *p;
|
||||||
for(p = str; *p != 0; p++) {}
|
for(p = str; *p != 0; p++) {}
|
||||||
return p - str;
|
return p - str;
|
||||||
}
|
}
|
||||||
|
|
||||||
char *strcat(char *restrict dst, const char *restrict src) {
|
char *strcat(char *restrict dst, const char *restrict src) {
|
||||||
strcpy(dst + strlen(dst), src);
|
strcpy(dst + strlen(dst), src);
|
||||||
return dst;
|
return dst;
|
||||||
}
|
}
|
||||||
|
|
||||||
int isspace(int c) {
|
int isspace(int c) {
|
||||||
switch (c) {
|
switch (c) {
|
||||||
case ' ':
|
case ' ':
|
||||||
case '\t':
|
case '\t':
|
||||||
case '\v':
|
case '\v':
|
||||||
case '\f':
|
case '\f':
|
||||||
case '\r':
|
case '\r':
|
||||||
case '\n':
|
case '\n':
|
||||||
return 1;
|
return 1;
|
||||||
default:
|
default:
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
int isdigit(int c) {
|
int isdigit(int c) {
|
||||||
return c - '0' > -1 && c - '0' < 10;
|
return c - '0' > -1 && c - '0' < 10;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
#define ATOX(name, type) \
|
#define ATOX(name, type) \
|
||||||
type name(const char* s) { \
|
type name(const char* s) { \
|
||||||
for(; isspace(*s); s++); \
|
for(; isspace(*s); s++); \
|
||||||
int neg = 0; \
|
int neg = 0; \
|
||||||
switch (*s) { \
|
switch (*s) { \
|
||||||
case '-': \
|
case '-': \
|
||||||
neg = 1; \
|
neg = 1; \
|
||||||
/* FALLTHRU */ \
|
/* FALLTHRU */ \
|
||||||
case '+': \
|
case '+': \
|
||||||
s++; \
|
s++; \
|
||||||
break; \
|
break; \
|
||||||
} \
|
} \
|
||||||
type num = 0; \
|
type num = 0; \
|
||||||
for (; *s == '0'; s++); \
|
for (; *s == '0'; s++); \
|
||||||
for (; isdigit(*s); s++) { \
|
for (; isdigit(*s); s++) { \
|
||||||
num *= 10; \
|
num *= 10; \
|
||||||
num += *s - '0'; \
|
num += *s - '0'; \
|
||||||
} \
|
} \
|
||||||
return num * (neg ? -1 : 1); \
|
return num * (neg ? -1 : 1); \
|
||||||
}
|
}
|
||||||
|
|
||||||
ATOX(atoi, int)
|
ATOX(atoi, int)
|
||||||
ATOX(atol, long int)
|
ATOX(atol, long int)
|
||||||
|
|
@ -118,7 +118,7 @@ char itoc(int i) {
|
||||||
}
|
}
|
||||||
|
|
||||||
int ctoi(char c) {
|
int ctoi(char c) {
|
||||||
if(c < 'A') {
|
if(c < 'A') {
|
||||||
return c - '0';
|
return c - '0';
|
||||||
} else if(c < 'a') {
|
} else if(c < 'a') {
|
||||||
return c - 'A' + 10;
|
return c - 'A' + 10;
|
||||||
|
|
@ -128,89 +128,89 @@ int ctoi(char c) {
|
||||||
}
|
}
|
||||||
|
|
||||||
#define UXTOA(type, name) \
|
#define UXTOA(type, name) \
|
||||||
char *name(unsigned type n, char *buffer, int radix) { \
|
char *name(unsigned type n, char *buffer, int radix) { \
|
||||||
if (n == 0) { \
|
if (n == 0) { \
|
||||||
buffer[0] = '0'; \
|
buffer[0] = '0'; \
|
||||||
buffer[1] = '\0'; \
|
buffer[1] = '\0'; \
|
||||||
return buffer; \
|
return buffer; \
|
||||||
} \
|
} \
|
||||||
char *start = buffer; \
|
char *start = buffer; \
|
||||||
for (; n; n /= radix) { \
|
for (; n; n /= radix) { \
|
||||||
*buffer++ = itoc(n % radix); \
|
*buffer++ = itoc(n % radix); \
|
||||||
} \
|
} \
|
||||||
*buffer-- = '\0'; \
|
*buffer-- = '\0'; \
|
||||||
while(buffer > start) { \
|
while(buffer > start) { \
|
||||||
char tmp = *start; \
|
char tmp = *start; \
|
||||||
*start++ = *buffer; \
|
*start++ = *buffer; \
|
||||||
*buffer-- = tmp; \
|
*buffer-- = tmp; \
|
||||||
} \
|
} \
|
||||||
return buffer; \
|
return buffer; \
|
||||||
}
|
}
|
||||||
|
|
||||||
UXTOA(int, utoa)
|
UXTOA(int, utoa)
|
||||||
UXTOA(long int, ultoa)
|
UXTOA(long int, ultoa)
|
||||||
|
|
||||||
#define XTOA(type, name) \
|
#define XTOA(type, name) \
|
||||||
char *name(type n, char* buffer, int radix) { \
|
char *name(type n, char* buffer, int radix) { \
|
||||||
if (n == 0) { \
|
if (n == 0) { \
|
||||||
buffer[0] = '0'; \
|
buffer[0] = '0'; \
|
||||||
buffer[1] = '\0'; \
|
buffer[1] = '\0'; \
|
||||||
return buffer; \
|
return buffer; \
|
||||||
} \
|
} \
|
||||||
if (n < 0) { \
|
if (n < 0) { \
|
||||||
*buffer++ = '-'; \
|
*buffer++ = '-'; \
|
||||||
n = -n; \
|
n = -n; \
|
||||||
} \
|
} \
|
||||||
char *start = buffer; \
|
char *start = buffer; \
|
||||||
for (; n; n /= radix) { \
|
for (; n; n /= radix) { \
|
||||||
*buffer++ = itoc(n % radix); \
|
*buffer++ = itoc(n % radix); \
|
||||||
} \
|
} \
|
||||||
*buffer-- = '\0'; \
|
*buffer-- = '\0'; \
|
||||||
while(buffer > start) { \
|
while(buffer > start) { \
|
||||||
char tmp = *start; \
|
char tmp = *start; \
|
||||||
*start++ = *buffer; \
|
*start++ = *buffer; \
|
||||||
*buffer-- = tmp; \
|
*buffer-- = tmp; \
|
||||||
} \
|
} \
|
||||||
return buffer; \
|
return buffer; \
|
||||||
}
|
}
|
||||||
|
|
||||||
XTOA(int, itoa)
|
XTOA(int, itoa)
|
||||||
XTOA(long int, ltoa)
|
XTOA(long int, ltoa)
|
||||||
|
|
||||||
#define STRTOX(name, type) \
|
#define STRTOX(name, type) \
|
||||||
type name(const char *s, char **endptr, int radix) { \
|
type name(const char *s, char **endptr, int radix) { \
|
||||||
*endptr = NULL; \
|
*endptr = NULL; \
|
||||||
for(; isspace(*s); s++); \
|
for(; isspace(*s); s++); \
|
||||||
int neg = 0; \
|
int neg = 0; \
|
||||||
switch (*s) { \
|
switch (*s) { \
|
||||||
case '-': \
|
case '-': \
|
||||||
neg = 1; \
|
neg = 1; \
|
||||||
/* FALLTHRU */ \
|
/* FALLTHRU */ \
|
||||||
case '+': \
|
case '+': \
|
||||||
s++; \
|
s++; \
|
||||||
break; \
|
break; \
|
||||||
} \
|
} \
|
||||||
if (!radix) { \
|
if (!radix) { \
|
||||||
if (*s == '0') { \
|
if (*s == '0') { \
|
||||||
s++; \
|
s++; \
|
||||||
if (*s == 'x' || *s == 'X') { \
|
if (*s == 'x' || *s == 'X') { \
|
||||||
s++; \
|
s++; \
|
||||||
radix = 16; \
|
radix = 16; \
|
||||||
} else { \
|
} else { \
|
||||||
radix = 8; \
|
radix = 8; \
|
||||||
} \
|
} \
|
||||||
} else { \
|
} else { \
|
||||||
radix = 10; \
|
radix = 10; \
|
||||||
} \
|
} \
|
||||||
} \
|
} \
|
||||||
for (; *s == '0'; s++, *endptr = (void*) s); \
|
for (; *s == '0'; s++, *endptr = (void*) s); \
|
||||||
type num = 0; \
|
type num = 0; \
|
||||||
for (; isdigit(*s); s++, *endptr = (void*) s) { \
|
for (; isdigit(*s); s++, *endptr = (void*) s) { \
|
||||||
num *= radix; \
|
num *= radix; \
|
||||||
num += *s - '0'; \
|
num += *s - '0'; \
|
||||||
} \
|
} \
|
||||||
return num * (neg ? -1 : 1); \
|
return num * (neg ? -1 : 1); \
|
||||||
}
|
}
|
||||||
|
|
||||||
STRTOX(strtoi, int)
|
STRTOX(strtoi, int)
|
||||||
STRTOX(strtol, long int)
|
STRTOX(strtol, long int)
|
||||||
|
|
|
||||||
Loading…
Reference in a new issue