Bug fix: check if vm exists
[avr-sim.git] / Decoder.cpp
blob8caf298159dd6dac449ae87ac11baca8180092c9
1 #include "Decoder.h"
2 #include "Instructions.h"
3 #include "DecoderHelp.h"
5 namespace avr {
7 std::vector<Instruction *> Decoder::lut;
9 Decoder::Decoder() {
10 if( lut.size() == 0 ) {
11 const unsigned int num_ops = 0x10000;
12 lut.resize( num_ops );
13 for(unsigned int i = 0; i < num_ops; i++) {
14 lut[i] = lookupOpcode(i);
19 bool Decoder::is2WordInstruction( word opcode ) const {
20 return lut[opcode]->is2Word();
23 Instruction * Decoder::lookupOpcode( word opcode ) {
24 int decode;
26 switch( opcode ) {
27 /* opcodes with no operands */
28 case 0x9519: return new op::EICALL(opcode); /* 1001 0101 0001 1001 | EICALL */
29 case 0x9419: return new op::EIJMP(opcode); /* 1001 0100 0001 1001 | EIJMP */
30 case 0x95D8: return new op::ELPM(opcode); /* 1001 0101 1101 1000 | ELPM */
31 case 0x95F8: return new op::ESPM(opcode); /* 1001 0101 1111 1000 | ESPM */
32 case 0x9509: return new op::ICALL(opcode); /* 1001 0101 0000 1001 | ICALL */
33 case 0x9409: return new op::IJMP(opcode); /* 1001 0100 0000 1001 | IJMP */
34 case 0x95C8: return new op::LPM(opcode); /* 1001 0101 1100 1000 | LPM */
35 case 0x0000: return new op::NOP(opcode); /* 0000 0000 0000 0000 | NOP */
36 case 0x9508: return new op::RET(opcode); /* 1001 0101 0000 1000 | RET */
37 case 0x9518: return new op::RETI(opcode); /* 1001 0101 0001 1000 | RETI */
38 case 0x9588: return new op::SLEEP(opcode); /* 1001 0101 1000 1000 | SLEEP */
39 case 0x95E8: return new op::SPM(opcode); /* 1001 0101 1110 1000 | SPM */
40 case 0x95A8: return new op::WDR(opcode); /* 1001 0101 1010 1000 | WDR */
41 case 0x9598: return new op::BREAK(opcode); /* 1001 0101 1001 1000 | BREAK */
42 default: {
43 /* opcodes with two 5-bit register (Rd and Rr) operands */
44 decode = opcode & ~(mask_Rd_5 | mask_Rr_5);
45 switch ( decode ) {
46 case 0x1C00: return new op::ADC(opcode); /* 0001 11rd dddd rrrr | ADC or ROL */
48 case 0x0C00: return new op::ADD(opcode); /* 0000 11rd dddd rrrr | ADD or LSL */
49 case 0x2000: return new op::AND(opcode); /* 0010 00rd dddd rrrr | AND or TST */
50 case 0x1400: return new op::CP(opcode); /* 0001 01rd dddd rrrr | CP */
51 case 0x0400: return new op::CPC(opcode); /* 0000 01rd dddd rrrr | CPC */
52 case 0x1000: return new op::CPSE(opcode); /* 0001 00rd dddd rrrr | CPSE */
53 case 0x2400: return new op::EOR(opcode); /* 0010 01rd dddd rrrr | EOR or CLR */
54 case 0x2C00: return new op::MOV(opcode); /* 0010 11rd dddd rrrr | MOV */
55 case 0x9C00: return new op::MUL(opcode); /* 1001 11rd dddd rrrr | MUL */
56 case 0x2800: return new op::OR(opcode); /* 0010 10rd dddd rrrr | OR */
57 case 0x0800: return new op::SBC(opcode); /* 0000 10rd dddd rrrr | SBC */
58 case 0x1800: return new op::SUB(opcode); /* 0001 10rd dddd rrrr | SUB */
61 /* opcode with a single register (Rd) as operand */
62 decode = opcode & ~(mask_Rd_5);
63 switch (decode) {
64 case 0x9405: return new op::ASR(opcode); /* 1001 010d dddd 0101 | ASR */
65 case 0x9400: return new op::COM(opcode); /* 1001 010d dddd 0000 | COM */
66 case 0x940A: return new op::DEC(opcode); /* 1001 010d dddd 1010 | DEC */
67 case 0x9006: return new op::ELPM_Z(opcode); /* 1001 000d dddd 0110 | ELPM */
68 case 0x9007: return new op::ELPM_Z_incr(opcode); /* 1001 000d dddd 0111 | ELPM */
69 case 0x9403: return new op::INC(opcode); /* 1001 010d dddd 0011 | INC */
70 case 0x9000: return new op::LDS(opcode); /* 1001 000d dddd 0000 | LDS */
71 case 0x900C: return new op::LD_X(opcode); /* 1001 000d dddd 1100 | LD */
72 case 0x900E: return new op::LD_X_decr(opcode); /* 1001 000d dddd 1110 | LD */
73 case 0x900D: return new op::LD_X_incr(opcode); /* 1001 000d dddd 1101 | LD */
74 case 0x900A: return new op::LD_Y_decr(opcode); /* 1001 000d dddd 1010 | LD */
75 case 0x9009: return new op::LD_Y_incr(opcode); /* 1001 000d dddd 1001 | LD */
76 case 0x9002: return new op::LD_Z_decr(opcode); /* 1001 000d dddd 0010 | LD */
77 case 0x9001: return new op::LD_Z_incr(opcode); /* 1001 000d dddd 0001 | LD */
78 case 0x9004: return new op::LPM_Z(opcode); /* 1001 000d dddd 0100 | LPM */
79 case 0x9005: return new op::LPM_Z_incr(opcode); /* 1001 000d dddd 0101 | LPM */
80 case 0x9406: return new op::LSR(opcode); /* 1001 010d dddd 0110 | LSR */
81 case 0x9401: return new op::NEG(opcode); /* 1001 010d dddd 0001 | NEG */
82 case 0x900F: return new op::POP(opcode); /* 1001 000d dddd 1111 | POP */
83 case 0x920F: return new op::PUSH(opcode); /* 1001 001d dddd 1111 | PUSH */
84 case 0x9407: return new op::ROR(opcode); /* 1001 010d dddd 0111 | ROR */
85 case 0x9200: return new op::STS(opcode); /* 1001 001d dddd 0000 | STS */
86 case 0x920C: return new op::ST_X(opcode); /* 1001 001d dddd 1100 | ST */
87 case 0x920E: return new op::ST_X_decr(opcode); /* 1001 001d dddd 1110 | ST */
88 case 0x920D: return new op::ST_X_incr(opcode); /* 1001 001d dddd 1101 | ST */
89 case 0x920A: return new op::ST_Y_decr(opcode); /* 1001 001d dddd 1010 | ST */
90 case 0x9209: return new op::ST_Y_incr(opcode); /* 1001 001d dddd 1001 | ST */
91 case 0x9202: return new op::ST_Z_decr(opcode); /* 1001 001d dddd 0010 | ST */
92 case 0x9201: return new op::ST_Z_incr(opcode); /* 1001 001d dddd 0001 | ST */
93 case 0x9402: return new op::SWAP(opcode); /* 1001 010d dddd 0010 | SWAP */
96 /* opcodes with a register (Rd) and a constant data (K) as operands */
97 decode = opcode & ~(mask_Rd_4 | mask_K_8);
98 switch ( decode ) {
99 case 0x7000: return new op::ANDI(opcode); /* 0111 KKKK dddd KKKK | CBR or ANDI */
100 case 0x3000: return new op::CPI(opcode); /* 0011 KKKK dddd KKKK | CPI */
101 case 0xE000: return new op::LDI(opcode); /* 1110 KKKK dddd KKKK | LDI or SER */
102 case 0x6000: return new op::ORI(opcode); /* 0110 KKKK dddd KKKK | SBR or ORI */
103 case 0x4000: return new op::SBCI(opcode); /* 0100 KKKK dddd KKKK | SBCI */
104 case 0x5000: return new op::SUBI(opcode); /* 0101 KKKK dddd KKKK | SUBI */
107 /* opcodes with a register (Rd) and a register bit number (b) as operands */
108 decode = opcode & ~(mask_Rd_5 | mask_reg_bit);
109 switch ( decode ) {
110 case 0xF800: return new op::BLD(opcode); /* 1111 100d dddd 0bbb | BLD */
111 case 0xFA00: return new op::BST(opcode); /* 1111 101d dddd 0bbb | BST */
112 case 0xFC00: return new op::SBRC(opcode); /* 1111 110d dddd 0bbb | SBRC */
113 case 0xFE00: return new op::SBRS(opcode); /* 1111 111d dddd 0bbb | SBRS */
116 /* opcodes with a relative 7-bit address (k) and a register bit number (b) as operands */
117 decode = opcode & ~(mask_k_7 | mask_reg_bit);
118 switch ( decode ) {
119 case 0xF400: return new op::BRBC(opcode); /* 1111 01kk kkkk kbbb | BRBC */
120 case 0xF000: return new op::BRBS(opcode); /* 1111 00kk kkkk kbbb | BRBS */
123 /* opcodes with a 6-bit address displacement (q) and a register (Rd) as operands */
124 decode = opcode & ~(mask_Rd_5 | mask_q_displ);
125 switch ( decode ) {
126 case 0x8008: return new op::LDD_Y(opcode); /* 10q0 qq0d dddd 1qqq | LDD */
127 case 0x8000: return new op::LDD_Z(opcode); /* 10q0 qq0d dddd 0qqq | LDD */
128 case 0x8208: return new op::STD_Y(opcode); /* 10q0 qq1d dddd 1qqq | STD */
129 case 0x8200: return new op::STD_Z(opcode); /* 10q0 qq1d dddd 0qqq | STD */
132 /* opcodes with a absolute 22-bit address (k) operand */
133 decode = opcode & ~(mask_k_22);
134 switch ( decode ) {
135 case 0x940E: return new op::CALL(opcode); /* 1001 010k kkkk 111k | CALL */
136 case 0x940C: return new op::JMP(opcode); /* 1001 010k kkkk 110k | JMP */
139 /* opcode with a sreg bit select (s) operand */
140 decode = opcode & ~(mask_sreg_bit);
141 switch ( decode ) {
142 /* BCLR takes place of CL{C,Z,N,V,S,H,T,I} */
143 /* BSET takes place of SE{C,Z,N,V,S,H,T,I} */
144 case 0x9488: return new op::BCLR(opcode); /* 1001 0100 1sss 1000 | BCLR */
145 case 0x9408: return new op::BSET(opcode); /* 1001 0100 0sss 1000 | BSET */
148 /* opcodes with a 6-bit constant (K) and a register (Rd) as operands */
149 decode = opcode & ~(mask_K_6 | mask_Rd_2);
150 switch ( decode ) {
151 case 0x9600: return new op::ADIW(opcode); /* 1001 0110 KKdd KKKK | ADIW */
152 case 0x9700: return new op::SBIW(opcode); /* 1001 0111 KKdd KKKK | SBIW */
155 /* opcodes with a 5-bit IO Addr (A) and register bit number (b) as operands */
156 decode = opcode & ~(mask_A_5 | mask_reg_bit);
157 switch ( decode ) {
158 case 0x9800: return new op::CBI(opcode); /* 1001 1000 AAAA Abbb | CBI */
159 case 0x9A00: return new op::SBI(opcode); /* 1001 1010 AAAA Abbb | SBI */
160 case 0x9900: return new op::SBIC(opcode); /* 1001 1001 AAAA Abbb | SBIC */
161 case 0x9B00: return new op::SBIS(opcode); /* 1001 1011 AAAA Abbb | SBIS */
164 /* opcodes with a 6-bit IO Addr (A) and register (Rd) as operands */
165 decode = opcode & ~(mask_A_6 | mask_Rd_5);
166 switch ( decode ) {
167 case 0xB000: return new op::IN(opcode); /* 1011 0AAd dddd AAAA | IN */
168 case 0xB800: return new op::OUT(opcode); /* 1011 1AAd dddd AAAA | OUT */
171 /* opcodes with a relative 12-bit address (k) operand */
172 decode = opcode & ~(mask_k_12);
173 switch ( decode ) {
174 case 0xD000: return new op::RCALL(opcode); /* 1101 kkkk kkkk kkkk | RCALL */
175 case 0xC000: return new op::RJMP(opcode); /* 1100 kkkk kkkk kkkk | RJMP */
178 /* opcodes with two 4-bit register (Rd and Rr) operands */
179 decode = opcode & ~(mask_Rd_4 | mask_Rr_4);
180 switch ( decode ) {
181 case 0x0100: return new op::MOVW(opcode); /* 0000 0001 dddd rrrr | MOVW */
182 case 0x0200: return new op::MULS(opcode); /* 0000 0010 dddd rrrr | MULS */
185 /* opcodes with two 3-bit register (Rd and Rr) operands */
186 decode = opcode & ~(mask_Rd_3 | mask_Rr_3);
187 switch ( decode ) {
188 case 0x0300: return new op::MULSU(opcode); /* 0000 0011 0ddd 0rrr | MULSU */
189 case 0x0308: return new op::FMUL(opcode); /* 0000 0011 0ddd 1rrr | FMUL */
190 case 0x0380: return new op::FMULS(opcode); /* 0000 0011 1ddd 0rrr | FMULS */
191 case 0x0388: return new op::FMULSU(opcode); /* 0000 0011 1ddd 1rrr | FMULSU */
194 } /* default */
195 } /* first switch */
197 //return NULL;
198 return new op::ILLEGAL(opcode);