main.rs 4.99 KB
Newer Older
1 2
#![feature(asm)]

Jeremy Soller's avatar
Jeremy Soller committed
3 4
#[macro_use]
extern crate bitflags;
5
extern crate event;
Jeremy Soller's avatar
Jeremy Soller committed
6
extern crate io;
Jeremy Soller's avatar
Jeremy Soller committed
7
extern crate orbclient;
8 9
extern crate syscall;

10 11 12 13
use std::fs::File;
use std::io::{Read, Write, Result};
use std::os::unix::io::AsRawFd;
use std::{mem, thread};
14

15 16
use event::EventQueue;
use orbclient::{KeyEvent, MouseEvent};
17 18
use syscall::iopl;

Jeremy Soller's avatar
Jeremy Soller committed
19
mod controller;
Jeremy Soller's avatar
Jeremy Soller committed
20
mod keymap;
21

22 23 24 25 26 27 28 29 30 31
bitflags! {
    flags MousePacketFlags: u8 {
        const LEFT_BUTTON = 1,
        const RIGHT_BUTTON = 1 << 1,
        const MIDDLE_BUTTON = 1 << 2,
        const ALWAYS_ON = 1 << 3,
        const X_SIGN = 1 << 4,
        const Y_SIGN = 1 << 5,
        const X_OVERFLOW = 1 << 6,
        const Y_OVERFLOW = 1 << 7
Jeremy Soller's avatar
Jeremy Soller committed
32
    }
33
}
34

35
fn main() {
36
    thread::spawn(|| {
37
        unsafe {
Jeremy Soller's avatar
Jeremy Soller committed
38
            iopl(3).expect("ps2d: failed to get I/O permission");
39 40 41
            asm!("cli" :::: "intel", "volatile");
        }

42
        let extra_packet = controller::Ps2::new().init();
43

44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66
        let mut input = File::open("display:input").expect("ps2d: failed to open display:input");

        let mut event_queue = EventQueue::<(bool, u8)>::new().expect("ps2d: failed to create event queue");

        let mut key_irq = File::open("irq:1").expect("ps2d: failed to open irq:1");

        event_queue.add(key_irq.as_raw_fd(), move |_count: usize| -> Result<Option<(bool, u8)>> {
            let mut irq = [0; 8];
            if key_irq.read(&mut irq)? >= mem::size_of::<usize>() {
                let data: u8;
                unsafe {
                    asm!("in al, dx" : "={al}"(data) : "{dx}"(0x60) : : "intel", "volatile");
                }

                key_irq.write(&irq)?;

                Ok(Some((true, data)))
            } else {
                Ok(None)
            }
        }).expect("ps2d: failed to poll irq:1");

        let mut mouse_irq = File::open("irq:12").expect("ps2d: failed to open irq:12");
67

68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153
        event_queue.add(mouse_irq.as_raw_fd(), move |_count: usize| -> Result<Option<(bool, u8)>> {
            let mut irq = [0; 8];
            if mouse_irq.read(&mut irq)? >= mem::size_of::<usize>() {
                let data: u8;
                unsafe {
                    asm!("in al, dx" : "={al}"(data) : "{dx}"(0x60) : : "intel", "volatile");
                }

                mouse_irq.write(&irq)?;

                Ok(Some((false, data)))
            } else {
                Ok(None)
            }
        }).expect("ps2d: failed to poll irq:12");

        let mut lshift = false;
        let mut rshift = false;
        let mut packets = [0; 4];
        let mut packet_i = 0;

        loop {
            let (keyboard, data) = event_queue.run().expect("ps2d: failed to handle events");

            if keyboard {
                let (scancode, pressed) = if data >= 0x80 {
                    (data - 0x80, false)
                } else {
                    (data, true)
                };

                if scancode == 0x2A {
                    lshift = pressed;
                } else if scancode == 0x36 {
                    rshift = pressed;
                }

                input.write(&KeyEvent {
                    character: keymap::get_char(scancode, lshift || rshift),
                    scancode: scancode,
                    pressed: pressed
                }.to_event()).expect("ps2d: failed to write key event");
            } else {
                packets[packet_i] = data;
                packet_i += 1;

                let flags = MousePacketFlags::from_bits_truncate(packets[0]);
                if ! flags.contains(ALWAYS_ON) {
                    println!("MOUSE MISALIGN {:X}", packets[0]);

                    packets = [0; 4];
                    packet_i = 0;
                } else if packet_i >= packets.len() || (!extra_packet && packet_i >= 3) {
                    if ! flags.contains(X_OVERFLOW) && ! flags.contains(Y_OVERFLOW) {
                        let mut dx = packets[1] as i32;
                        if flags.contains(X_SIGN) {
                            dx -= 0x100;
                        }

                        let mut dy = -(packets[2] as i32);
                        if flags.contains(Y_SIGN) {
                            dy += 0x100;
                        }

                        let _extra = if extra_packet {
                            packets[3]
                        } else {
                            0
                        };

                        input.write(&MouseEvent {
                            x: dx,
                            y: dy,
                            left_button: flags.contains(LEFT_BUTTON),
                            middle_button: flags.contains(MIDDLE_BUTTON),
                            right_button: flags.contains(RIGHT_BUTTON)
                        }.to_event()).expect("ps2d: failed to write mouse event");
                    } else {
                        println!("ps2d: overflow {:X} {:X} {:X} {:X}", packets[0], packets[1], packets[2], packets[3]);
                    }

                    packets = [0; 4];
                    packet_i = 0;
                }
            }
        }
Jeremy Soller's avatar
Jeremy Soller committed
154
    });
155
}