1 /* file: "dispatch.c" */
4 * Copyright 2004-2009 by Marc Feeley and Vincent St-Amour, All Rights Reserved.
7 #include "picobit-vm.h"
10 env
= cons (arg1
, env
);
15 obj o
= ram_get_car (env
);
16 env
= ram_get_cdr (env
);
20 void pop_procedure () {
24 if (!RAM_CLOSURE(arg1
))
25 TYPE_ERROR("pop_procedure.0", "procedure");
27 entry
= ram_get_entry (arg1
) + CODE_START
;
29 else if (IN_ROM(arg1
)) {
30 if (!ROM_CLOSURE(arg1
))
31 TYPE_ERROR("pop_procedure.1", "procedure");
33 entry
= rom_get_entry (arg1
) + CODE_START
;
36 TYPE_ERROR("pop_procedure.2", "procedure");
39 uint8
handle_arity_and_rest_param (uint8 na
) {
42 np
= rom_get (entry
++);
44 if ((np
& 0x80) == 0) {
46 ERROR("handle_arity_and_rest_param.0", "wrong number of arguments");
52 ERROR("handle_arity_and_rest_param.1", "wrong number of arguments");
59 arg3
= cons (arg4
, arg3
);
65 arg1
= cons (arg3
, arg1
);
72 uint8
build_env (uint8 na
) {
76 arg1
= cons (arg3
, arg1
);
85 // the second half is a closure
86 arg3
= alloc_ram_cell_init (CLOSURE_FIELD0
| (pc
>> 11),
88 ((pc
& 0x0007) << 5) | (env
>> 8),
90 cont
= alloc_ram_cell_init (COMPOSITE_FIELD0
| (cont
>> 8),
92 CONTINUATION_FIELD2
| (arg3
>> 8),
98 pc
= rom_get (CODE_START
+2);
99 pc
= (CODE_START
+ 4) + (pc
<< 2);
101 glovars
= rom_get (CODE_START
+3); // number of global variables
106 IF_TRACE(show_state (pc
));
107 FETCH_NEXT_BYTECODE();
108 bytecode_hi4
= bytecode
& 0xf0;
109 bytecode_lo4
= bytecode
& 0x0f;
111 switch (bytecode_hi4
>> 4) {
113 /*************************************************************************/
114 case PUSH_CONSTANT1
:
116 IF_TRACE(printf(" (push-constant "); show (bytecode_lo4
); printf (")\n"));
124 /*************************************************************************/
125 case PUSH_CONSTANT2
:
127 IF_TRACE(printf(" (push-constant "); show (bytecode_lo4
+16); printf (")\n"));
128 arg1
= bytecode_lo4
+16;
134 /*************************************************************************/
137 IF_TRACE(printf(" (push-stack %d)\n", bytecode_lo4
));
141 while (bytecode_lo4
!= 0) {
142 arg1
= ram_get_cdr (arg1
);
146 arg1
= ram_get_car (arg1
);
152 /*************************************************************************/
155 IF_TRACE(printf(" (push-stack %d)\n", bytecode_lo4
+16));
161 while (bytecode_lo4
!= 0) {
162 arg1
= ram_get_cdr (arg1
);
166 arg1
= ram_get_car (arg1
);
172 /*************************************************************************/
175 IF_TRACE(printf(" (push-global %d)\n", bytecode_lo4
));
177 arg1
= get_global (bytecode_lo4
);
183 /*************************************************************************/
186 IF_TRACE(printf(" (set-global %d)\n", bytecode_lo4
));
188 set_global (bytecode_lo4
, pop());
192 /*************************************************************************/
195 IF_TRACE(printf(" (call %d)\n", bytecode_lo4
));
198 build_env (handle_arity_and_rest_param (bytecode_lo4
));
208 /*************************************************************************/
211 IF_TRACE(printf(" (jump %d)\n", bytecode_lo4
));
214 build_env (handle_arity_and_rest_param (bytecode_lo4
));
223 /*************************************************************************/
226 switch (bytecode_lo4
) {
227 case 0: // call-toplevel
228 FETCH_NEXT_BYTECODE();
231 FETCH_NEXT_BYTECODE();
233 IF_TRACE(printf(" (call-toplevel 0x%04x)\n",
234 ((arg2
<< 8) | bytecode
) + CODE_START
));
236 entry
= (arg2
<< 8) + bytecode
+ CODE_START
;
239 build_env (rom_get (entry
++));
250 case 1: // jump-toplevel
251 FETCH_NEXT_BYTECODE();
254 FETCH_NEXT_BYTECODE();
256 IF_TRACE(printf(" (jump-toplevel 0x%04x)\n",
257 ((arg2
<< 8) | bytecode
) + CODE_START
));
259 entry
= (arg2
<< 8) + bytecode
+ CODE_START
;
262 build_env (rom_get (entry
++));
273 FETCH_NEXT_BYTECODE();
276 FETCH_NEXT_BYTECODE();
278 IF_TRACE(printf(" (goto 0x%04x)\n",
279 (arg2
<< 8) + bytecode
+ CODE_START
));
281 pc
= (arg2
<< 8) + bytecode
+ CODE_START
;
285 case 3: // goto-if-false
286 FETCH_NEXT_BYTECODE();
289 FETCH_NEXT_BYTECODE();
291 IF_TRACE(printf(" (goto-if-false 0x%04x)\n",
292 (arg2
<< 8) + bytecode
+ CODE_START
));
294 if (pop() == OBJ_FALSE
)
295 pc
= (arg2
<< 8) + bytecode
+ CODE_START
;
300 FETCH_NEXT_BYTECODE();
303 FETCH_NEXT_BYTECODE();
305 IF_TRACE(printf(" (closure 0x%04x)\n", (arg2
<< 8) | bytecode
));
309 entry
= (arg2
<< 8) | bytecode
;
312 alloc_ram_cell_init (CLOSURE_FIELD0
| (arg2
>> 3),
313 ((arg2
& 0x07) << 5) | (bytecode
>> 3),
314 ((bytecode
& 0x07) << 5) | ((arg3
& 0x1f00) >> 8),
325 case 5: // call-toplevel-short
326 FETCH_NEXT_BYTECODE(); // TODO the short version have a lot in common with the long ones, abstract ?
327 // TODO short instructions don't work at the moment
328 IF_TRACE(printf(" (call-toplevel-short 0x%04x)\n",
329 pc
+ bytecode
+ CODE_START
));
331 entry
= pc
+ bytecode
+ CODE_START
;
334 build_env (rom_get (entry
++));
344 case 6: // jump-toplevel-short
345 FETCH_NEXT_BYTECODE();
347 IF_TRACE(printf(" (jump-toplevel-short 0x%04x)\n",
348 pc
+ bytecode
+ CODE_START
));
350 entry
= pc
+ bytecode
+ CODE_START
;
353 build_env (rom_get (entry
++));
362 case 7: // goto-short
363 FETCH_NEXT_BYTECODE();
365 IF_TRACE(printf(" (goto-short 0x%04x)\n", pc
+ bytecode
+ CODE_START
));
367 pc
= pc
+ bytecode
+ CODE_START
;
371 case 8: // goto-if-false-short
372 FETCH_NEXT_BYTECODE();
374 IF_TRACE(printf(" (goto-if-false-short 0x%04x)\n",
375 pc
+ bytecode
+ CODE_START
));
377 if (pop() == OBJ_FALSE
)
378 pc
= pc
+ bytecode
+ CODE_START
;
382 case 9: // closure-short
383 FETCH_NEXT_BYTECODE();
385 IF_TRACE(printf(" (closure-short 0x%04x)\n", pc
+ bytecode
));
389 entry
= pc
+ bytecode
;
391 arg1
= alloc_ram_cell_init (CLOSURE_FIELD0
| (arg2
>> 3),
392 ((arg2
& 0x07) << 5) | (bytecode
>> 3),
393 ((bytecode
&0x07) <<5) |((arg3
&0x1f00) >>8),
413 case 14: // push_global [long]
414 FETCH_NEXT_BYTECODE();
416 IF_TRACE(printf(" (push-global [long] %d)\n", bytecode
));
418 arg1
= get_global (bytecode
);
424 case 15: // set_global [long]
425 FETCH_NEXT_BYTECODE();
427 IF_TRACE(printf(" (set-global [long] %d)\n", bytecode
));
429 set_global (bytecode
, pop());
436 /*************************************************************************/
437 case PUSH_CONSTANT_LONG
:
439 /* push-constant [long] */
441 FETCH_NEXT_BYTECODE();
443 IF_TRACE(printf(" (push [long] 0x%04x)\n", (bytecode_lo4
<< 8) + bytecode
));
445 // necessary since SIXPIC would have kept the result of the shift at 8 bits
447 arg1
= (arg1
<< 8) | bytecode
;
452 /*************************************************************************/
457 /*************************************************************************/
462 /*************************************************************************/
465 IF_TRACE(printf(" (%s)\n", prim_name
[bytecode_lo4
]));
467 switch (bytecode_lo4
) {
469 arg1
= pop(); prim_numberp (); push_arg1(); break;
471 arg2
= pop(); arg1
= pop(); prim_add (); push_arg1(); break;
473 arg2
= pop(); arg1
= pop(); prim_sub (); push_arg1(); break;
475 arg2
= pop(); arg1
= pop(); prim_mul (); push_arg1(); break;
477 arg2
= pop(); arg1
= pop(); prim_div (); push_arg1(); break;
479 arg2
= pop(); arg1
= pop(); prim_rem (); push_arg1(); break;
481 arg1
= pop(); prim_neg (); push_arg1(); break;
483 arg2
= pop(); arg1
= pop(); prim_eq (); push_arg1(); break;
485 arg2
= pop(); arg1
= pop(); prim_lt (); push_arg1(); break;
487 arg2
= pop(); arg1
= pop(); prim_leq (); push_arg1(); break;
489 arg2
= pop(); arg1
= pop(); prim_gt (); push_arg1(); break;
491 arg2
= pop(); arg1
= pop(); prim_geq (); push_arg1(); break;
493 arg1
= pop(); prim_pairp (); push_arg1(); break;
495 arg2
= pop(); arg1
= pop(); prim_cons (); push_arg1(); break;
497 arg1
= pop(); prim_car (); push_arg1(); break;
499 arg1
= pop(); prim_cdr (); push_arg1(); break;
504 /*************************************************************************/
507 IF_TRACE(printf(" (%s)\n", prim_name
[bytecode_lo4
+16]));
509 switch (bytecode_lo4
) {
511 arg2
= pop(); arg1
= pop(); prim_set_car (); break;
513 arg2
= pop(); arg1
= pop(); prim_set_cdr (); break;
515 arg1
= pop(); prim_nullp (); push_arg1(); break;
517 arg2
= pop(); arg1
= pop(); prim_eqp (); push_arg1(); break;
519 arg1
= pop(); prim_not (); push_arg1(); break;
521 /* prim #%get-cont */
526 /* prim #%graft-to-cont */
528 arg1
= pop(); /* thunk to call */
529 cont
= pop(); /* continuation */
534 build_env (handle_arity_and_rest_param (0));
543 /* prim #%return-to-cont */
545 arg1
= pop(); /* value to return */
546 cont
= pop(); /* continuation */
548 arg2
= ram_get_cdr (cont
);
550 pc
= ram_get_entry (arg2
);
552 env
= ram_get_cdr (arg2
);
553 cont
= ram_get_car (cont
);
564 arg1
= pop(); prim_symbolp (); push_arg1(); break;
567 arg1
= pop(); prim_stringp (); push_arg1(); break;
569 /* prim #%string->list */
570 arg1
= pop(); prim_string2list (); push_arg1(); break;
572 /* prim #%list->string */
573 arg1
= pop(); prim_list2string (); push_arg1(); break;
575 /* prim #%make-u8vector */
576 arg2
= pop(); arg1
= pop(); prim_make_u8vector (); push_arg1(); break;
578 /* prim #%u8vector-ref */
579 arg2
= pop(); arg1
= pop(); prim_u8vector_ref (); push_arg1(); break;
581 /* prim #%u8vector-set! */
582 arg3
= pop(); arg2
= pop(); arg1
= pop(); prim_u8vector_set (); break;
587 /*************************************************************************/
590 IF_TRACE(printf(" (%s)\n", prim_name
[bytecode_lo4
+32]));
592 switch (bytecode_lo4
) {
600 prim_clock (); push_arg1(); break;
603 arg2
= pop(); arg1
= pop(); prim_motor (); break;
606 arg3
= pop(); arg2
= pop(); arg1
= pop(); prim_led (); ;break;
608 /* prim #%led2-color */
609 arg1
= pop(); prim_led2_color (); break;
611 /* prim #%getchar-wait */
612 arg2
= pop(); arg1
= pop(); prim_getchar_wait (); push_arg1(); break;
615 arg2
= pop(); arg1
= pop(); prim_putchar (); break;
618 arg2
= pop(); arg1
= pop(); prim_beep (); break;
621 arg1
= pop(); prim_adc (); push_arg1(); break;
623 /* prim #%u8vector? */
624 arg1
= pop(); prim_u8vectorp (); push_arg1(); break;
627 prim_sernum (); push_arg1(); break;
629 /* prim #%u8vector-length */
630 arg1
= pop(); prim_u8vector_length (); push_arg1(); break;
632 /* prim #%u8vector-copy! */
633 arg5
= pop(); arg4
= pop(); arg3
= pop(); arg2
= pop(); arg1
= pop();
634 prim_u8vector_copy (); break;
649 arg2
= ram_get_cdr (cont
);
650 pc
= ram_get_entry (arg2
);
651 env
= ram_get_cdr (arg2
);
652 cont
= ram_get_car (cont
);
660 /*************************************************************************/
664 IF_TRACE(printf(" (%s)\n", prim_name
[bytecode_lo4
]));
666 switch (bytecode_lo4
) {
668 /* prim #%boolean? */
669 arg1
= pop(); prim_booleanp (); push_arg1(); break;
671 /* prim #%network-init */
672 prim_network_init (); break;
674 /* prim #%network-cleanup */
675 prim_network_cleanup (); break;
677 /* prim #%receive-packet-to-u8vector */
678 arg1
= pop(); prim_receive_packet_to_u8vector (); push_arg1(); break;
680 /* prim #%send-packet-from-u8vector */
681 arg2
= pop(); arg1
= pop(); prim_send_packet_from_u8vector ();
684 arg2
= pop(); arg1
= pop(); prim_ior (); push_arg1(); break;
687 arg2
= pop(); arg1
= pop(); prim_xor (); push_arg1(); break;
713 /*************************************************************************/