Nino Der Kinderen / Mbed 2 deprecated InetTest

Embedded C project:18/12/2014

Dependencies:   DS1307 TextLCD mbed

NetServices/drv/serial/buf/SerialBuf.cpp@0:8d87bc453349, 2014-12-18 (annotated)

Committer:
ninoderkinderen
Date:
Thu Dec 18 09:35:49 2014 +0000
Revision:
0:8d87bc453349
Programma embedded C

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ninoderkinderen 0:8d87bc453349 1
ninoderkinderen 0:8d87bc453349 2 /*
ninoderkinderen 0:8d87bc453349 3 Copyright (c) 2010 Donatien Garnier (donatiengar [at] gmail [dot] com)
ninoderkinderen 0:8d87bc453349 4
ninoderkinderen 0:8d87bc453349 5 Permission is hereby granted, free of charge, to any person obtaining a copy
ninoderkinderen 0:8d87bc453349 6 of this software and associated documentation files (the "Software"), to deal
ninoderkinderen 0:8d87bc453349 7 in the Software without restriction, including without limitation the rights
ninoderkinderen 0:8d87bc453349 8 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
ninoderkinderen 0:8d87bc453349 9 copies of the Software, and to permit persons to whom the Software is
ninoderkinderen 0:8d87bc453349 10 furnished to do so, subject to the following conditions:
ninoderkinderen 0:8d87bc453349 11
ninoderkinderen 0:8d87bc453349 12 The above copyright notice and this permission notice shall be included in
ninoderkinderen 0:8d87bc453349 13 all copies or substantial portions of the Software.
ninoderkinderen 0:8d87bc453349 14
ninoderkinderen 0:8d87bc453349 15 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
ninoderkinderen 0:8d87bc453349 16 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
ninoderkinderen 0:8d87bc453349 17 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
ninoderkinderen 0:8d87bc453349 18 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
ninoderkinderen 0:8d87bc453349 19 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
ninoderkinderen 0:8d87bc453349 20 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
ninoderkinderen 0:8d87bc453349 21 THE SOFTWARE.
ninoderkinderen 0:8d87bc453349 22 */
ninoderkinderen 0:8d87bc453349 23
ninoderkinderen 0:8d87bc453349 24 #include "SerialBuf.h"
ninoderkinderen 0:8d87bc453349 25 #include "mbed.h"
ninoderkinderen 0:8d87bc453349 26
ninoderkinderen 0:8d87bc453349 27 //#define __DEBUG
ninoderkinderen 0:8d87bc453349 28 #include "dbg/dbg.h"
ninoderkinderen 0:8d87bc453349 29
ninoderkinderen 0:8d87bc453349 30 #include "netCfg.h"
ninoderkinderen 0:8d87bc453349 31 #if NET_GPRS
ninoderkinderen 0:8d87bc453349 32
ninoderkinderen 0:8d87bc453349 33 #if NET_USB_SERIAL
ninoderkinderen 0:8d87bc453349 34 #define m_pStream( a ) (m_pSerial?m_pSerial->a:m_pUsbSerial->a)
ninoderkinderen 0:8d87bc453349 35 #else
ninoderkinderen 0:8d87bc453349 36 #define m_pStream( a ) (m_pSerial->a)
ninoderkinderen 0:8d87bc453349 37 #endif
ninoderkinderen 0:8d87bc453349 38
ninoderkinderen 0:8d87bc453349 39 //Circular buf
ninoderkinderen 0:8d87bc453349 40
ninoderkinderen 0:8d87bc453349 41 SerialCircularBuf::SerialCircularBuf(int len) : m_readMode(false)
ninoderkinderen 0:8d87bc453349 42 {
ninoderkinderen 0:8d87bc453349 43 m_buf = new char[len];
ninoderkinderen 0:8d87bc453349 44 m_len = len;
ninoderkinderen 0:8d87bc453349 45 m_pReadStart = m_pRead = m_buf;
ninoderkinderen 0:8d87bc453349 46 m_pWrite = m_buf;
ninoderkinderen 0:8d87bc453349 47 }
ninoderkinderen 0:8d87bc453349 48
ninoderkinderen 0:8d87bc453349 49 SerialCircularBuf::~SerialCircularBuf()
ninoderkinderen 0:8d87bc453349 50 {
ninoderkinderen 0:8d87bc453349 51 if(m_buf)
ninoderkinderen 0:8d87bc453349 52 delete[] m_buf;
ninoderkinderen 0:8d87bc453349 53 }
ninoderkinderen 0:8d87bc453349 54
ninoderkinderen 0:8d87bc453349 55 int SerialCircularBuf::room() //Return room available in buf
ninoderkinderen 0:8d87bc453349 56 {
ninoderkinderen 0:8d87bc453349 57 //return m_len - len() - 1; //-1 is to avoid loop
ninoderkinderen 0:8d87bc453349 58 if ( m_pReadStart > m_pWrite )
ninoderkinderen 0:8d87bc453349 59 return ( m_pReadStart - m_pWrite - 1 );
ninoderkinderen 0:8d87bc453349 60 else
ninoderkinderen 0:8d87bc453349 61 return m_len - ( m_pWrite - m_pReadStart ) - 1;
ninoderkinderen 0:8d87bc453349 62 }
ninoderkinderen 0:8d87bc453349 63
ninoderkinderen 0:8d87bc453349 64 int SerialCircularBuf::len() //Return chars length in buf
ninoderkinderen 0:8d87bc453349 65 {
ninoderkinderen 0:8d87bc453349 66 if ( m_pWrite >= m_pRead )
ninoderkinderen 0:8d87bc453349 67 return ( m_pWrite - m_pRead );
ninoderkinderen 0:8d87bc453349 68 else
ninoderkinderen 0:8d87bc453349 69 return m_len - ( m_pRead - m_pWrite ); // = ( ( m_buf + m_len) - m_pRead ) + ( m_pWrite - m_buf )
ninoderkinderen 0:8d87bc453349 70 }
ninoderkinderen 0:8d87bc453349 71
ninoderkinderen 0:8d87bc453349 72 void SerialCircularBuf::write(char c)
ninoderkinderen 0:8d87bc453349 73 {
ninoderkinderen 0:8d87bc453349 74 #if 0
ninoderkinderen 0:8d87bc453349 75 if(!room())
ninoderkinderen 0:8d87bc453349 76 return;
ninoderkinderen 0:8d87bc453349 77 #endif
ninoderkinderen 0:8d87bc453349 78 //WARN: Must call room() before
ninoderkinderen 0:8d87bc453349 79 *m_pWrite = c;
ninoderkinderen 0:8d87bc453349 80 m_pWrite++;
ninoderkinderen 0:8d87bc453349 81 if(m_pWrite>=m_buf+m_len)
ninoderkinderen 0:8d87bc453349 82 m_pWrite=m_buf;
ninoderkinderen 0:8d87bc453349 83 }
ninoderkinderen 0:8d87bc453349 84 char SerialCircularBuf::read()
ninoderkinderen 0:8d87bc453349 85 {
ninoderkinderen 0:8d87bc453349 86 #if 0
ninoderkinderen 0:8d87bc453349 87 if(!len())
ninoderkinderen 0:8d87bc453349 88 return 0;
ninoderkinderen 0:8d87bc453349 89 #endif
ninoderkinderen 0:8d87bc453349 90 //WARN: Must call len() before
ninoderkinderen 0:8d87bc453349 91 char c = *m_pRead;
ninoderkinderen 0:8d87bc453349 92 m_pRead++;
ninoderkinderen 0:8d87bc453349 93
ninoderkinderen 0:8d87bc453349 94 if(m_pRead>=m_buf+m_len)
ninoderkinderen 0:8d87bc453349 95 m_pRead=m_buf;
ninoderkinderen 0:8d87bc453349 96
ninoderkinderen 0:8d87bc453349 97 if(!m_readMode) //If readmode=false, trash this char
ninoderkinderen 0:8d87bc453349 98 m_pReadStart=m_pRead;
ninoderkinderen 0:8d87bc453349 99
ninoderkinderen 0:8d87bc453349 100 return c;
ninoderkinderen 0:8d87bc453349 101 }
ninoderkinderen 0:8d87bc453349 102
ninoderkinderen 0:8d87bc453349 103 void SerialCircularBuf::setReadMode(bool readMode) //If true, keeps chars in buf when read, false by default
ninoderkinderen 0:8d87bc453349 104 {
ninoderkinderen 0:8d87bc453349 105 if(m_readMode == true && readMode == false)
ninoderkinderen 0:8d87bc453349 106 {
ninoderkinderen 0:8d87bc453349 107 //Trash bytes that have been read
ninoderkinderen 0:8d87bc453349 108 flushRead();
ninoderkinderen 0:8d87bc453349 109 }
ninoderkinderen 0:8d87bc453349 110 m_readMode = readMode;
ninoderkinderen 0:8d87bc453349 111 }
ninoderkinderen 0:8d87bc453349 112
ninoderkinderen 0:8d87bc453349 113 void SerialCircularBuf::flushRead() //Delete chars that have been read & return chars len (only useful with readMode = true)
ninoderkinderen 0:8d87bc453349 114 {
ninoderkinderen 0:8d87bc453349 115 m_pReadStart = m_pRead;
ninoderkinderen 0:8d87bc453349 116 }
ninoderkinderen 0:8d87bc453349 117
ninoderkinderen 0:8d87bc453349 118 void SerialCircularBuf::resetRead() //Go back to initial read position & return chars len (only useful with readMode = true)
ninoderkinderen 0:8d87bc453349 119 {
ninoderkinderen 0:8d87bc453349 120 m_pRead = m_pReadStart;
ninoderkinderen 0:8d87bc453349 121 }
ninoderkinderen 0:8d87bc453349 122
ninoderkinderen 0:8d87bc453349 123 //SerialBuf
ninoderkinderen 0:8d87bc453349 124
ninoderkinderen 0:8d87bc453349 125 SerialBuf::SerialBuf(int len) : m_rxBuf(len), m_txBuf(len), m_pSerial(NULL) //Buffer length
ninoderkinderen 0:8d87bc453349 126 #if NET_USB_SERIAL
ninoderkinderen 0:8d87bc453349 127 , m_pUsbSerial(NULL)
ninoderkinderen 0:8d87bc453349 128 #endif
ninoderkinderen 0:8d87bc453349 129 {
ninoderkinderen 0:8d87bc453349 130 DBG("New Serial buf@%p\n", this);
ninoderkinderen 0:8d87bc453349 131 }
ninoderkinderen 0:8d87bc453349 132
ninoderkinderen 0:8d87bc453349 133 SerialBuf::~SerialBuf()
ninoderkinderen 0:8d87bc453349 134 {
ninoderkinderen 0:8d87bc453349 135
ninoderkinderen 0:8d87bc453349 136 }
ninoderkinderen 0:8d87bc453349 137
ninoderkinderen 0:8d87bc453349 138 void SerialBuf::attach(Serial* pSerial)
ninoderkinderen 0:8d87bc453349 139 {
ninoderkinderen 0:8d87bc453349 140 DBG("Serial buf@%p in attach\n", this);
ninoderkinderen 0:8d87bc453349 141 m_pSerial = pSerial;
ninoderkinderen 0:8d87bc453349 142 m_pSerial->attach<SerialBuf>(this, &SerialBuf::onRxInterrupt, Serial::RxIrq);
ninoderkinderen 0:8d87bc453349 143 m_pSerial->attach<SerialBuf>(this, &SerialBuf::onTxInterrupt, Serial::TxIrq);
ninoderkinderen 0:8d87bc453349 144 onRxInterrupt(); //Read data
ninoderkinderen 0:8d87bc453349 145 }
ninoderkinderen 0:8d87bc453349 146
ninoderkinderen 0:8d87bc453349 147 void SerialBuf::detach()
ninoderkinderen 0:8d87bc453349 148 {
ninoderkinderen 0:8d87bc453349 149 if(m_pSerial)
ninoderkinderen 0:8d87bc453349 150 {
ninoderkinderen 0:8d87bc453349 151 m_pSerial->attach<SerialBuf>(NULL, NULL, Serial::RxIrq);
ninoderkinderen 0:8d87bc453349 152 m_pSerial->attach<SerialBuf>(NULL, NULL, Serial::TxIrq);
ninoderkinderen 0:8d87bc453349 153 m_pSerial = NULL;
ninoderkinderen 0:8d87bc453349 154 }
ninoderkinderen 0:8d87bc453349 155 #if NET_USB_SERIAL
ninoderkinderen 0:8d87bc453349 156 else if(m_pUsbSerial)
ninoderkinderen 0:8d87bc453349 157 {
ninoderkinderen 0:8d87bc453349 158 m_pUsbSerial->attach<SerialBuf>(NULL, NULL, UsbSerial::RxIrq);
ninoderkinderen 0:8d87bc453349 159 m_pUsbSerial->attach<SerialBuf>(NULL, NULL, UsbSerial::TxIrq);
ninoderkinderen 0:8d87bc453349 160 m_pUsbSerial = NULL;
ninoderkinderen 0:8d87bc453349 161 }
ninoderkinderen 0:8d87bc453349 162 #endif
ninoderkinderen 0:8d87bc453349 163 }
ninoderkinderen 0:8d87bc453349 164
ninoderkinderen 0:8d87bc453349 165 #if NET_USB_SERIAL
ninoderkinderen 0:8d87bc453349 166 void SerialBuf::attach(UsbSerial* pUsbSerial)
ninoderkinderen 0:8d87bc453349 167 {
ninoderkinderen 0:8d87bc453349 168 m_pUsbSerial = pUsbSerial;
ninoderkinderen 0:8d87bc453349 169 m_pUsbSerial->attach<SerialBuf>(this, &SerialBuf::onRxInterrupt, UsbSerial::RxIrq);
ninoderkinderen 0:8d87bc453349 170 m_pUsbSerial->attach<SerialBuf>(this, &SerialBuf::onTxInterrupt, UsbSerial::TxIrq);
ninoderkinderen 0:8d87bc453349 171 onRxInterrupt(); //Read data
ninoderkinderen 0:8d87bc453349 172 }
ninoderkinderen 0:8d87bc453349 173 #endif
ninoderkinderen 0:8d87bc453349 174
ninoderkinderen 0:8d87bc453349 175 char SerialBuf::getc()
ninoderkinderen 0:8d87bc453349 176 {
ninoderkinderen 0:8d87bc453349 177 while(!readable());
ninoderkinderen 0:8d87bc453349 178 char c = m_rxBuf.read();
ninoderkinderen 0:8d87bc453349 179 return c;
ninoderkinderen 0:8d87bc453349 180 }
ninoderkinderen 0:8d87bc453349 181
ninoderkinderen 0:8d87bc453349 182 void SerialBuf::putc(char c)
ninoderkinderen 0:8d87bc453349 183 {
ninoderkinderen 0:8d87bc453349 184 while(!writeable());
ninoderkinderen 0:8d87bc453349 185 m_txBuf.write(c);
ninoderkinderen 0:8d87bc453349 186 onTxInterrupt();
ninoderkinderen 0:8d87bc453349 187 }
ninoderkinderen 0:8d87bc453349 188
ninoderkinderen 0:8d87bc453349 189 bool SerialBuf::readable()
ninoderkinderen 0:8d87bc453349 190 {
ninoderkinderen 0:8d87bc453349 191 if( !m_rxBuf.len() ) //Fill buf if possible
ninoderkinderen 0:8d87bc453349 192 onRxInterrupt();
ninoderkinderen 0:8d87bc453349 193 return (m_rxBuf.len() > 0);
ninoderkinderen 0:8d87bc453349 194 }
ninoderkinderen 0:8d87bc453349 195
ninoderkinderen 0:8d87bc453349 196 bool SerialBuf::writeable()
ninoderkinderen 0:8d87bc453349 197 {
ninoderkinderen 0:8d87bc453349 198 if( !m_txBuf.room() ) //Free buf is possible
ninoderkinderen 0:8d87bc453349 199 onTxInterrupt();
ninoderkinderen 0:8d87bc453349 200 return (m_txBuf.room() > 0);
ninoderkinderen 0:8d87bc453349 201 }
ninoderkinderen 0:8d87bc453349 202
ninoderkinderen 0:8d87bc453349 203 void SerialBuf::setReadMode(bool readMode) //If true, keeps chars in buf when read, false by default
ninoderkinderen 0:8d87bc453349 204 {
ninoderkinderen 0:8d87bc453349 205 m_rxBuf.setReadMode(readMode);
ninoderkinderen 0:8d87bc453349 206 }
ninoderkinderen 0:8d87bc453349 207
ninoderkinderen 0:8d87bc453349 208 void SerialBuf::flushRead() //Delete chars that have been read & return chars len (only useful with readMode = true)
ninoderkinderen 0:8d87bc453349 209 {
ninoderkinderen 0:8d87bc453349 210 m_rxBuf.flushRead();
ninoderkinderen 0:8d87bc453349 211 }
ninoderkinderen 0:8d87bc453349 212
ninoderkinderen 0:8d87bc453349 213 void SerialBuf::resetRead() //Go back to initial read position & return chars len (only useful with readMode = true)
ninoderkinderen 0:8d87bc453349 214 {
ninoderkinderen 0:8d87bc453349 215 m_rxBuf.resetRead();
ninoderkinderen 0:8d87bc453349 216 }
ninoderkinderen 0:8d87bc453349 217
ninoderkinderen 0:8d87bc453349 218 void SerialBuf::onRxInterrupt() //Callback from m_pSerial
ninoderkinderen 0:8d87bc453349 219 {
ninoderkinderen 0:8d87bc453349 220 while( m_rxBuf.room() && m_pStream(readable()) )
ninoderkinderen 0:8d87bc453349 221 {
ninoderkinderen 0:8d87bc453349 222 m_rxBuf.write(m_pStream(getc()));
ninoderkinderen 0:8d87bc453349 223 }
ninoderkinderen 0:8d87bc453349 224 }
ninoderkinderen 0:8d87bc453349 225
ninoderkinderen 0:8d87bc453349 226 void SerialBuf::onTxInterrupt() //Callback from m_pSerial
ninoderkinderen 0:8d87bc453349 227 {
ninoderkinderen 0:8d87bc453349 228 while( m_txBuf.len() && m_pStream(writeable()) )
ninoderkinderen 0:8d87bc453349 229 {
ninoderkinderen 0:8d87bc453349 230 m_pStream(putc(m_txBuf.read()));
ninoderkinderen 0:8d87bc453349 231 }
ninoderkinderen 0:8d87bc453349 232 }
ninoderkinderen 0:8d87bc453349 233
ninoderkinderen 0:8d87bc453349 234
ninoderkinderen 0:8d87bc453349 235 #endif