85 lines
2.8 KiB
C
85 lines
2.8 KiB
C
#include "_devices.h"
|
|
|
|
static BYTE read_one(com_device_t* dev) {
|
|
while (!comdev_available(dev)) Sleep(50);
|
|
BYTE data;
|
|
comdev_read(dev, &data, 1);
|
|
return data;
|
|
}
|
|
|
|
const BYTE TOUCH_ID_LUT[] = "ABCD\0EFGH\0IJKL\0MNOPQRSTU\0VWXY\0";
|
|
static BYTE get_touch_id(BYTE id) {
|
|
for (BYTE i = 0; i < sizeof(TOUCH_ID_LUT); i++) {
|
|
if (TOUCH_ID_LUT[i] == id) return i;
|
|
}
|
|
return 0xff;
|
|
}
|
|
|
|
BOOL touch_is_enabled = false;
|
|
BYTE thresh = 0x00; // Lazy caching of single value
|
|
DWORD WINAPI touch_bd_thread(com_device_t* dev) {
|
|
while (1) {
|
|
if (touch_is_enabled && !comdev_available(dev)) {
|
|
// Active mode!
|
|
comdev_write(dev, (unsigned char*)"(@@@@@@@@@@@@)", 14);
|
|
Sleep(100);
|
|
continue;
|
|
}
|
|
|
|
while (read_one(dev) != '{') continue;
|
|
while (comdev_available(dev) < 5) {
|
|
log_info("touch", "<. .>");
|
|
Sleep(50);
|
|
}
|
|
BYTE command[5];
|
|
comdev_read(dev, command, 5);
|
|
BYTE response[6];
|
|
memcpy(response, "( )", 6);
|
|
|
|
if (memcmp(command, "HALT}", 5) == 0) {
|
|
if (touch_is_enabled)
|
|
log_info("touch", "Touchscreen left active mode");
|
|
else
|
|
log_misc("touch", "Touchscreen not in active mode");
|
|
touch_is_enabled = false;
|
|
} else if (memcmp(command, "STAT}", 5) == 0) {
|
|
if (!touch_is_enabled)
|
|
log_info("touch", "Touchscreen entered active mode");
|
|
else
|
|
log_misc("touch", "Touchscreen already in active mode");
|
|
touch_is_enabled = true;
|
|
} else if (command[2] == 'k' && command[4] == '}') {
|
|
BYTE sensor = get_touch_id(command[1]);
|
|
|
|
log_misc("touch", "k-command recieved: %d >=%d", sensor, command[3]);
|
|
// Sensor == '@': failed
|
|
// ( <L/R> <sensor> <> <> )
|
|
response[1] = command[0];
|
|
response[2] = command[1];
|
|
thresh = command[3];
|
|
|
|
comdev_write(dev, response, 6);
|
|
} else if (command[2] == 't' && command[3] == 'h' && command[4] == '}') {
|
|
BYTE sensor = get_touch_id(command[1]);
|
|
|
|
// { <L/R> <sensor> t h }
|
|
log_misc("touch", "th-command recieved: %d", sensor);
|
|
|
|
// Sensor == '@': failed
|
|
// ( <L/R> <sensor> <> <threshold> )
|
|
response[1] = command[0]; // 'L' or 'R'
|
|
response[2] = command[1]; // Sensor
|
|
response[4] = thresh;
|
|
|
|
comdev_write(dev, response, 6);
|
|
} else {
|
|
log_error("touch", "Unhandled: {%.*s", 5, command);
|
|
}
|
|
}
|
|
}
|
|
|
|
void install_touch_bd() {
|
|
com_device_t* touch = new_com_device(3);
|
|
com_device_thread(touch, touch_bd_thread);
|
|
}
|