etisserant@41: #include <time.h>
etisserant@41: #include <signal.h>
etisserant@41: 
etisserant@41: #include "iec_std_lib.h"
etisserant@41: 
etisserant@41: /*
etisserant@41:  * Functions and variables provied by generated C softPLC
etisserant@41:  **/ 
etisserant@41: void config_run__(int tick);
etisserant@41: void config_init__(void);
etisserant@41: extern int common_ticktime__;
etisserant@41: 
etisserant@41: /*
etisserant@41:  *  Functions and variables to export to generated C softPLC
etisserant@41:  **/
etisserant@41:  
etisserant@41: TIME __CURRENT_TIME;
etisserant@41: 
etisserant@41: #define __LOCATED_VAR(type, name) type name;
etisserant@41: #include "LOCATED_VARIABLES.h"
etisserant@41: #undef __LOCATED_VAR
etisserant@41: 
etisserant@41: #define print_BOOL(name) printf("  %s = (BOOL) %s\n",#name, name?"TRUE":"FALSE");
etisserant@41: #define print_SINT(name) printf("  %s = (SINT) %d\n",#name, name);
etisserant@41: #define print_INT(name) printf("  %s = (INT) %d\n",#name, name);
etisserant@41: #define print_DINT(name) printf("  %s = (DINT) %d\n",#name, name);
etisserant@41: #define print_LINT(name) printf("  %s = (LINT) %d\n",#name, name);
etisserant@41: #define print_USINT(name) printf("  %s = (USINT) %u\n",#name, name);
etisserant@41: #define print_UINT(name) printf("  %s = (UINT) %u\n",#name, name);
etisserant@41: #define print_UDINT(name) printf("  %s = (UDINT) %u\n",#name, name);
etisserant@41: #define print_ULINT(name) printf("  %s = (ULINT) %lu\n",#name, name);
etisserant@41: #define print_REAL(name) printf("  %s = (REAL) %f\n",#name, (double)name);
etisserant@41: #define print_LREAL(name) printf("  %s = (LREAL) %f\n",#name, (double)name);
etisserant@41: #define print_TIME(name) {tmp STRING = __time_to_string(name);tmp.body[tmp.len] = 0; printf("  %s = (TIME) %s*s\n",#name, tmp.len, &tmp.body);}
etisserant@41: #define print_DATE(name) {tmp STRING = __date_to_string(name);tmp.body[tmp.len] = 0; printf("  %s = (TIME) %*s\n",#name, tmp.len, &tmp.body);}
etisserant@41: #define print_TOD(name) {tmp STRING = __tod_to_string(name);tmp.body[tmp.len] = 0; printf("  %s = (TIME) %*s\n",#name, tmp.len, &tmp.body);}
etisserant@41: #define print_DT(name) {tmp STRING = __dt_to_string(name);tmp.body[tmp.len] = 0; printf("  %s = (TIME) %*s\n",#name, tmp.len, &tmp.body);}
etisserant@41: #define print_STRING(name) printf("  %s = (STRING) {%d, \"%*s\"}\n",#name, name.len, name.len, &name.body);
etisserant@41: #define print_BYTE(name) printf("  %s = (BYTE) 0x%2.2x\n",#name, name);
etisserant@41: #define print_WORD(name) printf("  %s = (WORD) 0x%d4.4\n",#name, name);
etisserant@41: #define print_DWORD(name) printf("  %s = (DWORD) 0x%d8.8\n",#name, name);
etisserant@41: #define print_LWORD(name) printf("  %s = (LWORD) 0x%d16.16\n",#name, name);
etisserant@41: 
etisserant@41: static int tick = 0;
etisserant@41: void timer_notify(sigval_t val)
etisserant@41: {
etisserant@41:     clock_gettime(CLOCK_REALTIME, &__CURRENT_TIME);
etisserant@41:     printf("Tick %d\n",tick);
etisserant@41:     config_run__(tick++);
etisserant@41:     printf("  Located variables : \n");
etisserant@41: #define __LOCATED_VAR(type, name) print_##type(name);
etisserant@41: #include "LOCATED_VARIABLES.h"
etisserant@41: #undef __LOCATED_VAR
etisserant@41: }
etisserant@41: 
etisserant@41: void catch_signal(int sig)
etisserant@41: {
etisserant@41:   signal(SIGTERM, catch_signal);
etisserant@41:   signal(SIGINT, catch_signal);
etisserant@41:   printf("Got Signal %d\n",sig);
etisserant@41: }
etisserant@41: 
etisserant@41: #define maxval(a,b) ((a>b)?a:b)
etisserant@41: int main(int argc,char **argv)
etisserant@41: {
etisserant@41:     timer_t timer;
etisserant@41:     struct sigevent sigev;
etisserant@41:     long tv_nsec = 1000000 * (maxval(common_ticktime__,1)%1000);
etisserant@41:     time_t tv_sec = common_ticktime__/1000;
etisserant@41:     struct itimerspec timerValues;
etisserant@41:     
etisserant@41:     memset (&sigev, 0, sizeof (struct sigevent));
etisserant@41:     memset (&timerValues, 0, sizeof (struct itimerspec));
etisserant@41:     sigev.sigev_value.sival_int = 0;
etisserant@41:     sigev.sigev_notify = SIGEV_THREAD;
etisserant@41:     sigev.sigev_notify_attributes = NULL;
etisserant@41:     sigev.sigev_notify_function = timer_notify;
etisserant@41:     timerValues.it_value.tv_sec = tv_sec;
etisserant@41:     timerValues.it_value.tv_nsec = tv_nsec;
etisserant@41:     timerValues.it_interval.tv_sec = tv_sec;
etisserant@41:     timerValues.it_interval.tv_nsec = tv_nsec;
etisserant@41: 
etisserant@41:     config_init__();
etisserant@41: 
etisserant@41:     timer_create (CLOCK_REALTIME, &sigev, &timer);
etisserant@41:     timer_settime (timer, 0, &timerValues, NULL);
etisserant@41:     
etisserant@41:     /* install signal handler for manual break */
etisserant@41:     signal(SIGTERM, catch_signal);
etisserant@41:     signal(SIGINT, catch_signal);
etisserant@41:     
etisserant@41:     pause();
etisserant@41:     
etisserant@41:     timer_delete (timer);
etisserant@41:     
etisserant@41:     return 0;
etisserant@41: }