Hendrik Vincent / Mbed 2 deprecated Weerstation

Leest de waarde van een sensor binnen een maakt deze beschikbaar via internet

Dependencies:   NTPClient_NetServices mbed

NetServices/drv/serial/buf/SerialBuf.cpp@0:05ccbd4f84f1, 2013-12-02 (annotated)

Committer:
hendrikvincent
Date:
Mon Dec 02 09:01:23 2013 +0000
Revision:
0:05ccbd4f84f1
eerste programma;

Who changed what in which revision?

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