forked for unsupported target
Dependents: stm32-disco-example DISCO-F469NI_BD_SD_Card_Control
Fork of USBHOST by
USBHost/USBHost.cpp@5:fc157e6bd5a5, 2017-04-26 (annotated)
- Committer:
- frq08711@LMECWL0871.LME.ST.COM
- Date:
- Wed Apr 26 18:11:37 2017 +0200
- Revision:
- 5:fc157e6bd5a5
- Parent:
- 1:ab240722d7ef
update for hub support
Who changed what in which revision?
User | Revision | Line number | New 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 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 18 | #include "USBHost.h" |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 19 | #include "USBHostHub.h" |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 20 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 21 | USBHost * USBHost::instHost = NULL; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 22 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 23 | #define DEVICE_CONNECTED_EVENT (1 << 0) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 24 | #define DEVICE_DISCONNECTED_EVENT (1 << 1) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 25 | #define TD_PROCESSED_EVENT (1 << 2) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 26 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 27 | #define MAX_TRY_ENUMERATE_HUB 3 |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 28 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 29 | #define MIN(a, b) ((a > b) ? b : a) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 30 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 31 | /** |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 32 | * How interrupts are processed: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 33 | * - new device connected: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 34 | * - a message is queued in queue_usb_event with the id DEVICE_CONNECTED_EVENT |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 35 | * - when the usb_thread receives the event, it: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 36 | * - resets the device |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 37 | * - reads the device descriptor |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 38 | * - sets the address of the device |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 39 | * - if it is a hub, enumerates it |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 40 | * - device disconnected: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 41 | * - a message is queued in queue_usb_event with the id DEVICE_DISCONNECTED_EVENT |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 42 | * - when the usb_thread receives the event, it: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 43 | * - free the device and all its children (hub) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 44 | * - td processed |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 45 | * - a message is queued in queue_usb_event with the id TD_PROCESSED_EVENT |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 46 | * - when the usb_thread receives the event, it: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 47 | * - call the callback attached to the endpoint where the td is attached |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 48 | */ |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 49 | void USBHost::usb_process() |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 50 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 51 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 52 | bool controlListState; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 53 | bool bulkListState; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 54 | bool interruptListState; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 55 | USBEndpoint * ep; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 56 | uint8_t i, j, res, timeout_set_addr = 10; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 57 | uint8_t buf[8]; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 58 | bool too_many_hub; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 59 | int idx; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 60 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 61 | #if DEBUG_TRANSFER |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 62 | uint8_t * buf_transfer; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 63 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 64 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 65 | #if MAX_HUB_NB |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 66 | uint8_t k; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 67 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 68 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 69 | while(1) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 70 | osEvent evt = mail_usb_event.get(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 71 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 72 | if (evt.status == osEventMail) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 73 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 74 | message_t * usb_msg = (message_t*)evt.value.p; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 75 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 76 | switch (usb_msg->event_id) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 77 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 78 | // a new device has been connected |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 79 | case DEVICE_CONNECTED_EVENT: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 80 | too_many_hub = false; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 81 | buf[4] = 0; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 82 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 83 | do { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 84 | Lock lock(this); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 85 | bool hub_unplugged = true; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 86 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 87 | int idx = findDevice(usb_msg->hub, usb_msg->port, (USBHostHub *)(usb_msg->hub_parent)); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 88 | /* check that hub is connected to root port */ |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 89 | if (usb_msg->hub_parent) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 90 | /* a hub device must be present */ |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 91 | for (k = 0; k < MAX_HUB_NB; k++) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 92 | if ((&hubs[k] == usb_msg->hub_parent) && (hub_in_use[k])) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 93 | hub_unplugged=false; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 94 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 95 | } else hub_unplugged = false; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 96 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 97 | if (((idx!=-1) && deviceInUse[idx] ) || ((idx == -1) && hub_unplugged)) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 98 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 99 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 100 | for (i =0 ; i < MAX_DEVICE_CONNECTED; i++) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 101 | if (!deviceInUse[i]) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 102 | USB_DBG_EVENT("new device connected: %p\r\n", &devices[i]); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 103 | devices[i].init(usb_msg->hub, usb_msg->port, usb_msg->lowSpeed); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 104 | deviceReset[i] = false; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 105 | deviceInited[i] = true; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 106 | break; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 107 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 108 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 109 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 110 | if (i == MAX_DEVICE_CONNECTED) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 111 | USB_ERR("Too many device connected!!\r\n"); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 112 | continue; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 113 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 114 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 115 | if (!controlEndpointAllocated) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 116 | control = newEndpoint(CONTROL_ENDPOINT, OUT, 0x08, 0x00); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 117 | addEndpoint(NULL, 0, (USBEndpoint*)control); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 118 | controlEndpointAllocated = true; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 119 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 120 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 121 | #if MAX_HUB_NB |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 122 | if (usb_msg->hub_parent) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 123 | devices[i].setHubParent((USBHostHub *)(usb_msg->hub_parent)); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 124 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 125 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 126 | for (j = 0; j < timeout_set_addr; j++) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 127 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 128 | resetDevice(&devices[i]); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 129 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 130 | // set size of control endpoint |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 131 | devices[i].setSizeControlEndpoint(8); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 132 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 133 | devices[i].activeAddress(false); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 134 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 135 | // get first 8 bit of device descriptor |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 136 | // and check if we deal with a hub |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 137 | USB_DBG("usb_thread read device descriptor on dev: %p\r\n", &devices[i]); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 138 | res = getDeviceDescriptor(&devices[i], buf, 8); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 139 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 140 | if (res != USB_TYPE_OK) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 141 | USB_ERR("usb_thread could not read dev descr"); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 142 | continue; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 143 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 144 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 145 | // set size of control endpoint |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 146 | devices[i].setSizeControlEndpoint(buf[7]); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 147 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 148 | // second step: set an address to the device |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 149 | res = setAddress(&devices[i], devices[i].getAddress()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 150 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 151 | if (res != USB_TYPE_OK) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 152 | USB_ERR("SET ADDR FAILED"); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 153 | continue; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 154 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 155 | devices[i].activeAddress(true); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 156 | USB_DBG("Address of %p: %d", &devices[i], devices[i].getAddress()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 157 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 158 | // try to read again the device descriptor to check if the device |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 159 | // answers to its new address |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 160 | res = getDeviceDescriptor(&devices[i], buf, 8); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 161 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 162 | if (res == USB_TYPE_OK) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 163 | break; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 164 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 165 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 166 | Thread::wait(100); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 167 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 168 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 169 | USB_INFO("New device connected: %p [hub: %d - port: %d]", &devices[i], usb_msg->hub, usb_msg->port); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 170 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 171 | #if MAX_HUB_NB |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 172 | if (buf[4] == HUB_CLASS) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 173 | for (k = 0; k < MAX_HUB_NB; k++) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 174 | if (hub_in_use[k] == false) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 175 | for (uint8_t j = 0; j < MAX_TRY_ENUMERATE_HUB; j++) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 176 | if (hubs[k].connect(&devices[i])) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 177 | devices[i].hub = &hubs[k]; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 178 | hub_in_use[k] = true; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 179 | break; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 180 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 181 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 182 | if (hub_in_use[k] == true) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 183 | break; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 184 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 185 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 186 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 187 | if (k == MAX_HUB_NB) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 188 | USB_ERR("Too many hubs connected!!\r\n"); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 189 | too_many_hub = true; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 190 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 191 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 192 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 193 | if (usb_msg->hub_parent) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 194 | ((USBHostHub *)(usb_msg->hub_parent))->deviceConnected(&devices[i]); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 195 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 196 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 197 | if ((i < MAX_DEVICE_CONNECTED) && !too_many_hub) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 198 | deviceInUse[i] = true; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 199 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 200 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 201 | } while(0); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 202 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 203 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 204 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 205 | // a device has been disconnected |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 206 | case DEVICE_DISCONNECTED_EVENT: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 207 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 208 | do { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 209 | Lock lock(this); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 210 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 211 | controlListState = disableList(CONTROL_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 212 | bulkListState = disableList(BULK_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 213 | interruptListState = disableList(INTERRUPT_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 214 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 215 | idx = findDevice(usb_msg->hub, usb_msg->port, (USBHostHub *)(usb_msg->hub_parent)); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 216 | if (idx != -1) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 217 | freeDevice((USBDeviceConnected*)&devices[idx]); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 218 | deviceInited[idx]=false; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 219 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 220 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 221 | if (controlListState) enableList(CONTROL_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 222 | if (bulkListState) enableList(BULK_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 223 | if (interruptListState) enableList(INTERRUPT_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 224 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 225 | } while(0); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 226 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 227 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 228 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 229 | // a td has been processed |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 230 | // call callback on the ed associated to the td |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 231 | // we are not in ISR -> users can use printf in their callback method |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 232 | case TD_PROCESSED_EVENT: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 233 | ep = (USBEndpoint *) ((HCTD *)usb_msg->td_addr)->ep; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 234 | if (usb_msg->td_state == USB_TYPE_IDLE) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 235 | USB_DBG_EVENT("call callback on td %p [ep: %p state: %s - dev: %p - %s]", usb_msg->td_addr, ep, ep->getStateString(), ep->dev, ep->dev->getName(ep->getIntfNb())); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 236 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 237 | #if DEBUG_TRANSFER |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 238 | if (ep->getDir() == IN) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 239 | buf_transfer = ep->getBufStart(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 240 | printf("READ SUCCESS [%d bytes transferred - td: 0x%08X] on ep: [%p - addr: %02X]: ", ep->getLengthTransferred(), usb_msg->td_addr, ep, ep->getAddress()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 241 | for (int i = 0; i < ep->getLengthTransferred(); i++) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 242 | printf("%02X ", buf_transfer[i]); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 243 | printf("\r\n\r\n"); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 244 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 245 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 246 | ep->call(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 247 | } else { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 248 | idx = findDevice(ep->dev); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 249 | if (idx != -1) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 250 | if (deviceInUse[idx]) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 251 | USB_WARN("td %p processed but not in idle state: %s [ep: %p - dev: %p - %s]", usb_msg->td_addr, ep->getStateString(), ep, ep->dev, ep->dev->getName(ep->getIntfNb())); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 252 | ep->setState(USB_TYPE_IDLE); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 253 | /* as error, on interrupt endpoint can be |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 254 | * reported, call the call back registered , |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 255 | * if device still in use, this call back |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 256 | * shall ask again an interrupt request. |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 257 | */ |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 258 | ep->call(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 259 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 260 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 261 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 262 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 263 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 264 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 265 | mail_usb_event.free(usb_msg); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 266 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 267 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 268 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 269 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 270 | USBHost::USBHost() : usbThread(osPriorityNormal, USB_THREAD_STACK) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 271 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 272 | #ifndef USBHOST_OTHER |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 273 | headControlEndpoint = NULL; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 274 | headBulkEndpoint = NULL; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 275 | headInterruptEndpoint = NULL; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 276 | tailControlEndpoint = NULL; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 277 | tailBulkEndpoint = NULL; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 278 | tailInterruptEndpoint = NULL; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 279 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 280 | lenReportDescr = 0; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 281 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 282 | controlEndpointAllocated = false; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 283 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 284 | for (uint8_t i = 0; i < MAX_DEVICE_CONNECTED; i++) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 285 | deviceInUse[i] = false; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 286 | devices[i].setAddress(i + 1); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 287 | deviceReset[i] = false; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 288 | deviceInited[i] = false; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 289 | for (uint8_t j = 0; j < MAX_INTF; j++) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 290 | deviceAttachedDriver[i][j] = false; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 291 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 292 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 293 | #if MAX_HUB_NB |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 294 | for (uint8_t i = 0; i < MAX_HUB_NB; i++) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 295 | hubs[i].setHost(this); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 296 | hub_in_use[i] = false; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 297 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 298 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 299 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 300 | usbThread.start(this, &USBHost::usb_process); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 301 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 302 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 303 | USBHost::Lock::Lock(USBHost* pHost) : m_pHost(pHost) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 304 | { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 305 | m_pHost->usb_mutex.lock(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 306 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 307 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 308 | USBHost::Lock::~Lock() |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 309 | { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 310 | m_pHost->usb_mutex.unlock(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 311 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 312 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 313 | void USBHost::transferCompleted(volatile uint32_t addr) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 314 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 315 | uint8_t state; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 316 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 317 | if(addr == 0) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 318 | return; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 319 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 320 | volatile HCTD* tdList = NULL; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 321 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 322 | //First we must reverse the list order and dequeue each TD |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 323 | do { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 324 | volatile HCTD* td = (volatile HCTD*)addr; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 325 | addr = (uint32_t)td->nextTD; //Dequeue from physical list |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 326 | td->nextTD = (hcTd*)tdList; //Enqueue into reversed list |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 327 | tdList = td; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 328 | } while(addr); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 329 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 330 | while(tdList != NULL) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 331 | volatile HCTD* td = tdList; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 332 | tdList = (volatile HCTD*)td->nextTD; //Dequeue element now as it could be modified below |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 333 | if (td->ep != NULL) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 334 | USBEndpoint * ep = (USBEndpoint *)(td->ep); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 335 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 336 | #ifdef USBHOST_OTHER |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 337 | state = ((HCTD *)td)->state; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 338 | if (state == USB_TYPE_IDLE) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 339 | ep->setLengthTransferred((uint32_t)td->currBufPtr - (uint32_t)ep->getBufStart()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 340 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 341 | #else |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 342 | if (((HCTD *)td)->control >> 28) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 343 | state = ((HCTD *)td)->control >> 28; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 344 | } else { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 345 | if (td->currBufPtr) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 346 | ep->setLengthTransferred((uint32_t)td->currBufPtr - (uint32_t)ep->getBufStart()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 347 | state = 16 /*USB_TYPE_IDLE*/; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 348 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 349 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 350 | if (state == USB_TYPE_IDLE) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 351 | ep->setLengthTransferred((uint32_t)td->currBufPtr - (uint32_t)ep->getBufStart()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 352 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 353 | ep->unqueueTransfer(td); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 354 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 355 | if (ep->getType() != CONTROL_ENDPOINT) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 356 | // callback on the processed td will be called from the usb_thread (not in ISR) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 357 | message_t * usb_msg = mail_usb_event.alloc(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 358 | usb_msg->event_id = TD_PROCESSED_EVENT; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 359 | usb_msg->td_addr = (void *)td; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 360 | usb_msg->td_state = state; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 361 | mail_usb_event.put(usb_msg); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 362 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 363 | ep->setState((USB_TYPE)state); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 364 | ep->ep_queue.put((uint8_t*)1); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 365 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 366 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 367 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 368 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 369 | USBHost * USBHost::getHostInst() |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 370 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 371 | if (instHost == NULL) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 372 | instHost = new USBHost(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 373 | instHost->init(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 374 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 375 | return instHost; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 376 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 377 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 378 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 379 | /* |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 380 | * Called when a device has been connected |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 381 | * Called in ISR!!!! (no printf) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 382 | */ |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 383 | /* virtual */ void USBHost::deviceConnected(int hub, int port, bool lowSpeed, USBHostHub * hub_parent) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 384 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 385 | // be sure that the new device connected is not already connected... |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 386 | disableList(CONTROL_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 387 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 388 | int idx = findDevice(hub, port, hub_parent); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 389 | if (idx != -1) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 390 | if (deviceInited[idx]) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 391 | enableList(CONTROL_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 392 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 393 | return; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 394 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 395 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 396 | message_t * usb_msg = mail_usb_event.alloc(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 397 | usb_msg->event_id = DEVICE_CONNECTED_EVENT; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 398 | usb_msg->hub = hub; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 399 | usb_msg->port = port; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 400 | usb_msg->lowSpeed = lowSpeed; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 401 | usb_msg->hub_parent = hub_parent; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 402 | mail_usb_event.put(usb_msg); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 403 | enableList(CONTROL_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 404 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 405 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 406 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 407 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 408 | /* |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 409 | * Called when a device has been disconnected |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 410 | * Called in ISR!!!! (no printf) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 411 | */ |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 412 | /* virtual */ void USBHost::deviceDisconnected(int hub, int port, USBHostHub * hub_parent, volatile uint32_t addr) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 413 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 414 | // be sure that the device disconnected is connected... |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 415 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 416 | disableList(CONTROL_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 417 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 418 | int idx = findDevice(hub, port, hub_parent); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 419 | if (idx != -1) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 420 | if (!deviceInUse[idx]) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 421 | enableList(CONTROL_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 422 | return; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 423 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 424 | } else { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 425 | enableList(CONTROL_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 426 | return; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 427 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 428 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 429 | message_t * usb_msg = mail_usb_event.alloc(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 430 | usb_msg->event_id = DEVICE_DISCONNECTED_EVENT; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 431 | usb_msg->hub = hub; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 432 | usb_msg->port = port; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 433 | usb_msg->hub_parent = hub_parent; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 434 | mail_usb_event.put(usb_msg); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 435 | enableList(CONTROL_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 436 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 437 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 438 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 439 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 440 | void USBHost::freeDevice(USBDeviceConnected * dev) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 441 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 442 | USBEndpoint * ep = NULL; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 443 | HCED * ed = NULL; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 444 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 445 | #if MAX_HUB_NB |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 446 | if (dev->getClass() == HUB_CLASS) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 447 | if (dev->hub == NULL) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 448 | USB_ERR("HUB NULL!!!!!\r\n"); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 449 | } else { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 450 | dev->hub->hubDisconnected(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 451 | for (uint8_t i = 0; i < MAX_HUB_NB; i++) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 452 | if (dev->hub == &hubs[i]) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 453 | hub_in_use[i] = false; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 454 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 455 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 456 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 457 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 458 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 459 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 460 | // notify hub parent that this device has been disconnected |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 461 | if (dev->getHubParent()) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 462 | dev->getHubParent()->deviceDisconnected(dev); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 463 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 464 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 465 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 466 | int idx = findDevice(dev); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 467 | if (idx != -1) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 468 | deviceInUse[idx] = false; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 469 | deviceReset[idx] = false; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 470 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 471 | for (uint8_t j = 0; j < MAX_INTF; j++) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 472 | deviceAttachedDriver[idx][j] = false; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 473 | if (dev->getInterface(j) != NULL) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 474 | USB_DBG("FREE INTF %d on dev: %p, %p, nb_endpot: %d, %s", j, (void *)dev->getInterface(j), dev, dev->getInterface(j)->nb_endpoint, dev->getName(j)); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 475 | for (int i = 0; i < dev->getInterface(j)->nb_endpoint; i++) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 476 | if ((ep = dev->getEndpoint(j, i)) != NULL) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 477 | #ifndef USBHOST_OTHER |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 478 | ed = (HCED *)ep->getHCED(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 479 | ed->control |= (1 << 14); //sKip bit |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 480 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 481 | unqueueEndpoint(ep); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 482 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 483 | freeTD((volatile uint8_t*)ep->getTDList()[0]); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 484 | freeTD((volatile uint8_t*)ep->getTDList()[1]); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 485 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 486 | freeED((uint8_t *)ep->getHCED()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 487 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 488 | printList(BULK_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 489 | printList(INTERRUPT_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 490 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 491 | USB_INFO("Device disconnected [%p - %s - hub: %d - port: %d]", dev, dev->getName(j), dev->getHub(), dev->getPort()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 492 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 493 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 494 | dev->disconnect(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 495 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 496 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 497 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 498 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 499 | void USBHost::unqueueEndpoint(USBEndpoint * ep) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 500 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 501 | #ifdef USBHOST_OTHER |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 502 | ep->setState(USB_TYPE_FREE); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 503 | #else |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 504 | USBEndpoint * prec = NULL; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 505 | USBEndpoint * current = NULL; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 506 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 507 | for (int i = 0; i < 2; i++) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 508 | current = (i == 0) ? (USBEndpoint*)headBulkEndpoint : (USBEndpoint*)headInterruptEndpoint; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 509 | prec = current; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 510 | while (current != NULL) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 511 | if (current == ep) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 512 | if (current->nextEndpoint() != NULL) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 513 | prec->queueEndpoint(current->nextEndpoint()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 514 | if (current == headBulkEndpoint) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 515 | updateBulkHeadED((uint32_t)current->nextEndpoint()->getHCED()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 516 | headBulkEndpoint = current->nextEndpoint(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 517 | } else if (current == headInterruptEndpoint) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 518 | updateInterruptHeadED((uint32_t)current->nextEndpoint()->getHCED()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 519 | headInterruptEndpoint = current->nextEndpoint(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 520 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 521 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 522 | // here we are dequeuing the queue of ed |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 523 | // we need to update the tail pointer |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 524 | else { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 525 | prec->queueEndpoint(NULL); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 526 | if (current == headBulkEndpoint) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 527 | updateBulkHeadED(0); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 528 | headBulkEndpoint = current->nextEndpoint(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 529 | } else if (current == headInterruptEndpoint) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 530 | updateInterruptHeadED(0); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 531 | headInterruptEndpoint = current->nextEndpoint(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 532 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 533 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 534 | // modify tail |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 535 | switch (current->getType()) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 536 | case BULK_ENDPOINT: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 537 | tailBulkEndpoint = prec; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 538 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 539 | case INTERRUPT_ENDPOINT: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 540 | tailInterruptEndpoint = prec; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 541 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 542 | default: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 543 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 544 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 545 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 546 | current->setState(USB_TYPE_FREE); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 547 | return; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 548 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 549 | prec = current; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 550 | current = current->nextEndpoint(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 551 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 552 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 553 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 554 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 555 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 556 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 557 | USBDeviceConnected * USBHost::getDevice(uint8_t index) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 558 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 559 | if ((index >= MAX_DEVICE_CONNECTED) || (!deviceInUse[index])) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 560 | return NULL; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 561 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 562 | return (USBDeviceConnected*)&devices[index]; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 563 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 564 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 565 | // create an USBEndpoint descriptor. the USBEndpoint is not linked |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 566 | USBEndpoint * USBHost::newEndpoint(ENDPOINT_TYPE type, ENDPOINT_DIRECTION dir, uint32_t size, uint8_t addr) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 567 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 568 | int i = 0; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 569 | HCED * ed = (HCED *)getED(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 570 | HCTD* td_list[2] = { (HCTD*)getTD(), (HCTD*)getTD() }; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 571 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 572 | memset((void *)td_list[0], 0x00, sizeof(HCTD)); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 573 | memset((void *)td_list[1], 0x00, sizeof(HCTD)); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 574 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 575 | // search a free USBEndpoint |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 576 | for (i = 0; i < MAX_ENDPOINT; i++) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 577 | if (endpoints[i].getState() == USB_TYPE_FREE) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 578 | endpoints[i].init(ed, type, dir, size, addr, td_list); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 579 | USB_DBG("USBEndpoint created (%p): type: %d, dir: %d, size: %d, addr: %d, state: %s", &endpoints[i], type, dir, size, addr, endpoints[i].getStateString()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 580 | return &endpoints[i]; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 581 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 582 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 583 | USB_ERR("could not allocate more endpoints!!!!"); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 584 | return NULL; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 585 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 586 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 587 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 588 | USB_TYPE USBHost::resetDevice(USBDeviceConnected * dev) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 589 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 590 | int index = findDevice(dev); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 591 | if (index != -1) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 592 | USB_DBG("Resetting hub %d, port %d\n", dev->getHub(), dev->getPort()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 593 | Thread::wait(100); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 594 | if (dev->getHub() == 0) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 595 | resetRootHub(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 596 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 597 | #if MAX_HUB_NB |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 598 | else { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 599 | dev->getHubParent()->portReset(dev->getPort()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 600 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 601 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 602 | Thread::wait(100); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 603 | deviceReset[index] = true; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 604 | return USB_TYPE_OK; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 605 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 606 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 607 | return USB_TYPE_ERROR; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 608 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 609 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 610 | // link the USBEndpoint to the linked list and attach an USBEndpoint to a device |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 611 | bool USBHost::addEndpoint(USBDeviceConnected * dev, uint8_t intf_nb, USBEndpoint * ep) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 612 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 613 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 614 | if (ep == NULL) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 615 | return false; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 616 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 617 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 618 | #ifndef USBHOST_OTHER |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 619 | HCED * prevEd; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 620 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 621 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 622 | // set device address in the USBEndpoint descriptor |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 623 | if (dev == NULL) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 624 | ep->setDeviceAddress(0); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 625 | } else { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 626 | ep->setDeviceAddress(dev->getAddress()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 627 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 628 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 629 | if ((dev != NULL) && dev->getSpeed()) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 630 | ep->setSpeed(dev->getSpeed()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 631 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 632 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 633 | ep->setIntfNb(intf_nb); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 634 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 635 | #ifndef USBHOST_OTHER |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 636 | // queue the new USBEndpoint on the ED list |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 637 | switch (ep->getType()) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 638 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 639 | case CONTROL_ENDPOINT: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 640 | prevEd = ( HCED*) controlHeadED(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 641 | if (!prevEd) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 642 | updateControlHeadED((uint32_t) ep->getHCED()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 643 | USB_DBG_TRANSFER("First control USBEndpoint: %08X", (uint32_t) ep->getHCED()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 644 | headControlEndpoint = ep; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 645 | tailControlEndpoint = ep; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 646 | return true; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 647 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 648 | tailControlEndpoint->queueEndpoint(ep); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 649 | tailControlEndpoint = ep; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 650 | return true; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 651 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 652 | case BULK_ENDPOINT: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 653 | prevEd = ( HCED*) bulkHeadED(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 654 | if (!prevEd) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 655 | updateBulkHeadED((uint32_t) ep->getHCED()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 656 | USB_DBG_TRANSFER("First bulk USBEndpoint: %08X\r\n", (uint32_t) ep->getHCED()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 657 | headBulkEndpoint = ep; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 658 | tailBulkEndpoint = ep; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 659 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 660 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 661 | USB_DBG_TRANSFER("Queue BULK Ed %p after %p\r\n",ep->getHCED(), prevEd); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 662 | tailBulkEndpoint->queueEndpoint(ep); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 663 | tailBulkEndpoint = ep; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 664 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 665 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 666 | case INTERRUPT_ENDPOINT: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 667 | prevEd = ( HCED*) interruptHeadED(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 668 | if (!prevEd) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 669 | updateInterruptHeadED((uint32_t) ep->getHCED()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 670 | USB_DBG_TRANSFER("First interrupt USBEndpoint: %08X\r\n", (uint32_t) ep->getHCED()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 671 | headInterruptEndpoint = ep; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 672 | tailInterruptEndpoint = ep; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 673 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 674 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 675 | USB_DBG_TRANSFER("Queue INTERRUPT Ed %p after %p\r\n",ep->getHCED(), prevEd); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 676 | tailInterruptEndpoint->queueEndpoint(ep); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 677 | tailInterruptEndpoint = ep; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 678 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 679 | default: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 680 | return false; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 681 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 682 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 683 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 684 | ep->dev = dev; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 685 | dev->addEndpoint(intf_nb, ep); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 686 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 687 | return true; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 688 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 689 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 690 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 691 | int USBHost::findDevice(USBDeviceConnected * dev) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 692 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 693 | for (int i = 0; i < MAX_DEVICE_CONNECTED; i++) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 694 | if (dev == &devices[i]) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 695 | return i; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 696 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 697 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 698 | return -1; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 699 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 700 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 701 | int USBHost::findDevice(uint8_t hub, uint8_t port, USBHostHub * hub_parent) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 702 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 703 | for (int i = 0; i < MAX_DEVICE_CONNECTED; i++) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 704 | if (devices[i].getHub() == hub && devices[i].getPort() == port) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 705 | if (hub_parent != NULL) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 706 | if (hub_parent == devices[i].getHubParent()) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 707 | return i; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 708 | } else { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 709 | return i; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 710 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 711 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 712 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 713 | return -1; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 714 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 715 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 716 | void USBHost::printList(ENDPOINT_TYPE type) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 717 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 718 | #if defined(DEBUG_EP_STATE) && !defined(USBHOST_OTHER) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 719 | volatile HCED * hced; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 720 | switch(type) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 721 | case CONTROL_ENDPOINT: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 722 | hced = (HCED *)controlHeadED(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 723 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 724 | case BULK_ENDPOINT: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 725 | hced = (HCED *)bulkHeadED(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 726 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 727 | case INTERRUPT_ENDPOINT: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 728 | hced = (HCED *)interruptHeadED(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 729 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 730 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 731 | volatile HCTD * hctd = NULL; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 732 | const char * type_str = (type == BULK_ENDPOINT) ? "BULK" : |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 733 | ((type == INTERRUPT_ENDPOINT) ? "INTERRUPT" : |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 734 | ((type == CONTROL_ENDPOINT) ? "CONTROL" : "ISOCHRONOUS")); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 735 | printf("State of %s:\r\n", type_str); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 736 | while (hced != NULL) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 737 | uint8_t dir = ((hced->control & (3 << 11)) >> 11); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 738 | printf("hced: %p [ADDR: %d, DIR: %s, EP_NB: 0x%X]\r\n", hced, |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 739 | hced->control & 0x7f, |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 740 | (dir == 1) ? "OUT" : ((dir == 0) ? "FROM_TD":"IN"), |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 741 | (hced->control & (0xf << 7)) >> 7); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 742 | hctd = (HCTD *)((uint32_t)(hced->headTD) & ~(0xf)); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 743 | while (hctd != hced->tailTD) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 744 | printf("\thctd: %p [DIR: %s]\r\n", hctd, ((hctd->control & (3 << 19)) >> 19) == 1 ? "OUT" : "IN"); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 745 | hctd = hctd->nextTD; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 746 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 747 | printf("\thctd: %p\r\n", hctd); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 748 | hced = hced->nextED; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 749 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 750 | printf("\r\n\r\n"); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 751 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 752 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 753 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 754 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 755 | // add a transfer on the TD linked list |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 756 | USB_TYPE USBHost::addTransfer(USBEndpoint * ed, uint8_t * buf, uint32_t len) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 757 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 758 | USB_TYPE ret=USB_TYPE_PROCESSING; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 759 | td_mutex.lock(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 760 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 761 | // allocate a TD which will be freed in TDcompletion |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 762 | volatile HCTD * td = ed->getNextTD(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 763 | if (td == NULL) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 764 | return USB_TYPE_ERROR; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 765 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 766 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 767 | #ifndef USBHOST_OTHER |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 768 | uint32_t token = (ed->isSetup() ? TD_SETUP : ( (ed->getDir() == IN) ? TD_IN : TD_OUT )); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 769 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 770 | uint32_t td_toggle; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 771 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 772 | if (ed->getType() == CONTROL_ENDPOINT) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 773 | if (ed->isSetup()) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 774 | td_toggle = TD_TOGGLE_0; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 775 | } else { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 776 | td_toggle = TD_TOGGLE_1; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 777 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 778 | } else { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 779 | td_toggle = 0; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 780 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 781 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 782 | td->control = (TD_ROUNDING | token | TD_DELAY_INT(0) | td_toggle | TD_CC); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 783 | td->currBufPtr = buf; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 784 | td->bufEnd = (buf + (len - 1)); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 785 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 786 | ENDPOINT_TYPE type = ed->getType(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 787 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 788 | disableList(type); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 789 | ed->queueTransfer(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 790 | printList(type); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 791 | enableList(type); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 792 | #else |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 793 | /* call method specific for endpoint */ |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 794 | td->currBufPtr = buf; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 795 | td->size = len; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 796 | ret = ed->queueTransfer(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 797 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 798 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 799 | td_mutex.unlock(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 800 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 801 | return ret; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 802 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 803 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 804 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 805 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 806 | USB_TYPE USBHost::getDeviceDescriptor(USBDeviceConnected * dev, uint8_t * buf, uint16_t max_len_buf, uint16_t * len_dev_descr) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 807 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 808 | USB_TYPE t = controlRead( dev, |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 809 | USB_DEVICE_TO_HOST | USB_RECIPIENT_DEVICE, |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 810 | GET_DESCRIPTOR, |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 811 | (DEVICE_DESCRIPTOR << 8) | (0), |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 812 | 0, buf, MIN(DEVICE_DESCRIPTOR_LENGTH, max_len_buf)); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 813 | if (len_dev_descr) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 814 | *len_dev_descr = MIN(DEVICE_DESCRIPTOR_LENGTH, max_len_buf); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 815 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 816 | return t; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 817 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 818 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 819 | USB_TYPE USBHost::getConfigurationDescriptor(USBDeviceConnected * dev, uint8_t * buf, uint16_t max_len_buf, uint16_t * len_conf_descr) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 820 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 821 | USB_TYPE res; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 822 | uint16_t total_conf_descr_length = 0; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 823 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 824 | // fourth step: get the beginning of the configuration descriptor to have the total length of the conf descr |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 825 | res = controlRead( dev, |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 826 | USB_DEVICE_TO_HOST | USB_RECIPIENT_DEVICE, |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 827 | GET_DESCRIPTOR, |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 828 | (CONFIGURATION_DESCRIPTOR << 8) | (0), |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 829 | 0, buf, CONFIGURATION_DESCRIPTOR_LENGTH); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 830 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 831 | if (res != USB_TYPE_OK) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 832 | USB_ERR("GET CONF 1 DESCR FAILED"); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 833 | return res; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 834 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 835 | total_conf_descr_length = buf[2] | (buf[3] << 8); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 836 | total_conf_descr_length = MIN(max_len_buf, total_conf_descr_length); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 837 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 838 | if (len_conf_descr) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 839 | *len_conf_descr = total_conf_descr_length; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 840 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 841 | USB_DBG("TOTAL_LENGTH: %d \t NUM_INTERF: %d", total_conf_descr_length, buf[4]); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 842 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 843 | return controlRead( dev, |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 844 | USB_DEVICE_TO_HOST | USB_RECIPIENT_DEVICE, |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 845 | GET_DESCRIPTOR, |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 846 | (CONFIGURATION_DESCRIPTOR << 8) | (0), |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 847 | 0, buf, total_conf_descr_length); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 848 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 849 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 850 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 851 | USB_TYPE USBHost::setAddress(USBDeviceConnected * dev, uint8_t address) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 852 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 853 | return controlWrite( dev, |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 854 | USB_HOST_TO_DEVICE | USB_RECIPIENT_DEVICE, |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 855 | SET_ADDRESS, |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 856 | address, |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 857 | 0, NULL, 0); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 858 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 859 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 860 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 861 | USB_TYPE USBHost::setConfiguration(USBDeviceConnected * dev, uint8_t conf) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 862 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 863 | return controlWrite( dev, |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 864 | USB_HOST_TO_DEVICE | USB_RECIPIENT_DEVICE, |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 865 | SET_CONFIGURATION, |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 866 | conf, |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 867 | 0, NULL, 0); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 868 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 869 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 870 | uint8_t USBHost::numberDriverAttached(USBDeviceConnected * dev) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 871 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 872 | int index = findDevice(dev); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 873 | uint8_t cnt = 0; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 874 | if (index == -1) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 875 | return 0; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 876 | for (uint8_t i = 0; i < MAX_INTF; i++) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 877 | if (deviceAttachedDriver[index][i]) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 878 | cnt++; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 879 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 880 | return cnt; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 881 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 882 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 883 | // enumerate a device with the control USBEndpoint |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 884 | USB_TYPE USBHost::enumerate(USBDeviceConnected * dev, IUSBEnumerator* pEnumerator) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 885 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 886 | uint16_t total_conf_descr_length = 0; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 887 | USB_TYPE res; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 888 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 889 | do { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 890 | Lock lock(this); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 891 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 892 | // don't enumerate a device which all interfaces are registered to a specific driver |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 893 | int index = findDevice(dev); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 894 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 895 | if (index == -1) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 896 | return USB_TYPE_ERROR; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 897 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 898 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 899 | uint8_t nb_intf_attached = numberDriverAttached(dev); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 900 | USB_DBG("dev: %p nb_intf: %d", dev, dev->getNbIntf()); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 901 | USB_DBG("dev: %p nb_intf_attached: %d", dev, nb_intf_attached); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 902 | if ((nb_intf_attached != 0) && (dev->getNbIntf() == nb_intf_attached)) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 903 | USB_DBG("Don't enumerate dev: %p because all intf are registered with a driver", dev); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 904 | return USB_TYPE_OK; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 905 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 906 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 907 | USB_DBG("Enumerate dev: %p", dev); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 908 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 909 | // third step: get the whole device descriptor to see vid, pid |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 910 | res = getDeviceDescriptor(dev, data, DEVICE_DESCRIPTOR_LENGTH); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 911 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 912 | if (res != USB_TYPE_OK) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 913 | USB_DBG("GET DEV DESCR FAILED"); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 914 | return res; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 915 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 916 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 917 | dev->setClass(data[4]); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 918 | dev->setSubClass(data[5]); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 919 | dev->setProtocol(data[6]); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 920 | dev->setVid(data[8] | (data[9] << 8)); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 921 | dev->setPid(data[10] | (data[11] << 8)); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 922 | USB_DBG("CLASS: %02X \t VID: %04X \t PID: %04X", data[4], data[8] | (data[9] << 8), data[10] | (data[11] << 8)); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 923 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 924 | pEnumerator->setVidPid( data[8] | (data[9] << 8), data[10] | (data[11] << 8) ); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 925 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 926 | res = getConfigurationDescriptor(dev, data, sizeof(data), &total_conf_descr_length); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 927 | if (res != USB_TYPE_OK) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 928 | return res; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 929 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 930 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 931 | #if (DEBUG > 3) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 932 | USB_DBG("CONFIGURATION DESCRIPTOR:\r\n"); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 933 | for (int i = 0; i < total_conf_descr_length; i++) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 934 | printf("%02X ", data[i]); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 935 | printf("\r\n\r\n"); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 936 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 937 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 938 | // Parse the configuration descriptor |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 939 | parseConfDescr(dev, data, total_conf_descr_length, pEnumerator); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 940 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 941 | // only set configuration if not enumerated before |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 942 | if (!dev->isEnumerated()) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 943 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 944 | USB_DBG("Set configuration 1 on dev: %p", dev); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 945 | // sixth step: set configuration (only 1 supported) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 946 | res = setConfiguration(dev, 1); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 947 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 948 | if (res != USB_TYPE_OK) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 949 | USB_DBG("SET CONF FAILED"); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 950 | return res; |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 951 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 952 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 953 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 954 | dev->setEnumerated(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 955 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 956 | // Now the device is enumerated! |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 957 | USB_DBG("dev %p is enumerated\r\n", dev); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 958 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 959 | } while(0); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 960 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 961 | // Some devices may require this delay |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 962 | Thread::wait(100); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 963 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 964 | return USB_TYPE_OK; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 965 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 966 | // this method fills the USBDeviceConnected object: class,.... . It also add endpoints found in the descriptor. |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 967 | void USBHost::parseConfDescr(USBDeviceConnected * dev, uint8_t * conf_descr, uint32_t len, IUSBEnumerator* pEnumerator) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 968 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 969 | uint32_t index = 0; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 970 | uint32_t len_desc = 0; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 971 | uint8_t id = 0; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 972 | int nb_endpoints_used = 0; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 973 | USBEndpoint * ep = NULL; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 974 | uint8_t intf_nb = 0; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 975 | bool parsing_intf = false; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 976 | uint8_t current_intf = 0; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 977 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 978 | while (index < len) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 979 | len_desc = conf_descr[index]; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 980 | id = conf_descr[index+1]; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 981 | switch (id) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 982 | case CONFIGURATION_DESCRIPTOR: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 983 | USB_DBG("dev: %p has %d intf", dev, conf_descr[4]); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 984 | dev->setNbIntf(conf_descr[4]); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 985 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 986 | case INTERFACE_DESCRIPTOR: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 987 | if(pEnumerator->parseInterface(conf_descr[index + 2], conf_descr[index + 5], conf_descr[index + 6], conf_descr[index + 7])) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 988 | if (intf_nb++ <= MAX_INTF) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 989 | current_intf = conf_descr[index + 2]; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 990 | dev->addInterface(current_intf, conf_descr[index + 5], conf_descr[index + 6], conf_descr[index + 7]); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 991 | nb_endpoints_used = 0; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 992 | USB_DBG("ADD INTF %d on device %p: class: %d, subclass: %d, proto: %d", current_intf, dev, conf_descr[index + 5],conf_descr[index + 6],conf_descr[index + 7]); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 993 | } else { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 994 | USB_DBG("Drop intf..."); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 995 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 996 | parsing_intf = true; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 997 | } else { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 998 | parsing_intf = false; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 999 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1000 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1001 | case ENDPOINT_DESCRIPTOR: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1002 | if (parsing_intf && (intf_nb <= MAX_INTF) ) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1003 | if (nb_endpoints_used < MAX_ENDPOINT_PER_INTERFACE) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1004 | if( pEnumerator->useEndpoint(current_intf, (ENDPOINT_TYPE)(conf_descr[index + 3] & 0x03), (ENDPOINT_DIRECTION)((conf_descr[index + 2] >> 7) + 1)) ) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1005 | // if the USBEndpoint is isochronous -> skip it (TODO: fix this) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1006 | if ((conf_descr[index + 3] & 0x03) != ISOCHRONOUS_ENDPOINT) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1007 | ep = newEndpoint((ENDPOINT_TYPE)(conf_descr[index+3] & 0x03), |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1008 | (ENDPOINT_DIRECTION)((conf_descr[index + 2] >> 7) + 1), |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1009 | conf_descr[index + 4] | (conf_descr[index + 5] << 8), |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1010 | conf_descr[index + 2] & 0x0f); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1011 | USB_DBG("ADD USBEndpoint %p, on interf %d on device %p", ep, current_intf, dev); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1012 | if (ep != NULL && dev != NULL) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1013 | addEndpoint(dev, current_intf, ep); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1014 | } else { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1015 | USB_DBG("EP NULL"); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1016 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1017 | nb_endpoints_used++; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1018 | } else { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1019 | USB_DBG("ISO USBEndpoint NOT SUPPORTED"); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1020 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1021 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1022 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1023 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1024 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1025 | case HID_DESCRIPTOR: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1026 | lenReportDescr = conf_descr[index + 7] | (conf_descr[index + 8] << 8); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1027 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1028 | default: |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1029 | break; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1030 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1031 | index += len_desc; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1032 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1033 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1034 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1035 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1036 | USB_TYPE USBHost::bulkWrite(USBDeviceConnected * dev, USBEndpoint * ep, uint8_t * buf, uint32_t len, bool blocking) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1037 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1038 | return generalTransfer(dev, ep, buf, len, blocking, BULK_ENDPOINT, true); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1039 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1040 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1041 | USB_TYPE USBHost::bulkRead(USBDeviceConnected * dev, USBEndpoint * ep, uint8_t * buf, uint32_t len, bool blocking) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1042 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1043 | return generalTransfer(dev, ep, buf, len, blocking, BULK_ENDPOINT, false); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1044 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1045 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1046 | USB_TYPE USBHost::interruptWrite(USBDeviceConnected * dev, USBEndpoint * ep, uint8_t * buf, uint32_t len, bool blocking) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1047 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1048 | return generalTransfer(dev, ep, buf, len, blocking, INTERRUPT_ENDPOINT, true); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1049 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1050 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1051 | USB_TYPE USBHost::interruptRead(USBDeviceConnected * dev, USBEndpoint * ep, uint8_t * buf, uint32_t len, bool blocking) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1052 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1053 | return generalTransfer(dev, ep, buf, len, blocking, INTERRUPT_ENDPOINT, false); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1054 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1055 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1056 | USB_TYPE USBHost::generalTransfer(USBDeviceConnected * dev, USBEndpoint * ep, uint8_t * buf, uint32_t len, bool blocking, ENDPOINT_TYPE type, bool write) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1057 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1058 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1059 | #if DEBUG_TRANSFER |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1060 | const char * type_str = (type == BULK_ENDPOINT) ? "BULK" : ((type == INTERRUPT_ENDPOINT) ? "INTERRUPT" : "ISOCHRONOUS"); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1061 | USB_DBG_TRANSFER("----- %s %s [dev: %p - %s - hub: %d - port: %d - addr: %d - ep: %02X]------", type_str, (write) ? "WRITE" : "READ", dev, dev->getName(ep->getIntfNb()), dev->getHub(), dev->getPort(), dev->getAddress(), ep->getAddress()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1062 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1063 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1064 | Lock lock(this); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1065 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1066 | USB_TYPE res; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1067 | ENDPOINT_DIRECTION dir = (write) ? OUT : IN; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1068 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1069 | if (dev == NULL) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1070 | USB_ERR("dev NULL"); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1071 | return USB_TYPE_ERROR; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1072 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1073 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1074 | if (ep == NULL) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1075 | USB_ERR("ep NULL"); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1076 | return USB_TYPE_ERROR; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1077 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1078 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1079 | if (ep->getState() != USB_TYPE_IDLE) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1080 | USB_WARN("[ep: %p - dev: %p - %s] NOT IDLE: %s", ep, ep->dev, ep->dev->getName(ep->getIntfNb()), ep->getStateString()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1081 | return ep->getState(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1082 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1083 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1084 | if ((ep->getDir() != dir) || (ep->getType() != type)) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1085 | USB_ERR("[ep: %p - dev: %p] wrong dir or bad USBEndpoint type", ep, ep->dev); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1086 | return USB_TYPE_ERROR; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1087 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1088 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1089 | if (dev->getAddress() != ep->getDeviceAddress()) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1090 | USB_ERR("[ep: %p - dev: %p] USBEndpoint addr and device addr don't match", ep, ep->dev); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1091 | return USB_TYPE_ERROR; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1092 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1093 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1094 | #if DEBUG_TRANSFER |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1095 | if (write) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1096 | USB_DBG_TRANSFER("%s WRITE buffer", type_str); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1097 | for (int i = 0; i < ep->getLengthTransferred(); i++) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1098 | printf("%02X ", buf[i]); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1099 | printf("\r\n\r\n"); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1100 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1101 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1102 | res = addTransfer(ep, buf, len); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1103 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1104 | if ((blocking)&& (res == USB_TYPE_PROCESSING)) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1105 | #ifdef USBHOST_OTHER |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1106 | osEvent event = ep->ep_queue.get(TD_TIMEOUT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1107 | if (event.status == osEventTimeout) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1108 | { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1109 | /* control endpoint is confusing for merge on b */ |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1110 | disableList(CONTROL_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1111 | ep->setState(USB_TYPE_ERROR); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1112 | ep->ep_queue.get(0); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1113 | ep->unqueueTransfer(ep->getProcessedTD()); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1114 | enableList(CONTROL_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1115 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1116 | #else |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1117 | ep->ep_queue.get(); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1118 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1119 | res = ep->getState(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1120 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1121 | USB_DBG_TRANSFER("%s TRANSFER res: %s on ep: %p\r\n", type_str, ep->getStateString(), ep); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1122 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1123 | if (res != USB_TYPE_IDLE) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1124 | return res; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1125 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1126 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1127 | return USB_TYPE_OK; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1128 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1129 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1130 | return res; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1131 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1132 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1133 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1134 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1135 | USB_TYPE USBHost::controlRead(USBDeviceConnected * dev, uint8_t requestType, uint8_t request, uint32_t value, uint32_t index, uint8_t * buf, uint32_t len) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1136 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1137 | return controlTransfer(dev, requestType, request, value, index, buf, len, false); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1138 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1139 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1140 | USB_TYPE USBHost::controlWrite(USBDeviceConnected * dev, uint8_t requestType, uint8_t request, uint32_t value, uint32_t index, uint8_t * buf, uint32_t len) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1141 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1142 | return controlTransfer(dev, requestType, request, value, index, buf, len, true); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1143 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1144 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1145 | USB_TYPE USBHost::controlTransfer(USBDeviceConnected * dev, uint8_t requestType, uint8_t request, uint32_t value, uint32_t index, uint8_t * buf, uint32_t len, bool write) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1146 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1147 | Lock lock(this); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1148 | USB_DBG_TRANSFER("----- CONTROL %s [dev: %p - hub: %d - port: %d] ------", (write) ? "WRITE" : "READ", dev, dev->getHub(), dev->getPort()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1149 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1150 | int length_transfer = len; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1151 | USB_TYPE res; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1152 | uint32_t token; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1153 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1154 | control->setSpeed(dev->getSpeed()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1155 | control->setSize(dev->getSizeControlEndpoint()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1156 | if (dev->isActiveAddress()) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1157 | control->setDeviceAddress(dev->getAddress()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1158 | } else { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1159 | control->setDeviceAddress(0); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1160 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1161 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1162 | USB_DBG_TRANSFER("Control transfer on device: %d\r\n", control->getDeviceAddress()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1163 | fillControlBuf(requestType, request, value, index, len); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1164 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1165 | #if DEBUG_TRANSFER |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1166 | USB_DBG_TRANSFER("SETUP PACKET: "); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1167 | for (int i = 0; i < 8; i++) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1168 | printf("%01X ", setupPacket[i]); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1169 | printf("\r\n"); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1170 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1171 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1172 | control->setNextToken(TD_SETUP); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1173 | res = addTransfer(control, (uint8_t*)setupPacket, 8); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1174 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1175 | if (res == USB_TYPE_PROCESSING) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1176 | #ifdef USBHOST_OTHER |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1177 | { osEvent event = control->ep_queue.get(TD_TIMEOUT_CTRL); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1178 | if (event.status == osEventTimeout) { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1179 | disableList(CONTROL_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1180 | control->setState(USB_TYPE_ERROR); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1181 | control->ep_queue.get(0); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1182 | control->unqueueTransfer(control->getProcessedTD()); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1183 | enableList(CONTROL_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1184 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1185 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1186 | #else |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1187 | control->ep_queue.get(); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1188 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1189 | res = control->getState(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1190 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1191 | USB_DBG_TRANSFER("CONTROL setup stage %s", control->getStateString()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1192 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1193 | if (res != USB_TYPE_IDLE) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1194 | return res; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1195 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1196 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1197 | if (length_transfer) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1198 | token = (write) ? TD_OUT : TD_IN; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1199 | control->setNextToken(token); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1200 | res = addTransfer(control, (uint8_t *)buf, length_transfer); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1201 | |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1202 | if (res == USB_TYPE_PROCESSING) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1203 | #ifdef USBHOST_OTHER |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1204 | { osEvent event = control->ep_queue.get(TD_TIMEOUT_CTRL); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1205 | if (event.status == osEventTimeout) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1206 | { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1207 | disableList(CONTROL_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1208 | control->setState(USB_TYPE_ERROR); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1209 | control->ep_queue.get(0); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1210 | control->unqueueTransfer(control->getProcessedTD()); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1211 | enableList(CONTROL_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1212 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1213 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1214 | #else |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1215 | control->ep_queue.get(); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1216 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1217 | res = control->getState(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1218 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1219 | #if DEBUG_TRANSFER |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1220 | USB_DBG_TRANSFER("CONTROL %s stage %s", (write) ? "WRITE" : "READ", control->getStateString()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1221 | if (write) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1222 | USB_DBG_TRANSFER("CONTROL WRITE buffer"); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1223 | for (int i = 0; i < control->getLengthTransferred(); i++) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1224 | printf("%02X ", buf[i]); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1225 | printf("\r\n\r\n"); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1226 | } else { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1227 | USB_DBG_TRANSFER("CONTROL READ SUCCESS [%d bytes transferred]", control->getLengthTransferred()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1228 | for (int i = 0; i < control->getLengthTransferred(); i++) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1229 | printf("%02X ", buf[i]); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1230 | printf("\r\n\r\n"); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1231 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1232 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1233 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1234 | if (res != USB_TYPE_IDLE) { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1235 | return res; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1236 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1237 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1238 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1239 | token = (write) ? TD_IN : TD_OUT; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1240 | control->setNextToken(token); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1241 | res = addTransfer(control, NULL, 0); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1242 | if (res == USB_TYPE_PROCESSING) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1243 | #ifdef USBHOST_OTHER |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1244 | { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1245 | osEvent event = control->ep_queue.get(TD_TIMEOUT_CTRL); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1246 | if (event.status == osEventTimeout) |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1247 | { |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1248 | disableList(CONTROL_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1249 | control->setState(USB_TYPE_ERROR); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1250 | control->ep_queue.get(0); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1251 | control->unqueueTransfer(control->getProcessedTD()); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1252 | enableList(CONTROL_ENDPOINT); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1253 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1254 | } |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1255 | #else |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1256 | control->ep_queue.get(); |
frq08711@LMECWL0871.LME.ST.COM | 5:fc157e6bd5a5 | 1257 | #endif |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1258 | res = control->getState(); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1259 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1260 | USB_DBG_TRANSFER("CONTROL ack stage %s", control->getStateString()); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1261 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1262 | if (res != USB_TYPE_IDLE) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1263 | return res; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1264 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1265 | return USB_TYPE_OK; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1266 | } |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1267 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1268 | |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1269 | void USBHost::fillControlBuf(uint8_t requestType, uint8_t request, uint16_t value, uint16_t index, int len) |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1270 | { |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1271 | setupPacket[0] = requestType; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1272 | setupPacket[1] = request; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1273 | setupPacket[2] = (uint8_t) value; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1274 | setupPacket[3] = (uint8_t) (value >> 8); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1275 | setupPacket[4] = (uint8_t) index; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1276 | setupPacket[5] = (uint8_t) (index >> 8); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1277 | setupPacket[6] = (uint8_t) len; |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1278 | setupPacket[7] = (uint8_t) (len >> 8); |
frq08711@LMECWL0871.LME.ST.COM | 1:ab240722d7ef | 1279 | } |