|
|
- /* 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"
- #include "wait.h"
- #if defined(SPLIT_POINTING_ENABLE) && defined(POINTING_DEVICE_COMBINED)
- # include "keyboard.h"
- #endif
-
- #if (defined(CIRQUE_PINNACLE_TAP_ENABLE) || defined(CIRQUE_PINNACLE_CIRCULAR_SCROLL_ENABLE)) && CIRQUE_PINNACLE_POSITION_MODE
- static cirque_pinnacle_features_t features = {.tap_enable = true, .circular_scroll_enable = true};
- #endif
-
- #if defined(CIRQUE_PINNACLE_TAP_ENABLE) && CIRQUE_PINNACLE_POSITION_MODE
- 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);
- }
- }
- 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
- # if !CIRQUE_PINNACLE_POSITION_MODE
- # error "Circular scroll is not supported in relative mode"
- # endif
- /* 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 = INT8_MAX, 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 +/-INT8_MAX; angles are independent of resolution.
- */
- if (scale) {
- /* Rotate coordinates into a consistent orientation */
- report_mouse_t rot = {.x = (int8_t)((int32_t)touchData.xValue * INT8_MAX * 2 / scale - center), .y = (int8_t)((int32_t)touchData.yValue * INT8_MAX * 2 / scale - center)};
- # if defined(SPLIT_POINTING_ENABLE) && defined(POINTING_DEVICE_COMBINED)
- if (!is_keyboard_left()) {
- rot = pointing_device_adjust_by_defines_right(rot);
- } else
- # endif
- {
- rot = pointing_device_adjust_by_defines(rot);
- }
- x = rot.x;
- y = rot.y;
- } 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
- */
- scroll.axis = x < 0;
- }
- } 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
- # if !CIRQUE_PINNACLE_POSITION_MODE
- # error "Circular scroll is not supported in relative mode"
- # endif
- 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
-
- #if defined(CIRQUE_PINNACLE_TAP_ENABLE) && CIRQUE_PINNACLE_POSITION_MODE
- if (features.tap_enable) {
- *mouse_report = trackpad_tap(*mouse_report, touchData);
- }
- #endif
-
- return suppress_mouse_update;
- }
|