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;
56 rcv = ps2_host_send(0xFF);
57 print("ps2_mouse_init: send 0xFF: ");
58 phex(ps2_error); print("\n");
62 rcv = ps2_host_recv();
63 print("ps2_mouse_init: read ACK: ");
64 phex(rcv); phex(ps2_error); print("\n");
67 // BAT takes some time
69 rcv = ps2_host_recv();
70 print("ps2_mouse_init: read BAT: ");
71 phex(rcv); phex(ps2_error); print("\n");
75 rcv = ps2_host_recv();
76 print("ps2_mouse_init: read DevID: ");
77 phex(rcv); phex(ps2_error); print("\n");
80 // Enable data reporting
82 print("ps2_mouse_init: send 0xF4: ");
83 phex(ps2_error); print("\n");
87 rcv = ps2_host_recv();
88 print("ps2_mouse_init: read ACK: ");
89 phex(rcv); phex(ps2_error); print("\n");
94 print("ps2_mouse_init: send 0xF0: ");
95 phex(ps2_error); print("\n");
99 rcv = ps2_host_recv();
100 print("ps2_mouse_init: read ACK: ");
101 phex(rcv); phex(ps2_error); print("\n");
110 -----------------------------------------------------------------------
111 0 btn: Yovflw Xovflw Ysign Xsign 1 Middle Right Left
112 1 x: X movement(0-255)
113 2 y: Y movement(0-255)
115 uint8_t ps2_mouse_read(void)
119 if (!ps2_mouse_enable) return 1;
128 ps2_mouse_btn = ps2_host_recv();
130 ps2_mouse_x = ps2_host_recv();
132 ps2_mouse_y = ps2_host_recv();
138 bool ps2_mouse_changed(void)
140 return (ps2_mouse_x || ps2_mouse_y || (ps2_mouse_btn & PS2_MOUSE_BTN_MASK) != ps2_mouse_btn_prev);
143 #define PS2_MOUSE_SCROLL_BUTTON 0x04
144 void ps2_mouse_usb_send(void)
146 static bool scrolled = false;
148 if (!ps2_mouse_enable) return;
150 if (ps2_mouse_changed()) {
154 // convert scale of X, Y: PS/2(-256/255) -> USB(-127/127)
155 if (ps2_mouse_btn & (1<<PS2_MOUSE_X_SIGN))
156 x = ps2_mouse_x > 128 ? (int8_t)ps2_mouse_x : -127;
158 x = ps2_mouse_x < 128 ? (int8_t)ps2_mouse_x : 127;
160 if (ps2_mouse_btn & (1<<PS2_MOUSE_Y_SIGN))
161 y = ps2_mouse_y > 128 ? (int8_t)ps2_mouse_y : -127;
163 y = ps2_mouse_y < 128 ? (int8_t)ps2_mouse_y : 127;
165 // Y is needed to reverse
168 if (ps2_mouse_btn & PS2_MOUSE_SCROLL_BUTTON) {
170 if (x > 0 || x < 0) h = (x > 64 ? 64 : (x < -64 ? -64 :x));
171 if (y > 0 || y < 0) v = (y > 64 ? 64 : (y < -64 ? -64 :y));
174 usb_mouse_send(0,0, -v/16, h/16, 0);
177 } else if (!scrolled && (ps2_mouse_btn_prev & PS2_MOUSE_SCROLL_BUTTON)) {
178 usb_mouse_send(0,0,0,0, PS2_MOUSE_SCROLL_BUTTON);
180 usb_mouse_send(0,0,0,0, 0);
183 usb_mouse_send(x, y, 0, 0, ps2_mouse_btn & PS2_MOUSE_BTN_MASK);
186 ps2_mouse_btn_prev = (ps2_mouse_btn & PS2_MOUSE_BTN_MASK);
194 void ps2_mouse_print(void)
196 if (!debug_mouse) return;
197 print("ps2_mouse[btn|x y]: ");
198 phex(ps2_mouse_btn); print("|");
199 phex(ps2_mouse_x); print(" ");
200 phex(ps2_mouse_y); print("\n");