altos/lisp: Split out read debug, add memory validation
[fw/altos] / src / lisp / ao_lisp_builtin.c
index ccd13d075604467018cf6eb344f0c7cdc3941b9c..fdca020849177c9d2684bc22cfd91ef2c7c20b0a 100644 (file)
@@ -14,6 +14,7 @@
 
 #include "ao_lisp.h"
 #include <limits.h>
+#include <math.h>
 
 static int
 builtin_size(void *addr)
@@ -98,7 +99,7 @@ ao_lisp_check_argc(ao_poly name, struct ao_lisp_cons *cons, int min, int max)
 
        while (cons && argc <= max) {
                argc++;
-               cons = ao_lisp_poly_cons(cons->cdr);
+               cons = ao_lisp_cons_cdr(cons);
        }
        if (argc < min || argc > max)
                return ao_lisp_error(AO_LISP_INVALID, "%s: invalid arg count", ao_lisp_poly_atom(name)->name);
@@ -113,7 +114,7 @@ ao_lisp_arg(struct ao_lisp_cons *cons, int argc)
        while (argc--) {
                if (!cons)
                        return AO_LISP_NIL;
-               cons = ao_lisp_poly_cons(cons->cdr);
+               cons = ao_lisp_cons_cdr(cons);
        }
        return cons->car;
 }
@@ -124,7 +125,7 @@ ao_lisp_check_argt(ao_poly name, struct ao_lisp_cons *cons, int argc, int type,
        ao_poly car = ao_lisp_arg(cons, argc);
 
        if ((!car && !nil_ok) || ao_lisp_poly_type(car) != type)
-               return ao_lisp_error(AO_LISP_INVALID, "%s: invalid type for arg %d", ao_lisp_poly_atom(name)->name, argc);
+               return ao_lisp_error(AO_LISP_INVALID, "%s: arg %d invalid type %v", ao_lisp_poly_atom(name)->name, argc, car);
        return _ao_lisp_bool_true;
 }
 
@@ -162,17 +163,17 @@ ao_lisp_do_cons(struct ao_lisp_cons *cons)
 ao_poly
 ao_lisp_do_last(struct ao_lisp_cons *cons)
 {
-       ao_poly l;
+       struct ao_lisp_cons     *list;
        if (!ao_lisp_check_argc(_ao_lisp_atom_last, cons, 1, 1))
                return AO_LISP_NIL;
        if (!ao_lisp_check_argt(_ao_lisp_atom_last, cons, 0, AO_LISP_CONS, 1))
                return AO_LISP_NIL;
-       l = ao_lisp_arg(cons, 0);
-       while (l) {
-               struct ao_lisp_cons *list = ao_lisp_poly_cons(l);
+       for (list = ao_lisp_poly_cons(ao_lisp_arg(cons, 0));
+            list;
+            list = ao_lisp_cons_cdr(list))
+       {
                if (!list->cdr)
                        return list->car;
-               l = list->cdr;
        }
        return AO_LISP_NIL;
 }
@@ -206,6 +207,17 @@ ao_lisp_do_set(struct ao_lisp_cons *cons)
        return ao_lisp_atom_set(ao_lisp_arg(cons, 0), ao_lisp_arg(cons, 1));
 }
 
+ao_poly
+ao_lisp_do_def(struct ao_lisp_cons *cons)
+{
+       if (!ao_lisp_check_argc(_ao_lisp_atom_def, cons, 2, 2))
+               return AO_LISP_NIL;
+       if (!ao_lisp_check_argt(_ao_lisp_atom_def, cons, 0, AO_LISP_ATOM, 0))
+               return AO_LISP_NIL;
+
+       return ao_lisp_atom_def(ao_lisp_arg(cons, 0), ao_lisp_arg(cons, 1));
+}
+
 ao_poly
 ao_lisp_do_setq(struct ao_lisp_cons *cons)
 {
@@ -214,9 +226,9 @@ ao_lisp_do_setq(struct ao_lisp_cons *cons)
                return AO_LISP_NIL;
        name = cons->car;
        if (ao_lisp_poly_type(name) != AO_LISP_ATOM)
-               return ao_lisp_error(AO_LISP_INVALID, "set! of non-atom");
-       if (!ao_lisp_atom_ref(ao_lisp_frame_current, name))
-               return ao_lisp_error(AO_LISP_INVALID, "atom not defined");
+               return ao_lisp_error(AO_LISP_INVALID, "set! of non-atom %v", name);
+       if (!ao_lisp_atom_ref(name))
+               return ao_lisp_error(AO_LISP_INVALID, "atom %v not defined", name);
        return ao_lisp__cons(_ao_lisp_atom_set,
                             ao_lisp__cons(ao_lisp__cons(_ao_lisp_atom_quote,
                                                         ao_lisp__cons(name, AO_LISP_NIL)),
@@ -231,9 +243,9 @@ ao_lisp_do_cond(struct ao_lisp_cons *cons)
 }
 
 ao_poly
-ao_lisp_do_progn(struct ao_lisp_cons *cons)
+ao_lisp_do_begin(struct ao_lisp_cons *cons)
 {
-       ao_lisp_stack->state = eval_progn;
+       ao_lisp_stack->state = eval_begin;
        ao_lisp_stack->sexprs = ao_lisp_cons_poly(cons);
        return AO_LISP_NIL;
 }
@@ -253,7 +265,7 @@ ao_lisp_do_write(struct ao_lisp_cons *cons)
        while (cons) {
                val = cons->car;
                ao_lisp_poly_write(val);
-               cons = ao_lisp_poly_cons(cons->cdr);
+               cons = ao_lisp_cons_cdr(cons);
                if (cons)
                        printf(" ");
        }
@@ -268,39 +280,38 @@ ao_lisp_do_display(struct ao_lisp_cons *cons)
        while (cons) {
                val = cons->car;
                ao_lisp_poly_display(val);
-               cons = ao_lisp_poly_cons(cons->cdr);
+               cons = ao_lisp_cons_cdr(cons);
        }
        return _ao_lisp_bool_true;
 }
 
 ao_poly
-ao_lisp_math(struct ao_lisp_cons *cons, enum ao_lisp_builtin_id op)
+ao_lisp_math(struct ao_lisp_cons *orig_cons, enum ao_lisp_builtin_id op)
 {
-       struct ao_lisp_cons *orig_cons = cons;
+       struct ao_lisp_cons *cons = cons;
        ao_poly ret = AO_LISP_NIL;
 
-       while (cons) {
+       for (cons = orig_cons; cons; cons = ao_lisp_cons_cdr(cons)) {
                ao_poly         car = cons->car;
-               ao_poly         cdr;
                uint8_t         rt = ao_lisp_poly_type(ret);
                uint8_t         ct = ao_lisp_poly_type(car);
 
                if (cons == orig_cons) {
                        ret = car;
-                       if (cons->cdr == AO_LISP_NIL && ct == AO_LISP_INT) {
+                       if (cons->cdr == AO_LISP_NIL) {
                                switch (op) {
                                case builtin_minus:
-                                       ret = ao_lisp_integer_poly(-ao_lisp_poly_integer(ret));
+                                       if (ao_lisp_integer_typep(ct))
+                                               ret = ao_lisp_integer_poly(-ao_lisp_poly_integer(ret));
+                                       else if (ct == AO_LISP_FLOAT)
+                                               ret = ao_lisp_float_get(-ao_lisp_poly_number(ret));
                                        break;
                                case builtin_divide:
-                                       switch (ao_lisp_poly_integer(ret)) {
-                                       case 0:
-                                               return ao_lisp_error(AO_LISP_DIVIDE_BY_ZERO, "divide by zero");
-                                       case 1:
-                                               break;
-                                       default:
-                                               ret = ao_lisp_int_poly(0);
-                                               break;
+                                       if (ao_lisp_integer_typep(ct) && ao_lisp_poly_integer(ret) == 1)
+                                               ;
+                                       else if (ao_lisp_number_typep(ct)) {
+                                               float   v = ao_lisp_poly_number(ret);
+                                               ret = ao_lisp_float_get(1/v);
                                        }
                                        break;
                                default:
@@ -310,21 +321,30 @@ ao_lisp_math(struct ao_lisp_cons *cons, enum ao_lisp_builtin_id op)
                } else if (ao_lisp_integer_typep(rt) && ao_lisp_integer_typep(ct)) {
                        int32_t r = ao_lisp_poly_integer(ret);
                        int32_t c = ao_lisp_poly_integer(car);
+                       int64_t t;
 
                        switch(op) {
                        case builtin_plus:
                                r += c;
+                       check_overflow:
+                               if (r < AO_LISP_MIN_BIGINT || AO_LISP_MAX_BIGINT < r)
+                                       goto inexact;
                                break;
                        case builtin_minus:
                                r -= c;
+                               goto check_overflow;
                                break;
                        case builtin_times:
-                               r *= c;
+                               t = (int64_t) r * (int64_t) c;
+                               if (t < AO_LISP_MIN_BIGINT || AO_LISP_MAX_BIGINT < t)
+                                       goto inexact;
+                               r = (int32_t) t;
                                break;
                        case builtin_divide:
-                               if (c == 0)
-                                       return ao_lisp_error(AO_LISP_DIVIDE_BY_ZERO, "divide by zero");
-                               r /= c;
+                               if (c != 0 && (r % c) == 0)
+                                       r /= c;
+                               else
+                                       goto inexact;
                                break;
                        case builtin_quotient:
                                if (c == 0)
@@ -350,6 +370,32 @@ ao_lisp_math(struct ao_lisp_cons *cons, enum ao_lisp_builtin_id op)
                                break;
                        }
                        ret = ao_lisp_integer_poly(r);
+               } else if (ao_lisp_number_typep(rt) && ao_lisp_number_typep(ct)) {
+                       float r, c;
+               inexact:
+                       r = ao_lisp_poly_number(ret);
+                       c = ao_lisp_poly_number(car);
+                       switch(op) {
+                       case builtin_plus:
+                               r += c;
+                               break;
+                       case builtin_minus:
+                               r -= c;
+                               break;
+                       case builtin_times:
+                               r *= c;
+                               break;
+                       case builtin_divide:
+                               r /= c;
+                               break;
+                       case builtin_quotient:
+                       case builtin_remainder:
+                       case builtin_modulo:
+                               return ao_lisp_error(AO_LISP_INVALID, "non-integer value in integer divide");
+                       default:
+                               break;
+                       }
+                       ret = ao_lisp_float_get(r);
                }
 
                else if (rt == AO_LISP_STRING && ct == AO_LISP_STRING && op == builtin_plus)
@@ -357,11 +403,6 @@ ao_lisp_math(struct ao_lisp_cons *cons, enum ao_lisp_builtin_id op)
                                                                     ao_lisp_poly_string(car)));
                else
                        return ao_lisp_error(AO_LISP_INVALID, "invalid args");
-
-               cdr = cons->cdr;
-               if (cdr != AO_LISP_NIL && ao_lisp_poly_type(cdr) != AO_LISP_CONS)
-                       return ao_lisp_error(AO_LISP_INVALID, "improper list");
-               cons = ao_lisp_poly_cons(cdr);
        }
        return ret;
 }
@@ -417,8 +458,7 @@ ao_lisp_compare(struct ao_lisp_cons *cons, enum ao_lisp_builtin_id op)
                return _ao_lisp_bool_true;
 
        left = cons->car;
-       cons = ao_lisp_poly_cons(cons->cdr);
-       while (cons) {
+       for (cons = ao_lisp_cons_cdr(cons); cons; cons = ao_lisp_cons_cdr(cons)) {
                ao_poly right = cons->car;
 
                if (op == builtin_equal) {
@@ -477,7 +517,6 @@ ao_lisp_compare(struct ao_lisp_cons *cons, enum ao_lisp_builtin_id op)
                        }
                }
                left = right;
-               cons = ao_lisp_poly_cons(cons->cdr);
        }
        return _ao_lisp_bool_true;
 }
@@ -533,9 +572,9 @@ ao_lisp_do_string_to_list(struct ao_lisp_cons *cons)
 }
 
 ao_poly
-ao_lisp_do_flush(struct ao_lisp_cons *cons)
+ao_lisp_do_flush_output(struct ao_lisp_cons *cons)
 {
-       if (!ao_lisp_check_argc(_ao_lisp_atom_flush, cons, 0, 0))
+       if (!ao_lisp_check_argc(_ao_lisp_atom_flush2doutput, cons, 0, 0))
                return AO_LISP_NIL;
        ao_lisp_os_flush();
        return _ao_lisp_bool_true;
@@ -637,7 +676,27 @@ ao_lisp_do_typep(int type, struct ao_lisp_cons *cons)
 ao_poly
 ao_lisp_do_pairp(struct ao_lisp_cons *cons)
 {
-       return ao_lisp_do_typep(AO_LISP_CONS, cons);
+       ao_poly v;
+       if (!ao_lisp_check_argc(_ao_lisp_atom_led, cons, 1, 1))
+               return AO_LISP_NIL;
+       v = ao_lisp_arg(cons, 0);
+       if (v != AO_LISP_NIL && ao_lisp_poly_type(v) == AO_LISP_CONS)
+               return _ao_lisp_bool_true;
+       return _ao_lisp_bool_false;
+}
+
+ao_poly
+ao_lisp_do_integerp(struct ao_lisp_cons *cons)
+{
+       if (!ao_lisp_check_argc(_ao_lisp_atom_led, cons, 1, 1))
+               return AO_LISP_NIL;
+       switch (ao_lisp_poly_type(ao_lisp_arg(cons, 0))) {
+       case AO_LISP_INT:
+       case AO_LISP_BIGINT:
+               return _ao_lisp_bool_true;
+       default:
+               return _ao_lisp_bool_false;
+       }
 }
 
 ao_poly
@@ -648,6 +707,7 @@ ao_lisp_do_numberp(struct ao_lisp_cons *cons)
        switch (ao_lisp_poly_type(ao_lisp_arg(cons, 0))) {
        case AO_LISP_INT:
        case AO_LISP_BIGINT:
+       case AO_LISP_FLOAT:
                return _ao_lisp_bool_true;
        default:
                return _ao_lisp_bool_false;