e5d481e75d3e5b25068346d11959b0f3a5856c17
[fw/altos] / src / scheme / ao_scheme_frame.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 #include "ao_scheme.h"
16
17 static inline int
18 frame_vals_num_size(int num)
19 {
20         return sizeof (struct ao_scheme_frame_vals) + num * sizeof (struct ao_scheme_val);
21 }
22
23 static int
24 frame_vals_size(void *addr)
25 {
26         struct ao_scheme_frame_vals     *vals = addr;
27         return frame_vals_num_size(vals->size);
28 }
29
30 static void
31 frame_vals_mark(void *addr)
32 {
33         struct ao_scheme_frame_vals     *vals = addr;
34         int                             f;
35
36         for (f = 0; f < vals->size; f++) {
37                 struct ao_scheme_val    *v = &vals->vals[f];
38
39                 ao_scheme_poly_mark(v->val, 0);
40                 MDBG_MOVE("frame mark atom %s %d val %d at %d    ",
41                           ao_scheme_poly_atom(v->atom)->name,
42                           MDBG_OFFSET(ao_scheme_ref(v->atom)),
43                           MDBG_OFFSET(ao_scheme_ref(v->val)), f);
44                 MDBG_DO(ao_scheme_poly_write(v->val));
45                 MDBG_DO(printf("\n"));
46         }
47 }
48
49 static void
50 frame_vals_move(void *addr)
51 {
52         struct ao_scheme_frame_vals     *vals = addr;
53         int                             f;
54
55         for (f = 0; f < vals->size; f++) {
56                 struct ao_scheme_val    *v = &vals->vals[f];
57
58                 ao_scheme_poly_move(&v->atom, 0);
59                 ao_scheme_poly_move(&v->val, 0);
60                 MDBG_MOVE("frame move atom %s %d val %d at %d\n",
61                           ao_scheme_poly_atom(v->atom)->name,
62                           MDBG_OFFSET(ao_scheme_ref(v->atom)),
63                           MDBG_OFFSET(ao_scheme_ref(v->val)), f);
64         }
65 }
66
67 const struct ao_scheme_type ao_scheme_frame_vals_type = {
68         .mark = frame_vals_mark,
69         .size = frame_vals_size,
70         .move = frame_vals_move,
71         .name = "frame_vals"
72 };
73
74 static int
75 frame_size(void *addr)
76 {
77         (void) addr;
78         return sizeof (struct ao_scheme_frame);
79 }
80
81 static void
82 frame_mark(void *addr)
83 {
84         struct ao_scheme_frame  *frame = addr;
85
86         for (;;) {
87                 MDBG_MOVE("frame mark %d\n", MDBG_OFFSET(frame));
88                 if (!AO_SCHEME_IS_POOL(frame))
89                         break;
90                 ao_scheme_poly_mark(frame->vals, 0);
91                 frame = ao_scheme_poly_frame(frame->prev);
92                 MDBG_MOVE("frame next %d\n", MDBG_OFFSET(frame));
93                 if (!frame)
94                         break;
95                 if (ao_scheme_mark_memory(&ao_scheme_frame_type, frame))
96                         break;
97         }
98 }
99
100 static void
101 frame_move(void *addr)
102 {
103         struct ao_scheme_frame  *frame = addr;
104
105         for (;;) {
106                 struct ao_scheme_frame  *prev;
107                 int                     ret;
108
109                 MDBG_MOVE("frame move %d\n", MDBG_OFFSET(frame));
110                 if (!AO_SCHEME_IS_POOL(frame))
111                         break;
112                 ao_scheme_poly_move(&frame->vals, 0);
113                 prev = ao_scheme_poly_frame(frame->prev);
114                 if (!prev)
115                         break;
116                 ret = ao_scheme_move_memory(&ao_scheme_frame_type, (void **) &prev);
117                 if (prev != ao_scheme_poly_frame(frame->prev)) {
118                         MDBG_MOVE("frame prev moved from %d to %d\n",
119                                   MDBG_OFFSET(ao_scheme_poly_frame(frame->prev)),
120                                   MDBG_OFFSET(prev));
121                         frame->prev = ao_scheme_frame_poly(prev);
122                 }
123                 if (ret)
124                         break;
125                 frame = prev;
126         }
127 }
128
129 const struct ao_scheme_type ao_scheme_frame_type = {
130         .mark = frame_mark,
131         .size = frame_size,
132         .move = frame_move,
133         .name = "frame",
134 };
135
136 void
137 ao_scheme_frame_write(ao_poly p)
138 {
139         struct ao_scheme_frame          *frame = ao_scheme_poly_frame(p);
140         struct ao_scheme_frame_vals     *vals = ao_scheme_poly_frame_vals(frame->vals);
141         int                             f;
142
143         printf ("{");
144         if (frame) {
145                 if (frame->type & AO_SCHEME_FRAME_PRINT)
146                         printf("recurse...");
147                 else {
148                         frame->type |= AO_SCHEME_FRAME_PRINT;
149                         for (f = 0; f < frame->num; f++) {
150                                 if (f != 0)
151                                         printf(", ");
152                                 ao_scheme_poly_write(vals->vals[f].atom);
153                                 printf(" = ");
154                                 ao_scheme_poly_write(vals->vals[f].val);
155                         }
156                         if (frame->prev)
157                                 ao_scheme_poly_write(frame->prev);
158                         frame->type &= ~AO_SCHEME_FRAME_PRINT;
159                 }
160         }
161         printf("}");
162 }
163
164 static int
165 ao_scheme_frame_find(struct ao_scheme_frame *frame, int top, ao_poly atom)
166 {
167         struct ao_scheme_frame_vals     *vals = ao_scheme_poly_frame_vals(frame->vals);
168         int                             l = 0;
169         int                             r = top - 1;
170
171         while (l <= r) {
172                 int m = (l + r) >> 1;
173                 if (vals->vals[m].atom < atom)
174                         l = m + 1;
175                 else
176                         r = m - 1;
177         }
178         return l;
179 }
180
181 ao_poly *
182 ao_scheme_frame_ref(struct ao_scheme_frame *frame, ao_poly atom)
183 {
184         struct ao_scheme_frame_vals     *vals = ao_scheme_poly_frame_vals(frame->vals);
185         int                             l = ao_scheme_frame_find(frame, frame->num, atom);
186
187         if (l >= frame->num)
188                 return NULL;
189
190         if (vals->vals[l].atom != atom)
191                 return NULL;
192         return &vals->vals[l].val;
193 }
194
195 struct ao_scheme_frame  *ao_scheme_frame_free_list[AO_SCHEME_FRAME_FREE];
196
197 static struct ao_scheme_frame_vals *
198 ao_scheme_frame_vals_new(int num)
199 {
200         struct ao_scheme_frame_vals     *vals;
201
202         vals = ao_scheme_alloc(frame_vals_num_size(num));
203         if (!vals)
204                 return NULL;
205         vals->type = AO_SCHEME_FRAME_VALS;
206         vals->size = num;
207         memset(vals->vals, '\0', num * sizeof (struct ao_scheme_val));
208         return vals;
209 }
210
211 struct ao_scheme_frame *
212 ao_scheme_frame_new(int num)
213 {
214         struct ao_scheme_frame          *frame;
215         struct ao_scheme_frame_vals     *vals;
216
217         if (num < AO_SCHEME_FRAME_FREE && (frame = ao_scheme_frame_free_list[num])) {
218                 ao_scheme_frame_free_list[num] = ao_scheme_poly_frame(frame->prev);
219                 vals = ao_scheme_poly_frame_vals(frame->vals);
220         } else {
221                 frame = ao_scheme_alloc(sizeof (struct ao_scheme_frame));
222                 if (!frame)
223                         return NULL;
224                 frame->type = AO_SCHEME_FRAME;
225                 frame->num = 0;
226                 frame->prev = AO_SCHEME_NIL;
227                 frame->vals = AO_SCHEME_NIL;
228                 ao_scheme_frame_stash(0, frame);
229                 vals = ao_scheme_frame_vals_new(num);
230                 frame = ao_scheme_frame_fetch(0);
231                 if (!vals)
232                         return NULL;
233                 frame->vals = ao_scheme_frame_vals_poly(vals);
234                 frame->num = num;
235         }
236         frame->prev = AO_SCHEME_NIL;
237         return frame;
238 }
239
240 ao_poly
241 ao_scheme_frame_mark(struct ao_scheme_frame *frame)
242 {
243         if (!frame)
244                 return AO_SCHEME_NIL;
245         frame->type |= AO_SCHEME_FRAME_MARK;
246         return ao_scheme_frame_poly(frame);
247 }
248
249 void
250 ao_scheme_frame_free(struct ao_scheme_frame *frame)
251 {
252         if (frame && !ao_scheme_frame_marked(frame)) {
253                 int     num = frame->num;
254                 if (num < AO_SCHEME_FRAME_FREE) {
255                         struct ao_scheme_frame_vals     *vals;
256
257                         vals = ao_scheme_poly_frame_vals(frame->vals);
258                         memset(vals->vals, '\0', vals->size * sizeof (struct ao_scheme_val));
259                         frame->prev = ao_scheme_frame_poly(ao_scheme_frame_free_list[num]);
260                         ao_scheme_frame_free_list[num] = frame;
261                 }
262         }
263 }
264
265 static struct ao_scheme_frame *
266 ao_scheme_frame_realloc(struct ao_scheme_frame *frame, int new_num)
267 {
268         struct ao_scheme_frame_vals     *vals;
269         struct ao_scheme_frame_vals     *new_vals;
270         int                             copy;
271
272         if (new_num == frame->num)
273                 return frame;
274         ao_scheme_frame_stash(0, frame);
275         new_vals = ao_scheme_frame_vals_new(new_num);
276         frame = ao_scheme_frame_fetch(0);
277         if (!new_vals)
278                 return NULL;
279         vals = ao_scheme_poly_frame_vals(frame->vals);
280         copy = new_num;
281         if (copy > frame->num)
282                 copy = frame->num;
283         memcpy(new_vals->vals, vals->vals, copy * sizeof (struct ao_scheme_val));
284         frame->vals = ao_scheme_frame_vals_poly(new_vals);
285         frame->num = new_num;
286         return frame;
287 }
288
289 void
290 ao_scheme_frame_bind(struct ao_scheme_frame *frame, int num, ao_poly atom, ao_poly val)
291 {
292         struct ao_scheme_frame_vals     *vals = ao_scheme_poly_frame_vals(frame->vals);
293         int                             l = ao_scheme_frame_find(frame, num, atom);
294
295         memmove(&vals->vals[l+1],
296                 &vals->vals[l],
297                 (num - l) * sizeof (struct ao_scheme_val));
298         vals->vals[l].atom = atom;
299         vals->vals[l].val = val;
300 }
301
302 ao_poly
303 ao_scheme_frame_add(struct ao_scheme_frame *frame, ao_poly atom, ao_poly val)
304 {
305         ao_poly *ref = frame ? ao_scheme_frame_ref(frame, atom) : NULL;
306
307         if (!ref) {
308                 int f = frame->num;
309                 ao_scheme_poly_stash(0, atom);
310                 ao_scheme_poly_stash(1, val);
311                 frame = ao_scheme_frame_realloc(frame, f + 1);
312                 val = ao_scheme_poly_fetch(1);
313                 atom = ao_scheme_poly_fetch(0);
314                 if (!frame)
315                         return AO_SCHEME_NIL;
316                 ao_scheme_frame_bind(frame, frame->num - 1, atom, val);
317         } else
318                 *ref = val;
319         return val;
320 }
321
322 struct ao_scheme_frame  *ao_scheme_frame_global;
323 struct ao_scheme_frame  *ao_scheme_frame_current;
324
325 void
326 ao_scheme_frame_init(void)
327 {
328         if (!ao_scheme_frame_global)
329                 ao_scheme_frame_global = ao_scheme_frame_new(0);
330 }