1

/**

     2

 * Code common to all C targets

     3

 **/ 

     4

     5

#include "iec_types.h"

     6

     7

/*

     8

 * Prototypes of functions provied by generated C softPLC

     9

 **/ 

    10

void config_run__(int tick);

    11

void config_init__(void);

    12

    13

/*

    14

 * Prototypes of functions provied by generated target C code

    15

 * */

    16

void __init_debug(void);

    17

void __cleanup_debug(void);

    18

/*void __retrieve_debug(void);*/

    19

void __publish_debug(void);

    20

    21

void __init_python(void);

    22

void __cleanup_python(void);

    23

void __retrieve_python(void);

    24

void __publish_python(void);

    25

    26

/*

    27

 *  Variables used by generated C softPLC and plugins

    28

 **/

    29

IEC_TIME __CURRENT_TIME;

    30

IEC_BOOL __DEBUG;

    31

int __tick = -1;

    32

    33

/* Help to quit cleanly when init fail at a certain level */

    34

static int init_level = 0;

    35

    36

/*

    37

 * Prototypes of functions exported by plugins 

    38

 **/

    39

%(calls_prototypes)s

    40

    41

/*

    42

 * Retrieve input variables, run PLC and publish output variables 

    43

 **/

    44

void __run()

    45

{

    46

    __tick++;

    47

    48

    %(retrieve_calls)s

    49

    50

    __retrieve_python();

    51

    52

    /*__retrieve_debug();*/

    53

    54

    config_run__(__tick);

    55

    56

    __publish_python();

    57

    58

    __publish_debug();

    59

    60

    %(publish_calls)s

    61

    62

}

    63

    64

/*

    65

 * Initialize variables according to PLC's defalut values,

    66

 * and then init plugins with that values  

    67

 **/

    68

int __init(int argc,char **argv)

    69

{

    70

    int res;

    71

    config_init__();

    72

    __init_debug();

    73

    __init_python();

    74

    %(init_calls)s

    75

    return 0;

    76

}

    77

/*

    78

 * Calls plugin cleanup proc.

    79

 **/

    80

void __cleanup()

    81

{

    82

    %(cleanup_calls)s

    83

    __cleanup_debug();

    84

    __cleanup_python();

    85

}

    86

    87

    88

void PLC_GetTime(IEC_TIME *CURRENT_TIME);

    89

void PLC_SetTimer(long long next, long long period);

    90

    91

#define CALIBRATED -2

    92

#define NOT_CALIBRATED -1

    93

static int calibration_count = NOT_CALIBRATED;

    94

static IEC_TIME cal_begin;

    95

static long long Tsync = 0;

    96

static long long FreqCorr = 0;

    97

static int Nticks = 0;

    98

static int  last_tick = 0;

    99

static long long Ttick = 0;

   100

#define mod %%

   101

/*

   102

 * Call this on each external sync, 

   103

 * @param sync_align_ratio 0->100 : align ratio, < 0 : no align, calibrate period 

   104

 **/

   105

void align_tick(int sync_align_ratio)

   106

{

   107

	/*

   108

	printf("align_tick(%%d)\n", calibrate);

   109

	*/

   110

	if(sync_align_ratio < 0){ /* Calibration */

   111

		if(calibration_count == CALIBRATED)

   112

			/* Re-calibration*/

   113

			calibration_count = NOT_CALIBRATED;

   114

		if(calibration_count == NOT_CALIBRATED)

   115

			/* Calibration start, get time*/

   116

			PLC_GetTime(&cal_begin);

   117

		calibration_count++;

   118

	}else{ /* do alignment (if possible) */

   119

		if(calibration_count >= 0){

   120

			/* End of calibration */

   121

			/* Get final time */

   122

			IEC_TIME cal_end;

   123

			PLC_GetTime(&cal_end);

   124

			/*adjust calibration_count*/

   125

			calibration_count++;

   126

			/* compute mean of Tsync, over calibration period */	

   127

			Tsync = ((long long)(cal_end.tv_sec - cal_begin.tv_sec) * (long long)1000000000 +

   128

					(cal_end.tv_nsec - cal_begin.tv_nsec)) / calibration_count;

   129

			if( (Nticks = (Tsync / Ttick)) > 0){

   130

				FreqCorr = (Tsync mod Ttick); /* to be divided by Nticks */

   131

			}else{

   132

				FreqCorr = Tsync - (Ttick mod Tsync);

   133

			}

   134

			/*

   135

			printf("Tsync = %%ld\n", Tsync);

   136

			printf("calibration_count = %%d\n", calibration_count);

   137

			printf("Nticks = %%d\n", Nticks);

   138

			*/

   139

			calibration_count = CALIBRATED;

   140

		}

   141

		if(calibration_count == CALIBRATED){

   142

			/* Get Elapsed time since last PLC tick (__CURRENT_TIME) */

   143

			IEC_TIME now;

   144

			long long elapsed;

   145

			long long Tcorr;

   146

			long long PhaseCorr;

   147

			long long PeriodicTcorr;

   148

			PLC_GetTime(&now);

   149

			elapsed = (now.tv_sec - __CURRENT_TIME.tv_sec) * 1000000000 + now.tv_nsec - __CURRENT_TIME.tv_nsec;

   150

			if(Nticks > 0){

   151

				PhaseCorr = elapsed - (Ttick + FreqCorr/Nticks)*sync_align_ratio/100; /* to be divided by Nticks */

   152

				Tcorr = Ttick + (PhaseCorr + FreqCorr) / Nticks;

   153

				if(Nticks < 2){

   154

					/* When Sync source period is near Tick time */

   155

					/* PhaseCorr may not be applied to Periodic time given to timer */

   156

					PeriodicTcorr = Ttick + FreqCorr / Nticks;

   157

				}else{

   158

					PeriodicTcorr = Tcorr; 

   159

				}

   160

			}else if(__tick > last_tick){

   161

				last_tick = __tick;

   162

				PhaseCorr = elapsed - (Tsync*sync_align_ratio/100);

   163

				PeriodicTcorr = Tcorr = Ttick + PhaseCorr + FreqCorr;

   164

			}else{

   165

				/*PLC did not run meanwhile. Nothing to do*/

   166

				return;

   167

			}

   168

			/* DO ALIGNEMENT */

   169

			PLC_SetTimer(Tcorr - elapsed, PeriodicTcorr);

   170

		}

   171

	}

   172

}

   173

   174

/**

   175

 * Prototypes for function provided by arch-specific code (main)

   176

 * is concatained hereafter

   177

 **/