1

#include <stdio.h>

     2

#include <string.h>

     3

#include <time.h>

     4

#include <signal.h>

     5

#include <stdlib.h>

     6

     7

void PLC_GetTime(IEC_TIME *CURRENT_TIME)

     8

{

     9

    clock_gettime(CLOCK_REALTIME, CURRENT_TIME);

    10

}

    11

    12

void PLC_timer_notify(sigval_t val)

    13

{

    14

    PLC_GetTime(&__CURRENT_TIME);

    15

    __run();

    16

}

    17

    18

timer_t PLC_timer;

    19

    20

void PLC_SetTimer(long long next, long long period)

    21

{

    22

    struct itimerspec timerValues;

    23

	/*

    24

	printf("SetTimer(%lld,%lld)\n",next, period);

    25

	*/

    26

    memset (&timerValues, 0, sizeof (struct itimerspec));

    27

	{

    28

#ifdef __lldiv_t_defined

    29

		lldiv_t nxt_div = lldiv(next, 1000000000);

    30

		lldiv_t period_div = lldiv(period, 1000000000);

    31

	    timerValues.it_value.tv_sec = nxt_div.quot;

    32

	    timerValues.it_value.tv_nsec = nxt_div.rem;

    33

	    timerValues.it_interval.tv_sec = period_div.quot;

    34

	    timerValues.it_interval.tv_nsec = period_div.rem;

    35

#else

    36

	    timerValues.it_value.tv_sec = next / 1000000000;

    37

	    timerValues.it_value.tv_nsec = next % 1000000000;

    38

	    timerValues.it_interval.tv_sec = period / 1000000000;

    39

	    timerValues.it_interval.tv_nsec = period % 1000000000;

    40

#endif

    41

	}	

    42

    timer_settime (PLC_timer, 0, &timerValues, NULL);

    43

}

    44

    45

void catch_signal(int sig)

    46

{

    47

  signal(SIGTERM, catch_signal);

    48

  signal(SIGINT, catch_signal);

    49

  printf("Got Signal %d\n",sig);

    50

}

    51

    52

int main(int argc,char **argv)

    53

{

    54

    struct sigevent sigev;

    55

    /* Translate PLC's microseconds to Ttick nanoseconds */

    56

    Ttick = 1000000 * maxval(common_ticktime__,1);

    57

    58

    memset (&sigev, 0, sizeof (struct sigevent));

    59

    sigev.sigev_value.sival_int = 0;

    60

    sigev.sigev_notify = SIGEV_THREAD;

    61

    sigev.sigev_notify_attributes = NULL;

    62

    sigev.sigev_notify_function = PLC_timer_notify;

    63

    64

    timer_create (CLOCK_REALTIME, &sigev, &PLC_timer);

    65

    if(  __init(argc,argv) == 0 ){

    66

        PLC_SetTimer(Ttick,Ttick);

    67

    68

        /* install signal handler for manual break */

    69

        signal(SIGTERM, catch_signal);

    70

        signal(SIGINT, catch_signal);

    71

        /* Wait some signal */

    72

        pause();

    73

        /* Stop the PLC */

    74

        PLC_SetTimer(0,0);

    75

    }

    76

    __cleanup();

    77

    timer_delete (PLC_timer);

    78

    79

    return 0;

    80

}