NetServices Stack source

Dependents:   HelloWorld ServoInterfaceBoardExample1 4180_Lab4

Committer:
donatien
Date:
Fri Jul 09 14:46:47 2010 +0000
Revision:
4:fd826cad83c0
Parent:
0:632c9925f013

        

Who changed what in which revision?

UserRevisionLine numberNew contents of line
donatien 0:632c9925f013 1
donatien 0:632c9925f013 2 /*
donatien 0:632c9925f013 3 Copyright (c) 2010 Donatien Garnier (donatiengar [at] gmail [dot] com)
donatien 0:632c9925f013 4
donatien 0:632c9925f013 5 Permission is hereby granted, free of charge, to any person obtaining a copy
donatien 0:632c9925f013 6 of this software and associated documentation files (the "Software"), to deal
donatien 0:632c9925f013 7 in the Software without restriction, including without limitation the rights
donatien 0:632c9925f013 8 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
donatien 0:632c9925f013 9 copies of the Software, and to permit persons to whom the Software is
donatien 0:632c9925f013 10 furnished to do so, subject to the following conditions:
donatien 0:632c9925f013 11
donatien 0:632c9925f013 12 The above copyright notice and this permission notice shall be included in
donatien 0:632c9925f013 13 all copies or substantial portions of the Software.
donatien 0:632c9925f013 14
donatien 0:632c9925f013 15 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
donatien 0:632c9925f013 16 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
donatien 0:632c9925f013 17 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
donatien 0:632c9925f013 18 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
donatien 0:632c9925f013 19 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
donatien 0:632c9925f013 20 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
donatien 0:632c9925f013 21 THE SOFTWARE.
donatien 0:632c9925f013 22 */
donatien 0:632c9925f013 23
donatien 4:fd826cad83c0 24 #include "rpc.h"
donatien 4:fd826cad83c0 25
donatien 0:632c9925f013 26 #include "UsbSerial.h"
donatien 4:fd826cad83c0 27
donatien 4:fd826cad83c0 28 //#define __DEBUG
donatien 4:fd826cad83c0 29 #include "dbg/dbg.h"
donatien 0:632c9925f013 30
donatien 0:632c9925f013 31 #include "netCfg.h"
donatien 0:632c9925f013 32 #if NET_USB_SERIAL
donatien 0:632c9925f013 33
donatien 0:632c9925f013 34 namespace mbed {
donatien 0:632c9925f013 35
donatien 0:632c9925f013 36 #define BUF_LEN 64
donatien 4:fd826cad83c0 37 #define FLUSH_TMOUT 100000 //US
donatien 0:632c9925f013 38
donatien 4:fd826cad83c0 39 UsbSerial::UsbSerial(UsbDevice* pDevice, int epIn, int epOut, const char* name /*= NULL*/) : Stream(name), m_epIn(pDevice, epIn, true, USB_BULK, BUF_LEN), m_epOut(pDevice, epOut, false, USB_BULK, BUF_LEN),
donatien 4:fd826cad83c0 40 m_pInCbItem(NULL), m_pInCbMeth(NULL), m_pOutCbItem(NULL), m_pOutCbMeth(NULL)
donatien 4:fd826cad83c0 41 {
donatien 0:632c9925f013 42 m_inBufEven = new char[BUF_LEN];
donatien 0:632c9925f013 43 m_inBufOdd = new char[BUF_LEN];
donatien 0:632c9925f013 44 m_pInBufPos = m_inBufUsr = m_inBufEven;
donatien 0:632c9925f013 45 m_inBufTrmt = m_inBufOdd;
donatien 0:632c9925f013 46
donatien 0:632c9925f013 47 m_outBufEven = new char[BUF_LEN];
donatien 0:632c9925f013 48 m_outBufOdd = new char[BUF_LEN];
donatien 0:632c9925f013 49 m_pOutBufPos = m_outBufUsr = m_outBufEven;
donatien 0:632c9925f013 50 m_outBufTrmt = m_outBufOdd;
donatien 0:632c9925f013 51
donatien 0:632c9925f013 52 m_inBufLen = m_outBufLen = 0;
donatien 0:632c9925f013 53
donatien 4:fd826cad83c0 54 DBG("Starting RX'ing on in ep\n");
donatien 4:fd826cad83c0 55
donatien 4:fd826cad83c0 56 m_timeout = false;
donatien 4:fd826cad83c0 57
donatien 4:fd826cad83c0 58 m_epIn.setOnCompletion(this, &UsbSerial::onEpInTransfer);
donatien 4:fd826cad83c0 59 m_epOut.setOnCompletion(this, &UsbSerial::onEpOutTransfer);
donatien 4:fd826cad83c0 60
donatien 4:fd826cad83c0 61 startRx();
donatien 0:632c9925f013 62 }
donatien 0:632c9925f013 63
donatien 0:632c9925f013 64 UsbSerial::~UsbSerial()
donatien 0:632c9925f013 65 {
donatien 0:632c9925f013 66 delete[] m_inBufEven;
donatien 0:632c9925f013 67 delete[] m_inBufOdd;
donatien 0:632c9925f013 68 delete[] m_outBufEven;
donatien 0:632c9925f013 69 delete[] m_outBufOdd;
donatien 0:632c9925f013 70 }
donatien 0:632c9925f013 71
donatien 0:632c9925f013 72 void UsbSerial::baud(int baudrate) {
donatien 0:632c9925f013 73 //
donatien 0:632c9925f013 74 }
donatien 0:632c9925f013 75
donatien 0:632c9925f013 76 void UsbSerial::format(int bits, int parity, int stop) {
donatien 0:632c9925f013 77 //
donatien 0:632c9925f013 78 }
donatien 0:632c9925f013 79
donatien 4:fd826cad83c0 80 #if 0 //For doc only
donatien 4:fd826cad83c0 81 template <class T>
donatien 4:fd826cad83c0 82 void attach(T* pCbItem, void (T::*pCbMeth)())
donatien 4:fd826cad83c0 83 {
donatien 4:fd826cad83c0 84 m_pCbItem = (CDummy*) pCbItem;
donatien 4:fd826cad83c0 85 m_pCbMeth = (void (CDummy::*)()) pCbMeth;
donatien 4:fd826cad83c0 86 }
donatien 4:fd826cad83c0 87 #endif
donatien 4:fd826cad83c0 88
donatien 0:632c9925f013 89 int UsbSerial::_getc() {
donatien 4:fd826cad83c0 90 NVIC_DisableIRQ(US_TICKER_TIMER_IRQn);
donatien 4:fd826cad83c0 91 NVIC_DisableIRQ(USB_IRQn);
donatien 0:632c9925f013 92 char c;
donatien 0:632c9925f013 93 c = *m_pInBufPos;
donatien 0:632c9925f013 94 m_pInBufPos++;
donatien 4:fd826cad83c0 95 NVIC_EnableIRQ(USB_IRQn);
donatien 4:fd826cad83c0 96 NVIC_EnableIRQ(US_TICKER_TIMER_IRQn);
donatien 0:632c9925f013 97 return c;
donatien 0:632c9925f013 98 }
donatien 0:632c9925f013 99
donatien 0:632c9925f013 100 int UsbSerial::_putc(int c) {
donatien 4:fd826cad83c0 101 NVIC_DisableIRQ(US_TICKER_TIMER_IRQn);
donatien 4:fd826cad83c0 102 NVIC_DisableIRQ(USB_IRQn);
donatien 4:fd826cad83c0 103 if( (m_pOutBufPos - m_outBufUsr) < BUF_LEN )
donatien 0:632c9925f013 104 {
donatien 4:fd826cad83c0 105 *m_pOutBufPos = (char) c;
donatien 4:fd826cad83c0 106 m_pOutBufPos++;
donatien 4:fd826cad83c0 107 }
donatien 4:fd826cad83c0 108 else
donatien 4:fd826cad83c0 109 {
donatien 4:fd826cad83c0 110 DBG("NO WAY!!!\n");
donatien 4:fd826cad83c0 111 }
donatien 4:fd826cad83c0 112 #if 1
donatien 4:fd826cad83c0 113 if( (m_pOutBufPos - m_outBufUsr) >= BUF_LEN ) //Must flush
donatien 4:fd826cad83c0 114 {
donatien 4:fd826cad83c0 115 if(m_timeout)
donatien 4:fd826cad83c0 116 m_txTimeout.detach();
donatien 0:632c9925f013 117 startTx();
donatien 0:632c9925f013 118 }
donatien 0:632c9925f013 119 else
donatien 0:632c9925f013 120 {
donatien 4:fd826cad83c0 121 /*if(m_timeout)
donatien 4:fd826cad83c0 122 m_txTimeout.detach();
donatien 4:fd826cad83c0 123 m_timeout = true;
donatien 4:fd826cad83c0 124 m_txTimeout.attach_us(this, &UsbSerial::startTx, FLUSH_TMOUT);*/
donatien 4:fd826cad83c0 125 if(!m_timeout)
donatien 4:fd826cad83c0 126 {
donatien 4:fd826cad83c0 127 m_timeout = true;
donatien 4:fd826cad83c0 128 m_txTimeout.attach_us(this, &UsbSerial::startTx, FLUSH_TMOUT);
donatien 4:fd826cad83c0 129 }
donatien 0:632c9925f013 130 }
donatien 4:fd826cad83c0 131 #endif
donatien 4:fd826cad83c0 132 //startTx();
donatien 4:fd826cad83c0 133 NVIC_EnableIRQ(USB_IRQn);
donatien 4:fd826cad83c0 134 NVIC_EnableIRQ(US_TICKER_TIMER_IRQn);
donatien 0:632c9925f013 135 return c;
donatien 0:632c9925f013 136 }
donatien 0:632c9925f013 137
donatien 0:632c9925f013 138 int UsbSerial::readable() {
donatien 4:fd826cad83c0 139 NVIC_DisableIRQ(US_TICKER_TIMER_IRQn);
donatien 4:fd826cad83c0 140 NVIC_DisableIRQ(USB_IRQn);
donatien 4:fd826cad83c0 141 int res;
donatien 0:632c9925f013 142 if( (m_pInBufPos - m_inBufUsr) < m_inBufLen )
donatien 0:632c9925f013 143 {
donatien 4:fd826cad83c0 144 //DBG("\r\nREADABLE\r\n");
donatien 4:fd826cad83c0 145 res = true;
donatien 0:632c9925f013 146 }
donatien 0:632c9925f013 147 else
donatien 0:632c9925f013 148 {
donatien 4:fd826cad83c0 149 //DBG("\r\nNOT READABLE\r\n");
donatien 0:632c9925f013 150 startRx(); //Try to swap packets & start another transmission
donatien 4:fd826cad83c0 151 res = ((m_pInBufPos - m_inBufUsr) < m_inBufLen )?true:false;
donatien 0:632c9925f013 152 }
donatien 4:fd826cad83c0 153 NVIC_EnableIRQ(USB_IRQn);
donatien 4:fd826cad83c0 154 NVIC_EnableIRQ(US_TICKER_TIMER_IRQn);
donatien 4:fd826cad83c0 155 return (bool)res;
donatien 0:632c9925f013 156 }
donatien 0:632c9925f013 157
donatien 0:632c9925f013 158 int UsbSerial::writeable() {
donatien 4:fd826cad83c0 159 NVIC_DisableIRQ(US_TICKER_TIMER_IRQn);
donatien 4:fd826cad83c0 160 NVIC_DisableIRQ(USB_IRQn);
donatien 4:fd826cad83c0 161 // DBG("\r\nWRITEABLE???\r\n");
donatien 4:fd826cad83c0 162 int res = (bool)( (m_pOutBufPos - m_outBufUsr) < BUF_LEN);
donatien 4:fd826cad83c0 163 NVIC_EnableIRQ(USB_IRQn);
donatien 4:fd826cad83c0 164 NVIC_EnableIRQ(US_TICKER_TIMER_IRQn);
donatien 4:fd826cad83c0 165 return res;
donatien 4:fd826cad83c0 166 }
donatien 4:fd826cad83c0 167
donatien 4:fd826cad83c0 168 void UsbSerial::onReadable()
donatien 4:fd826cad83c0 169 {
donatien 4:fd826cad83c0 170 if(m_pInCbItem && m_pInCbMeth)
donatien 4:fd826cad83c0 171 (m_pInCbItem->*m_pInCbMeth)();
donatien 0:632c9925f013 172 }
donatien 0:632c9925f013 173
donatien 4:fd826cad83c0 174 void UsbSerial::onWriteable()
donatien 4:fd826cad83c0 175 {
donatien 4:fd826cad83c0 176 if(m_pOutCbItem && m_pOutCbMeth)
donatien 4:fd826cad83c0 177 (m_pOutCbItem->*m_pOutCbMeth)();
donatien 4:fd826cad83c0 178 }
donatien 4:fd826cad83c0 179
donatien 4:fd826cad83c0 180 void UsbSerial::onEpInTransfer()
donatien 4:fd826cad83c0 181 {
donatien 4:fd826cad83c0 182 int len = m_epIn.status();
donatien 4:fd826cad83c0 183 DBG("RX transfer completed w len=%d\n",len);
donatien 4:fd826cad83c0 184 startRx();
donatien 4:fd826cad83c0 185 if(len > 0)
donatien 4:fd826cad83c0 186 onReadable();
donatien 4:fd826cad83c0 187 }
donatien 4:fd826cad83c0 188
donatien 4:fd826cad83c0 189 void UsbSerial::onEpOutTransfer()
donatien 4:fd826cad83c0 190 {
donatien 4:fd826cad83c0 191 int len = m_epOut.status();
donatien 4:fd826cad83c0 192 DBG("TX transfer completed w len=%d\n",len);
donatien 4:fd826cad83c0 193 if(m_timeout)
donatien 4:fd826cad83c0 194 m_txTimeout.detach();
donatien 4:fd826cad83c0 195 startTx();
donatien 4:fd826cad83c0 196 if(len > 0)
donatien 4:fd826cad83c0 197 onWriteable();
donatien 4:fd826cad83c0 198 }
donatien 0:632c9925f013 199
donatien 0:632c9925f013 200 void UsbSerial::startTx()
donatien 0:632c9925f013 201 {
donatien 4:fd826cad83c0 202
donatien 4:fd826cad83c0 203 DBG("Transfer>\n");
donatien 4:fd826cad83c0 204
donatien 4:fd826cad83c0 205 m_timeout = false;
donatien 4:fd826cad83c0 206
donatien 4:fd826cad83c0 207 // m_txTimeout.detach();
donatien 4:fd826cad83c0 208
donatien 4:fd826cad83c0 209 if(!(m_pOutBufPos - m_outBufUsr))
donatien 0:632c9925f013 210 {
donatien 4:fd826cad83c0 211 DBG("?!?!?\n");
donatien 0:632c9925f013 212 return;
donatien 0:632c9925f013 213 }
donatien 0:632c9925f013 214
donatien 4:fd826cad83c0 215 if( m_epOut.status() == USBERR_PROCESSING )
donatien 4:fd826cad83c0 216 {
donatien 4:fd826cad83c0 217 //Wait & retry
donatien 4:fd826cad83c0 218 //m_timeout = true;
donatien 4:fd826cad83c0 219 //m_txTimeout.attach_us(this, &UsbSerial::startTx, FLUSH_TMOUT);
donatien 4:fd826cad83c0 220 DBG("Ep is busy...\n");
donatien 4:fd826cad83c0 221 return;
donatien 4:fd826cad83c0 222 }
donatien 4:fd826cad83c0 223
donatien 4:fd826cad83c0 224 if( m_epOut.status() < 0 )
donatien 4:fd826cad83c0 225 {
donatien 4:fd826cad83c0 226 DBG("Tx trying again...\n");
donatien 4:fd826cad83c0 227 m_epOut.transfer((volatile uint8_t*)m_outBufTrmt, m_outBufLen);
donatien 4:fd826cad83c0 228 return;
donatien 4:fd826cad83c0 229 }
donatien 4:fd826cad83c0 230
donatien 0:632c9925f013 231 m_outBufLen = m_pOutBufPos - m_outBufUsr;
donatien 0:632c9925f013 232
donatien 0:632c9925f013 233 //Swap buffers
donatien 0:632c9925f013 234 volatile char* swapBuf = m_outBufUsr;
donatien 0:632c9925f013 235 m_outBufUsr = m_outBufTrmt;
donatien 0:632c9925f013 236 m_outBufTrmt = swapBuf;
donatien 0:632c9925f013 237
donatien 4:fd826cad83c0 238 m_epOut.transfer((volatile uint8_t*)m_outBufTrmt, m_outBufLen);
donatien 0:632c9925f013 239
donatien 0:632c9925f013 240 m_pOutBufPos = m_outBufUsr;
donatien 0:632c9925f013 241
donatien 0:632c9925f013 242 }
donatien 0:632c9925f013 243
donatien 0:632c9925f013 244 void UsbSerial::startRx()
donatien 0:632c9925f013 245 {
donatien 0:632c9925f013 246 if( (m_pInBufPos - m_inBufUsr) < m_inBufLen )
donatien 0:632c9925f013 247 {
donatien 0:632c9925f013 248 //User buf is not empty, cannot swap now...
donatien 0:632c9925f013 249 return;
donatien 0:632c9925f013 250 }
donatien 4:fd826cad83c0 251 int len = m_epIn.status();
donatien 4:fd826cad83c0 252 if( len == USBERR_PROCESSING )
donatien 4:fd826cad83c0 253 {
donatien 4:fd826cad83c0 254 //Previous transmission not completed
donatien 4:fd826cad83c0 255 return;
donatien 4:fd826cad83c0 256 }
donatien 0:632c9925f013 257 if( len < 0 )
donatien 0:632c9925f013 258 {
donatien 4:fd826cad83c0 259 DBG("Rx trying again...\n");
donatien 4:fd826cad83c0 260 m_epIn.transfer((volatile uint8_t*)m_inBufTrmt, BUF_LEN); //Start another transmission
donatien 0:632c9925f013 261 return;
donatien 0:632c9925f013 262 }
donatien 0:632c9925f013 263
donatien 0:632c9925f013 264 m_inBufLen = len;
donatien 0:632c9925f013 265
donatien 0:632c9925f013 266 //Swap buffers
donatien 0:632c9925f013 267 volatile char* swapBuf = m_inBufUsr;
donatien 0:632c9925f013 268 m_inBufUsr = m_inBufTrmt;
donatien 0:632c9925f013 269 m_inBufTrmt = swapBuf;
donatien 4:fd826cad83c0 270 m_pInBufPos = m_inBufUsr;
donatien 0:632c9925f013 271
donatien 4:fd826cad83c0 272 DBG("Starting new transfer\n");
donatien 4:fd826cad83c0 273 m_epIn.transfer((volatile uint8_t*)m_inBufTrmt, BUF_LEN); //Start another transmission
donatien 4:fd826cad83c0 274
donatien 0:632c9925f013 275 }
donatien 0:632c9925f013 276
donatien 4:fd826cad83c0 277 #ifdef MBED_RPC
donatien 0:632c9925f013 278 const struct rpc_method *UsbSerial::get_rpc_methods() {
donatien 0:632c9925f013 279 static const rpc_method methods[] = {
donatien 0:632c9925f013 280 { "readable", rpc_method_caller<int, UsbSerial, &UsbSerial::readable> },
donatien 0:632c9925f013 281 { "writeable", rpc_method_caller<int, UsbSerial, &UsbSerial::writeable> },
donatien 0:632c9925f013 282 RPC_METHOD_SUPER(Stream)
donatien 0:632c9925f013 283 };
donatien 0:632c9925f013 284 return methods;
donatien 0:632c9925f013 285 }
donatien 0:632c9925f013 286
donatien 0:632c9925f013 287 struct rpc_class *UsbSerial::get_rpc_class() {
donatien 0:632c9925f013 288 static const rpc_function funcs[] = {
donatien 4:fd826cad83c0 289 /*{ "new", rpc_function_caller<const char*, UsbDevice*, int, int, const char*, Base::construct<UsbSerial,UsbDevice*,int,int,const char*> > },*/ //RPC is buggy
donatien 0:632c9925f013 290 RPC_METHOD_END
donatien 0:632c9925f013 291 };
donatien 0:632c9925f013 292 static rpc_class c = { "UsbSerial", funcs, NULL };
donatien 0:632c9925f013 293 return &c;
donatien 0:632c9925f013 294 }
donatien 4:fd826cad83c0 295 #endif
donatien 0:632c9925f013 296
donatien 0:632c9925f013 297 } // namespace mbed
donatien 0:632c9925f013 298
donatien 0:632c9925f013 299 #endif
donatien 0:632c9925f013 300