git.gag.com Git - fw/altos/blob - src/lisp/ao_lisp_mem.c

   1 /*
   2  * Copyright © 2016 Keith Packard <keithp@keithp.com>
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation, either version 2 of the License, or
   7  * (at your option) any later version.
   8  *
   9  * This program is distributed in the hope that it will be useful, but
  10  * WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  12  * General Public License for more details.
  13  */
  14
  15 #define AO_LISP_CONST_BITS
  16
  17 #include "ao_lisp.h"
  18 #include <stdio.h>
  19
  20 #ifdef AO_LISP_MAKE_CONST
  21
  22 /*
  23  * When building the constant table, it is the
  24  * pool for allocations.
  25  */
  26
  27 #include <stdlib.h>
  28 uint8_t ao_lisp_const[AO_LISP_POOL_CONST] __attribute__((aligned(4)));
  29 #define ao_lisp_pool ao_lisp_const
  30 #undef AO_LISP_POOL
  31 #define AO_LISP_POOL AO_LISP_POOL_CONST
  32
  33 #else
  34
  35 uint8_t ao_lisp_pool[AO_LISP_POOL + AO_LISP_POOL_EXTRA] __attribute__((aligned(4)));
  36
  37 #endif
  38
  39 #if DBG_MEM
  40 int dbg_move_depth;
  41 int dbg_mem = DBG_MEM_START;
  42 int dbg_validate = 0;
  43
  44 struct ao_lisp_record {
  45         struct ao_lisp_record           *next;
  46         const struct ao_lisp_type       *type;
  47         void                            *addr;
  48         int                             size;
  49 };
  50
  51 static struct ao_lisp_record    *record_head, **record_tail;
  52
  53 static void
  54 ao_lisp_record_free(struct ao_lisp_record *record)
  55 {
  56         while (record) {
  57                 struct ao_lisp_record *next = record->next;
  58                 free(record);
  59                 record = next;
  60         }
  61 }
  62
  63 static void
  64 ao_lisp_record_reset(void)
  65 {
  66         ao_lisp_record_free(record_head);
  67         record_head = NULL;
  68         record_tail = &record_head;
  69 }
  70
  71 static void
  72 ao_lisp_record(const struct ao_lisp_type        *type,
  73                void                             *addr,
  74                int                              size)
  75 {
  76         struct ao_lisp_record   *r = malloc(sizeof (struct ao_lisp_record));
  77
  78         r->next = NULL;
  79         r->type = type;
  80         r->addr = addr;
  81         r->size = size;
  82         *record_tail = r;
  83         record_tail = &r->next;
  84 }
  85
  86 static struct ao_lisp_record *
  87 ao_lisp_record_save(void)
  88 {
  89         struct ao_lisp_record *r = record_head;
  90
  91         record_head = NULL;
  92         record_tail = &record_head;
  93         return r;
  94 }
  95
  96 static void
  97 ao_lisp_record_compare(char *where,
  98                        struct ao_lisp_record *a,
  99                        struct ao_lisp_record *b)
 100 {
 101         while (a && b) {
 102                 if (a->type != b->type || a->size != b->size) {
 103                         printf("%s record difers %d %s %d -> %d %s %d\n",
 104                                where,
 105                                MDBG_OFFSET(a->addr),
 106                                a->type->name,
 107                                a->size,
 108                                MDBG_OFFSET(b->addr),
 109                                b->type->name,
 110                                b->size);
 111                         ao_lisp_abort();
 112                 }
 113                 a = a->next;
 114                 b = b->next;
 115         }
 116         if (a) {
 117                 printf("%s record differs %d %s %d -> NULL\n",
 118                        where,
 119                        MDBG_OFFSET(a->addr),
 120                        a->type->name,
 121                        a->size);
 122                 ao_lisp_abort();
 123         }
 124         if (b) {
 125                 printf("%s record differs NULL -> %d %s %d\n",
 126                        where,
 127                        MDBG_OFFSET(b->addr),
 128                        b->type->name,
 129                        b->size);
 130                 ao_lisp_abort();
 131         }
 132 }
 133
 134 #else
 135 #define ao_lisp_record_reset()
 136 #endif
 137
 138 uint8_t ao_lisp_exception;
 139
 140 struct ao_lisp_root {
 141         const struct ao_lisp_type       *type;
 142         void                            **addr;
 143 };
 144
 145 static struct ao_lisp_cons      *save_cons[2];
 146 static char                     *save_string[2];
 147 static ao_poly                  save_poly[3];
 148
 149 static const struct ao_lisp_root        ao_lisp_root[] = {
 150         {
 151                 .type = &ao_lisp_cons_type,
 152                 .addr = (void **) &save_cons[0],
 153         },
 154         {
 155                 .type = &ao_lisp_cons_type,
 156                 .addr = (void **) &save_cons[1],
 157         },
 158         {
 159                 .type = &ao_lisp_string_type,
 160                 .addr = (void **) &save_string[0],
 161         },
 162         {
 163                 .type = &ao_lisp_string_type,
 164                 .addr = (void **) &save_string[1],
 165         },
 166         {
 167                 .type = NULL,
 168                 .addr = (void **) &save_poly[0]
 169         },
 170         {
 171                 .type = NULL,
 172                 .addr = (void **) &save_poly[1]
 173         },
 174         {
 175                 .type = NULL,
 176                 .addr = (void **) &save_poly[2]
 177         },
 178         {
 179                 .type = &ao_lisp_atom_type,
 180                 .addr = (void **) &ao_lisp_atoms
 181         },
 182         {
 183                 .type = &ao_lisp_frame_type,
 184                 .addr = (void **) &ao_lisp_frame_global,
 185         },
 186         {
 187                 .type = &ao_lisp_frame_type,
 188                 .addr = (void **) &ao_lisp_frame_current,
 189         },
 190         {
 191                 .type = &ao_lisp_stack_type,
 192                 .addr = (void **) &ao_lisp_stack,
 193         },
 194         {
 195                 .type = NULL,
 196                 .addr = (void **) &ao_lisp_v,
 197         },
 198         {
 199                 .type = &ao_lisp_cons_type,
 200                 .addr = (void **) &ao_lisp_read_cons,
 201         },
 202         {
 203                 .type = &ao_lisp_cons_type,
 204                 .addr = (void **) &ao_lisp_read_cons_tail,
 205         },
 206         {
 207                 .type = &ao_lisp_cons_type,
 208                 .addr = (void **) &ao_lisp_read_stack,
 209         },
 210 };
 211
 212 #define AO_LISP_ROOT    (sizeof (ao_lisp_root) / sizeof (ao_lisp_root[0]))
 213
 214 static const void ** const ao_lisp_cache[] = {
 215         (const void **) &ao_lisp_cons_free_list,
 216         (const void **) &ao_lisp_stack_free_list,
 217         (const void **) &ao_lisp_frame_free_list[0],
 218         (const void **) &ao_lisp_frame_free_list[1],
 219         (const void **) &ao_lisp_frame_free_list[2],
 220         (const void **) &ao_lisp_frame_free_list[3],
 221 };
 222
 223 #if AO_LISP_FRAME_FREE != 4
 224 #error Unexpected AO_LISP_FRAME_FREE value
 225 #endif
 226
 227 #define AO_LISP_CACHE   (sizeof (ao_lisp_cache) / sizeof (ao_lisp_cache[0]))
 228
 229 #define AO_LISP_BUSY_SIZE       ((AO_LISP_POOL + 31) / 32)
 230
 231 static uint8_t  ao_lisp_busy[AO_LISP_BUSY_SIZE];
 232 static uint8_t  ao_lisp_cons_note[AO_LISP_BUSY_SIZE];
 233 static uint8_t  ao_lisp_cons_last[AO_LISP_BUSY_SIZE];
 234 static uint8_t  ao_lisp_cons_noted;
 235
 236 uint16_t        ao_lisp_top;
 237
 238 struct ao_lisp_chunk {
 239         uint16_t                old_offset;
 240         union {
 241                 uint16_t        size;
 242                 uint16_t        new_offset;
 243         };
 244 };
 245
 246 #define AO_LISP_NCHUNK  64
 247
 248 static struct ao_lisp_chunk ao_lisp_chunk[AO_LISP_NCHUNK];
 249
 250 /* Offset of an address within the pool. */
 251 static inline uint16_t pool_offset(void *addr) {
 252 #if DBG_MEM
 253         if (!AO_LISP_IS_POOL(addr))
 254                 ao_lisp_abort();
 255 #endif
 256         return ((uint8_t *) addr) - ao_lisp_pool;
 257 }
 258
 259 static inline void mark(uint8_t *tag, int offset) {
 260         int     byte = offset >> 5;
 261         int     bit = (offset >> 2) & 7;
 262         tag[byte] |= (1 << bit);
 263 }
 264
 265 static inline void clear(uint8_t *tag, int offset) {
 266         int     byte = offset >> 5;
 267         int     bit = (offset >> 2) & 7;
 268         tag[byte] &= ~(1 << bit);
 269 }
 270
 271 static inline int busy(uint8_t *tag, int offset) {
 272         int     byte = offset >> 5;
 273         int     bit = (offset >> 2) & 7;
 274         return (tag[byte] >> bit) & 1;
 275 }
 276
 277 static inline int min(int a, int b) { return a < b ? a : b; }
 278 static inline int max(int a, int b) { return a > b ? a : b; }
 279
 280 static inline int limit(int offset) {
 281         return min(AO_LISP_POOL, max(offset, 0));
 282 }
 283
 284 static int total_marked;
 285
 286 static void
 287 note_cons(uint16_t offset)
 288 {
 289         MDBG_MOVE("note cons %d\n", offset);
 290         ao_lisp_cons_noted = 1;
 291         mark(ao_lisp_cons_note, offset);
 292 }
 293
 294 static uint16_t chunk_low, chunk_high;
 295 static uint16_t chunk_first, chunk_last;
 296 static int chunk_busy;
 297
 298 static void
 299 note_chunk(uint16_t offset, uint16_t size)
 300 {
 301         int l, r;
 302
 303         if (offset < chunk_low || chunk_high <= offset)
 304                 return;
 305
 306         /* Binary search for the location */
 307         l = 0;
 308         r = chunk_busy - 1;
 309         while (l <= r) {
 310                 int m = (l + r) >> 1;
 311                 if (ao_lisp_chunk[m].old_offset < offset)
 312                         l = m + 1;
 313                 else
 314                         r = m - 1;
 315         }
 316         /*
 317          * The correct location is always in 'l', with r = l-1 being
 318          * the entry before the right one
 319          */
 320
 321 #if DBG_MEM
 322         /* Off the right side */
 323         if (l >= AO_LISP_NCHUNK)
 324                 ao_lisp_abort();
 325
 326         /* Off the left side */
 327         if (l == 0 && chunk_busy && offset > ao_lisp_chunk[0].old_offset)
 328                 ao_lisp_abort();
 329 #endif
 330
 331         /* Shuffle existing entries right */
 332         int end = min(AO_LISP_NCHUNK, chunk_busy + 1);
 333
 334         memmove(&ao_lisp_chunk[l+1],
 335                 &ao_lisp_chunk[l],
 336                 (end - (l+1)) * sizeof (struct ao_lisp_chunk));
 337
 338         /* Add new entry */
 339         ao_lisp_chunk[l].old_offset = offset;
 340         ao_lisp_chunk[l].size = size;
 341
 342         /* Increment the number of elements up to the size of the array */
 343         if (chunk_busy < AO_LISP_NCHUNK)
 344                 chunk_busy++;
 345
 346         /* Set the top address if the array is full */
 347         if (chunk_busy == AO_LISP_NCHUNK)
 348                 chunk_high = ao_lisp_chunk[AO_LISP_NCHUNK-1].old_offset +
 349                         ao_lisp_chunk[AO_LISP_NCHUNK-1].size;
 350 }
 351
 352 static void
 353 reset_chunks(void)
 354 {
 355         memset(ao_lisp_chunk, '\0', sizeof (ao_lisp_chunk));
 356         chunk_high = ao_lisp_top;
 357         chunk_busy = 0;
 358 }
 359
 360 /*
 361  * Walk all referenced objects calling functions on each one
 362  */
 363
 364 static void
 365 walk(int (*visit_addr)(const struct ao_lisp_type *type, void **addr),
 366      int (*visit_poly)(ao_poly *p, uint8_t do_note_cons))
 367 {
 368         int i;
 369
 370         total_marked = 0;
 371         ao_lisp_record_reset();
 372         memset(ao_lisp_busy, '\0', sizeof (ao_lisp_busy));
 373         memset(ao_lisp_cons_note, '\0', sizeof (ao_lisp_cons_note));
 374         ao_lisp_cons_noted = 0;
 375         for (i = 0; i < (int) AO_LISP_ROOT; i++) {
 376                 if (ao_lisp_root[i].type) {
 377                         void **a = ao_lisp_root[i].addr, *v;
 378                         if (a && (v = *a)) {
 379                                 MDBG_MOVE("root ptr %d\n", MDBG_OFFSET(v));
 380                                 visit_addr(ao_lisp_root[i].type, a);
 381                         }
 382                 } else {
 383                         ao_poly *a = (ao_poly *) ao_lisp_root[i].addr, p;
 384                         if (a && (p = *a)) {
 385                                 MDBG_MOVE("root poly %d\n", MDBG_OFFSET(ao_lisp_ref(p)));
 386                                 visit_poly(a, 0);
 387                         }
 388                 }
 389         }
 390         while (ao_lisp_cons_noted) {
 391                 memcpy(ao_lisp_cons_last, ao_lisp_cons_note, sizeof (ao_lisp_cons_note));
 392                 memset(ao_lisp_cons_note, '\0', sizeof (ao_lisp_cons_note));
 393                 ao_lisp_cons_noted = 0;
 394                 for (i = 0; i < AO_LISP_POOL; i += 4) {
 395                         if (busy(ao_lisp_cons_last, i)) {
 396                                 void *v = ao_lisp_pool + i;
 397                                 MDBG_MOVE("root cons %d\n", MDBG_OFFSET(v));
 398                                 visit_addr(&ao_lisp_cons_type, &v);
 399                         }
 400                 }
 401         }
 402 }
 403
 404 #if MDBG_DUMP
 405 static void
 406 dump_busy(void)
 407 {
 408         int     i;
 409         MDBG_MOVE("busy:");
 410         for (i = 0; i < ao_lisp_top; i += 4) {
 411                 if ((i & 0xff) == 0) {
 412                         MDBG_MORE("\n");
 413                         MDBG_MOVE("%s", "");
 414                 }
 415                 else if ((i & 0x1f) == 0)
 416                         MDBG_MORE(" ");
 417                 if (busy(ao_lisp_busy, i))
 418                         MDBG_MORE("*");
 419                 else
 420                         MDBG_MORE("-");
 421         }
 422         MDBG_MORE ("\n");
 423 }
 424 #define DUMP_BUSY()     dump_busy()
 425 #else
 426 #define DUMP_BUSY()
 427 #endif
 428
 429 static const struct ao_lisp_type const *ao_lisp_types[AO_LISP_NUM_TYPE] = {
 430         [AO_LISP_CONS] = &ao_lisp_cons_type,
 431         [AO_LISP_INT] = NULL,
 432         [AO_LISP_STRING] = &ao_lisp_string_type,
 433         [AO_LISP_OTHER] = (void *) 0x1,
 434         [AO_LISP_ATOM] = &ao_lisp_atom_type,
 435         [AO_LISP_BUILTIN] = &ao_lisp_builtin_type,
 436         [AO_LISP_FRAME] = &ao_lisp_frame_type,
 437         [AO_LISP_LAMBDA] = &ao_lisp_lambda_type,
 438         [AO_LISP_STACK] = &ao_lisp_stack_type,
 439 };
 440
 441 static int
 442 ao_lisp_mark_ref(const struct ao_lisp_type *type, void **ref)
 443 {
 444         return ao_lisp_mark(type, *ref);
 445 }
 446
 447 static int
 448 ao_lisp_poly_mark_ref(ao_poly *p, uint8_t do_note_cons)
 449 {
 450         return ao_lisp_poly_mark(*p, do_note_cons);
 451 }
 452
 453 int ao_lisp_collects[2];
 454 int ao_lisp_freed[2];
 455 int ao_lisp_loops[2];
 456
 457 int ao_lisp_last_top;
 458
 459 int
 460 ao_lisp_collect(uint8_t style)
 461 {
 462         int     ret;
 463         int     i;
 464         int     top;
 465         int     loops = 0;
 466 #if DBG_MEM
 467         int     marked;
 468         int     moved;
 469         struct ao_lisp_record   *mark_record = NULL, *move_record = NULL;
 470
 471         MDBG_MOVE("collect %d\n", ao_lisp_collects);
 472         marked = moved = 0;
 473 #endif
 474
 475         /* The first time through, we're doing a full collect */
 476         if (ao_lisp_last_top == 0)
 477                 style = AO_LISP_COLLECT_FULL;
 478
 479         /* Clear references to all caches */
 480         for (i = 0; i < (int) AO_LISP_CACHE; i++)
 481                 *ao_lisp_cache[i] = NULL;
 482         if (style == AO_LISP_COLLECT_FULL) {
 483                 chunk_low = top = 0;
 484         } else {
 485                 chunk_low = top = ao_lisp_last_top;
 486         }
 487         for (;;) {
 488                 loops++;
 489                 MDBG_MOVE("move chunks from %d to %d\n", chunk_low, top);
 490                 /* Find the sizes of the first chunk of objects to move */
 491                 reset_chunks();
 492                 walk(ao_lisp_mark_ref, ao_lisp_poly_mark_ref);
 493 #if DBG_MEM
 494                 marked = total_marked;
 495
 496                 ao_lisp_record_free(mark_record);
 497                 mark_record = ao_lisp_record_save();
 498                 if (mark_record && move_record)
 499                         ao_lisp_record_compare("mark", move_record, mark_record);
 500
 501                 if (moved && moved != marked)
 502                         ao_lisp_abort();
 503 #endif
 504
 505                 DUMP_BUSY();
 506
 507                 /* Find the first moving object */
 508                 for (i = 0; i < chunk_busy; i++) {
 509                         uint16_t        size = ao_lisp_chunk[i].size;
 510
 511 #if DBG_MEM
 512                         if (!size)
 513                                 ao_lisp_abort();
 514 #endif
 515
 516                         if (ao_lisp_chunk[i].old_offset > top)
 517                                 break;
 518
 519                         MDBG_MOVE("chunk %d %d not moving\n",
 520                                   ao_lisp_chunk[i].old_offset,
 521                                   ao_lisp_chunk[i].size);
 522 #if DBG_MEM
 523                         if (ao_lisp_chunk[i].old_offset != top)
 524                                 ao_lisp_abort();
 525 #endif
 526                         top += size;
 527                 }
 528
 529                 /*
 530                  * Limit amount of chunk array used in mapping moves
 531                  * to the active region
 532                  */
 533                 chunk_first = i;
 534                 chunk_low = ao_lisp_chunk[i].old_offset;
 535
 536                 /* Copy all of the objects */
 537                 for (; i < chunk_busy; i++) {
 538                         uint16_t        size = ao_lisp_chunk[i].size;
 539
 540 #if DBG_MEM
 541                         if (!size)
 542                                 ao_lisp_abort();
 543 #endif
 544
 545                         MDBG_MOVE("chunk %d %d -> %d\n",
 546                                   ao_lisp_chunk[i].old_offset,
 547                                   size,
 548                                   top);
 549                         ao_lisp_chunk[i].new_offset = top;
 550
 551                         memmove(&ao_lisp_pool[top],
 552                                 &ao_lisp_pool[ao_lisp_chunk[i].old_offset],
 553                                 size);
 554
 555                         top += size;
 556                 }
 557
 558                 chunk_last = i;
 559
 560                 if (chunk_first < chunk_last) {
 561                         /* Relocate all references to the objects */
 562                         walk(ao_lisp_move, ao_lisp_poly_move);
 563
 564 #if DBG_MEM
 565                         ao_lisp_record_free(move_record);
 566                         move_record = ao_lisp_record_save();
 567                         if (mark_record && move_record)
 568                                 ao_lisp_record_compare("move", mark_record, move_record);
 569
 570                         moved = total_marked;
 571                         if (moved != marked)
 572                                 ao_lisp_abort();
 573 #endif
 574                 }
 575
 576                 /* If we ran into the end of the heap, then
 577                  * there's no need to keep walking
 578                  */
 579                 if (chunk_last != AO_LISP_NCHUNK)
 580                         break;
 581
 582                 /* Next loop starts right above this loop */
 583                 chunk_low = chunk_high;
 584         }
 585
 586         /* Compute amount of memory freed */
 587         ret = ao_lisp_top - top;
 588
 589         /* Collect stats */
 590         ++ao_lisp_collects[style];
 591         ao_lisp_freed[style] += ret;
 592         ao_lisp_loops[style] += loops;
 593
 594         ao_lisp_top = top;
 595         if (style == AO_LISP_COLLECT_FULL)
 596                 ao_lisp_last_top = top;
 597
 598         MDBG_DO(memset(ao_lisp_chunk, '\0', sizeof (ao_lisp_chunk));
 599                 walk(ao_lisp_mark_ref, ao_lisp_poly_mark_ref));
 600
 601         return ret;
 602 }
 603
 604 /*
 605  * Mark interfaces for objects
 606  */
 607
 608 /*
 609  * Note a reference to memory and collect information about a few
 610  * object sizes at a time
 611  */
 612
 613 int
 614 ao_lisp_mark_memory(const struct ao_lisp_type *type, void *addr)
 615 {
 616         int offset;
 617         if (!AO_LISP_IS_POOL(addr))
 618                 return 1;
 619
 620         offset = pool_offset(addr);
 621         MDBG_MOVE("mark memory %d\n", MDBG_OFFSET(addr));
 622         if (busy(ao_lisp_busy, offset)) {
 623                 MDBG_MOVE("already marked\n");
 624                 return 1;
 625         }
 626         mark(ao_lisp_busy, offset);
 627         note_chunk(offset, ao_lisp_size(type, addr));
 628         return 0;
 629 }
 630
 631 /*
 632  * Mark an object and all that it refereces
 633  */
 634 int
 635 ao_lisp_mark(const struct ao_lisp_type *type, void *addr)
 636 {
 637         int ret;
 638         MDBG_MOVE("mark %d\n", MDBG_OFFSET(addr));
 639         MDBG_MOVE_IN();
 640         ret = ao_lisp_mark_memory(type, addr);
 641         if (!ret) {
 642                 MDBG_MOVE("mark recurse\n");
 643                 type->mark(addr);
 644         }
 645         MDBG_MOVE_OUT();
 646         return ret;
 647 }
 648
 649 /*
 650  * Mark an object, unless it is a cons cell and
 651  * do_note_cons is set. In that case, just
 652  * set a bit in the cons note array; those
 653  * will be marked in a separate pass to avoid
 654  * deep recursion in the collector
 655  */
 656 int
 657 ao_lisp_poly_mark(ao_poly p, uint8_t do_note_cons)
 658 {
 659         uint8_t type;
 660         void    *addr;
 661
 662         type = ao_lisp_poly_base_type(p);
 663
 664         if (type == AO_LISP_INT)
 665                 return 1;
 666
 667         addr = ao_lisp_ref(p);
 668         if (!AO_LISP_IS_POOL(addr))
 669                 return 1;
 670
 671         if (type == AO_LISP_CONS && do_note_cons) {
 672                 note_cons(pool_offset(addr));
 673                 return 1;
 674         } else {
 675                 if (type == AO_LISP_OTHER)
 676                         type = ao_lisp_other_type(addr);
 677
 678                 const struct ao_lisp_type *lisp_type = ao_lisp_types[type];
 679 #if DBG_MEM
 680                 if (!lisp_type)
 681                         ao_lisp_abort();
 682 #endif
 683
 684                 return ao_lisp_mark(lisp_type, addr);
 685         }
 686 }
 687
 688 /*
 689  * Find the current location of an object
 690  * based on the original location. For unmoved
 691  * objects, this is simple. For moved objects,
 692  * go search for it
 693  */
 694
 695 static uint16_t
 696 move_map(uint16_t offset)
 697 {
 698         int             l, r;
 699
 700         if (offset < chunk_low || chunk_high <= offset)
 701                 return offset;
 702
 703         /* Binary search for the location */
 704         l = chunk_first;
 705         r = chunk_busy - 1;
 706         while (l <= r) {
 707                 int m = (l + r) >> 1;
 708                 if (ao_lisp_chunk[m].old_offset < offset)
 709                         l = m + 1;
 710                 else
 711                         r = m - 1;
 712         }
 713 #if DBG_MEM
 714         if (ao_lisp_chunk[l].old_offset != offset)
 715                 ao_lisp_abort();
 716 #endif
 717         return ao_lisp_chunk[l].new_offset;
 718 }
 719
 720 int
 721 ao_lisp_move_memory(const struct ao_lisp_type *type, void **ref)
 722 {
 723         void            *addr = *ref;
 724         uint16_t        offset, orig_offset;
 725
 726         if (!AO_LISP_IS_POOL(addr))
 727                 return 1;
 728
 729         (void) type;
 730
 731         MDBG_MOVE("move memory %d\n", MDBG_OFFSET(addr));
 732         orig_offset = pool_offset(addr);
 733         offset = move_map(orig_offset);
 734         if (offset != orig_offset) {
 735                 MDBG_MOVE("update ref %d %d -> %d\n",
 736                           AO_LISP_IS_POOL(ref) ? MDBG_OFFSET(ref) : -1,
 737                           orig_offset, offset);
 738                 *ref = ao_lisp_pool + offset;
 739         }
 740         if (busy(ao_lisp_busy, offset)) {
 741                 MDBG_MOVE("already moved\n");
 742                 return 1;
 743         }
 744         mark(ao_lisp_busy, offset);
 745         MDBG_DO(ao_lisp_record(type, addr, ao_lisp_size(type, addr)));
 746         return 0;
 747 }
 748
 749 int
 750 ao_lisp_move(const struct ao_lisp_type *type, void **ref)
 751 {
 752         int ret;
 753         MDBG_MOVE("move object %d\n", MDBG_OFFSET(*ref));
 754         MDBG_MOVE_IN();
 755         ret = ao_lisp_move_memory(type, ref);
 756         if (!ret) {
 757                 MDBG_MOVE("move recurse\n");
 758                 type->move(*ref);
 759         }
 760         MDBG_MOVE_OUT();
 761         return ret;
 762 }
 763
 764 int
 765 ao_lisp_poly_move(ao_poly *ref, uint8_t do_note_cons)
 766 {
 767         uint8_t         type;
 768         ao_poly         p = *ref;
 769         int             ret;
 770         void            *addr;
 771         uint16_t        offset, orig_offset;
 772         uint8_t         base_type;
 773
 774         base_type = type = ao_lisp_poly_base_type(p);
 775
 776         if (type == AO_LISP_INT)
 777                 return 1;
 778
 779         addr = ao_lisp_ref(p);
 780         if (!AO_LISP_IS_POOL(addr))
 781                 return 1;
 782
 783         orig_offset = pool_offset(addr);
 784         offset = move_map(orig_offset);
 785
 786         if (type == AO_LISP_CONS && do_note_cons) {
 787                 note_cons(orig_offset);
 788                 ret = 1;
 789         } else {
 790                 if (type == AO_LISP_OTHER)
 791                         type = ao_lisp_other_type(ao_lisp_pool + offset);
 792
 793                 const struct ao_lisp_type *lisp_type = ao_lisp_types[type];
 794 #if DBG_MEM
 795                 if (!lisp_type)
 796                         ao_lisp_abort();
 797 #endif
 798
 799                 ret = ao_lisp_move(lisp_type, &addr);
 800         }
 801
 802         /* Re-write the poly value */
 803         if (offset != orig_offset) {
 804                 ao_poly np = ao_lisp_poly(ao_lisp_pool + offset, base_type);
 805                 MDBG_MOVE("poly %d moved %d -> %d\n",
 806                           type, orig_offset, offset);
 807                 *ref = np;
 808         }
 809         return ret;
 810 }
 811
 812 #if DBG_MEM
 813 void
 814 ao_lisp_validate(void)
 815 {
 816         chunk_low = 0;
 817         memset(ao_lisp_chunk, '\0', sizeof (ao_lisp_chunk));
 818         walk(ao_lisp_mark_ref, ao_lisp_poly_mark_ref);
 819 }
 820
 821 int dbg_allocs;
 822
 823 #endif
 824
 825 void *
 826 ao_lisp_alloc(int size)
 827 {
 828         void    *addr;
 829
 830         MDBG_DO(++dbg_allocs);
 831         MDBG_DO(if (dbg_validate) ao_lisp_validate());
 832         size = ao_lisp_size_round(size);
 833         if (ao_lisp_top + size > AO_LISP_POOL) {
 834                 if (ao_lisp_collect(AO_LISP_COLLECT_INCREMENTAL) < size &&
 835                     ao_lisp_collect(AO_LISP_COLLECT_FULL) < size)
 836                 {
 837                         ao_lisp_error(AO_LISP_OOM, "out of memory");
 838                         return NULL;
 839                 }
 840         }
 841         addr = ao_lisp_pool + ao_lisp_top;
 842         ao_lisp_top += size;
 843         return addr;
 844 }
 845
 846 void
 847 ao_lisp_cons_stash(int id, struct ao_lisp_cons *cons)
 848 {
 849         save_cons[id] = cons;
 850 }
 851
 852 struct ao_lisp_cons *
 853 ao_lisp_cons_fetch(int id)
 854 {
 855         struct ao_lisp_cons *cons = save_cons[id];
 856         save_cons[id] = NULL;
 857         return cons;
 858 }
 859
 860 void
 861 ao_lisp_poly_stash(int id, ao_poly poly)
 862 {
 863         save_poly[id] = poly;
 864 }
 865
 866 ao_poly
 867 ao_lisp_poly_fetch(int id)
 868 {
 869         ao_poly poly = save_poly[id];
 870         save_poly[id] = AO_LISP_NIL;
 871         return poly;
 872 }
 873
 874 void
 875 ao_lisp_string_stash(int id, char *string)
 876 {
 877         save_string[id] = string;
 878 }
 879
 880 char *
 881 ao_lisp_string_fetch(int id)
 882 {
 883         char *string = save_string[id];
 884         save_string[id] = NULL;
 885         return string;
 886 }
 887