]>
git.gir.st - tmk_keyboard.git/blob - ps2_mouse.c
8 #define PS2_MOUSE_DEBUG
18 // disable when errors occur 255 times.
19 #define ERROR_RETURN() do { \
21 if (ps2_mouse_error_count < 255) { \
22 ps2_mouse_error_count++; \
24 ps2_mouse_error_count = 0; \
25 ps2_mouse_enable = false; \
36 - Tracpoint command support: needed
37 - Middle button + move = Wheel traslation
39 bool ps2_mouse_enable
= true;
40 uint8_t ps2_mouse_x
= 0;
41 uint8_t ps2_mouse_y
= 0;
42 uint8_t ps2_mouse_btn
= 0;
43 uint8_t ps2_mouse_error_count
= 0;
45 static uint8_t ps2_mouse_btn_prev
= 0;
48 uint8_t ps2_mouse_init(void) {
51 if (!ps2_mouse_enable
) return 1;
54 rcv
= ps2_host_send(0xFF);
55 print("ps2_mouse_init: send 0xFF: ");
56 phex(ps2_error
); print("\n");
60 rcv
= ps2_host_recv();
61 print("ps2_mouse_init: read ACK: ");
62 phex(rcv
); phex(ps2_error
); print("\n");
65 // BAT takes some time
67 rcv
= ps2_host_recv();
68 print("ps2_mouse_init: read BAT: ");
69 phex(rcv
); phex(ps2_error
); print("\n");
73 rcv
= ps2_host_recv();
74 print("ps2_mouse_init: read DevID: ");
75 phex(rcv
); phex(ps2_error
); print("\n");
78 // Enable data reporting
80 print("ps2_mouse_init: send 0xF4: ");
81 phex(ps2_error
); print("\n");
85 rcv
= ps2_host_recv();
86 print("ps2_mouse_init: read ACK: ");
87 phex(rcv
); phex(ps2_error
); print("\n");
92 print("ps2_mouse_init: send 0xF0: ");
93 phex(ps2_error
); print("\n");
97 rcv
= ps2_host_recv();
98 print("ps2_mouse_init: read ACK: ");
99 phex(rcv
); phex(ps2_error
); print("\n");
108 -----------------------------------------------------------------------
109 0 btn: Yovflw Xovflw Ysign Xsign 1 Middle Right Left
110 1 x: X movement(0-255)
111 2 y: Y movement(0-255)
113 uint8_t ps2_mouse_read(void)
117 if (!ps2_mouse_enable
) return 1;
126 ps2_mouse_btn
= ps2_host_recv();
128 ps2_mouse_x
= ps2_host_recv();
130 ps2_mouse_y
= ps2_host_recv();
136 bool ps2_mouse_changed(void)
138 return (ps2_mouse_x
|| ps2_mouse_y
|| (ps2_mouse_btn
& PS2_MOUSE_BTN_MASK
) != ps2_mouse_btn_prev
);
141 #define PS2_MOUSE_SCROLL_BUTTON 0x04
142 void ps2_mouse_usb_send(void)
144 static bool scrolled
= false;
146 if (!ps2_mouse_enable
) return;
148 if (ps2_mouse_changed()) {
152 // convert scale of X, Y: PS/2(-256/255) -> USB(-127/127)
153 if (ps2_mouse_btn
& (1<<PS2_MOUSE_X_SIGN
))
154 x
= ps2_mouse_x
> 128 ? (int8_t)ps2_mouse_x
: -127;
156 x
= ps2_mouse_x
< 128 ? (int8_t)ps2_mouse_x
: 127;
158 if (ps2_mouse_btn
& (1<<PS2_MOUSE_Y_SIGN
))
159 y
= ps2_mouse_y
> 128 ? (int8_t)ps2_mouse_y
: -127;
161 y
= ps2_mouse_y
< 128 ? (int8_t)ps2_mouse_y
: 127;
163 // Y is needed to reverse
166 if (ps2_mouse_btn
& PS2_MOUSE_SCROLL_BUTTON
) {
168 if (x
> 0 || x
< 0) h
= (x
> 64 ? 64 : (x
< -64 ? -64 :x
));
169 if (y
> 0 || y
< 0) v
= (y
> 64 ? 64 : (y
< -64 ? -64 :y
));
172 usb_mouse_send(0,0, -v
/16, h
/16, 0);
175 } else if (!scrolled
&& (ps2_mouse_btn_prev
& PS2_MOUSE_SCROLL_BUTTON
)) {
176 usb_mouse_send(0,0,0,0, PS2_MOUSE_SCROLL_BUTTON
);
178 usb_mouse_send(0,0,0,0, 0);
181 usb_mouse_send(x
, y
, 0, 0, ps2_mouse_btn
& PS2_MOUSE_BTN_MASK
);
184 ps2_mouse_btn_prev
= (ps2_mouse_btn
& PS2_MOUSE_BTN_MASK
);
192 void ps2_mouse_print(void)
194 if (!debug_mouse
) return;
195 print("ps2_mouse[btn|x y]: ");
196 phex(ps2_mouse_btn
); print("|");
197 phex(ps2_mouse_x
); print(" ");
198 phex(ps2_mouse_y
); print("\n");