Teensy 4.1 core updated for C++20
Vous ne pouvez pas sélectionner plus de 25 sujets Les noms de sujets doivent commencer par une lettre ou un nombre, peuvent contenir des tirets ('-') et peuvent comporter jusqu'à 35 caractères.

usb_mouse.c 8.2KB

il y a 9 ans
il y a 9 ans
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256
  1. /* Teensyduino Core Library
  2. * http://www.pjrc.com/teensy/
  3. * Copyright (c) 2013 PJRC.COM, LLC.
  4. *
  5. * Permission is hereby granted, free of charge, to any person obtaining
  6. * a copy of this software and associated documentation files (the
  7. * "Software"), to deal in the Software without restriction, including
  8. * without limitation the rights to use, copy, modify, merge, publish,
  9. * distribute, sublicense, and/or sell copies of the Software, and to
  10. * permit persons to whom the Software is furnished to do so, subject to
  11. * the following conditions:
  12. *
  13. * 1. The above copyright notice and this permission notice shall be
  14. * included in all copies or substantial portions of the Software.
  15. *
  16. * 2. If the Software is incorporated into a build system that allows
  17. * selection among a list of target devices, then similar target
  18. * devices manufactured by PJRC.COM must be included in the list of
  19. * target devices and selectable in the same manner.
  20. *
  21. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  22. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  23. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  24. * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  25. * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  26. * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  27. * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  28. * SOFTWARE.
  29. */
  30. #include "usb_dev.h"
  31. #include "usb_mouse.h"
  32. #include "core_pins.h" // for yield()
  33. #include "HardwareSerial.h"
  34. #include <string.h> // for memcpy()
  35. #ifdef MOUSE_INTERFACE // defined by usb_dev.h -> usb_desc.h
  36. #if F_CPU >= 20000000
  37. // which buttons are currently pressed
  38. uint8_t usb_mouse_buttons_state=0;
  39. //#define DEFAULT_XRES 640
  40. //#define DEFAULT_YRES 480
  41. //#define DEFAULT_XRES 800
  42. //#define DEFAULT_YRES 600
  43. //#define DEFAULT_XRES 1024
  44. //#define DEFAULT_YRES 768
  45. //#define DEFAULT_XRES 1280
  46. //#define DEFAULT_YRES 720
  47. //#define DEFAULT_XRES 1280
  48. //#define DEFAULT_YRES 800
  49. #define DEFAULT_XRES 1366
  50. #define DEFAULT_YRES 768
  51. //#define DEFAULT_XRES 1440
  52. //#define DEFAULT_YRES 900
  53. //#define DEFAULT_XRES 1920
  54. //#define DEFAULT_YRES 1080
  55. //#define DEFAULT_XRES 2560
  56. //#define DEFAULT_YRES 1440
  57. //#define DEFAULT_XRES 2560
  58. //#define DEFAULT_YRES 1600
  59. //#define DEFAULT_XRES 2880
  60. //#define DEFAULT_YRES 1800
  61. //#define DEFAULT_XRES 3840
  62. //#define DEFAULT_YRES 2160
  63. //#define DEFAULT_XRES 7680
  64. //#define DEFAULT_YRES 4320
  65. #define DEFAULT_XSCALE ((0x80000000ul+DEFAULT_XRES/2)/DEFAULT_XRES)
  66. #define DEFAULT_YSCALE ((0x80000000ul+DEFAULT_YRES/2)/DEFAULT_YRES)
  67. static uint16_t usb_mouse_resolution_x=DEFAULT_XRES;
  68. static uint16_t usb_mouse_resolution_y=DEFAULT_YRES;
  69. static uint16_t usb_mouse_position_x=DEFAULT_XRES/2;
  70. static uint16_t usb_mouse_position_y=DEFAULT_YRES/2;
  71. static uint32_t usb_mouse_scale_x=DEFAULT_XSCALE;
  72. static uint32_t usb_mouse_scale_y=DEFAULT_YSCALE;
  73. static uint32_t usb_mouse_offset_x=DEFAULT_XSCALE/2-1;
  74. static uint32_t usb_mouse_offset_y=DEFAULT_YSCALE/2-1;
  75. // Set the mouse buttons. To create a "click", 2 calls are needed,
  76. // one to push the button down and the second to release it
  77. int usb_mouse_buttons(uint8_t left, uint8_t middle, uint8_t right, uint8_t back, uint8_t forward)
  78. {
  79. uint8_t mask=0;
  80. if (left) mask |= 1;
  81. if (middle) mask |= 4;
  82. if (right) mask |= 2;
  83. if (back) mask |= 8;
  84. if (forward) mask |= 16;
  85. usb_mouse_buttons_state = mask;
  86. return usb_mouse_move(0, 0, 0, 0);
  87. }
  88. // Maximum number of transmit packets to queue so we don't starve other endpoints for memory
  89. #define TX_PACKET_LIMIT 3
  90. static uint8_t transmit_previous_timeout=0;
  91. // When the PC isn't listening, how long do we wait before discarding data?
  92. #define TX_TIMEOUT_MSEC 30
  93. #if F_CPU == 240000000
  94. #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 1600)
  95. #elif F_CPU == 216000000
  96. #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 1440)
  97. #elif F_CPU == 192000000
  98. #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 1280)
  99. #elif F_CPU == 180000000
  100. #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 1200)
  101. #elif F_CPU == 168000000
  102. #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 1100)
  103. #elif F_CPU == 144000000
  104. #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 932)
  105. #elif F_CPU == 120000000
  106. #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 764)
  107. #elif F_CPU == 96000000
  108. #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 596)
  109. #elif F_CPU == 72000000
  110. #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 512)
  111. #elif F_CPU == 48000000
  112. #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 428)
  113. #elif F_CPU == 24000000
  114. #define TX_TIMEOUT (TX_TIMEOUT_MSEC * 262)
  115. #endif
  116. // Move the mouse. x, y and wheel are -127 to 127. Use 0 for no movement.
  117. int usb_mouse_move(int8_t x, int8_t y, int8_t wheel, int8_t horiz)
  118. {
  119. uint32_t wait_count=0;
  120. usb_packet_t *tx_packet;
  121. //serial_print("move");
  122. //serial_print("\n");
  123. if (x == -128) x = -127;
  124. if (y == -128) y = -127;
  125. if (wheel == -128) wheel = -127;
  126. if (horiz == -128) horiz = -127;
  127. while (1) {
  128. if (!usb_configuration) {
  129. return -1;
  130. }
  131. if (usb_tx_packet_count(MOUSE_ENDPOINT) < TX_PACKET_LIMIT) {
  132. tx_packet = usb_malloc();
  133. if (tx_packet) break;
  134. }
  135. if (++wait_count > TX_TIMEOUT || transmit_previous_timeout) {
  136. transmit_previous_timeout = 1;
  137. return -1;
  138. }
  139. yield();
  140. }
  141. transmit_previous_timeout = 0;
  142. *(tx_packet->buf + 0) = 1;
  143. *(tx_packet->buf + 1) = usb_mouse_buttons_state;
  144. *(tx_packet->buf + 2) = x;
  145. *(tx_packet->buf + 3) = y;
  146. *(tx_packet->buf + 4) = wheel;
  147. *(tx_packet->buf + 5) = horiz; // horizontal scroll
  148. tx_packet->len = 6;
  149. usb_tx(MOUSE_ENDPOINT, tx_packet);
  150. return 0;
  151. }
  152. int usb_mouse_position(uint16_t x, uint16_t y)
  153. {
  154. uint32_t wait_count=0, val32;
  155. usb_packet_t *tx_packet;
  156. if (x >= usb_mouse_resolution_x) x = usb_mouse_resolution_x - 1;
  157. usb_mouse_position_x = x;
  158. if (y >= usb_mouse_resolution_y) y = usb_mouse_resolution_y - 1;
  159. usb_mouse_position_y = y;
  160. while (1) {
  161. if (!usb_configuration) {
  162. return -1;
  163. }
  164. if (usb_tx_packet_count(MOUSE_ENDPOINT) < TX_PACKET_LIMIT) {
  165. tx_packet = usb_malloc();
  166. if (tx_packet) break;
  167. }
  168. if (++wait_count > TX_TIMEOUT || transmit_previous_timeout) {
  169. transmit_previous_timeout = 1;
  170. return -1;
  171. }
  172. yield();
  173. }
  174. transmit_previous_timeout = 0;
  175. *(tx_packet->buf + 0) = 2;
  176. val32 = usb_mouse_position_x * usb_mouse_scale_x + usb_mouse_offset_x;
  177. //serial_print("position:");
  178. //serial_phex16(usb_mouse_position_x);
  179. //serial_print("->");
  180. //serial_phex32(val32);
  181. *(tx_packet->buf + 1) = val32 >> 16;
  182. *(tx_packet->buf + 2) = val32 >> 24;
  183. val32 = usb_mouse_position_y * usb_mouse_scale_y + usb_mouse_offset_y;
  184. //serial_print(",");
  185. //serial_phex16(usb_mouse_position_y);
  186. //serial_print("->");
  187. //serial_phex32(val32);
  188. //serial_print("\n");
  189. *(tx_packet->buf + 3) = val32 >> 16;
  190. *(tx_packet->buf + 4) = val32 >> 24;
  191. tx_packet->len = 5;
  192. usb_tx(MOUSE_ENDPOINT, tx_packet);
  193. return 0;
  194. }
  195. void usb_mouse_screen_size(uint16_t width, uint16_t height, uint8_t mac)
  196. {
  197. if (width < 128) width = 128;
  198. else if (width > 7680) width = 7680;
  199. if (height < 128) height = 128;
  200. else if (height > 7680) height = 7680;
  201. usb_mouse_resolution_x = width;
  202. usb_mouse_resolution_y = height;
  203. usb_mouse_position_x = width / 2;
  204. usb_mouse_position_y = height / 2;
  205. usb_mouse_scale_x = (0x80000000ul + (width >> 1)) / width;
  206. usb_mouse_scale_y = (0x80000000ul + (height >> 1)) / height;
  207. usb_mouse_offset_x = (usb_mouse_scale_x >> 1) - 1;
  208. usb_mouse_offset_y = (usb_mouse_scale_y >> 1) - 1;
  209. if (mac) {
  210. // ugly workaround for Mac's HID coordinate scaling:
  211. // http://lists.apple.com/archives/usb/2011/Jun/msg00032.html
  212. usb_mouse_offset_x += 161061273ul;
  213. usb_mouse_offset_y += 161061273ul;
  214. usb_mouse_scale_x = (1825361101ul + (width >> 1)) / width;
  215. usb_mouse_scale_y = (1825361101ul + (height >> 1)) / height;
  216. }
  217. }
  218. #endif // F_CPU
  219. #endif // MOUSE_INTERFACE