forked from epics_driver_modules/require
281 lines
7.9 KiB
C
281 lines
7.9 KiB
C
#include <ctype.h>
|
|
#include <string.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
|
|
#include "expr.h"
|
|
|
|
int exprDebug;
|
|
|
|
static int parseSubExpr(const char** pp, long* v, int pr, int op);
|
|
#define parseExpr(pp,v) parseSubExpr(pp, v, 0, 0)
|
|
|
|
static int parseValue(const char** pp, long* v)
|
|
{
|
|
long val;
|
|
const char *p = *pp;
|
|
char o;
|
|
|
|
/* A value is optionally prefixed with an unary operator + - ! ~.
|
|
* It is either a number (decimal, octal or hex)
|
|
* or an expression in ().
|
|
* Allowed chars after a number: operators, closing parenthesis, whitespace, quotes, end of string
|
|
*/
|
|
|
|
/* first look for value */
|
|
while (isspace((unsigned char)*p)) p++;
|
|
o = *p;
|
|
if (memchr("+-~!", o, 4))
|
|
{
|
|
/* handle unary operators */
|
|
p++;
|
|
if (!parseValue(&p, &val)) return 0; /* no valid value */
|
|
if (o == '-') val=-val;
|
|
else if (o == '~') val=~val;
|
|
else if (o == '!') val=!val;
|
|
}
|
|
else if (o == '(')
|
|
{
|
|
/* handle sub-expression */
|
|
p++;
|
|
if (parseExpr(&p, &val) < 0) return 0; /* no valid expression */
|
|
while (isspace((unsigned char)*p)) p++;
|
|
if (*p++ != ')') return 0; /* missing ) */
|
|
}
|
|
else
|
|
{
|
|
/* get number */
|
|
char* e;
|
|
val = strtol(p, &e, 0);
|
|
if (e == p) return 0; /* no number */
|
|
|
|
if (isalpha((unsigned char)*e)||*e=='.')
|
|
{
|
|
/* followed by rubbish */
|
|
return 0;
|
|
}
|
|
p = e;
|
|
}
|
|
*pp = p;
|
|
*v = val;
|
|
return 1;
|
|
}
|
|
|
|
static long ipow(long base, long exp)
|
|
{
|
|
long v;
|
|
if (exp < 0) return 0;
|
|
if (exp == 0) return 1;
|
|
v = base;
|
|
while (--exp) v *= base; /* optimize this! */
|
|
return v;
|
|
}
|
|
|
|
struct {char str[4]; int pr;} ops[] = {
|
|
{"",0},
|
|
{"**",11},
|
|
{"*", 10},{"/",10},{"%",10},
|
|
{"+",9},{"-",9},
|
|
{"<<",8},{">>>",8},{">>",8},
|
|
{"<=>",7},{"<=",7},{">=",7},{"<",7},{">",7},
|
|
{"==",6},{"!=",6},
|
|
{"&&",5},{"||",5},
|
|
{"&",4},{"^",3},{"|",2},
|
|
{"?:",1},{"?",1},{":",0}
|
|
};
|
|
|
|
static int startsWith(const char* p, const char* s)
|
|
{
|
|
int i = 0;
|
|
while (*s) { i++; if (*p++ != *s++) return 0; }
|
|
return i;
|
|
}
|
|
|
|
static int parseOp(const char** pp)
|
|
{
|
|
const char *p = *pp;
|
|
int o, l;
|
|
|
|
while (isspace((unsigned char)*p)) p++;
|
|
if (ispunct((unsigned char)*p))
|
|
{
|
|
for (o = 1; o < (int)(sizeof(ops)/sizeof(ops[0])); o++)
|
|
{
|
|
if ((l = startsWith(p, ops[o].str)))
|
|
{
|
|
/* operator found */
|
|
*pp = p+l;
|
|
return o;
|
|
}
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int parseSubExpr(const char** pp, long* v, int pr, int o)
|
|
{
|
|
const char *p = *pp;
|
|
long val = o ? *v : 0;
|
|
long val2;
|
|
int o2 = o;
|
|
|
|
if (exprDebug) printf("parseExpr(%d): start %ld %s %s\n", pr, val, ops[o].str, p);
|
|
do {
|
|
if (!parseValue(&p, &val2))
|
|
{
|
|
if (exprDebug) printf("parseExpr(%d): no value after %ld %s\n", pr, val, ops[o].str);
|
|
return -1;
|
|
}
|
|
if ((o2 = parseOp(&p)))
|
|
{
|
|
if (exprDebug) printf("parseExpr(%d): %ld %s %ld %s %s\n", pr, val, ops[o].str, val2, ops[o2].str, p);
|
|
if (o && ops[o2].pr > ops[o].pr)
|
|
{
|
|
if ((o2 = parseSubExpr(&p, &val2, ops[o].pr, o2)) < 0)
|
|
{
|
|
if (exprDebug) printf("parseExpr(%d): parse failed after %ld %s %ld\n", pr, val, ops[o].str, val2);
|
|
return -1;
|
|
}
|
|
}
|
|
}
|
|
if (exprDebug) printf("parseExpr(%d): %ld %s %ld", pr, val, ops[o].str, val2);
|
|
switch (o)
|
|
{
|
|
case 0: val = val2; break;
|
|
case 1: val = ipow(val, val2); break;
|
|
case 2: val *= val2; break;
|
|
case 3: val /= val2; break;
|
|
case 4: val %= val2; break;
|
|
case 5: val += val2; break;
|
|
case 6: val -= val2; break;
|
|
case 7: val <<= val2; break;
|
|
case 8: val = (unsigned long)val >> val2; break;
|
|
case 9: val >>= val2; break;
|
|
case 10: val = val < val2 ? -1 : val == val2 ? 0 : 1; break;
|
|
case 11: val = val <= val2; break;
|
|
case 12: val = val >= val2; break;
|
|
case 13: val = val < val2; break;
|
|
case 14: val = val > val2; break;
|
|
case 15: val = val == val2; break;
|
|
case 16: val = val != val2; break;
|
|
case 17: val = val && val2; break;
|
|
case 18: val = val || val2; break;
|
|
case 19: val &= val2; break;
|
|
case 20: val ^= val2; break;
|
|
case 21: val |= val2; break;
|
|
case 22: if (!val) val = val2; break;
|
|
}
|
|
if (exprDebug) printf(" = %ld\n", val);
|
|
if (o2 == 23) /* ? ... : ... */
|
|
{
|
|
long val3 = 0;
|
|
val2 = 1;
|
|
if (exprDebug) printf("parseExpr(%d) if %ld ...\n", pr, val);
|
|
if ((o2 = parseSubExpr(&p, &val2, 1, 0)) == 24)
|
|
o2 = parseSubExpr(&p, &val3, 1, 0);
|
|
else o2 = 0;
|
|
if (exprDebug) printf("parseExpr(%d) if %ld then %ld else %ld\n", pr, val, val2, val3);
|
|
val = val ? val2 : val3;
|
|
}
|
|
o = o2;
|
|
} while (ops[o].pr && pr <= ops[o].pr);
|
|
if (exprDebug) printf("parseExpr(%d): value = %ld return %d %s\n", pr, val, o, ops[o].str);
|
|
*pp = p;
|
|
*v = val;
|
|
return o;
|
|
}
|
|
|
|
const char* getFormat(const char** pp)
|
|
{
|
|
static char format [20];
|
|
const char* p = *pp;
|
|
unsigned int i = 1;
|
|
if (exprDebug) printf("getFormat %s\n", p);
|
|
if ((format[0] = *p++) == '%')
|
|
{
|
|
while (i < sizeof(format) && memchr(" #-+0", *p, 5))
|
|
format[i++] = *p++;
|
|
while (i < sizeof(format) && *p >= '0' && *p <= '9')
|
|
format[i++] = *p++;
|
|
if (i < sizeof(format))
|
|
format[i++] = 'l';
|
|
if (i < sizeof(format) && memchr("diouxXc", *p, 7))
|
|
{
|
|
format[i++] = *p++;
|
|
format[i] = 0;
|
|
*pp = p;
|
|
if (exprDebug) printf("format = '%s'\n", format);
|
|
return format;
|
|
}
|
|
}
|
|
if (exprDebug) printf("no format\n");
|
|
return NULL;
|
|
}
|
|
|
|
size_t replaceExpressions(const char* r, char* buffer, size_t buffersize)
|
|
{
|
|
long val;
|
|
char* w = buffer;
|
|
char* s;
|
|
|
|
while (*r)
|
|
{
|
|
s = w;
|
|
if (*r == '"' || *r == '\'')
|
|
{
|
|
/* quoted strings */
|
|
char c = *w++ = *r++;
|
|
while (*r && *r != c) {
|
|
if (*r == '\\' && !(*w++ = *r++)) break;
|
|
*w++ = *r++;
|
|
}
|
|
if (*r) *w++ = *r++;
|
|
*w = 0;
|
|
if (exprDebug) printf("quoted string %s\n", s);
|
|
}
|
|
else if (*r == '%')
|
|
{
|
|
/* formatted expression */
|
|
const char* r2 = r;
|
|
const char* f;
|
|
if (exprDebug) printf("formatted expression after '%s'\n", s);
|
|
if ((f = getFormat(&r2)) && parseExpr(&r2, &val) == 0)
|
|
{
|
|
r = r2;
|
|
if (w > buffer && w[-1] == '(' && *r2++ == ')')
|
|
{
|
|
w--;
|
|
r = r2;
|
|
}
|
|
w += sprintf(w, f , val);
|
|
if (exprDebug) printf("formatted expression %s\n", s);
|
|
}
|
|
}
|
|
else if (parseExpr(&r, &val) == 0)
|
|
{
|
|
/* unformatted expression */
|
|
w += sprintf(w, "%ld", val);
|
|
*w = 0;
|
|
if (exprDebug) printf("simple expression %s\n", s);
|
|
}
|
|
else if (*r == ',')
|
|
{
|
|
/* single comma */
|
|
*w++ = *r++;
|
|
}
|
|
else {
|
|
/* unquoted string (i.e plain word) */
|
|
do {
|
|
*w++ = *r++;
|
|
} while (*r && !strchr("%(\"', \t\n", *r));
|
|
*w = 0;
|
|
if (exprDebug) printf("plain word '%s'\n", s);
|
|
}
|
|
/* copy space */
|
|
while (isspace((unsigned char)*r)) *w++ = *r++;
|
|
/* terminate */
|
|
*w = 0;
|
|
}
|
|
return w - buffer;
|
|
}
|