123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124 |
- #include <stdint.h>
- #include <avr/io.h>
- #include <util/delay.h>
- #include "serial.h"
- #include "serial_mouse.h"
- #include "report.h"
- #include "host.h"
- #include "timer.h"
- #include "print.h"
- #include "debug.h"
- #ifdef MAX
- #undef MAX
- #endif
- #define MAX(X, Y) ((X) > (Y) ? (X) : (Y))
- static void print_usb_data(const report_mouse_t *report);
- void serial_mouse_task(void)
- {
-
- static uint8_t buffer[3];
- static int buffer_cur = 0;
- static report_mouse_t report = {};
- int16_t rcv;
- rcv = serial_recv2();
- if (rcv < 0)
-
- return;
- if (debug_mouse)
- xprintf("serial_mouse: byte: %04X\n", rcv);
-
- if (rcv & (1 << 6))
- buffer_cur = 0;
- buffer[buffer_cur] = (uint8_t)rcv;
- if (buffer_cur == 0 && buffer[buffer_cur] == 0x20) {
-
- report.buttons |= MOUSE_BTN3;
- report.x = report.y = 0;
- print_usb_data(&report);
- host_mouse_send(&report);
- return;
- }
- buffer_cur++;
- if (buffer_cur < 3)
- return;
- buffer_cur = 0;
-
- report.buttons = 0;
- if (buffer[0] & (1 << 5))
- report.buttons |= MOUSE_BTN1;
- if (buffer[0] & (1 << 4))
- report.buttons |= MOUSE_BTN2;
- report.x = (buffer[0] << 6) | buffer[1];
- report.y = ((buffer[0] << 4) & 0xC0) | buffer[2];
-
- report.x = MAX(report.x, -127);
- report.y = MAX(report.y, -127);
- #if 0
- if (!report.buttons && !report.x && !report.y) {
-
- report.buttons |= MOUSE_BTN3;
- }
- #endif
- print_usb_data(&report);
- host_mouse_send(&report);
- }
- static void print_usb_data(const report_mouse_t *report)
- {
- if (!debug_mouse)
- return;
- xprintf("serial_mouse usb: [%02X|%d %d %d %d]\n",
- report->buttons, report->x, report->y,
- report->v, report->h);
- }
|