toaruos/modules/ps2mouse.c

152 lines
3.3 KiB
C
Raw Normal View History

/* vim: tabstop=4 shiftwidth=4 noexpandtab
* Mouse driver
*/
2011-10-29 09:33:45 +04:00
#include <system.h>
#include <logging.h>
2012-02-03 02:16:29 +04:00
#include <pipe.h>
2014-03-17 02:13:27 +04:00
#include <module.h>
2012-02-03 02:16:29 +04:00
#include <mouse.h>
2011-10-29 09:33:45 +04:00
2014-03-17 02:13:27 +04:00
static uint8_t mouse_cycle = 0;
static int8_t mouse_byte[3];
2011-10-29 09:33:45 +04:00
2012-12-08 12:24:43 +04:00
#define PACKETS_IN_PIPE 1024
#define DISCARD_POINT 32
#define MOUSE_IRQ 12
2011-10-29 09:33:45 +04:00
#define MOUSE_PORT 0x60
#define MOUSE_STATUS 0x64
#define MOUSE_ABIT 0x02
#define MOUSE_BBIT 0x01
#define MOUSE_WRITE 0xD4
#define MOUSE_F_BIT 0x20
#define MOUSE_V_BIT 0x08
2014-03-17 02:13:27 +04:00
static fs_node_t * mouse_pipe;
2011-10-29 09:33:45 +04:00
2014-03-17 02:13:27 +04:00
static void mouse_wait(uint8_t a_type) {
2011-10-29 09:33:45 +04:00
uint32_t timeout = 100000;
if (!a_type) {
while (--timeout) {
if ((inportb(MOUSE_STATUS) & MOUSE_BBIT) == 1) {
2011-10-29 09:33:45 +04:00
return;
}
}
2012-12-08 06:33:07 +04:00
debug_print(INFO, "mouse timeout");
2011-10-29 09:33:45 +04:00
return;
} else {
while (--timeout) {
if (!((inportb(MOUSE_STATUS) & MOUSE_ABIT))) {
2011-10-29 09:33:45 +04:00
return;
}
}
2012-12-08 06:33:07 +04:00
debug_print(INFO, "mouse timeout");
2011-10-29 09:33:45 +04:00
return;
}
}
2014-03-17 02:13:27 +04:00
static void mouse_write(uint8_t write) {
2011-10-29 09:33:45 +04:00
mouse_wait(1);
outportb(MOUSE_STATUS, MOUSE_WRITE);
2011-10-29 09:33:45 +04:00
mouse_wait(1);
outportb(MOUSE_PORT, write);
2011-10-29 09:33:45 +04:00
}
2014-03-17 02:13:27 +04:00
static uint8_t mouse_read(void) {
2011-10-29 09:33:45 +04:00
mouse_wait(0);
char t = inportb(MOUSE_PORT);
return t;
2011-10-29 09:33:45 +04:00
}
2014-03-17 02:13:27 +04:00
static void mouse_handler(struct regs *r) {
uint8_t status = inportb(MOUSE_STATUS);
while (status & MOUSE_BBIT) {
int8_t mouse_in = inportb(MOUSE_PORT);
if (status & MOUSE_F_BIT) {
switch (mouse_cycle) {
case 0:
mouse_byte[0] = mouse_in;
if (!(mouse_in & MOUSE_V_BIT)) return;
++mouse_cycle;
break;
case 1:
mouse_byte[1] = mouse_in;
++mouse_cycle;
break;
case 2:
mouse_byte[2] = mouse_in;
/* We now have a full mouse packet ready to use */
if (mouse_byte[0] & 0x80 || mouse_byte[0] & 0x40) {
/* x/y overflow? bad packet! */
break;
}
mouse_device_packet_t packet;
packet.magic = MOUSE_MAGIC;
packet.x_difference = mouse_byte[1];
packet.y_difference = mouse_byte[2];
packet.buttons = 0;
if (mouse_byte[0] & 0x01) {
packet.buttons |= LEFT_CLICK;
}
if (mouse_byte[0] & 0x02) {
packet.buttons |= RIGHT_CLICK;
}
if (mouse_byte[0] & 0x04) {
packet.buttons |= MIDDLE_CLICK;
}
mouse_cycle = 0;
mouse_device_packet_t bitbucket;
2013-03-23 02:11:19 +04:00
while (pipe_size(mouse_pipe) > (int)(DISCARD_POINT * sizeof(packet))) {
read_fs(mouse_pipe, 0, sizeof(packet), (uint8_t *)&bitbucket);
}
write_fs(mouse_pipe, 0, sizeof(packet), (uint8_t *)&packet);
break;
}
}
status = inportb(MOUSE_STATUS);
}
irq_ack(MOUSE_IRQ);
}
2014-03-17 02:13:27 +04:00
static int mouse_install(void) {
2012-12-08 06:33:07 +04:00
debug_print(NOTICE, "Initializing PS/2 mouse interface");
2011-10-29 09:33:45 +04:00
uint8_t status;
IRQ_OFF;
mouse_pipe = make_pipe(sizeof(mouse_device_packet_t) * PACKETS_IN_PIPE);
2011-10-29 09:33:45 +04:00
mouse_wait(1);
outportb(MOUSE_STATUS, 0xA8);
2011-10-29 09:33:45 +04:00
mouse_wait(1);
outportb(MOUSE_STATUS, 0x20);
2011-10-29 09:33:45 +04:00
mouse_wait(0);
status = inportb(0x60) | 2;
mouse_wait(1);
outportb(MOUSE_STATUS, 0x60);
2011-10-29 09:33:45 +04:00
mouse_wait(1);
outportb(MOUSE_PORT, status);
2011-10-29 09:33:45 +04:00
mouse_write(0xF6);
mouse_read();
mouse_write(0xF4);
mouse_read();
IRQ_RES;
irq_install_handler(MOUSE_IRQ, mouse_handler);
2014-03-17 02:13:27 +04:00
uint8_t tmp = inportb(0x61);
outportb(0x61, tmp | 0x80);
outportb(0x61, tmp & 0x7F);
inportb(MOUSE_PORT);
mouse_pipe->flags = FS_CHARDEVICE;
2014-03-17 02:13:27 +04:00
vfs_mount("/dev/mouse", mouse_pipe);
return 0;
2011-10-29 09:33:45 +04:00
}
2014-03-17 02:13:27 +04:00
static int mouse_uninstall(void) {
/* TODO */
return 0;
}
MODULE_DEF(ps2mouse, mouse_install, mouse_uninstall);