targets/plc_common_main.c
branch1.1 Korean release
changeset 1280 72a826dfcfbb
parent 977 c8e008b8cefe
parent 1279 0eb9f8af479f
child 1384 02fe382c4511
--- a/targets/plc_common_main.c	Wed Mar 13 12:34:55 2013 +0900
+++ /dev/null	Thu Jan 01 00:00:00 1970 +0000
@@ -1,173 +0,0 @@
-/**
- * Code common to all C targets
- **/
-
-#include "iec_types.h"
-/*
- * Prototypes of functions provided by generated C softPLC
- **/
-void config_run__(unsigned long tick);
-void config_init__(void);
-
-/*
- * Prototypes of functions provided by generated target C code
- * */
-void __init_debug(void);
-void __cleanup_debug(void);
-/*void __retrieve_debug(void);*/
-void __publish_debug(void);
-
-/*
- *  Variables used by generated C softPLC and plugins
- **/
-IEC_TIME __CURRENT_TIME;
-IEC_BOOL __DEBUG = 0;
-unsigned long __tick = 0;
-
-/*
- *  Variable generated by C softPLC and plugins
- **/
-extern unsigned long greatest_tick_count__;
-
-/* Help to quit cleanly when init fail at a certain level */
-static int init_level = 0;
-
-/*
- * Prototypes of functions exported by plugins
- **/
-%(calls_prototypes)s
-
-/*
- * Retrieve input variables, run PLC and publish output variables
- **/
-void __run(void)
-{
-    __tick++;
-    if (greatest_tick_count__)
-        __tick %%= greatest_tick_count__;
-
-    %(retrieve_calls)s
-
-    /*__retrieve_debug();*/
-
-    config_run__(__tick);
-
-    __publish_debug();
-
-    %(publish_calls)s
-
-}
-
-/*
- * Initialize variables according to PLC's default values,
- * and then init plugins with that values
- **/
-int __init(int argc,char **argv)
-{
-    int res = 0;
-    init_level = 0;
-    config_init__();
-    __init_debug();
-    %(init_calls)s
-    return res;
-}
-/*
- * Calls plugin cleanup proc.
- **/
-void __cleanup(void)
-{
-    %(cleanup_calls)s
-    __cleanup_debug();
-}
-
-
-void PLC_GetTime(IEC_TIME *CURRENT_TIME);
-void PLC_SetTimer(unsigned long long next, unsigned long long period);
-
-#define CALIBRATED -2
-#define NOT_CALIBRATED -1
-static int calibration_count = NOT_CALIBRATED;
-static IEC_TIME cal_begin;
-static long long Tsync = 0;
-static long long FreqCorr = 0;
-static int Nticks = 0;
-static unsigned long last_tick = 0;
-static long long Ttick = 0;
-#define mod %%
-/*
- * Call this on each external sync,
- * @param sync_align_ratio 0->100 : align ratio, < 0 : no align, calibrate period
- **/
-void align_tick(int sync_align_ratio)
-{
-	/*
-	printf("align_tick(%%d)\n", calibrate);
-	*/
-	if(sync_align_ratio < 0){ /* Calibration */
-		if(calibration_count == CALIBRATED)
-			/* Re-calibration*/
-			calibration_count = NOT_CALIBRATED;
-		if(calibration_count == NOT_CALIBRATED)
-			/* Calibration start, get time*/
-			PLC_GetTime(&cal_begin);
-		calibration_count++;
-	}else{ /* do alignment (if possible) */
-		if(calibration_count >= 0){
-			/* End of calibration */
-			/* Get final time */
-			IEC_TIME cal_end;
-			PLC_GetTime(&cal_end);
-			/*adjust calibration_count*/
-			calibration_count++;
-			/* compute mean of Tsync, over calibration period */
-			Tsync = ((long long)(cal_end.tv_sec - cal_begin.tv_sec) * (long long)1000000000 +
-					(cal_end.tv_nsec - cal_begin.tv_nsec)) / calibration_count;
-			if( (Nticks = (Tsync / Ttick)) > 0){
-				FreqCorr = (Tsync mod Ttick); /* to be divided by Nticks */
-			}else{
-				FreqCorr = Tsync - (Ttick mod Tsync);
-			}
-			/*
-			printf("Tsync = %%ld\n", Tsync);
-			printf("calibration_count = %%d\n", calibration_count);
-			printf("Nticks = %%d\n", Nticks);
-			*/
-			calibration_count = CALIBRATED;
-		}
-		if(calibration_count == CALIBRATED){
-			/* Get Elapsed time since last PLC tick (__CURRENT_TIME) */
-			IEC_TIME now;
-			long long elapsed;
-			long long Tcorr;
-			long long PhaseCorr;
-			long long PeriodicTcorr;
-			PLC_GetTime(&now);
-			elapsed = (now.tv_sec - __CURRENT_TIME.tv_sec) * 1000000000 + now.tv_nsec - __CURRENT_TIME.tv_nsec;
-			if(Nticks > 0){
-				PhaseCorr = elapsed - (Ttick + FreqCorr/Nticks)*sync_align_ratio/100; /* to be divided by Nticks */
-				Tcorr = Ttick + (PhaseCorr + FreqCorr) / Nticks;
-				if(Nticks < 2){
-					/* When Sync source period is near Tick time */
-					/* PhaseCorr may not be applied to Periodic time given to timer */
-					PeriodicTcorr = Ttick + FreqCorr / Nticks;
-				}else{
-					PeriodicTcorr = Tcorr;
-				}
-			}else if(__tick > last_tick){
-				last_tick = __tick;
-				PhaseCorr = elapsed - (Tsync*sync_align_ratio/100);
-				PeriodicTcorr = Tcorr = Ttick + PhaseCorr + FreqCorr;
-			}else{
-				/*PLC did not run meanwhile. Nothing to do*/
-				return;
-			}
-			/* DO ALIGNEMENT */
-			PLC_SetTimer(Tcorr - elapsed, PeriodicTcorr);
-		}
-	}
-}
-
-/**
- * Prototypes for function provided by arch-specific code (main)
- * is concatained hereafter
- **/