pointing_device_drivers.c 12 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368
  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. # if CIRQUE_PINNACLE_POSITION_MODE
  96. report_mouse_t cirque_pinnacle_get_report(report_mouse_t mouse_report) {
  97. pinnacle_data_t touchData = cirque_pinnacle_read_data();
  98. mouse_xy_report_t report_x = 0, report_y = 0;
  99. static uint16_t x = 0, y = 0;
  100. # ifdef POINTING_DEVICE_GESTURES_CURSOR_GLIDE_ENABLE
  101. cursor_glide_t glide_report = {0};
  102. if (cursor_glide_enable) {
  103. glide_report = cursor_glide_check(&glide);
  104. }
  105. # endif
  106. if (!touchData.valid) {
  107. # ifdef POINTING_DEVICE_GESTURES_CURSOR_GLIDE_ENABLE
  108. if (cursor_glide_enable && glide_report.valid) {
  109. report_x = glide_report.dx;
  110. report_y = glide_report.dy;
  111. goto mouse_report_update;
  112. }
  113. # endif
  114. return mouse_report;
  115. }
  116. # if CONSOLE_ENABLE
  117. if (debug_mouse && touchData.touchDown) {
  118. dprintf("cirque_pinnacle touchData x=%4d y=%4d z=%2d\n", touchData.xValue, touchData.yValue, touchData.zValue);
  119. }
  120. # endif
  121. // Scale coordinates to arbitrary X, Y resolution
  122. cirque_pinnacle_scale_data(&touchData, cirque_pinnacle_get_scale(), cirque_pinnacle_get_scale());
  123. if (!cirque_pinnacle_gestures(&mouse_report, touchData)) {
  124. if (x && y && touchData.xValue && touchData.yValue) {
  125. report_x = CONSTRAIN_HID_XY((int16_t)(touchData.xValue - x));
  126. report_y = CONSTRAIN_HID_XY((int16_t)(touchData.yValue - y));
  127. }
  128. x = touchData.xValue;
  129. y = touchData.yValue;
  130. # ifdef POINTING_DEVICE_GESTURES_CURSOR_GLIDE_ENABLE
  131. if (cursor_glide_enable) {
  132. if (touchData.touchDown) {
  133. cursor_glide_update(&glide, report_x, report_y, touchData.zValue);
  134. } else if (!glide_report.valid) {
  135. glide_report = cursor_glide_start(&glide);
  136. if (glide_report.valid) {
  137. report_x = glide_report.dx;
  138. report_y = glide_report.dy;
  139. }
  140. }
  141. }
  142. # endif
  143. }
  144. # ifdef POINTING_DEVICE_GESTURES_CURSOR_GLIDE_ENABLE
  145. mouse_report_update:
  146. # endif
  147. mouse_report.x = report_x;
  148. mouse_report.y = report_y;
  149. return mouse_report;
  150. }
  151. uint16_t cirque_pinnacle_get_cpi(void) {
  152. return CIRQUE_PINNACLE_PX_TO_INCH(cirque_pinnacle_get_scale());
  153. }
  154. void cirque_pinnacle_set_cpi(uint16_t cpi) {
  155. cirque_pinnacle_set_scale(CIRQUE_PINNACLE_INCH_TO_PX(cpi));
  156. }
  157. // clang-format off
  158. const pointing_device_driver_t pointing_device_driver = {
  159. .init = cirque_pinnacle_init,
  160. .get_report = cirque_pinnacle_get_report,
  161. .set_cpi = cirque_pinnacle_set_cpi,
  162. .get_cpi = cirque_pinnacle_get_cpi
  163. };
  164. // clang-format on
  165. # else
  166. report_mouse_t cirque_pinnacle_get_report(report_mouse_t mouse_report) {
  167. pinnacle_data_t touchData = cirque_pinnacle_read_data();
  168. // Scale coordinates to arbitrary X, Y resolution
  169. cirque_pinnacle_scale_data(&touchData, cirque_pinnacle_get_scale(), cirque_pinnacle_get_scale());
  170. if (touchData.valid) {
  171. mouse_report.buttons = touchData.buttons;
  172. mouse_report.x = CONSTRAIN_HID_XY(touchData.xDelta);
  173. mouse_report.y = CONSTRAIN_HID_XY(touchData.yDelta);
  174. mouse_report.v = touchData.wheelCount;
  175. }
  176. return mouse_report;
  177. }
  178. // clang-format off
  179. const pointing_device_driver_t pointing_device_driver = {
  180. .init = cirque_pinnacle_init,
  181. .get_report = cirque_pinnacle_get_report,
  182. .set_cpi = cirque_pinnacle_set_scale,
  183. .get_cpi = cirque_pinnacle_get_scale
  184. };
  185. // clang-format on
  186. # endif
  187. #elif defined(POINTING_DEVICE_DRIVER_paw3204)
  188. report_mouse_t paw3204_get_report(report_mouse_t mouse_report) {
  189. report_paw3204_t data = paw3204_read();
  190. if (data.isMotion) {
  191. # ifdef CONSOLE_ENABLE
  192. dprintf("Raw ] X: %d, Y: %d\n", data.x, data.y);
  193. # endif
  194. mouse_report.x = data.x;
  195. mouse_report.y = data.y;
  196. }
  197. return mouse_report;
  198. }
  199. const pointing_device_driver_t pointing_device_driver = {
  200. .init = paw3204_init,
  201. .get_report = paw3204_get_report,
  202. .set_cpi = paw3204_set_cpi,
  203. .get_cpi = paw3204_get_cpi,
  204. };
  205. #elif defined(POINTING_DEVICE_DRIVER_pimoroni_trackball)
  206. mouse_xy_report_t pimoroni_trackball_adapt_values(clamp_range_t* offset) {
  207. if (*offset > XY_REPORT_MAX) {
  208. *offset -= XY_REPORT_MAX;
  209. return (mouse_xy_report_t)XY_REPORT_MAX;
  210. } else if (*offset < XY_REPORT_MIN) {
  211. *offset += XY_REPORT_MAX;
  212. return (mouse_xy_report_t)XY_REPORT_MIN;
  213. } else {
  214. mouse_xy_report_t temp_return = *offset;
  215. *offset = 0;
  216. return temp_return;
  217. }
  218. }
  219. report_mouse_t pimoroni_trackball_get_report(report_mouse_t mouse_report) {
  220. static uint16_t debounce = 0;
  221. static uint8_t error_count = 0;
  222. pimoroni_data_t pimoroni_data = {0};
  223. static clamp_range_t x_offset = 0, y_offset = 0;
  224. if (error_count < PIMORONI_TRACKBALL_ERROR_COUNT) {
  225. i2c_status_t status = read_pimoroni_trackball(&pimoroni_data);
  226. if (status == I2C_STATUS_SUCCESS) {
  227. error_count = 0;
  228. if (!(pimoroni_data.click & 128)) {
  229. mouse_report.buttons = pointing_device_handle_buttons(mouse_report.buttons, false, POINTING_DEVICE_BUTTON1);
  230. if (!debounce) {
  231. x_offset += pimoroni_trackball_get_offsets(pimoroni_data.right, pimoroni_data.left, PIMORONI_TRACKBALL_SCALE);
  232. y_offset += pimoroni_trackball_get_offsets(pimoroni_data.down, pimoroni_data.up, PIMORONI_TRACKBALL_SCALE);
  233. mouse_report.x = pimoroni_trackball_adapt_values(&x_offset);
  234. mouse_report.y = pimoroni_trackball_adapt_values(&y_offset);
  235. } else {
  236. debounce--;
  237. }
  238. } else {
  239. mouse_report.buttons = pointing_device_handle_buttons(mouse_report.buttons, true, POINTING_DEVICE_BUTTON1);
  240. debounce = PIMORONI_TRACKBALL_DEBOUNCE_CYCLES;
  241. }
  242. } else {
  243. error_count++;
  244. }
  245. }
  246. return mouse_report;
  247. }
  248. // clang-format off
  249. const pointing_device_driver_t pointing_device_driver = {
  250. .init = pimoroni_trackball_device_init,
  251. .get_report = pimoroni_trackball_get_report,
  252. .set_cpi = pimoroni_trackball_set_cpi,
  253. .get_cpi = pimoroni_trackball_get_cpi
  254. };
  255. // clang-format on
  256. #elif defined(POINTING_DEVICE_DRIVER_pmw3360) || defined(POINTING_DEVICE_DRIVER_pmw3389)
  257. static void pmw33xx_init_wrapper(void) {
  258. pmw33xx_init(0);
  259. }
  260. static void pmw33xx_set_cpi_wrapper(uint16_t cpi) {
  261. pmw33xx_set_cpi(0, cpi);
  262. }
  263. static uint16_t pmw33xx_get_cpi_wrapper(void) {
  264. return pmw33xx_get_cpi(0);
  265. }
  266. report_mouse_t pmw33xx_get_report(report_mouse_t mouse_report) {
  267. pmw33xx_report_t report = pmw33xx_read_burst(0);
  268. static bool in_motion = false;
  269. if (report.motion.b.is_lifted) {
  270. return mouse_report;
  271. }
  272. if (!report.motion.b.is_motion) {
  273. in_motion = false;
  274. return mouse_report;
  275. }
  276. if (!in_motion) {
  277. in_motion = true;
  278. dprintf("PWM3360 (0): starting motion\n");
  279. }
  280. mouse_report.x = CONSTRAIN_HID_XY(report.delta_x);
  281. mouse_report.y = CONSTRAIN_HID_XY(report.delta_y);
  282. return mouse_report;
  283. }
  284. // clang-format off
  285. const pointing_device_driver_t pointing_device_driver = {
  286. .init = pmw33xx_init_wrapper,
  287. .get_report = pmw33xx_get_report,
  288. .set_cpi = pmw33xx_set_cpi_wrapper,
  289. .get_cpi = pmw33xx_get_cpi_wrapper
  290. };
  291. // clang-format on
  292. #else
  293. __attribute__((weak)) void pointing_device_driver_init(void) {}
  294. __attribute__((weak)) report_mouse_t pointing_device_driver_get_report(report_mouse_t mouse_report) {
  295. return mouse_report;
  296. }
  297. __attribute__((weak)) uint16_t pointing_device_driver_get_cpi(void) {
  298. return 0;
  299. }
  300. __attribute__((weak)) void pointing_device_driver_set_cpi(uint16_t cpi) {}
  301. // clang-format off
  302. const pointing_device_driver_t pointing_device_driver = {
  303. .init = pointing_device_driver_init,
  304. .get_report = pointing_device_driver_get_report,
  305. .get_cpi = pointing_device_driver_get_cpi,
  306. .set_cpi = pointing_device_driver_set_cpi
  307. };
  308. // clang-format on
  309. #endif