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