]>
git.gir.st - tmk_keyboard.git/blob - ps2_mouse.c
8 #define PS2_MOUSE_DEBUG
23 - Tracpoint command support: needed
24 - Middle button + move = Wheel traslation
26 uint8_t ps2_mouse_x
= 0;
27 uint8_t ps2_mouse_y
= 0;
28 uint8_t ps2_mouse_btn
= 0;
29 uint8_t ps2_mouse_error_count
= 0;
30 static uint8_t ps2_mouse_btn_prev
= 0;
32 void ps2_mouse_init(void) {
36 rcv
= ps2_host_send(0xFF);
37 print("ps2_mouse_init: send 0xFF: ");
38 phex(ps2_error
); print("\n");
41 rcv
= ps2_host_recv();
42 print("ps2_mouse_init: read ACK: ");
43 phex(rcv
); phex(ps2_error
); print("\n");
45 // BAT takes some time
47 rcv
= ps2_host_recv();
48 print("ps2_mouse_init: read BAT: ");
49 phex(rcv
); phex(ps2_error
); print("\n");
52 rcv
= ps2_host_recv();
53 print("ps2_mouse_init: read DevID: ");
54 phex(rcv
); phex(ps2_error
); print("\n");
56 // Enable data reporting
58 print("ps2_mouse_init: send 0xF4: ");
59 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");
68 print("ps2_mouse_init: send 0xF0: ");
69 phex(ps2_error
); print("\n");
72 rcv
= ps2_host_recv();
73 print("ps2_mouse_init: read ACK: ");
74 phex(rcv
); phex(ps2_error
); print("\n");
76 if (ps2_error
) ps2_mouse_error_count
++;
82 -----------------------------------------------------------------------
83 0 btn: Yovflw Xovflw Ysign Xsign 1 Middle Right Left
84 1 x: X movement(0-255)
85 2 y: Y movement(0-255)
87 void ps2_mouse_read(void)
94 ps2_mouse_btn
= ps2_host_recv();
95 ps2_mouse_x
= ps2_host_recv();
96 ps2_mouse_y
= ps2_host_recv();
98 if (ps2_error
) ps2_mouse_error_count
++;
101 bool ps2_mouse_changed(void)
103 return (ps2_mouse_x
|| ps2_mouse_y
|| (ps2_mouse_btn
& PS2_MOUSE_BTN_MASK
) != ps2_mouse_btn_prev
);
106 #define PS2_MOUSE_SCROLL_BUTTON 0x04
107 void ps2_mouse_usb_send(void)
109 static bool scrolled
= false;
110 if (ps2_mouse_changed()) {
114 // convert scale of X, Y: PS/2(-256/255) -> USB(-127/127)
115 if (ps2_mouse_btn
& (1<<PS2_MOUSE_X_SIGN
))
116 x
= ps2_mouse_x
> 128 ? (int8_t)ps2_mouse_x
: -127;
118 x
= ps2_mouse_x
< 128 ? (int8_t)ps2_mouse_x
: 127;
120 if (ps2_mouse_btn
& (1<<PS2_MOUSE_Y_SIGN
))
121 y
= ps2_mouse_y
> 128 ? (int8_t)ps2_mouse_y
: -127;
123 y
= ps2_mouse_y
< 128 ? (int8_t)ps2_mouse_y
: 127;
125 // Y is needed to reverse
128 if (ps2_mouse_btn
& PS2_MOUSE_SCROLL_BUTTON
) {
130 if (x
> 0 || x
< 0) h
= (x
> 64 ? 64 : (x
< -64 ? -64 :x
));
131 if (y
> 0 || y
< 0) v
= (y
> 64 ? 64 : (y
< -64 ? -64 :y
));
134 usb_mouse_send(0,0, -v
/16, h
/16, 0);
137 } else if (!scrolled
&& (ps2_mouse_btn_prev
& PS2_MOUSE_SCROLL_BUTTON
)) {
138 usb_mouse_send(0,0,0,0, PS2_MOUSE_SCROLL_BUTTON
);
140 usb_mouse_send(0,0,0,0, 0);
143 usb_mouse_send(x
, y
, 0, 0, ps2_mouse_btn
& PS2_MOUSE_BTN_MASK
);
146 ps2_mouse_btn_prev
= (ps2_mouse_btn
& PS2_MOUSE_BTN_MASK
);
154 void ps2_mouse_print(void)
156 if (!debug_mouse
) return;
157 print("ps2_mouse[btn|x y]: ");
158 phex(ps2_mouse_btn
); print("|");
159 phex(ps2_mouse_x
); print(" ");
160 phex(ps2_mouse_y
); print("\n");