pointing_device_drivers.c 11 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324
  1. /* Copyright 2017 Joshua Broekhuijsen <snipeye+qmk@gmail.com>
  2. * Copyright 2020 Christopher Courtney, aka Drashna Jael're (@drashna) <drashna@live.com>
  3. * Copyright 2021 Dasky (@daskygit)
  4. *
  5. * This program is free software: you can redistribute it and/or modify
  6. * it under the terms of the GNU General Public License as published by
  7. * the Free Software Foundation, either version 2 of the License, or
  8. * (at your option) any later version.
  9. *
  10. * This program is distributed in the hope that it will be useful,
  11. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13. * GNU General Public License for more details.
  14. *
  15. * You should have received a copy of the GNU General Public License
  16. * along with this program. If not, see <http://www.gnu.org/licenses/>.
  17. */
  18. #include "pointing_device.h"
  19. #include "debug.h"
  20. #include "wait.h"
  21. #include "timer.h"
  22. #include <stddef.h>
  23. #define CONSTRAIN_HID(amt) ((amt) < INT8_MIN ? INT8_MIN : ((amt) > INT8_MAX ? INT8_MAX : (amt)))
  24. #define CONSTRAIN_HID_XY(amt) ((amt) < XY_REPORT_MIN ? XY_REPORT_MIN : ((amt) > XY_REPORT_MAX ? XY_REPORT_MAX : (amt)))
  25. // get_report functions should probably be moved to their respective drivers.
  26. #if defined(POINTING_DEVICE_DRIVER_adns5050)
  27. report_mouse_t adns5050_get_report(report_mouse_t mouse_report) {
  28. report_adns5050_t data = adns5050_read_burst();
  29. if (data.dx != 0 || data.dy != 0) {
  30. # ifdef CONSOLE_ENABLE
  31. if (debug_mouse) dprintf("Raw ] X: %d, Y: %d\n", data.dx, data.dy);
  32. # endif
  33. mouse_report.x = (mouse_xy_report_t)data.dx;
  34. mouse_report.y = (mouse_xy_report_t)data.dy;
  35. }
  36. return mouse_report;
  37. }
  38. // clang-format off
  39. const pointing_device_driver_t pointing_device_driver = {
  40. .init = adns5050_init,
  41. .get_report = adns5050_get_report,
  42. .set_cpi = adns5050_set_cpi,
  43. .get_cpi = adns5050_get_cpi,
  44. };
  45. // clang-format on
  46. #elif defined(POINTING_DEVICE_DRIVER_adns9800)
  47. report_mouse_t adns9800_get_report_driver(report_mouse_t mouse_report) {
  48. report_adns9800_t sensor_report = adns9800_get_report();
  49. mouse_report.x = CONSTRAIN_HID_XY(sensor_report.x);
  50. mouse_report.y = CONSTRAIN_HID_XY(sensor_report.y);
  51. return mouse_report;
  52. }
  53. // clang-format off
  54. const pointing_device_driver_t pointing_device_driver = {
  55. .init = adns9800_init,
  56. .get_report = adns9800_get_report_driver,
  57. .set_cpi = adns9800_set_cpi,
  58. .get_cpi = adns9800_get_cpi
  59. };
  60. // clang-format on
  61. #elif defined(POINTING_DEVICE_DRIVER_analog_joystick)
  62. report_mouse_t analog_joystick_get_report(report_mouse_t mouse_report) {
  63. report_analog_joystick_t data = analog_joystick_read();
  64. # ifdef CONSOLE_ENABLE
  65. if (debug_mouse) dprintf("Raw ] X: %d, Y: %d\n", data.x, data.y);
  66. # endif
  67. mouse_report.x = data.x;
  68. mouse_report.y = data.y;
  69. mouse_report.buttons = pointing_device_handle_buttons(mouse_report.buttons, data.button, POINTING_DEVICE_BUTTON1);
  70. return mouse_report;
  71. }
  72. // clang-format off
  73. const pointing_device_driver_t pointing_device_driver = {
  74. .init = analog_joystick_init,
  75. .get_report = analog_joystick_get_report,
  76. .set_cpi = NULL,
  77. .get_cpi = NULL
  78. };
  79. // clang-format on
  80. #elif defined(POINTING_DEVICE_DRIVER_cirque_pinnacle_i2c) || defined(POINTING_DEVICE_DRIVER_cirque_pinnacle_spi)
  81. # ifdef POINTING_DEVICE_GESTURES_CURSOR_GLIDE_ENABLE
  82. static bool cursor_glide_enable = true;
  83. static cursor_glide_context_t glide = {.config = {
  84. .coef = 102, /* Good default friction coef */
  85. .interval = 10, /* 100sps */
  86. .trigger_px = 10, /* Default threshold in case of hover, set to 0 if you'd like */
  87. }};
  88. void cirque_pinnacle_enable_cursor_glide(bool enable) {
  89. cursor_glide_enable = enable;
  90. }
  91. void cirque_pinnacle_configure_cursor_glide(float trigger_px) {
  92. glide.config.trigger_px = trigger_px;
  93. }
  94. # endif
  95. report_mouse_t cirque_pinnacle_get_report(report_mouse_t mouse_report) {
  96. pinnacle_data_t touchData = cirque_pinnacle_read_data();
  97. mouse_xy_report_t report_x = 0, report_y = 0;
  98. static mouse_xy_report_t x = 0, y = 0;
  99. # ifdef POINTING_DEVICE_GESTURES_CURSOR_GLIDE_ENABLE
  100. cursor_glide_t glide_report = {0};
  101. if (cursor_glide_enable) {
  102. glide_report = cursor_glide_check(&glide);
  103. }
  104. # endif
  105. # if !CIRQUE_PINNACLE_POSITION_MODE
  106. # error Cirque Pinnacle with relative mode not implemented yet.
  107. # endif
  108. if (!touchData.valid) {
  109. # ifdef POINTING_DEVICE_GESTURES_CURSOR_GLIDE_ENABLE
  110. if (cursor_glide_enable && glide_report.valid) {
  111. report_x = glide_report.dx;
  112. report_y = glide_report.dy;
  113. goto mouse_report_update;
  114. }
  115. # endif
  116. return mouse_report;
  117. }
  118. # if CONSOLE_ENABLE
  119. if (debug_mouse && touchData.touchDown) {
  120. dprintf("cirque_pinnacle touchData x=%4d y=%4d z=%2d\n", touchData.xValue, touchData.yValue, touchData.zValue);
  121. }
  122. # endif
  123. // Scale coordinates to arbitrary X, Y resolution
  124. cirque_pinnacle_scale_data(&touchData, cirque_pinnacle_get_scale(), cirque_pinnacle_get_scale());
  125. if (!cirque_pinnacle_gestures(&mouse_report, touchData)) {
  126. if (x && y && touchData.xValue && touchData.yValue) {
  127. report_x = (mouse_xy_report_t)(touchData.xValue - x);
  128. report_y = (mouse_xy_report_t)(touchData.yValue - y);
  129. }
  130. x = touchData.xValue;
  131. y = touchData.yValue;
  132. # ifdef POINTING_DEVICE_GESTURES_CURSOR_GLIDE_ENABLE
  133. if (cursor_glide_enable) {
  134. if (touchData.touchDown) {
  135. cursor_glide_update(&glide, report_x, report_y, touchData.zValue);
  136. } else if (!glide_report.valid) {
  137. glide_report = cursor_glide_start(&glide);
  138. if (glide_report.valid) {
  139. report_x = glide_report.dx;
  140. report_y = glide_report.dy;
  141. }
  142. }
  143. }
  144. # endif
  145. }
  146. # ifdef POINTING_DEVICE_GESTURES_CURSOR_GLIDE_ENABLE
  147. mouse_report_update:
  148. # endif
  149. mouse_report.x = report_x;
  150. mouse_report.y = report_y;
  151. return mouse_report;
  152. }
  153. uint16_t cirque_pinnacle_get_cpi(void) {
  154. return CIRQUE_PINNACLE_PX_TO_INCH(cirque_pinnacle_get_scale());
  155. }
  156. void cirque_pinnacle_set_cpi(uint16_t cpi) {
  157. cirque_pinnacle_set_scale(CIRQUE_PINNACLE_INCH_TO_PX(cpi));
  158. }
  159. // clang-format off
  160. const pointing_device_driver_t pointing_device_driver = {
  161. .init = cirque_pinnacle_init,
  162. .get_report = cirque_pinnacle_get_report,
  163. .set_cpi = cirque_pinnacle_set_cpi,
  164. .get_cpi = cirque_pinnacle_get_cpi
  165. };
  166. // clang-format on
  167. #elif defined(POINTING_DEVICE_DRIVER_pimoroni_trackball)
  168. mouse_xy_report_t pimoroni_trackball_adapt_values(clamp_range_t* offset) {
  169. if (*offset > XY_REPORT_MAX) {
  170. *offset -= XY_REPORT_MAX;
  171. return (mouse_xy_report_t)XY_REPORT_MAX;
  172. } else if (*offset < XY_REPORT_MIN) {
  173. *offset += XY_REPORT_MAX;
  174. return (mouse_xy_report_t)XY_REPORT_MIN;
  175. } else {
  176. mouse_xy_report_t temp_return = *offset;
  177. *offset = 0;
  178. return temp_return;
  179. }
  180. }
  181. report_mouse_t pimoroni_trackball_get_report(report_mouse_t mouse_report) {
  182. static uint16_t debounce = 0;
  183. static uint8_t error_count = 0;
  184. pimoroni_data_t pimoroni_data = {0};
  185. static clamp_range_t x_offset = 0, y_offset = 0;
  186. if (error_count < PIMORONI_TRACKBALL_ERROR_COUNT) {
  187. i2c_status_t status = read_pimoroni_trackball(&pimoroni_data);
  188. if (status == I2C_STATUS_SUCCESS) {
  189. error_count = 0;
  190. if (!(pimoroni_data.click & 128)) {
  191. mouse_report.buttons = pointing_device_handle_buttons(mouse_report.buttons, false, POINTING_DEVICE_BUTTON1);
  192. if (!debounce) {
  193. x_offset += pimoroni_trackball_get_offsets(pimoroni_data.right, pimoroni_data.left, PIMORONI_TRACKBALL_SCALE);
  194. y_offset += pimoroni_trackball_get_offsets(pimoroni_data.down, pimoroni_data.up, PIMORONI_TRACKBALL_SCALE);
  195. mouse_report.x = pimoroni_trackball_adapt_values(&x_offset);
  196. mouse_report.y = pimoroni_trackball_adapt_values(&y_offset);
  197. } else {
  198. debounce--;
  199. }
  200. } else {
  201. mouse_report.buttons = pointing_device_handle_buttons(mouse_report.buttons, true, POINTING_DEVICE_BUTTON1);
  202. debounce = PIMORONI_TRACKBALL_DEBOUNCE_CYCLES;
  203. }
  204. } else {
  205. error_count++;
  206. }
  207. }
  208. return mouse_report;
  209. }
  210. // clang-format off
  211. const pointing_device_driver_t pointing_device_driver = {
  212. .init = pimoroni_trackball_device_init,
  213. .get_report = pimoroni_trackball_get_report,
  214. .set_cpi = pimoroni_trackball_set_cpi,
  215. .get_cpi = pimoroni_trackball_get_cpi
  216. };
  217. // clang-format on
  218. #elif defined(POINTING_DEVICE_DRIVER_pmw3360) || defined(POINTING_DEVICE_DRIVER_pmw3389)
  219. static void pmw33xx_init_wrapper(void) {
  220. pmw33xx_init(0);
  221. }
  222. static void pmw33xx_set_cpi_wrapper(uint16_t cpi) {
  223. pmw33xx_set_cpi(0, cpi);
  224. }
  225. static uint16_t pmw33xx_get_cpi_wrapper(void) {
  226. return pmw33xx_get_cpi(0);
  227. }
  228. report_mouse_t pmw33xx_get_report(report_mouse_t mouse_report) {
  229. pmw33xx_report_t report = pmw33xx_read_burst(0);
  230. static bool in_motion = false;
  231. if (report.motion.b.is_lifted) {
  232. return mouse_report;
  233. }
  234. if (!report.motion.b.is_motion) {
  235. in_motion = false;
  236. return mouse_report;
  237. }
  238. if (!in_motion) {
  239. in_motion = true;
  240. dprintf("PWM3360 (0): starting motion\n");
  241. }
  242. mouse_report.x = CONSTRAIN_HID_XY(report.delta_x);
  243. mouse_report.y = CONSTRAIN_HID_XY(report.delta_y);
  244. return mouse_report;
  245. }
  246. // clang-format off
  247. const pointing_device_driver_t pointing_device_driver = {
  248. .init = pmw33xx_init_wrapper,
  249. .get_report = pmw33xx_get_report,
  250. .set_cpi = pmw33xx_set_cpi_wrapper,
  251. .get_cpi = pmw33xx_get_cpi_wrapper
  252. };
  253. // clang-format on
  254. #else
  255. __attribute__((weak)) void pointing_device_driver_init(void) {}
  256. __attribute__((weak)) report_mouse_t pointing_device_driver_get_report(report_mouse_t mouse_report) {
  257. return mouse_report;
  258. }
  259. __attribute__((weak)) uint16_t pointing_device_driver_get_cpi(void) {
  260. return 0;
  261. }
  262. __attribute__((weak)) void pointing_device_driver_set_cpi(uint16_t cpi) {}
  263. // clang-format off
  264. const pointing_device_driver_t pointing_device_driver = {
  265. .init = pointing_device_driver_init,
  266. .get_report = pointing_device_driver_get_report,
  267. .get_cpi = pointing_device_driver_get_cpi,
  268. .set_cpi = pointing_device_driver_set_cpi
  269. };
  270. // clang-format on
  271. #endif