1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
|
// MIT License, Copyright (c) 2020 Marvin Borner
#include <boot.h>
#include <cpu.h>
#include <errno.h>
#include <fs.h>
#include <interrupts.h>
#include <mem.h>
#include <mouse.h>
#include <print.h>
#include <proc.h>
#include <stack.h>
#include <str.h>
#include <sys.h>
PROTECTED static struct stack *queue = NULL;
PROTECTED static u32 dev_id = 0;
static struct event_mouse *event = NULL;
static char mouse_cycle = 0;
static char mouse_byte[3] = { 0 };
static void mouse_handler(struct regs *r)
{
UNUSED(r);
switch (mouse_cycle) {
case 0:
mouse_byte[0] = (char)inb(0x60);
if (((mouse_byte[0] >> 3) & 1) == 1)
mouse_cycle++;
else
mouse_cycle = 0;
break;
case 1:
mouse_byte[1] = (char)inb(0x60);
mouse_cycle++;
break;
case 2:
mouse_byte[2] = (char)inb(0x60);
event = malloc(sizeof(*event));
event->magic = MOUSE_MAGIC;
event->diff_x = mouse_byte[1];
event->diff_y = mouse_byte[2];
event->but1 = mouse_byte[0] & 1;
event->but2 = (mouse_byte[0] >> 1) & 1;
event->but3 = (mouse_byte[0] >> 2) & 1;
stack_push_bot(queue, event);
mouse_cycle = 0;
proc_unblock(dev_id, PROC_BLOCK_DEV);
break;
default:
break;
}
}
CLEAR static void mouse_serial_wait(u8 a_type)
{
u32 time_out = 100000;
if (a_type == 0) {
while (time_out--)
if ((inb(0x64) & 1) == 1)
return;
return;
} else {
while (time_out--)
if ((inb(0x64) & 2) == 0)
return;
return;
}
}
CLEAR static void mouse_serial_write(u8 a_write)
{
mouse_serial_wait(1);
outb(0x64, 0xD4);
mouse_serial_wait(1);
outb(0x60, a_write);
}
CLEAR static u8 mouse_serial_read(void)
{
mouse_serial_wait(0);
return inb(0x60);
}
static res mouse_ready(void)
{
return !stack_empty(queue);
}
static res mouse_read(void *buf, u32 offset, u32 count, struct device *dev)
{
(void)dev;
if (stack_empty(queue))
return -EINVAL;
struct event_mouse *e = stack_pop(queue);
memcpy(buf, (u8 *)e + offset, MIN(count, sizeof(*e)));
free(e);
return MIN(count, sizeof(*e));
}
CLEAR void mouse_install(void)
{
u8 status;
// Enable auxiliary mouse device
mouse_serial_wait(1);
outb(0x64, 0xA8);
// Enable interrupts
mouse_serial_wait(1);
outb(0x64, 0x20);
mouse_serial_wait(0);
status = (u8)(inb(0x60) | 3);
mouse_serial_wait(1);
outb(0x64, 0x60);
mouse_serial_wait(1);
outb(0x60, status);
// Use default settings
mouse_serial_write(0xF6);
mouse_serial_read();
// Enable mousewheel
mouse_serial_write(0xF2);
mouse_serial_read();
mouse_serial_read();
mouse_serial_write(0xF3);
mouse_serial_read();
mouse_serial_write(200);
mouse_serial_read();
mouse_serial_write(0xF3);
mouse_serial_read();
mouse_serial_write(100);
mouse_serial_read();
mouse_serial_write(0xF3);
mouse_serial_read();
mouse_serial_write(80);
mouse_serial_read();
mouse_serial_write(0xF2);
mouse_serial_read();
status = (u8)mouse_serial_read();
if (status == 3) {
}
/* printf("Scrollwheel support!\n"); */
// Activate 4th and 5th mouse buttons
mouse_serial_write(0xF2);
mouse_serial_read();
mouse_serial_read();
mouse_serial_write(0xF3);
mouse_serial_read();
mouse_serial_write(200);
mouse_serial_read();
mouse_serial_write(0xF3);
mouse_serial_read();
mouse_serial_write(200);
mouse_serial_read();
mouse_serial_write(0xF3);
mouse_serial_read();
mouse_serial_write(80);
mouse_serial_read();
mouse_serial_write(0xF2);
mouse_serial_read();
status = (u8)mouse_serial_read();
if (status == 4) {
}
/* printf("4th and 5th mouse button support!\n"); */
/* TODO: Fix mouse laggyness
mouse_serial_write(0xE8);
mouse_serial_read();
mouse_serial_write(0x03);
mouse_serial_read();
mouse_serial_write(0xF3);
mouse_serial_read();
mouse_serial_write(200);
mouse_serial_read(); */
// Enable mouse
mouse_serial_write(0xF4);
mouse_serial_read();
// Setup the mouse handler
irq_install_handler(12, mouse_handler);
queue = stack_new();
struct device *dev = zalloc(sizeof(*dev));
dev->name = strdup("mouse");
dev->type = DEV_CHAR;
dev->read = mouse_read;
dev->ready = mouse_ready;
device_add(dev);
dev_id = dev->id;
}
|
