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 b75ffaa0d611ffa5427e7b191d4d68d996e74534..d2b60c9a6561b06f1ec926d864d0c9934de951af 100644 (file)
--- a/src/lisp/ao_lisp_cons.c
+++ b/src/lisp/ao_lisp_cons.c
@@ -14,8 +14,6 @@
 
 #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;
@@ -25,7 +23,7 @@ static void cons_mark(void *addr)
                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;
        }
 }
@@ -47,11 +45,17 @@ static void cons_move(void *addr)
                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);
-               ret = ao_lisp_move_memory((void **) &cdr, sizeof (struct ao_lisp_cons));
+               if (!cdr)
+                       break;
+               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;
@@ -62,25 +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_root_add(&ao_lisp_cons_type, &cdr);
-       ao_lisp_root_poly_add(&car);
-       cons = ao_lisp_alloc(sizeof (struct ao_lisp_cons));
-       ao_lisp_root_clear(&car);
-       ao_lisp_root_clear(&cdr);
-       if (!cons)
-               return NULL;
+       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)
 {