4 #include "mTaskSymbols.h"
10 void run_task(struct task
*t
, int fd
)
12 uint8_t *program
= t
->bc
;
16 char stack
[STACKSIZE
] = {0};
17 printf("Running task with length: %d\n", plen
);
19 printf("program: %d\n", program
[pc
]);
20 printf("stack: %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n",
21 stack
[0], stack
[1], stack
[2], stack
[3], stack
[4],
22 stack
[5], stack
[6], stack
[7], stack
[8], stack
[9]);
23 switch(program
[pc
++]){
24 case BCNOP
: trace("nop\n");
26 case BCPUSH
: trace("push %d\n", program
[pc
]*265+program
[pc
+1]);
27 stack
[sp
++] = program
[pc
]*265 + program
[pc
+1];
30 case BCPOP
: trace("pop\n");
33 case BCSDSSTORE
: trace("sds store\n");
34 sds_store(program
[pc
++], stack
[sp
-1]);
36 case BCSDSFETCH
: trace("sds fetch\n");
37 stack
[sp
++] = sds_fetch(program
[pc
++]);
39 case BCSDSPUBLISH
: trace("sds publish\n");
40 sds_publish(program
[pc
++], fd
);
42 case BCNOT
: trace("not\n");
43 stack
[sp
] = stack
[sp
] > 0 ? 0 : 1;
45 case BCADD
: trace("add\n");
46 stack
[sp
-2] = stack
[sp
-1] + stack
[sp
-2];
49 case BCSUB
: trace("sub\n");
50 stack
[sp
-2] = stack
[sp
-1] - stack
[sp
-2];
53 case BCMUL
: trace("mul\n");
54 stack
[sp
-2] = stack
[sp
-1] * stack
[sp
-2];
57 case BCDIV
: trace("div\n");
58 stack
[sp
-2] = stack
[sp
-1] / stack
[sp
-2];
61 case BCAND
: trace("and\n");
62 stack
[sp
-2] = stack
[sp
-1] && stack
[sp
-2];
65 case BCOR
: trace("or\n");
66 stack
[sp
-2] = stack
[sp
-1] || stack
[sp
-2];
69 case BCEQ
: trace("eq\n");
70 stack
[sp
-2] = stack
[sp
-1] == stack
[sp
-2];
73 case BCNEQ
: trace("neq\n");
74 stack
[sp
-2] = stack
[sp
-1] != stack
[sp
-2];
77 case BCLES
: trace("les\n");
78 stack
[sp
-2] = stack
[sp
-1] < stack
[sp
-2];
81 case BCGRE
: trace("gre\n");
82 stack
[sp
-2] = stack
[sp
-1] > stack
[sp
-2];
85 case BCLEQ
: trace("leq\n");
86 stack
[sp
-2] = stack
[sp
-1] <= stack
[sp
-2];
89 case BCGEQ
: trace("geq\n");
90 stack
[sp
-2] = stack
[sp
-1] >= stack
[sp
-2];
93 case BCJMP
: trace("jmp to %d\n", program
[pc
]);
94 pc
= pc
+ program
[pc
];
96 case BCJMPT
: trace("jmpt to %d\n", program
[pc
]);
97 pc
+= stack
[sp
] ? program
[pc
] : 1;
99 case BCJMPF
: trace("jmpf to %d\n", program
[pc
]);
100 pc
+= stack
[sp
] ? 1 : program
[pc
];
102 case BCSERIALAVAIL
: trace("SerialAvailable()\n");
104 case BCSERIALPRINT
: trace("SerialPrint()\n");
106 case BCSERIALPRINTLN
: trace("SerialPrintln()\n");
108 case BCSERIALREAD
: trace("SerialRead()\n");
110 case BCSERIALPARSEINT
: trace("SerialParseInt()\n");
112 case BCANALOGREAD
: trace("AnalogRead(%d)\n", program
[pc
]);
115 case BCANALOGWRITE
: trace("AnalogWrite(%d)\n", program
[pc
]);
118 case BCDIGITALREAD
: trace("DigitalRead(%d)\n", program
[pc
]);
121 case BCDIGITALWRITE
: trace("DigitalWrite(%d)\n", program
[pc
]);
125 die("Unrecognized command: %d\n", program
[--pc
]);
128 debug("Task terminated\n");