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