Update filesystem structure

2025-07-10 06:49:17 +00:00 · 2023-05-20 04:31:14 +03:00
parent 81c40be73a
commit e8162bc3cb
26 changed files with 35 additions and 60 deletions
--- a/Modules/PersonalSystem2/Mouse.cpp
+++ b/Modules/PersonalSystem2/Mouse.cpp
@ -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;
+	}
+}