Cirque trackpad features: circular scroll, inertial cursor (#17482)
This commit is contained in:
parent
904ec0ce78
commit
5db705d054
11 changed files with 1122 additions and 148 deletions
226
drivers/sensors/cirque_pinnacle_gestures.c
Normal file
226
drivers/sensors/cirque_pinnacle_gestures.c
Normal file
|
@ -0,0 +1,226 @@
|
|||
/* Copyright 2020 Christopher Courtney, aka Drashna Jael're (@drashna) <drashna@live.com>
|
||||
* Copyright 2022 Daniel Kao <daniel.m.kao@gmail.com>
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
#include <stdlib.h>
|
||||
#include <lib/lib8tion/lib8tion.h>
|
||||
#include "cirque_pinnacle_gestures.h"
|
||||
#include "pointing_device.h"
|
||||
#include "timer.h"
|
||||
|
||||
#if defined(CIRQUE_PINNACLE_TAP_ENABLE) || defined(CIRQUE_PINNACLE_CIRCULAR_SCROLL_ENABLE)
|
||||
static cirque_pinnacle_features_t features = {.tap_enable = true, .circular_scroll_enable = true};
|
||||
#endif
|
||||
|
||||
#ifdef CIRQUE_PINNACLE_TAP_ENABLE
|
||||
static trackpad_tap_context_t tap;
|
||||
|
||||
static report_mouse_t trackpad_tap(report_mouse_t mouse_report, pinnacle_data_t touchData) {
|
||||
if (touchData.touchDown != tap.touchDown) {
|
||||
tap.touchDown = touchData.touchDown;
|
||||
if (!touchData.zValue) {
|
||||
if (timer_elapsed(tap.timer) < CIRQUE_PINNACLE_TAPPING_TERM && tap.timer != 0) {
|
||||
mouse_report.buttons = pointing_device_handle_buttons(mouse_report.buttons, true, POINTING_DEVICE_BUTTON1);
|
||||
pointing_device_set_report(mouse_report);
|
||||
pointing_device_send();
|
||||
# if TAP_CODE_DELAY > 0
|
||||
wait_ms(TAP_CODE_DELAY);
|
||||
# endif
|
||||
mouse_report.buttons = pointing_device_handle_buttons(mouse_report.buttons, false, POINTING_DEVICE_BUTTON1);
|
||||
pointing_device_set_report(mouse_report);
|
||||
pointing_device_send();
|
||||
}
|
||||
}
|
||||
tap.timer = timer_read();
|
||||
}
|
||||
if (timer_elapsed(tap.timer) > (CIRQUE_PINNACLE_TOUCH_DEBOUNCE)) {
|
||||
tap.timer = 0;
|
||||
}
|
||||
|
||||
return mouse_report;
|
||||
}
|
||||
|
||||
void cirque_pinnacle_enable_tap(bool enable) {
|
||||
features.tap_enable = enable;
|
||||
}
|
||||
#endif
|
||||
|
||||
#ifdef CIRQUE_PINNACLE_CIRCULAR_SCROLL_ENABLE
|
||||
/* To set a trackpad exclusively as scroll wheel: outer_ring_pct = 100, trigger_px = 0, trigger_ang = 0 */
|
||||
static circular_scroll_context_t scroll = {.config = {.outer_ring_pct = 33,
|
||||
.trigger_px = 16,
|
||||
.trigger_ang = 9102, /* 50 degrees */
|
||||
.wheel_clicks = 18}};
|
||||
|
||||
static inline uint16_t atan2_16(int32_t dy, int32_t dx) {
|
||||
if (dy == 0) {
|
||||
if (dx >= 0) {
|
||||
return 0;
|
||||
} else {
|
||||
return 32768;
|
||||
}
|
||||
}
|
||||
|
||||
int32_t abs_y = dy > 0 ? dy : -dy;
|
||||
int16_t a;
|
||||
|
||||
if (dx >= 0) {
|
||||
a = 8192 - (8192 * (dx - abs_y) / (dx + abs_y));
|
||||
} else {
|
||||
a = 24576 - (8192 * (dx + abs_y) / (abs_y - dx));
|
||||
}
|
||||
|
||||
if (dy < 0) {
|
||||
return -a; // negate if in quad III or IV
|
||||
}
|
||||
return a;
|
||||
}
|
||||
|
||||
static circular_scroll_t circular_scroll(pinnacle_data_t touchData) {
|
||||
circular_scroll_t report = {0, 0, false};
|
||||
int8_t x, y, wheel_clicks;
|
||||
uint8_t center = 256 / 2, mag;
|
||||
int16_t ang, dot, det, opposite_side, adjacent_side;
|
||||
uint16_t scale = cirque_pinnacle_get_scale();
|
||||
|
||||
if (touchData.zValue) {
|
||||
/*
|
||||
* Place origin at center of trackpad, treat coordinates as vectors.
|
||||
* Scale to fixed int8_t size; angles are independent of resolution.
|
||||
*/
|
||||
if (scale) {
|
||||
x = (int8_t)((int32_t)touchData.xValue * 256 / scale - center);
|
||||
y = (int8_t)((int32_t)touchData.yValue * 256 / scale - center);
|
||||
} else {
|
||||
x = 0;
|
||||
y = 0;
|
||||
}
|
||||
|
||||
/* Check if first touch */
|
||||
if (!scroll.z) {
|
||||
report.suppress_touch = false;
|
||||
/* Check if touch falls within outer ring */
|
||||
mag = sqrt16(x * x + y * y);
|
||||
if (mag * 100 / center >= 100 - scroll.config.outer_ring_pct) {
|
||||
scroll.state = SCROLL_DETECTING;
|
||||
scroll.x = x;
|
||||
scroll.y = y;
|
||||
scroll.mag = mag;
|
||||
/*
|
||||
* Decide scroll axis:
|
||||
* Vertical if started from righ half
|
||||
* Horizontal if started from left half
|
||||
* Flipped for left-handed
|
||||
*/
|
||||
# if defined(POINTING_DEVICE_ROTATION_90)
|
||||
scroll.axis = y < 0;
|
||||
# elif defined(POINTING_DEVICE_ROTATION_180)
|
||||
scroll.axis = x > 0;
|
||||
# elif defined(POINTING_DEVICE_ROTATION_270)
|
||||
scroll.axis = y > 0;
|
||||
# else
|
||||
scroll.axis = x < 0;
|
||||
# endif
|
||||
}
|
||||
} else if (scroll.state == SCROLL_DETECTING) {
|
||||
report.suppress_touch = true;
|
||||
/* Already detecting scroll, check movement from touchdown location */
|
||||
mag = sqrt16((x - scroll.x) * (x - scroll.x) + (y - scroll.y) * (y - scroll.y));
|
||||
if (mag >= scroll.config.trigger_px) {
|
||||
/*
|
||||
* Find angle of movement.
|
||||
* 0 degrees here means movement towards center of circle
|
||||
*/
|
||||
dot = scroll.x * x + scroll.y * y;
|
||||
det = scroll.x * y - scroll.y * x;
|
||||
opposite_side = abs(det); /* Based on scalar rejection */
|
||||
adjacent_side = abs(scroll.mag * scroll.mag - abs(dot)); /* Based on scalar projection */
|
||||
ang = (int16_t)atan2_16(opposite_side, adjacent_side);
|
||||
if (ang < scroll.config.trigger_ang) {
|
||||
/* Not a scroll, release coordinates */
|
||||
report.suppress_touch = false;
|
||||
scroll.state = NOT_SCROLL;
|
||||
} else {
|
||||
/* Scroll detected */
|
||||
scroll.state = SCROLL_VALID;
|
||||
}
|
||||
}
|
||||
}
|
||||
if (scroll.state == SCROLL_VALID) {
|
||||
report.suppress_touch = true;
|
||||
dot = scroll.x * x + scroll.y * y;
|
||||
det = scroll.x * y - scroll.y * x;
|
||||
ang = (int16_t)atan2_16(det, dot);
|
||||
wheel_clicks = ((int32_t)ang * scroll.config.wheel_clicks) / 65536;
|
||||
if (wheel_clicks >= 1 || wheel_clicks <= -1) {
|
||||
if (scroll.config.left_handed) {
|
||||
if (scroll.axis == 0) {
|
||||
report.h = -wheel_clicks;
|
||||
} else {
|
||||
report.v = wheel_clicks;
|
||||
}
|
||||
} else {
|
||||
if (scroll.axis == 0) {
|
||||
report.v = -wheel_clicks;
|
||||
} else {
|
||||
report.h = wheel_clicks;
|
||||
}
|
||||
}
|
||||
scroll.x = x;
|
||||
scroll.y = y;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
scroll.z = touchData.zValue;
|
||||
if (!scroll.z) scroll.state = SCROLL_UNINITIALIZED;
|
||||
|
||||
return report;
|
||||
}
|
||||
|
||||
void cirque_pinnacle_enable_circular_scroll(bool enable) {
|
||||
features.circular_scroll_enable = enable;
|
||||
}
|
||||
|
||||
void cirque_pinnacle_configure_circular_scroll(uint8_t outer_ring_pct, uint8_t trigger_px, uint16_t trigger_ang, uint8_t wheel_clicks, bool left_handed) {
|
||||
scroll.config.outer_ring_pct = outer_ring_pct;
|
||||
scroll.config.trigger_px = trigger_px;
|
||||
scroll.config.trigger_ang = trigger_ang;
|
||||
scroll.config.wheel_clicks = wheel_clicks;
|
||||
scroll.config.left_handed = left_handed;
|
||||
}
|
||||
#endif
|
||||
|
||||
bool cirque_pinnacle_gestures(report_mouse_t* mouse_report, pinnacle_data_t touchData) {
|
||||
bool suppress_mouse_update = false;
|
||||
|
||||
#ifdef CIRQUE_PINNACLE_CIRCULAR_SCROLL_ENABLE
|
||||
circular_scroll_t scroll_report;
|
||||
if (features.circular_scroll_enable) {
|
||||
scroll_report = circular_scroll(touchData);
|
||||
mouse_report->v = scroll_report.v;
|
||||
mouse_report->h = scroll_report.h;
|
||||
suppress_mouse_update = scroll_report.suppress_touch;
|
||||
}
|
||||
#endif
|
||||
|
||||
#ifdef CIRQUE_PINNACLE_TAP_ENABLE
|
||||
if (features.tap_enable) {
|
||||
*mouse_report = trackpad_tap(*mouse_report, touchData);
|
||||
}
|
||||
#endif
|
||||
|
||||
return suppress_mouse_update;
|
||||
}
|
Loading…
Add table
Add a link
Reference in a new issue