Erick / Mbed 2 deprecated ICE_BLE_TEST

Dependencies:   NaturalTinyShell_ice libmDot-12Sept mbed-rtos mbed

Fork of ICE by Erick

Committer:
jmarkel44
Date:
Tue Sep 13 11:59:34 2016 +0000
Revision:
46:4cb96ab2d1c8
Parent:
22:fe535532859c
Child:
48:1c7861d80d16
commit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jmarkel44 20:653923c2f37a 1 #include "ControlTask.h"
jmarkel44 20:653923c2f37a 2 #include <stdio.h>
jmarkel44 20:653923c2f37a 3 #include "rtos.h"
jmarkel44 46:4cb96ab2d1c8 4 #include "ConfigurationHandler.h"
jmarkel44 46:4cb96ab2d1c8 5 #include "MTSLog.h"
jmarkel44 20:653923c2f37a 6
jmarkel44 46:4cb96ab2d1c8 7 static void serviceSetpointControl(SetpointControl *control);
jmarkel44 46:4cb96ab2d1c8 8 static void serviceTimerControl(TimerControl *control);
jmarkel44 46:4cb96ab2d1c8 9
jmarkel44 46:4cb96ab2d1c8 10 /*****************************************************************************
jmarkel44 46:4cb96ab2d1c8 11 * Function: ControlTask()
jmarkel44 46:4cb96ab2d1c8 12 * Description: show the controls
jmarkel44 46:4cb96ab2d1c8 13 *
jmarkel44 46:4cb96ab2d1c8 14 * @param msg
jmarkel44 46:4cb96ab2d1c8 15 * @return none
jmarkel44 46:4cb96ab2d1c8 16 *****************************************************************************/
jmarkel44 20:653923c2f37a 17 void ControlTask(void const *args)
jmarkel44 20:653923c2f37a 18 {
jmarkel44 20:653923c2f37a 19 printf("\r%s has started...\n", __func__);
jmarkel44 20:653923c2f37a 20
jmarkel44 20:653923c2f37a 21 while ( true ) {
jmarkel44 46:4cb96ab2d1c8 22 // service the setpoint controls
jmarkel44 46:4cb96ab2d1c8 23 if ( !setpointTable.empty() ) {
jmarkel44 46:4cb96ab2d1c8 24 StringSetpointMap::iterator pos;
jmarkel44 46:4cb96ab2d1c8 25 for ( pos = setpointTable.begin(); pos != setpointTable.end(); ++pos ) {
jmarkel44 46:4cb96ab2d1c8 26 serviceSetpointControl(pos->second);
jmarkel44 46:4cb96ab2d1c8 27 }
jmarkel44 46:4cb96ab2d1c8 28 }
jmarkel44 46:4cb96ab2d1c8 29 // service the timer controls
jmarkel44 46:4cb96ab2d1c8 30 if ( !timerTable.empty() ) {
jmarkel44 46:4cb96ab2d1c8 31 StringTimerMap::iterator pos;
jmarkel44 46:4cb96ab2d1c8 32 for ( pos = timerTable.begin(); pos != timerTable.end(); ++pos ) {
jmarkel44 46:4cb96ab2d1c8 33 serviceTimerControl(pos->second);
jmarkel44 46:4cb96ab2d1c8 34 }
jmarkel44 46:4cb96ab2d1c8 35 }
jmarkel44 22:fe535532859c 36 Thread::wait(5000);
jmarkel44 20:653923c2f37a 37 }
jmarkel44 46:4cb96ab2d1c8 38 }
jmarkel44 46:4cb96ab2d1c8 39
jmarkel44 46:4cb96ab2d1c8 40 /*****************************************************************************
jmarkel44 46:4cb96ab2d1c8 41 * Function: serviceSetpointControl()
jmarkel44 46:4cb96ab2d1c8 42 * Description: service a setpoint control
jmarkel44 46:4cb96ab2d1c8 43 *
jmarkel44 46:4cb96ab2d1c8 44 * @param control -> the setpoint control object
jmarkel44 46:4cb96ab2d1c8 45 * @return none
jmarkel44 46:4cb96ab2d1c8 46 *****************************************************************************/
jmarkel44 46:4cb96ab2d1c8 47 static void serviceSetpointControl(SetpointControl *control)
jmarkel44 46:4cb96ab2d1c8 48 {
jmarkel44 46:4cb96ab2d1c8 49 logInfo("\r%s: servicing control %s\n",
jmarkel44 46:4cb96ab2d1c8 50 __func__, control->getControlFile().c_str());
jmarkel44 46:4cb96ab2d1c8 51 }
jmarkel44 46:4cb96ab2d1c8 52
jmarkel44 46:4cb96ab2d1c8 53 /*****************************************************************************
jmarkel44 46:4cb96ab2d1c8 54 * Function: serviceTimerControl()
jmarkel44 46:4cb96ab2d1c8 55 * Description: service a timer control
jmarkel44 46:4cb96ab2d1c8 56 *
jmarkel44 46:4cb96ab2d1c8 57 * @param control -> the timer control object
jmarkel44 46:4cb96ab2d1c8 58 * @return none
jmarkel44 46:4cb96ab2d1c8 59 *****************************************************************************/
jmarkel44 46:4cb96ab2d1c8 60 static void serviceTimerControl(TimerControl *control)
jmarkel44 46:4cb96ab2d1c8 61 {
jmarkel44 46:4cb96ab2d1c8 62 logInfo("\r%s: servicing timer control %s\n",
jmarkel44 46:4cb96ab2d1c8 63 __func__, control->getControlFile().c_str());
jmarkel44 46:4cb96ab2d1c8 64 }