71 lines
2 KiB
Rust
71 lines
2 KiB
Rust
#![feature(asm)]
|
|
|
|
extern crate syscall;
|
|
|
|
use std::fs::File;
|
|
use std::io::{Read, Write};
|
|
use std::mem;
|
|
use std::thread;
|
|
|
|
use syscall::iopl;
|
|
|
|
fn main() {
|
|
println!("PS/2 driver launching");
|
|
|
|
thread::spawn(|| {
|
|
unsafe {
|
|
iopl(3).expect("pskbd: failed to get I/O permission");
|
|
asm!("cli" :::: "intel", "volatile");
|
|
}
|
|
|
|
let mut file = File::open("irq:1").expect("pskbd: failed to open irq:1");
|
|
|
|
println!("pskbd: Reading keyboard IRQs");
|
|
|
|
loop {
|
|
let mut irqs = [0; 8];
|
|
if file.read(&mut irqs).expect("pskbd: failed to read irq:1") >= mem::size_of::<usize>() {
|
|
let data: u8;
|
|
unsafe {
|
|
asm!("in al, dx" : "={al}"(data) : "{dx}"(0x60) : : "intel", "volatile");
|
|
}
|
|
|
|
println!("pskbd: IRQ {}: {:X}", unsafe { *(irqs.as_ptr() as *const usize) }, data);
|
|
|
|
file.write(&irqs).expect("pskbd: failed to write irq:1");
|
|
} else {
|
|
thread::yield_now();
|
|
}
|
|
}
|
|
});
|
|
|
|
thread::spawn(|| {
|
|
unsafe {
|
|
iopl(3).expect("psmsd: failed to get I/O permission");
|
|
asm!("cli" :::: "intel", "volatile");
|
|
}
|
|
|
|
let mut file = File::open("irq:12").expect("psmsd: failed to open irq:12");
|
|
|
|
println!("psmsd: Reading mouse IRQs");
|
|
|
|
loop {
|
|
let mut irqs = [0; 8];
|
|
if file.read(&mut irqs).expect("psmsd: failed to read irq:12") >= mem::size_of::<usize>() {
|
|
let data: u8;
|
|
unsafe {
|
|
asm!("in al, dx" : "={al}"(data) : "{dx}"(0x60) : : "intel", "volatile");
|
|
}
|
|
|
|
println!("psmsd: IRQ {}: {:X}", unsafe { *(irqs.as_ptr() as *const usize) }, data);
|
|
|
|
file.write(&irqs).expect("psmsd: failed to write irq:12");
|
|
} else {
|
|
thread::yield_now();
|
|
}
|
|
}
|
|
});
|
|
|
|
println!("PS/2 driver running in background");
|
|
}
|