2016-08-14 02:21:46 +02:00
|
|
|
/// This function is where the kernel sets up IRQ handlers
|
|
|
|
/// It is increcibly unsafe, and should be minimal in nature
|
|
|
|
/// It must create the IDT with the correct entries, those entries are
|
|
|
|
/// defined in other files inside of the `arch` module
|
2016-08-14 02:58:31 +02:00
|
|
|
|
2016-08-18 03:06:33 +02:00
|
|
|
use core::sync::atomic::{AtomicBool, ATOMIC_BOOL_INIT, AtomicUsize, ATOMIC_USIZE_INIT, Ordering};
|
2016-08-18 01:40:18 +02:00
|
|
|
|
2016-08-16 02:37:58 +02:00
|
|
|
use acpi;
|
2016-09-11 02:48:27 +02:00
|
|
|
use allocator;
|
2016-09-01 01:45:21 +02:00
|
|
|
use device;
|
2016-08-15 19:29:53 +02:00
|
|
|
use externs::memset;
|
2016-08-15 22:34:20 +02:00
|
|
|
use gdt;
|
2016-08-15 19:29:53 +02:00
|
|
|
use idt;
|
2016-08-31 00:23:51 +02:00
|
|
|
use interrupt;
|
2016-09-20 22:50:04 +02:00
|
|
|
use memory;
|
|
|
|
use paging::{self, entry, Page, VirtualAddress};
|
2016-08-15 19:29:53 +02:00
|
|
|
|
|
|
|
/// Test of zero values in BSS.
|
|
|
|
static BSS_TEST_ZERO: usize = 0;
|
2016-08-20 01:38:37 +02:00
|
|
|
/// Test of non-zero values in data.
|
|
|
|
static DATA_TEST_NONZERO: usize = 0xFFFFFFFFFFFFFFFF;
|
|
|
|
/// Test of zero values in thread BSS
|
|
|
|
#[thread_local]
|
|
|
|
static mut TBSS_TEST_ZERO: usize = 0;
|
|
|
|
/// Test of non-zero values in thread data.
|
|
|
|
#[thread_local]
|
|
|
|
static mut TDATA_TEST_NONZERO: usize = 0xFFFFFFFFFFFFFFFF;
|
2016-08-15 19:29:53 +02:00
|
|
|
|
2016-10-23 17:13:12 +02:00
|
|
|
pub static CPU_COUNT: AtomicUsize = ATOMIC_USIZE_INIT;
|
2016-09-02 01:08:43 +02:00
|
|
|
pub static AP_READY: AtomicBool = ATOMIC_BOOL_INIT;
|
2016-08-18 01:40:18 +02:00
|
|
|
static BSP_READY: AtomicBool = ATOMIC_BOOL_INIT;
|
|
|
|
|
2016-08-15 19:29:53 +02:00
|
|
|
extern {
|
|
|
|
/// Kernel main function
|
2016-10-23 17:13:12 +02:00
|
|
|
fn kmain(cpus: usize) -> !;
|
2016-08-18 03:38:04 +02:00
|
|
|
/// Kernel main for APs
|
2016-08-19 03:44:31 +02:00
|
|
|
fn kmain_ap(id: usize) -> !;
|
2016-08-15 19:29:53 +02:00
|
|
|
}
|
2016-08-14 17:31:35 +02:00
|
|
|
|
2016-08-17 05:25:48 +02:00
|
|
|
/// The entry to Rust, all things must be initialized
|
2016-08-14 02:21:46 +02:00
|
|
|
#[no_mangle]
|
2016-08-14 19:45:47 +02:00
|
|
|
pub unsafe extern fn kstart() -> ! {
|
2016-08-14 17:31:35 +02:00
|
|
|
{
|
2016-08-16 00:29:54 +02:00
|
|
|
extern {
|
|
|
|
/// The starting byte of the _.bss_ (uninitialized data) segment.
|
|
|
|
static mut __bss_start: u8;
|
|
|
|
/// The ending byte of the _.bss_ (uninitialized data) segment.
|
|
|
|
static mut __bss_end: u8;
|
2016-08-20 01:38:37 +02:00
|
|
|
/// The end of the kernel
|
|
|
|
static mut __end: u8;
|
2016-08-16 00:29:54 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
// Zero BSS, this initializes statics that are set to 0
|
|
|
|
{
|
|
|
|
let start_ptr = &mut __bss_start as *mut u8;
|
|
|
|
let end_ptr = & __bss_end as *const u8 as usize;
|
2016-08-14 17:31:35 +02:00
|
|
|
|
2016-08-16 00:29:54 +02:00
|
|
|
if start_ptr as usize <= end_ptr {
|
|
|
|
let size = end_ptr - start_ptr as usize;
|
|
|
|
memset(start_ptr, 0, size);
|
|
|
|
}
|
|
|
|
|
2016-08-20 01:38:37 +02:00
|
|
|
assert_eq!(BSS_TEST_ZERO, 0);
|
|
|
|
assert_eq!(DATA_TEST_NONZERO, 0xFFFFFFFFFFFFFFFF);
|
2016-08-14 17:31:35 +02:00
|
|
|
}
|
|
|
|
|
2016-08-16 00:29:54 +02:00
|
|
|
// Initialize memory management
|
2016-09-15 04:47:55 +02:00
|
|
|
memory::init(0, &__end as *const u8 as usize - ::KERNEL_OFFSET);
|
2016-08-14 17:31:35 +02:00
|
|
|
|
2016-08-18 00:26:43 +02:00
|
|
|
// TODO: allocate a stack
|
2016-09-19 16:46:11 +02:00
|
|
|
let stack_start = 0x00080000 + ::KERNEL_OFFSET;
|
|
|
|
let stack_end = 0x0009F000 + ::KERNEL_OFFSET;
|
2016-08-14 02:58:31 +02:00
|
|
|
|
2016-08-18 00:26:43 +02:00
|
|
|
// Initialize paging
|
2016-09-12 21:06:00 +02:00
|
|
|
let (mut active_table, tcb_offset) = paging::init(0, stack_start, stack_end);
|
2016-08-14 17:31:35 +02:00
|
|
|
|
2016-08-19 22:53:16 +02:00
|
|
|
// Set up GDT
|
2016-09-12 02:25:05 +02:00
|
|
|
gdt::init(tcb_offset, stack_end);
|
2016-08-19 22:53:16 +02:00
|
|
|
|
|
|
|
// Set up IDT
|
|
|
|
idt::init();
|
|
|
|
|
2016-08-20 01:38:37 +02:00
|
|
|
// Test tdata and tbss
|
|
|
|
{
|
|
|
|
assert_eq!(TBSS_TEST_ZERO, 0);
|
|
|
|
TBSS_TEST_ZERO += 1;
|
|
|
|
assert_eq!(TBSS_TEST_ZERO, 1);
|
|
|
|
assert_eq!(TDATA_TEST_NONZERO, 0xFFFFFFFFFFFFFFFF);
|
|
|
|
TDATA_TEST_NONZERO -= 1;
|
|
|
|
assert_eq!(TDATA_TEST_NONZERO, 0xFFFFFFFFFFFFFFFE);
|
|
|
|
}
|
|
|
|
|
2016-08-18 03:34:33 +02:00
|
|
|
// Reset AP variables
|
2016-10-23 17:13:12 +02:00
|
|
|
CPU_COUNT.store(1, Ordering::SeqCst);
|
2016-09-02 01:08:43 +02:00
|
|
|
AP_READY.store(false, Ordering::SeqCst);
|
2016-08-18 03:34:33 +02:00
|
|
|
BSP_READY.store(false, Ordering::SeqCst);
|
2016-08-18 03:06:33 +02:00
|
|
|
|
2016-09-15 05:28:09 +02:00
|
|
|
// Setup kernel heap
|
2016-08-19 22:53:16 +02:00
|
|
|
{
|
2016-09-11 02:48:27 +02:00
|
|
|
// Map heap pages
|
2016-09-12 21:06:00 +02:00
|
|
|
let heap_start_page = Page::containing_address(VirtualAddress::new(::KERNEL_HEAP_OFFSET));
|
|
|
|
let heap_end_page = Page::containing_address(VirtualAddress::new(::KERNEL_HEAP_OFFSET + ::KERNEL_HEAP_SIZE-1));
|
2016-09-11 02:48:27 +02:00
|
|
|
for page in Page::range_inclusive(heap_start_page, heap_end_page) {
|
2016-10-17 00:18:01 +02:00
|
|
|
active_table.map(page, entry::PRESENT | entry::GLOBAL | entry::WRITABLE | entry::NO_EXECUTE);
|
2016-09-11 02:48:27 +02:00
|
|
|
}
|
2016-08-19 22:53:16 +02:00
|
|
|
|
2016-09-11 02:48:27 +02:00
|
|
|
// Init the allocator
|
2016-09-12 21:06:00 +02:00
|
|
|
allocator::init(::KERNEL_HEAP_OFFSET, ::KERNEL_HEAP_SIZE);
|
2016-09-15 05:28:09 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
// Initialize devices
|
2016-10-31 17:49:00 +01:00
|
|
|
device::init(&mut active_table);
|
2016-08-19 22:53:16 +02:00
|
|
|
|
2016-09-01 19:51:33 +02:00
|
|
|
// Read ACPI tables, starts APs
|
2016-09-02 01:08:43 +02:00
|
|
|
acpi::init(&mut active_table);
|
2016-09-01 19:51:33 +02:00
|
|
|
|
2016-08-18 01:40:18 +02:00
|
|
|
BSP_READY.store(true, Ordering::SeqCst);
|
|
|
|
}
|
|
|
|
|
2016-10-23 17:13:12 +02:00
|
|
|
kmain(CPU_COUNT.load(Ordering::SeqCst));
|
2016-08-14 02:58:31 +02:00
|
|
|
}
|
2016-08-17 05:25:48 +02:00
|
|
|
|
|
|
|
/// Entry to rust for an AP
|
2016-10-23 17:13:12 +02:00
|
|
|
pub unsafe extern fn kstart_ap(cpu_id: usize, bsp_table: usize, stack_start: usize, stack_end: usize) -> ! {
|
2016-08-18 00:26:43 +02:00
|
|
|
{
|
2016-08-20 01:38:37 +02:00
|
|
|
assert_eq!(BSS_TEST_ZERO, 0);
|
|
|
|
assert_eq!(DATA_TEST_NONZERO, 0xFFFFFFFFFFFFFFFF);
|
|
|
|
|
2016-08-19 22:53:16 +02:00
|
|
|
// Initialize paging
|
2016-10-23 17:13:12 +02:00
|
|
|
let tcb_offset = paging::init_ap(cpu_id, bsp_table, stack_start, stack_end);
|
2016-08-19 22:53:16 +02:00
|
|
|
|
2016-08-18 00:26:43 +02:00
|
|
|
// Set up GDT for AP
|
2016-09-12 23:02:03 +02:00
|
|
|
gdt::init(tcb_offset, stack_end);
|
2016-08-17 23:47:54 +02:00
|
|
|
|
2016-08-19 22:53:16 +02:00
|
|
|
// Set up IDT for AP
|
|
|
|
idt::init();
|
2016-08-17 23:47:54 +02:00
|
|
|
|
2016-08-20 01:38:37 +02:00
|
|
|
// Test tdata and tbss
|
|
|
|
{
|
|
|
|
assert_eq!(TBSS_TEST_ZERO, 0);
|
|
|
|
TBSS_TEST_ZERO += 1;
|
|
|
|
assert_eq!(TBSS_TEST_ZERO, 1);
|
|
|
|
assert_eq!(TDATA_TEST_NONZERO, 0xFFFFFFFFFFFFFFFF);
|
|
|
|
TDATA_TEST_NONZERO -= 1;
|
|
|
|
assert_eq!(TDATA_TEST_NONZERO, 0xFFFFFFFFFFFFFFFE);
|
|
|
|
}
|
|
|
|
|
2016-10-31 17:49:00 +01:00
|
|
|
// Initialize devices (for AP)
|
|
|
|
device::init_ap();
|
|
|
|
|
2016-09-02 01:08:43 +02:00
|
|
|
AP_READY.store(true, Ordering::SeqCst);
|
2016-08-17 23:47:54 +02:00
|
|
|
}
|
|
|
|
|
2016-08-18 01:40:18 +02:00
|
|
|
while ! BSP_READY.load(Ordering::SeqCst) {
|
2016-08-31 00:23:51 +02:00
|
|
|
interrupt::pause();
|
2016-08-18 01:40:18 +02:00
|
|
|
}
|
|
|
|
|
2016-09-12 21:06:00 +02:00
|
|
|
kmain_ap(cpu_id);
|
2016-08-17 05:25:48 +02:00
|
|
|
}
|
2016-09-08 05:16:30 +02:00
|
|
|
|
2016-10-31 17:49:00 +01:00
|
|
|
pub unsafe fn usermode(ip: usize, sp: usize, fs: usize) -> ! {
|
2016-09-09 23:48:54 +02:00
|
|
|
// Go to usermode
|
2016-10-31 17:49:00 +01:00
|
|
|
asm!("xchg bx, bx
|
|
|
|
mov ds, ax
|
2016-09-08 05:16:30 +02:00
|
|
|
mov es, ax
|
|
|
|
mov fs, ax
|
|
|
|
mov gs, ax
|
2016-10-31 17:49:00 +01:00
|
|
|
wrfsbase rbx
|
2016-09-13 01:52:38 +02:00
|
|
|
push rax
|
|
|
|
push rcx
|
|
|
|
push rdx
|
|
|
|
push rsi
|
2016-10-31 17:49:00 +01:00
|
|
|
push rdi
|
2016-09-08 05:16:30 +02:00
|
|
|
iretq"
|
2016-09-13 01:52:38 +02:00
|
|
|
: // No output because it never returns
|
2016-10-31 17:49:00 +01:00
|
|
|
: "{rax}"(gdt::GDT_USER_DATA << 3 | 3), // Data segment
|
|
|
|
"{rbx}"(fs), // TLS segment
|
|
|
|
"{rcx}"(sp), // Stack pointer
|
|
|
|
"{rdx}"(3 << 12 | 1 << 9), // Flags - Set IOPL and interrupt enable flag
|
|
|
|
"{rsi}"(gdt::GDT_USER_CODE << 3 | 3), // Code segment
|
|
|
|
"{rdi}"(ip) // IP
|
2016-09-13 01:52:38 +02:00
|
|
|
: // No clobers because it never returns
|
2016-09-08 05:16:30 +02:00
|
|
|
: "intel", "volatile");
|
2016-09-09 23:48:54 +02:00
|
|
|
unreachable!();
|
2016-09-08 05:16:30 +02:00
|
|
|
}
|