|
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141 |
-
-
- #include "usb_dev.h"
- #include "usb_touch.h"
- #include "core_pins.h"
- #include "HardwareSerial.h"
-
- #ifdef MULTITOUCH_INTERFACE
- #if F_CPU >= 20000000
-
- static uint8_t prev_id=0;
- static uint8_t scan_index=0;
- static uint8_t scan_count=0;
- static uint8_t contactid[MULTITOUCH_FINGERS];
- static uint8_t pressure[MULTITOUCH_FINGERS];
- static uint16_t xpos[MULTITOUCH_FINGERS];
- static uint16_t ypos[MULTITOUCH_FINGERS];
- static uint16_t scan_timestamp;
-
-
- void usb_touchscreen_press(uint8_t finger, uint32_t x, uint32_t y, uint32_t press)
- {
- if (finger >= MULTITOUCH_FINGERS) return;
- if (press > 255) press = 255;
- if (x > 32767) x = 32767;
- if (y > 32767) y = 32767;
- __disable_irq();
- if (pressure[finger] == 0 && press > 0) {
-
-
- uint8_t id = prev_id + 1;
- if (id == 0 || id > 127) id = 1;
- prev_id = id;
- contactid[finger] = (id << 1) | 1;
- }
- xpos[finger] = x;
- ypos[finger] = y;
- pressure[finger] = press;
- __enable_irq();
- }
-
-
-
-
-
- void usb_touchscreen_release(uint8_t finger)
- {
- if (finger >= MULTITOUCH_FINGERS) return;
- pressure[finger] = 0;
- }
-
-
-
-
-
-
-
-
-
-
-
-
-
-
- void usb_touchscreen_update_callback(void)
- {
- if (scan_index == 0) {
- if (usb_tx_packet_count(MULTITOUCH_ENDPOINT) > 1) {
-
-
- return;
- }
- scan_timestamp = millis() * 10;
- scan_count = 0;
- }
- while (scan_index < MULTITOUCH_FINGERS) {
- uint32_t press = pressure[scan_index];
- uint32_t id = contactid[scan_index];
- if (id) {
- usb_packet_t *tx_packet;
- tx_packet = usb_malloc();
- if (tx_packet == NULL) return;
- if (press == 0) {
-
-
-
- id &= 0xFE;
- contactid[scan_index] = 0;
- }
- *(tx_packet->buf + 0) = id;
- *(tx_packet->buf + 1) = press;
- *(tx_packet->buf + 2) = xpos[scan_index];
- *(tx_packet->buf + 3) = xpos[scan_index] >> 8;
- *(tx_packet->buf + 4) = ypos[scan_index];
- *(tx_packet->buf + 5) = ypos[scan_index] >> 8;
- *(tx_packet->buf + 6) = scan_timestamp;
- *(tx_packet->buf + 7) = scan_timestamp >> 8;
- tx_packet->len = 8;
- usb_tx(MULTITOUCH_ENDPOINT, tx_packet);
- scan_index++;
- return;
- }
- scan_index++;
- }
- if (++scan_count >= MULTITOUCH_FINGERS) {
-
- scan_index = 0;
- }
- }
-
-
- #endif
- #endif
|