source: Deliverables/D4.1/ASMInterpret.ml @ 42

Last change on this file since 42 was 42, checked in by mulligan, 9 years ago

Address1 function completed for instructions A--M.

File size: 25.6 KB
Line 
1open Physical;;
2open ASM;;
3
4exception BOO
5
6type time = int;;
7
8type foo
9
10(* no differentiation between internal and external code memory *)
11type status =
12 { code_memory: byte WordMap.t;        (* can be reduced *)
13   low_internal_ram: byte Byte7Map.t;
14   high_internal_ram: byte Byte7Map.t;
15   external_ram: byte WordMap.t;
16
17   pc: word;
18
19   (* sfr *)
20   p0: byte;
21   sp: byte;
22   dpl: byte;
23   dph: byte;
24   pcon: byte;
25   tcon: byte;
26   tmod: byte;
27   tl0: byte;
28   tl1: byte;
29   th0: byte;
30   th1: byte;
31   p1: byte;
32   scon: byte;
33   sbuf: byte;
34   p2: byte;
35   ie: byte;
36   p3: byte;
37   ip: byte;
38   psw: byte;
39   acc: byte;
40   b: byte;
41
42   clock: time;
43   timer0: word;
44   timer1: word;
45   timer2: word;  (* can be missing *)
46   io: foo (*(time * ?line? -> ?val?)*)
47 }
48
49let carr status = let (c,_,_,_),_ = status.psw in c
50
51(* timings taken from SIEMENS *)
52
53let fetch pmem pc =
54 let next pc = pc ++ 1, WordMap.find pc pmem in
55 let next7 pc =
56  let pc,v = next pc in
57   try pc, byte7_of_byte v
58   with FOO2 -> raise BOO in
59 let instr = WordMap.find pc pmem in
60 let pc = pc ++ 1 in
61 try
62  match instr with
63     (a10,a9,a8,true),(false,false,false,true) ->
64      let pc,b1 = next pc in
65       ACALL (`ADDR11 (a10,a9,a8,b1)), pc, 2
66   | (false,false,true,false),(true,r1,r2,r3) ->
67      ADD (`A,`REG (r1,r2,r3)), pc, 1
68   | (false,false,true,false),(false,true,false,true) ->
69      let pc,b1 = next pc in
70       ADD (`A,`DIRECT b1), pc, 1
71   | (false,false,true,false),(false,true,true,i1) ->
72       ADD (`A,`INDIRECT i1), pc, 1
73   | (false,false,true,false),(false,true,false,false) ->
74      let pc,b1 = next pc in
75       ADD (`A,`DATA b1), pc, 1
76   | (false,false,true,true),(true,r1,r2,r3) ->
77       ADDC (`A,`REG (r1,r2,r3)), pc, 1
78   | (false,false,true,true),(false,true,false,true) ->
79      let pc,b1 = next pc in
80       ADDC (`A,`DIRECT b1), pc, 1
81   | (false,false,true,true),(false,true,true,i1) ->
82       ADDC (`A,`INDIRECT i1), pc, 1
83   | (false,false,true,true),(false,true,false,false) ->
84      let pc,b1 = next pc in
85       ADDC (`A,`DATA b1), pc, 1
86   | (a10,a9,a8,false),(false,false,false,true) ->
87      let pc,b1 = next pc in
88       AJMP (`ADDR11 (a10,a9,a8,b1)), pc, 2
89   | (false,true,false,true),(true,r1,r2,r3) ->
90      ANL (`U1 (`A, `REG (r1,r2,r3))), pc, 1
91   | (false,true,false,true),(false,true,false,true) ->
92      let pc,b1 = next pc in
93       ANL (`U1 (`A, `DIRECT b1)), pc, 1
94   | (false,true,false,true),(false,true,true,i1) ->
95       ANL (`U1 (`A, `INDIRECT i1)), pc, 1
96   | (false,true,false,true),(false,true,false,false) ->
97      let pc,b1 = next pc in
98       ANL (`U1 (`A, `DATA b1)), pc, 1
99   | (false,true,false,true),(false,false,true,false) ->
100      let pc,b1 = next pc in
101       ANL (`U2 (`DIRECT b1,`A)), pc, 1
102   | (false,true,false,true),(false,false,true,true) ->
103      let pc,b1 = next pc in
104      let pc,b2 = next pc in
105       ANL (`U2 (`DIRECT b1,`DATA b2)), pc, 2
106   | (true,false,false,false),(false,false,true,false) ->
107      let pc,b1 = next7 pc in
108       ANL (`U3 (`C,`BIT b1)), pc, 2
109   | (true,false,true,true),(false,false,false,false) ->
110      let pc,b1 = next7 pc in
111       ANL (`U3 (`C,`NBIT b1)), pc, 2
112   | (true,false,true,true),(false,true,false,true) ->
113      let       pc,b1 = next pc in
114      let pc,b2 = next pc in
115        CJNE (`U1 (`A, `DIRECT b1), `REL b2), pc, 2
116   | (true,false,true,true),(false,true,false,false) ->
117       let pc,b1 = next pc in
118       let pc,b2 = next pc in
119         CJNE (`U1 (`A, `DATA b1), `REL b2), pc, 2
120   | (true,false,true,true),(true,r1,r2,r3) ->
121       let pc,b1 = next pc in
122       let pc,b2 = next pc in
123         CJNE (`U2 (`REG(r1,r2,r3), `DATA b1), `REL b2), pc, 2
124   | (true,false,true,true),(false,true,true,i1) ->
125       let pc,b1 = next pc in
126       let pc,b2 = next pc in
127         CJNE (`U2 (`INDIRECT i1, `DATA b1), `REL b2), pc, 2
128   | (true,true,true,false),(false,true,false,false) ->
129         CLR `A, pc, 1
130   | (true,true,false,false),(false,false,true,true) ->
131         CLR `C, pc, 1
132   | (true,true,false,false),(false,false,true,false) ->
133       let pc,b1 = next7 pc in
134         CLR (`BIT b1), pc, 1
135   | (true,true,false,true),(false,true,false,false) ->
136         DA `A, pc, 1
137   | (false,false,false,true),(false,true,false,false) ->
138         DEC `A, pc, 1
139   | (false,false,false,true),(true,r1,r2,r3) ->
140         DEC (`REG(r1,r2,r3)), pc, 1
141   | (false,false,false,true),(false,true,false,true) ->
142       let pc,b1 = next pc in
143         DEC (`DIRECT b1), pc, 1
144   | (false,false,false,true),(false,true,true,i1) ->
145         DEC (`INDIRECT i1), pc, 1
146   | (true,false,false,false),(false,true,false,false) ->
147         DIV (`A, `B), pc, 4
148   | (true,true,false,true),(true,r1,r2,r3) ->
149       let pc,b1 = next pc in
150         DJNZ (`REG(r1,r2,r3), `REL b1), pc, 2
151   | (true,true,false,true),(false,true,false,true) ->
152       let pc,b1 = next pc in
153       let pc,b2 = next pc in
154         DJNZ (`DIRECT b1, `REL b2), pc, 2
155   | (false,false,false,false),(false,true,false,false) ->
156         INC `A, pc, 1
157   | (false,false,false,false),(true,r1,r2,r3) ->
158         INC (`REG(r1,r2,r3)), pc, 1
159   | (false,false,false,false),(false,true,false,true) ->
160       let pc,b1 = next pc in
161         INC (`DIRECT b1), pc, 1
162   | (false,false,false,false),(false,true,true,i1) ->
163         INC (`INDIRECT i1), pc, 1
164   | (true,false,true,false),(false,false,true,true) ->
165         INC `DPTR, pc, 2
166   | (false,false,true,false),(false,false,false,false) ->
167       let pc,b1 = next7 pc in
168       let pc,b2 = next pc in
169         JB (`BIT b1, `REL b2), pc, 2
170   | (false,false,false,true),(false,false,false,false) ->
171       let pc,b1 = next7 pc in
172       let pc,b2 = next pc in
173         JBC (`BIT b1, `REL b2), pc, 2
174   | (false,true,false,false),(false,false,false,false) ->
175       let pc,b1 = next pc in
176         JC (`REL b1), pc, 2
177   | (false,true,true,true),(false,false,true,true) ->
178         JMP `IND_DPTR, pc, 2
179   | (false,false,true,true),(false,false,false,false) ->
180       let pc,b1 = next7 pc in
181       let pc,b2 = next pc in
182         JNB (`BIT b1, `REL b2), pc, 2
183   | (false,true,false,true),(false,false,false,false) ->
184       let pc,b1 = next pc in
185         JNC (`REL b1), pc, 2
186   | (false,true,true,true),(false,false,false,false) ->
187       let pc,b1 = next pc in
188         JNZ (`REL b1), pc, 2
189   | (false,true,true,false),(false,false,false,false) ->
190       let pc,b1 = next pc in
191         JZ (`REL b1), pc, 2
192   | (false,false,false,true),(false,false,true,false) ->
193       let pc,b1 = next pc in
194       let pc,b2 = next pc in
195         LCALL (`ADDR16 (b1,b2)), pc, 2
196   | (false,false,false,false),(false,false,true,false) ->
197       let pc,b1 = next pc in
198       let pc,b2 = next pc in
199         LJMP (`ADDR16 (b1,b2)), pc, 2
200   | (true,true,true,false),(true,r1,r2,r3) ->
201         MOV (`U1 (`A, `REG(r1,r2,r3))), pc, 1
202   | (true,true,true,false),(false,true,false,true) ->
203       let pc,b1 = next pc in
204         MOV (`U1 (`A, `DIRECT b1)), pc, 1
205   | (true,true,true,false),(false,true,true,i1) ->
206         MOV (`U1 (`A, `INDIRECT i1)), pc, 1
207   | (false,true,true,true),(false,true,false,false) ->
208       let pc,b1 = next pc in
209         MOV (`U1 (`A, `DATA b1)), pc, 1
210   | (true,true,true,true),(true,r1,r2,r3) ->
211         MOV (`U2 (`REG(r1,r2,r3), `A)), pc, 1
212   | (true,false,true,false),(true,r1,r2,r3) ->
213       let pc,b1 = next pc in
214         MOV (`U2 (`REG(r1,r2,r3), (`DIRECT b1))), pc, 2
215   | (false,true,true,true),(true,r1,r2,r3) ->
216       let pc,b1 = next pc in
217         MOV (`U2 (`REG(r1,r2,r3), (`DATA b1))), pc, 1
218   | (true,true,true,true),(false,true,false,true) ->
219       let pc,b1 = next pc in
220         MOV (`U3 (`DIRECT b1, `A)), pc, 1
221   | (true,false,false,false),(true,r1,r2,r3) ->
222       let pc,b1 = next pc in
223         MOV (`U3 (`DIRECT b1, `REG(r1,r2,r3))), pc, 2
224   | (true,false,false,false),(false,true,false,true) ->
225       let pc,b1 = next pc in
226       let pc,b2 = next pc in
227         MOV (`U3 (`DIRECT b1, `DIRECT b2)), pc, 2
228   | (true,false,false,false),(false,true,true,i1) ->
229       let pc,b1 = next pc in
230         MOV (`U3 (`DIRECT b1, `INDIRECT i1)), pc, 2
231   | (false,true,true,true),(false,true,false,true) ->
232       let pc,b1 = next pc in
233       let pc,b2 = next pc in
234         MOV (`U3 (`DIRECT b1, `DATA b2)), pc, 2
235   | (true,true,true,true),(false,true,true,i1) ->
236         MOV (`U2 (`INDIRECT i1, `A)), pc, 1
237   | (true,false,true,false),(false,true,true,i1) ->
238       let pc,b1 = next pc in
239         MOV (`U2 (`INDIRECT i1, `DIRECT b1)), pc, 2
240   | (false,true,true,true),(false,true,true,i1) ->
241       let pc,b1 = next pc in
242         MOV (`U2 (`INDIRECT i1, `DATA b1)), pc, 1
243   | (true,false,true,false),(false,false,true,false) ->
244       let pc,b1 = next7 pc in
245         MOV (`U5 (`C, `BIT b1)), pc, 1
246   | (true,false,false,true),(false,false,true,false) ->
247       let pc,b1 = next7 pc in
248         MOV (`U6 (`BIT b1, `C)), pc, 2
249   | (true,false,false,true),(false,false,false,false) ->
250       let pc,b1 = next pc in
251       let pc,b2 = next pc in
252         MOV (`U4 (`DPTR, `DATA16(b1,b2))), pc, 2
253   | (true,false,false,true),(false,false,true,true) ->
254         MOVC (`A, `A_DPTR), pc, 2
255   | (true,false,false,false),(false,false,true,true) ->
256         MOVC (`A, `A_PC), pc, 2
257   | (true,true,true,false),(false,false,true,i1) ->
258         MOVX (`U1 (`A, `INDIRECT i1)), pc, 2
259   | (true,true,true,false),(false,false,false,false) ->
260         MOVX (`U1 (`A, `IND_DPTR)), pc, 2
261   | (true,true,true,true),(false,false,true,i1) ->
262         MOVX (`U2 (`INDIRECT i1, `A)), pc, 2
263   | (true,true,true,true),(false,false,false,false) ->
264         MOVX (`U2 (`IND_DPTR, `A)), pc, 2
265   | (true,false,true,false),(false,true,false,false) ->
266         MUL(`A, `B), pc, 4
267   | (false,false,false,false),(false,false,false,false) ->
268         NOP, pc, 1
269   | (false,true,false,false),(true,r1,r2,r3) ->
270         ORL (`U1(`A, `REG(r1,r2,r3))), pc, 1
271   | (false,true,false,false),(false,true,false,true) ->
272       let pc,b1 = next pc in
273         ORL (`U1(`A, `DIRECT b1)), pc, 1
274   | (false,true,false,false),(false,true,true,i1) ->
275         ORL (`U1(`A, `INDIRECT i1)), pc, 1
276   | (false,true,false,false),(false,true,false,false) ->
277       let pc,b1 = next pc in
278         ORL (`U1(`A, `DATA b1)), pc, 1
279   | (false,true,false,false),(false,false,true,false) ->
280       let pc,b1 = next pc in
281         ORL (`U2(`DIRECT b1, `A)), pc, 1
282   | (false,true,false,false),(false,false,true,true) ->
283       let pc,b1 = next pc in
284       let pc,b2 = next pc in
285         ORL (`U2 (`DIRECT b1, `DATA b2)), pc, 2
286   | (false,true,true,true),(false,false,true,false) ->
287       let pc,b1 = next7 pc in
288         ORL (`U3 (`C, `BIT b1)), pc, 2
289   | (true,false,true,false),(false,false,false,false) ->
290       let pc,b1 = next7 pc in
291         ORL (`U3 (`C, `NBIT b1)), pc, 2
292   | (true,true,false,true),(false,false,false,false) ->
293       let pc,b1 = next pc in
294         POP (`DIRECT b1), pc, 2
295   | (true,true,false,false),(false,false,false,false) ->
296       let pc,b1 = next pc in
297         PUSH (`DIRECT b1), pc, 2
298   | (false,false,true,false),(false,false,true,false) ->
299         RET, pc, 2
300   | (false,false,true,true),(false,false,true,false) ->
301         RETI, pc, 2
302   | (false,false,true,false),(false,false,true,true) ->
303         RL `A, pc, 1
304   | (false,false,true,true),(false,false,true,true) ->
305         RLC `A, pc, 1
306   | (false,false,false,false),(false,false,true,true) ->
307         RR `A, pc, 1
308   | (false,false,false,true),(false,false,true,true) ->
309         RRC `A, pc, 1
310   | (true,true,false,true),(false,false,true,true) ->
311         SETB `C, pc, 1
312   | (true,true,false,true),(false,false,true,false) ->
313       let pc,b1 = next7 pc in
314         SETB (`BIT b1), pc, 1
315   | (true,false,false,false),(false,false,false,false) ->
316       let pc,b1 = next pc in
317         SJMP (`REL b1), pc, 2
318   | (true,false,false,true),(false,true,false,true) ->
319       let pc,b1 = next pc in
320         SUBB (`A, `DIRECT b1), pc, 1
321   | (true,false,false,true),(false,true,true,i1) ->
322         SUBB (`A, `INDIRECT i1), pc, 1
323   | (true,false,false,true),(false,true,false,false) ->
324       let pc,b1 = next pc in
325         SUBB (`A, `DATA b1), pc, 1
326   | (true,true,false,false),(false,true,false,false) ->
327         SWAP `A, pc, 1
328   | (true,true,false,false),(true,r1,r2,r3) ->
329         XCH (`A, `REG(r1,r2,r3)), pc, 1
330   | (true,true,false,false),(false,true,false,true) ->
331       let pc,b1 = next pc in
332         XCH (`A, `DIRECT b1), pc, 1
333   | (true,true,false,false),(false,true,true,i1) ->
334         XCH (`A, `INDIRECT i1), pc, 1
335   | (true,true,false,true),(false,true,true,i1) ->
336         XCHD(`A, `INDIRECT i1), pc, 1
337   | (false,true,true,false),(true,r1,r2,r3) ->
338         XRL(`U1(`A, `REG(r1,r2,r3))), pc, 1
339   | (false,true,true,false),(false,true,false,true) ->
340       let pc,b1 = next pc in
341         XRL(`U1(`A, `DIRECT b1)), pc, 1
342   | (false,true,true,false),(false,true,true,i1) ->
343         XRL(`U1(`A, `INDIRECT i1)), pc, 1
344   | (false,true,true,false),(false,true,false,false) ->
345       let pc,b1 = next pc in
346         XRL(`U1(`A, `DATA b1)), pc, 1
347   | (false,true,true,false),(false,false,true,false) ->
348       let pc,b1 = next pc in
349         XRL(`U2(`DIRECT b1, `A)), pc, 1
350   | (false,true,true,false),(false,false,true,true) ->
351       let pc,b1 = next pc in
352       let pc,b2 = next pc in
353         XRL(`U2(`DIRECT b1, `DATA b2)), pc, 2
354 with
355  Not_found -> raise BOO
356;;
357
358let assembly1 =
359 function
360    ACALL (`ADDR11 (a10,a9,a8,b1)) ->
361     [(a10,a9,a8,true),(false,false,false,true); b1]
362  | ADD (`A,`REG (r1,r2,r3)) ->
363     [(false,false,true,false),(true,r1,r2,r3)]
364  | ADD (`A, `DIRECT b1) ->
365     [(false,false,true,false),(false,true,false,true); b1]
366  | ADD (`A, `INDIRECT i1) ->
367     [(false,false,true,false),(false,true,true,i1)]
368  | ADD (`A, `DATA b1) ->
369     [(false,false,true,false),(false,true,false,false); b1]
370  | ADDC (`A, `REG(r1,r2,r3)) ->
371     [(false,false,true,true),(true,r1,r2,r3)]
372  | ADDC (`A, `DIRECT b1) ->
373     [(false,false,true,true),(false,true,false,true); b1]
374  | ADDC (`A,`INDIRECT i1) ->
375     [(false,false,true,true),(false,true,true,i1)]
376  | ADDC (`A,`DATA b1) ->
377     [(false,false,true,true),(false,true,false,false); b1]
378  | AJMP (`ADDR11 (a10,a9,a8,b1)) ->
379     [(a10,a9,a8,false),(false,false,false,true)]
380  | ANL (`U1 (`A, `REG (r1,r2,r3))) ->
381     [(false,true,false,true),(true,r1,r2,r3)]
382  | ANL (`U1 (`A, `DIRECT b1)) ->
383     [(false,true,false,true),(false,true,false,true); b1]
384  | ANL (`U1 (`A, `INDIRECT i1)) ->
385     [(false,true,false,true),(false,true,true,i1)]
386  | ANL (`U1 (`A, `DATA b1)) ->
387     [(false,true,false,true),(false,true,false,false); b1]
388  | ANL (`U2 (`DIRECT b1,`A)) ->
389     [(false,true,false,true),(false,false,true,false); b1]
390  | ANL (`U2 (`DIRECT b1,`DATA b2)) ->
391     [(false,true,false,true),(false,false,true,true); b1; b2]
392  | ANL (`U3 (`C,`BIT b1)) ->
393     [(true,false,false,false),(false,false,true,false); byte_of_byte7 b1]
394  | ANL (`U3 (`C,`NBIT b1)) ->
395    [(true,false,true,true),(false,false,false,false); byte_of_byte7 b1]
396  | CJNE (`U1 (`A, `DIRECT b1), `REL b2) ->
397    [(true,false,true,true),(false,true,false,true); b1; b2]
398  | CJNE (`U1 (`A, `DATA b1), `REL b2) ->
399    [(true,false,true,true),(false,true,false,false); b1; b2]
400  | CJNE (`U2 (`REG(r1,r2,r3), `DATA b1), `REL b2) ->
401    [(true,false,true,true),(true,r1,r2,r3); b1; b2]
402  | CJNE (`U2 (`INDIRECT i1, `DATA b1), `REL b2) ->
403    [(true,false,true,true),(false,true,true,i1); b1; b2]
404  | CLR `A ->
405    [(true,true,true,false),(false,true,false,false)]
406  | CLR `C ->
407    [(true,true,false,false),(false,false,true,true)]
408  | CLR (`BIT b1) ->
409    [(true,true,false,false),(false,false,true,false); byte_of_byte7 b1]
410  | DA `A ->
411    [(true,true,false,true),(false,true,false,false)]
412  | DEC `A ->
413    [(false,false,false,true),(false,true,false,false)]
414  | DEC (`REG(r1,r2,r3)) ->
415    [(false,false,false,true),(true,r1,r2,r3)]
416  | DEC (`DIRECT b1) ->
417    [(false,false,false,true),(false,true,false,true); b1]
418  | DEC (`INDIRECT i1) ->
419    [(false,false,false,true),(false,true,true,i1)]
420  | DIV (`A, `B) ->
421    [(true,false,false,false),(false,true,false,false)]
422  | DJNZ (`REG(r1,r2,r3), `REL b1) ->
423    [(true,true,false,true),(true,r1,r2,r3); b1]
424  | DJNZ (`DIRECT b1, `REL b2) ->
425    [(true,true,false,true),(false,true,false,true); b1; b2]
426  | INC `A ->
427    [(false,false,false,false),(false,true,false,false)]
428  | INC (`REG(r1,r2,r3)) ->
429    [(false,false,false,false),(true,r1,r2,r3)]
430  | INC (`DIRECT b1) ->
431    [(false,false,false,false),(false,true,false,true); b1]
432  | INC (`INDIRECT i1) ->
433    [(false,false,false,false),(false,true,true,i1)]
434  | INC `DPTR ->
435    [(true,false,true,false),(false,false,true,true)]
436  | JB (`BIT b1, `REL b2) ->
437    [(false,false,true,false),(false,false,false,false); byte_of_byte7 b1; b2]
438  | JBC (`BIT b1, `REL b2) ->
439    [(false,false,false,true),(false,false,false,false); byte_of_byte7 b1; b2]
440  | JC (`REL b1) ->
441    [(false,true,false,false),(false,false,false,false); b1]
442  | JMP `IND_DPTR ->
443    [(false,true,true,true),(false,false,true,true)]
444  | JNB (`BIT b1, `REL b2) ->
445    [(false,false,true,true),(false,false,false,false); byte_of_byte7 b1; b2]
446  | JNC (`REL b1) ->
447    [(false,true,false,true),(false,false,false,false); b1]
448  | JNZ (`REL b1) ->
449    [(false,true,true,true),(false,false,false,false); b1]
450  | JZ (`REL b1) ->
451    [(false,true,true,false),(false,false,false,false); b1]
452  | LCALL (`ADDR16 (b1,b2)) ->
453    [(false,false,false,true),(false,false,true,false); b1; b2]
454  | LJMP (`ADDR16 (b1,b2)) ->
455    [(false,false,false,false),(false,false,true,false); b1; b2]
456  | MOV (`U1 (`A, `REG(r1,r2,r3))) ->
457    [(true,true,true,false),(true,r1,r2,r3)]
458  | MOV (`U1 (`A, `DIRECT b1)) ->
459    [(true,true,true,false),(false,true,false,true); b1]
460  | MOV (`U1 (`A, `INDIRECT i1)) ->
461    [(true,true,true,false),(false,true,true,i1)]
462  | MOV (`U1 (`A, `DATA b1)) ->
463    [(false,true,true,true),(false,true,false,false); b1]
464  | MOV (`U2 (`REG(r1,r2,r3), `A)) ->
465    [(true,true,true,true),(true,r1,r2,r3)]
466  | MOV (`U2 (`REG(r1,r2,r3), (`DIRECT b1))) ->
467    [(true,false,true,false),(true,r1,r2,r3); b1]
468  | MOV (`U2 (`REG(r1,r2,r3), (`DATA b1))) ->
469    [(false,true,true,true),(true,r1,r2,r3); b1]
470  | MOV (`U3 (`DIRECT b1, `A)) ->
471    [(true,true,true,true),(false,true,false,true); b1]
472  | MOV (`U3 (`DIRECT b1, `REG(r1,r2,r3))) ->
473    [(true,false,false,false),(true,r1,r2,r3); b1]
474  | MOV (`U3 (`DIRECT b1, `DIRECT b2)) ->
475    [(true,false,false,false),(false,true,false,true); b1; b2]
476  | MOV (`U3 (`DIRECT b1, `INDIRECT i1)) ->
477    [(true,false,false,false),(false,true,true,i1); b1]
478  | MOV (`U3 (`DIRECT b1, `DATA b2)) ->
479    [(false,true,true,true),(false,true,false,true); b1; b2]
480  | MOV (`U2 (`INDIRECT i1, `A)) ->
481    [(true,true,true,true),(false,true,true,i1)]
482  | MOV (`U2 (`INDIRECT i1, `DIRECT b1)) ->
483    [(true,false,true,false),(false,true,true,i1); b1]
484  | MOV (`U2 (`INDIRECT i1, `DATA b1)) ->
485    [(false,true,true,true),(false,true,true,i1); b1]
486  | MOV (`U5 (`C, `BIT b1)) ->
487    [(true,false,true,false),(false,false,true,false); byte_of_byte7 b1]
488  | MOV (`U6 (`BIT b1, `C)) ->
489    [(true,false,false,true),(false,false,true,false); byte_of_byte7 b1]
490  | MOV (`U4 (`DPTR, `DATA16(b1,b2))) ->
491    [(true,false,false,true),(false,false,false,false); b1; b2]
492  | MOVC (`A, `A_DPTR) ->
493    [(true,false,false,true),(false,false,true,true)]
494  | MOVC (`A, `A_PC) ->
495    [(true,false,false,false),(false,false,true,true)]
496  | MOVX (`U1 (`A, `INDIRECT i1)) ->
497    [(true,true,true,false),(false,false,true,i1)]
498  | MOVX (`U1 (`A, `IND_DPTR)) ->
499    [(true,true,true,false),(false,false,false,false)]
500  | MOVX (`U2 (`INDIRECT i1, `A)) ->
501    [(true,true,true,true),(false,false,true,i1)]
502  | MOVX (`U2 (`IND_DPTR, `A)) ->
503    [(true,true,true,true),(false,false,false,false)]
504  | MUL(`A, `B) ->
505    [(true,false,true,false),(false,true,false,false)]
506;;
507
508let address_of_register status (b1,b2,b3) =
509 let (_,_,rs1,rs0),_ = status.psw in
510 let base =
511  match rs1,rs0 with
512     false,false -> 0x00
513   | false,true  -> 0x08
514   | true,false  -> 0x10
515   | true,true   -> 0x18
516 in
517  byte7_of_int (base + int_of_nibble (false,b1,b2,b3))
518;;
519
520let fetch_register status reg =
521 let addr = address_of_register status reg in
522  Byte7Map.find addr status.low_internal_ram
523;;
524
525let set_register status v reg =
526 let addr = address_of_register status reg in
527  { status with low_internal_ram =
528     Byte7Map.add addr v status.low_internal_ram }
529;;
530
531let fetch_arg8 status = 
532 function
533    `DIRECT addr ->
534      (match addr with
535         (false,r1,r2,r3),n1 ->
536           Byte7Map.find (r1,r2,r3,n1) status.low_internal_ram
537       | (true,r1,r2,r3),n1 ->
538           (*CSC: SFR access, TO BE IMPLEMENTED *)
539           assert false)
540  | `INDIRECT b ->
541     let addr = fetch_register status (false,false,b) in
542     (match addr with 
543         (false,r1,r2,r3),n1 ->
544           Byte7Map.find (r1,r2,r3,n1) status.low_internal_ram
545       | (true,r1,r2,r3),n1 ->
546           Byte7Map.find (r1,r2,r3,n1) status.high_internal_ram)
547  | `REG (b1,b2,b3) ->
548      fetch_register status (b1,b2,b3)
549  | `A -> status.acc
550  | `B -> status.b
551  | `DATA b -> b
552  | `A_DPTR ->
553     let dpr = status.dph,status.dpl in
554     (* CSC: what is the right behaviour in case of overflow?
555        assert false for now. Try to understand what DEC really does *)
556     let addr = dpr ++ (int_of_byte status.acc) in
557      WordMap.find addr status.external_ram
558  | `A_PC ->
559     (* CSC: what is the right behaviour in case of overflow?
560        assert false for now *)
561     let addr = status.pc ++ (int_of_byte status.acc) in
562      WordMap.find addr status.external_ram
563  | `IND_DPTR ->
564     let dpr = status.dph,status.dpl in
565      WordMap.find dpr status.external_ram
566;;
567
568let set_arg8 status v =
569 function
570    `DIRECT addr ->
571      (match addr with
572         (false,r1,r2,r3),n1 ->
573           { status with low_internal_ram =
574              Byte7Map.add (r1,r2,r3,n1) v status.low_internal_ram }
575       | (true,r1,r2,r3),n1 ->
576           (*CSC: SFR access, TO BE IMPLEMENTED *)
577           (* assert false for now. Try to understand what DEC really does *)
578           assert false)
579  | `INDIRECT b ->
580     let addr = fetch_register status (false,false,b) in
581     (match addr with 
582         (false,r1,r2,r3),n1 ->
583           { status with low_internal_ram =
584              Byte7Map.add (r1,r2,r3,n1) v status.low_internal_ram }
585       | (true,r1,r2,r3),n1 ->
586           { status with high_internal_ram =
587              Byte7Map.add (r1,r2,r3,n1) v status.high_internal_ram })
588  | `REG (b1,b2,b3) ->
589      set_register status v (b1,b2,b3)
590  | `A -> { status with acc = v }
591  | `B -> { status with b = v }
592  | `IND_DPTR ->
593     let dpr = status.dph,status.dpl in
594      { status with external_ram =
595        WordMap.add dpr v status.external_ram }
596;;
597
598let set_flags status c ac ov =
599 { status with psw =
600    let (_c,oac,fo,rs1),(rs0,_ov,ud,p) = status.psw in
601    let ac = match ac with None -> oac | Some v -> v in
602     (c,ac,fo,rs1),(rs0,ov,ud,p)
603 }
604;;
605
606let execute1 status =
607 let instr,pc,ticks = fetch status.code_memory status.pc in
608 let status = { status with clock = status.clock + ticks; pc = pc } in
609  match instr with
610     ADD (`A,d1) ->
611      let v,c,ac,ov =
612       add8_with_c (fetch_arg8 status `A) (fetch_arg8 status d1) false
613      in
614       set_flags (set_arg8 status v `A) c (Some ac) ov
615   | ADDC (`A,d1) ->
616      let v,c,ac,ov =
617       add8_with_c (fetch_arg8 status `A) (fetch_arg8 status d1) (carr status)
618      in
619       set_flags (set_arg8 status v `A) c (Some ac) ov
620   | SUBB (`A,d1) ->
621      let v,c,ac,ov =
622       subb8_with_c (fetch_arg8 status `A) (fetch_arg8 status d1) (carr status)
623      in
624       set_flags (set_arg8 status v `A) c (Some ac) ov
625(*
626   | INC `DPTR -> assert false
627*)
628   | INC ((`A | `REG _ | `DIRECT _ | `INDIRECT _) as d) ->
629      let b = fetch_arg8 status d in
630      let res = inc b in
631       set_arg8 status res d
632   | DEC d ->
633      let b = fetch_arg8 status d in
634      let res = dec b in
635       set_arg8 status res d
636 | MUL (`A,`B) ->
637    let acc = int_of_byte status.acc in
638    let b = int_of_byte status.b in
639    let prod = acc * b in
640    let ov = prod > 255 in
641    let l = byte_of_int (prod mod 256) in
642    let h = byte_of_int (prod / 256) in
643    let status = { status with acc = l ; b = h } in
644     set_flags status false None ov
645 | DIV (`A,`B) ->
646    let acc = int_of_byte status.acc in
647    let b = int_of_byte status.b in
648     if b = 0 then
649      (* CSC: acc and b undefined! we leave them as they are... *)
650      set_flags status false None true
651     else
652      let q = byte_of_int (acc / b) in
653      let r = byte_of_int (acc mod b) in
654      let status = { status with acc = q ; b = r } in
655       set_flags status false None false
656(*
657 | DA  of acc
658
659 (* logical operations *)
660 | ANL of
661    (acc * [ reg | direct | indirect | data ],
662     direct * [ acc | data ],
663     carry * [ bit | nbit]) union3
664 | ORL of
665    (acc * [ reg | direct | indirect ],
666     direct * [ acc | data ],
667     carry * [ bit | nbit]) union3
668 | XRL of
669    (acc * [ reg | direct | indirect ],
670     direct * [ acc | data ]) union2
671 | CLR of [ acc | carry | bit ]
672 | CPL of [ acc | carry | bit ]
673 | RL of acc
674 | RLC of acc
675 | RR of acc
676 | RRC of acc
677 | SWAP of acc
678
679 (* data transfer *)
680 | MOV of
681    (acc * [ reg | direct | indirect | data ],
682     [ reg | indirect ] * [ acc | direct | data ],
683     direct * [ acc | reg | direct | indirect | data ],
684     dptr * data16,
685     carry * bit,
686     bit * carry
687     ) union6
688 | MOVC of acc * [ acc_dptr | acc_pc ]
689 | MOVX of (acc * [ indirect | indirect_dptr ],
690            [ indirect | indirect_dptr ] * acc) union2
691 | SETB of [ carry | bit ]
692 | PUSH of direct
693 | POP of direct
694 | XCH of acc * [ reg | direct | indirect ]
695 | XCHD of acc * indirect
696
697 (* program branching *)
698 | JC of rel
699 | JNC of rel
700 | JB of rel
701 | JNB of rel
702 | JBC of bit * rel
703 | ACALL of addr11
704 | LCALL of addr16
705 | RET
706 | RETI
707 | AJMP of addr11
708 | LJMP of addr16
709 | SJMP of rel
710 | JMP of indirect_dptr
711 | JZ of rel
712 | JNZ of rel
713 | CJNE of (acc * [ direct | data ], [ reg | indirect ] * data) union2 * rel
714 | DJNZ of [ reg | direct ] * rel
715 | NOP
716*)
717;;
Note: See TracBrowser for help on using the repository browser.