altos/telegps-v2.0: git ignore make results

[fw/altos] / src / lisp / ao_lisp_cons.c

diff --git a/src/lisp/ao_lisp_cons.c b/src/lisp/ao_lisp_cons.c
index 4929b91cf73dfcaeb0964d46928c6b53d22c13fb..d2b60c9a6561b06f1ec926d864d0c9934de951af 100644 (file)
--- a/src/lisp/ao_lisp_cons.c
+++ b/src/lisp/ao_lisp_cons.c
@@ -14,18 +14,16 @@
 
 #include "ao_lisp.h"
 
-#define OFFSET(a)      ((int) ((uint8_t *) (a) - ao_lisp_const))
-
 static void cons_mark(void *addr)
 {
        struct ao_lisp_cons     *cons = addr;
 
        for (;;) {
-               ao_lisp_poly_mark(cons->car);
+               ao_lisp_poly_mark(cons->car, 1);
                cons = ao_lisp_poly_cons(cons->cdr);
                if (!cons)
                        break;
-               if (ao_lisp_mark_memory(cons, sizeof (struct ao_lisp_cons)))
+               if (ao_lisp_mark_memory(&ao_lisp_cons_type, cons))
                        break;
        }
 }
@@ -44,10 +42,23 @@ static void cons_move(void *addr)
                return;
 
        for (;;) {
-               (void) ao_lisp_poly_move(&cons->car);
-               if (ao_lisp_poly_move(&cons->cdr))
+               struct ao_lisp_cons     *cdr;
+               int                     ret;
+
+               MDBG_MOVE("cons_move start %d (%d, %d)\n",
+                         MDBG_OFFSET(cons), MDBG_OFFSET(ao_lisp_ref(cons->car)), MDBG_OFFSET(ao_lisp_ref(cons->cdr)));
+               (void) ao_lisp_poly_move(&cons->car, 1);
+               cdr = ao_lisp_poly_cons(cons->cdr);
+               if (!cdr)
                        break;
-               cons = ao_lisp_poly_cons(cons->cdr);
+               ret = ao_lisp_move_memory(&ao_lisp_cons_type, (void **) &cdr);
+               if (cdr != ao_lisp_poly_cons(cons->cdr))
+                       cons->cdr = ao_lisp_cons_poly(cdr);
+               MDBG_MOVE("cons_move end %d (%d, %d)\n",
+                         MDBG_OFFSET(cons), MDBG_OFFSET(ao_lisp_ref(cons->car)), MDBG_OFFSET(ao_lisp_ref(cons->cdr)));
+               if (ret)
+                       break;
+               cons = cdr;
        }
 }
 
@@ -55,19 +66,44 @@ const struct ao_lisp_type ao_lisp_cons_type = {
        .mark = cons_mark,
        .size = cons_size,
        .move = cons_move,
+       .name = "cons",
 };
 
+struct ao_lisp_cons *ao_lisp_cons_free_list;
+
 struct ao_lisp_cons *
 ao_lisp_cons_cons(ao_poly car, struct ao_lisp_cons *cdr)
 {
-       struct ao_lisp_cons     *cons = ao_lisp_alloc(sizeof (struct ao_lisp_cons));
-       if (!cons)
-               return NULL;
+       struct ao_lisp_cons     *cons;
+
+       if (ao_lisp_cons_free_list) {
+               cons = ao_lisp_cons_free_list;
+               ao_lisp_cons_free_list = ao_lisp_poly_cons(cons->cdr);
+       } else {
+               ao_lisp_poly_stash(0, car);
+               ao_lisp_cons_stash(0, cdr);
+               cons = ao_lisp_alloc(sizeof (struct ao_lisp_cons));
+               car = ao_lisp_poly_fetch(0);
+               cdr = ao_lisp_cons_fetch(0);
+               if (!cons)
+                       return NULL;
+       }
        cons->car = car;
        cons->cdr = ao_lisp_cons_poly(cdr);
        return cons;
 }
 
+void
+ao_lisp_cons_free(struct ao_lisp_cons *cons)
+{
+       while (cons) {
+               ao_poly cdr = cons->cdr;
+               cons->cdr = ao_lisp_cons_poly(ao_lisp_cons_free_list);
+               ao_lisp_cons_free_list = cons;
+               cons = ao_lisp_poly_cons(cdr);
+       }
+}
+
 void
 ao_lisp_cons_print(ao_poly c)
 {
@@ -83,3 +119,25 @@ ao_lisp_cons_print(ao_poly c)
        }
        printf(")");
 }
+
+void
+ao_lisp_cons_patom(ao_poly c)
+{
+       struct ao_lisp_cons *cons = ao_lisp_poly_cons(c);
+
+       while (cons) {
+               ao_lisp_poly_patom(cons->car);
+               cons = ao_lisp_poly_cons(cons->cdr);
+       }
+}
+
+int
+ao_lisp_cons_length(struct ao_lisp_cons *cons)
+{
+       int     len = 0;
+       while (cons) {
+               len++;
+               cons = ao_lisp_poly_cons(cons->cdr);
+       }
+       return len;
+}