pic: initialize with rust code

2 files changed, 20 insertions, 4 deletions

diff --git a/src/arch/x86_64/interrupt/pic_8259.rs b/src/arch/x86_64/interrupt/pic_8259.rs
index 894697c..969e8d1 100644
--- a/src/arch/x86_64/interrupt/pic_8259.rs
+++ b/src/arch/x86_64/interrupt/pic_8259.rs
@@ -1,7 +1,7 @@
 // For now, the PIC is stateless, i.e. we don'e need a struct for it.
 // Perhaps I need a Mutex handle later...
 use crate::arch::x86_64::io_port::*;
-
+use crate::arch::x86_64::misc::*;
 const IMR1: u16 = 0x21;
 const IMR2: u16 = 0xa1;
 const CTRL1: u16 = 0x20;
@@ -13,6 +13,21 @@ impl PicDeviceInt {
 	pub const KEYBOARD: u8 = 1;
 }
 
+// init must be called before interrupt is enabled.
+// TODO: turn pic into a singleton struct
+pub fn init() {
+	outb(0x20, 0x11);
+	outb(0xa0, 0x11);
+	outb(0x21, 0x20);
+	outb(0xa1, 0x28);
+	outb(0x21, 0x04);
+	outb(0xa1, 0x02);
+	outb(0x21, 0x03);
+	outb(0xa1, 0x03);
+	outb(0xa1, 0xff);
+	outb(0x21, 0xfb);
+}
+
 // 8-bit registers IMR1 and IMR2 registers hold interrupt masking bit 0~7 and
 // 8~15; if an interrupt is masked(set 1) on the respective bit, it's disabled
 pub fn allow(interrupt: u8) {
diff --git a/src/lib.rs b/src/lib.rs
index 897bbed..7f339c9 100644
--- a/src/lib.rs
+++ b/src/lib.rs
@@ -25,6 +25,10 @@ fn panic(info: &PanicInfo) -> ! {
 
 #[no_mangle]
 pub extern "C" fn _entry() -> ! {
+	// init code
+	pic_8259::init();
+	pic_8259::allow(PicDeviceInt::KEYBOARD);
+	interrupt::interrupt_enable();
 	io::set_attr(0x1f);
 	io::clear();
 	println!("--RuStuBs--");
@@ -32,9 +36,6 @@ pub extern "C" fn _entry() -> ! {
 	println!("   (,-.`._,'(       |\\`-/|");
 	println!("       `-.-' \\ )-`( , o o)");
 	println!("             `-    \\`_`\"'-");
-	// testing interrupt/PIC
-	// pic_8259::allow(PicDeviceInt::KEYBOARD);
-	// interrupt::interrupt_enable();
 	//
 	// busy loop query keyboard
 	let mut framemap = mm::pma::FMap::new();