Andy Lustig / Mbed 2 deprecated stateScript_v2_karpova

Karpova Lab fork of stateScript

Dependencies:   SMARTWAV mbed

Fork of stateScript_v2 by Mattias Karlsson

hardwareInterface.cpp@0:8dbd6bd9167f, 2015-05-19 (annotated)

Committer:
mkarlsso
Date:
Tue May 19 15:45:42 2015 +0000
Revision:
0:8dbd6bd9167f
Child:
1:3a050d26d4f6
Child:
2:35266b266eaa
initial commit

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 0:8dbd6bd9167f 35
mkarlsso 0:8dbd6bd9167f 36 }
mkarlsso 0:8dbd6bd9167f 37
mkarlsso 0:8dbd6bd9167f 38 void sSystem::immediateClockReset() {
mkarlsso 0:8dbd6bd9167f 39 //For external clock reset
mkarlsso 0:8dbd6bd9167f 40 timeKeeper = 0;
mkarlsso 0:8dbd6bd9167f 41 textDisplay << timeKeeper << " Clock reset\r\n";
mkarlsso 0:8dbd6bd9167f 42 }
mkarlsso 0:8dbd6bd9167f 43
mkarlsso 0:8dbd6bd9167f 44 void sSystem::mainLoopToDo() {
mkarlsso 0:8dbd6bd9167f 45
mkarlsso 0:8dbd6bd9167f 46 }
mkarlsso 0:8dbd6bd9167f 47
mkarlsso 0:8dbd6bd9167f 48 void sSystem::pauseInterrupts() {
mkarlsso 0:8dbd6bd9167f 49
mkarlsso 0:8dbd6bd9167f 50 }
mkarlsso 0:8dbd6bd9167f 51
mkarlsso 0:8dbd6bd9167f 52 void sSystem::resumeInterrupts() {
mkarlsso 0:8dbd6bd9167f 53
mkarlsso 0:8dbd6bd9167f 54 }
mkarlsso 0:8dbd6bd9167f 55
mkarlsso 0:8dbd6bd9167f 56 int sSystem::getPendingFunctionTriggers(uint16_t *bufferPtr) {
mkarlsso 0:8dbd6bd9167f 57 return 0;
mkarlsso 0:8dbd6bd9167f 58 }
mkarlsso 0:8dbd6bd9167f 59
mkarlsso 0:8dbd6bd9167f 60 uint32_t sSystem::getDigitalOutputChangeFlags() {
mkarlsso 0:8dbd6bd9167f 61
mkarlsso 0:8dbd6bd9167f 62 }
mkarlsso 0:8dbd6bd9167f 63
mkarlsso 0:8dbd6bd9167f 64 uint32_t sSystem::getDigitalInputChangeFlags() {
mkarlsso 0:8dbd6bd9167f 65
mkarlsso 0:8dbd6bd9167f 66 }
mkarlsso 0:8dbd6bd9167f 67
mkarlsso 0:8dbd6bd9167f 68 //------------------------------------------------------
mkarlsso 0:8dbd6bd9167f 69 sDigitalOut::sDigitalOut() {
mkarlsso 0:8dbd6bd9167f 70
mkarlsso 0:8dbd6bd9167f 71 }
mkarlsso 0:8dbd6bd9167f 72
mkarlsso 0:8dbd6bd9167f 73 //----------------------------------------------------
mkarlsso 0:8dbd6bd9167f 74 sDigitalIn::sDigitalIn() {
mkarlsso 0:8dbd6bd9167f 75 lastDownEvent.triggered = false;
mkarlsso 0:8dbd6bd9167f 76 lastUpEvent.triggered = false;
mkarlsso 0:8dbd6bd9167f 77 }
mkarlsso 0:8dbd6bd9167f 78
mkarlsso 0:8dbd6bd9167f 79 void sDigitalIn::addStateChange(int newState, uint32_t timeStamp) {
mkarlsso 0:8dbd6bd9167f 80
mkarlsso 0:8dbd6bd9167f 81 //With levers and beam breaks, there will be flutter when triggers happen.
mkarlsso 0:8dbd6bd9167f 82 //The goal is to capture the initial event time, so we ignore extra triggers
mkarlsso 0:8dbd6bd9167f 83 //until it has been processed
mkarlsso 0:8dbd6bd9167f 84 if ((newState == 0) && (!lastDownEvent.triggered)){
mkarlsso 0:8dbd6bd9167f 85 lastDownEvent.timeStamp = timeStamp;
mkarlsso 0:8dbd6bd9167f 86 lastDownEvent.triggered = true;
mkarlsso 0:8dbd6bd9167f 87 } else if ((newState == 1) && (!lastUpEvent.triggered)) {
mkarlsso 0:8dbd6bd9167f 88 lastUpEvent.timeStamp = timeStamp;
mkarlsso 0:8dbd6bd9167f 89 lastUpEvent.triggered = true;
mkarlsso 0:8dbd6bd9167f 90 }
mkarlsso 0:8dbd6bd9167f 91 }
mkarlsso 0:8dbd6bd9167f 92
mkarlsso 0:8dbd6bd9167f 93 //-----------------------------------------------------
mkarlsso 0:8dbd6bd9167f 94 sSerialPort::sSerialPort() {
mkarlsso 0:8dbd6bd9167f 95
mkarlsso 0:8dbd6bd9167f 96 }
mkarlsso 0:8dbd6bd9167f 97
mkarlsso 0:8dbd6bd9167f 98 //------------------------------------------------------
mkarlsso 0:8dbd6bd9167f 99
mkarlsso 0:8dbd6bd9167f 100 sSound::sSound(void):
mkarlsso 0:8dbd6bd9167f 101 fileNameExists(false),
mkarlsso 0:8dbd6bd9167f 102 volumePtr(NULL),
mkarlsso 0:8dbd6bd9167f 103 volume(-1),
mkarlsso 0:8dbd6bd9167f 104 play(true),
mkarlsso 0:8dbd6bd9167f 105 reset(false) {
mkarlsso 0:8dbd6bd9167f 106 }
mkarlsso 0:8dbd6bd9167f 107
mkarlsso 0:8dbd6bd9167f 108 void sSound::setFile(string fileNameIn) {
mkarlsso 0:8dbd6bd9167f 109 for (int i = 0; i < 20; i++) {
mkarlsso 0:8dbd6bd9167f 110 fileName[i] = NULL;
mkarlsso 0:8dbd6bd9167f 111 }
mkarlsso 0:8dbd6bd9167f 112 size_t length = fileNameIn.size();
mkarlsso 0:8dbd6bd9167f 113 if (length <= 20) {
mkarlsso 0:8dbd6bd9167f 114 fileNameIn.copy(fileName, length, 0);
mkarlsso 0:8dbd6bd9167f 115 fileNameExists = true;
mkarlsso 0:8dbd6bd9167f 116 }
mkarlsso 0:8dbd6bd9167f 117 }
mkarlsso 0:8dbd6bd9167f 118 void sSound::setVolume(int volumeIn) {
mkarlsso 0:8dbd6bd9167f 119
mkarlsso 0:8dbd6bd9167f 120 if ((volumeIn >= 0) && (volumeIn < 256)) {
mkarlsso 0:8dbd6bd9167f 121 volume = volumeIn;
mkarlsso 0:8dbd6bd9167f 122 volumePtr = NULL;
mkarlsso 0:8dbd6bd9167f 123 }
mkarlsso 0:8dbd6bd9167f 124 }
mkarlsso 0:8dbd6bd9167f 125
mkarlsso 0:8dbd6bd9167f 126 void sSound::setVolume(int* volumeIn) {
mkarlsso 0:8dbd6bd9167f 127
mkarlsso 0:8dbd6bd9167f 128 volume = -1;
mkarlsso 0:8dbd6bd9167f 129 volumePtr = volumeIn;
mkarlsso 0:8dbd6bd9167f 130
mkarlsso 0:8dbd6bd9167f 131 }
mkarlsso 0:8dbd6bd9167f 132
mkarlsso 0:8dbd6bd9167f 133 void sSound::setPlayback(bool playIn) {
mkarlsso 0:8dbd6bd9167f 134 play = playIn;
mkarlsso 0:8dbd6bd9167f 135 }
mkarlsso 0:8dbd6bd9167f 136
mkarlsso 0:8dbd6bd9167f 137 void sSound::setReset() {
mkarlsso 0:8dbd6bd9167f 138 reset = true;
mkarlsso 0:8dbd6bd9167f 139 }
mkarlsso 0:8dbd6bd9167f 140
mkarlsso 0:8dbd6bd9167f 141
mkarlsso 0:8dbd6bd9167f 142 //-----------------------------------------------------
mkarlsso 0:8dbd6bd9167f 143 outputStream::outputStream(int bufferSizeIn):
mkarlsso 0:8dbd6bd9167f 144 readHead(0),
mkarlsso 0:8dbd6bd9167f 145 writeHead(0),
mkarlsso 0:8dbd6bd9167f 146 totalWriteHead(0),
mkarlsso 0:8dbd6bd9167f 147 totalReadHead(0),
mkarlsso 0:8dbd6bd9167f 148 bufferSize(bufferSizeIn),
mkarlsso 0:8dbd6bd9167f 149 unsentData(false),
mkarlsso 0:8dbd6bd9167f 150 serialPtr(NULL) {
mkarlsso 0:8dbd6bd9167f 151
mkarlsso 0:8dbd6bd9167f 152 outputBuffer = new char[bufferSize];
mkarlsso 0:8dbd6bd9167f 153
mkarlsso 0:8dbd6bd9167f 154 }
mkarlsso 0:8dbd6bd9167f 155
mkarlsso 0:8dbd6bd9167f 156 outputStream::~outputStream() {
mkarlsso 0:8dbd6bd9167f 157 delete[] outputBuffer;
mkarlsso 0:8dbd6bd9167f 158 }
mkarlsso 0:8dbd6bd9167f 159
mkarlsso 0:8dbd6bd9167f 160 void outputStream::setSerial(sSerialPort *s) {
mkarlsso 0:8dbd6bd9167f 161 serialPtr = s;
mkarlsso 0:8dbd6bd9167f 162 }
mkarlsso 0:8dbd6bd9167f 163
mkarlsso 0:8dbd6bd9167f 164 //used to immediately write to serial port
mkarlsso 0:8dbd6bd9167f 165 void outputStream::flush() {
mkarlsso 0:8dbd6bd9167f 166 if (serialPtr != NULL) {
mkarlsso 0:8dbd6bd9167f 167 while(unsentData) {
mkarlsso 0:8dbd6bd9167f 168 serialPtr->writeChar(getNextChar());
mkarlsso 0:8dbd6bd9167f 169 }
mkarlsso 0:8dbd6bd9167f 170 }
mkarlsso 0:8dbd6bd9167f 171 }
mkarlsso 0:8dbd6bd9167f 172
mkarlsso 0:8dbd6bd9167f 173 //adds text to the buffer
mkarlsso 0:8dbd6bd9167f 174 void outputStream::send(string outputString) {
mkarlsso 0:8dbd6bd9167f 175 int strLen = outputString.size();
mkarlsso 0:8dbd6bd9167f 176
mkarlsso 0:8dbd6bd9167f 177 int total = 0;
mkarlsso 0:8dbd6bd9167f 178 int chunk = 0;
mkarlsso 0:8dbd6bd9167f 179 if (totalWriteHead+strLen > (totalReadHead + bufferSize)) {
mkarlsso 0:8dbd6bd9167f 180 //We don't have enough space in the buffer, so flush it
mkarlsso 0:8dbd6bd9167f 181 flush();
mkarlsso 0:8dbd6bd9167f 182 }
mkarlsso 0:8dbd6bd9167f 183 if (!(totalWriteHead+strLen > (totalReadHead + bufferSize))) {
mkarlsso 0:8dbd6bd9167f 184 while (strLen - total > 0) {
mkarlsso 0:8dbd6bd9167f 185 chunk = min((bufferSize - writeHead), strLen - total);
mkarlsso 0:8dbd6bd9167f 186 outputString.copy(outputBuffer + writeHead, chunk, total);
mkarlsso 0:8dbd6bd9167f 187 writeHead = (writeHead + chunk) % bufferSize;
mkarlsso 0:8dbd6bd9167f 188 totalWriteHead += chunk;
mkarlsso 0:8dbd6bd9167f 189 total += chunk;
mkarlsso 0:8dbd6bd9167f 190 }
mkarlsso 0:8dbd6bd9167f 191 if (total > 0) {
mkarlsso 0:8dbd6bd9167f 192 unsentData = true;
mkarlsso 0:8dbd6bd9167f 193 }
mkarlsso 0:8dbd6bd9167f 194 }
mkarlsso 0:8dbd6bd9167f 195 }
mkarlsso 0:8dbd6bd9167f 196
mkarlsso 0:8dbd6bd9167f 197 void outputStream::debug(const char *s) {
mkarlsso 0:8dbd6bd9167f 198 //send to serial immediately, but only if debugOut is true
mkarlsso 0:8dbd6bd9167f 199 if (debugOut) {
mkarlsso 0:8dbd6bd9167f 200 string tmpString = string(s);
mkarlsso 0:8dbd6bd9167f 201 send(tmpString);
mkarlsso 0:8dbd6bd9167f 202 flush();
mkarlsso 0:8dbd6bd9167f 203 }
mkarlsso 0:8dbd6bd9167f 204 }
mkarlsso 0:8dbd6bd9167f 205
mkarlsso 0:8dbd6bd9167f 206 //Overloaded << operator to for debugging output. This eliminates the
mkarlsso 0:8dbd6bd9167f 207 //need for printf statements
mkarlsso 0:8dbd6bd9167f 208 outputStream& outputStream::operator<<(string outputString) {
mkarlsso 0:8dbd6bd9167f 209 send(outputString);
mkarlsso 0:8dbd6bd9167f 210 return *this;
mkarlsso 0:8dbd6bd9167f 211 }
mkarlsso 0:8dbd6bd9167f 212
mkarlsso 0:8dbd6bd9167f 213 outputStream& outputStream::operator<<(const char* s) {
mkarlsso 0:8dbd6bd9167f 214 string tmpString = string(s);
mkarlsso 0:8dbd6bd9167f 215 send(tmpString);
mkarlsso 0:8dbd6bd9167f 216 return *this;
mkarlsso 0:8dbd6bd9167f 217 }
mkarlsso 0:8dbd6bd9167f 218
mkarlsso 0:8dbd6bd9167f 219 outputStream& outputStream::operator<<(int outputNum) {
mkarlsso 0:8dbd6bd9167f 220 ostringstream varConvert;
mkarlsso 0:8dbd6bd9167f 221 varConvert << outputNum;
mkarlsso 0:8dbd6bd9167f 222 send(varConvert.str());
mkarlsso 0:8dbd6bd9167f 223 return *this;
mkarlsso 0:8dbd6bd9167f 224 }
mkarlsso 0:8dbd6bd9167f 225
mkarlsso 0:8dbd6bd9167f 226 outputStream& outputStream::operator<<(uint32_t outputNum) {
mkarlsso 0:8dbd6bd9167f 227 ostringstream varConvert;
mkarlsso 0:8dbd6bd9167f 228 varConvert << outputNum;
mkarlsso 0:8dbd6bd9167f 229 send(varConvert.str());
mkarlsso 0:8dbd6bd9167f 230 return *this;
mkarlsso 0:8dbd6bd9167f 231 }
mkarlsso 0:8dbd6bd9167f 232 //the main loop gets one character per loop and write it to the serial port
mkarlsso 0:8dbd6bd9167f 233 char outputStream::getNextChar() {
mkarlsso 0:8dbd6bd9167f 234
mkarlsso 0:8dbd6bd9167f 235
mkarlsso 0:8dbd6bd9167f 236 if (totalReadHead < totalWriteHead) {
mkarlsso 0:8dbd6bd9167f 237 tmpOut = *(outputBuffer+readHead);
mkarlsso 0:8dbd6bd9167f 238 readHead = (readHead+1) % bufferSize;
mkarlsso 0:8dbd6bd9167f 239 totalReadHead++;
mkarlsso 0:8dbd6bd9167f 240 if (totalReadHead >= totalWriteHead) {
mkarlsso 0:8dbd6bd9167f 241 unsentData = false;
mkarlsso 0:8dbd6bd9167f 242 }
mkarlsso 0:8dbd6bd9167f 243 }
mkarlsso 0:8dbd6bd9167f 244 return tmpOut;
mkarlsso 0:8dbd6bd9167f 245
mkarlsso 0:8dbd6bd9167f 246 }
mkarlsso 0:8dbd6bd9167f 247
mkarlsso 0:8dbd6bd9167f 248