altos/lisp: Split out read debug, add memory validation

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

diff --git a/src/lisp/ao_lisp_error.c b/src/lisp/ao_lisp_error.c
index ea8111d9434ec434f6b146eadc202ba3591aa62a..7f9094879e7ad9241273c6a635c52592f3792f42 100644 (file)
--- a/src/lisp/ao_lisp_error.c
+++ b/src/lisp/ao_lisp_error.c
@@ -15,6 +15,111 @@
 #include "ao_lisp.h"
 #include <stdarg.h>
 
+void
+ao_lisp_error_poly(char *name, ao_poly poly, ao_poly last)
+{
+       int first = 1;
+       printf("\t\t%s(", name);
+       if (ao_lisp_poly_type(poly) == AO_LISP_CONS) {
+               if (poly) {
+                       while (poly) {
+                               struct ao_lisp_cons *cons = ao_lisp_poly_cons(poly);
+                               if (!first)
+                                       printf("\t\t         ");
+                               else
+                                       first = 0;
+                               ao_lisp_poly_write(cons->car);
+                               printf("\n");
+                               if (poly == last)
+                                       break;
+                               poly = cons->cdr;
+                       }
+                       printf("\t\t         )\n");
+               } else
+                       printf(")\n");
+       } else {
+               ao_lisp_poly_write(poly);
+               printf("\n");
+       }
+}
+
+static void tabs(int indent)
+{
+       while (indent--)
+               printf("\t");
+}
+
+void
+ao_lisp_error_frame(int indent, char *name, struct ao_lisp_frame *frame)
+{
+       int                     f;
+
+       tabs(indent);
+       printf ("%s{", name);
+       if (frame) {
+               struct ao_lisp_frame_vals       *vals = ao_lisp_poly_frame_vals(frame->vals);
+               if (frame->type & AO_LISP_FRAME_PRINT)
+                       printf("recurse...");
+               else {
+                       frame->type |= AO_LISP_FRAME_PRINT;
+                       for (f = 0; f < frame->num; f++) {
+                               if (f != 0) {
+                                       tabs(indent);
+                                       printf("         ");
+                               }
+                               ao_lisp_poly_write(vals->vals[f].atom);
+                               printf(" = ");
+                               ao_lisp_poly_write(vals->vals[f].val);
+                               printf("\n");
+                       }
+                       if (frame->prev)
+                               ao_lisp_error_frame(indent + 1, "prev:   ", ao_lisp_poly_frame(frame->prev));
+                       frame->type &= ~AO_LISP_FRAME_PRINT;
+               }
+               tabs(indent);
+               printf("        }\n");
+       } else
+               printf ("}\n");
+}
+
+void
+ao_lisp_vprintf(char *format, va_list args)
+{
+       char c;
+
+       while ((c = *format++) != '\0') {
+               if (c == '%') {
+                       switch (c = *format++) {
+                       case 'v':
+                               ao_lisp_poly_write((ao_poly) va_arg(args, unsigned int));
+                               break;
+                       case 'p':
+                               printf("%p", va_arg(args, void *));
+                               break;
+                       case 'd':
+                               printf("%d", va_arg(args, int));
+                               break;
+                       case 's':
+                               printf("%s", va_arg(args, char *));
+                               break;
+                       default:
+                               putchar(c);
+                               break;
+                       }
+               } else
+                       putchar(c);
+       }
+}
+
+void
+ao_lisp_printf(char *format, ...)
+{
+       va_list args;
+       va_start(args, format);
+       ao_lisp_vprintf(format, args);
+       va_end(args);
+}
+
 ao_poly
 ao_lisp_error(int error, char *format, ...)
 {
@@ -22,8 +127,13 @@ ao_lisp_error(int error, char *format, ...)
 
        ao_lisp_exception |= error;
        va_start(args, format);
-       vprintf(format, args);
+       ao_lisp_vprintf(format, args);
+       putchar('\n');
        va_end(args);
-       printf("\n");
+       ao_lisp_printf("Value:  %v\n", ao_lisp_v);
+       ao_lisp_printf("Frame:  %v\n", ao_lisp_frame_poly(ao_lisp_frame_current));
+       printf("Stack:\n");
+       ao_lisp_stack_write(ao_lisp_stack_poly(ao_lisp_stack));
+       ao_lisp_printf("Globals: %v\n", ao_lisp_frame_poly(ao_lisp_frame_global));
        return AO_LISP_NIL;
 }