Commit | Line | Data |
---|---|---|
53487a7b ILT |
1 | /* Disassembly routines for TMS320C30 architecture |
2 | Copyright (C) 1998 Free Software Foundation, Inc. | |
3 | Contributed by Steven Haworth (steve@pm.cse.rmit.edu.au) | |
4 | ||
5 | This program is free software; you can redistribute it and/or modify | |
6 | it under the terms of the GNU General Public License as published by | |
7 | the Free Software Foundation; either version 2 of the License, or | |
8 | (at your option) any later version. | |
9 | ||
10 | This program is distributed in the hope that it will be useful, | |
11 | but WITHOUT ANY WARRANTY; without even the implied warranty of | |
12 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
13 | GNU General Public License for more details. | |
14 | ||
15 | You should have received a copy of the GNU General Public License | |
16 | along with this program; if not, write to the Free Software | |
17 | Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA | |
18 | 02111-1307, USA. */ | |
19 | ||
20 | #include <errno.h> | |
21 | #include <math.h> | |
22 | #include <stdlib.h> | |
23 | #include <string.h> | |
24 | #include "dis-asm.h" | |
25 | #include "opcode/tic30.h" | |
26 | ||
27 | #define NORMAL_INSN 1 | |
28 | #define PARALLEL_INSN 2 | |
29 | ||
30 | /* Gets the type of instruction based on the top 2 or 3 bits of the | |
31 | instruction word. */ | |
32 | #define GET_TYPE(insn) (insn & 0x80000000 ? insn & 0xC0000000 : insn & 0xE0000000) | |
33 | ||
34 | /* Instruction types. */ | |
35 | #define TWO_OPERAND_1 0x00000000 | |
36 | #define TWO_OPERAND_2 0x40000000 | |
37 | #define THREE_OPERAND 0x20000000 | |
38 | #define PAR_STORE 0xC0000000 | |
39 | #define MUL_ADDS 0x80000000 | |
40 | #define BRANCHES 0x60000000 | |
41 | ||
42 | /* Specific instruction id bits. */ | |
43 | #define NORMAL_IDEN 0x1F800000 | |
44 | #define PAR_STORE_IDEN 0x3E000000 | |
45 | #define MUL_ADD_IDEN 0x2C000000 | |
46 | #define BR_IMM_IDEN 0x1F000000 | |
47 | #define BR_COND_IDEN 0x1C3F0000 | |
48 | ||
49 | /* Addressing modes. */ | |
50 | #define AM_REGISTER 0x00000000 | |
51 | #define AM_DIRECT 0x00200000 | |
52 | #define AM_INDIRECT 0x00400000 | |
53 | #define AM_IMM 0x00600000 | |
54 | ||
55 | #define P_FIELD 0x03000000 | |
56 | ||
57 | #define REG_AR0 0x08 | |
58 | #define LDP_INSN 0x08700000 | |
59 | ||
60 | /* TMS320C30 program counter for current instruction. */ | |
61 | static unsigned int _pc; | |
62 | ||
63 | struct instruction | |
64 | { | |
65 | int type; | |
66 | template *tm; | |
67 | partemplate *ptm; | |
68 | }; | |
69 | ||
70 | int get_tic30_instruction PARAMS ((unsigned long, struct instruction *)); | |
71 | int print_two_operand | |
72 | PARAMS ((disassemble_info *, unsigned long, struct instruction *)); | |
73 | int print_three_operand | |
74 | PARAMS ((disassemble_info *, unsigned long, struct instruction *)); | |
75 | int print_par_insn | |
76 | PARAMS ((disassemble_info *, unsigned long, struct instruction *)); | |
77 | int print_branch | |
78 | PARAMS ((disassemble_info *, unsigned long, struct instruction *)); | |
79 | int get_indirect_operand PARAMS ((unsigned short, int, char *)); | |
80 | int get_register_operand PARAMS ((unsigned char, char *)); | |
81 | int cnvt_tmsfloat_ieee PARAMS ((unsigned long, int, float *)); | |
82 | ||
83 | int | |
84 | print_insn_tic30 (pc, info) | |
85 | bfd_vma pc; | |
86 | disassemble_info *info; | |
87 | { | |
88 | unsigned long insn_word; | |
89 | struct instruction insn = | |
90 | {0, NULL, NULL}; | |
91 | bfd_vma bufaddr = pc - info->buffer_vma; | |
92 | /* Obtain the current instruction word from the buffer. */ | |
93 | insn_word = (*(info->buffer + bufaddr) << 24) | (*(info->buffer + bufaddr + 1) << 16) | | |
94 | (*(info->buffer + bufaddr + 2) << 8) | *(info->buffer + bufaddr + 3); | |
95 | _pc = pc / 4; | |
96 | /* Get the instruction refered to by the current instruction word | |
97 | and print it out based on its type. */ | |
98 | if (!get_tic30_instruction (insn_word, &insn)) | |
99 | return -1; | |
100 | switch (GET_TYPE (insn_word)) | |
101 | { | |
102 | case TWO_OPERAND_1: | |
103 | case TWO_OPERAND_2: | |
104 | if (!print_two_operand (info, insn_word, &insn)) | |
105 | return -1; | |
106 | break; | |
107 | case THREE_OPERAND: | |
108 | if (!print_three_operand (info, insn_word, &insn)) | |
109 | return -1; | |
110 | break; | |
111 | case PAR_STORE: | |
112 | case MUL_ADDS: | |
113 | if (!print_par_insn (info, insn_word, &insn)) | |
114 | return -1; | |
115 | break; | |
116 | case BRANCHES: | |
117 | if (!print_branch (info, insn_word, &insn)) | |
118 | return -1; | |
119 | break; | |
120 | } | |
121 | return 4; | |
122 | } | |
123 | ||
124 | int | |
125 | get_tic30_instruction (insn_word, insn) | |
126 | unsigned long insn_word; | |
127 | struct instruction *insn; | |
128 | { | |
129 | switch (GET_TYPE (insn_word)) | |
130 | { | |
131 | case TWO_OPERAND_1: | |
132 | case TWO_OPERAND_2: | |
133 | case THREE_OPERAND: | |
134 | insn->type = NORMAL_INSN; | |
135 | { | |
136 | template *current_optab = (template *) tic30_optab; | |
137 | for (; current_optab < tic30_optab_end; current_optab++) | |
138 | { | |
139 | if (GET_TYPE (current_optab->base_opcode) == GET_TYPE (insn_word)) | |
140 | { | |
141 | if (current_optab->operands == 0) | |
142 | { | |
143 | if (current_optab->base_opcode == insn_word) | |
144 | { | |
145 | insn->tm = current_optab; | |
146 | break; | |
147 | } | |
148 | } | |
149 | else if ((current_optab->base_opcode & NORMAL_IDEN) == (insn_word & NORMAL_IDEN)) | |
150 | { | |
151 | insn->tm = current_optab; | |
152 | break; | |
153 | } | |
154 | } | |
155 | } | |
156 | } | |
157 | break; | |
158 | case PAR_STORE: | |
159 | insn->type = PARALLEL_INSN; | |
160 | { | |
161 | partemplate *current_optab = (partemplate *) tic30_paroptab; | |
162 | for (; current_optab < tic30_paroptab_end; current_optab++) | |
163 | { | |
164 | if (GET_TYPE (current_optab->base_opcode) == GET_TYPE (insn_word)) | |
165 | { | |
166 | if ((current_optab->base_opcode & PAR_STORE_IDEN) == (insn_word & PAR_STORE_IDEN)) | |
167 | { | |
168 | insn->ptm = current_optab; | |
169 | break; | |
170 | } | |
171 | } | |
172 | } | |
173 | } | |
174 | break; | |
175 | case MUL_ADDS: | |
176 | insn->type = PARALLEL_INSN; | |
177 | { | |
178 | partemplate *current_optab = (partemplate *) tic30_paroptab; | |
179 | for (; current_optab < tic30_paroptab_end; current_optab++) | |
180 | { | |
181 | if (GET_TYPE (current_optab->base_opcode) == GET_TYPE (insn_word)) | |
182 | { | |
183 | if ((current_optab->base_opcode & MUL_ADD_IDEN) == (insn_word & MUL_ADD_IDEN)) | |
184 | { | |
185 | insn->ptm = current_optab; | |
186 | break; | |
187 | } | |
188 | } | |
189 | } | |
190 | } | |
191 | break; | |
192 | case BRANCHES: | |
193 | insn->type = NORMAL_INSN; | |
194 | { | |
195 | template *current_optab = (template *) tic30_optab; | |
196 | for (; current_optab < tic30_optab_end; current_optab++) | |
197 | { | |
198 | if (GET_TYPE (current_optab->base_opcode) == GET_TYPE (insn_word)) | |
199 | { | |
200 | if (current_optab->operand_types[0] & Imm24) | |
201 | { | |
202 | if ((current_optab->base_opcode & BR_IMM_IDEN) == (insn_word & BR_IMM_IDEN)) | |
203 | { | |
204 | insn->tm = current_optab; | |
205 | break; | |
206 | } | |
207 | } | |
208 | else if (current_optab->operands > 0) | |
209 | { | |
210 | if ((current_optab->base_opcode & BR_COND_IDEN) == (insn_word & BR_COND_IDEN)) | |
211 | { | |
212 | insn->tm = current_optab; | |
213 | break; | |
214 | } | |
215 | } | |
216 | else | |
217 | { | |
218 | if ((current_optab->base_opcode & (BR_COND_IDEN | 0x00800000)) == (insn_word & (BR_COND_IDEN | 0x00800000))) | |
219 | { | |
220 | insn->tm = current_optab; | |
221 | break; | |
222 | } | |
223 | } | |
224 | } | |
225 | } | |
226 | } | |
227 | break; | |
228 | default: | |
229 | return 0; | |
230 | } | |
231 | return 1; | |
232 | } | |
233 | ||
234 | int | |
235 | print_two_operand (info, insn_word, insn) | |
236 | disassemble_info *info; | |
237 | unsigned long insn_word; | |
238 | struct instruction *insn; | |
239 | { | |
240 | char name[12]; | |
241 | char operand[2][13] = | |
242 | { | |
243 | {0}, | |
244 | {0}}; | |
245 | float f_number; | |
246 | ||
247 | if (insn->tm == NULL) | |
248 | return 0; | |
249 | strcpy (name, insn->tm->name); | |
250 | if (insn->tm->opcode_modifier == AddressMode) | |
251 | { | |
252 | int src_op, dest_op; | |
253 | /* Determine whether instruction is a store or a normal instruction. */ | |
254 | if ((insn->tm->operand_types[1] & (Direct | Indirect)) == (Direct | Indirect)) | |
255 | { | |
256 | src_op = 1; | |
257 | dest_op = 0; | |
258 | } | |
259 | else | |
260 | { | |
261 | src_op = 0; | |
262 | dest_op = 1; | |
263 | } | |
264 | /* Get the destination register. */ | |
265 | if (insn->tm->operands == 2) | |
266 | get_register_operand ((insn_word & 0x001F0000) >> 16, operand[dest_op]); | |
267 | /* Get the source operand based on addressing mode. */ | |
268 | switch (insn_word & AddressMode) | |
269 | { | |
270 | case AM_REGISTER: | |
271 | /* Check for the NOP instruction before getting the operand. */ | |
272 | if ((insn->tm->operand_types[0] & NotReq) == 0) | |
273 | get_register_operand ((insn_word & 0x0000001F), operand[src_op]); | |
274 | break; | |
275 | case AM_DIRECT: | |
276 | sprintf (operand[src_op], "@0x%lX", (insn_word & 0x0000FFFF)); | |
277 | break; | |
278 | case AM_INDIRECT: | |
279 | get_indirect_operand ((insn_word & 0x0000FFFF), 2, operand[src_op]); | |
280 | break; | |
281 | case AM_IMM: | |
282 | /* Get the value of the immediate operand based on variable type. */ | |
283 | switch (insn->tm->imm_arg_type) | |
284 | { | |
285 | case Imm_Float: | |
286 | cnvt_tmsfloat_ieee ((insn_word & 0x0000FFFF), 2, &f_number); | |
287 | sprintf (operand[src_op], "%2.2f", f_number); | |
288 | break; | |
289 | case Imm_SInt: | |
290 | sprintf (operand[src_op], "%d", (short) (insn_word & 0x0000FFFF)); | |
291 | break; | |
292 | case Imm_UInt: | |
293 | sprintf (operand[src_op], "%lu", (insn_word & 0x0000FFFF)); | |
294 | break; | |
295 | default: | |
296 | return 0; | |
297 | } | |
298 | /* Handle special case for LDP instruction. */ | |
299 | if ((insn_word & 0xFFFFFF00) == LDP_INSN) | |
300 | { | |
301 | strcpy (name, "ldp"); | |
302 | sprintf (operand[0], "0x%06lX", (insn_word & 0x000000FF) << 16); | |
303 | operand[1][0] = '\0'; | |
304 | } | |
305 | } | |
306 | } | |
307 | /* Handle case for stack and rotate instructions. */ | |
308 | else if (insn->tm->operands == 1) | |
309 | { | |
310 | if (insn->tm->opcode_modifier == StackOp) | |
311 | { | |
312 | get_register_operand ((insn_word & 0x001F0000) >> 16, operand[0]); | |
313 | } | |
314 | } | |
315 | /* Output instruction to stream. */ | |
316 | info->fprintf_func (info->stream, " %s %s%c%s", name, | |
317 | operand[0][0] ? operand[0] : "", | |
318 | operand[1][0] ? ',' : ' ', | |
319 | operand[1][0] ? operand[1] : ""); | |
320 | return 1; | |
321 | } | |
322 | ||
323 | int | |
324 | print_three_operand (info, insn_word, insn) | |
325 | disassemble_info *info; | |
326 | unsigned long insn_word; | |
327 | struct instruction *insn; | |
328 | { | |
329 | char operand[3][13] = | |
330 | { | |
331 | {0}, | |
332 | {0}, | |
333 | {0}}; | |
334 | ||
335 | if (insn->tm == NULL) | |
336 | return 0; | |
337 | switch (insn_word & AddressMode) | |
338 | { | |
339 | case AM_REGISTER: | |
340 | get_register_operand ((insn_word & 0x000000FF), operand[0]); | |
341 | get_register_operand ((insn_word & 0x0000FF00) >> 8, operand[1]); | |
342 | break; | |
343 | case AM_DIRECT: | |
344 | get_register_operand ((insn_word & 0x000000FF), operand[0]); | |
345 | get_indirect_operand ((insn_word & 0x0000FF00) >> 8, 1, operand[1]); | |
346 | break; | |
347 | case AM_INDIRECT: | |
348 | get_indirect_operand ((insn_word & 0x000000FF), 1, operand[0]); | |
349 | get_register_operand ((insn_word & 0x0000FF00) >> 8, operand[1]); | |
350 | break; | |
351 | case AM_IMM: | |
352 | get_indirect_operand ((insn_word & 0x000000FF), 1, operand[0]); | |
353 | get_indirect_operand ((insn_word & 0x0000FF00) >> 8, 1, operand[1]); | |
354 | break; | |
355 | default: | |
356 | return 0; | |
357 | } | |
358 | if (insn->tm->operands == 3) | |
359 | get_register_operand ((insn_word & 0x001F0000) >> 16, operand[2]); | |
360 | info->fprintf_func (info->stream, " %s %s,%s%c%s", insn->tm->name, | |
361 | operand[0], operand[1], | |
362 | operand[2][0] ? ',' : ' ', | |
363 | operand[2][0] ? operand[2] : ""); | |
364 | return 1; | |
365 | } | |
366 | ||
367 | int | |
368 | print_par_insn (info, insn_word, insn) | |
369 | disassemble_info *info; | |
370 | unsigned long insn_word; | |
371 | struct instruction *insn; | |
372 | { | |
373 | int i; | |
374 | char *name1, *name2; | |
375 | char operand[2][3][13] = | |
376 | { | |
377 | { | |
378 | {0}, | |
379 | {0}, | |
380 | {0}}, | |
381 | { | |
382 | {0}, | |
383 | {0}, | |
384 | {0}}}; | |
385 | ||
386 | if (insn->ptm == NULL) | |
387 | return 0; | |
388 | /* Parse out the names of each of the parallel instructions from the | |
389 | q_insn1_insn2 format. */ | |
390 | name1 = (char *) strdup (insn->ptm->name + 2); | |
391 | for (i = 0; i < strlen (name1); i++) | |
392 | { | |
393 | if (name1[i] == '_') | |
394 | { | |
395 | name2 = &name1[i + 1]; | |
396 | name1[i] = '\0'; | |
397 | break; | |
398 | } | |
399 | } | |
400 | /* Get the operands of the instruction based on the operand order. */ | |
401 | switch (insn->ptm->oporder) | |
402 | { | |
403 | case OO_4op1: | |
404 | get_indirect_operand ((insn_word & 0x000000FF), 1, operand[0][0]); | |
405 | get_indirect_operand ((insn_word & 0x0000FF00) >> 8, 1, operand[1][1]); | |
406 | get_register_operand ((insn_word >> 16) & 0x07, operand[1][0]); | |
407 | get_register_operand ((insn_word >> 22) & 0x07, operand[0][1]); | |
408 | break; | |
409 | case OO_4op2: | |
410 | get_indirect_operand ((insn_word & 0x000000FF), 1, operand[0][0]); | |
411 | get_indirect_operand ((insn_word & 0x0000FF00) >> 8, 1, operand[1][0]); | |
412 | get_register_operand ((insn_word >> 19) & 0x07, operand[1][1]); | |
413 | get_register_operand ((insn_word >> 22) & 0x07, operand[0][1]); | |
414 | break; | |
415 | case OO_4op3: | |
416 | get_indirect_operand ((insn_word & 0x000000FF), 1, operand[0][1]); | |
417 | get_indirect_operand ((insn_word & 0x0000FF00) >> 8, 1, operand[1][1]); | |
418 | get_register_operand ((insn_word >> 16) & 0x07, operand[1][0]); | |
419 | get_register_operand ((insn_word >> 22) & 0x07, operand[0][0]); | |
420 | break; | |
421 | case OO_5op1: | |
422 | get_indirect_operand ((insn_word & 0x000000FF), 1, operand[0][0]); | |
423 | get_indirect_operand ((insn_word & 0x0000FF00) >> 8, 1, operand[1][1]); | |
424 | get_register_operand ((insn_word >> 16) & 0x07, operand[1][0]); | |
425 | get_register_operand ((insn_word >> 19) & 0x07, operand[0][1]); | |
426 | get_register_operand ((insn_word >> 22) & 0x07, operand[0][2]); | |
427 | break; | |
428 | case OO_5op2: | |
429 | get_indirect_operand ((insn_word & 0x000000FF), 1, operand[0][1]); | |
430 | get_indirect_operand ((insn_word & 0x0000FF00) >> 8, 1, operand[1][1]); | |
431 | get_register_operand ((insn_word >> 16) & 0x07, operand[1][0]); | |
432 | get_register_operand ((insn_word >> 19) & 0x07, operand[0][0]); | |
433 | get_register_operand ((insn_word >> 22) & 0x07, operand[0][2]); | |
434 | break; | |
435 | case OO_PField: | |
436 | if (insn_word & 0x00800000) | |
437 | get_register_operand (0x01, operand[0][2]); | |
438 | else | |
439 | get_register_operand (0x00, operand[0][2]); | |
440 | if (insn_word & 0x00400000) | |
441 | get_register_operand (0x03, operand[1][2]); | |
442 | else | |
443 | get_register_operand (0x02, operand[1][2]); | |
444 | switch (insn_word & P_FIELD) | |
445 | { | |
446 | case 0x00000000: | |
447 | get_indirect_operand ((insn_word & 0x000000FF), 1, operand[0][1]); | |
448 | get_indirect_operand ((insn_word & 0x0000FF00) >> 8, 1, operand[0][0]); | |
449 | get_register_operand ((insn_word >> 16) & 0x07, operand[1][1]); | |
450 | get_register_operand ((insn_word >> 19) & 0x07, operand[1][0]); | |
451 | break; | |
452 | case 0x01000000: | |
453 | get_indirect_operand ((insn_word & 0x000000FF), 1, operand[1][0]); | |
454 | get_indirect_operand ((insn_word & 0x0000FF00) >> 8, 1, operand[0][0]); | |
455 | get_register_operand ((insn_word >> 16) & 0x07, operand[1][1]); | |
456 | get_register_operand ((insn_word >> 19) & 0x07, operand[0][1]); | |
457 | break; | |
458 | case 0x02000000: | |
459 | get_indirect_operand ((insn_word & 0x000000FF), 1, operand[1][1]); | |
460 | get_indirect_operand ((insn_word & 0x0000FF00) >> 8, 1, operand[1][0]); | |
461 | get_register_operand ((insn_word >> 16) & 0x07, operand[0][1]); | |
462 | get_register_operand ((insn_word >> 19) & 0x07, operand[0][0]); | |
463 | break; | |
464 | case 0x03000000: | |
465 | get_indirect_operand ((insn_word & 0x000000FF), 1, operand[1][1]); | |
466 | get_indirect_operand ((insn_word & 0x0000FF00) >> 8, 1, operand[0][0]); | |
467 | get_register_operand ((insn_word >> 16) & 0x07, operand[1][0]); | |
468 | get_register_operand ((insn_word >> 19) & 0x07, operand[0][1]); | |
469 | break; | |
470 | } | |
471 | break; | |
472 | default: | |
473 | return 0; | |
474 | } | |
475 | info->fprintf_func (info->stream, " %s %s,%s%c%s", name1, | |
476 | operand[0][0], operand[0][1], | |
477 | operand[0][2][0] ? ',' : ' ', | |
478 | operand[0][2][0] ? operand[0][2] : ""); | |
479 | info->fprintf_func (info->stream, "\n\t\t\t|| %s %s,%s%c%s", name2, | |
480 | operand[1][0], operand[1][1], | |
481 | operand[1][2][0] ? ',' : ' ', | |
482 | operand[1][2][0] ? operand[1][2] : ""); | |
483 | free (name1); | |
484 | return 1; | |
485 | } | |
486 | ||
487 | int | |
488 | print_branch (info, insn_word, insn) | |
489 | disassemble_info *info; | |
490 | unsigned long insn_word; | |
491 | struct instruction *insn; | |
492 | { | |
493 | char operand[2][13] = | |
494 | { | |
495 | {0}, | |
496 | {0}}; | |
497 | unsigned long address; | |
498 | int print_label = 0; | |
499 | ||
500 | if (insn->tm == NULL) | |
501 | return 0; | |
502 | /* Get the operands for 24-bit immediate jumps. */ | |
503 | if (insn->tm->operand_types[0] & Imm24) | |
504 | { | |
505 | address = insn_word & 0x00FFFFFF; | |
506 | sprintf (operand[0], "0x%lX", address); | |
507 | print_label = 1; | |
508 | } | |
509 | /* Get the operand for the trap instruction. */ | |
510 | else if (insn->tm->operand_types[0] & IVector) | |
511 | { | |
512 | address = insn_word & 0x0000001F; | |
513 | sprintf (operand[0], "0x%lX", address); | |
514 | } | |
515 | else | |
516 | { | |
517 | address = insn_word & 0x0000FFFF; | |
518 | /* Get the operands for the DB instructions. */ | |
519 | if (insn->tm->operands == 2) | |
520 | { | |
521 | get_register_operand (((insn_word & 0x01C00000) >> 22) + REG_AR0, operand[0]); | |
522 | if (insn_word & PCRel) | |
523 | { | |
524 | sprintf (operand[1], "%d", (short) address); | |
525 | print_label = 1; | |
526 | } | |
527 | else | |
528 | get_register_operand (insn_word & 0x0000001F, operand[1]); | |
529 | } | |
530 | /* Get the operands for the standard branches. */ | |
531 | else if (insn->tm->operands == 1) | |
532 | { | |
533 | if (insn_word & PCRel) | |
534 | { | |
535 | address = (short) address; | |
536 | sprintf (operand[0], "%ld", address); | |
537 | print_label = 1; | |
538 | } | |
539 | else | |
540 | get_register_operand (insn_word & 0x0000001F, operand[0]); | |
541 | } | |
542 | } | |
543 | info->fprintf_func (info->stream, " %s %s%c%s", insn->tm->name, | |
544 | operand[0][0] ? operand[0] : "", | |
545 | operand[1][0] ? ',' : ' ', | |
546 | operand[1][0] ? operand[1] : ""); | |
547 | /* Print destination of branch in relation to current symbol. */ | |
548 | if (print_label && info->symbol) | |
549 | { | |
550 | if ((insn->tm->opcode_modifier == PCRel) && (insn_word & PCRel)) | |
551 | { | |
552 | address = (_pc + 1 + (short) address) - ((info->symbol->section->vma + info->symbol->value) / 4); | |
553 | /* Check for delayed instruction, if so adjust destination. */ | |
554 | if (insn_word & 0x00200000) | |
555 | address += 2; | |
556 | } | |
557 | else | |
558 | { | |
559 | address -= ((info->symbol->section->vma + info->symbol->value) / 4); | |
560 | } | |
561 | if (address == 0) | |
562 | info->fprintf_func (info->stream, " <%s>", info->symbol->name); | |
563 | else | |
564 | info->fprintf_func (info->stream, " <%s %c %d>", info->symbol->name, | |
565 | ((short) address < 0) ? '-' : '+', | |
566 | abs (address)); | |
567 | } | |
568 | return 1; | |
569 | } | |
570 | ||
571 | int | |
572 | get_indirect_operand (fragment, size, buffer) | |
573 | unsigned short fragment; | |
574 | int size; | |
575 | char *buffer; | |
576 | { | |
577 | unsigned char mod; | |
578 | unsigned arnum; | |
579 | unsigned char disp; | |
580 | ||
581 | if (buffer == NULL) | |
582 | return 0; | |
583 | /* Determine which bits identify the sections of the indirect operand based on the | |
584 | size in bytes. */ | |
585 | switch (size) | |
586 | { | |
587 | case 1: | |
588 | mod = (fragment & 0x00F8) >> 3; | |
589 | arnum = (fragment & 0x0007); | |
590 | disp = 0; | |
591 | break; | |
592 | case 2: | |
593 | mod = (fragment & 0xF800) >> 11; | |
594 | arnum = (fragment & 0x0700) >> 8; | |
595 | disp = (fragment & 0x00FF); | |
596 | break; | |
597 | default: | |
598 | return 0; | |
599 | } | |
600 | { | |
601 | const ind_addr_type *current_ind = tic30_indaddr_tab; | |
602 | for (; current_ind < tic30_indaddrtab_end; current_ind++) | |
603 | { | |
604 | if (current_ind->modfield == mod) | |
605 | { | |
606 | if (current_ind->displacement == IMPLIED_DISP && size == 2) | |
607 | { | |
608 | continue; | |
609 | } | |
610 | else | |
611 | { | |
612 | int i, bufcnt; | |
613 | for (i = 0, bufcnt = 0; i < strlen (current_ind->syntax); i++, bufcnt++) | |
614 | { | |
615 | buffer[bufcnt] = current_ind->syntax[i]; | |
616 | if (buffer[bufcnt - 1] == 'a' && buffer[bufcnt] == 'r') | |
617 | buffer[++bufcnt] = arnum + '0'; | |
618 | if (buffer[bufcnt] == '(' && current_ind->displacement == DISP_REQUIRED) | |
619 | { | |
620 | sprintf (&buffer[bufcnt + 1], "%u", disp); | |
621 | bufcnt += strlen (&buffer[bufcnt + 1]); | |
622 | } | |
623 | } | |
624 | buffer[bufcnt + 1] = '\0'; | |
625 | break; | |
626 | } | |
627 | } | |
628 | } | |
629 | } | |
630 | return 1; | |
631 | } | |
632 | ||
633 | int | |
634 | get_register_operand (fragment, buffer) | |
635 | unsigned char fragment; | |
636 | char *buffer; | |
637 | { | |
638 | const reg *current_reg = tic30_regtab; | |
639 | ||
640 | if (buffer == NULL) | |
641 | return 0; | |
642 | for (; current_reg < tic30_regtab_end; current_reg++) | |
643 | { | |
644 | if ((fragment & 0x1F) == current_reg->opcode) | |
645 | { | |
646 | strcpy (buffer, current_reg->name); | |
647 | return 1; | |
648 | } | |
649 | } | |
650 | return 0; | |
651 | } | |
652 | ||
653 | int | |
654 | cnvt_tmsfloat_ieee (tmsfloat, size, ieeefloat) | |
655 | unsigned long tmsfloat; | |
656 | int size; | |
657 | float *ieeefloat; | |
658 | { | |
659 | unsigned long exp, sign, mant; | |
660 | ||
661 | if (size == 2) | |
662 | { | |
663 | if ((tmsfloat & 0x0000F000) == 0x00008000) | |
664 | tmsfloat = 0x80000000; | |
665 | else | |
666 | { | |
667 | tmsfloat <<= 16; | |
668 | tmsfloat = (long) tmsfloat >> 4; | |
669 | } | |
670 | } | |
671 | exp = tmsfloat & 0xFF000000; | |
672 | if (exp == 0x80000000) | |
673 | { | |
674 | *ieeefloat = 0.0; | |
675 | return 1; | |
676 | } | |
677 | exp += 0x7F000000; | |
678 | sign = (tmsfloat & 0x00800000) << 8; | |
679 | mant = tmsfloat & 0x007FFFFF; | |
680 | if (exp == 0xFF000000) | |
681 | { | |
682 | if (mant == 0) | |
683 | *ieeefloat = ERANGE; | |
684 | if (sign == 0) | |
685 | *ieeefloat = 1.0 / 0.0; | |
686 | else | |
687 | *ieeefloat = -1.0 / 0.0; | |
688 | return 1; | |
689 | } | |
690 | exp >>= 1; | |
691 | if (sign) | |
692 | { | |
693 | mant = (~mant) & 0x007FFFFF; | |
694 | mant += 1; | |
695 | exp += mant & 0x00800000; | |
696 | exp &= 0x7F800000; | |
697 | mant &= 0x007FFFFF; | |
698 | } | |
699 | if (tmsfloat == 0x80000000) | |
700 | sign = mant = exp = 0; | |
701 | tmsfloat = sign | exp | mant; | |
702 | *ieeefloat = *((float *) &tmsfloat); | |
703 | return 1; | |
704 | } |