EL4121 Embedded System / mbed-os

mbed-os

Dependents:   cobaLCDJoyMotor_Thread odometry_omni_3roda_v3 odometry_omni_3roda_v1 odometry_omni_3roda_v2 ... more

features/unsupported/USBHost/USBHost3GModule/WANDongleSerialPort.cpp@0:b74591d5ab33, 2017-12-11 (annotated)

Committer:
be_bryan
Date:
Mon Dec 11 17:54:04 2017 +0000
Revision:
0:b74591d5ab33
motor ++

Who changed what in which revision?

UserRevisionLine numberNew contents of line
be_bryan 0:b74591d5ab33 1 /* Copyright (c) 2010-2012 mbed.org, MIT License
be_bryan 0:b74591d5ab33 2 *
be_bryan 0:b74591d5ab33 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
be_bryan 0:b74591d5ab33 4 * and associated documentation files (the "Software"), to deal in the Software without
be_bryan 0:b74591d5ab33 5 * restriction, including without limitation the rights to use, copy, modify, merge, publish,
be_bryan 0:b74591d5ab33 6 * distribute, sublicense, and/or sell copies of the Software, and to permit persons to whom the
be_bryan 0:b74591d5ab33 7 * Software is furnished to do so, subject to the following conditions:
be_bryan 0:b74591d5ab33 8 *
be_bryan 0:b74591d5ab33 9 * The above copyright notice and this permission notice shall be included in all copies or
be_bryan 0:b74591d5ab33 10 * substantial portions of the Software.
be_bryan 0:b74591d5ab33 11 *
be_bryan 0:b74591d5ab33 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
be_bryan 0:b74591d5ab33 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
be_bryan 0:b74591d5ab33 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
be_bryan 0:b74591d5ab33 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
be_bryan 0:b74591d5ab33 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
be_bryan 0:b74591d5ab33 17 */
be_bryan 0:b74591d5ab33 18
be_bryan 0:b74591d5ab33 19 #include "USBHostConf.h"
be_bryan 0:b74591d5ab33 20
be_bryan 0:b74591d5ab33 21 #ifdef USBHOST_3GMODULE
be_bryan 0:b74591d5ab33 22
be_bryan 0:b74591d5ab33 23 #define __DEBUG__ 0
be_bryan 0:b74591d5ab33 24 #ifndef __MODULE__
be_bryan 0:b74591d5ab33 25 #define __MODULE__ "WANDongleSerialPort.cpp"
be_bryan 0:b74591d5ab33 26 #endif
be_bryan 0:b74591d5ab33 27
be_bryan 0:b74591d5ab33 28 #include "dbg.h"
be_bryan 0:b74591d5ab33 29 #include <stdint.h>
be_bryan 0:b74591d5ab33 30 #include "rtos.h"
be_bryan 0:b74591d5ab33 31
be_bryan 0:b74591d5ab33 32 #include "WANDongleSerialPort.h"
be_bryan 0:b74591d5ab33 33
be_bryan 0:b74591d5ab33 34 WANDongleSerialPort::WANDongleSerialPort() : cb_tx_en(false), cb_rx_en(false), listener(NULL)
be_bryan 0:b74591d5ab33 35 {
be_bryan 0:b74591d5ab33 36 reset();
be_bryan 0:b74591d5ab33 37 }
be_bryan 0:b74591d5ab33 38
be_bryan 0:b74591d5ab33 39 void WANDongleSerialPort::init(USBHost* pHost)
be_bryan 0:b74591d5ab33 40 {
be_bryan 0:b74591d5ab33 41 host = pHost;
be_bryan 0:b74591d5ab33 42 }
be_bryan 0:b74591d5ab33 43
be_bryan 0:b74591d5ab33 44 void WANDongleSerialPort::reset()
be_bryan 0:b74591d5ab33 45 {
be_bryan 0:b74591d5ab33 46 tx_mtx.lock();
be_bryan 0:b74591d5ab33 47 rx_mtx.lock();
be_bryan 0:b74591d5ab33 48
be_bryan 0:b74591d5ab33 49 bulk_in = NULL;
be_bryan 0:b74591d5ab33 50 bulk_out = NULL;
be_bryan 0:b74591d5ab33 51
be_bryan 0:b74591d5ab33 52 buf_out_len = 0;
be_bryan 0:b74591d5ab33 53 max_out_size = 0;
be_bryan 0:b74591d5ab33 54 lock_tx = false;
be_bryan 0:b74591d5ab33 55 cb_tx_pending = false;
be_bryan 0:b74591d5ab33 56
be_bryan 0:b74591d5ab33 57 buf_in_len = 0;
be_bryan 0:b74591d5ab33 58 buf_in_read_pos = 0;
be_bryan 0:b74591d5ab33 59 lock_rx = false;
be_bryan 0:b74591d5ab33 60 cb_rx_pending = false;
be_bryan 0:b74591d5ab33 61
be_bryan 0:b74591d5ab33 62 tx_mtx.unlock();
be_bryan 0:b74591d5ab33 63 rx_mtx.unlock();
be_bryan 0:b74591d5ab33 64 }
be_bryan 0:b74591d5ab33 65
be_bryan 0:b74591d5ab33 66 int WANDongleSerialPort::readPacket()
be_bryan 0:b74591d5ab33 67 {
be_bryan 0:b74591d5ab33 68 USB_DBG("Read packet on %p", this);
be_bryan 0:b74591d5ab33 69 rx_mtx.lock();
be_bryan 0:b74591d5ab33 70 if(lock_rx)
be_bryan 0:b74591d5ab33 71 {
be_bryan 0:b74591d5ab33 72 USB_ERR("Fail");
be_bryan 0:b74591d5ab33 73 rx_mtx.unlock();
be_bryan 0:b74591d5ab33 74 return -1;
be_bryan 0:b74591d5ab33 75 }
be_bryan 0:b74591d5ab33 76
be_bryan 0:b74591d5ab33 77 if( bulk_in == NULL )
be_bryan 0:b74591d5ab33 78 {
be_bryan 0:b74591d5ab33 79 USB_WARN("Port is disconnected");
be_bryan 0:b74591d5ab33 80 rx_mtx.unlock();
be_bryan 0:b74591d5ab33 81 return -1;
be_bryan 0:b74591d5ab33 82 }
be_bryan 0:b74591d5ab33 83
be_bryan 0:b74591d5ab33 84 lock_rx = true; //Receiving
be_bryan 0:b74591d5ab33 85 rx_mtx.unlock();
be_bryan 0:b74591d5ab33 86 // USB_DBG("readPacket");
be_bryan 0:b74591d5ab33 87 //lock_rx.lock();
be_bryan 0:b74591d5ab33 88 USB_TYPE res = host->bulkRead(dev, (USBEndpoint *)bulk_in, buf_in, ((USBEndpoint *)bulk_in)->getSize(), false); //Queue transfer
be_bryan 0:b74591d5ab33 89 if(res != USB_TYPE_PROCESSING)
be_bryan 0:b74591d5ab33 90 {
be_bryan 0:b74591d5ab33 91 //lock_rx.unlock();
be_bryan 0:b74591d5ab33 92 USB_ERR("host->bulkRead() returned %d", res);
be_bryan 0:b74591d5ab33 93 Thread::wait(100);
be_bryan 0:b74591d5ab33 94 return -1;
be_bryan 0:b74591d5ab33 95 }
be_bryan 0:b74591d5ab33 96 return 0;
be_bryan 0:b74591d5ab33 97 }
be_bryan 0:b74591d5ab33 98
be_bryan 0:b74591d5ab33 99 int WANDongleSerialPort::writePacket()
be_bryan 0:b74591d5ab33 100 {
be_bryan 0:b74591d5ab33 101 tx_mtx.lock();
be_bryan 0:b74591d5ab33 102 if(lock_tx)
be_bryan 0:b74591d5ab33 103 {
be_bryan 0:b74591d5ab33 104 USB_ERR("Fail");
be_bryan 0:b74591d5ab33 105 tx_mtx.unlock();
be_bryan 0:b74591d5ab33 106 return -1;
be_bryan 0:b74591d5ab33 107 }
be_bryan 0:b74591d5ab33 108
be_bryan 0:b74591d5ab33 109 if( bulk_out == NULL )
be_bryan 0:b74591d5ab33 110 {
be_bryan 0:b74591d5ab33 111 USB_WARN("Port is disconnected");
be_bryan 0:b74591d5ab33 112 tx_mtx.unlock();
be_bryan 0:b74591d5ab33 113 return -1;
be_bryan 0:b74591d5ab33 114 }
be_bryan 0:b74591d5ab33 115
be_bryan 0:b74591d5ab33 116 lock_tx = true; //Transmitting
be_bryan 0:b74591d5ab33 117 tx_mtx.unlock();
be_bryan 0:b74591d5ab33 118 // USB_DBG("writePacket");
be_bryan 0:b74591d5ab33 119
be_bryan 0:b74591d5ab33 120 //lock_tx.lock();
be_bryan 0:b74591d5ab33 121 USB_TYPE res = host->bulkWrite(dev, (USBEndpoint *)bulk_out, buf_out, buf_out_len, false); //Queue transfer
be_bryan 0:b74591d5ab33 122 if(res != USB_TYPE_PROCESSING)
be_bryan 0:b74591d5ab33 123 {
be_bryan 0:b74591d5ab33 124 //lock_tx.unlock();
be_bryan 0:b74591d5ab33 125 USB_ERR("host->bulkWrite() returned %d", res);
be_bryan 0:b74591d5ab33 126 Thread::wait(100);
be_bryan 0:b74591d5ab33 127 return -1;
be_bryan 0:b74591d5ab33 128 }
be_bryan 0:b74591d5ab33 129 return 0;
be_bryan 0:b74591d5ab33 130 }
be_bryan 0:b74591d5ab33 131
be_bryan 0:b74591d5ab33 132 int WANDongleSerialPort::putc(int c)
be_bryan 0:b74591d5ab33 133 {
be_bryan 0:b74591d5ab33 134 tx_mtx.lock();
be_bryan 0:b74591d5ab33 135 if(!lock_tx)
be_bryan 0:b74591d5ab33 136 {
be_bryan 0:b74591d5ab33 137 if(buf_out_len < max_out_size)
be_bryan 0:b74591d5ab33 138 {
be_bryan 0:b74591d5ab33 139 buf_out[buf_out_len] = (uint8_t)c;
be_bryan 0:b74591d5ab33 140 buf_out_len++;
be_bryan 0:b74591d5ab33 141 }
be_bryan 0:b74591d5ab33 142 }
be_bryan 0:b74591d5ab33 143 else
be_bryan 0:b74591d5ab33 144 {
be_bryan 0:b74591d5ab33 145 USB_ERR("CAN'T WRITE!");
be_bryan 0:b74591d5ab33 146 }
be_bryan 0:b74591d5ab33 147 tx_mtx.unlock();
be_bryan 0:b74591d5ab33 148 return c;
be_bryan 0:b74591d5ab33 149 }
be_bryan 0:b74591d5ab33 150
be_bryan 0:b74591d5ab33 151 int WANDongleSerialPort::getc()
be_bryan 0:b74591d5ab33 152 {
be_bryan 0:b74591d5ab33 153 rx_mtx.lock();
be_bryan 0:b74591d5ab33 154 int c = 0;
be_bryan 0:b74591d5ab33 155 if(!lock_rx)
be_bryan 0:b74591d5ab33 156 {
be_bryan 0:b74591d5ab33 157 if(buf_in_read_pos < buf_in_len)
be_bryan 0:b74591d5ab33 158 {
be_bryan 0:b74591d5ab33 159 c = (int)buf_in[buf_in_read_pos];
be_bryan 0:b74591d5ab33 160 buf_in_read_pos++;
be_bryan 0:b74591d5ab33 161 }
be_bryan 0:b74591d5ab33 162 }
be_bryan 0:b74591d5ab33 163 else
be_bryan 0:b74591d5ab33 164 {
be_bryan 0:b74591d5ab33 165 USB_ERR("CAN'T READ!");
be_bryan 0:b74591d5ab33 166 }
be_bryan 0:b74591d5ab33 167 rx_mtx.unlock();
be_bryan 0:b74591d5ab33 168 return c;
be_bryan 0:b74591d5ab33 169 }
be_bryan 0:b74591d5ab33 170
be_bryan 0:b74591d5ab33 171 int WANDongleSerialPort::readable()
be_bryan 0:b74591d5ab33 172 {
be_bryan 0:b74591d5ab33 173 rx_mtx.lock();
be_bryan 0:b74591d5ab33 174 if (lock_rx)
be_bryan 0:b74591d5ab33 175 {
be_bryan 0:b74591d5ab33 176 rx_mtx.unlock();
be_bryan 0:b74591d5ab33 177 return 0;
be_bryan 0:b74591d5ab33 178 }
be_bryan 0:b74591d5ab33 179
be_bryan 0:b74591d5ab33 180 /* if( !lock_rx.trylock() )
be_bryan 0:b74591d5ab33 181 {
be_bryan 0:b74591d5ab33 182 return 0;
be_bryan 0:b74591d5ab33 183 }*/
be_bryan 0:b74591d5ab33 184 int res = buf_in_len - buf_in_read_pos;
be_bryan 0:b74591d5ab33 185 //lock_rx.unlock();
be_bryan 0:b74591d5ab33 186 rx_mtx.unlock();
be_bryan 0:b74591d5ab33 187 return res;
be_bryan 0:b74591d5ab33 188 }
be_bryan 0:b74591d5ab33 189
be_bryan 0:b74591d5ab33 190 int WANDongleSerialPort::writeable()
be_bryan 0:b74591d5ab33 191 {
be_bryan 0:b74591d5ab33 192 tx_mtx.lock();
be_bryan 0:b74591d5ab33 193 if (lock_tx)
be_bryan 0:b74591d5ab33 194 {
be_bryan 0:b74591d5ab33 195 tx_mtx.unlock();
be_bryan 0:b74591d5ab33 196 return 0;
be_bryan 0:b74591d5ab33 197 }
be_bryan 0:b74591d5ab33 198
be_bryan 0:b74591d5ab33 199 /*if( !lock_tx.trylock() )
be_bryan 0:b74591d5ab33 200 {
be_bryan 0:b74591d5ab33 201 return 0;
be_bryan 0:b74591d5ab33 202 }*/
be_bryan 0:b74591d5ab33 203 int res = max_out_size - buf_out_len;
be_bryan 0:b74591d5ab33 204 tx_mtx.unlock();
be_bryan 0:b74591d5ab33 205 //lock_tx.unlock();
be_bryan 0:b74591d5ab33 206 return res;
be_bryan 0:b74591d5ab33 207 }
be_bryan 0:b74591d5ab33 208
be_bryan 0:b74591d5ab33 209 void WANDongleSerialPort::attach(IUSBHostSerialListener* pListener)
be_bryan 0:b74591d5ab33 210 {
be_bryan 0:b74591d5ab33 211 if(pListener == NULL)
be_bryan 0:b74591d5ab33 212 {
be_bryan 0:b74591d5ab33 213 setupIrq(false, RxIrq);
be_bryan 0:b74591d5ab33 214 setupIrq(false, TxIrq);
be_bryan 0:b74591d5ab33 215 }
be_bryan 0:b74591d5ab33 216 listener = pListener;
be_bryan 0:b74591d5ab33 217 if(pListener != NULL)
be_bryan 0:b74591d5ab33 218 {
be_bryan 0:b74591d5ab33 219 setupIrq(true, RxIrq);
be_bryan 0:b74591d5ab33 220 setupIrq(true, TxIrq);
be_bryan 0:b74591d5ab33 221 }
be_bryan 0:b74591d5ab33 222 }
be_bryan 0:b74591d5ab33 223
be_bryan 0:b74591d5ab33 224 void WANDongleSerialPort::setupIrq(bool en, IrqType irq /*= RxIrq*/)
be_bryan 0:b74591d5ab33 225 {
be_bryan 0:b74591d5ab33 226 switch(irq)
be_bryan 0:b74591d5ab33 227 {
be_bryan 0:b74591d5ab33 228 case RxIrq:
be_bryan 0:b74591d5ab33 229 rx_mtx.lock();
be_bryan 0:b74591d5ab33 230 cb_rx_en = en;
be_bryan 0:b74591d5ab33 231 if(en && cb_rx_pending)
be_bryan 0:b74591d5ab33 232 {
be_bryan 0:b74591d5ab33 233 cb_rx_pending = false;
be_bryan 0:b74591d5ab33 234 rx_mtx.unlock();
be_bryan 0:b74591d5ab33 235 listener->readable(); //Process the interrupt that was raised
be_bryan 0:b74591d5ab33 236 }
be_bryan 0:b74591d5ab33 237 else
be_bryan 0:b74591d5ab33 238 {
be_bryan 0:b74591d5ab33 239 rx_mtx.unlock();
be_bryan 0:b74591d5ab33 240 }
be_bryan 0:b74591d5ab33 241 break;
be_bryan 0:b74591d5ab33 242 case TxIrq:
be_bryan 0:b74591d5ab33 243 tx_mtx.lock();
be_bryan 0:b74591d5ab33 244 cb_tx_en = en;
be_bryan 0:b74591d5ab33 245 if(en && cb_tx_pending)
be_bryan 0:b74591d5ab33 246 {
be_bryan 0:b74591d5ab33 247 cb_tx_pending = false;
be_bryan 0:b74591d5ab33 248 tx_mtx.unlock();
be_bryan 0:b74591d5ab33 249 listener->writeable(); //Process the interrupt that was raised
be_bryan 0:b74591d5ab33 250 }
be_bryan 0:b74591d5ab33 251 else
be_bryan 0:b74591d5ab33 252 {
be_bryan 0:b74591d5ab33 253 tx_mtx.unlock();
be_bryan 0:b74591d5ab33 254 }
be_bryan 0:b74591d5ab33 255 break;
be_bryan 0:b74591d5ab33 256 }
be_bryan 0:b74591d5ab33 257 }
be_bryan 0:b74591d5ab33 258
be_bryan 0:b74591d5ab33 259
be_bryan 0:b74591d5ab33 260 void WANDongleSerialPort::connect( USBDeviceConnected* pDev, USBEndpoint* pInEp, USBEndpoint* pOutEp )
be_bryan 0:b74591d5ab33 261 {
be_bryan 0:b74591d5ab33 262 dev = pDev;
be_bryan 0:b74591d5ab33 263 bulk_in = pInEp;
be_bryan 0:b74591d5ab33 264 bulk_out = pOutEp;
be_bryan 0:b74591d5ab33 265 max_out_size = bulk_out->getSize();
be_bryan 0:b74591d5ab33 266 if( max_out_size > WANDONGLE_MAX_OUTEP_SIZE )
be_bryan 0:b74591d5ab33 267 {
be_bryan 0:b74591d5ab33 268 max_out_size = WANDONGLE_MAX_OUTEP_SIZE;
be_bryan 0:b74591d5ab33 269 }
be_bryan 0:b74591d5ab33 270 bulk_in->attach(this, &WANDongleSerialPort::rxHandler);
be_bryan 0:b74591d5ab33 271 bulk_out->attach(this, &WANDongleSerialPort::txHandler);
be_bryan 0:b74591d5ab33 272 readPacket(); //Start receiving data
be_bryan 0:b74591d5ab33 273 }
be_bryan 0:b74591d5ab33 274
be_bryan 0:b74591d5ab33 275 void WANDongleSerialPort::disconnect( )
be_bryan 0:b74591d5ab33 276 {
be_bryan 0:b74591d5ab33 277 reset();
be_bryan 0:b74591d5ab33 278 }
be_bryan 0:b74591d5ab33 279
be_bryan 0:b74591d5ab33 280 //Private methods
be_bryan 0:b74591d5ab33 281
be_bryan 0:b74591d5ab33 282
be_bryan 0:b74591d5ab33 283 void WANDongleSerialPort::rxHandler()
be_bryan 0:b74591d5ab33 284 {
be_bryan 0:b74591d5ab33 285 if (((USBEndpoint *) bulk_in)->getState() == USB_TYPE_IDLE) //Success
be_bryan 0:b74591d5ab33 286 {
be_bryan 0:b74591d5ab33 287 buf_in_read_pos = 0;
be_bryan 0:b74591d5ab33 288 buf_in_len = ((USBEndpoint *) bulk_in)->getLengthTransferred(); //Update length
be_bryan 0:b74591d5ab33 289 //lock_rx.unlock();
be_bryan 0:b74591d5ab33 290 rx_mtx.lock();
be_bryan 0:b74591d5ab33 291 lock_rx = false; //Transmission complete
be_bryan 0:b74591d5ab33 292 if(cb_rx_en)
be_bryan 0:b74591d5ab33 293 {
be_bryan 0:b74591d5ab33 294 rx_mtx.unlock();
be_bryan 0:b74591d5ab33 295 listener->readable(); //Call handler from the IRQ context
be_bryan 0:b74591d5ab33 296 //readPacket() should be called by the handler subsequently once the buffer has been emptied
be_bryan 0:b74591d5ab33 297 }
be_bryan 0:b74591d5ab33 298 else
be_bryan 0:b74591d5ab33 299 {
be_bryan 0:b74591d5ab33 300 cb_rx_pending = true; //Queue the callback
be_bryan 0:b74591d5ab33 301 rx_mtx.unlock();
be_bryan 0:b74591d5ab33 302 }
be_bryan 0:b74591d5ab33 303
be_bryan 0:b74591d5ab33 304 }
be_bryan 0:b74591d5ab33 305 else //Error, try reading again
be_bryan 0:b74591d5ab33 306 {
be_bryan 0:b74591d5ab33 307 //lock_rx.unlock();
be_bryan 0:b74591d5ab33 308 USB_DBG("Trying again");
be_bryan 0:b74591d5ab33 309 readPacket();
be_bryan 0:b74591d5ab33 310 }
be_bryan 0:b74591d5ab33 311 }
be_bryan 0:b74591d5ab33 312
be_bryan 0:b74591d5ab33 313 void WANDongleSerialPort::txHandler()
be_bryan 0:b74591d5ab33 314 {
be_bryan 0:b74591d5ab33 315 if (((USBEndpoint *) bulk_out)->getState() == USB_TYPE_IDLE) //Success
be_bryan 0:b74591d5ab33 316 {
be_bryan 0:b74591d5ab33 317 tx_mtx.lock();
be_bryan 0:b74591d5ab33 318 buf_out_len = 0; //Reset length
be_bryan 0:b74591d5ab33 319 lock_tx = false; //Transmission complete
be_bryan 0:b74591d5ab33 320 //lock_tx.unlock();
be_bryan 0:b74591d5ab33 321 if(cb_tx_en)
be_bryan 0:b74591d5ab33 322 {
be_bryan 0:b74591d5ab33 323 tx_mtx.unlock();
be_bryan 0:b74591d5ab33 324 listener->writeable(); //Call handler from the IRQ context
be_bryan 0:b74591d5ab33 325 //writePacket() should be called by the handler subsequently once the buffer has been filled
be_bryan 0:b74591d5ab33 326 }
be_bryan 0:b74591d5ab33 327 else
be_bryan 0:b74591d5ab33 328 {
be_bryan 0:b74591d5ab33 329 cb_tx_pending = true; //Queue the callback
be_bryan 0:b74591d5ab33 330 tx_mtx.unlock();
be_bryan 0:b74591d5ab33 331 }
be_bryan 0:b74591d5ab33 332 }
be_bryan 0:b74591d5ab33 333 else //Error, try reading again
be_bryan 0:b74591d5ab33 334 {
be_bryan 0:b74591d5ab33 335 //lock_tx.unlock();
be_bryan 0:b74591d5ab33 336 writePacket();
be_bryan 0:b74591d5ab33 337 }
be_bryan 0:b74591d5ab33 338 }
be_bryan 0:b74591d5ab33 339
be_bryan 0:b74591d5ab33 340 #endif /* USBHOST_3GMODULE */