Team_PjL / USBHost_F769NI

only for STM32F769NI-DISCOVERY, porting from mbed OS5 unsupport functions

USBHostHub/USBHostHub.cpp@0:dae1ac0c0a7b, 2019-08-07 (annotated)

Committer:
kenjiArai
Date:
Wed Aug 07 05:33:53 2019 +0000
Revision:
0:dae1ac0c0a7b
only for STM32F769NI-DISCOVERY, porting from mbed OS5 unsupport functions

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kenjiArai 0:dae1ac0c0a7b 1 /* mbed USBHost Library
kenjiArai 0:dae1ac0c0a7b 2 * Copyright (c) 2006-2013 ARM Limited
kenjiArai 0:dae1ac0c0a7b 3 *
kenjiArai 0:dae1ac0c0a7b 4 * Licensed under the Apache License, Version 2.0 (the "License");
kenjiArai 0:dae1ac0c0a7b 5 * you may not use this file except in compliance with the License.
kenjiArai 0:dae1ac0c0a7b 6 * You may obtain a copy of the License at
kenjiArai 0:dae1ac0c0a7b 7 *
kenjiArai 0:dae1ac0c0a7b 8 * http://www.apache.org/licenses/LICENSE-2.0
kenjiArai 0:dae1ac0c0a7b 9 *
kenjiArai 0:dae1ac0c0a7b 10 * Unless required by applicable law or agreed to in writing, software
kenjiArai 0:dae1ac0c0a7b 11 * distributed under the License is distributed on an "AS IS" BASIS,
kenjiArai 0:dae1ac0c0a7b 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
kenjiArai 0:dae1ac0c0a7b 13 * See the License for the specific language governing permissions and
kenjiArai 0:dae1ac0c0a7b 14 * limitations under the License.
kenjiArai 0:dae1ac0c0a7b 15 */
kenjiArai 0:dae1ac0c0a7b 16
kenjiArai 0:dae1ac0c0a7b 17 #include "USBHostHub.h"
kenjiArai 0:dae1ac0c0a7b 18
kenjiArai 0:dae1ac0c0a7b 19 #if MAX_HUB_NB
kenjiArai 0:dae1ac0c0a7b 20
kenjiArai 0:dae1ac0c0a7b 21 #include "USBHost.h"
kenjiArai 0:dae1ac0c0a7b 22 #include "dbg.h"
kenjiArai 0:dae1ac0c0a7b 23
kenjiArai 0:dae1ac0c0a7b 24 #define GET_STATUS 0x00
kenjiArai 0:dae1ac0c0a7b 25 #define CLEAR_FEATURE 0x01
kenjiArai 0:dae1ac0c0a7b 26 #define GET_STATE 0x02
kenjiArai 0:dae1ac0c0a7b 27 #define SET_FEATURE 0x03
kenjiArai 0:dae1ac0c0a7b 28 #define GET_DESCRIPTOR 0x06
kenjiArai 0:dae1ac0c0a7b 29
kenjiArai 0:dae1ac0c0a7b 30 #define PORT_CONNECTION_FEATURE (0x00)
kenjiArai 0:dae1ac0c0a7b 31 #define PORT_ENABLE_FEATURE (0x01)
kenjiArai 0:dae1ac0c0a7b 32 #define PORT_RESET_FEATURE (0x04)
kenjiArai 0:dae1ac0c0a7b 33 #define PORT_POWER_FEATURE (0x08)
kenjiArai 0:dae1ac0c0a7b 34
kenjiArai 0:dae1ac0c0a7b 35 #define C_PORT_CONNECTION_FEATURE (16)
kenjiArai 0:dae1ac0c0a7b 36 #define C_PORT_ENABLE_FEATURE (17)
kenjiArai 0:dae1ac0c0a7b 37 #define C_PORT_RESET_FEATURE (20)
kenjiArai 0:dae1ac0c0a7b 38
kenjiArai 0:dae1ac0c0a7b 39 #define PORT_CONNECTION (1 << 0)
kenjiArai 0:dae1ac0c0a7b 40 #define PORT_ENABLE (1 << 1)
kenjiArai 0:dae1ac0c0a7b 41 #define PORT_SUSPEND (1 << 2)
kenjiArai 0:dae1ac0c0a7b 42 #define PORT_OVER_CURRENT (1 << 3)
kenjiArai 0:dae1ac0c0a7b 43 #define PORT_RESET (1 << 4)
kenjiArai 0:dae1ac0c0a7b 44 #define PORT_POWER (1 << 8)
kenjiArai 0:dae1ac0c0a7b 45 #define PORT_LOW_SPEED (1 << 9)
kenjiArai 0:dae1ac0c0a7b 46
kenjiArai 0:dae1ac0c0a7b 47 #define C_PORT_CONNECTION (1 << 16)
kenjiArai 0:dae1ac0c0a7b 48 #define C_PORT_ENABLE (1 << 17)
kenjiArai 0:dae1ac0c0a7b 49 #define C_PORT_SUSPEND (1 << 18)
kenjiArai 0:dae1ac0c0a7b 50 #define C_PORT_OVER_CURRENT (1 << 19)
kenjiArai 0:dae1ac0c0a7b 51 #define C_PORT_RESET (1 << 20)
kenjiArai 0:dae1ac0c0a7b 52
kenjiArai 0:dae1ac0c0a7b 53 USBHostHub::USBHostHub()
kenjiArai 0:dae1ac0c0a7b 54 {
kenjiArai 0:dae1ac0c0a7b 55 host = NULL;
kenjiArai 0:dae1ac0c0a7b 56 init();
kenjiArai 0:dae1ac0c0a7b 57 }
kenjiArai 0:dae1ac0c0a7b 58
kenjiArai 0:dae1ac0c0a7b 59 void USBHostHub::init()
kenjiArai 0:dae1ac0c0a7b 60 {
kenjiArai 0:dae1ac0c0a7b 61 dev_connected = false;
kenjiArai 0:dae1ac0c0a7b 62 dev = NULL;
kenjiArai 0:dae1ac0c0a7b 63 int_in = NULL;
kenjiArai 0:dae1ac0c0a7b 64 dev_connected = false;
kenjiArai 0:dae1ac0c0a7b 65 hub_intf = -1;
kenjiArai 0:dae1ac0c0a7b 66 hub_device_found = false;
kenjiArai 0:dae1ac0c0a7b 67 nb_port = 0;
kenjiArai 0:dae1ac0c0a7b 68 hub_characteristics = 0;
kenjiArai 0:dae1ac0c0a7b 69
kenjiArai 0:dae1ac0c0a7b 70 for (int i = 0; i < MAX_HUB_PORT; i++) {
kenjiArai 0:dae1ac0c0a7b 71 device_children[i] = NULL;
kenjiArai 0:dae1ac0c0a7b 72 }
kenjiArai 0:dae1ac0c0a7b 73 }
kenjiArai 0:dae1ac0c0a7b 74
kenjiArai 0:dae1ac0c0a7b 75 void USBHostHub::setHost(USBHost * host_)
kenjiArai 0:dae1ac0c0a7b 76 {
kenjiArai 0:dae1ac0c0a7b 77 host = host_;
kenjiArai 0:dae1ac0c0a7b 78 }
kenjiArai 0:dae1ac0c0a7b 79
kenjiArai 0:dae1ac0c0a7b 80 bool USBHostHub::connected()
kenjiArai 0:dae1ac0c0a7b 81 {
kenjiArai 0:dae1ac0c0a7b 82 return dev_connected;
kenjiArai 0:dae1ac0c0a7b 83 }
kenjiArai 0:dae1ac0c0a7b 84
kenjiArai 0:dae1ac0c0a7b 85 bool USBHostHub::connect(USBDeviceConnected * dev)
kenjiArai 0:dae1ac0c0a7b 86 {
kenjiArai 0:dae1ac0c0a7b 87 if (dev_connected) {
kenjiArai 0:dae1ac0c0a7b 88 return true;
kenjiArai 0:dae1ac0c0a7b 89 }
kenjiArai 0:dae1ac0c0a7b 90
kenjiArai 0:dae1ac0c0a7b 91 if(host->enumerate(dev, this)) {
kenjiArai 0:dae1ac0c0a7b 92 init();
kenjiArai 0:dae1ac0c0a7b 93 return false;
kenjiArai 0:dae1ac0c0a7b 94 }
kenjiArai 0:dae1ac0c0a7b 95
kenjiArai 0:dae1ac0c0a7b 96 if (hub_device_found) {
kenjiArai 0:dae1ac0c0a7b 97 this->dev = dev;
kenjiArai 0:dae1ac0c0a7b 98
kenjiArai 0:dae1ac0c0a7b 99 int_in = dev->getEndpoint(hub_intf, INTERRUPT_ENDPOINT, IN);
kenjiArai 0:dae1ac0c0a7b 100
kenjiArai 0:dae1ac0c0a7b 101 if (!int_in) {
kenjiArai 0:dae1ac0c0a7b 102 init();
kenjiArai 0:dae1ac0c0a7b 103 return false;
kenjiArai 0:dae1ac0c0a7b 104 }
kenjiArai 0:dae1ac0c0a7b 105
kenjiArai 0:dae1ac0c0a7b 106 USB_INFO("New HUB: VID:%04x PID:%04x [dev: %p - intf: %d]", dev->getVid(), dev->getPid(), dev, hub_intf);
kenjiArai 0:dae1ac0c0a7b 107 dev->setName("Hub", hub_intf);
kenjiArai 0:dae1ac0c0a7b 108 host->registerDriver(dev, hub_intf, this, &USBHostHub::disconnect);
kenjiArai 0:dae1ac0c0a7b 109
kenjiArai 0:dae1ac0c0a7b 110 int_in->attach(this, &USBHostHub::rxHandler);
kenjiArai 0:dae1ac0c0a7b 111
kenjiArai 0:dae1ac0c0a7b 112 // get HUB descriptor
kenjiArai 0:dae1ac0c0a7b 113 host->controlRead( dev,
kenjiArai 0:dae1ac0c0a7b 114 USB_DEVICE_TO_HOST | USB_REQUEST_TYPE_CLASS,
kenjiArai 0:dae1ac0c0a7b 115 GET_DESCRIPTOR,
kenjiArai 0:dae1ac0c0a7b 116 0x29 << 8, 0, buf, sizeof(HubDescriptor));
kenjiArai 0:dae1ac0c0a7b 117 nb_port = buf[2];
kenjiArai 0:dae1ac0c0a7b 118 hub_characteristics = buf[3];
kenjiArai 0:dae1ac0c0a7b 119
kenjiArai 0:dae1ac0c0a7b 120 USB_DBG("Hub has %d port", nb_port);
kenjiArai 0:dae1ac0c0a7b 121
kenjiArai 0:dae1ac0c0a7b 122 for (uint8_t j = 1; j <= nb_port; j++) {
kenjiArai 0:dae1ac0c0a7b 123 setPortFeature(PORT_POWER_FEATURE, j);
kenjiArai 0:dae1ac0c0a7b 124 }
kenjiArai 0:dae1ac0c0a7b 125 wait_ms(buf[5]*2);
kenjiArai 0:dae1ac0c0a7b 126
kenjiArai 0:dae1ac0c0a7b 127 host->interruptRead(dev, int_in, buf, 1, false);
kenjiArai 0:dae1ac0c0a7b 128 dev_connected = true;
kenjiArai 0:dae1ac0c0a7b 129 return true;
kenjiArai 0:dae1ac0c0a7b 130 }
kenjiArai 0:dae1ac0c0a7b 131
kenjiArai 0:dae1ac0c0a7b 132 return false;
kenjiArai 0:dae1ac0c0a7b 133 }
kenjiArai 0:dae1ac0c0a7b 134
kenjiArai 0:dae1ac0c0a7b 135 void USBHostHub::disconnect()
kenjiArai 0:dae1ac0c0a7b 136 {
kenjiArai 0:dae1ac0c0a7b 137 init();
kenjiArai 0:dae1ac0c0a7b 138 }
kenjiArai 0:dae1ac0c0a7b 139
kenjiArai 0:dae1ac0c0a7b 140 /*virtual*/ void USBHostHub::setVidPid(uint16_t vid, uint16_t pid)
kenjiArai 0:dae1ac0c0a7b 141 {
kenjiArai 0:dae1ac0c0a7b 142 // we don't check VID/PID for MSD driver
kenjiArai 0:dae1ac0c0a7b 143 }
kenjiArai 0:dae1ac0c0a7b 144
kenjiArai 0:dae1ac0c0a7b 145 /*virtual*/ bool USBHostHub::parseInterface(uint8_t intf_nb, uint8_t intf_class, uint8_t intf_subclass, uint8_t intf_protocol) //Must return true if the interface should be parsed
kenjiArai 0:dae1ac0c0a7b 146 {
kenjiArai 0:dae1ac0c0a7b 147 if ((hub_intf == -1) &&
kenjiArai 0:dae1ac0c0a7b 148 (intf_class == HUB_CLASS) &&
kenjiArai 0:dae1ac0c0a7b 149 (intf_subclass == 0) &&
kenjiArai 0:dae1ac0c0a7b 150 (intf_protocol == 0)) {
kenjiArai 0:dae1ac0c0a7b 151 hub_intf = intf_nb;
kenjiArai 0:dae1ac0c0a7b 152 return true;
kenjiArai 0:dae1ac0c0a7b 153 }
kenjiArai 0:dae1ac0c0a7b 154 return false;
kenjiArai 0:dae1ac0c0a7b 155 }
kenjiArai 0:dae1ac0c0a7b 156
kenjiArai 0:dae1ac0c0a7b 157 /*virtual*/ bool USBHostHub::useEndpoint(uint8_t intf_nb, ENDPOINT_TYPE type, ENDPOINT_DIRECTION dir) //Must return true if the endpoint will be used
kenjiArai 0:dae1ac0c0a7b 158 {
kenjiArai 0:dae1ac0c0a7b 159 if (intf_nb == hub_intf) {
kenjiArai 0:dae1ac0c0a7b 160 if ((type == INTERRUPT_ENDPOINT) && (dir == IN)) {
kenjiArai 0:dae1ac0c0a7b 161 hub_device_found = true;
kenjiArai 0:dae1ac0c0a7b 162 return true;
kenjiArai 0:dae1ac0c0a7b 163 }
kenjiArai 0:dae1ac0c0a7b 164 }
kenjiArai 0:dae1ac0c0a7b 165 return false;
kenjiArai 0:dae1ac0c0a7b 166 }
kenjiArai 0:dae1ac0c0a7b 167
kenjiArai 0:dae1ac0c0a7b 168 void USBHostHub::deviceConnected(USBDeviceConnected * dev)
kenjiArai 0:dae1ac0c0a7b 169 {
kenjiArai 0:dae1ac0c0a7b 170 device_children[dev->getPort() - 1] = dev;
kenjiArai 0:dae1ac0c0a7b 171 }
kenjiArai 0:dae1ac0c0a7b 172
kenjiArai 0:dae1ac0c0a7b 173 void USBHostHub::deviceDisconnected(USBDeviceConnected * dev)
kenjiArai 0:dae1ac0c0a7b 174 {
kenjiArai 0:dae1ac0c0a7b 175 device_children[dev->getPort() - 1] = NULL;
kenjiArai 0:dae1ac0c0a7b 176 }
kenjiArai 0:dae1ac0c0a7b 177
kenjiArai 0:dae1ac0c0a7b 178 void USBHostHub::hubDisconnected()
kenjiArai 0:dae1ac0c0a7b 179 {
kenjiArai 0:dae1ac0c0a7b 180 for (uint8_t i = 0; i < MAX_HUB_PORT; i++) {
kenjiArai 0:dae1ac0c0a7b 181 if (device_children[i] != NULL) {
kenjiArai 0:dae1ac0c0a7b 182 host->freeDevice(device_children[i]);
kenjiArai 0:dae1ac0c0a7b 183 }
kenjiArai 0:dae1ac0c0a7b 184 }
kenjiArai 0:dae1ac0c0a7b 185 }
kenjiArai 0:dae1ac0c0a7b 186
kenjiArai 0:dae1ac0c0a7b 187 void USBHostHub::rxHandler()
kenjiArai 0:dae1ac0c0a7b 188 {
kenjiArai 0:dae1ac0c0a7b 189 uint32_t status;
kenjiArai 0:dae1ac0c0a7b 190 if (int_in) {
kenjiArai 0:dae1ac0c0a7b 191 if ((int_in->getLengthTransferred())&&(int_in->getState() == USB_TYPE_IDLE)) {
kenjiArai 0:dae1ac0c0a7b 192 for (int port = 1; port <= nb_port; port++) {
kenjiArai 0:dae1ac0c0a7b 193 status = getPortStatus(port);
kenjiArai 0:dae1ac0c0a7b 194 USB_DBG("[hub handler hub: %d] status port %d [hub: %p]: 0x%X", dev->getHub(), port, dev, status);
kenjiArai 0:dae1ac0c0a7b 195
kenjiArai 0:dae1ac0c0a7b 196 // if connection status has changed
kenjiArai 0:dae1ac0c0a7b 197 if (status & C_PORT_CONNECTION) {
kenjiArai 0:dae1ac0c0a7b 198 if (status & PORT_CONNECTION) {
kenjiArai 0:dae1ac0c0a7b 199 USB_DBG("[hub handler hub: %d - port: %d] new device connected", dev->getHub(), port);
kenjiArai 0:dae1ac0c0a7b 200 host->deviceConnected(dev->getHub() + 1, port, status & PORT_LOW_SPEED, this);
kenjiArai 0:dae1ac0c0a7b 201 } else {
kenjiArai 0:dae1ac0c0a7b 202 USB_DBG("[hub handler hub: %d - port: %d] device disconnected", dev->getHub(), port);
kenjiArai 0:dae1ac0c0a7b 203 host->deviceDisconnected(dev->getHub() + 1, port, this, 0);
kenjiArai 0:dae1ac0c0a7b 204 }
kenjiArai 0:dae1ac0c0a7b 205
kenjiArai 0:dae1ac0c0a7b 206 clearPortFeature(C_PORT_CONNECTION_FEATURE, port);
kenjiArai 0:dae1ac0c0a7b 207 }
kenjiArai 0:dae1ac0c0a7b 208
kenjiArai 0:dae1ac0c0a7b 209 if (status & C_PORT_RESET) {
kenjiArai 0:dae1ac0c0a7b 210 clearPortFeature(C_PORT_RESET_FEATURE, port);
kenjiArai 0:dae1ac0c0a7b 211 }
kenjiArai 0:dae1ac0c0a7b 212
kenjiArai 0:dae1ac0c0a7b 213 if (status & C_PORT_ENABLE) {
kenjiArai 0:dae1ac0c0a7b 214 clearPortFeature(C_PORT_ENABLE_FEATURE, port);
kenjiArai 0:dae1ac0c0a7b 215 }
kenjiArai 0:dae1ac0c0a7b 216
kenjiArai 0:dae1ac0c0a7b 217 if ((status & PORT_OVER_CURRENT)) {
kenjiArai 0:dae1ac0c0a7b 218 USB_ERR("OVER CURRENT DETECTED\r\n");
kenjiArai 0:dae1ac0c0a7b 219 clearPortFeature(PORT_OVER_CURRENT, port);
kenjiArai 0:dae1ac0c0a7b 220 host->deviceDisconnected(dev->getHub() + 1, port, this, 0);
kenjiArai 0:dae1ac0c0a7b 221 }
kenjiArai 0:dae1ac0c0a7b 222 }
kenjiArai 0:dae1ac0c0a7b 223 }
kenjiArai 0:dae1ac0c0a7b 224 host->interruptRead(dev, int_in, buf, 1, false);
kenjiArai 0:dae1ac0c0a7b 225 }
kenjiArai 0:dae1ac0c0a7b 226 }
kenjiArai 0:dae1ac0c0a7b 227
kenjiArai 0:dae1ac0c0a7b 228 void USBHostHub::portReset(uint8_t port)
kenjiArai 0:dae1ac0c0a7b 229 {
kenjiArai 0:dae1ac0c0a7b 230 // reset port
kenjiArai 0:dae1ac0c0a7b 231 uint32_t status;
kenjiArai 0:dae1ac0c0a7b 232 USB_DBG("reset port %d on hub: %p [this: %p]", port, dev, this)
kenjiArai 0:dae1ac0c0a7b 233 setPortFeature(PORT_RESET_FEATURE, port);
kenjiArai 0:dae1ac0c0a7b 234 #if defined(TARGET_RZ_A1H)
kenjiArai 0:dae1ac0c0a7b 235 ThisThread::sleep_for(50); // Reset release waiting for Hi-Speed check.
kenjiArai 0:dae1ac0c0a7b 236 #endif
kenjiArai 0:dae1ac0c0a7b 237 while(1) {
kenjiArai 0:dae1ac0c0a7b 238 status = getPortStatus(port);
kenjiArai 0:dae1ac0c0a7b 239 /* disconnection since reset request */
kenjiArai 0:dae1ac0c0a7b 240 if (!(status & PORT_CONNECTION)) {
kenjiArai 0:dae1ac0c0a7b 241 break;
kenjiArai 0:dae1ac0c0a7b 242 }
kenjiArai 0:dae1ac0c0a7b 243 if (status & (PORT_ENABLE | PORT_RESET)) {
kenjiArai 0:dae1ac0c0a7b 244 break;
kenjiArai 0:dae1ac0c0a7b 245 }
kenjiArai 0:dae1ac0c0a7b 246 if (status & PORT_OVER_CURRENT) {
kenjiArai 0:dae1ac0c0a7b 247 USB_ERR("OVER CURRENT DETECTED\r\n");
kenjiArai 0:dae1ac0c0a7b 248 clearPortFeature(PORT_OVER_CURRENT, port);
kenjiArai 0:dae1ac0c0a7b 249 host->deviceDisconnected(dev->getHub() + 1, port, this, 0);
kenjiArai 0:dae1ac0c0a7b 250 break;
kenjiArai 0:dae1ac0c0a7b 251 }
kenjiArai 0:dae1ac0c0a7b 252 ThisThread::sleep_for(10);
kenjiArai 0:dae1ac0c0a7b 253 }
kenjiArai 0:dae1ac0c0a7b 254 }
kenjiArai 0:dae1ac0c0a7b 255
kenjiArai 0:dae1ac0c0a7b 256 void USBHostHub::setPortFeature(uint32_t feature, uint8_t port)
kenjiArai 0:dae1ac0c0a7b 257 {
kenjiArai 0:dae1ac0c0a7b 258 host->controlWrite( dev,
kenjiArai 0:dae1ac0c0a7b 259 USB_HOST_TO_DEVICE | USB_REQUEST_TYPE_CLASS | USB_RECIPIENT_INTERFACE | USB_RECIPIENT_ENDPOINT,
kenjiArai 0:dae1ac0c0a7b 260 SET_FEATURE,
kenjiArai 0:dae1ac0c0a7b 261 feature,
kenjiArai 0:dae1ac0c0a7b 262 port,
kenjiArai 0:dae1ac0c0a7b 263 NULL,
kenjiArai 0:dae1ac0c0a7b 264 0);
kenjiArai 0:dae1ac0c0a7b 265 }
kenjiArai 0:dae1ac0c0a7b 266
kenjiArai 0:dae1ac0c0a7b 267 void USBHostHub::clearPortFeature(uint32_t feature, uint8_t port)
kenjiArai 0:dae1ac0c0a7b 268 {
kenjiArai 0:dae1ac0c0a7b 269 host->controlWrite( dev,
kenjiArai 0:dae1ac0c0a7b 270 USB_HOST_TO_DEVICE | USB_REQUEST_TYPE_CLASS | USB_RECIPIENT_INTERFACE | USB_RECIPIENT_ENDPOINT,
kenjiArai 0:dae1ac0c0a7b 271 CLEAR_FEATURE,
kenjiArai 0:dae1ac0c0a7b 272 feature,
kenjiArai 0:dae1ac0c0a7b 273 port,
kenjiArai 0:dae1ac0c0a7b 274 NULL,
kenjiArai 0:dae1ac0c0a7b 275 0);
kenjiArai 0:dae1ac0c0a7b 276 }
kenjiArai 0:dae1ac0c0a7b 277
kenjiArai 0:dae1ac0c0a7b 278 uint32_t USBHostHub::getPortStatus(uint8_t port)
kenjiArai 0:dae1ac0c0a7b 279 {
kenjiArai 0:dae1ac0c0a7b 280 uint32_t st;
kenjiArai 0:dae1ac0c0a7b 281 host->controlRead( dev,
kenjiArai 0:dae1ac0c0a7b 282 USB_DEVICE_TO_HOST | USB_REQUEST_TYPE_CLASS | USB_RECIPIENT_INTERFACE | USB_RECIPIENT_ENDPOINT,
kenjiArai 0:dae1ac0c0a7b 283 GET_STATUS,
kenjiArai 0:dae1ac0c0a7b 284 0,
kenjiArai 0:dae1ac0c0a7b 285 port,
kenjiArai 0:dae1ac0c0a7b 286 (uint8_t *)&st,
kenjiArai 0:dae1ac0c0a7b 287 4);
kenjiArai 0:dae1ac0c0a7b 288 return st;
kenjiArai 0:dae1ac0c0a7b 289 }
kenjiArai 0:dae1ac0c0a7b 290
kenjiArai 0:dae1ac0c0a7b 291 #endif