Mattias Karlsson / Mbed 2 deprecated stateScript_v2

Microcontroller firmware that uses a simple, yet powerful scripting language to control the timing of input and output events with high temporal resolution. Written by Mattias Karlsson

Dependencies:   SMARTWAV mbed

hardwareInterface.cpp@3:d7b0a0890d96, 2015-10-10 (annotated)

Committer:
mkarlsso
Date:
Sat Oct 10 22:37:17 2015 +0000
Revision:
3:d7b0a0890d96
Parent:
2:35266b266eaa
Child:
6:6a6761a47951
Changes ports for new PCB board

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mkarlsso 0:8dbd6bd9167f 1 #include "hardwareInterface.h"
mkarlsso 0:8dbd6bd9167f 2 //#include <ostream>
mkarlsso 0:8dbd6bd9167f 3 #include <sstream>
mkarlsso 0:8dbd6bd9167f 4
mkarlsso 0:8dbd6bd9167f 5 using namespace std;
mkarlsso 0:8dbd6bd9167f 6
mkarlsso 0:8dbd6bd9167f 7 //In debug mode, debug messages output to the screen
mkarlsso 0:8dbd6bd9167f 8 #ifdef DEBUGOUTPUT
mkarlsso 0:8dbd6bd9167f 9 bool debugOut = true;
mkarlsso 0:8dbd6bd9167f 10 #else
mkarlsso 0:8dbd6bd9167f 11 bool debugOut = false;
mkarlsso 0:8dbd6bd9167f 12 #endif
mkarlsso 0:8dbd6bd9167f 13
mkarlsso 0:8dbd6bd9167f 14 uint32_t timeKeeper; //the main clock (updated every ms)
mkarlsso 0:8dbd6bd9167f 15 bool resetTimer;
mkarlsso 0:8dbd6bd9167f 16 bool clockSlave;
mkarlsso 0:8dbd6bd9167f 17 bool changeToSlave;
mkarlsso 0:8dbd6bd9167f 18 bool changeToStandAlone;
mkarlsso 0:8dbd6bd9167f 19
mkarlsso 0:8dbd6bd9167f 20
mkarlsso 0:8dbd6bd9167f 21 #ifdef MBEDHARDWARE
mkarlsso 0:8dbd6bd9167f 22
mkarlsso 0:8dbd6bd9167f 23 //On the MBED, this needs to be put on a defined bank of memory, or else we run out of memory
mkarlsso 0:8dbd6bd9167f 24 __attribute((section("AHBSRAM0"),aligned)) outputStream textDisplay(512);
mkarlsso 0:8dbd6bd9167f 25
mkarlsso 0:8dbd6bd9167f 26 #else
mkarlsso 0:8dbd6bd9167f 27 outputStream textDisplay(256);
mkarlsso 0:8dbd6bd9167f 28
mkarlsso 0:8dbd6bd9167f 29 #endif
mkarlsso 0:8dbd6bd9167f 30
mkarlsso 0:8dbd6bd9167f 31
mkarlsso 0:8dbd6bd9167f 32 //---------------------------------------------------------
mkarlsso 0:8dbd6bd9167f 33
mkarlsso 0:8dbd6bd9167f 34 sSystem::sSystem() {
mkarlsso 3:d7b0a0890d96 35 for (int i=0;i<32;i++) {
mkarlsso 3:d7b0a0890d96 36 ignorePortUpdates[i] = false;
mkarlsso 3:d7b0a0890d96 37 }
mkarlsso 3:d7b0a0890d96 38 }
mkarlsso 0:8dbd6bd9167f 39
mkarlsso 3:d7b0a0890d96 40 //The user can toggle whether a particular port triggers a state update report every time it changes
mkarlsso 3:d7b0a0890d96 41 //This is useful for inputs that toggle continuously.
mkarlsso 3:d7b0a0890d96 42 void sSystem::setPortUpdatesOff(int portNum) {
mkarlsso 3:d7b0a0890d96 43 ignorePortUpdates[portNum] = true;
mkarlsso 3:d7b0a0890d96 44 }
mkarlsso 3:d7b0a0890d96 45
mkarlsso 3:d7b0a0890d96 46 void sSystem::setPortUpdatesOn(int portNum) {
mkarlsso 3:d7b0a0890d96 47 ignorePortUpdates[portNum] = false;
mkarlsso 3:d7b0a0890d96 48 }
mkarlsso 3:d7b0a0890d96 49
mkarlsso 3:d7b0a0890d96 50 bool* sSystem::getIgnoreUpdates() {
mkarlsso 3:d7b0a0890d96 51 return ignorePortUpdates;
mkarlsso 0:8dbd6bd9167f 52 }
mkarlsso 0:8dbd6bd9167f 53
mkarlsso 0:8dbd6bd9167f 54 void sSystem::immediateClockReset() {
mkarlsso 0:8dbd6bd9167f 55 //For external clock reset
mkarlsso 0:8dbd6bd9167f 56 timeKeeper = 0;
mkarlsso 0:8dbd6bd9167f 57 textDisplay << timeKeeper << " Clock reset\r\n";
mkarlsso 0:8dbd6bd9167f 58 }
mkarlsso 0:8dbd6bd9167f 59
mkarlsso 0:8dbd6bd9167f 60 void sSystem::mainLoopToDo() {
mkarlsso 0:8dbd6bd9167f 61
mkarlsso 0:8dbd6bd9167f 62 }
mkarlsso 0:8dbd6bd9167f 63
mkarlsso 0:8dbd6bd9167f 64 void sSystem::pauseInterrupts() {
mkarlsso 0:8dbd6bd9167f 65
mkarlsso 0:8dbd6bd9167f 66 }
mkarlsso 0:8dbd6bd9167f 67
mkarlsso 0:8dbd6bd9167f 68 void sSystem::resumeInterrupts() {
mkarlsso 0:8dbd6bd9167f 69
mkarlsso 0:8dbd6bd9167f 70 }
mkarlsso 0:8dbd6bd9167f 71
mkarlsso 0:8dbd6bd9167f 72 int sSystem::getPendingFunctionTriggers(uint16_t *bufferPtr) {
mkarlsso 0:8dbd6bd9167f 73 return 0;
mkarlsso 0:8dbd6bd9167f 74 }
mkarlsso 0:8dbd6bd9167f 75
mkarlsso 0:8dbd6bd9167f 76 uint32_t sSystem::getDigitalOutputChangeFlags() {
mkarlsso 0:8dbd6bd9167f 77
mkarlsso 0:8dbd6bd9167f 78 }
mkarlsso 0:8dbd6bd9167f 79
mkarlsso 0:8dbd6bd9167f 80 uint32_t sSystem::getDigitalInputChangeFlags() {
mkarlsso 0:8dbd6bd9167f 81
mkarlsso 0:8dbd6bd9167f 82 }
mkarlsso 0:8dbd6bd9167f 83
mkarlsso 0:8dbd6bd9167f 84 //------------------------------------------------------
mkarlsso 0:8dbd6bd9167f 85 sDigitalOut::sDigitalOut() {
mkarlsso 0:8dbd6bd9167f 86
mkarlsso 0:8dbd6bd9167f 87 }
mkarlsso 0:8dbd6bd9167f 88
mkarlsso 0:8dbd6bd9167f 89 //----------------------------------------------------
mkarlsso 0:8dbd6bd9167f 90 sDigitalIn::sDigitalIn() {
mkarlsso 0:8dbd6bd9167f 91 lastDownEvent.triggered = false;
mkarlsso 0:8dbd6bd9167f 92 lastUpEvent.triggered = false;
mkarlsso 2:35266b266eaa 93 bufferedDownEvent.triggered = false;
mkarlsso 2:35266b266eaa 94 bufferedUpEvent.triggered = false;
mkarlsso 2:35266b266eaa 95 updating = false;
mkarlsso 0:8dbd6bd9167f 96 }
mkarlsso 0:8dbd6bd9167f 97
mkarlsso 0:8dbd6bd9167f 98 void sDigitalIn::addStateChange(int newState, uint32_t timeStamp) {
mkarlsso 0:8dbd6bd9167f 99
mkarlsso 0:8dbd6bd9167f 100 //With levers and beam breaks, there will be flutter when triggers happen.
mkarlsso 0:8dbd6bd9167f 101 //The goal is to capture the initial event time, so we ignore extra triggers
mkarlsso 0:8dbd6bd9167f 102 //until it has been processed
mkarlsso 2:35266b266eaa 103 if (!updating) {
mkarlsso 2:35266b266eaa 104 if ((newState == 0) && (!lastDownEvent.triggered)){
mkarlsso 2:35266b266eaa 105 lastDownEvent.timeStamp = timeStamp;
mkarlsso 2:35266b266eaa 106 lastDownEvent.triggered = true;
mkarlsso 2:35266b266eaa 107 } else if ((newState == 1) && (!lastUpEvent.triggered)) {
mkarlsso 2:35266b266eaa 108 lastUpEvent.timeStamp = timeStamp;
mkarlsso 2:35266b266eaa 109 lastUpEvent.triggered = true;
mkarlsso 2:35266b266eaa 110 }
mkarlsso 2:35266b266eaa 111 } else {
mkarlsso 2:35266b266eaa 112 //If we are currently checking this input, then we buffer the trigger and deal with it after
mkarlsso 2:35266b266eaa 113 if (newState == 0){
mkarlsso 2:35266b266eaa 114 bufferedDownEvent.timeStamp = timeStamp;
mkarlsso 2:35266b266eaa 115 bufferedDownEvent.triggered = true;
mkarlsso 2:35266b266eaa 116 } else if (newState == 1) {
mkarlsso 2:35266b266eaa 117 bufferedUpEvent.timeStamp = timeStamp;
mkarlsso 2:35266b266eaa 118 bufferedUpEvent.triggered = true;
mkarlsso 2:35266b266eaa 119 }
mkarlsso 2:35266b266eaa 120 }
mkarlsso 2:35266b266eaa 121 /*
mkarlsso 0:8dbd6bd9167f 122 if ((newState == 0) && (!lastDownEvent.triggered)){
mkarlsso 0:8dbd6bd9167f 123 lastDownEvent.timeStamp = timeStamp;
mkarlsso 0:8dbd6bd9167f 124 lastDownEvent.triggered = true;
mkarlsso 0:8dbd6bd9167f 125 } else if ((newState == 1) && (!lastUpEvent.triggered)) {
mkarlsso 0:8dbd6bd9167f 126 lastUpEvent.timeStamp = timeStamp;
mkarlsso 0:8dbd6bd9167f 127 lastUpEvent.triggered = true;
mkarlsso 2:35266b266eaa 128 }*/
mkarlsso 2:35266b266eaa 129 }
mkarlsso 2:35266b266eaa 130
mkarlsso 2:35266b266eaa 131 void sDigitalIn::setUpdate(bool state) {
mkarlsso 2:35266b266eaa 132 updating = state; //If true, then we buffer any trigger events until the update check is done.
mkarlsso 2:35266b266eaa 133 if (!updating) {
mkarlsso 2:35266b266eaa 134 if (bufferedUpEvent.triggered) {
mkarlsso 2:35266b266eaa 135 lastUpEvent = bufferedUpEvent;
mkarlsso 2:35266b266eaa 136 }
mkarlsso 2:35266b266eaa 137 if (bufferedDownEvent.triggered) {
mkarlsso 2:35266b266eaa 138 lastDownEvent = bufferedDownEvent;
mkarlsso 2:35266b266eaa 139 }
mkarlsso 2:35266b266eaa 140 bufferedDownEvent.triggered = false;
mkarlsso 2:35266b266eaa 141 bufferedUpEvent.triggered = false;
mkarlsso 0:8dbd6bd9167f 142 }
mkarlsso 0:8dbd6bd9167f 143 }
mkarlsso 0:8dbd6bd9167f 144
mkarlsso 0:8dbd6bd9167f 145 //-----------------------------------------------------
mkarlsso 0:8dbd6bd9167f 146 sSerialPort::sSerialPort() {
mkarlsso 0:8dbd6bd9167f 147
mkarlsso 0:8dbd6bd9167f 148 }
mkarlsso 0:8dbd6bd9167f 149
mkarlsso 0:8dbd6bd9167f 150 //------------------------------------------------------
mkarlsso 0:8dbd6bd9167f 151
mkarlsso 0:8dbd6bd9167f 152 sSound::sSound(void):
mkarlsso 0:8dbd6bd9167f 153 fileNameExists(false),
mkarlsso 0:8dbd6bd9167f 154 volumePtr(NULL),
mkarlsso 0:8dbd6bd9167f 155 volume(-1),
mkarlsso 0:8dbd6bd9167f 156 play(true),
mkarlsso 0:8dbd6bd9167f 157 reset(false) {
mkarlsso 0:8dbd6bd9167f 158 }
mkarlsso 0:8dbd6bd9167f 159
mkarlsso 0:8dbd6bd9167f 160 void sSound::setFile(string fileNameIn) {
mkarlsso 0:8dbd6bd9167f 161 for (int i = 0; i < 20; i++) {
mkarlsso 0:8dbd6bd9167f 162 fileName[i] = NULL;
mkarlsso 0:8dbd6bd9167f 163 }
mkarlsso 0:8dbd6bd9167f 164 size_t length = fileNameIn.size();
mkarlsso 0:8dbd6bd9167f 165 if (length <= 20) {
mkarlsso 0:8dbd6bd9167f 166 fileNameIn.copy(fileName, length, 0);
mkarlsso 0:8dbd6bd9167f 167 fileNameExists = true;
mkarlsso 0:8dbd6bd9167f 168 }
mkarlsso 0:8dbd6bd9167f 169 }
mkarlsso 0:8dbd6bd9167f 170 void sSound::setVolume(int volumeIn) {
mkarlsso 0:8dbd6bd9167f 171
mkarlsso 0:8dbd6bd9167f 172 if ((volumeIn >= 0) && (volumeIn < 256)) {
mkarlsso 0:8dbd6bd9167f 173 volume = volumeIn;
mkarlsso 0:8dbd6bd9167f 174 volumePtr = NULL;
mkarlsso 0:8dbd6bd9167f 175 }
mkarlsso 0:8dbd6bd9167f 176 }
mkarlsso 0:8dbd6bd9167f 177
mkarlsso 0:8dbd6bd9167f 178 void sSound::setVolume(int* volumeIn) {
mkarlsso 0:8dbd6bd9167f 179
mkarlsso 0:8dbd6bd9167f 180 volume = -1;
mkarlsso 0:8dbd6bd9167f 181 volumePtr = volumeIn;
mkarlsso 0:8dbd6bd9167f 182
mkarlsso 0:8dbd6bd9167f 183 }
mkarlsso 0:8dbd6bd9167f 184
mkarlsso 0:8dbd6bd9167f 185 void sSound::setPlayback(bool playIn) {
mkarlsso 0:8dbd6bd9167f 186 play = playIn;
mkarlsso 0:8dbd6bd9167f 187 }
mkarlsso 0:8dbd6bd9167f 188
mkarlsso 0:8dbd6bd9167f 189 void sSound::setReset() {
mkarlsso 0:8dbd6bd9167f 190 reset = true;
mkarlsso 0:8dbd6bd9167f 191 }
mkarlsso 0:8dbd6bd9167f 192
mkarlsso 0:8dbd6bd9167f 193
mkarlsso 0:8dbd6bd9167f 194 //-----------------------------------------------------
mkarlsso 0:8dbd6bd9167f 195 outputStream::outputStream(int bufferSizeIn):
mkarlsso 0:8dbd6bd9167f 196 readHead(0),
mkarlsso 0:8dbd6bd9167f 197 writeHead(0),
mkarlsso 0:8dbd6bd9167f 198 totalWriteHead(0),
mkarlsso 0:8dbd6bd9167f 199 totalReadHead(0),
mkarlsso 0:8dbd6bd9167f 200 bufferSize(bufferSizeIn),
mkarlsso 0:8dbd6bd9167f 201 unsentData(false),
mkarlsso 0:8dbd6bd9167f 202 serialPtr(NULL) {
mkarlsso 0:8dbd6bd9167f 203
mkarlsso 0:8dbd6bd9167f 204 outputBuffer = new char[bufferSize];
mkarlsso 0:8dbd6bd9167f 205
mkarlsso 0:8dbd6bd9167f 206 }
mkarlsso 0:8dbd6bd9167f 207
mkarlsso 0:8dbd6bd9167f 208 outputStream::~outputStream() {
mkarlsso 0:8dbd6bd9167f 209 delete[] outputBuffer;
mkarlsso 0:8dbd6bd9167f 210 }
mkarlsso 0:8dbd6bd9167f 211
mkarlsso 0:8dbd6bd9167f 212 void outputStream::setSerial(sSerialPort *s) {
mkarlsso 0:8dbd6bd9167f 213 serialPtr = s;
mkarlsso 0:8dbd6bd9167f 214 }
mkarlsso 0:8dbd6bd9167f 215
mkarlsso 0:8dbd6bd9167f 216 //used to immediately write to serial port
mkarlsso 0:8dbd6bd9167f 217 void outputStream::flush() {
mkarlsso 0:8dbd6bd9167f 218 if (serialPtr != NULL) {
mkarlsso 0:8dbd6bd9167f 219 while(unsentData) {
mkarlsso 0:8dbd6bd9167f 220 serialPtr->writeChar(getNextChar());
mkarlsso 0:8dbd6bd9167f 221 }
mkarlsso 0:8dbd6bd9167f 222 }
mkarlsso 0:8dbd6bd9167f 223 }
mkarlsso 0:8dbd6bd9167f 224
mkarlsso 0:8dbd6bd9167f 225 //adds text to the buffer
mkarlsso 3:d7b0a0890d96 226 void outputStream::send(const string &outputString) {
mkarlsso 0:8dbd6bd9167f 227 int strLen = outputString.size();
mkarlsso 0:8dbd6bd9167f 228
mkarlsso 0:8dbd6bd9167f 229 int total = 0;
mkarlsso 0:8dbd6bd9167f 230 int chunk = 0;
mkarlsso 0:8dbd6bd9167f 231 if (totalWriteHead+strLen > (totalReadHead + bufferSize)) {
mkarlsso 0:8dbd6bd9167f 232 //We don't have enough space in the buffer, so flush it
mkarlsso 0:8dbd6bd9167f 233 flush();
mkarlsso 0:8dbd6bd9167f 234 }
mkarlsso 0:8dbd6bd9167f 235 if (!(totalWriteHead+strLen > (totalReadHead + bufferSize))) {
mkarlsso 0:8dbd6bd9167f 236 while (strLen - total > 0) {
mkarlsso 0:8dbd6bd9167f 237 chunk = min((bufferSize - writeHead), strLen - total);
mkarlsso 0:8dbd6bd9167f 238 outputString.copy(outputBuffer + writeHead, chunk, total);
mkarlsso 0:8dbd6bd9167f 239 writeHead = (writeHead + chunk) % bufferSize;
mkarlsso 0:8dbd6bd9167f 240 totalWriteHead += chunk;
mkarlsso 0:8dbd6bd9167f 241 total += chunk;
mkarlsso 0:8dbd6bd9167f 242 }
mkarlsso 0:8dbd6bd9167f 243 if (total > 0) {
mkarlsso 0:8dbd6bd9167f 244 unsentData = true;
mkarlsso 0:8dbd6bd9167f 245 }
mkarlsso 0:8dbd6bd9167f 246 }
mkarlsso 0:8dbd6bd9167f 247 }
mkarlsso 0:8dbd6bd9167f 248
mkarlsso 3:d7b0a0890d96 249 //adds text to the buffer
mkarlsso 3:d7b0a0890d96 250 void outputStream::send(const char *s) {
mkarlsso 3:d7b0a0890d96 251 int strLen = strlen(s);
mkarlsso 3:d7b0a0890d96 252
mkarlsso 3:d7b0a0890d96 253 int total = 0;
mkarlsso 3:d7b0a0890d96 254 //int chunk = 0;
mkarlsso 3:d7b0a0890d96 255 if (totalWriteHead+strLen > (totalReadHead + bufferSize)) {
mkarlsso 3:d7b0a0890d96 256 //We don't have enough space in the buffer, so flush it
mkarlsso 3:d7b0a0890d96 257 flush();
mkarlsso 3:d7b0a0890d96 258 }
mkarlsso 3:d7b0a0890d96 259 if (!(totalWriteHead+strLen > (totalReadHead + bufferSize))) {
mkarlsso 3:d7b0a0890d96 260 while (strLen - total > 0) {
mkarlsso 3:d7b0a0890d96 261 strncpy(outputBuffer + writeHead, s+total,1);
mkarlsso 3:d7b0a0890d96 262 total++;
mkarlsso 3:d7b0a0890d96 263 writeHead = (writeHead + 1) % bufferSize;
mkarlsso 3:d7b0a0890d96 264 totalWriteHead += 1;
mkarlsso 3:d7b0a0890d96 265
mkarlsso 3:d7b0a0890d96 266 /*
mkarlsso 3:d7b0a0890d96 267 chunk = min((bufferSize - writeHead), strLen - total);
mkarlsso 3:d7b0a0890d96 268 strncpy(outputBuffer + writeHead,);
mkarlsso 3:d7b0a0890d96 269 outputString.copy(outputBuffer + writeHead, chunk, total);
mkarlsso 3:d7b0a0890d96 270 writeHead = (writeHead + chunk) % bufferSize;
mkarlsso 3:d7b0a0890d96 271 totalWriteHead += chunk;
mkarlsso 3:d7b0a0890d96 272 total += chunk;
mkarlsso 3:d7b0a0890d96 273 */
mkarlsso 3:d7b0a0890d96 274 }
mkarlsso 3:d7b0a0890d96 275 if (total > 0) {
mkarlsso 3:d7b0a0890d96 276 unsentData = true;
mkarlsso 3:d7b0a0890d96 277 }
mkarlsso 3:d7b0a0890d96 278 }
mkarlsso 3:d7b0a0890d96 279 }
mkarlsso 3:d7b0a0890d96 280
mkarlsso 0:8dbd6bd9167f 281 void outputStream::debug(const char *s) {
mkarlsso 0:8dbd6bd9167f 282 //send to serial immediately, but only if debugOut is true
mkarlsso 0:8dbd6bd9167f 283 if (debugOut) {
mkarlsso 0:8dbd6bd9167f 284 string tmpString = string(s);
mkarlsso 0:8dbd6bd9167f 285 send(tmpString);
mkarlsso 0:8dbd6bd9167f 286 flush();
mkarlsso 0:8dbd6bd9167f 287 }
mkarlsso 0:8dbd6bd9167f 288 }
mkarlsso 0:8dbd6bd9167f 289
mkarlsso 0:8dbd6bd9167f 290 //Overloaded << operator to for debugging output. This eliminates the
mkarlsso 0:8dbd6bd9167f 291 //need for printf statements
mkarlsso 3:d7b0a0890d96 292 outputStream& outputStream::operator<<(const string &outputString) {
mkarlsso 0:8dbd6bd9167f 293 send(outputString);
mkarlsso 3:d7b0a0890d96 294
mkarlsso 0:8dbd6bd9167f 295 return *this;
mkarlsso 0:8dbd6bd9167f 296 }
mkarlsso 0:8dbd6bd9167f 297
mkarlsso 0:8dbd6bd9167f 298 outputStream& outputStream::operator<<(const char* s) {
mkarlsso 3:d7b0a0890d96 299 //string tmpString = string(s);
mkarlsso 3:d7b0a0890d96 300 //send(tmpString);
mkarlsso 3:d7b0a0890d96 301 send(s);
mkarlsso 0:8dbd6bd9167f 302 return *this;
mkarlsso 0:8dbd6bd9167f 303 }
mkarlsso 0:8dbd6bd9167f 304
mkarlsso 0:8dbd6bd9167f 305 outputStream& outputStream::operator<<(int outputNum) {
mkarlsso 0:8dbd6bd9167f 306 ostringstream varConvert;
mkarlsso 0:8dbd6bd9167f 307 varConvert << outputNum;
mkarlsso 0:8dbd6bd9167f 308 send(varConvert.str());
mkarlsso 0:8dbd6bd9167f 309 return *this;
mkarlsso 0:8dbd6bd9167f 310 }
mkarlsso 0:8dbd6bd9167f 311
mkarlsso 0:8dbd6bd9167f 312 outputStream& outputStream::operator<<(uint32_t outputNum) {
mkarlsso 0:8dbd6bd9167f 313 ostringstream varConvert;
mkarlsso 0:8dbd6bd9167f 314 varConvert << outputNum;
mkarlsso 0:8dbd6bd9167f 315 send(varConvert.str());
mkarlsso 0:8dbd6bd9167f 316 return *this;
mkarlsso 0:8dbd6bd9167f 317 }
mkarlsso 0:8dbd6bd9167f 318 //the main loop gets one character per loop and write it to the serial port
mkarlsso 0:8dbd6bd9167f 319 char outputStream::getNextChar() {
mkarlsso 0:8dbd6bd9167f 320
mkarlsso 0:8dbd6bd9167f 321
mkarlsso 0:8dbd6bd9167f 322 if (totalReadHead < totalWriteHead) {
mkarlsso 0:8dbd6bd9167f 323 tmpOut = *(outputBuffer+readHead);
mkarlsso 0:8dbd6bd9167f 324 readHead = (readHead+1) % bufferSize;
mkarlsso 0:8dbd6bd9167f 325 totalReadHead++;
mkarlsso 0:8dbd6bd9167f 326 if (totalReadHead >= totalWriteHead) {
mkarlsso 0:8dbd6bd9167f 327 unsentData = false;
mkarlsso 0:8dbd6bd9167f 328 }
mkarlsso 0:8dbd6bd9167f 329 }
mkarlsso 0:8dbd6bd9167f 330 return tmpOut;
mkarlsso 0:8dbd6bd9167f 331
mkarlsso 0:8dbd6bd9167f 332 }
mkarlsso 0:8dbd6bd9167f 333
mkarlsso 0:8dbd6bd9167f 334