mirror of
https://github.com/Fennix-Project/Kernel.git
synced 2025-07-10 06:49:17 +00:00
Update filesystem structure
This commit is contained in:
234
Modules/PersonalSystem2/Mouse.cpp
Normal file
234
Modules/PersonalSystem2/Mouse.cpp
Normal file
@ -0,0 +1,234 @@
|
||||
#include "mouse.hpp"
|
||||
|
||||
#include <debug.h>
|
||||
#include <io.h>
|
||||
|
||||
#include "../../DAPI.hpp"
|
||||
#include "../drv.hpp"
|
||||
|
||||
namespace PS2Mouse
|
||||
{
|
||||
KernelAPI KAPI;
|
||||
|
||||
int MouseX = 0, MouseY = 0, MouseZ = 0;
|
||||
int MouseLeft = 0, MouseMiddle = 0, MouseRight = 0;
|
||||
|
||||
uint8_t Packet[4];
|
||||
bool PacketReady = false;
|
||||
uint8_t Cycle = 0;
|
||||
|
||||
void WaitRead()
|
||||
{
|
||||
uint64_t Timeout = 100000;
|
||||
while (Timeout--)
|
||||
if (inb(Ports::STATUS) & State::OUTPUT_FULL)
|
||||
return;
|
||||
}
|
||||
|
||||
void WaitWrite()
|
||||
{
|
||||
uint64_t Timeout = 100000;
|
||||
while (Timeout--)
|
||||
if ((inb(Ports::STATUS) & State::INPUT_FULL) == 0)
|
||||
return;
|
||||
}
|
||||
|
||||
uint8_t Read()
|
||||
{
|
||||
WaitRead();
|
||||
return inb(Ports::DATA);
|
||||
}
|
||||
|
||||
void Write(uint16_t Port, uint8_t Value)
|
||||
{
|
||||
WaitWrite();
|
||||
outb(Port, Value);
|
||||
}
|
||||
|
||||
int DriverEntry(void *Data)
|
||||
{
|
||||
if (!Data)
|
||||
return INVALID_KERNEL_API;
|
||||
KAPI = *(KernelAPI *)Data;
|
||||
if (KAPI.Version.Major < 0 || KAPI.Version.Minor < 0 || KAPI.Version.Patch < 0)
|
||||
return KERNEL_API_VERSION_NOT_SUPPORTED;
|
||||
|
||||
return OK;
|
||||
}
|
||||
|
||||
int CallbackHandler(KernelCallback *Data)
|
||||
{
|
||||
switch (Data->Reason)
|
||||
{
|
||||
case AcknowledgeReason:
|
||||
{
|
||||
debug("Kernel acknowledged the driver.");
|
||||
break;
|
||||
}
|
||||
case ConfigurationReason:
|
||||
{
|
||||
outb(COMMAND, 0xA8);
|
||||
Write(COMMAND, READ_CONFIG);
|
||||
uint8_t Status = Read();
|
||||
Status |= 0b10;
|
||||
Write(COMMAND, WRITE_CONFIG);
|
||||
Write(DATA, Status);
|
||||
Write(COMMAND, 0xD4);
|
||||
Write(DATA, 0xF6);
|
||||
Read();
|
||||
Write(COMMAND, 0xD4);
|
||||
Write(DATA, 0xF4);
|
||||
Read();
|
||||
|
||||
trace("PS/2 mouse configured.");
|
||||
break;
|
||||
}
|
||||
case FetchReason:
|
||||
{
|
||||
Data->InputCallback.Mouse.X = MouseX;
|
||||
Data->InputCallback.Mouse.Y = MouseY;
|
||||
Data->InputCallback.Mouse.Z = MouseZ;
|
||||
Data->InputCallback.Mouse.Buttons.Left = MouseLeft;
|
||||
Data->InputCallback.Mouse.Buttons.Right = MouseRight;
|
||||
Data->InputCallback.Mouse.Buttons.Middle = MouseMiddle;
|
||||
break;
|
||||
}
|
||||
case StopReason:
|
||||
{
|
||||
outb(COMMAND, 0xA8);
|
||||
Write(COMMAND, READ_CONFIG);
|
||||
uint8_t Status = Read();
|
||||
Status &= ~0b10;
|
||||
Write(COMMAND, WRITE_CONFIG);
|
||||
Write(DATA, Status);
|
||||
Write(COMMAND, 0xD4);
|
||||
Write(DATA, 0xF5);
|
||||
Read();
|
||||
|
||||
debug("Driver stopped.");
|
||||
break;
|
||||
}
|
||||
default:
|
||||
{
|
||||
warn("Unknown reason.");
|
||||
break;
|
||||
}
|
||||
}
|
||||
return OK;
|
||||
}
|
||||
|
||||
int InterruptCallback(CPURegisters *)
|
||||
{
|
||||
uint8_t Data = inb(0x60);
|
||||
|
||||
if (__builtin_expect(!!(PacketReady), 0))
|
||||
{
|
||||
bool XNegative, YNegative, XOverflow, YOverflow;
|
||||
|
||||
if (Packet[0] & PS2XSign)
|
||||
XNegative = true;
|
||||
else
|
||||
XNegative = false;
|
||||
|
||||
if (Packet[0] & PS2YSign)
|
||||
YNegative = true;
|
||||
else
|
||||
YNegative = false;
|
||||
|
||||
if (Packet[0] & PS2XOverflow)
|
||||
XOverflow = true;
|
||||
else
|
||||
XOverflow = false;
|
||||
|
||||
if (Packet[0] & PS2YOverflow)
|
||||
YOverflow = true;
|
||||
else
|
||||
YOverflow = false;
|
||||
|
||||
if (!XNegative)
|
||||
{
|
||||
MouseX += Packet[1];
|
||||
if (XOverflow)
|
||||
MouseX += 255;
|
||||
}
|
||||
else
|
||||
{
|
||||
Packet[1] = (uint8_t)(256 - Packet[1]);
|
||||
MouseX -= Packet[1];
|
||||
if (XOverflow)
|
||||
MouseX -= 255;
|
||||
}
|
||||
|
||||
if (!YNegative)
|
||||
{
|
||||
MouseY -= Packet[2];
|
||||
if (YOverflow)
|
||||
MouseY -= 255;
|
||||
}
|
||||
else
|
||||
{
|
||||
Packet[2] = (uint8_t)(256 - Packet[2]);
|
||||
MouseY += Packet[2];
|
||||
if (YOverflow)
|
||||
MouseY += 255;
|
||||
}
|
||||
|
||||
uint32_t Width = KAPI.Display.GetWidth();
|
||||
uint32_t Height = KAPI.Display.GetHeight();
|
||||
|
||||
if (MouseX < 0)
|
||||
MouseX = 0;
|
||||
|
||||
if ((uint32_t)MouseX > Width - 1)
|
||||
MouseX = Width - 1;
|
||||
|
||||
if (MouseY < 0)
|
||||
MouseY = 0;
|
||||
if ((uint32_t)MouseY > Height - 1)
|
||||
MouseY = Height - 1;
|
||||
|
||||
MouseLeft = 0;
|
||||
MouseMiddle = 0;
|
||||
MouseRight = 0;
|
||||
|
||||
if (Packet[0] & PS2LeftButton)
|
||||
MouseLeft = 1;
|
||||
if (Packet[0] & PS2MiddleButton)
|
||||
MouseMiddle = 1;
|
||||
if (Packet[0] & PS2RightButton)
|
||||
MouseRight = 1;
|
||||
PacketReady = false;
|
||||
}
|
||||
|
||||
switch (Cycle)
|
||||
{
|
||||
case 0:
|
||||
{
|
||||
if ((Data & 0b00001000) == 0)
|
||||
break;
|
||||
Packet[0] = Data;
|
||||
Cycle++;
|
||||
break;
|
||||
}
|
||||
case 1:
|
||||
{
|
||||
Packet[1] = Data;
|
||||
Cycle++;
|
||||
break;
|
||||
}
|
||||
case 2:
|
||||
{
|
||||
Packet[2] = Data;
|
||||
PacketReady = true;
|
||||
Cycle = 0;
|
||||
break;
|
||||
}
|
||||
default:
|
||||
{
|
||||
warn("Unknown cycle %d", Cycle);
|
||||
break;
|
||||
}
|
||||
}
|
||||
return OK;
|
||||
}
|
||||
}
|
Reference in New Issue
Block a user