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/ConfigurationHandler.cpp@121:650205ffa656, 2016-09-23 (annotated)

Committer:
jmarkel44
Date:
Fri Sep 23 12:45:49 2016 +0000
Revision:
121:650205ffa656
Parent:
97:5cf6ab71dcd0
Child:
122:4db48b933115
event logging of manual controls;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jmarkel44 0:65cfa4873284 1 /******************************************************************************
jmarkel44 0:65cfa4873284 2 *
jmarkel44 0:65cfa4873284 3 * File: ConfigurationHandler.cpp
jmarkel44 0:65cfa4873284 4 * Desciption: source for the ICE Configuration Handler
jmarkel44 0:65cfa4873284 5 *
jmarkel44 0:65cfa4873284 6 *****************************************************************************/
jmarkel44 3:8ea4db957749 7 #include "ConfigurationHandler.h"
jmarkel44 0:65cfa4873284 8 #include "global.h"
jmarkel44 5:5e77a1db4d45 9 #include "SetpointControl.h"
jmarkel44 12:ea87887ca7ad 10 #include "TimerControl.h"
jmarkel44 12:ea87887ca7ad 11
jmarkel44 46:4cb96ab2d1c8 12 StringSetpointMap setpointTable; // setpoint control object table
jmarkel44 46:4cb96ab2d1c8 13 StringTimerMap timerTable; // timer control object table
jmarkel44 97:5cf6ab71dcd0 14 StringManualMap manualTable; // manual control object table
jmarkel44 5:5e77a1db4d45 15
jmarkel44 5:5e77a1db4d45 16 // local function prototypes
jmarkel44 5:5e77a1db4d45 17 static int loadPersistentControls(void);
jmarkel44 5:5e77a1db4d45 18
jmarkel44 74:03ccf04998b5 19 // local helper functions
jmarkel44 5:5e77a1db4d45 20 static int createControl(const Message_t *msg);
jmarkel44 5:5e77a1db4d45 21 static int modifyControl(const Message_t *msg);
jmarkel44 5:5e77a1db4d45 22 static int destroyControl(const Message_t *msg);
jmarkel44 5:5e77a1db4d45 23
jmarkel44 12:ea87887ca7ad 24 /*****************************************************************************
jmarkel44 12:ea87887ca7ad 25 * Function: ConfigurationHandler()
jmarkel44 12:ea87887ca7ad 26 * Description: The ICE Configuration Handler
jmarkel44 12:ea87887ca7ad 27 *
jmarkel44 12:ea87887ca7ad 28 * @param args (unused)
jmarkel44 12:ea87887ca7ad 29 * @return none
jmarkel44 12:ea87887ca7ad 30 *****************************************************************************/
jmarkel44 0:65cfa4873284 31 void ConfigurationHandler(void const *args)
jmarkel44 0:65cfa4873284 32 {
jmarkel44 12:ea87887ca7ad 33 UNUSED(args);
jmarkel44 5:5e77a1db4d45 34 loadPersistentControls();
jmarkel44 75:96512ccc0443 35 osSignalSet(mainThreadId, sig_config_continue);
jmarkel44 5:5e77a1db4d45 36
jmarkel44 3:8ea4db957749 37 while ( true ) {
jmarkel44 5:5e77a1db4d45 38 // wait for an event
jmarkel44 5:5e77a1db4d45 39 osEvent evt = MailBox.get();
jmarkel44 5:5e77a1db4d45 40 if (evt.status == osEventMail) {
jmarkel44 5:5e77a1db4d45 41 Message_t *msg = (Message_t*) evt.value.p;
jmarkel44 5:5e77a1db4d45 42
jmarkel44 37:7e6986b77f01 43 logInfo("\r%s: mes->action = %d\n", __func__, msg->action);
jmarkel44 37:7e6986b77f01 44 logInfo("\r%s: msg->control = %d\n", __func__, msg->control);
jmarkel44 37:7e6986b77f01 45 logInfo("\r%s: msg->controlFile = %s\n", __func__, msg->controlFile);
jmarkel44 5:5e77a1db4d45 46
jmarkel44 5:5e77a1db4d45 47 switch ( msg->action ) {
jmarkel44 5:5e77a1db4d45 48 case ACTION_CREATE: {
jmarkel44 5:5e77a1db4d45 49 (void)createControl(msg);
jmarkel44 5:5e77a1db4d45 50 break;
jmarkel44 5:5e77a1db4d45 51 }
jmarkel44 5:5e77a1db4d45 52 case ACTION_MODIFY: {
jmarkel44 5:5e77a1db4d45 53 (void)modifyControl(msg);
jmarkel44 5:5e77a1db4d45 54 break;
jmarkel44 5:5e77a1db4d45 55 }
jmarkel44 5:5e77a1db4d45 56 case ACTION_DESTROY: {
jmarkel44 5:5e77a1db4d45 57 (void)destroyControl(msg);
jmarkel44 5:5e77a1db4d45 58 break;
jmarkel44 5:5e77a1db4d45 59 }
jmarkel44 5:5e77a1db4d45 60 default:
jmarkel44 5:5e77a1db4d45 61 break;
jmarkel44 5:5e77a1db4d45 62 }
jmarkel44 5:5e77a1db4d45 63
jmarkel44 5:5e77a1db4d45 64 // free the message
jmarkel44 5:5e77a1db4d45 65 MailBox.free(msg);
jmarkel44 5:5e77a1db4d45 66 }
jmarkel44 0:65cfa4873284 67 }
jmarkel44 0:65cfa4873284 68 }
jmarkel44 5:5e77a1db4d45 69
jmarkel44 12:ea87887ca7ad 70 /*****************************************************************************
jmarkel44 12:ea87887ca7ad 71 * Function: ConfigurationHandler_showControls()
jmarkel44 13:c80c283f9db2 72 * Description: show the controls
jmarkel44 12:ea87887ca7ad 73 *
jmarkel44 12:ea87887ca7ad 74 * @param msg
jmarkel44 12:ea87887ca7ad 75 * @return none
jmarkel44 12:ea87887ca7ad 76 *****************************************************************************/
jmarkel44 12:ea87887ca7ad 77 void ConfigurationHandler_showControls(void)
jmarkel44 12:ea87887ca7ad 78 {
jmarkel44 12:ea87887ca7ad 79 if ( !timerTable.empty() ) {
jmarkel44 12:ea87887ca7ad 80 printf("\rTIMER CONTROLS\n");
jmarkel44 12:ea87887ca7ad 81 StringTimerMap::iterator pos;
jmarkel44 46:4cb96ab2d1c8 82 for ( pos = timerTable.begin(); pos != timerTable.end(); ++pos ) {
jmarkel44 46:4cb96ab2d1c8 83 printf("\r control file: %32s\n",
jmarkel44 46:4cb96ab2d1c8 84 pos->second->getControlFile().c_str());
jmarkel44 12:ea87887ca7ad 85 }
jmarkel44 12:ea87887ca7ad 86 }
jmarkel44 74:03ccf04998b5 87
jmarkel44 12:ea87887ca7ad 88 if ( !setpointTable.empty() ) {
jmarkel44 12:ea87887ca7ad 89 printf("\rSETPOINT CONTROLS\n");
jmarkel44 12:ea87887ca7ad 90 StringSetpointMap::iterator pos;
jmarkel44 93:1553fb156915 91 for ( pos = setpointTable.begin(); pos != setpointTable.end(); ++pos ) {
jmarkel44 93:1553fb156915 92 pos->second->display();
jmarkel44 12:ea87887ca7ad 93 }
jmarkel44 12:ea87887ca7ad 94 }
jmarkel44 121:650205ffa656 95
jmarkel44 97:5cf6ab71dcd0 96 if ( !manualTable.empty() ) {
jmarkel44 97:5cf6ab71dcd0 97 printf("MANUAL CONTROLS\n");
jmarkel44 97:5cf6ab71dcd0 98 StringManualMap::iterator pos;
jmarkel44 97:5cf6ab71dcd0 99 for ( pos = manualTable.begin(); pos != manualTable.end(); ++pos ) {
jmarkel44 97:5cf6ab71dcd0 100 pos->second->display();
jmarkel44 97:5cf6ab71dcd0 101 }
jmarkel44 97:5cf6ab71dcd0 102 }
jmarkel44 12:ea87887ca7ad 103 }
jmarkel44 12:ea87887ca7ad 104
jmarkel44 12:ea87887ca7ad 105 /*****************************************************************************
jmarkel44 12:ea87887ca7ad 106 * Function: loadPersistentControls()
jmarkel44 12:ea87887ca7ad 107 * Description: load persistent controls from flash
jmarkel44 12:ea87887ca7ad 108 *
jmarkel44 12:ea87887ca7ad 109 * @param none
jmarkel44 12:ea87887ca7ad 110 * @return none
jmarkel44 12:ea87887ca7ad 111 *****************************************************************************/
jmarkel44 12:ea87887ca7ad 112 static int loadPersistentControls(void)
jmarkel44 12:ea87887ca7ad 113 {
jmarkel44 12:ea87887ca7ad 114 static bool loaded = false;
jmarkel44 12:ea87887ca7ad 115
jmarkel44 12:ea87887ca7ad 116 if ( !loaded ) { // lazy protection
jmarkel44 121:650205ffa656 117
jmarkel44 77:43e0a3d9e536 118 printf("\rLoading persistent controls: \n");
jmarkel44 74:03ccf04998b5 119 std::vector<mDot::mdot_file> file_list = GLOBAL_mdot->listUserFiles();
jmarkel44 74:03ccf04998b5 120
jmarkel44 74:03ccf04998b5 121 for (std::vector<mDot::mdot_file>::iterator i = file_list.begin(); i != file_list.end(); ++i) {
jmarkel44 74:03ccf04998b5 122 if( strncmp( i->name, CONTROL_SP_STR, strlen(CONTROL_SP_STR)) == 0 ) {
jmarkel44 77:43e0a3d9e536 123 // create the setpoint control
jmarkel44 74:03ccf04998b5 124 Message_t msg;
jmarkel44 74:03ccf04998b5 125 msg.control = CONTROL_SETPOINT;
jmarkel44 74:03ccf04998b5 126 strncpy(msg.controlFile, i->name, sizeof(msg.controlFile));
jmarkel44 74:03ccf04998b5 127 int rc = createControl(&msg);
jmarkel44 74:03ccf04998b5 128 if ( rc != 0 ) {
jmarkel44 121:650205ffa656 129 logError("%s: failed to load %s", __func__, msg.controlFile);
jmarkel44 74:03ccf04998b5 130 } else {
jmarkel44 74:03ccf04998b5 131 printf("\r control %s loaded.\n", msg.controlFile);
jmarkel44 74:03ccf04998b5 132 }
jmarkel44 74:03ccf04998b5 133 } else if ( strncmp( i->name, CONTROL_TM_STR, strlen(CONTROL_TM_STR)) == 0 ) {
jmarkel44 121:650205ffa656 134 // create the timer control
jmarkel44 74:03ccf04998b5 135 Message_t msg;
jmarkel44 74:03ccf04998b5 136 msg.control = CONTROL_TIMER;
jmarkel44 74:03ccf04998b5 137 strncpy(msg.controlFile, i->name, sizeof(msg.controlFile));
jmarkel44 74:03ccf04998b5 138 int rc = createControl(&msg);
jmarkel44 74:03ccf04998b5 139 if ( rc != 0 ) {
jmarkel44 121:650205ffa656 140 logError("%s: failed to load %s", __func__, msg.controlFile);
jmarkel44 121:650205ffa656 141
jmarkel44 74:03ccf04998b5 142 } else {
jmarkel44 74:03ccf04998b5 143 printf("\r control %s loaded.\n", msg.controlFile);
jmarkel44 74:03ccf04998b5 144 }
jmarkel44 74:03ccf04998b5 145 } else if ( strncmp( i->name, CONTROL_MN_STR, strlen(CONTROL_MN_STR)) == 0 ) {
jmarkel44 77:43e0a3d9e536 146 // TODO: load the manual control -> these may not persist??
jmarkel44 121:650205ffa656 147 // do nothing
jmarkel44 74:03ccf04998b5 148 } else {
jmarkel44 74:03ccf04998b5 149 // not a control file
jmarkel44 74:03ccf04998b5 150 }
jmarkel44 74:03ccf04998b5 151 }
jmarkel44 12:ea87887ca7ad 152 }
jmarkel44 12:ea87887ca7ad 153 return 0;
jmarkel44 12:ea87887ca7ad 154 }
jmarkel44 12:ea87887ca7ad 155
jmarkel44 12:ea87887ca7ad 156 /*****************************************************************************
jmarkel44 12:ea87887ca7ad 157 * Function: createControl()
jmarkel44 12:ea87887ca7ad 158 * Description: creates a new control
jmarkel44 12:ea87887ca7ad 159 *
jmarkel44 12:ea87887ca7ad 160 * @param none
jmarkel44 12:ea87887ca7ad 161 * @return none
jmarkel44 12:ea87887ca7ad 162 *****************************************************************************/
jmarkel44 5:5e77a1db4d45 163 static int createControl(const Message_t *msg)
jmarkel44 5:5e77a1db4d45 164 {
jmarkel44 37:7e6986b77f01 165 logInfo("\r%s invoked\n", __func__);
jmarkel44 5:5e77a1db4d45 166
jmarkel44 5:5e77a1db4d45 167 switch (msg->control) {
jmarkel44 5:5e77a1db4d45 168 case CONTROL_SETPOINT: {
jmarkel44 46:4cb96ab2d1c8 169 SetpointControl *setpointControl = new SetpointControl;
jmarkel44 28:c410a61238bb 170 bool rc = setpointControl->load(msg->controlFile);
jmarkel44 19:9bc8fabeddfa 171 if ( rc != true ) {
jmarkel44 19:9bc8fabeddfa 172 logError("%s: failed to load %s\n", __func__, msg->controlFile);
jmarkel44 19:9bc8fabeddfa 173 delete setpointControl;
jmarkel44 19:9bc8fabeddfa 174 } else {
jmarkel44 19:9bc8fabeddfa 175 setpointTable[msg->controlFile] = setpointControl;
jmarkel44 74:03ccf04998b5 176 // start the setpoint control
jmarkel44 74:03ccf04998b5 177 setpointControl->start();
jmarkel44 19:9bc8fabeddfa 178 }
jmarkel44 5:5e77a1db4d45 179 break;
jmarkel44 5:5e77a1db4d45 180 }
jmarkel44 5:5e77a1db4d45 181 case CONTROL_TIMER: {
jmarkel44 46:4cb96ab2d1c8 182 TimerControl *timerControl = new TimerControl;
jmarkel44 28:c410a61238bb 183 bool rc = timerControl->load(msg->controlFile);
jmarkel44 19:9bc8fabeddfa 184 if ( rc != true ) {
jmarkel44 19:9bc8fabeddfa 185 logError("%s: failed to load %s\n", __func__, msg->controlFile);
jmarkel44 19:9bc8fabeddfa 186 delete timerControl;
jmarkel44 19:9bc8fabeddfa 187 } else {
jmarkel44 19:9bc8fabeddfa 188 timerTable[msg->controlFile] = timerControl;
jmarkel44 19:9bc8fabeddfa 189 }
jmarkel44 5:5e77a1db4d45 190 break;
jmarkel44 5:5e77a1db4d45 191 }
jmarkel44 46:4cb96ab2d1c8 192 case CONTROL_MANUAL: {
jmarkel44 46:4cb96ab2d1c8 193 ManualControl *manualControl = new ManualControl;
jmarkel44 46:4cb96ab2d1c8 194 bool rc = manualControl->load(msg->controlFile);
jmarkel44 46:4cb96ab2d1c8 195 if ( rc != true ) {
jmarkel44 46:4cb96ab2d1c8 196 logError("%s: failed to load %s\n", __func__, msg->controlFile);
jmarkel44 46:4cb96ab2d1c8 197 delete manualControl;
jmarkel44 46:4cb96ab2d1c8 198 } else {
jmarkel44 46:4cb96ab2d1c8 199 manualTable[msg->controlFile] = manualControl;
jmarkel44 97:5cf6ab71dcd0 200 // start the manual control
jmarkel44 97:5cf6ab71dcd0 201 manualControl->start();
jmarkel44 46:4cb96ab2d1c8 202 }
jmarkel44 46:4cb96ab2d1c8 203 break;
jmarkel44 46:4cb96ab2d1c8 204 }
jmarkel44 19:9bc8fabeddfa 205 case CONTROL_PID:
jmarkel44 19:9bc8fabeddfa 206 case CONTROL_COMPOSITE:
jmarkel44 5:5e77a1db4d45 207 default:
jmarkel44 46:4cb96ab2d1c8 208 logInfo("\r%s: control type %d not implemented yet...\n",
jmarkel44 46:4cb96ab2d1c8 209 __func__, msg->control);
jmarkel44 5:5e77a1db4d45 210 break;
jmarkel44 5:5e77a1db4d45 211 }
jmarkel44 5:5e77a1db4d45 212 return 0;
jmarkel44 5:5e77a1db4d45 213 }
jmarkel44 12:ea87887ca7ad 214
jmarkel44 12:ea87887ca7ad 215 /*****************************************************************************
jmarkel44 12:ea87887ca7ad 216 * Function: modifyControl()
jmarkel44 12:ea87887ca7ad 217 * Description: modifies a control
jmarkel44 12:ea87887ca7ad 218 *
jmarkel44 12:ea87887ca7ad 219 * @param msg
jmarkel44 12:ea87887ca7ad 220 * @return none
jmarkel44 12:ea87887ca7ad 221 *****************************************************************************/
jmarkel44 5:5e77a1db4d45 222 static int modifyControl(const Message_t *msg)
jmarkel44 5:5e77a1db4d45 223 {
jmarkel44 37:7e6986b77f01 224 logInfo("\r%s invoked\n", __func__);
jmarkel44 46:4cb96ab2d1c8 225
jmarkel44 46:4cb96ab2d1c8 226 // TODO: can we delete the current object and start a new one?
jmarkel44 5:5e77a1db4d45 227 return 0;
jmarkel44 5:5e77a1db4d45 228
jmarkel44 5:5e77a1db4d45 229 }
jmarkel44 12:ea87887ca7ad 230
jmarkel44 12:ea87887ca7ad 231 /*****************************************************************************
jmarkel44 12:ea87887ca7ad 232 * Function: destroyControl()
jmarkel44 12:ea87887ca7ad 233 * Description: destroys a controls
jmarkel44 12:ea87887ca7ad 234 *
jmarkel44 12:ea87887ca7ad 235 * @param msg
jmarkel44 12:ea87887ca7ad 236 * @return none
jmarkel44 12:ea87887ca7ad 237 *****************************************************************************/
jmarkel44 5:5e77a1db4d45 238 static int destroyControl(const Message_t *msg)
jmarkel44 5:5e77a1db4d45 239 {
jmarkel44 37:7e6986b77f01 240 logInfo("\r%s invoked\n", __func__);
jmarkel44 12:ea87887ca7ad 241
jmarkel44 12:ea87887ca7ad 242 switch ( msg->control ) {
jmarkel44 12:ea87887ca7ad 243 case CONTROL_SETPOINT: {
jmarkel44 12:ea87887ca7ad 244 StringSetpointMap::iterator pos;
jmarkel44 12:ea87887ca7ad 245 pos = setpointTable.find(msg->controlFile);
jmarkel44 12:ea87887ca7ad 246 if ( pos != setpointTable.end() ) {
jmarkel44 74:03ccf04998b5 247 pos->second->unregisterControl();
jmarkel44 12:ea87887ca7ad 248 delete (pos->second);
jmarkel44 12:ea87887ca7ad 249 setpointTable.erase(pos);
jmarkel44 12:ea87887ca7ad 250 }
jmarkel44 12:ea87887ca7ad 251 break;
jmarkel44 12:ea87887ca7ad 252 }
jmarkel44 12:ea87887ca7ad 253 case CONTROL_TIMER: {
jmarkel44 12:ea87887ca7ad 254 StringTimerMap::iterator pos;
jmarkel44 12:ea87887ca7ad 255 pos = timerTable.find(msg->controlFile);
jmarkel44 12:ea87887ca7ad 256 if ( pos != timerTable.end() ) {
jmarkel44 12:ea87887ca7ad 257 delete (pos->second);
jmarkel44 12:ea87887ca7ad 258 timerTable.erase(pos);
jmarkel44 12:ea87887ca7ad 259 }
jmarkel44 12:ea87887ca7ad 260 break;
jmarkel44 12:ea87887ca7ad 261 }
jmarkel44 46:4cb96ab2d1c8 262 case CONTROL_MANUAL: {
jmarkel44 46:4cb96ab2d1c8 263 StringManualMap::iterator pos;
jmarkel44 46:4cb96ab2d1c8 264 pos = manualTable.find(msg->controlFile);
jmarkel44 46:4cb96ab2d1c8 265 if ( pos != manualTable.end() ) {
jmarkel44 97:5cf6ab71dcd0 266 pos->second->unregisterControl();
jmarkel44 46:4cb96ab2d1c8 267 delete (pos->second);
jmarkel44 46:4cb96ab2d1c8 268 manualTable.erase(pos);
jmarkel44 46:4cb96ab2d1c8 269 }
jmarkel44 46:4cb96ab2d1c8 270 break;
jmarkel44 46:4cb96ab2d1c8 271 }
jmarkel44 12:ea87887ca7ad 272 default:
jmarkel44 12:ea87887ca7ad 273 break;
jmarkel44 12:ea87887ca7ad 274 }
jmarkel44 12:ea87887ca7ad 275 return 0;
jmarkel44 20:653923c2f37a 276 }