Erick / Mbed 2 deprecated ICE_BLE_TEST

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   NaturalTinyShell_ice libmDot-12Sept mbed-rtos mbed

Fork of ICE by Erick

src/ConfigurationHandler/Controls/CompositeControl.cpp@276:851554207c77, 2016-10-26 (annotated)

Committer:
jmarkel44
Date:
Wed Oct 26 20:31:39 2016 +0000
Revision:
276:851554207c77
Parent:
253:ae850c19cf81 
cJSON frees

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jmarkel44 164:7cecd731882e 1 /******************************************************************************
jmarkel44 164:7cecd731882e 2 *
jmarkel44 164:7cecd731882e 3 * File: CompositeControl.cpp
jmarkel44 164:7cecd731882e 4 * Desciption: ICE Composite Control Class implementation
jmarkel44 164:7cecd731882e 5 *
jmarkel44 164:7cecd731882e 6 *****************************************************************************/
jmarkel44 164:7cecd731882e 7 #include "CompositeControl.h"
jmarkel44 221:2a5e9902003c 8 #include "ConfigurationHandler.h"
jmarkel44 164:7cecd731882e 9 #include "mDot.h"
jmarkel44 242:3b0086a6d625 10 #include "cJSON.h"
jmarkel44 164:7cecd731882e 11 #include "ModbusMasterApi.h"
jmarkel44 164:7cecd731882e 12 #include "global.h"
jmarkel44 164:7cecd731882e 13 #include <string>
jmarkel44 232:8a86b5bf38f7 14 #include <iostream>
jmarkel44 232:8a86b5bf38f7 15 #include <iomanip>
jmarkel44 164:7cecd731882e 16
jmarkel44 164:7cecd731882e 17 extern mDot *GLOBAL_mdot;
jmarkel44 164:7cecd731882e 18
jmarkel44 221:2a5e9902003c 19 //
jmarkel44 221:2a5e9902003c 20 // method: load
jmarkel44 221:2a5e9902003c 21 // description: load a composite control
jmarkel44 221:2a5e9902003c 22 //
jmarkel44 221:2a5e9902003c 23 // @param none
jmarkel44 221:2a5e9902003c 24 // @return none
jmarkel44 221:2a5e9902003c 25 //
jmarkel44 220:dbe21411f962 26 bool CompositeControl::load(std::string _controlFile)
jmarkel44 164:7cecd731882e 27 {
jmarkel44 220:dbe21411f962 28 controlFile = _controlFile;
jmarkel44 220:dbe21411f962 29
jmarkel44 220:dbe21411f962 30 // open and read from the control file
jmarkel44 220:dbe21411f962 31 mDot::mdot_file file = GLOBAL_mdot->openUserFile(controlFile.c_str(), mDot::FM_RDONLY);
jmarkel44 220:dbe21411f962 32 if ( file.fd < 0 ) {
jmarkel44 220:dbe21411f962 33 logError("%s: failed to open %s\n", __func__, controlFile.c_str());
jmarkel44 220:dbe21411f962 34 return false;
jmarkel44 220:dbe21411f962 35 }
jmarkel44 220:dbe21411f962 36
jmarkel44 220:dbe21411f962 37 // read the data into a buffer
jmarkel44 220:dbe21411f962 38 char dataBuf[MAX_FILE_SIZE];
jmarkel44 220:dbe21411f962 39
jmarkel44 220:dbe21411f962 40 int bytes_read = GLOBAL_mdot->readUserFile(file, (void *)dataBuf, sizeof(dataBuf));
jmarkel44 220:dbe21411f962 41 if ( bytes_read != sizeof(dataBuf) ) {
jmarkel44 220:dbe21411f962 42 logError("%s: failed to read %d bytes from %s", __func__, sizeof(dataBuf), controlFile.c_str());
jmarkel44 220:dbe21411f962 43 // caller should destroy the object
jmarkel44 220:dbe21411f962 44 return false;
jmarkel44 220:dbe21411f962 45 }
jmarkel44 220:dbe21411f962 46
jmarkel44 220:dbe21411f962 47 // close the file
jmarkel44 220:dbe21411f962 48 GLOBAL_mdot->closeUserFile(file);
jmarkel44 220:dbe21411f962 49
jmarkel44 242:3b0086a6d625 50 cJSON * root = cJSON_Parse(dataBuf);
jmarkel44 242:3b0086a6d625 51 id = cJSON_GetObjectItem(root,"id")->valuestring;
jmarkel44 242:3b0086a6d625 52 tag = cJSON_GetObjectItem(root, "tag")->valuestring;
jmarkel44 242:3b0086a6d625 53 priority = atoi(cJSON_GetObjectItem(root, "priority")->valuestring);
jmarkel44 242:3b0086a6d625 54 ca = cJSON_GetObjectItem(root, "ca")->valuestring;
jmarkel44 242:3b0086a6d625 55 cJSON *array = cJSON_GetObjectItem(root, "outputs");
jmarkel44 242:3b0086a6d625 56 for ( int i = 0; i < cJSON_GetArraySize(array); ++i ) {
jmarkel44 242:3b0086a6d625 57 cJSON *subitem = cJSON_GetArrayItem(array, i);
jmarkel44 242:3b0086a6d625 58 std::string tag = cJSON_GetObjectItem(subitem, "tag")->valuestring;
jmarkel44 242:3b0086a6d625 59 std::string response = cJSON_GetObjectItem(subitem, "responseA")->valuestring;
jmarkel44 242:3b0086a6d625 60 OutputElement x = { tag, response };
jmarkel44 242:3b0086a6d625 61 outputs.push_back(x);
jmarkel44 220:dbe21411f962 62 }
jmarkel44 276:851554207c77 63
jmarkel44 276:851554207c77 64 cJSON_Delete(root);
jmarkel44 220:dbe21411f962 65
jmarkel44 164:7cecd731882e 66 return true;
jmarkel44 164:7cecd731882e 67 }
jmarkel44 164:7cecd731882e 68
jmarkel44 221:2a5e9902003c 69 //
jmarkel44 221:2a5e9902003c 70 // method: start
jmarkel44 221:2a5e9902003c 71 // description: start the composite control
jmarkel44 221:2a5e9902003c 72 //
jmarkel44 221:2a5e9902003c 73 // @param none
jmarkel44 221:2a5e9902003c 74 // @return none
jmarkel44 221:2a5e9902003c 75 //
jmarkel44 221:2a5e9902003c 76 void CompositeControl::start(void)
jmarkel44 221:2a5e9902003c 77 {
jmarkel44 221:2a5e9902003c 78 currentState = STATE_START;
jmarkel44 221:2a5e9902003c 79 }
jmarkel44 221:2a5e9902003c 80
jmarkel44 221:2a5e9902003c 81 //
jmarkel44 221:2a5e9902003c 82 // method: update
jmarkel44 221:2a5e9902003c 83 // description: updater for the composite control
jmarkel44 221:2a5e9902003c 84 //
jmarkel44 221:2a5e9902003c 85 // @param none
jmarkel44 221:2a5e9902003c 86 // @return none
jmarkel44 230:11765008ff3a 87 //
jmarkel44 221:2a5e9902003c 88 void CompositeControl::update(void)
jmarkel44 164:7cecd731882e 89 {
jmarkel44 221:2a5e9902003c 90 std::string function;
jmarkel44 221:2a5e9902003c 91
jmarkel44 221:2a5e9902003c 92 switch ( currentState ) {
jmarkel44 221:2a5e9902003c 93 case STATE_INIT:
jmarkel44 221:2a5e9902003c 94 // do nothing
jmarkel44 221:2a5e9902003c 95 break;
jmarkel44 221:2a5e9902003c 96 case STATE_START:
jmarkel44 221:2a5e9902003c 97 function = executeCommand();
jmarkel44 221:2a5e9902003c 98 if ( function == "responseA" ) {
jmarkel44 221:2a5e9902003c 99 currentState = STATE_CONTROL_ON;
jmarkel44 221:2a5e9902003c 100 triggerOutputs(function);
jmarkel44 221:2a5e9902003c 101 } else if ( function == "nothing" ) {
jmarkel44 221:2a5e9902003c 102 currentState = STATE_CONTROL_OFF;
jmarkel44 221:2a5e9902003c 103 }
jmarkel44 221:2a5e9902003c 104 break;
jmarkel44 221:2a5e9902003c 105 case STATE_CONTROL_ON:
jmarkel44 221:2a5e9902003c 106 function = executeCommand();
jmarkel44 221:2a5e9902003c 107 if ( function == "nothing" ) {
jmarkel44 221:2a5e9902003c 108 currentState = STATE_CONTROL_OFF;
jmarkel44 221:2a5e9902003c 109 unregisterControls();
jmarkel44 221:2a5e9902003c 110 } else {
jmarkel44 221:2a5e9902003c 111 // do nothing
jmarkel44 221:2a5e9902003c 112 }
jmarkel44 221:2a5e9902003c 113 break;
jmarkel44 221:2a5e9902003c 114 case STATE_CONTROL_OFF:
jmarkel44 221:2a5e9902003c 115 function = executeCommand();
jmarkel44 221:2a5e9902003c 116 if ( function == "responseA" ) {
jmarkel44 221:2a5e9902003c 117 currentState = STATE_CONTROL_ON;
jmarkel44 221:2a5e9902003c 118 triggerOutputs(function);
jmarkel44 221:2a5e9902003c 119 } else {
jmarkel44 221:2a5e9902003c 120 // do nothing
jmarkel44 221:2a5e9902003c 121 }
jmarkel44 221:2a5e9902003c 122 break;
jmarkel44 221:2a5e9902003c 123 default:
jmarkel44 221:2a5e9902003c 124 break;
jmarkel44 221:2a5e9902003c 125 }
jmarkel44 221:2a5e9902003c 126 }
jmarkel44 221:2a5e9902003c 127
jmarkel44 230:11765008ff3a 128 //
jmarkel44 221:2a5e9902003c 129 // method: executeCommand
jmarkel44 221:2a5e9902003c 130 // description: execute the command specified in the control algorithm
jmarkel44 221:2a5e9902003c 131 //
jmarkel44 221:2a5e9902003c 132 // @param none
jmarkel44 221:2a5e9902003c 133 // @return none
jmarkel44 221:2a5e9902003c 134 //
jmarkel44 221:2a5e9902003c 135 std::string CompositeControl::executeCommand(void)
jmarkel44 221:2a5e9902003c 136 {
jmarkel44 221:2a5e9902003c 137 // look up the algorithm
jmarkel44 221:2a5e9902003c 138 StringAlgorithmMap::iterator pos;
jmarkel44 221:2a5e9902003c 139 pos = algorithmTable.find(this->ca);
jmarkel44 221:2a5e9902003c 140 if ( pos != algorithmTable.end() ) {
jmarkel44 221:2a5e9902003c 141 // we found the control algorithm
jmarkel44 221:2a5e9902003c 142 return this->executeOperation(pos->second);
jmarkel44 221:2a5e9902003c 143 }
jmarkel44 221:2a5e9902003c 144 return "nothing";
jmarkel44 220:dbe21411f962 145 }
jmarkel44 220:dbe21411f962 146
jmarkel44 221:2a5e9902003c 147 //
jmarkel44 221:2a5e9902003c 148 // method: executeOperation
jmarkel44 221:2a5e9902003c 149 // description: execute an operations from the control equation
jmarkel44 221:2a5e9902003c 150 //
jmarkel44 221:2a5e9902003c 151 // @param ca -> composite control algorithm
jmarkel44 221:2a5e9902003c 152 // @return string to the result
jmarkel44 221:2a5e9902003c 153 //
jmarkel44 221:2a5e9902003c 154 std::string CompositeControl::executeOperation(const CompositeAlgorithm *ca)
jmarkel44 221:2a5e9902003c 155 {
jmarkel44 221:2a5e9902003c 156 // (this->tag) <op> <opr> = <result>
jmarkel44 221:2a5e9902003c 157 //
jmarkel44 221:2a5e9902003c 158 // example:
jmarkel44 221:2a5e9902003c 159 // this->tag = "i_flowswitch"
jmarkel44 221:2a5e9902003c 160 // opr = "1"
jmarkel44 221:2a5e9902003c 161 // op = "=="
jmarkel44 221:2a5e9902003c 162 // if true return "responseA" else return "nothing"
jmarkel44 221:2a5e9902003c 163
jmarkel44 221:2a5e9902003c 164 ModbusValue value;
jmarkel44 221:2a5e9902003c 165 bool rc = ModbusMasterReadRegister(tag,&value);
jmarkel44 221:2a5e9902003c 166 if ( rc != true ) {
jmarkel44 231:f22901955e0c 167 logError("%s cannot find tag", __func__);
jmarkel44 221:2a5e9902003c 168 return "nothing";
jmarkel44 221:2a5e9902003c 169 }
jmarkel44 221:2a5e9902003c 170
jmarkel44 230:11765008ff3a 171 // equal to operator
jmarkel44 221:2a5e9902003c 172 if ( ca->getOp() == "==" ) {
jmarkel44 230:11765008ff3a 173 // perform the equality operation
jmarkel44 221:2a5e9902003c 174 if ( value.value == atof(ca->getOpr().c_str()) ) {
jmarkel44 221:2a5e9902003c 175 return ca->getResultTrue();
jmarkel44 221:2a5e9902003c 176 } else {
jmarkel44 221:2a5e9902003c 177 return ca->getResultFalse();
jmarkel44 221:2a5e9902003c 178 }
jmarkel44 221:2a5e9902003c 179 }
jmarkel44 230:11765008ff3a 180 if ( ca->getOp() == ">=" ) {
jmarkel44 230:11765008ff3a 181 if ( value.value >= atof(ca->getOpr().c_str()) ) {
jmarkel44 232:8a86b5bf38f7 182 return ca->getResultTrue();
jmarkel44 230:11765008ff3a 183 } else {
jmarkel44 230:11765008ff3a 184 return ca->getResultFalse();
jmarkel44 230:11765008ff3a 185 }
jmarkel44 230:11765008ff3a 186 }
jmarkel44 230:11765008ff3a 187 // addition operator
jmarkel44 221:2a5e9902003c 188 if ( ca->getOp() == "+" ) {
jmarkel44 227:7153e89b6974 189 // TODO
jmarkel44 221:2a5e9902003c 190 }
jmarkel44 230:11765008ff3a 191 // multiply operator
jmarkel44 227:7153e89b6974 192 if ( ca->getOp() == "*" ) {
jmarkel44 230:11765008ff3a 193 // TODO:
jmarkel44 227:7153e89b6974 194 }
jmarkel44 230:11765008ff3a 195 // subtraction operator
jmarkel44 227:7153e89b6974 196 if ( ca->getOp() == "-" ) {
jmarkel44 227:7153e89b6974 197 // TODO:
jmarkel44 227:7153e89b6974 198 }
jmarkel44 230:11765008ff3a 199
jmarkel44 221:2a5e9902003c 200 return "nothing";
jmarkel44 221:2a5e9902003c 201 }
jmarkel44 221:2a5e9902003c 202
jmarkel44 221:2a5e9902003c 203 //
jmarkel44 221:2a5e9902003c 204 // method: triggerOutputs
jmarkel44 221:2a5e9902003c 205 // description: trigger the output(s) to do something
jmarkel44 221:2a5e9902003c 206 //
jmarkel44 221:2a5e9902003c 207 // @param result -> the result of the operation
jmarkel44 221:2a5e9902003c 208 // @return none
jmarkel44 221:2a5e9902003c 209 //
jmarkel44 221:2a5e9902003c 210 void CompositeControl::triggerOutputs(std::string result)
jmarkel44 221:2a5e9902003c 211 {
jmarkel44 221:2a5e9902003c 212
jmarkel44 221:2a5e9902003c 213 // loop through the list
jmarkel44 221:2a5e9902003c 214 StringAlgorithmMap::iterator pos;
jmarkel44 221:2a5e9902003c 215 pos = algorithmTable.find(this->ca);
jmarkel44 221:2a5e9902003c 216 if ( pos != algorithmTable.end() ) {
jmarkel44 221:2a5e9902003c 217 std::vector<OutputElement>::iterator it;
jmarkel44 221:2a5e9902003c 218 for ( it = outputs.begin(); it != outputs.end(); ++it ) {
jmarkel44 221:2a5e9902003c 219 if ( it->response == "fixed off" ) {
jmarkel44 221:2a5e9902003c 220 printf("\rSending an OFF control for %s\n", it->tag.c_str());
jmarkel44 221:2a5e9902003c 221 sendMail(it->tag, ACTION_CONTROL_OFF);
jmarkel44 221:2a5e9902003c 222 } else if ( it->response == "fixed on" ) {
jmarkel44 221:2a5e9902003c 223 printf("\rSending an ON request for %s\n", it->tag.c_str());
jmarkel44 221:2a5e9902003c 224 sendMail(it->tag, ACTION_CONTROL_ON);
jmarkel44 221:2a5e9902003c 225 }
jmarkel44 221:2a5e9902003c 226 }
jmarkel44 221:2a5e9902003c 227 } else {
jmarkel44 221:2a5e9902003c 228 logError("%s: failed to find the control algorithm %s\n", __func__, this->ca.c_str());
jmarkel44 221:2a5e9902003c 229 }
jmarkel44 221:2a5e9902003c 230 }
jmarkel44 221:2a5e9902003c 231
jmarkel44 221:2a5e9902003c 232 //
jmarkel44 221:2a5e9902003c 233 // method: sendMail
jmarkel44 221:2a5e9902003c 234 // description: send mail to the output task
jmarkel44 221:2a5e9902003c 235 //
jmarkel44 221:2a5e9902003c 236 // @param io_tag -> input/output tag
jmarkel44 221:2a5e9902003c 237 // @param action -> ON, OFF, UNREGISTER
jmarkel44 221:2a5e9902003c 238 // @return none
jmarkel44 221:2a5e9902003c 239 //
jmarkel44 221:2a5e9902003c 240 void CompositeControl::sendMail(const std::string io_tag, OutputAction action)
jmarkel44 221:2a5e9902003c 241 {
jmarkel44 222:94ea9a091d99 242 logInfo("%s: composite control attempting to send action %d\n",
jmarkel44 222:94ea9a091d99 243 __func__, action);
jmarkel44 221:2a5e9902003c 244
jmarkel44 221:2a5e9902003c 245 OutputControlMsg_t *output_mail = OutputMasterMailBox.alloc();
jmarkel44 221:2a5e9902003c 246 memset(output_mail, 0, sizeof(OutputControlMsg_t));
jmarkel44 221:2a5e9902003c 247
jmarkel44 227:7153e89b6974 248 output_mail->action = action;
jmarkel44 227:7153e89b6974 249 output_mail->controlType = CONTROL_COMPOSITE;
jmarkel44 227:7153e89b6974 250 output_mail->priority = this->priority;
jmarkel44 227:7153e89b6974 251
jmarkel44 221:2a5e9902003c 252 strncpy(output_mail->input_tag, this->tag.c_str(), sizeof(output_mail->input_tag)-1);
jmarkel44 221:2a5e9902003c 253 strncpy(output_mail->output_tag, io_tag.c_str(), sizeof(output_mail->output_tag)-1);
jmarkel44 221:2a5e9902003c 254 strncpy(output_mail->id, this->id.c_str(), sizeof(output_mail->id)-1);
jmarkel44 230:11765008ff3a 255
jmarkel44 221:2a5e9902003c 256 OutputMasterMailBox.put(output_mail);
jmarkel44 221:2a5e9902003c 257 }
jmarkel44 221:2a5e9902003c 258
jmarkel44 221:2a5e9902003c 259 //
jmarkel44 221:2a5e9902003c 260 // method: unregisterControls
jmarkel44 221:2a5e9902003c 261 // description: unregister the control with the output task
jmarkel44 230:11765008ff3a 262 //
jmarkel44 221:2a5e9902003c 263 // @param none
jmarkel44 221:2a5e9902003c 264 // @return none
jmarkel44 221:2a5e9902003c 265 //
jmarkel44 221:2a5e9902003c 266 void CompositeControl::unregisterControls(void)
jmarkel44 221:2a5e9902003c 267 {
jmarkel44 221:2a5e9902003c 268 // loop through the list
jmarkel44 221:2a5e9902003c 269 StringAlgorithmMap::iterator pos;
jmarkel44 221:2a5e9902003c 270 pos = algorithmTable.find(this->ca);
jmarkel44 221:2a5e9902003c 271 if ( pos != algorithmTable.end() ) {
jmarkel44 221:2a5e9902003c 272 std::vector<OutputElement>::iterator it;
jmarkel44 221:2a5e9902003c 273 for ( it = outputs.begin(); it != outputs.end(); ++it ) {
jmarkel44 221:2a5e9902003c 274 sendMail(it->tag, ACTION_CONTROL_UNREGISTER);
jmarkel44 221:2a5e9902003c 275 }
jmarkel44 221:2a5e9902003c 276 } else {
jmarkel44 221:2a5e9902003c 277 logError("%s: failed to find the control algorithm %s\n", __func__, this->ca.c_str());
jmarkel44 221:2a5e9902003c 278 }
jmarkel44 221:2a5e9902003c 279 }
jmarkel44 221:2a5e9902003c 280
jmarkel44 221:2a5e9902003c 281 //
jmarkel44 232:8a86b5bf38f7 282 // method: display
jmarkel44 221:2a5e9902003c 283 // description: display the pertinents
jmarkel44 221:2a5e9902003c 284 //
jmarkel44 221:2a5e9902003c 285 // @param none
jmarkel44 221:2a5e9902003c 286 // @return none
jmarkel44 221:2a5e9902003c 287 //
jmarkel44 220:dbe21411f962 288 void CompositeControl::display(void)
jmarkel44 220:dbe21411f962 289 {
jmarkel44 221:2a5e9902003c 290 const char *mapper[] = { "INIT",
jmarkel44 221:2a5e9902003c 291 "START",
jmarkel44 221:2a5e9902003c 292 "CONTROL_OFF",
jmarkel44 242:3b0086a6d625 293 "CONTROL_ON"
jmarkel44 242:3b0086a6d625 294 };
jmarkel44 232:8a86b5bf38f7 295
jmarkel44 242:3b0086a6d625 296 printf("\r\n");
jmarkel44 232:8a86b5bf38f7 297 std::cout << left << setw(10) << setfill(' ') << "composite: ";
jmarkel44 253:ae850c19cf81 298 std::cout << left << setw(40) << setfill(' ') << controlFile;
jmarkel44 232:8a86b5bf38f7 299 std::cout << left << setw(20) << setfill(' ') << id;
jmarkel44 232:8a86b5bf38f7 300 std::cout << left << setw(20) << setfill(' ') << tag;
jmarkel44 232:8a86b5bf38f7 301 std::cout << left << setw(6) << setfill(' ') << priority;
jmarkel44 232:8a86b5bf38f7 302 std::cout << left << setw(20) << setfill(' ') << ca;
jmarkel44 232:8a86b5bf38f7 303 std::cout << left << setw(16) << setfill(' ') << mapper[currentState];
jmarkel44 221:2a5e9902003c 304
jmarkel44 220:dbe21411f962 305 vector<OutputElement>::iterator it;
jmarkel44 220:dbe21411f962 306 for ( it = outputs.begin(); it != outputs.end(); ++it ) {
jmarkel44 232:8a86b5bf38f7 307 std::cout << left << (*it).tag << ":" << (*it).response << " ";
jmarkel44 220:dbe21411f962 308 }
jmarkel44 232:8a86b5bf38f7 309
jmarkel44 232:8a86b5bf38f7 310 std::cout.flush();
jmarkel44 232:8a86b5bf38f7 311
jmarkel44 164:7cecd731882e 312 }