etisserant@40: /****
etisserant@40:  * IEC 61131-3 standard function lib
etisserant@40:  */
etisserant@40: 
etisserant@40: #include <limits.h>
etisserant@40: #include <float.h>
etisserant@40: #include <math.h>
etisserant@40: #include <time.h>
etisserant@40: #include <sys/types.h>
etisserant@40: 
etisserant@41: #include <stdio.h>
etisserant@40: #include <stdlib.h>
etisserant@40: #include <string.h>
etisserant@40: #include <stdarg.h>
etisserant@40: 
etisserant@40: #include "iec_std_lib_generated.h"
etisserant@40: 
etisserant@43: #define __print_BOOL(name) printf("  %s = (BOOL) %s\n",#name, name?"TRUE":"FALSE");
etisserant@43: #define __print_SINT(name) printf("  %s = (SINT) %d\n",#name, name);
etisserant@43: #define __print_INT(name) printf("  %s = (INT) %d\n",#name, name);
etisserant@43: #define __print_DINT(name) printf("  %s = (DINT) %d\n",#name, name);
etisserant@43: #define __print_LINT(name) printf("  %s = (LINT) %d\n",#name, name);
etisserant@43: #define __print_USINT(name) printf("  %s = (USINT) %u\n",#name, name);
etisserant@43: #define __print_UINT(name) printf("  %s = (UINT) %u\n",#name, name);
etisserant@43: #define __print_UDINT(name) printf("  %s = (UDINT) %u\n",#name, name);
etisserant@43: #define __print_ULINT(name) printf("  %s = (ULINT) %lu\n",#name, name);
etisserant@43: #define __print_REAL(name) printf("  %s = (REAL) %f\n",#name, (double)name);
etisserant@43: #define __print_LREAL(name) printf("  %s = (LREAL) %f\n",#name, (double)name);
etisserant@43: #define __print_TIME(name) {STRING __tmp = __time_to_string(name);__tmp.body[__tmp.len] = 0; printf("  %s = (TIME) %*s\n",#name, __tmp.len, &__tmp.body);}
etisserant@43: #define __print_DATE(name) {STRING __tmp = __date_to_string(name);__tmp.body[__tmp.len] = 0; printf("  %s = (DATE) %*s\n",#name, __tmp.len, &__tmp.body);}
etisserant@43: #define __print_TOD(name) {STRING __tmp = __tod_to_string(name);__tmp.body[__tmp.len] = 0; printf("  %s = (TOD) %*s\n",#name, __tmp.len, &__tmp.body);}
etisserant@43: #define __print_DT(name) {STRING __tmp = __dt_to_string(name);__tmp.body[__tmp.len] = 0; printf("  %s = (DT) %*s\n",#name, __tmp.len, &__tmp.body);}
etisserant@43: #define __print_STRING(name) printf("  %s = (STRING) {%d, \"%*s\"}\n",#name, name.len, name.len, &name.body);
etisserant@43: #define __print_BYTE(name) printf("  %s = (BYTE) 0x%2.2x\n",#name, name);
etisserant@43: #define __print_WORD(name) printf("  %s = (WORD) 0x%4.4x\n",#name, name);
etisserant@43: #define __print_DWORD(name) printf("  %s = (DWORD) 0x%8.8x\n",#name, name);
etisserant@43: #define __print_LWORD(name) printf("  %s = (LWORD) 0x%16.16lx\n",#name, name);
etisserant@43: 
etisserant@43: #ifdef DEBUG_IEC
etisserant@43: #define DBG(...) printf(__VA_ARGS__);
etisserant@43: #define DBG_TYPE(TYPENAME, name) __print_##TYPENAME(name);
etisserant@43: #else
etisserant@43: #define DBG(...)
etisserant@43: #define DBG_TYPE(TYPENAME, name)
etisserant@43: #endif
etisserant@43: 
etisserant@40: /*****************/
etisserant@40: /*  Types defs   */
etisserant@40: /*****************/
etisserant@40: 
etisserant@40: typedef u_int8_t  BOOL;
etisserant@40: 
etisserant@40: #define TRUE 1
etisserant@40: #define FALSE 0
etisserant@40: 
etisserant@40: typedef int8_t    SINT;
etisserant@40: typedef int16_t   INT;
etisserant@40: typedef int32_t   DINT;
etisserant@40: typedef int64_t   LINT;
etisserant@40: 
etisserant@40: typedef u_int8_t    USINT;
etisserant@40: typedef u_int16_t   UINT;
etisserant@40: typedef u_int32_t   UDINT;
etisserant@40: typedef u_int64_t   ULINT;
etisserant@40: 
etisserant@40: typedef u_int8_t    BYTE;
etisserant@40: typedef u_int16_t   WORD;
etisserant@40: typedef u_int32_t   DWORD;
etisserant@40: typedef u_int64_t   LWORD;
etisserant@40: 
etisserant@40: typedef float    REAL;
etisserant@40: typedef double   LREAL;
etisserant@40: 
etisserant@40: typedef struct timespec TIME;
etisserant@40: typedef struct timespec DATE;
etisserant@40: typedef struct timespec DT;
etisserant@40: typedef struct timespec TOD;
etisserant@40: 
etisserant@40: #define __TIME_CMP(t1, t2) (t2.tv_sec == t1.tv_sec ? t2.tv_nsec - t1.tv_nsec : t1.tv_sec - t2.tv_sec) 
etisserant@41: extern TIME __CURRENT_TIME;
etisserant@40: 
etisserant@40: #define STR_MAX_LEN 40
etisserant@40: typedef int8_t __strlen_t;
etisserant@40: typedef struct {
etisserant@40:     __strlen_t len;
etisserant@40:     u_int8_t body[STR_MAX_LEN];
etisserant@40: } STRING;
etisserant@40: 
etisserant@40: #define __STR_CMP(str1, str2) memcmp((char*)&str1.body,(char*)&str2.body, str1.len < str2.len ? str1.len : str2.len)
etisserant@40: 
etisserant@40: /* TODO
etisserant@40: typedef struct {
etisserant@40:     __strlen_t len;
etisserant@40:     u_int16_t body[STR_MAX_LEN];
etisserant@40: } WSTRING;
etisserant@40: */
etisserant@40: 
etisserant@41: #define __INIT_REAL 0
etisserant@41: #define __INIT_LREAL 0
etisserant@41: #define __INIT_SINT 0
etisserant@41: #define __INIT_INT 0
etisserant@41: #define __INIT_DINT 0
etisserant@41: #define __INIT_LINT 0
etisserant@41: #define __INIT_USINT 0
etisserant@41: #define __INIT_UINT 0
etisserant@41: #define __INIT_UDINT 0
etisserant@41: #define __INIT_ULINT 0
etisserant@41: #define __INIT_TIME (TIME){0,0}
etisserant@41: #define __INIT_BOOL 0
etisserant@41: #define __INIT_BYTE 0
etisserant@41: #define __INIT_WORD 0
etisserant@41: #define __INIT_DWORD 0
etisserant@41: #define __INIT_LWORD 0
etisserant@41: #define __INIT_STRING (STRING){0,""}
etisserant@41: //#define __INIT_WSTRING
etisserant@41: #define __INIT_DATE (DATE){0,0}
etisserant@41: #define __INIT_TOD (TOD){0,0}
etisserant@41: #define __INIT_DT (DT){0,0}
etisserant@41: 
etisserant@40: typedef union __IL_DEFVAR_T {
etisserant@40:     BOOL    BOOLvar;
etisserant@40: 
etisserant@40:     SINT    SINTvar;
etisserant@40:     INT     INTvar;
etisserant@40:     DINT    DINTvar;
etisserant@40:     LINT    LINTvar;
etisserant@40: 
etisserant@40:     USINT   USINTvar;
etisserant@40:     UINT    UINTvar;
etisserant@40:     UDINT   UDINTvar;
etisserant@40:     ULINT   ULINTvar;
etisserant@40: 
etisserant@40:     BYTE    BYTEvar;
etisserant@40:     WORD    WORDvar;
etisserant@40:     DWORD   DWORDvar;
etisserant@40:     LWORD   LWORDvar;
etisserant@40: 
etisserant@40:     REAL    REALvar;
etisserant@40:     LREAL   LREALvar;
etisserant@40: 
etisserant@40:     TIME    TIMEvar;
etisserant@40:     TOD TODvar;
etisserant@40:     DT  DTvar;
etisserant@40:     DATE    DATEvar;
etisserant@40: } __IL_DEFVAR_T;
etisserant@40: 
etisserant@40: 
etisserant@40: 
etisserant@40: 
etisserant@40: /*****************/
etisserant@40: /* Misc internal */
etisserant@40: /*****************/
etisserant@40: 
etisserant@40: /* function that generates an IEC runtime error */
etisserant@41: static inline void IEC_error(void) {
etisserant@40:   /* TODO... */
etisserant@40:   fprintf(stderr, "IEC 61131-3 runtime error.\n");
etisserant@40:   /*exit(1);*/
etisserant@40: }
etisserant@40: 
etisserant@40: 
etisserant@40: static inline void __normalize_timespec (struct timespec *ts) {
etisserant@40:   if( ts->tv_nsec < -1000000000 || (( ts->tv_sec > 0 ) && ( ts->tv_nsec < 0 ))){
etisserant@40:     ts->tv_sec--;
etisserant@40:     ts->tv_nsec += 1000000000;
etisserant@40:   }
etisserant@40:   if( ts->tv_nsec > 1000000000 || (( ts->tv_sec < 0 ) && ( ts->tv_nsec > 0 ))){
etisserant@40:     ts->tv_sec++;
etisserant@40:     ts->tv_nsec -= 1000000000;
etisserant@40:   }
etisserant@40: }
etisserant@40: 
etisserant@40: static inline struct timespec __time_to_timespec(int sign, double mseconds, double seconds, double minutes, double hours, double days) {
etisserant@40:   struct timespec ts;
etisserant@40:   
etisserant@40:   /* sign is 1 for positive values, -1 for negative time... */
etisserant@40:   long double total_sec = ((days*24 + hours)*60 + minutes)*60 + seconds + mseconds/1e3;
etisserant@40:   if (sign >= 0) sign = 1; else sign = -1;
etisserant@40:   ts.tv_sec = sign * (long int)total_sec;
etisserant@40:   ts.tv_nsec = sign * (long int)((total_sec - ts.tv_sec)*1e9);
etisserant@40: 
etisserant@40:   return ts;
etisserant@40: }
etisserant@40: 
etisserant@40: 
etisserant@40: static inline struct timespec __tod_to_timespec(double seconds, double minutes, double hours) {
etisserant@40:   struct timespec ts;
etisserant@40:   
etisserant@40:   long double total_sec = (hours*60 + minutes)*60 + seconds;
etisserant@40:   ts.tv_sec = (long int)total_sec;
etisserant@40:   ts.tv_nsec = (long int)((total_sec - ts.tv_sec)*1e9);
etisserant@40:   
etisserant@40:   return ts;
etisserant@40: }
etisserant@40: 
etisserant@40: static inline struct timespec __date_to_timespec(int day, int month, int year) {
etisserant@40:   struct timespec ts;
etisserant@40:   struct tm broken_down_time;
etisserant@40: 
etisserant@40:   broken_down_time.tm_sec = 0;
etisserant@40:   broken_down_time.tm_min = 0;
etisserant@40:   broken_down_time.tm_hour = 0;
etisserant@40:   broken_down_time.tm_mday = day;  /* day of month, from 1 to 31 */
etisserant@40:   broken_down_time.tm_mon = month - 1;   /* month since January, in the range 0 to 11 */
etisserant@40:   broken_down_time.tm_year = year - 1900;  /* number of years since 1900 */
etisserant@40: 
etisserant@40:   time_t epoch_seconds = mktime(&broken_down_time); /* determine number of seconds since the epoch, i.e. Jan 1st 1970 */
etisserant@40: 
etisserant@40:   if ((time_t)(-1) == epoch_seconds)
etisserant@40:     IEC_error();
etisserant@40: 
etisserant@40:   ts.tv_sec = epoch_seconds;
etisserant@40:   ts.tv_nsec = 0;
etisserant@40:   
etisserant@40:   return ts;
etisserant@40: }
etisserant@40: 
etisserant@40: static inline struct timespec __dt_to_timespec(double seconds,  double minutes, double hours, int day, int month, int year) {
etisserant@40:   struct timespec ts;
etisserant@40:   
etisserant@40:   long double total_sec = (hours*60 + minutes)*60 + seconds;
etisserant@40:   ts.tv_sec = (long int)total_sec;
etisserant@40:   ts.tv_nsec = (long int)((total_sec - ts.tv_sec)*1e9);
etisserant@40: 
etisserant@40:   struct tm broken_down_time;
etisserant@40:   broken_down_time.tm_sec = 0;
etisserant@40:   broken_down_time.tm_min = 0;
etisserant@40:   broken_down_time.tm_hour = 0;
etisserant@40:   broken_down_time.tm_mday = day;  /* day of month, from 1 to 31 */
etisserant@40:   broken_down_time.tm_mon = month - 1;   /* month since January, in the range 0 to 11 */
etisserant@40:   broken_down_time.tm_year = year - 1900;  /* number of years since 1900 */
etisserant@40: 
etisserant@40:   time_t epoch_seconds = mktime(&broken_down_time); /* determine number of seconds since the epoch, i.e. Jan 1st 1970 */
etisserant@40:   if ((time_t)(-1) == epoch_seconds)
etisserant@40:     IEC_error();
etisserant@40: 
etisserant@40:   ts.tv_sec += epoch_seconds;
etisserant@40:   if (ts.tv_sec < epoch_seconds)
etisserant@40:     /* since the TOD is always positive, if the above happens then we had an overflow */
etisserant@40:     IEC_error();
etisserant@40: 
etisserant@40:   return ts;
etisserant@40: }
etisserant@40: 
etisserant@40: /***************/
etisserant@40: /*   Time ops  */
etisserant@40: /***************/
etisserant@41: static inline TIME __date_and_time_to_time_of_day(TIME IN){
etisserant@40:   return (TIME){IN.tv_sec % 86400, IN.tv_nsec};
etisserant@40: }
etisserant@41: static inline TIME __date_and_time_to_date(TIME IN){
etisserant@40:   return (TIME){IN.tv_sec - (IN.tv_sec % (24*60*60)), 0};
etisserant@40: }
etisserant@41: static inline TIME __time_add(TIME IN1, TIME IN2){
etisserant@40:   TIME res ={IN1.tv_sec + IN2.tv_sec,
etisserant@40:              IN1.tv_nsec + IN2.tv_nsec };
etisserant@40:   __normalize_timespec(&res);
etisserant@40:   return res;
etisserant@40: }
etisserant@41: static inline TIME __time_sub(TIME IN1, TIME IN2){
etisserant@40:   TIME res ={IN1.tv_sec - IN2.tv_sec,
etisserant@40:              IN1.tv_nsec - IN2.tv_nsec };
etisserant@40:   __normalize_timespec(&res);
etisserant@40:   return res;
etisserant@40: }
etisserant@41: static inline TIME __time_mul(TIME IN1, LREAL IN2){
etisserant@40:   LREAL s_f = IN1.tv_sec * IN2;
etisserant@40:   time_t s = s_f;
etisserant@40:   div_t ns = div((LREAL)IN1.tv_nsec * IN2, 1000000000);
etisserant@40:   TIME res = {s + ns.quot,
etisserant@40:               ns.rem + (s_f - s) * 1000000000 };
etisserant@40:   __normalize_timespec(&res);
etisserant@40:   return res;
etisserant@40: }
etisserant@41: static inline TIME __time_div(TIME IN1, LREAL IN2){
etisserant@40:   LREAL s_f = IN1.tv_sec / IN2;
etisserant@40:   time_t s = s_f;
etisserant@40:   TIME res = {s,
etisserant@40:               IN1.tv_nsec / IN2 + (s_f - s) * 1000000000 };
etisserant@40:   __normalize_timespec(&res);
etisserant@40:   return res;
etisserant@40: }
etisserant@40: 
etisserant@40: /***************/
etisserant@40: /* String ops  */
etisserant@40: /***************/
etisserant@41: static inline UINT __len(STRING IN){
etisserant@40:     return IN.len;
etisserant@40: }
etisserant@41: static inline STRING __left(STRING IN, SINT L){
etisserant@41:     STRING res = __INIT_STRING;
etisserant@40:     L = L < IN.len ? L : IN.len;
etisserant@41:     memcpy(&res.body, &IN.body, L);
etisserant@40:     res.len = L;
etisserant@40:     return res;
etisserant@40: }
etisserant@41: static inline STRING __right(STRING IN, SINT L){
etisserant@41:     STRING res = __INIT_STRING;
etisserant@41:     L = L < IN.len ? L : IN.len;
etisserant@41:     memcpy(&res.body, &IN.body[IN.len - L], L);
etisserant@41:     res.len = L;
etisserant@41:     return res;
etisserant@41: }
etisserant@41: static inline STRING __mid(STRING IN, SINT L, SINT P){
etisserant@41:     STRING res = __INIT_STRING;
etisserant@40:     if(P <= IN.len){
etisserant@40: 	    P -= 1; /* now can be used as [index]*/
etisserant@40: 	    L = L + P <= IN.len ? L : IN.len - P;
etisserant@41: 	    memcpy(&res.body, &IN.body[P] , L);
etisserant@40:         res.len = L;
etisserant@40:     }
etisserant@40:     return res;
etisserant@40: }
etisserant@41: static inline STRING __concat(SINT param_count, ...){
etisserant@40:   va_list ap;
etisserant@40:   UINT i;
etisserant@40:   __strlen_t charcount = 0;
etisserant@41:   STRING res = __INIT_STRING;
etisserant@40: 
etisserant@40:   va_start (ap, param_count);         /* Initialize the argument list.  */
etisserant@40: 
etisserant@40:   for (i = 0; i < param_count && charcount < STR_MAX_LEN; i++)
etisserant@40:   {
etisserant@40:     STRING tmp = va_arg(ap, STRING);
etisserant@40:     __strlen_t charrem = STR_MAX_LEN - charcount;
etisserant@40:     __strlen_t to_write = tmp.len > charrem ? charrem : tmp.len;
etisserant@40:     memcpy(&res.body[charcount], &tmp.body , to_write);
etisserant@40:     charcount += to_write;
etisserant@40:   }
etisserant@40: 
etisserant@40:   res.len = charcount;
etisserant@40: 
etisserant@40:   va_end (ap);                  /* Clean up.  */
etisserant@40:   return res;
etisserant@40: }
etisserant@41: static inline STRING __insert(STRING IN1, STRING IN2, SINT P){
etisserant@41:     STRING res = __INIT_STRING;
etisserant@40:     __strlen_t to_copy;
etisserant@40:     
etisserant@41:     to_copy = P > IN1.len ? IN1.len : P - 1;
etisserant@40:     memcpy(&res.body, &IN1.body , to_copy);
etisserant@40:     P = res.len = to_copy;
etisserant@40:     
etisserant@40:     to_copy = IN2.len + res.len > STR_MAX_LEN ? STR_MAX_LEN - res.len : IN2.len;
etisserant@40:     memcpy(&res.body[res.len], &IN2.body , to_copy);
etisserant@40:     res.len += to_copy;
etisserant@40: 
etisserant@40:     to_copy = IN1.len - P < STR_MAX_LEN - res.len ? IN1.len - P : STR_MAX_LEN - res.len ;
etisserant@40:     memcpy(&res.body[res.len], &IN1.body[P] , to_copy);
etisserant@40:     res.len += to_copy;
etisserant@40: 
etisserant@40:     return res;
etisserant@40: }
etisserant@41: static inline STRING __delete(STRING IN, SINT L, SINT P){
etisserant@41:     STRING res = __INIT_STRING;
etisserant@40:     __strlen_t to_copy;
etisserant@40:     
etisserant@41:     to_copy = P > IN.len ? IN.len : P-1;
etisserant@40:     memcpy(&res.body, &IN.body , to_copy);
etisserant@40:     P = res.len = to_copy;
etisserant@40: 
etisserant@41:     if( IN.len > P + L ){
etisserant@41:         to_copy = IN.len - P - L;
etisserant@41:         memcpy(&res.body[res.len], &IN.body[P + L], to_copy);
etisserant@41:         res.len += to_copy;
etisserant@41:     }
etisserant@41: 
etisserant@41:     return res;
etisserant@41: }
etisserant@41: static inline STRING __replace(STRING IN1, STRING IN2, SINT L, SINT P){
etisserant@41:     STRING res = __INIT_STRING;
etisserant@40:     __strlen_t to_copy;
etisserant@40:     
etisserant@41:     to_copy = P > IN1.len ? IN1.len : P-1;
etisserant@40:     memcpy(&res.body, &IN1.body , to_copy);
etisserant@40:     P = res.len = to_copy;
etisserant@40:     
etisserant@41:     to_copy = IN2.len < L ? IN2.len : L;
etisserant@41: 
etisserant@41:     if( to_copy + res.len > STR_MAX_LEN ) 
etisserant@41:        to_copy = STR_MAX_LEN - res.len;   
etisserant@41: 
etisserant@40:     memcpy(&res.body[res.len], &IN2.body , to_copy);
etisserant@40:     res.len += to_copy;
etisserant@40: 
etisserant@41:     P += L;
etisserant@41:     if( res.len <  STR_MAX_LEN && P < IN1.len)
etisserant@41:     {
etisserant@41:         to_copy = IN1.len - P;
etisserant@41:         memcpy(&res.body[res.len], &IN1.body[P] , to_copy);
etisserant@41:         res.len += to_copy;
etisserant@41:     }
etisserant@41: 
etisserant@41:     return res;
etisserant@41: }
etisserant@41: 
etisserant@41: 
etisserant@41: 
etisserant@41: static inline UINT __pfind(STRING* IN1, STRING* IN2){
etisserant@41:     UINT count1 = 0; /* offset of first matching char in IN1 */
etisserant@41:     UINT count2 = 0; /* count of matching char */
etisserant@40:     while(count1 + count2 < IN1->len && count2 < IN2->len)
etisserant@40:     {
etisserant@40:         if(IN1->body[count1 + count2] != IN2->body[count2++]){
etisserant@40:             count1 += count2;
etisserant@40:             count2 = 0;
etisserant@40:         }        
etisserant@40:     }
etisserant@41:     return count2 == IN2->len -1 ? 0 : count1 + 1;
etisserant@41: }
etisserant@41: static inline UINT __find(STRING IN1, STRING IN2){
etisserant@40:     return __pfind(&IN1, &IN2);
etisserant@40: }
etisserant@40: 
etisserant@40: /***************/
etisserant@40: /* Convertions */
etisserant@40: /***************/
etisserant@40:     /***************/
etisserant@40:     /*  TO_STRING  */
etisserant@40:     /***************/
etisserant@41: static inline STRING __bool_to_string(BOOL IN)
etisserant@40: {
etisserant@40:     if(IN)
etisserant@40:         return (STRING){4, "TRUE"};
etisserant@40:     return (STRING){5,"FALSE"};
etisserant@40: }
etisserant@41: static inline STRING __bit_to_string(LWORD IN){
etisserant@41:     STRING res = __INIT_STRING;
etisserant@40:     res.len = snprintf(res.body, STR_MAX_LEN, "16#%llx", IN);
etisserant@40:     if(res.len > STR_MAX_LEN) res.len = STR_MAX_LEN;
etisserant@40:     return res;
etisserant@40: }
etisserant@41: static inline STRING __real_to_string(LREAL IN){
etisserant@41:     STRING res = __INIT_STRING;
etisserant@43:     res.len = snprintf(res.body, STR_MAX_LEN, "%.10g", IN);
etisserant@40:     if(res.len > STR_MAX_LEN) res.len = STR_MAX_LEN;
etisserant@40:     return res;
etisserant@40: }
etisserant@41: static inline STRING __sint_to_string(LINT IN){
etisserant@41:     STRING res = __INIT_STRING;
etisserant@40:     res.len = snprintf(res.body, STR_MAX_LEN, "%lld", IN);
etisserant@40:     if(res.len > STR_MAX_LEN) res.len = STR_MAX_LEN;
etisserant@40:     return res;
etisserant@40: }
etisserant@41: static inline STRING __uint_to_string(ULINT IN){
etisserant@41:     STRING res = __INIT_STRING;
etisserant@42:     res.len = snprintf(res.body, STR_MAX_LEN, "%llu", IN);
etisserant@40:     if(res.len > STR_MAX_LEN) res.len = STR_MAX_LEN;
etisserant@40:     return res;
etisserant@40: }
etisserant@40:     /***************/
etisserant@40:     /* FROM_STRING */
etisserant@40:     /***************/
etisserant@41: static inline BOOL __string_to_bool(STRING IN){
etisserant@40:     return IN.len == 5 ? !memcmp(&IN.body,"TRUE", IN.len) : 0;
etisserant@40: }
etisserant@40: 
etisserant@41: static inline LINT __pstring_to_sint(STRING* IN){
etisserant@40:     LINT res = 0;
etisserant@40:     char tmp[STR_MAX_LEN];
etisserant@40:     char tmp2[STR_MAX_LEN];
etisserant@40:     __strlen_t l;
etisserant@40:     unsigned int shift = 0;
etisserant@40:     
etisserant@40:     if(IN->body[0]=='2' && IN->body[1]=='#'){
etisserant@40:         /* 2#0101_1010_1011_1111 */
etisserant@40:         for(l = IN->len - 1; l >= 2 && shift < 64; l--)
etisserant@40:         {
etisserant@40:             char c = IN->body[l];
etisserant@40:             if( c >= '0' && c <= '1'){
etisserant@40:                 res |= ( c - '0') << shift;
etisserant@40:                 shift += 1;
etisserant@40:             }
etisserant@40:         }
etisserant@40:     }else if(IN->body[0]=='8' && IN->body[1]=='#'){
etisserant@40:         /* 8#1234_5665_4321 */
etisserant@40:         for(l = IN->len - 1; l >= 2 && shift < 64; l--)
etisserant@40:         {
etisserant@40:             char c = IN->body[l];
etisserant@40:             if( c >= '0' && c <= '7'){
etisserant@40:                 res |= ( c - '0') << shift;
etisserant@40:                 shift += 3;
etisserant@40:             }
etisserant@40:         }
etisserant@43:     }else if(IN->body[0]=='1' && IN->body[1]=='6' && IN->body[2]=='#'){
etisserant@40:         /* 16#1234_5678_9abc_DEFG */
etisserant@40:         for(l = IN->len - 1; l >= 3 && shift < 64; l--)
etisserant@40:         {
etisserant@40:             char c = IN->body[l];
etisserant@40:             if( c >= '0' && c <= '9'){
etisserant@43:                 res |= (LWORD)( c - '0') << shift;
etisserant@40:                 shift += 4;
etisserant@40:             }else if( c >= 'a' && c <= 'f'){
etisserant@43:                 res |= (LWORD)( c - 'a' + 10 ) << shift;
etisserant@40:                 shift += 4;
etisserant@40:             }else if( c >= 'A' && c <= 'F'){
etisserant@43:                 res |= (LWORD)( c - 'A' + 10 ) << shift;
etisserant@40:                 shift += 4;
etisserant@40:             }
etisserant@40:         }
etisserant@40:     }else{
etisserant@40:         /* -123456789 */
etisserant@40:         LINT fac = IN->body[0] == '-' ? -1 : 1;
etisserant@40:         for(l = IN->len - 1; l >= 0 && shift < 20; l--)
etisserant@40:         {
etisserant@40:             char c = IN->body[l];
etisserant@40:             if( c >= '0' && c <= '9'){
etisserant@40:                 res += ( c - '0') * fac;
etisserant@40:                 fac *= 10;
etisserant@40:                 shift += 1;
etisserant@41:             }else if( c >= '.' ){ /* reset value */
etisserant@41:                 res = 0;
etisserant@41:                 fac = 1;
etisserant@41:                 shift = 0;
etisserant@41:             }            
etisserant@40:         }
etisserant@40:     }
etisserant@40:     return res;
etisserant@40: }
etisserant@40: 
etisserant@41: static inline LINT __string_to_sint(STRING IN){
etisserant@40:     return (LWORD)__pstring_to_sint(&IN);
etisserant@40: }
etisserant@41: static inline LWORD __string_to_bit(STRING IN){
etisserant@40:     return (LWORD)__pstring_to_sint(&IN);
etisserant@40: }
etisserant@41: static inline ULINT __string_to_uint(STRING IN){
etisserant@40:     return (ULINT)__pstring_to_sint(&IN);
etisserant@40: }
etisserant@41: static inline LREAL __string_to_real(STRING IN){
etisserant@40:     /* search the dot */
etisserant@40:     __strlen_t l = IN.len;
etisserant@40:     while(--l > 0 && IN.body[l] != '.');
etisserant@40:     if(l != 0){
etisserant@40:         return atof((const char *)&IN.body);
etisserant@40:     }else{
etisserant@40:         return (LREAL)__pstring_to_sint(&IN);
etisserant@40:     }    
etisserant@40: }
etisserant@40: 
etisserant@40:     /***************/
etisserant@40:     /*   TO_TIME   */
etisserant@40:     /***************/
etisserant@41: static inline TIME __int_to_time(LINT IN){
etisserant@40:     return (TIME){IN, 0};
etisserant@40: }
etisserant@40: 
etisserant@41: static inline TIME __real_to_time(LREAL IN){
etisserant@40:     return (TIME){IN, (IN - (LINT)IN) * 1000000000};
etisserant@40: }
etisserant@41: static inline TIME __string_to_time(STRING IN){
etisserant@40:     /* TODO :
etisserant@40:      *
etisserant@40:      *  Duration literals without underlines: T#14ms    T#-14ms   T#14.7s   T#14.7m
etisserant@40:      *                short prefix            T#14.7h    t#14.7d   t#25h15m
etisserant@40:      *                                        t#5d14h12m18s3.5ms
etisserant@40:      *                long prefix             TIME#14ms    TIME#-14ms   time#14.7s
etisserant@40:      *  Duration literals with underlines:
etisserant@40:      *                short prefix            t#25h_15m t#5d_14h_12m_18s_3.5ms
etisserant@40:      *                long prefix             TIME#25h_15m
etisserant@40:      *                                        time#5d_14h_12m_18s_3.5ms
etisserant@40:      *
etisserant@40:      *  Long prefix notation                 Short prefix notation
etisserant@40:      *  DATE#1984-06-25                      D#1984-06-25
etisserant@40:      *  date#1984-06-25                      d#1984-06-25
etisserant@40:      *  TIME_OF_DAY#15:36:55.36              TOD#15:36:55.36
etisserant@40:      *  time_of_day#15:36:55.36              tod#15:36:55.36
etisserant@40:      *  DATE_AND_TIME#1984-06-25-15:36:55.36 DT#1984-06-25-15:36:55.36
etisserant@40:      *  date_and_time#1984-06-25-15:36:55.36 dt#1984-06-25-15:36:55.36
etisserant@40:      *
etisserant@40:      */
etisserant@40:     /* Quick hack : only transform seconds */
etisserant@40:     /* search the dot */
etisserant@40:     __strlen_t l = IN.len;
etisserant@40:     while(--l > 0 && IN.body[l] != '.');
etisserant@40:     if(l != 0){
etisserant@40:         LREAL IN_val = atof((const char *)&IN.body);
etisserant@40:         return  (TIME){IN_val, (IN_val - (LINT)IN_val)*1000000000};
etisserant@40:     }else{
etisserant@40:         return  (TIME){__pstring_to_sint(&IN), 0};
etisserant@40:     }
etisserant@40: }
etisserant@40: 
etisserant@40:     /***************/
etisserant@40:     /*  FROM_TIME  */
etisserant@40:     /***************/
etisserant@41: static inline LREAL __time_to_real(TIME IN){
etisserant@40:     return (LREAL)IN.tv_sec + ((LREAL)IN.tv_nsec/1000000000);
etisserant@40: }
etisserant@41: static inline LINT __time_to_int(TIME IN){
etisserant@40:     return IN.tv_sec;
etisserant@40: }
etisserant@41: static inline STRING __time_to_string(TIME IN){
etisserant@40:     /*t#5d14h12m18s3.5ms*/
etisserant@41:     STRING res = __INIT_STRING;
etisserant@40:     div_t days = div(IN.tv_sec ,86400);
etisserant@40:     if(!days.rem && IN.tv_nsec == 0){
etisserant@40:         res.len = snprintf((char*)&res.body, STR_MAX_LEN, "T#%dd", days.quot);
etisserant@40:     }else{
etisserant@40:         div_t hours = div(days.rem, 3600);
etisserant@40:         if(!hours.rem && IN.tv_nsec == 0){
etisserant@40:             res.len = snprintf((char*)&res.body, STR_MAX_LEN, "T#%dd%dh", days.quot, hours.quot);
etisserant@40:         }else{
etisserant@40:             div_t minuts = div(hours.rem, 60);
etisserant@40:             if(!minuts.rem && IN.tv_nsec == 0){
etisserant@40:                 res.len = snprintf((char*)&res.body, STR_MAX_LEN, "T#%dd%dh%dm", days.quot, hours.quot, minuts.quot);
etisserant@40:             }else{
etisserant@40:                 if(IN.tv_nsec == 0){
etisserant@40:                     res.len = snprintf((char*)&res.body, STR_MAX_LEN, "T#%dd%dh%dm%ds", days.quot, hours.quot, minuts.quot, minuts.rem);
etisserant@40:                 }else{
etisserant@42:                     res.len = snprintf((char*)&res.body, STR_MAX_LEN, "T#%dd%dh%dm%ds%gms", days.quot, hours.quot, minuts.quot, minuts.rem, (LREAL)IN.tv_nsec / 1000000);
etisserant@40:                 }
etisserant@40:             }
etisserant@40:         }
etisserant@40:     }
etisserant@40:     if(res.len > STR_MAX_LEN) res.len = STR_MAX_LEN;
etisserant@40:     return res;
etisserant@40: }
etisserant@41: static inline STRING __date_to_string(DATE IN){
etisserant@40:     /* D#1984-06-25 */
etisserant@41:     STRING res = __INIT_STRING;
etisserant@40:     struct tm broken_down_time;
etisserant@40:     time_t seconds = IN.tv_sec;
etisserant@42:     if (NULL == localtime_r(&seconds, &broken_down_time)){ /* get the UTC (GMT) broken down time */
etisserant@40:         IEC_error();
etisserant@40:         return (STRING){7,"D#ERROR"};
etisserant@40:     }
etisserant@42:     res.len = snprintf((char*)&res.body, STR_MAX_LEN, "D#%d-%2.2d-%2.2d", broken_down_time.tm_year + 1900, broken_down_time.tm_mon + 1, broken_down_time.tm_mday);
etisserant@40:     if(res.len > STR_MAX_LEN) res.len = STR_MAX_LEN;
etisserant@40:     return res;
etisserant@40: }
etisserant@41: static inline STRING __tod_to_string(TOD IN){
etisserant@40:     /* TOD#15:36:55.36 */
etisserant@41:     STRING res = __INIT_STRING;
etisserant@40:     struct tm broken_down_time;
etisserant@40:     time_t seconds = IN.tv_sec;
etisserant@42:     if (NULL == localtime_r(&seconds, &broken_down_time)){ /* get the UTC (GMT) broken down time */
etisserant@40:         IEC_error();
etisserant@40:         return (STRING){9,"TOD#ERROR"};
etisserant@40:     }
etisserant@40:     if(IN.tv_nsec == 0){
etisserant@40:         res.len = snprintf((char*)&res.body, STR_MAX_LEN, "TOD#%2.2d:%2.2d:%d", broken_down_time.tm_hour, broken_down_time.tm_min, broken_down_time.tm_sec);
etisserant@40:     }else{
etisserant@42:         res.len = snprintf((char*)&res.body, STR_MAX_LEN, "TOD#%2.2d:%2.2d:%g", broken_down_time.tm_hour, broken_down_time.tm_min, (LREAL)broken_down_time.tm_sec + (LREAL)IN.tv_nsec / 1e9);
etisserant@40:     }
etisserant@40:     if(res.len > STR_MAX_LEN) res.len = STR_MAX_LEN;
etisserant@40:     return res;
etisserant@40: }
etisserant@41: static inline STRING __dt_to_string(DT IN){
etisserant@40:     /* DT#1984-06-25-15:36:55.36 */
etisserant@40:     STRING res;
etisserant@40:     struct tm broken_down_time;
etisserant@40:     time_t seconds = IN.tv_sec;
etisserant@42:     if (NULL == localtime_r(&seconds, &broken_down_time)){ /* get the UTC (GMT) broken down time */
etisserant@40:         IEC_error();
etisserant@40:         return (STRING){8,"DT#ERROR"};
etisserant@40:     }
etisserant@40:     if(IN.tv_nsec == 0){
etisserant@40:         res.len = snprintf((char*)&res.body, STR_MAX_LEN, "DT#%d-%2.2d-%2.2d-%2.2d:%2.2d:%d",
etisserant@40:                  broken_down_time.tm_year,
etisserant@40:                  broken_down_time.tm_mon,
etisserant@40:                  broken_down_time.tm_mday,
etisserant@40:                  broken_down_time.tm_hour,
etisserant@40:                  broken_down_time.tm_min,
etisserant@40:                  broken_down_time.tm_sec);
etisserant@40:     }else{
etisserant@42:         res.len = snprintf((char*)&res.body, STR_MAX_LEN, "DT#%d-%2.2d-%2.2d-%2.2d:%2.2d:%g",
etisserant@40:                  broken_down_time.tm_year,
etisserant@40:                  broken_down_time.tm_mon,
etisserant@40:                  broken_down_time.tm_mday,
etisserant@40:                  broken_down_time.tm_hour,
etisserant@40:                  broken_down_time.tm_min,
etisserant@42:                  (LREAL)broken_down_time.tm_sec + ((LREAL)IN.tv_nsec / 1e9));
etisserant@40:     }
etisserant@40:     if(res.len > STR_MAX_LEN) res.len = STR_MAX_LEN;
etisserant@40:     return res;
etisserant@40: }
etisserant@40:     /* BCD */
etisserant@48: #define __bcd_digit(fac) 
etisserant@41: static inline ULINT __bcd_to_uint(LWORD IN){
etisserant@40:     return IN & 0xf +
etisserant@48:            !(IN >>= 4) ? 0 : IN & 0xf * 10ULL + 
etisserant@48:            !(IN >>= 4) ? 0 : IN & 0xf * 100ULL + 
etisserant@48:            !(IN >>= 4) ? 0 : IN & 0xf * 1000ULL + 
etisserant@48:            !(IN >>= 4) ? 0 : IN & 0xf * 10000ULL + 
etisserant@48:            !(IN >>= 4) ? 0 : IN & 0xf * 100000ULL + 
etisserant@48:            !(IN >>= 4) ? 0 : IN & 0xf * 1000000ULL + 
etisserant@48:            !(IN >>= 4) ? 0 : IN & 0xf * 10000000ULL + 
etisserant@48:            !(IN >>= 4) ? 0 : IN & 0xf * 100000000ULL + 
etisserant@48:            !(IN >>= 4) ? 0 : IN & 0xf * 1000000000ULL + 
etisserant@48:            !(IN >>= 4) ? 0 : IN & 0xf * 10000000000ULL + 
etisserant@48:            !(IN >>= 4) ? 0 : IN & 0xf * 100000000000ULL + 
etisserant@48:            !(IN >>= 4) ? 0 : IN & 0xf * 1000000000000ULL + 
etisserant@48:            !(IN >>= 4) ? 0 : IN & 0xf * 10000000000000ULL + 
etisserant@48:            !(IN >>= 4) ? 0 : IN & 0xf * 100000000000000ULL + 
etisserant@48:            !(IN >>= 4) ? 0 : IN & 0xf * 1000000000000000ULL;
etisserant@48:            
etisserant@40: }
etisserant@41: static inline LWORD __uint_to_bcd(ULINT IN){
etisserant@40:     return (IN - (IN /= 10))|
etisserant@40:            (IN - (IN /= 10)) << 4 |
etisserant@40:            (IN - (IN /= 10)) << 8 |
etisserant@40:            (IN - (IN /= 10)) << 12 |
etisserant@40:            (IN - (IN /= 10)) << 16 |
etisserant@40:            (IN - (IN /= 10)) << 20 |
etisserant@40:            (IN - (IN /= 10)) << 24 |
etisserant@40:            (IN - (IN /= 10)) << 28 |
etisserant@40:            (IN - (IN /= 10)) << 32 |
etisserant@40:            (IN - (IN /= 10)) << 36 |
etisserant@40:            (IN - (IN /= 10)) << 40 |
etisserant@40:            (IN - (IN /= 10)) << 44 |
etisserant@40:            (IN - (IN /= 10)) << 48 |
etisserant@40:            (IN - (IN /= 10)) << 52 |
etisserant@40:            (IN - (IN /= 10)) << 56 |
etisserant@40:            (IN - (IN /= 10)) << 60;
etisserant@40: }
etisserant@40: 
etisserant@40: /**************/
etisserant@40: /* Binary ops */
etisserant@40: /**************/
etisserant@40: #define __ror_(TYPENAME)\
etisserant@41: static inline TYPENAME __ror_##TYPENAME( TYPENAME IN, USINT N){\
etisserant@40:  N %= 8*sizeof(TYPENAME);\
etisserant@40:  return (IN >> N) | (IN << 8*sizeof(TYPENAME)-N);\
etisserant@40: }
etisserant@40: /* Call previously defined macro for each ANY_NBIT */
etisserant@40: ANY_NBIT(__ror_)
etisserant@40: 
etisserant@40: #define __rol_(TYPENAME)\
etisserant@41: static inline TYPENAME __rol_##TYPENAME( TYPENAME IN, USINT N){\
etisserant@40:  N %= 8*sizeof(TYPENAME);\
etisserant@40:  return (IN << N) | (IN >> 8*sizeof(TYPENAME)-N);\
etisserant@40: }
etisserant@40: /* Call previously defined macro for each ANY_NBIT */
etisserant@40: ANY_NBIT(__rol_)
etisserant@40: 
etisserant@40: /**************/
etisserant@40: /* Selection  */
etisserant@40: /**************/
etisserant@40: 	/**************/
etisserant@40: 	/*   limit    */
etisserant@40: 	/**************/
etisserant@40: 
etisserant@40: #define __limit_(TYPENAME)\
etisserant@41: static inline TYPENAME __limit_##TYPENAME( TYPENAME MN, TYPENAME IN, TYPENAME MX){\
etisserant@40:  return IN > MN ? IN < MX ? IN : MX : MN;\
etisserant@40: }
etisserant@40: 
etisserant@40: /* Call previously defined macro for each concerned type */
etisserant@40: ANY_NBIT(__limit_)
etisserant@40: ANY_NUM(__limit_)
etisserant@40: 
etisserant@40: #define __limit_time(TYPENAME)\
etisserant@41: static inline TIME __limit_##TYPENAME( TYPENAME MN, TYPENAME IN, TYPENAME MX){\
etisserant@40:     return __TIME_CMP(IN, MN) > 0 ? /* IN>MN ?*/\
etisserant@40:            __TIME_CMP(IN, MX) < 0 ? /* IN<MX ?*/\
etisserant@40:            IN : MX : MN;\
etisserant@40: }
etisserant@40: 
etisserant@40: /* Call previously defined macro for each concerned type */
etisserant@40: ANY_DATE(__limit_time)
etisserant@40: __limit_time(TIME)
etisserant@40: 
etisserant@41: static inline STRING __limit_STRING( STRING MN, STRING IN, STRING MX){
etisserant@40:     return __STR_CMP(IN, MN) > 0 ? __STR_CMP(IN, MX) < 0 ? IN : MX : MN;
etisserant@40: }
etisserant@40: 
etisserant@40:     /**************/
etisserant@40:     /*     MAX    */
etisserant@40:     /**************/
etisserant@40:     
etisserant@40: /* workaround for va-atgs limitation on shorter that int params */    
etisserant@40: #define VA_ARGS_REAL LREAL
etisserant@40: #define VA_ARGS_LREAL LREAL
etisserant@40: #define VA_ARGS_SINT DINT
etisserant@40: #define VA_ARGS_INT DINT
etisserant@40: #define VA_ARGS_DINT DINT
etisserant@40: #define VA_ARGS_LINT LINT
etisserant@40: #define VA_ARGS_USINT UDINT
etisserant@40: #define VA_ARGS_UINT UDINT
etisserant@40: #define VA_ARGS_UDINT UDINT
etisserant@40: #define VA_ARGS_ULINT ULINT
etisserant@40: #define VA_ARGS_TIME TIME
etisserant@40: #define VA_ARGS_BOOL DWORD
etisserant@40: #define VA_ARGS_BYTE DWORD
etisserant@40: #define VA_ARGS_WORD DWORD
etisserant@40: #define VA_ARGS_DWORD DWORD
etisserant@40: #define VA_ARGS_LWORD LWORD
etisserant@40: #define VA_ARGS_STRING STRING
etisserant@40: #define VA_ARGS_WSTRING WSTRING
etisserant@40: #define VA_ARGS_DATE DATE
etisserant@40: #define VA_ARGS_TOD TOD
etisserant@40: #define VA_ARGS_DT DT
etisserant@40: 
etisserant@40: #define __extrem_(fname,TYPENAME, COND) \
etisserant@41: static inline TYPENAME fname##TYPENAME( UINT param_count, TYPENAME op1, ...){\
etisserant@40:   va_list ap;\
etisserant@40:   UINT i;\
etisserant@40:   \
etisserant@40:   va_start (ap, op1);         /* Initialize the argument list.  */\
etisserant@40:   \
etisserant@40:   for (i = 0; i < param_count; i++){\
etisserant@40:     TYPENAME tmp = va_arg (ap, VA_ARGS_##TYPENAME);\
etisserant@40:     op1 = COND ? tmp : op1;\
etisserant@40:   }\
etisserant@40:   \
etisserant@40:   va_end (ap);                  /* Clean up.  */\
etisserant@40:   return op1;\
etisserant@40: }
etisserant@40: 
etisserant@40: #define __max_num(TYPENAME) __extrem_(__max_,TYPENAME, op1 < tmp)
etisserant@40: ANY_NBIT(__max_num)
etisserant@40: ANY_NUM(__max_num)
etisserant@40: 
etisserant@40: __extrem_(__max_, STRING, __STR_CMP(op1,tmp) < 0)
etisserant@40: #define __max_time(TYPENAME) __extrem_(__max_, TYPENAME, __TIME_CMP(op1, tmp) < 0)
etisserant@40: 
etisserant@40: /* Call previously defined macro for each concerned type */
etisserant@40: ANY_DATE(__max_time)
etisserant@40: __max_time(TIME)
etisserant@40: 
etisserant@40:     /**************/
etisserant@40:     /*     MIN    */
etisserant@40:     /**************/
etisserant@40: #define __min_num(TYPENAME) __extrem_(__min, TYPENAME, op1 > tmp)
etisserant@40: ANY_NBIT(__min_num)
etisserant@40: ANY_NUM(__min_num)
etisserant@40: 
etisserant@40: __extrem_(__min, STRING, __STR_CMP(op1,tmp) > 0)
etisserant@40: 
etisserant@40: #define __min_time(TYPENAME) __extrem_(__min_, TYPENAME, __TIME_CMP(op1, tmp) > 0)
etisserant@40: 
etisserant@40: /* Call previously defined macro for each concerned type */
etisserant@40: ANY_DATE(__min_time)
etisserant@40: __min_time(TIME)
etisserant@40: 
etisserant@40:     /**************/
etisserant@40:     /*     MUX    */
etisserant@40:     /**************/
etisserant@40: #define __mux_(TYPENAME) \
etisserant@41: static inline TYPENAME __mux_##TYPENAME( UINT param_count, UINT K, ...){\
etisserant@40:   va_list ap;\
etisserant@40:   UINT i;\
etisserant@41:   TYPENAME tmp = __INIT_##TYPENAME;\
etisserant@40:   \
etisserant@41:   va_start (ap, K);         /* Initialize the argument list.  */\
etisserant@40:   \
etisserant@40:   for (i = 0; i < param_count; i++){\
etisserant@40:     if(K == i){\
etisserant@41:         tmp = va_arg (ap, VA_ARGS_##TYPENAME);\
etisserant@40:         va_end (ap);                  /* Clean up.  */\
etisserant@40:         return tmp;\
etisserant@40:     }else{\
etisserant@40:         va_arg (ap, VA_ARGS_##TYPENAME);\
etisserant@40:     }\
etisserant@40:   }\
etisserant@40:   \
etisserant@40:   va_end (ap);                  /* Clean up.  */\
etisserant@41:   return tmp;\
etisserant@40: }
etisserant@40: 
etisserant@40: ANY(__mux_)
etisserant@40: 
etisserant@40: /**************/
etisserant@40: /* Comparison */
etisserant@40: /**************/
etisserant@40: 
etisserant@40: #define __compare_(fname,TYPENAME, COND) \
etisserant@41: static inline BOOL fname##TYPENAME( UINT param_count, TYPENAME op1, ...){\
etisserant@40:   va_list ap;\
etisserant@40:   UINT i;\
etisserant@40:   \
etisserant@40:   va_start (ap, op1);         /* Initialize the argument list.  */\
etisserant@43:   DBG(#fname #TYPENAME "\n")\
etisserant@43:   DBG_TYPE(TYPENAME, op1)\
etisserant@40:   \
etisserant@43:   for (i = 0; i < param_count - 1; i++){\
etisserant@40:     TYPENAME tmp = va_arg (ap, VA_ARGS_##TYPENAME);\
etisserant@43:     DBG_TYPE(TYPENAME, tmp)\
etisserant@40:     if(COND){\
etisserant@40:         op1 = tmp;\
etisserant@40:     }else{\
etisserant@40:         va_end (ap);                  /* Clean up.  */\
etisserant@40:         return 0;\
etisserant@40:     }\
etisserant@40:   }\
etisserant@40:   \
etisserant@40:   va_end (ap);                  /* Clean up.  */\
etisserant@40:   return 1;\
etisserant@40: }
etisserant@40: 
etisserant@40: #define __compare_num(fname, TYPENAME, TEST) __compare_(fname, TYPENAME, op1 TEST tmp )
etisserant@40: #define __compare_time(fname, TYPENAME, TEST) __compare_(fname, TYPENAME, __TIME_CMP(op1, tmp) TEST 0)
etisserant@40: #define __compare_string(fname, TEST) __compare_(fname, STRING, __STR_CMP(op1, tmp) TEST 0 )
etisserant@40: 
etisserant@40:     /**************/
etisserant@40:     /*     GT     */
etisserant@40:     /**************/
etisserant@40: 
etisserant@40: #define __gt_num(TYPENAME) __compare_num(__gt_, TYPENAME, > )
etisserant@40: ANY_NBIT(__gt_num)
etisserant@40: ANY_NUM(__gt_num)
etisserant@40: 
etisserant@40: #define __gt_time(TYPENAME) __compare_time(__gt_, TYPENAME, > )
etisserant@40: ANY_DATE(__gt_time)
etisserant@40: __gt_time(TIME)
etisserant@40: 
etisserant@40: __compare_string(__gt_, > )
etisserant@40: 
etisserant@40:     /**************/
etisserant@40:     /*     GE     */
etisserant@40:     /**************/
etisserant@40: 
etisserant@40: #define __ge_num(TYPENAME) __compare_num(__ge_, TYPENAME, >= )
etisserant@43: ANY_BIT(__ge_num)
etisserant@40: ANY_NUM(__ge_num)
etisserant@40: 
etisserant@40: #define __ge_time(TYPENAME) __compare_time(__ge_, TYPENAME, >= )
etisserant@40: ANY_DATE(__ge_time)
etisserant@40: __ge_time(TIME)
etisserant@40: 
etisserant@40: __compare_string(__ge_, >=)
etisserant@40: 
etisserant@40:     /**************/
etisserant@40:     /*     EQ     */
etisserant@40:     /**************/
etisserant@40: 
etisserant@40: #define __eq_num(TYPENAME) __compare_num(__eq_, TYPENAME, == )
etisserant@43: ANY_BIT(__eq_num)
etisserant@40: ANY_NUM(__eq_num)
etisserant@40: 
etisserant@40: #define __eq_time(TYPENAME) __compare_time(__eq_, TYPENAME, == )
etisserant@40: ANY_DATE(__eq_time)
etisserant@40: __eq_time(TIME)
etisserant@40: 
etisserant@40: __compare_string(__eq_, == )
etisserant@40: 
etisserant@40:     /**************/
etisserant@40:     /*     LT     */
etisserant@40:     /**************/
etisserant@40: 
etisserant@40: #define __lt_num(TYPENAME) __compare_num(__lt_, TYPENAME, < )
etisserant@43: ANY_BIT(__lt_num)
etisserant@40: ANY_NUM(__lt_num)
etisserant@40: 
etisserant@40: #define __lt_time(TYPENAME) __compare_time(__lt_, TYPENAME, < )
etisserant@40: ANY_DATE(__lt_time)
etisserant@40: __lt_time(TIME)
etisserant@40: 
etisserant@40: __compare_string(__lt_, < )
etisserant@40: 
etisserant@40:     /**************/
etisserant@40:     /*     LE     */
etisserant@40:     /**************/
etisserant@40: 
etisserant@40: #define __le_num(TYPENAME) __compare_num(__le_, TYPENAME, <= )
etisserant@43: ANY_BIT(__le_num)
etisserant@40: ANY_NUM(__le_num)
etisserant@40: 
etisserant@40: #define __le_time(TYPENAME) __compare_time(__le_, TYPENAME, <= )
etisserant@40: ANY_DATE(__le_time)
etisserant@40: __le_time(TIME)
etisserant@40: 
etisserant@40: __compare_string(__le_, <= )
etisserant@40: 
etisserant@40:     /**************/
etisserant@40:     /*     NE     */
etisserant@40:     /**************/
etisserant@40: 
etisserant@40: #define __ne_num(TYPENAME) __compare_num(__ne_, TYPENAME, != )
etisserant@43: ANY_BIT(__ne_num)
etisserant@40: ANY_NUM(__ne_num)
etisserant@40: 
etisserant@40: #define __ne_time(TYPENAME) __compare_time(__ne_, TYPENAME, != )
etisserant@40: ANY_DATE(__ne_time)
etisserant@40: __ne_time(TIME)
etisserant@40: 
etisserant@40: __compare_string(__ne_, != )
etisserant@40: 
etisserant@40: