mirror of
https://github.com/RGBCube/serenity
synced 2025-07-25 14:27:35 +00:00
Kernel: Enumify all magic constants for I8042 devices
This makes the code much easier to read.
This commit is contained in:
parent
0a748de1a0
commit
26c84967fa
4 changed files with 115 additions and 82 deletions
|
@ -37,51 +37,51 @@ UNMAP_AFTER_INIT void I8042Controller::detect_devices()
|
|||
{
|
||||
SpinlockLocker lock(m_lock);
|
||||
// Disable devices
|
||||
do_wait_then_write(I8042_STATUS, 0xad);
|
||||
do_wait_then_write(I8042_STATUS, 0xa7); // ignored if it doesn't exist
|
||||
do_wait_then_write(I8042Port::Command, I8042Command::DisableFirstPS2Port);
|
||||
do_wait_then_write(I8042Port::Command, I8042Command::DisableSecondPS2Port); // ignored if it doesn't exist
|
||||
|
||||
// Drain buffers
|
||||
do_drain();
|
||||
|
||||
do_wait_then_write(I8042_STATUS, 0x20);
|
||||
configuration = do_wait_then_read(I8042_BUFFER);
|
||||
do_wait_then_write(I8042_STATUS, 0x60);
|
||||
configuration &= ~3; // Disable IRQs for all
|
||||
do_wait_then_write(I8042_BUFFER, configuration);
|
||||
do_wait_then_write(I8042Port::Command, I8042Command::ReadConfiguration);
|
||||
configuration = do_wait_then_read(I8042Port::Buffer);
|
||||
do_wait_then_write(I8042Port::Command, I8042Command::WriteConfiguration);
|
||||
configuration &= ~I8042ConfigurationFlag::FirstPS2PortInterrupt;
|
||||
configuration &= ~I8042ConfigurationFlag::SecondPS2PortInterrupt;
|
||||
do_wait_then_write(I8042Port::Buffer, configuration);
|
||||
|
||||
m_is_dual_channel = (configuration & (1 << 5)) != 0;
|
||||
dbgln("I8042: {} channel controller",
|
||||
m_is_dual_channel ? "Dual" : "Single");
|
||||
m_is_dual_channel = (configuration & I8042ConfigurationFlag::SecondPS2PortClock) != 0;
|
||||
dbgln("I8042: {} channel controller", m_is_dual_channel ? "Dual" : "Single");
|
||||
|
||||
// Perform controller self-test
|
||||
do_wait_then_write(I8042_STATUS, 0xaa);
|
||||
if (do_wait_then_read(I8042_BUFFER) == 0x55) {
|
||||
do_wait_then_write(I8042Port::Command, I8042Command::TestPS2Controller);
|
||||
if (do_wait_then_read(I8042Port::Buffer) == I8042Response::ControllerTestPassed) {
|
||||
// Restore configuration in case the controller reset
|
||||
do_wait_then_write(I8042_STATUS, 0x60);
|
||||
do_wait_then_write(I8042_BUFFER, configuration);
|
||||
do_wait_then_write(I8042Port::Command, I8042Command::WriteConfiguration);
|
||||
do_wait_then_write(I8042Port::Buffer, configuration);
|
||||
} else {
|
||||
dbgln("I8042: Controller self test failed");
|
||||
}
|
||||
|
||||
// Test ports and enable them if available
|
||||
do_wait_then_write(I8042_STATUS, 0xab); // test
|
||||
m_first_port_available = (do_wait_then_read(I8042_BUFFER) == 0);
|
||||
do_wait_then_write(I8042Port::Command, I8042Command::TestFirstPS2Port);
|
||||
m_first_port_available = (do_wait_then_read(I8042Port::Buffer) == 0);
|
||||
|
||||
if (m_first_port_available) {
|
||||
do_wait_then_write(I8042_STATUS, 0xae); //enable
|
||||
configuration |= 1;
|
||||
configuration &= ~(1 << 4);
|
||||
do_wait_then_write(I8042Port::Command, I8042Command::EnableFirstPS2Port);
|
||||
configuration |= I8042ConfigurationFlag::FirstPS2PortInterrupt;
|
||||
configuration &= ~I8042ConfigurationFlag::FirstPS2PortClock;
|
||||
} else {
|
||||
dbgln("I8042: Keyboard port not available");
|
||||
}
|
||||
|
||||
if (m_is_dual_channel) {
|
||||
do_wait_then_write(I8042_STATUS, 0xa9); // test
|
||||
m_second_port_available = (do_wait_then_read(I8042_BUFFER) == 0);
|
||||
do_wait_then_write(I8042Port::Command, I8042Command::TestSecondPS2Port);
|
||||
m_second_port_available = (do_wait_then_read(I8042Port::Buffer) == 0);
|
||||
if (m_second_port_available) {
|
||||
do_wait_then_write(I8042_STATUS, 0xa8); // enable
|
||||
configuration |= 2;
|
||||
configuration &= ~(1 << 5);
|
||||
do_wait_then_write(I8042Port::Command, I8042Command::EnableSecondPS2Port);
|
||||
configuration |= I8042ConfigurationFlag::SecondPS2PortInterrupt;
|
||||
configuration &= ~I8042ConfigurationFlag::SecondPS2PortClock;
|
||||
} else {
|
||||
dbgln("I8042: Mouse port not available");
|
||||
}
|
||||
|
@ -89,9 +89,10 @@ UNMAP_AFTER_INIT void I8042Controller::detect_devices()
|
|||
|
||||
// Enable IRQs for the ports that are usable
|
||||
if (m_first_port_available || m_second_port_available) {
|
||||
configuration &= ~0x30; // renable clocks
|
||||
do_wait_then_write(I8042_STATUS, 0x60);
|
||||
do_wait_then_write(I8042_BUFFER, configuration);
|
||||
configuration &= ~I8042ConfigurationFlag::FirstPS2PortClock;
|
||||
configuration &= ~I8042ConfigurationFlag::SecondPS2PortClock;
|
||||
do_wait_then_write(I8042Port::Command, I8042Command::WriteConfiguration);
|
||||
do_wait_then_write(I8042Port::Buffer, configuration);
|
||||
}
|
||||
}
|
||||
|
||||
|
@ -101,11 +102,11 @@ UNMAP_AFTER_INIT void I8042Controller::detect_devices()
|
|||
if (!m_keyboard_device) {
|
||||
dbgln("I8042: Keyboard device failed to initialize, disable");
|
||||
m_first_port_available = false;
|
||||
configuration &= ~1;
|
||||
configuration |= 1 << 4;
|
||||
configuration &= ~I8042ConfigurationFlag::FirstPS2PortInterrupt;
|
||||
configuration |= I8042ConfigurationFlag::FirstPS2PortClock;
|
||||
SpinlockLocker lock(m_lock);
|
||||
do_wait_then_write(I8042_STATUS, 0x60);
|
||||
do_wait_then_write(I8042_BUFFER, configuration);
|
||||
do_wait_then_write(I8042Port::Command, I8042Command::WriteConfiguration);
|
||||
do_wait_then_write(I8042Port::Buffer, configuration);
|
||||
}
|
||||
}
|
||||
if (m_second_port_available) {
|
||||
|
@ -115,10 +116,10 @@ UNMAP_AFTER_INIT void I8042Controller::detect_devices()
|
|||
if (!m_mouse_device) {
|
||||
dbgln("I8042: Mouse device failed to initialize, disable");
|
||||
m_second_port_available = false;
|
||||
configuration |= 1 << 5;
|
||||
configuration |= I8042ConfigurationFlag::SecondPS2PortClock;
|
||||
SpinlockLocker lock(m_lock);
|
||||
do_wait_then_write(I8042_STATUS, 0x60);
|
||||
do_wait_then_write(I8042_BUFFER, configuration);
|
||||
do_wait_then_write(I8042Port::Command, I8042Command::WriteConfiguration);
|
||||
do_wait_then_write(I8042Port::Buffer, configuration);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
@ -134,11 +135,11 @@ bool I8042Controller::irq_process_input_buffer(HIDDevice::Type)
|
|||
{
|
||||
VERIFY(Processor::current_in_irq());
|
||||
|
||||
u8 status = IO::in8(I8042_STATUS);
|
||||
if (!(status & I8042_BUFFER_FULL))
|
||||
u8 status = IO::in8(I8042Port::Status);
|
||||
if (!(status & I8042StatusFlag::OutputBuffer))
|
||||
return false;
|
||||
HIDDevice::Type data_for_device = ((status & I8042_WHICH_BUFFER) == I8042_MOUSE_BUFFER) ? HIDDevice::Type::Mouse : HIDDevice::Type::Keyboard;
|
||||
u8 byte = IO::in8(I8042_BUFFER);
|
||||
HIDDevice::Type data_for_device = ((status & I8042StatusFlag::SecondPS2PortOutputBuffer) == 0) ? HIDDevice::Type::Keyboard : HIDDevice::Type::Mouse;
|
||||
u8 byte = IO::in8(I8042Port::Buffer);
|
||||
if (data_for_device == HIDDevice::Type::Mouse) {
|
||||
VERIFY(m_mouse_device);
|
||||
static_cast<PS2MouseDevice&>(*m_mouse_device).irq_handle_byte_read(byte);
|
||||
|
@ -155,10 +156,10 @@ bool I8042Controller::irq_process_input_buffer(HIDDevice::Type)
|
|||
void I8042Controller::do_drain()
|
||||
{
|
||||
for (;;) {
|
||||
u8 status = IO::in8(I8042_STATUS);
|
||||
if (!(status & I8042_BUFFER_FULL))
|
||||
u8 status = IO::in8(I8042Port::Status);
|
||||
if (!(status & I8042StatusFlag::OutputBuffer))
|
||||
return;
|
||||
IO::in8(I8042_BUFFER);
|
||||
IO::in8(I8042Port::Buffer);
|
||||
}
|
||||
}
|
||||
|
||||
|
@ -168,10 +169,10 @@ bool I8042Controller::do_reset_device(HIDDevice::Type device)
|
|||
VERIFY(m_lock.is_locked());
|
||||
|
||||
VERIFY(!Processor::current_in_irq());
|
||||
if (do_send_command(device, 0xff) != I8042_ACK)
|
||||
if (do_send_command(device, I8042Command::Reset) != I8042Response::Acknowledge)
|
||||
return false;
|
||||
// Wait until we get the self-test result
|
||||
return do_wait_then_read(I8042_BUFFER) == 0xaa;
|
||||
return do_wait_then_read(I8042Port::Buffer) == I8042Response::Success;
|
||||
}
|
||||
|
||||
u8 I8042Controller::do_send_command(HIDDevice::Type device, u8 command)
|
||||
|
@ -192,7 +193,7 @@ u8 I8042Controller::do_send_command(HIDDevice::Type device, u8 command, u8 data)
|
|||
VERIFY(!Processor::current_in_irq());
|
||||
|
||||
u8 response = do_write_to_device(device, command);
|
||||
if (response == I8042_ACK)
|
||||
if (response == I8042Response::Acknowledge)
|
||||
response = do_write_to_device(device, data);
|
||||
return response;
|
||||
}
|
||||
|
@ -209,13 +210,13 @@ u8 I8042Controller::do_write_to_device(HIDDevice::Type device, u8 data)
|
|||
do {
|
||||
if (device != HIDDevice::Type::Keyboard) {
|
||||
prepare_for_output();
|
||||
IO::out8(I8042_STATUS, 0xd4);
|
||||
IO::out8(I8042Port::Command, I8042Command::WriteSecondPS2PortInputBuffer);
|
||||
}
|
||||
prepare_for_output();
|
||||
IO::out8(I8042_BUFFER, data);
|
||||
IO::out8(I8042Port::Buffer, data);
|
||||
|
||||
response = do_wait_then_read(I8042_BUFFER);
|
||||
} while (response == I8042_RESEND && ++attempts < 3);
|
||||
response = do_wait_then_read(I8042Port::Buffer);
|
||||
} while (response == I8042Response::Resend && ++attempts < 3);
|
||||
if (attempts >= 3)
|
||||
dbgln("Failed to write byte to device, gave up");
|
||||
return response;
|
||||
|
@ -226,16 +227,20 @@ u8 I8042Controller::do_read_from_device(HIDDevice::Type device)
|
|||
VERIFY(device != HIDDevice::Type::Unknown);
|
||||
|
||||
prepare_for_input(device);
|
||||
return IO::in8(I8042_BUFFER);
|
||||
return IO::in8(I8042Port::Buffer);
|
||||
}
|
||||
|
||||
void I8042Controller::prepare_for_input(HIDDevice::Type device)
|
||||
{
|
||||
VERIFY(m_lock.is_locked());
|
||||
const u8 buffer_type = device == HIDDevice::Type::Keyboard ? I8042_KEYBOARD_BUFFER : I8042_MOUSE_BUFFER;
|
||||
u8 const second_port_flag = device == HIDDevice::Type::Keyboard ? 0 : I8042StatusFlag::SecondPS2PortOutputBuffer;
|
||||
for (;;) {
|
||||
u8 status = IO::in8(I8042_STATUS);
|
||||
if ((status & I8042_BUFFER_FULL) && (device == HIDDevice::Type::Unknown || ((status & I8042_WHICH_BUFFER) == buffer_type)))
|
||||
u8 status = IO::in8(I8042Port::Status);
|
||||
if (!(status & I8042StatusFlag::OutputBuffer))
|
||||
continue;
|
||||
if (device == HIDDevice::Type::Unknown)
|
||||
return;
|
||||
if ((status & I8042StatusFlag::SecondPS2PortOutputBuffer) == second_port_flag)
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
@ -244,7 +249,8 @@ void I8042Controller::prepare_for_output()
|
|||
{
|
||||
VERIFY(m_lock.is_locked());
|
||||
for (;;) {
|
||||
if (!(IO::in8(I8042_STATUS) & 2))
|
||||
u8 status = IO::in8(I8042Port::Status);
|
||||
if (!(status & I8042StatusFlag::InputBuffer))
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue