Louise Newberry / USBHOST

Fork to support Mouse boot protocol and steam controllers.

Fork of USBHOST by ST

USBHostHID/USBHostMouse.cpp@8:e57ccb876952, 2017-08-19 (annotated)

Committer:
geekylou
Date:
Sat Aug 19 19:47:53 2017 +0000
Revision:
8:e57ccb876952
Parent:
7:cc595e523032
Child:
11:ba29414a455e
Add steam controller support.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 1 /* mbed USBHost Library
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 2 * Copyright (c) 2006-2013 ARM Limited
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 3 *
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 4 * Licensed under the Apache License, Version 2.0 (the "License");
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 5 * you may not use this file except in compliance with the License.
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 6 * You may obtain a copy of the License at
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 7 *
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 8 * http://www.apache.org/licenses/LICENSE-2.0
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 9 *
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 10 * Unless required by applicable law or agreed to in writing, software
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 11 * distributed under the License is distributed on an "AS IS" BASIS,
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 13 * See the License for the specific language governing permissions and
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 14 * limitations under the License.
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 15 */
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 16
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 17 #include "USBHostMouse.h"
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 18
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 19 #if USBHOST_MOUSE
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 20
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 21 USBHostMouse::USBHostMouse() {
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 22 host = USBHost::getHostInst();
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 23 init();
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 24 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 25
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 26 void USBHostMouse::init() {
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 27 dev = NULL;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 28 int_in = NULL;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 29 onUpdate = NULL;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 30 onButtonUpdate = NULL;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 31 onXUpdate = NULL;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 32 onYUpdate = NULL;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 33 onZUpdate = NULL;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 34 report_id = 0;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 35 dev_connected = false;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 36 mouse_device_found = false;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 37 mouse_intf = -1;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 38
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 39 buttons = 0;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 40 x = 0;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 41 y = 0;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 42 z = 0;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 43 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 44
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 45 bool USBHostMouse::connected() {
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 46 return dev_connected;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 47 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 48
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 49 bool USBHostMouse::connect()
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 50 {
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 51 int len_listen;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 52
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 53 if (dev_connected) {
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 54 return true;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 55 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 56
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 57 for (uint8_t i = 0; i < MAX_DEVICE_CONNECTED; i++) {
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 58 if ((dev = host->getDevice(i)) != NULL) {
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 59
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 60 if(host->enumerate(dev, this))
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 61 break;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 62 if (mouse_device_found) {
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 63 {
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 64 /* As this is done in a specific thread
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 65 * this lock is taken to avoid to process the device
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 66 * disconnect in usb process during the device registering */
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 67 USBHost::Lock Lock(host);
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 68 int_in = dev->getEndpoint(mouse_intf, INTERRUPT_ENDPOINT, IN);
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 69 if (!int_in)
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 70 break;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 71
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 72 USB_INFO("New Mouse device: VID:%04x PID:%04x [dev: %p - intf: %d]", dev->getVid(), dev->getPid(), dev, mouse_intf);
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 73 dev->setName("Mouse", mouse_intf);
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 74 host->registerDriver(dev, mouse_intf, this, &USBHostMouse::init);
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 75
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 76 int_in->attach(this, &USBHostMouse::rxHandler);
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 77 len_listen = int_in->getSize();
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 78 if (len_listen > sizeof(report)) {
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 79 len_listen = sizeof(report);
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 80 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 81 }
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 82 int ret=host->interruptRead(dev, int_in, report, len_listen, false);
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 83 MBED_ASSERT((ret==USB_TYPE_OK) || (ret ==USB_TYPE_PROCESSING) || (ret == USB_TYPE_FREE));
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 84 if ((ret==USB_TYPE_OK) || (ret ==USB_TYPE_PROCESSING))
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 85 dev_connected = true;
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 86 if (ret == USB_TYPE_FREE)
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 87 dev_connected = false;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 88 return true;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 89 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 90 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 91 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 92 init();
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 93 return false;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 94 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 95
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 96 void USBHostMouse::rxHandler() {
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 97 int len_listen = int_in->getLengthTransferred();
geekylou 7:cc595e523032 98 int buttons_t, x_t, y_t, z_t;
geekylou 8:e57ccb876952 99 /*{
geekylou 7:cc595e523032 100 int index;
geekylou 7:cc595e523032 101 for (index=0;index < len_listen; index++)
geekylou 7:cc595e523032 102 {
geekylou 7:cc595e523032 103 printf("%2x ",report[index]);
geekylou 7:cc595e523032 104 }
geekylou 7:cc595e523032 105
geekylou 7:cc595e523032 106 if (index>0) printf(" %x:%x \r\n",dev->getVid(), dev->getPid());
geekylou 7:cc595e523032 107 }*/
geekylou 7:cc595e523032 108
geekylou 7:cc595e523032 109 // We really should be parsing the pid report but this is a good workaround
geekylou 7:cc595e523032 110 // for my wireless mouse for now!
geekylou 7:cc595e523032 111 if (dev->getVid() == 0x62a && dev->getPid() == 0x4101)
geekylou 7:cc595e523032 112 {
geekylou 7:cc595e523032 113 buttons_t = report[1] & 0x07;
geekylou 8:e57ccb876952 114 x_t = (((int)report[3] & 0xf) << 8) + (report[2]);
geekylou 8:e57ccb876952 115 y_t = (report[3] >> 4) + ((int)report[4] << 4);
geekylou 8:e57ccb876952 116
geekylou 8:e57ccb876952 117 if (y_t & 0x800) y_t |= 0xf000; // Fix 4 highest bits of negative nos.
geekylou 8:e57ccb876952 118 if (x_t & 0x800) x_t |= 0xf000;
geekylou 8:e57ccb876952 119
geekylou 8:e57ccb876952 120 z_t = report[5];
geekylou 7:cc595e523032 121 }
geekylou 7:cc595e523032 122 else
geekylou 7:cc595e523032 123 {
geekylou 7:cc595e523032 124 buttons_t = report[0] & 0x07;
geekylou 7:cc595e523032 125 x_t = report[1];
geekylou 7:cc595e523032 126 y_t = report[2];
geekylou 7:cc595e523032 127 z_t = report[3];
geekylou 7:cc595e523032 128 }
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 129 if (len_listen !=0) {
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 130
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 131 if (onUpdate) {
geekylou 8:e57ccb876952 132 (*onUpdate)(buttons_t, x_t, y_t, z_t);
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 133 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 134
geekylou 8:e57ccb876952 135 if (onButtonUpdate && (buttons != (buttons_t))) {
geekylou 8:e57ccb876952 136 (*onButtonUpdate)(buttons_t);
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 137 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 138
geekylou 8:e57ccb876952 139 if (onXUpdate && (x != x_t)) {
geekylou 7:cc595e523032 140 (*onXUpdate)(x_t);
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 141 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 142
geekylou 8:e57ccb876952 143 if (onYUpdate && (y != y_t)) {
geekylou 7:cc595e523032 144 (*onYUpdate)(y_t);
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 145 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 146
geekylou 8:e57ccb876952 147 if (onZUpdate && (z != z_t)) {
geekylou 7:cc595e523032 148 (*onZUpdate)(z_t);
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 149 }
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 150
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 151 // update mouse state
geekylou 7:cc595e523032 152 buttons = buttons_t;
geekylou 7:cc595e523032 153 x = x_t;
geekylou 7:cc595e523032 154 y = y_t;
geekylou 7:cc595e523032 155 z = z_t;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 156 }
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 157 /* set again the maximum value */
frq08711@LMECWL0871.LME.ST.COM 5:fc157e6bd5a5 158 len_listen = int_in->getSize();
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 159
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 160 if (len_listen > sizeof(report)) {
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 161 len_listen = sizeof(report);
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 162 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 163
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 164 if (dev)
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 165 host->interruptRead(dev, int_in, report, len_listen, false);
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 166 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 167
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 168 /*virtual*/ void USBHostMouse::setVidPid(uint16_t vid, uint16_t pid)
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 169 {
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 170 // we don't check VID/PID for mouse driver
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 171 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 172
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 173 /*virtual*/ bool USBHostMouse::parseInterface(uint8_t intf_nb, uint8_t intf_class, uint8_t intf_subclass, uint8_t intf_protocol) //Must return true if the interface should be parsed
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 174 {
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 175 if ((mouse_intf == -1) &&
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 176 (intf_class == HID_CLASS) &&
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 177 (intf_subclass == 0x01) &&
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 178 (intf_protocol == 0x02)) {
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 179 mouse_intf = intf_nb;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 180 return true;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 181 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 182 return false;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 183 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 184
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 185 /*virtual*/ bool USBHostMouse::useEndpoint(uint8_t intf_nb, ENDPOINT_TYPE type, ENDPOINT_DIRECTION dir) //Must return true if the endpoint will be used
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 186 {
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 187 if (intf_nb == mouse_intf) {
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 188 if (type == INTERRUPT_ENDPOINT && dir == IN) {
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 189 mouse_device_found = true;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 190 return true;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 191 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 192 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 193 return false;
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 194 }
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 195
frq08711@LMECWL0871.LME.ST.COM 1:ab240722d7ef 196 #endif