simgear/nasal/lib.c

   1 #include <math.h>
   2 #include <stdio.h>
   3 #include <stdlib.h>
   4 #include <stdarg.h>
   5 #include <string.h>
   6
   7 #ifdef _MSC_VER // sigh...
   8 #define snprintf _snprintf
   9 #define vsnprintf _vsnprintf
  10 #endif
  11
  12 #include "nasal.h"
  13 #include "code.h"
  14
  15 #define NEWSTR(c, s, l) naStr_fromdata(naNewString(c), s, l)
  16 #define NEWCSTR(c, s) NEWSTR(c, s, strlen(s))
  17
  18 // Generic argument error, assumes that the symbol "c" is a naContext,
  19 // and that the __FUNCTION__ string is of the form "f_NASALSYMBOL".
  20 #define ARGERR() \
  21     naRuntimeError(c, "bad/missing argument to %s()", (__FUNCTION__ + 2))
  22
  23 static naRef f_size(naContext c, naRef me, int argc, naRef* args)
  24 {
  25     if(argc == 0) ARGERR();
  26     if(naIsString(args[0])) return naNum(naStr_len(args[0]));
  27     if(naIsVector(args[0])) return naNum(naVec_size(args[0]));
  28     if(naIsHash(args[0])) return naNum(naHash_size(args[0]));
  29     naRuntimeError(c, "object has no size()");
  30     return naNil();
  31 }
  32
  33 static naRef f_keys(naContext c, naRef me, int argc, naRef* args)
  34 {
  35     naRef v, h = argc > 0 ? args[0] : naNil();
  36     if(!naIsHash(h)) ARGERR();
  37     v = naNewVector(c);
  38     naHash_keys(v, h);
  39     return v;
  40 }
  41
  42 static naRef f_append(naContext c, naRef me, int argc, naRef* args)
  43 {
  44     int i;
  45     if(argc < 2 || !naIsVector(args[0])) ARGERR();
  46     for(i=1; i<argc; i++) naVec_append(args[0], args[i]);
  47     return args[0];
  48 }
  49
  50 static naRef f_pop(naContext c, naRef me, int argc, naRef* args)
  51 {
  52     if(argc < 1 || !naIsVector(args[0])) ARGERR();
  53     return naVec_removelast(args[0]);
  54 }
  55
  56 static naRef f_setsize(naContext c, naRef me, int argc, naRef* args)
  57 {
  58     if(argc < 2 || !naIsVector(args[0])) ARGERR();
  59     naVec_setsize(args[0], (int)naNumValue(args[1]).num);
  60     return args[0];
  61 }
  62
  63 static naRef f_subvec(naContext c, naRef me, int argc, naRef* args)
  64 {
  65     int i;
  66     naRef nlen, result, v = args[0];
  67     int len = 0, start = (int)naNumValue(args[1]).num;
  68     if(argc < 2) return naNil();
  69     nlen = argc > 2 ? naNumValue(args[2]) : naNil();
  70     if(!naIsNil(nlen))
  71         len = (int)nlen.num;
  72     if(!naIsVector(v) || start < 0 || start > naVec_size(v) || len < 0)
  73         ARGERR();
  74     if(naIsNil(nlen) || len > naVec_size(v) - start)
  75         len = naVec_size(v) - start;
  76     result = naNewVector(c);
  77     naVec_setsize(result, len);
  78     for(i=0; i<len; i++)
  79         naVec_set(result, i, naVec_get(v, start + i));
  80     return result;
  81 }
  82
  83 static naRef f_delete(naContext c, naRef me, int argc, naRef* args)
  84 {
  85     if(argc < 2 || !naIsHash(args[0])) ARGERR();
  86     naHash_delete(args[0], args[1]);
  87     return args[0];
  88 }
  89
  90 static naRef f_int(naContext c, naRef me, int argc, naRef* args)
  91 {
  92     if(argc > 0) {
  93         naRef n = naNumValue(args[0]);
  94         if(naIsNil(n)) return n;
  95         if(n.num < 0) n.num = -floor(-n.num);
  96         else n.num = floor(n.num);
  97         return n;
  98     } else ARGERR();
  99     return naNil();
 100 }
 101
 102 static naRef f_num(naContext c, naRef me, int argc, naRef* args)
 103 {
 104     return argc > 0 ? naNumValue(args[0]) : naNil();
 105 }
 106
 107 static naRef f_streq(naContext c, naRef me, int argc, naRef* args)
 108 {
 109     return argc > 1 ? naNum(naStrEqual(args[0], args[1])) : naNil();
 110 }
 111
 112 static naRef f_cmp(naContext c, naRef me, int argc, naRef* args)
 113 {
 114     char *a, *b;
 115     int i, alen, blen;
 116     if(argc < 2 || !naIsString(args[0]) || !naIsString(args[1]))
 117         ARGERR();
 118     a = naStr_data(args[0]);
 119     alen = naStr_len(args[0]);
 120     b = naStr_data(args[1]);
 121     blen = naStr_len(args[1]);
 122     for(i=0; i<alen && i<blen; i++) {
 123         int diff = a[i] - b[i];
 124         if(diff) return naNum(diff < 0 ? -1 : 1);
 125     }
 126     return naNum(alen == blen ? 0 : (alen < blen ? -1 : 1));
 127 }
 128
 129 static naRef f_substr(naContext c, naRef me, int argc, naRef* args)
 130 {
 131     naRef src = argc > 1 ? args[0] : naNil();
 132     naRef startR = argc > 1 ? naNumValue(args[1]) : naNil();
 133     naRef lenR = argc > 2 ? naNumValue(args[2]) : naNil();
 134     int start, len;
 135     if(!naIsString(src) || naIsNil(startR)) ARGERR();
 136     start = (int)startR.num;
 137     len = naIsNil(lenR) ? (naStr_len(src) - start) : (int)lenR.num;
 138     if(len < 0) ARGERR();
 139     return naStr_substr(naNewString(c), src, start, len);
 140 }
 141
 142 static naRef f_chr(naContext c, naRef me, int argc, naRef* args)
 143 {
 144     char chr[1];
 145     naRef cr = argc > 0 ? naNumValue(args[0]) : naNil();
 146     if(IS_NIL(cr)) ARGERR();
 147     chr[0] = (char)cr.num;
 148     return NEWSTR(c, chr, 1);
 149 }
 150
 151 static naRef f_contains(naContext c, naRef me, int argc, naRef* args)
 152 {
 153     naRef hash = argc > 0 ? args[0] : naNil();
 154     naRef key = argc > 1 ? args[1] : naNil();
 155     if(naIsNil(hash) || naIsNil(key)) ARGERR();
 156     if(!naIsHash(hash)) return naNil();
 157     return naHash_get(hash, key, &key) ? naNum(1) : naNum(0);
 158 }
 159
 160 static naRef f_typeof(naContext c, naRef me, int argc, naRef* args)
 161 {
 162     naRef r = argc > 0 ? args[0] : naNil();
 163     char* t = "unknown";
 164     if(naIsNil(r)) t = "nil";
 165     else if(naIsNum(r)) t = "scalar";
 166     else if(naIsString(r)) t = "scalar";
 167     else if(naIsVector(r)) t = "vector";
 168     else if(naIsHash(r)) t = "hash";
 169     else if(naIsFunc(r)) t = "func";
 170     else if(naIsGhost(r)) t = "ghost";
 171     return NEWCSTR(c, t);
 172 }
 173
 174 static naRef f_ghosttype(naContext c, naRef me, int argc, naRef* args)
 175 {
 176     naRef g = argc > 0 ? args[0] : naNil();
 177     if(!naIsGhost(g)) return naNil();
 178     if(naGhost_type(g)->name) {
 179         return NEWCSTR(c, (char*)naGhost_type(g)->name);
 180     } else {
 181         char buf[32];
 182         sprintf(buf, "%p", naGhost_type(g));
 183         return NEWCSTR(c, buf);
 184     }
 185 }
 186
 187 static naRef f_compile(naContext c, naRef me, int argc, naRef* args)
 188 {
 189     int errLine;
 190     naRef script, code, fname;
 191     script = argc > 0 ? args[0] : naNil();
 192     fname = argc > 1 ? args[1] : NEWCSTR(c, "<compile>");
 193     if(!naIsString(script) || !naIsString(fname)) return naNil();
 194     code = naParseCode(c, fname, 1,
 195                        naStr_data(script), naStr_len(script), &errLine);
 196     if(naIsNil(code)) {
 197         char buf[256];
 198         snprintf(buf, sizeof(buf), "Parse error: %s at line %d",
 199                  naGetError(c), errLine);
 200         c->dieArg = NEWCSTR(c, buf);
 201         naRuntimeError(c, "__die__");
 202     }
 203     return naBindToContext(c, code);
 204 }
 205
 206 // FIXME: need a place to save the current IP when we get an error so
 207 // that it can be reset if we get a die()/naRethrowError() situation
 208 // later.  Right now, the IP on the stack trace is the line of the
 209 // die() call, when it should be this one...
 210 static naRef f_call(naContext c, naRef me, int argc, naRef* args)
 211 {
 212     naContext subc;
 213     naRef callargs, callme, callns, result;
 214     struct VecRec* vr;
 215     callargs = argc > 1 ? args[1] : naNil();
 216     callme = argc > 2 ? args[2] : naNil(); // Might be nil, that's OK
 217     callns = argc > 3 ? args[3] : naNil(); // ditto
 218     if(!IS_HASH(callme)) callme = naNil();
 219     if(!IS_HASH(callns)) callns = naNil();
 220     if(!IS_FUNC(args[0]) || (!IS_NIL(callargs) && !IS_VEC(callargs)))
 221         ARGERR();
 222
 223     // Note that we don't free the subcontext, in case the user
 224     // re-throws the same error.  That happens at the next OP_RETURN
 225     // or naSubContext().
 226     subc = naSubContext(c);
 227     vr = IS_NIL(callargs) ? 0 : PTR(callargs).vec->rec;
 228     result = naCall(subc, args[0], vr ? vr->size : 0, vr ? vr->array : 0,
 229                     callme, callns);
 230     if(naGetError(subc)) {
 231         if(argc <= 2 || !IS_VEC(args[argc-1])) {
 232             naRethrowError(subc);
 233         } else {
 234             int i, sd;
 235             naRef errv = args[argc-1];
 236             if(!IS_NIL(subc->dieArg)) naVec_append(errv, subc->dieArg);
 237             else naVec_append(errv, NEWCSTR(subc, naGetError(subc)));
 238             sd = naStackDepth(subc);
 239             for(i=0; i<sd; i++) {
 240                 naVec_append(errv, naGetSourceFile(subc, i));
 241                 naVec_append(errv, naNum(naGetLine(subc, i)));
 242             }
 243         }
 244     }
 245     return result;
 246 }
 247
 248 static naRef f_die(naContext c, naRef me, int argc, naRef* args)
 249 {
 250     naRef darg = argc > 0 ? args[0] : naNil();
 251     if(!naIsNil(darg) && c->callChild && IDENTICAL(c->callChild->dieArg, darg))
 252         naRethrowError(c->callChild);
 253     c->dieArg = darg;
 254     naRuntimeError(c, "__die__");
 255     return naNil(); // never executes
 256 }
 257
 258 // Wrapper around vsnprintf, iteratively increasing the buffer size
 259 // until it fits.  Returned buffer should be freed by the caller.
 260 static char* dosprintf(char* f, ...)
 261 {
 262     char* buf;
 263     va_list va;
 264     int olen, len = 16;
 265     while(1) {
 266         buf = naAlloc(len);
 267         va_start(va, f);
 268         olen = vsnprintf(buf, len, f, va);
 269         if(olen >= 0 && olen < len) {
 270             va_end(va);
 271             return buf;
 272         }
 273         va_end(va);
 274         naFree(buf);
 275         len *= 2;
 276     }
 277 }
 278
 279 // Inspects a printf format string f, and finds the next "%..." format
 280 // specifier.  Stores the start of the specifier in out, the length in
 281 // len, and the type in type.  Returns a pointer to the remainder of
 282 // the format string, or 0 if no format string was found.  Recognizes
 283 // all of ANSI C's syntax except for the "length modifier" feature.
 284 // Note: this does not validate the format character returned in
 285 // "type". That is the caller's job.
 286 static char* nextFormat(naContext c, char* f, char** out, int* len, char* type)
 287 {
 288     // Skip to the start of the format string
 289     while(*f && *f != '%') f++;
 290     if(!*f) return 0;
 291     *out = f++;
 292
 293     while(*f && (*f=='-' || *f=='+' || *f==' ' || *f=='0' || *f=='#')) f++;
 294
 295     // Test for duplicate flags.  This is pure pedantry and could
 296     // be removed on all known platforms, but just to be safe...
 297     {   char *p1, *p2;
 298         for(p1 = *out + 1; p1 < f; p1++)
 299             for(p2 = p1+1; p2 < f; p2++)
 300                 if(*p1 == *p2)
 301                     naRuntimeError(c, "duplicate flag in format string"); }
 302
 303     while(*f && *f >= '0' && *f <= '9') f++;
 304     if(*f && *f == '.') f++;
 305     while(*f && *f >= '0' && *f <= '9') f++;
 306     if(!*f) naRuntimeError(c, "invalid format string");
 307
 308     *type = *f++;
 309     *len = f - *out;
 310     return f;
 311 }
 312
 313 #define ERR(m) naRuntimeError(c, m)
 314 #define APPEND(r) result = naStr_concat(naNewString(c), result, r)
 315 static naRef f_sprintf(naContext c, naRef me, int argc, naRef* args)
 316 {
 317     char t, nultmp, *fstr, *next, *fout=0, *s;
 318     int flen, argn=1;
 319     naRef format, arg, result = naNewString(c);
 320
 321     if(argc < 1) ERR("not enough arguments to sprintf()");
 322     format = naStringValue(c, argc > 0 ? args[0] : naNil());
 323     if(naIsNil(format)) ERR("bad format string in sprintf()");
 324     s = naStr_data(format);
 325
 326     while((next = nextFormat(c, s, &fstr, &flen, &t))) {
 327         APPEND(NEWSTR(c, s, fstr-s)); // stuff before the format string
 328         if(flen == 2 && fstr[1] == '%') {
 329             APPEND(NEWSTR(c, "%", 1));
 330             s = next;
 331             continue;
 332         }
 333         if(argn >= argc) ERR("not enough arguments to sprintf()");
 334         arg = args[argn++];
 335         nultmp = fstr[flen]; // sneaky nul termination...
 336         fstr[flen] = 0;
 337         if(t == 's') {
 338             arg = naStringValue(c, arg);
 339             if(naIsNil(arg)) fout = dosprintf(fstr, "nil");
 340             else             fout = dosprintf(fstr, naStr_data(arg));
 341         } else {
 342             arg = naNumValue(arg);
 343             if(naIsNil(arg))
 344                 fout = dosprintf(fstr, "nil");
 345             else if(t=='d' || t=='i' || t=='c')
 346                 fout = dosprintf(fstr, (int)naNumValue(arg).num);
 347             else if(t=='o' || t=='u' || t=='x' || t=='X')
 348                 fout = dosprintf(fstr, (unsigned int)naNumValue(arg).num);
 349             else if(t=='e' || t=='E' || t=='f' || t=='F' || t=='g' || t=='G')
 350                 fout = dosprintf(fstr, naNumValue(arg).num);
 351             else
 352                 ERR("invalid sprintf format type");
 353         }
 354         fstr[flen] = nultmp;
 355         APPEND(NEWSTR(c, fout, strlen(fout)));
 356         naFree(fout);
 357         s = next;
 358     }
 359     APPEND(NEWSTR(c, s, strlen(s)));
 360     return result;
 361 }
 362
 363 // FIXME: needs to honor subcontext list
 364 static naRef f_caller(naContext c, naRef me, int argc, naRef* args)
 365 {
 366     int fidx;
 367     struct Frame* frame;
 368     naRef result, fr = argc ? naNumValue(args[0]) : naNum(1);
 369     if(IS_NIL(fr)) ARGERR();
 370     fidx = (int)fr.num;
 371     if(fidx > c->fTop - 1) return naNil();
 372     frame = &c->fStack[c->fTop - 1 - fidx];
 373     result = naNewVector(c);
 374     naVec_append(result, frame->locals);
 375     naVec_append(result, frame->func);
 376     naVec_append(result, PTR(PTR(frame->func).func->code).code->srcFile);
 377     naVec_append(result, naNum(naGetLine(c, fidx)));
 378     return result;
 379 }
 380
 381 static naRef f_closure(naContext c, naRef me, int argc, naRef* args)
 382 {
 383     int i;
 384     struct naFunc* f;
 385     naRef func = argc > 0 ? args[0] : naNil();
 386     naRef idx = argc > 1 ? naNumValue(args[1]) : naNum(0);
 387     if(!IS_FUNC(func) || IS_NIL(idx)) ARGERR();
 388     i = (int)idx.num;
 389     f = PTR(func).func;
 390     while(i > 0 && f) { i--; f = PTR(f->next).func; }
 391     if(!f) return naNil();
 392     return f->namespace;
 393 }
 394
 395 static int match(unsigned char* a, unsigned char* b, int l)
 396 {
 397     int i;
 398     for(i=0; i<l; i++) if(a[i] != b[i]) return 0;
 399     return 1;
 400 }
 401
 402 static int find(unsigned char* a, int al, unsigned char* s, int sl, int start)
 403 {
 404     int i;
 405     if(al == 0) return 0;
 406     for(i=start; i<sl-al+1; i++) if(match(a, s+i, al)) return i;
 407     return -1;
 408 }
 409
 410 static naRef f_find(naContext c, naRef me, int argc, naRef* args)
 411 {
 412     int start = 0;
 413     if(argc < 2 || !IS_STR(args[0]) || !IS_STR(args[1])) ARGERR();
 414     if(argc > 2) start = (int)(naNumValue(args[2]).num);
 415     return naNum(find(PTR(args[0]).str->data, PTR(args[0]).str->len,
 416                       PTR(args[1]).str->data, PTR(args[1]).str->len,
 417                       start));
 418 }
 419
 420 static naRef f_split(naContext c, naRef me, int argc, naRef* args)
 421 {
 422     int sl, dl, i;
 423     char *s, *d, *s0;
 424     naRef result;
 425     if(argc < 2 || !IS_STR(args[0]) || !IS_STR(args[1])) ARGERR();
 426     d = naStr_data(args[0]); dl = naStr_len(args[0]);
 427     s = naStr_data(args[1]); sl = naStr_len(args[1]);
 428     result = naNewVector(c);
 429     if(dl == 0) { // special case zero-length delimiter
 430         for(i=0; i<sl; i++) naVec_append(result, NEWSTR(c, s+i, 1));
 431         return result;
 432     }
 433     s0 = s;
 434     for(i=0; i <= sl-dl; i++) {
 435         if(match((unsigned char*)(s+i), (unsigned char*)d, dl)) {
 436             naVec_append(result, NEWSTR(c, s0, s+i-s0));
 437             s0 = s + i + dl;
 438             i += dl - 1;
 439         }
 440     }
 441     if(s0 - s <= sl) naVec_append(result, NEWSTR(c, s0, s+sl-s0));
 442     return result;
 443 }
 444
 445 // This is a comparatively weak RNG, based on the C library's rand()
 446 // function, which is usually not threadsafe and often of limited
 447 // precision.  The 5x loop guarantees that we get a full double worth
 448 // of precision even for 15 bit (Win32...) rand() implementations.
 449 static naRef f_rand(naContext c, naRef me, int argc, naRef* args)
 450 {
 451     int i;
 452     double r = 0;
 453     if(argc) {
 454         if(!IS_NUM(args[0])) naRuntimeError(c, "rand() seed not number");
 455         srand((unsigned int)args[0].num);
 456         return naNil();
 457     }
 458     for(i=0; i<5; i++) r = (r + rand()) * (1.0/(RAND_MAX+1.0));
 459     return naNum(r);
 460 }
 461
 462 static naRef f_bind(naContext c, naRef me, int argc, naRef* args)
 463 {
 464     naRef func = argc > 0 ? args[0] : naNil();
 465     naRef hash = argc > 1 ? args[1] : naNewHash(c);
 466     naRef next = argc > 2 ? args[2] : naNil();
 467     if(!IS_FUNC(func) || (!IS_NIL(next) && !IS_FUNC(next)) || !IS_HASH(hash))
 468         ARGERR();
 469     func = naNewFunc(c, PTR(func).func->code);
 470     PTR(func).func->namespace = hash;
 471     PTR(func).func->next = next;
 472     return func;
 473 }
 474
 475 static naCFuncItem funcs[] = {
 476     { "size", f_size },
 477     { "keys", f_keys },
 478     { "append", f_append },
 479     { "pop", f_pop },
 480     { "setsize", f_setsize },
 481     { "subvec", f_subvec },
 482     { "delete", f_delete },
 483     { "int", f_int },
 484     { "num", f_num },
 485     { "streq", f_streq },
 486     { "cmp", f_cmp },
 487     { "substr", f_substr },
 488     { "chr", f_chr },
 489     { "contains", f_contains },
 490     { "typeof", f_typeof },
 491     { "ghosttype", f_ghosttype },
 492     { "compile", f_compile },
 493     { "call", f_call },
 494     { "die", f_die },
 495     { "sprintf", f_sprintf },
 496     { "caller", f_caller },
 497     { "closure", f_closure },
 498     { "find", f_find },
 499     { "split", f_split },
 500     { "rand", f_rand },
 501     { "bind", f_bind },
 502     { 0 }
 503 };
 504
 505 naRef naInit_std(naContext c)
 506 {
 507     return naGenLib(c, funcs);
 508 }