|
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179 |
-
-
- #include "usb_dev.h"
- #include "usb_touch.h"
- #include "core_pins.h"
- #include <string.h> // for memcpy()
- #include "avr/pgmspace.h"
- #include "debug/printf.h"
- #include "core_pins.h"
-
-
- #ifdef MULTITOUCH_INTERFACE
-
- 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;
-
- #define TX_BUFSIZE 32
- static transfer_t tx_transfer __attribute__ ((used, aligned(32)));
- DMAMEM static uint8_t txbuffer[TX_BUFSIZE] __attribute__ ((aligned(32)));
- extern volatile uint8_t usb_high_speed;
- #if MULTITOUCH_SIZE > TX_BUFSIZE
- #error "Internal error, transmit buffer size is too small for touchscreen endpoint"
- #endif
-
-
- void usb_touchscreen_configure(void)
- {
- memset(&tx_transfer, 0, sizeof(tx_transfer));
- usb_config_tx(MULTITOUCH_ENDPOINT, MULTITOUCH_SIZE, 0, NULL);
- usb_start_sof_interrupts(MULTITOUCH_INTERFACE);
- }
-
-
- 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)
- {
- static uint8_t microframe_count=0;
- uint8_t contact_count = 0;
-
- if (usb_high_speed) {
-
- if (++microframe_count < 8) return;
- microframe_count = 0;
- }
-
-
- uint32_t status = usb_transfer_status(&tx_transfer);
- if ((status & 0x80)) {
- return;
- }
- if (status & 0x68) {
-
- }
-
- if (scan_index == 0) {
- scan_timestamp = millis() * 10;
- scan_count = 0;
-
-
-
- for (uint8_t i = 0; i < MULTITOUCH_FINGERS; i++) {
- if (contactid[i]) contact_count++;
- }
- }
- while (scan_index < MULTITOUCH_FINGERS) {
- uint32_t press = pressure[scan_index];
- uint32_t id = contactid[scan_index];
- if (id) {
- if (press == 0) {
-
-
-
- id &= 0xFE;
- contactid[scan_index] = 0;
- }
-
- txbuffer[0] = id;
- txbuffer[1] = press;
- txbuffer[2] = xpos[scan_index];
- txbuffer[3] = xpos[scan_index] >> 8;
- txbuffer[4] = ypos[scan_index];
- txbuffer[5] = ypos[scan_index] >> 8;
- txbuffer[6] = scan_timestamp;
- txbuffer[7] = scan_timestamp >> 8;
- txbuffer[8] = contact_count;
-
- usb_prepare_transfer(&tx_transfer, txbuffer, MULTITOUCH_SIZE, 0);
- arm_dcache_flush_delete(txbuffer, TX_BUFSIZE);
- usb_transmit(MULTITOUCH_ENDPOINT, &tx_transfer);
- scan_index++;
- return;
- }
- scan_index++;
- }
- if (++scan_count >= MULTITOUCH_FINGERS) {
-
- scan_index = 0;
- }
- }
-
-
- #endif
|