Library for Bert van Dam's book "ARM MICROCONTROLLERS" For all chapters with internet.

Dependencies:   mbed

Committer:
ICTFBI
Date:
Fri Oct 16 14:28:26 2015 +0000
Revision:
0:4edb816d21e1
Pre-update 16-10-15

Who changed what in which revision?

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