forked from AbleOS/ableos
101 lines
2.4 KiB
Plaintext
101 lines
2.4 KiB
Plaintext
.{memory, log} := @use("../../../libraries/stn/src/lib.hb");
|
|
.{bit0, bit1, bit5, bit6, bit7} := @use("bits.hb");
|
|
.{Port, PORT_AT_STARTUP} := @use("port.hb")
|
|
|
|
port1 := @as(Port, PORT_AT_STARTUP)
|
|
port2 := @as(Port, PORT_AT_STARTUP)
|
|
|
|
//wiki.osdev.org/"8042"_PS/2_Controller#PS/2_Controller_IO_Ports
|
|
$CONTROLLER_PORT := 0x64
|
|
$DATA_PORT := 0x60
|
|
|
|
$disable_port1 := fn(): void memory.outb(CONTROLLER_PORT, 0xAD)
|
|
$enable_port1 := fn(): void memory.outb(CONTROLLER_PORT, 0xAE)
|
|
$disable_port2 := fn(): void memory.outb(CONTROLLER_PORT, 0xA7)
|
|
$enable_port2 := fn(): void memory.outb(CONTROLLER_PORT, 0xA8)
|
|
|
|
test_port1 := fn(): bool {
|
|
memory.outb(CONTROLLER_PORT, 0xAB)
|
|
loop if has_input(get_info()) break
|
|
input := get_input()
|
|
return input == 0x0
|
|
}
|
|
|
|
test_port2 := fn(): bool {
|
|
memory.outb(CONTROLLER_PORT, 0xA9)
|
|
loop if has_input(get_info()) break
|
|
input := get_input()
|
|
return input == 0x0
|
|
}
|
|
|
|
get_config_byte := fn(): u8 {
|
|
memory.outb(CONTROLLER_PORT, 0x20)
|
|
loop if has_input(get_info()) break
|
|
return get_input()
|
|
}
|
|
|
|
Info := struct {d: u8}
|
|
|
|
$get_info := fn(): Info return .(memory.inb(CONTROLLER_PORT))
|
|
//inline when can
|
|
has_input := fn(info: Info): bool return bit0(info.d)
|
|
can_send := fn(info: Info): bool return bit1(info.d) == false
|
|
timed_out := fn(info: Info): bool return bit6(info.d)
|
|
check_parity := fn(info: Info): bool return bit7(info.d)
|
|
get_port := fn(info: Info): ^Port {
|
|
if bit5(info.d) {
|
|
return &port2
|
|
} else {
|
|
return &port1
|
|
}
|
|
}
|
|
|
|
//T
|
|
port2_ptr := &port2
|
|
send_byte := fn(port: ^Port, byte: u8): void {
|
|
if port == port2_ptr {
|
|
memory.outb(CONTROLLER_PORT, 0xD4)
|
|
}
|
|
loop if can_send(get_info()) break
|
|
memory.outb(DATA_PORT, byte)
|
|
}
|
|
|
|
$get_input := fn(): u8 return memory.inb(DATA_PORT)
|
|
$write_out := fn(data: u8): void memory.outb(DATA_PORT, data)
|
|
|
|
flush_input := fn(): void {
|
|
loop if has_input(get_info()) == false break else get_info()
|
|
}
|
|
|
|
init := fn(): void {
|
|
disable_port1()
|
|
disable_port2()
|
|
//Disables ports to make sure that they won't interfere with the setup process.
|
|
|
|
flush_input()
|
|
|
|
enable_port2()
|
|
port2.exists = bit5(@inline(get_config_byte)) == false
|
|
disable_port2()
|
|
|
|
flush_input()
|
|
|
|
port1.exists = test_port1()
|
|
|
|
if port2.exists {
|
|
port2.exists = test_port2()
|
|
}
|
|
|
|
if (port1.exists | port2.exists) == false {
|
|
log.error("No ports detected! No input will be processed! Cannot handle this!\0")
|
|
}
|
|
|
|
if port1.exists {
|
|
log.info("Port 1 exists.\0")
|
|
enable_port1()
|
|
}
|
|
if port2.exists {
|
|
log.info("Port 2 exists.\0")
|
|
enable_port2()
|
|
}
|
|
} |