projects / deliverable / binutils-gdb.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Rewrite the mipsI/II/III pending-slot code.
[deliverable/binutils-gdb.git] / sim / mips / interp.c
1 /*> interp.c <*/
2 /* Simulator for the MIPS architecture.
3
4 This file is part of the MIPS sim
5
6 THIS SOFTWARE IS NOT COPYRIGHTED
7
8 Cygnus offers the following for use in the public domain. Cygnus
9 makes no warranty with regard to the software or it's performance
10 and the user accepts the software "AS IS" with all faults.
11
12 CYGNUS DISCLAIMS ANY WARRANTIES, EXPRESS OR IMPLIED, WITH REGARD TO
13 THIS SOFTWARE INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
14 MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
15
16 $Revision$
17 $Author$
18 $Date$
19
20 NOTEs:
21
22 The IDT monitor (found on the VR4300 board), seems to lie about
23 register contents. It seems to treat the registers as sign-extended
24 32-bit values. This cause *REAL* problems when single-stepping 64-bit
25 code on the hardware.
26
27 */
28
29 /* The TRACE manifests enable the provision of extra features. If they
30 are not defined then a simpler (quicker) simulator is constructed
31 without the required run-time checks, etc. */
32 #if 1 /* 0 to allow user build selection, 1 to force inclusion */
33 #define TRACE (1)
34 #endif
35
36 #include "bfd.h"
37 #include "sim-main.h"
38 #include "sim-utils.h"
39 #include "sim-options.h"
40 #include "sim-assert.h"
41
42 #include "config.h"
43
44 #include <stdio.h>
45 #include <stdarg.h>
46 #include <ansidecl.h>
47 #include <ctype.h>
48 #include <limits.h>
49 #include <math.h>
50 #ifdef HAVE_STDLIB_H
51 #include <stdlib.h>
52 #endif
53 #ifdef HAVE_STRING_H
54 #include <string.h>
55 #else
56 #ifdef HAVE_STRINGS_H
57 #include <strings.h>
58 #endif
59 #endif
60
61 #include "getopt.h"
62 #include "libiberty.h"
63 #include "bfd.h"
64 #include "callback.h" /* GDB simulator callback interface */
65 #include "remote-sim.h" /* GDB simulator interface */
66
67 #include "sysdep.h"
68
69 #ifndef PARAMS
70 #define PARAMS(x)
71 #endif
72
73 char* pr_addr PARAMS ((SIM_ADDR addr));
74 char* pr_uword64 PARAMS ((uword64 addr));
75
76
77 /* Get the simulator engine description, without including the code: */
78 #if (WITH_IGEN)
79 #define LOADDRMASK (WITH_TARGET_WORD_BITSIZE == 64 ? 0x7 : 0x3)
80 #else
81 #define SIM_MANIFESTS
82 #include "oengine.c"
83 #undef SIM_MANIFESTS
84 #endif
85
86 /* Within interp.c we refer to the sim_state and sim_cpu directly. */
87 #define SD sd
88 #define CPU cpu
89
90
91 /* The following reserved instruction value is used when a simulator
92 trap is required. NOTE: Care must be taken, since this value may be
93 used in later revisions of the MIPS ISA. */
94 #define RSVD_INSTRUCTION (0x00000005)
95 #define RSVD_INSTRUCTION_MASK (0xFC00003F)
96
97 #define RSVD_INSTRUCTION_ARG_SHIFT 6
98 #define RSVD_INSTRUCTION_ARG_MASK 0xFFFFF
99
100
101 /* Bits in the Debug register */
102 #define Debug_DBD 0x80000000 /* Debug Branch Delay */
103 #define Debug_DM 0x40000000 /* Debug Mode */
104 #define Debug_DBp 0x00000002 /* Debug Breakpoint indicator */
105
106
107
108
109
110 /*---------------------------------------------------------------------------*/
111 /*-- GDB simulator interface ------------------------------------------------*/
112 /*---------------------------------------------------------------------------*/
113
114 static void ColdReset PARAMS((SIM_DESC sd));
115
116 /*---------------------------------------------------------------------------*/
117
118
119
120 #define DELAYSLOT() {\
121 if (STATE & simDELAYSLOT)\
122 sim_io_eprintf(sd,"Delay slot already activated (branch in delay slot?)\n");\
123 STATE |= simDELAYSLOT;\
124 }
125
126 #define JALDELAYSLOT() {\
127 DELAYSLOT ();\
128 STATE |= simJALDELAYSLOT;\
129 }
130
131 #define NULLIFY() {\
132 STATE &= ~simDELAYSLOT;\
133 STATE |= simSKIPNEXT;\
134 }
135
136 #define CANCELDELAYSLOT() {\
137 DSSTATE = 0;\
138 STATE &= ~(simDELAYSLOT | simJALDELAYSLOT);\
139 }
140
141 #define INDELAYSLOT() ((STATE & simDELAYSLOT) != 0)
142 #define INJALDELAYSLOT() ((STATE & simJALDELAYSLOT) != 0)
143
144 #define K0BASE (0x80000000)
145 #define K0SIZE (0x20000000)
146 #define K1BASE (0xA0000000)
147 #define K1SIZE (0x20000000)
148 #define MONITOR_BASE (0xBFC00000)
149 #define MONITOR_SIZE (1 << 11)
150 #define MEM_SIZE (2 << 20)
151
152 #if defined(TRACE)
153 static char *tracefile = "trace.din"; /* default filename for trace log */
154 FILE *tracefh = NULL;
155 static void open_trace PARAMS((SIM_DESC sd));
156 #endif /* TRACE */
157
158 #define OPTION_DINERO_TRACE 200
159 #define OPTION_DINERO_FILE 201
160
161 static SIM_RC
162 mips_option_handler (sd, opt, arg)
163 SIM_DESC sd;
164 int opt;
165 char *arg;
166 {
167 int cpu_nr;
168 switch (opt)
169 {
170 case OPTION_DINERO_TRACE: /* ??? */
171 #if defined(TRACE)
172 /* Eventually the simTRACE flag could be treated as a toggle, to
173 allow external control of the program points being traced
174 (i.e. only from main onwards, excluding the run-time setup,
175 etc.). */
176 for (cpu_nr = 0; cpu_nr < sim_engine_nr_cpus (sd); cpu_nr++)
177 {
178 sim_cpu *cpu = STATE_CPU (sd, cpu_nr);
179 if (arg == NULL)
180 STATE |= simTRACE;
181 else if (strcmp (arg, "yes") == 0)
182 STATE |= simTRACE;
183 else if (strcmp (arg, "no") == 0)
184 STATE &= ~simTRACE;
185 else if (strcmp (arg, "on") == 0)
186 STATE |= simTRACE;
187 else if (strcmp (arg, "off") == 0)
188 STATE &= ~simTRACE;
189 else
190 {
191 fprintf (stderr, "Unreconized dinero-trace option `%s'\n", arg);
192 return SIM_RC_FAIL;
193 }
194 }
195 return SIM_RC_OK;
196 #else /* !TRACE */
197 fprintf(stderr,"\
198 Simulator constructed without dinero tracing support (for performance).\n\
199 Re-compile simulator with \"-DTRACE\" to enable this option.\n");
200 return SIM_RC_FAIL;
201 #endif /* !TRACE */
202
203 case OPTION_DINERO_FILE:
204 #if defined(TRACE)
205 if (optarg != NULL) {
206 char *tmp;
207 tmp = (char *)malloc(strlen(optarg) + 1);
208 if (tmp == NULL)
209 {
210 sim_io_printf(sd,"Failed to allocate buffer for tracefile name \"%s\"\n",optarg);
211 return SIM_RC_FAIL;
212 }
213 else {
214 strcpy(tmp,optarg);
215 tracefile = tmp;
216 sim_io_printf(sd,"Placing trace information into file \"%s\"\n",tracefile);
217 }
218 }
219 #endif /* TRACE */
220 return SIM_RC_OK;
221
222 }
223
224 return SIM_RC_OK;
225 }
226
227 static const OPTION mips_options[] =
228 {
229 { {"dinero-trace", optional_argument, NULL, OPTION_DINERO_TRACE},
230 '\0', "on|off", "Enable dinero tracing",
231 mips_option_handler },
232 { {"dinero-file", required_argument, NULL, OPTION_DINERO_FILE},
233 '\0', "FILE", "Write dinero trace to FILE",
234 mips_option_handler },
235 { {NULL, no_argument, NULL, 0}, '\0', NULL, NULL, NULL }
236 };
237
238
239 int interrupt_pending;
240
241 static void
242 interrupt_event (SIM_DESC sd, void *data)
243 {
244 sim_cpu *cpu = STATE_CPU (sd, 0); /* FIXME */
245 if (SR & status_IE)
246 {
247 interrupt_pending = 0;
248 SignalExceptionInterrupt ();
249 }
250 else if (!interrupt_pending)
251 sim_events_schedule (sd, 1, interrupt_event, data);
252 }
253
254
255
256 /*---------------------------------------------------------------------------*/
257 /*-- GDB simulator interface ------------------------------------------------*/
258 /*---------------------------------------------------------------------------*/
259
260 SIM_DESC
261 sim_open (kind, cb, abfd, argv)
262 SIM_OPEN_KIND kind;
263 host_callback *cb;
264 struct _bfd *abfd;
265 char **argv;
266 {
267 SIM_DESC sd = sim_state_alloc (kind, cb);
268 sim_cpu *cpu = STATE_CPU (sd, 0); /* FIXME */
269
270 SIM_ASSERT (STATE_MAGIC (sd) == SIM_MAGIC_NUMBER);
271
272 /* FIXME: watchpoints code shouldn't need this */
273 STATE_WATCHPOINTS (sd)->pc = &(PC);
274 STATE_WATCHPOINTS (sd)->sizeof_pc = sizeof (PC);
275 STATE_WATCHPOINTS (sd)->interrupt_handler = interrupt_event;
276
277 STATE = 0;
278
279 if (sim_pre_argv_init (sd, argv[0]) != SIM_RC_OK)
280 return 0;
281 sim_add_option_table (sd, mips_options);
282
283 /* Allocate core managed memory */
284
285 /* the monitor */
286 sim_do_commandf (sd, "memory region 0x%lx,0x%lx", MONITOR_BASE, MONITOR_SIZE);
287 /* For compatibility with the old code - under this (at level one)
288 are the kernel spaces K0 & K1. Both of these map to a single
289 smaller sub region */
290 sim_do_commandf (sd, "memory alias 0x%lx@1,0x%lx%%0x%lx,0x%0x",
291 K1BASE, K0SIZE,
292 MEM_SIZE, /* actual size */
293 K0BASE);
294
295 /* getopt will print the error message so we just have to exit if this fails.
296 FIXME: Hmmm... in the case of gdb we need getopt to call
297 print_filtered. */
298 if (sim_parse_args (sd, argv) != SIM_RC_OK)
299 {
300 /* Uninstall the modules to avoid memory leaks,
301 file descriptor leaks, etc. */
302 sim_module_uninstall (sd);
303 return 0;
304 }
305
306 /* check for/establish the a reference program image */
307 if (sim_analyze_program (sd,
308 (STATE_PROG_ARGV (sd) != NULL
309 ? *STATE_PROG_ARGV (sd)
310 : NULL),
311 abfd) != SIM_RC_OK)
312 {
313 sim_module_uninstall (sd);
314 return 0;
315 }
316
317 /* Configure/verify the target byte order and other runtime
318 configuration options */
319 if (sim_config (sd) != SIM_RC_OK)
320 {
321 sim_module_uninstall (sd);
322 return 0;
323 }
324
325 if (sim_post_argv_init (sd) != SIM_RC_OK)
326 {
327 /* Uninstall the modules to avoid memory leaks,
328 file descriptor leaks, etc. */
329 sim_module_uninstall (sd);
330 return 0;
331 }
332
333 /* verify assumptions the simulator made about the host type system.
334 This macro does not return if there is a problem */
335 SIM_ASSERT (sizeof(int) == (4 * sizeof(char)));
336 SIM_ASSERT (sizeof(word64) == (8 * sizeof(char)));
337
338 /* This is NASTY, in that we are assuming the size of specific
339 registers: */
340 {
341 int rn;
342 for (rn = 0; (rn < (LAST_EMBED_REGNUM + 1)); rn++) {
343 if (rn < 32)
344 cpu->register_widths[rn] = WITH_TARGET_WORD_BITSIZE;
345 else if ((rn >= FGRIDX) && (rn < (FGRIDX + 32)))
346 cpu->register_widths[rn] = WITH_TARGET_WORD_BITSIZE;
347 else if ((rn >= 33) && (rn <= 37))
348 cpu->register_widths[rn] = WITH_TARGET_WORD_BITSIZE;
349 else if ((rn == SRIDX) || (rn == FCR0IDX) || (rn == FCR31IDX) || ((rn >= 72) && (rn <= 89)))
350 cpu->register_widths[rn] = 32;
351 else
352 cpu->register_widths[rn] = 0;
353 }
354 /* start-sanitize-r5900 */
355
356 /* set the 5900 "upper" registers to 64 bits */
357 for( rn = LAST_EMBED_REGNUM+1; rn < NUM_REGS; rn++)
358 cpu->register_widths[rn] = 64;
359 /* end-sanitize-r5900 */
360 }
361
362 #if defined(TRACE)
363 if (STATE & simTRACE)
364 open_trace(sd);
365 #endif /* TRACE */
366
367 /* Write the monitor trap address handlers into the monitor (eeprom)
368 address space. This can only be done once the target endianness
369 has been determined. */
370 {
371 unsigned loop;
372 /* Entry into the IDT monitor is via fixed address vectors, and
373 not using machine instructions. To avoid clashing with use of
374 the MIPS TRAP system, we place our own (simulator specific)
375 "undefined" instructions into the relevant vector slots. */
376 for (loop = 0; (loop < MONITOR_SIZE); loop += 4)
377 {
378 address_word vaddr = (MONITOR_BASE + loop);
379 unsigned32 insn = (RSVD_INSTRUCTION | (((loop >> 2) & RSVD_INSTRUCTION_ARG_MASK) << RSVD_INSTRUCTION_ARG_SHIFT));
380 H2T (insn);
381 sim_write (sd, vaddr, (char *)&insn, sizeof (insn));
382 }
383 /* The PMON monitor uses the same address space, but rather than
384 branching into it the address of a routine is loaded. We can
385 cheat for the moment, and direct the PMON routine to IDT style
386 instructions within the monitor space. This relies on the IDT
387 monitor not using the locations from 0xBFC00500 onwards as its
388 entry points.*/
389 for (loop = 0; (loop < 24); loop++)
390 {
391 address_word vaddr = (MONITOR_BASE + 0x500 + (loop * 4));
392 unsigned32 value = ((0x500 - 8) / 8); /* default UNDEFINED reason code */
393 switch (loop)
394 {
395 case 0: /* read */
396 value = 7;
397 break;
398 case 1: /* write */
399 value = 8;
400 break;
401 case 2: /* open */
402 value = 6;
403 break;
404 case 3: /* close */
405 value = 10;
406 break;
407 case 5: /* printf */
408 value = ((0x500 - 16) / 8); /* not an IDT reason code */
409 break;
410 case 8: /* cliexit */
411 value = 17;
412 break;
413 case 11: /* flush_cache */
414 value = 28;
415 break;
416 }
417 /* FIXME - should monitor_base be SIM_ADDR?? */
418 value = ((unsigned int)MONITOR_BASE + (value * 8));
419 H2T (value);
420 sim_write (sd, vaddr, (char *)&value, sizeof (value));
421
422 /* The LSI MiniRISC PMON has its vectors at 0x200, not 0x500. */
423 vaddr -= 0x300;
424 sim_write (sd, vaddr, (char *)&value, sizeof (value));
425 }
426 }
427
428 return sd;
429 }
430
431 #if defined(TRACE)
432 static void
433 open_trace(sd)
434 SIM_DESC sd;
435 {
436 tracefh = fopen(tracefile,"wb+");
437 if (tracefh == NULL)
438 {
439 sim_io_eprintf(sd,"Failed to create file \"%s\", writing trace information to stderr.\n",tracefile);
440 tracefh = stderr;
441 }
442 }
443 #endif /* TRACE */
444
445 void
446 sim_close (sd, quitting)
447 SIM_DESC sd;
448 int quitting;
449 {
450 #ifdef DEBUG
451 printf("DBG: sim_close: entered (quitting = %d)\n",quitting);
452 #endif
453
454 /* "quitting" is non-zero if we cannot hang on errors */
455
456 /* Ensure that any resources allocated through the callback
457 mechanism are released: */
458 sim_io_shutdown (sd);
459
460 #if defined(TRACE)
461 if (tracefh != NULL && tracefh != stderr)
462 fclose(tracefh);
463 tracefh = NULL;
464 #endif /* TRACE */
465
466 /* FIXME - free SD */
467
468 return;
469 }
470
471
472 int
473 sim_write (sd,addr,buffer,size)
474 SIM_DESC sd;
475 SIM_ADDR addr;
476 unsigned char *buffer;
477 int size;
478 {
479 int index;
480 sim_cpu *cpu = STATE_CPU (sd, 0); /* FIXME */
481
482 /* Return the number of bytes written, or zero if error. */
483 #ifdef DEBUG
484 sim_io_printf(sd,"sim_write(0x%s,buffer,%d);\n",pr_addr(addr),size);
485 #endif
486
487 /* We use raw read and write routines, since we do not want to count
488 the GDB memory accesses in our statistics gathering. */
489
490 for (index = 0; index < size; index++)
491 {
492 address_word vaddr = (address_word)addr + index;
493 address_word paddr;
494 int cca;
495 if (!address_translation (SD, CPU, NULL_CIA, vaddr, isDATA, isSTORE, &paddr, &cca, isRAW))
496 break;
497 if (sim_core_write_buffer (SD, CPU, sim_core_read_map, buffer + index, paddr, 1) != 1)
498 break;
499 }
500
501 return(index);
502 }
503
504 int
505 sim_read (sd,addr,buffer,size)
506 SIM_DESC sd;
507 SIM_ADDR addr;
508 unsigned char *buffer;
509 int size;
510 {
511 int index;
512 sim_cpu *cpu = STATE_CPU (sd, 0); /* FIXME */
513
514 /* Return the number of bytes read, or zero if error. */
515 #ifdef DEBUG
516 sim_io_printf(sd,"sim_read(0x%s,buffer,%d);\n",pr_addr(addr),size);
517 #endif /* DEBUG */
518
519 for (index = 0; (index < size); index++)
520 {
521 address_word vaddr = (address_word)addr + index;
522 address_word paddr;
523 int cca;
524 if (!address_translation (SD, CPU, NULL_CIA, vaddr, isDATA, isLOAD, &paddr, &cca, isRAW))
525 break;
526 if (sim_core_read_buffer (SD, CPU, sim_core_read_map, buffer + index, paddr, 1) != 1)
527 break;
528 }
529
530 return(index);
531 }
532
533 void
534 sim_store_register (sd,rn,memory)
535 SIM_DESC sd;
536 int rn;
537 unsigned char *memory;
538 {
539 sim_cpu *cpu = STATE_CPU (sd, 0); /* FIXME */
540 /* NOTE: gdb (the client) stores registers in target byte order
541 while the simulator uses host byte order */
542 #ifdef DEBUG
543 sim_io_printf(sd,"sim_store_register(%d,*memory=0x%s);\n",rn,pr_addr(*((SIM_ADDR *)memory)));
544 #endif /* DEBUG */
545
546 /* Unfortunately this suffers from the same problem as the register
547 numbering one. We need to know what the width of each logical
548 register number is for the architecture being simulated. */
549
550 if (cpu->register_widths[rn] == 0)
551 sim_io_eprintf(sd,"Invalid register width for %d (register store ignored)\n",rn);
552 /* start-sanitize-r5900 */
553 else if (rn == REGISTER_SA)
554 SA = T2H_8(*(uword64*)memory);
555 else if (rn > LAST_EMBED_REGNUM)
556 cpu->registers1[rn - LAST_EMBED_REGNUM - 1] = T2H_8(*(uword64*)memory);
557 /* end-sanitize-r5900 */
558 else if (cpu->register_widths[rn] == 32)
559 cpu->registers[rn] = T2H_4 (*(unsigned int*)memory);
560 else
561 cpu->registers[rn] = T2H_8 (*(uword64*)memory);
562
563 return;
564 }
565
566 void
567 sim_fetch_register (sd,rn,memory)
568 SIM_DESC sd;
569 int rn;
570 unsigned char *memory;
571 {
572 sim_cpu *cpu = STATE_CPU (sd, 0); /* FIXME */
573 /* NOTE: gdb (the client) stores registers in target byte order
574 while the simulator uses host byte order */
575 #ifdef DEBUG
576 sim_io_printf(sd,"sim_fetch_register(%d=0x%s,mem) : place simulator registers into memory\n",rn,pr_addr(registers[rn]));
577 #endif /* DEBUG */
578
579 if (cpu->register_widths[rn] == 0)
580 sim_io_eprintf(sd,"Invalid register width for %d (register fetch ignored)\n",rn);
581 /* start-sanitize-r5900 */
582 else if (rn == REGISTER_SA)
583 *((uword64 *)memory) = H2T_8(SA);
584 else if (rn > LAST_EMBED_REGNUM)
585 *((uword64 *)memory) = H2T_8(cpu->registers1[rn - LAST_EMBED_REGNUM - 1]);
586 /* end-sanitize-r5900 */
587 else if (cpu->register_widths[rn] == 32)
588 *((unsigned int *)memory) = H2T_4 ((unsigned int)(cpu->registers[rn] & 0xFFFFFFFF));
589 else /* 64bit register */
590 *((uword64 *)memory) = H2T_8 (cpu->registers[rn]);
591
592 return;
593 }
594
595
596 void
597 sim_info (sd,verbose)
598 SIM_DESC sd;
599 int verbose;
600 {
601 /* Accessed from the GDB "info files" command: */
602 if (STATE_VERBOSE_P (sd) || verbose)
603 {
604
605 sim_io_printf (sd, "MIPS %d-bit %s endian simulator\n",
606 WITH_TARGET_WORD_BITSIZE,
607 (CURRENT_TARGET_BYTE_ORDER == BIG_ENDIAN ? "Big" : "Little"));
608
609 #if !defined(FASTSIM)
610 /* It would be a useful feature, if when performing multi-cycle
611 simulations (rather than single-stepping) we keep the start and
612 end times of the execution, so that we can give a performance
613 figure for the simulator. */
614 #endif /* !FASTSIM */
615 sim_io_printf (sd, "Number of execution cycles = %ld\n",
616 (long) sim_events_time (sd));
617
618 /* print information pertaining to MIPS ISA and architecture being simulated */
619 /* things that may be interesting */
620 /* instructions executed - if available */
621 /* cycles executed - if available */
622 /* pipeline stalls - if available */
623 /* virtual time taken */
624 /* profiling size */
625 /* profiling frequency */
626 /* profile minpc */
627 /* profile maxpc */
628 }
629 profile_print (sd, STATE_VERBOSE_P (sd), NULL, NULL);
630 }
631
632
633 SIM_RC
634 sim_create_inferior (sd, abfd, argv,env)
635 SIM_DESC sd;
636 struct _bfd *abfd;
637 char **argv;
638 char **env;
639 {
640
641 #ifdef DEBUG
642 printf("DBG: sim_create_inferior entered: start_address = 0x%s\n",
643 pr_addr(PC));
644 #endif /* DEBUG */
645
646 ColdReset(sd);
647
648 if (abfd != NULL)
649 {
650 /* override PC value set by ColdReset () */
651 int cpu_nr;
652 for (cpu_nr = 0; cpu_nr < sim_engine_nr_cpus (sd); cpu_nr++)
653 {
654 sim_cpu *cpu = STATE_CPU (sd, cpu_nr);
655 CIA_SET (cpu, (unsigned64) bfd_get_start_address (abfd));
656 }
657 }
658
659 #if 0 /* def DEBUG */
660 if (argv || env)
661 {
662 /* We should really place the argv slot values into the argument
663 registers, and onto the stack as required. However, this
664 assumes that we have a stack defined, which is not
665 necessarily true at the moment. */
666 char **cptr;
667 sim_io_printf(sd,"sim_create_inferior() : passed arguments ignored\n");
668 for (cptr = argv; (cptr && *cptr); cptr++)
669 printf("DBG: arg \"%s\"\n",*cptr);
670 }
671 #endif /* DEBUG */
672
673 return SIM_RC_OK;
674 }
675
676 void
677 sim_do_command (sd,cmd)
678 SIM_DESC sd;
679 char *cmd;
680 {
681 if (sim_args_command (sd, cmd) != SIM_RC_OK)
682 sim_io_printf (sd, "Error: \"%s\" is not a valid MIPS simulator command.\n",
683 cmd);
684 }
685
686 /*---------------------------------------------------------------------------*/
687 /*-- Private simulator support interface ------------------------------------*/
688 /*---------------------------------------------------------------------------*/
689
690 /* Read a null terminated string from memory, return in a buffer */
691 static char *
692 fetch_str (sd, addr)
693 SIM_DESC sd;
694 address_word addr;
695 {
696 char *buf;
697 int nr = 0;
698 char null;
699 while (sim_read (sd, addr + nr, &null, 1) == 1 && null != 0)
700 nr++;
701 buf = NZALLOC (char, nr + 1);
702 sim_read (sd, addr, buf, nr);
703 return buf;
704 }
705
706 /* Simple monitor interface (currently setup for the IDT and PMON monitors) */
707 static void
708 sim_monitor (SIM_DESC sd,
709 sim_cpu *cpu,
710 address_word cia,
711 unsigned int reason)
712 {
713 #ifdef DEBUG
714 printf("DBG: sim_monitor: entered (reason = %d)\n",reason);
715 #endif /* DEBUG */
716
717 /* The IDT monitor actually allows two instructions per vector
718 slot. However, the simulator currently causes a trap on each
719 individual instruction. We cheat, and lose the bottom bit. */
720 reason >>= 1;
721
722 /* The following callback functions are available, however the
723 monitor we are simulating does not make use of them: get_errno,
724 isatty, lseek, rename, system, time and unlink */
725 switch (reason)
726 {
727
728 case 6: /* int open(char *path,int flags) */
729 {
730 char *path = fetch_str (sd, A0);
731 V0 = sim_io_open (sd, path, (int)A1);
732 zfree (path);
733 break;
734 }
735
736 case 7: /* int read(int file,char *ptr,int len) */
737 {
738 int fd = A0;
739 int nr = A2;
740 char *buf = zalloc (nr);
741 V0 = sim_io_read (sd, fd, buf, nr);
742 sim_write (sd, A1, buf, nr);
743 zfree (buf);
744 }
745 break;
746
747 case 8: /* int write(int file,char *ptr,int len) */
748 {
749 int fd = A0;
750 int nr = A2;
751 char *buf = zalloc (nr);
752 sim_read (sd, A1, buf, nr);
753 V0 = sim_io_write (sd, fd, buf, nr);
754 zfree (buf);
755 break;
756 }
757
758 case 10: /* int close(int file) */
759 {
760 V0 = sim_io_close (sd, (int)A0);
761 break;
762 }
763
764 case 2: /* Densan monitor: char inbyte(int waitflag) */
765 {
766 if (A0 == 0) /* waitflag == NOWAIT */
767 V0 = (unsigned_word)-1;
768 }
769 /* Drop through to case 11 */
770
771 case 11: /* char inbyte(void) */
772 {
773 char tmp;
774 if (sim_io_read_stdin (sd, &tmp, sizeof(char)) != sizeof(char))
775 {
776 sim_io_error(sd,"Invalid return from character read");
777 V0 = (unsigned_word)-1;
778 }
779 else
780 V0 = (unsigned_word)tmp;
781 break;
782 }
783
784 case 3: /* Densan monitor: void co(char chr) */
785 case 12: /* void outbyte(char chr) : write a byte to "stdout" */
786 {
787 char tmp = (char)(A0 & 0xFF);
788 sim_io_write_stdout (sd, &tmp, sizeof(char));
789 break;
790 }
791
792 case 17: /* void _exit() */
793 {
794 sim_io_eprintf (sd, "sim_monitor(17): _exit(int reason) to be coded\n");
795 sim_engine_halt (SD, CPU, NULL, NULL_CIA, sim_exited,
796 (unsigned int)(A0 & 0xFFFFFFFF));
797 break;
798 }
799
800 case 28 : /* PMON flush_cache */
801 break;
802
803 case 55: /* void get_mem_info(unsigned int *ptr) */
804 /* in: A0 = pointer to three word memory location */
805 /* out: [A0 + 0] = size */
806 /* [A0 + 4] = instruction cache size */
807 /* [A0 + 8] = data cache size */
808 {
809 address_word value = MEM_SIZE /* FIXME STATE_MEM_SIZE (sd) */;
810 H2T (value);
811 sim_write (sd, A0, (char *)&value, sizeof (value));
812 /* sim_io_eprintf (sd, "sim: get_mem_info() depreciated\n"); */
813 break;
814 }
815
816 case 158 : /* PMON printf */
817 /* in: A0 = pointer to format string */
818 /* A1 = optional argument 1 */
819 /* A2 = optional argument 2 */
820 /* A3 = optional argument 3 */
821 /* out: void */
822 /* The following is based on the PMON printf source */
823 {
824 address_word s = A0;
825 char c;
826 signed_word *ap = &A1; /* 1st argument */
827 /* This isn't the quickest way, since we call the host print
828 routine for every character almost. But it does avoid
829 having to allocate and manage a temporary string buffer. */
830 /* TODO: Include check that we only use three arguments (A1,
831 A2 and A3) */
832 while (sim_read (sd, s++, &c, 1) && c != '\0')
833 {
834 if (c == '%')
835 {
836 char tmp[40];
837 enum {FMT_RJUST, FMT_LJUST, FMT_RJUST0, FMT_CENTER} fmt = FMT_RJUST;
838 int width = 0, trunc = 0, haddot = 0, longlong = 0;
839 while (sim_read (sd, s++, &c, 1) && c != '\0')
840 {
841 if (strchr ("dobxXulscefg%", s))
842 break;
843 else if (c == '-')
844 fmt = FMT_LJUST;
845 else if (c == '0')
846 fmt = FMT_RJUST0;
847 else if (c == '~')
848 fmt = FMT_CENTER;
849 else if (c == '*')
850 {
851 if (haddot)
852 trunc = (int)*ap++;
853 else
854 width = (int)*ap++;
855 }
856 else if (c >= '1' && c <= '9')
857 {
858 address_word t = s;
859 unsigned int n;
860 while (sim_read (sd, s++, &c, 1) == 1 && isdigit (c))
861 tmp[s - t] = c;
862 tmp[s - t] = '\0';
863 n = (unsigned int)strtol(tmp,NULL,10);
864 if (haddot)
865 trunc = n;
866 else
867 width = n;
868 s--;
869 }
870 else if (c == '.')
871 haddot = 1;
872 }
873 switch (c)
874 {
875 case '%':
876 sim_io_printf (sd, "%%");
877 break;
878 case 's':
879 if ((int)*ap != 0)
880 {
881 address_word p = *ap++;
882 char ch;
883 while (sim_read (sd, p++, &ch, 1) == 1 && ch != '\0')
884 sim_io_printf(sd, "%c", ch);
885 }
886 else
887 sim_io_printf(sd,"(null)");
888 break;
889 case 'c':
890 sim_io_printf (sd, "%c", (int)*ap++);
891 break;
892 default:
893 if (c == 'l')
894 {
895 sim_read (sd, s++, &c, 1);
896 if (c == 'l')
897 {
898 longlong = 1;
899 sim_read (sd, s++, &c, 1);
900 }
901 }
902 if (strchr ("dobxXu", c))
903 {
904 word64 lv = (word64) *ap++;
905 if (c == 'b')
906 sim_io_printf(sd,"<binary not supported>");
907 else
908 {
909 sprintf (tmp, "%%%s%c", longlong ? "ll" : "", c);
910 if (longlong)
911 sim_io_printf(sd, tmp, lv);
912 else
913 sim_io_printf(sd, tmp, (int)lv);
914 }
915 }
916 else if (strchr ("eEfgG", c))
917 {
918 double dbl = *(double*)(ap++);
919 sprintf (tmp, "%%%d.%d%c", width, trunc, c);
920 sim_io_printf (sd, tmp, dbl);
921 trunc = 0;
922 }
923 }
924 }
925 else
926 sim_io_printf(sd, "%c", c);
927 }
928 break;
929 }
930
931 default:
932 sim_io_error (sd, "TODO: sim_monitor(%d) : PC = 0x%s\n",
933 reason, pr_addr(cia));
934 break;
935 }
936 return;
937 }
938
939 /* Store a word into memory. */
940
941 static void
942 store_word (SIM_DESC sd,
943 sim_cpu *cpu,
944 address_word cia,
945 uword64 vaddr,
946 signed_word val)
947 {
948 address_word paddr;
949 int uncached;
950
951 if ((vaddr & 3) != 0)
952 SignalExceptionAddressStore ();
953 else
954 {
955 if (AddressTranslation (vaddr, isDATA, isSTORE, &paddr, &uncached,
956 isTARGET, isREAL))
957 {
958 const uword64 mask = 7;
959 uword64 memval;
960 unsigned int byte;
961
962 paddr = (paddr & ~mask) | ((paddr & mask) ^ (ReverseEndian << 2));
963 byte = (vaddr & mask) ^ (BigEndianCPU << 2);
964 memval = ((uword64) val) << (8 * byte);
965 StoreMemory (uncached, AccessLength_WORD, memval, 0, paddr, vaddr,
966 isREAL);
967 }
968 }
969 }
970
971 /* Load a word from memory. */
972
973 static signed_word
974 load_word (SIM_DESC sd,
975 sim_cpu *cpu,
976 address_word cia,
977 uword64 vaddr)
978 {
979 if ((vaddr & 3) != 0)
980 SignalExceptionAddressLoad ();
981 else
982 {
983 address_word paddr;
984 int uncached;
985
986 if (AddressTranslation (vaddr, isDATA, isLOAD, &paddr, &uncached,
987 isTARGET, isREAL))
988 {
989 const uword64 mask = 0x7;
990 const unsigned int reverse = ReverseEndian ? 1 : 0;
991 const unsigned int bigend = BigEndianCPU ? 1 : 0;
992 uword64 memval;
993 unsigned int byte;
994
995 paddr = (paddr & ~mask) | ((paddr & mask) ^ (reverse << 2));
996 LoadMemory (&memval,NULL,uncached, AccessLength_WORD, paddr, vaddr,
997 isDATA, isREAL);
998 byte = (vaddr & mask) ^ (bigend << 2);
999 return SIGNEXTEND (((memval >> (8 * byte)) & 0xffffffff), 32);
1000 }
1001 }
1002
1003 return 0;
1004 }
1005
1006 /* Simulate the mips16 entry and exit pseudo-instructions. These
1007 would normally be handled by the reserved instruction exception
1008 code, but for ease of simulation we just handle them directly. */
1009
1010 static void
1011 mips16_entry (SIM_DESC sd,
1012 sim_cpu *cpu,
1013 address_word cia,
1014 unsigned int insn)
1015 {
1016 int aregs, sregs, rreg;
1017
1018 #ifdef DEBUG
1019 printf("DBG: mips16_entry: entered (insn = 0x%08X)\n",insn);
1020 #endif /* DEBUG */
1021
1022 aregs = (insn & 0x700) >> 8;
1023 sregs = (insn & 0x0c0) >> 6;
1024 rreg = (insn & 0x020) >> 5;
1025
1026 /* This should be checked by the caller. */
1027 if (sregs == 3)
1028 abort ();
1029
1030 if (aregs < 5)
1031 {
1032 int i;
1033 signed_word tsp;
1034
1035 /* This is the entry pseudo-instruction. */
1036
1037 for (i = 0; i < aregs; i++)
1038 store_word (SD, CPU, cia, (uword64) (SP + 4 * i), GPR[i + 4]);
1039
1040 tsp = SP;
1041 SP -= 32;
1042
1043 if (rreg)
1044 {
1045 tsp -= 4;
1046 store_word (SD, CPU, cia, (uword64) tsp, RA);
1047 }
1048
1049 for (i = 0; i < sregs; i++)
1050 {
1051 tsp -= 4;
1052 store_word (SD, CPU, cia, (uword64) tsp, GPR[16 + i]);
1053 }
1054 }
1055 else
1056 {
1057 int i;
1058 signed_word tsp;
1059
1060 /* This is the exit pseudo-instruction. */
1061
1062 tsp = SP + 32;
1063
1064 if (rreg)
1065 {
1066 tsp -= 4;
1067 RA = load_word (SD, CPU, cia, (uword64) tsp);
1068 }
1069
1070 for (i = 0; i < sregs; i++)
1071 {
1072 tsp -= 4;
1073 GPR[i + 16] = load_word (SD, CPU, cia, (uword64) tsp);
1074 }
1075
1076 SP += 32;
1077
1078 if (CURRENT_FLOATING_POINT == HARD_FLOATING_POINT)
1079 {
1080 if (aregs == 5)
1081 {
1082 FGR[0] = WORD64LO (GPR[4]);
1083 FPR_STATE[0] = fmt_uninterpreted;
1084 }
1085 else if (aregs == 6)
1086 {
1087 FGR[0] = WORD64LO (GPR[5]);
1088 FGR[1] = WORD64LO (GPR[4]);
1089 FPR_STATE[0] = fmt_uninterpreted;
1090 FPR_STATE[1] = fmt_uninterpreted;
1091 }
1092 }
1093
1094 PC = RA;
1095 }
1096
1097 }
1098
1099 /*-- trace support ----------------------------------------------------------*/
1100
1101 /* The TRACE support is provided (if required) in the memory accessing
1102 routines. Since we are also providing the architecture specific
1103 features, the architecture simulation code can also deal with
1104 notifying the TRACE world of cache flushes, etc. Similarly we do
1105 not need to provide profiling support in the simulator engine,
1106 since we can sample in the instruction fetch control loop. By
1107 defining the TRACE manifest, we add tracing as a run-time
1108 option. */
1109
1110 #if defined(TRACE)
1111 /* Tracing by default produces "din" format (as required by
1112 dineroIII). Each line of such a trace file *MUST* have a din label
1113 and address field. The rest of the line is ignored, so comments can
1114 be included if desired. The first field is the label which must be
1115 one of the following values:
1116
1117 0 read data
1118 1 write data
1119 2 instruction fetch
1120 3 escape record (treated as unknown access type)
1121 4 escape record (causes cache flush)
1122
1123 The address field is a 32bit (lower-case) hexadecimal address
1124 value. The address should *NOT* be preceded by "0x".
1125
1126 The size of the memory transfer is not important when dealing with
1127 cache lines (as long as no more than a cache line can be
1128 transferred in a single operation :-), however more information
1129 could be given following the dineroIII requirement to allow more
1130 complete memory and cache simulators to provide better
1131 results. i.e. the University of Pisa has a cache simulator that can
1132 also take bus size and speed as (variable) inputs to calculate
1133 complete system performance (a much more useful ability when trying
1134 to construct an end product, rather than a processor). They
1135 currently have an ARM version of their tool called ChARM. */
1136
1137
1138 void
1139 dotrace (SIM_DESC sd,
1140 sim_cpu *cpu,
1141 FILE *tracefh,
1142 int type,
1143 SIM_ADDR address,
1144 int width,
1145 char *comment,...)
1146 {
1147 if (STATE & simTRACE) {
1148 va_list ap;
1149 fprintf(tracefh,"%d %s ; width %d ; ",
1150 type,
1151 pr_addr(address),
1152 width);
1153 va_start(ap,comment);
1154 vfprintf(tracefh,comment,ap);
1155 va_end(ap);
1156 fprintf(tracefh,"\n");
1157 }
1158 /* NOTE: Since the "din" format will only accept 32bit addresses, and
1159 we may be generating 64bit ones, we should put the hi-32bits of the
1160 address into the comment field. */
1161
1162 /* TODO: Provide a buffer for the trace lines. We can then avoid
1163 performing writes until the buffer is filled, or the file is
1164 being closed. */
1165
1166 /* NOTE: We could consider adding a comment field to the "din" file
1167 produced using type 3 markers (unknown access). This would then
1168 allow information about the program that the "din" is for, and
1169 the MIPs world that was being simulated, to be placed into the
1170 trace file. */
1171
1172 return;
1173 }
1174 #endif /* TRACE */
1175
1176 /*---------------------------------------------------------------------------*/
1177 /*-- simulator engine -------------------------------------------------------*/
1178 /*---------------------------------------------------------------------------*/
1179
1180 static void
1181 ColdReset (SIM_DESC sd)
1182 {
1183 int cpu_nr;
1184 for (cpu_nr = 0; cpu_nr < sim_engine_nr_cpus (sd); cpu_nr++)
1185 {
1186 sim_cpu *cpu = STATE_CPU (sd, cpu_nr);
1187 /* RESET: Fixed PC address: */
1188 PC = UNSIGNED64 (0xFFFFFFFFBFC00000);
1189 /* The reset vector address is in the unmapped, uncached memory space. */
1190
1191 SR &= ~(status_SR | status_TS | status_RP);
1192 SR |= (status_ERL | status_BEV);
1193
1194 /* Cheat and allow access to the complete register set immediately */
1195 if (CURRENT_FLOATING_POINT == HARD_FLOATING_POINT
1196 && WITH_TARGET_WORD_BITSIZE == 64)
1197 SR |= status_FR; /* 64bit registers */
1198
1199 /* Ensure that any instructions with pending register updates are
1200 cleared: */
1201 PENDING_INVALIDATE();
1202
1203 /* Initialise the FPU registers to the unknown state */
1204 if (CURRENT_FLOATING_POINT == HARD_FLOATING_POINT)
1205 {
1206 int rn;
1207 for (rn = 0; (rn < 32); rn++)
1208 FPR_STATE[rn] = fmt_uninterpreted;
1209 }
1210
1211 }
1212 }
1213
1214 /* Description from page A-22 of the "MIPS IV Instruction Set" manual
1215 (revision 3.1) */
1216 /* Translate a virtual address to a physical address and cache
1217 coherence algorithm describing the mechanism used to resolve the
1218 memory reference. Given the virtual address vAddr, and whether the
1219 reference is to Instructions ot Data (IorD), find the corresponding
1220 physical address (pAddr) and the cache coherence algorithm (CCA)
1221 used to resolve the reference. If the virtual address is in one of
1222 the unmapped address spaces the physical address and the CCA are
1223 determined directly by the virtual address. If the virtual address
1224 is in one of the mapped address spaces then the TLB is used to
1225 determine the physical address and access type; if the required
1226 translation is not present in the TLB or the desired access is not
1227 permitted the function fails and an exception is taken.
1228
1229 NOTE: Normally (RAW == 0), when address translation fails, this
1230 function raises an exception and does not return. */
1231
1232 int
1233 address_translation (SIM_DESC sd,
1234 sim_cpu *cpu,
1235 address_word cia,
1236 address_word vAddr,
1237 int IorD,
1238 int LorS,
1239 address_word *pAddr,
1240 int *CCA,
1241 int raw)
1242 {
1243 int res = -1; /* TRUE : Assume good return */
1244
1245 #ifdef DEBUG
1246 sim_io_printf(sd,"AddressTranslation(0x%s,%s,%s,...);\n",pr_addr(vAddr),(IorD ? "isDATA" : "isINSTRUCTION"),(LorS ? "iSTORE" : "isLOAD"));
1247 #endif
1248
1249 /* Check that the address is valid for this memory model */
1250
1251 /* For a simple (flat) memory model, we simply pass virtual
1252 addressess through (mostly) unchanged. */
1253 vAddr &= 0xFFFFFFFF;
1254
1255 *pAddr = vAddr; /* default for isTARGET */
1256 *CCA = Uncached; /* not used for isHOST */
1257
1258 return(res);
1259 }
1260
1261 /* Description from page A-23 of the "MIPS IV Instruction Set" manual
1262 (revision 3.1) */
1263 /* Prefetch data from memory. Prefetch is an advisory instruction for
1264 which an implementation specific action is taken. The action taken
1265 may increase performance, but must not change the meaning of the
1266 program, or alter architecturally-visible state. */
1267
1268 void
1269 prefetch (SIM_DESC sd,
1270 sim_cpu *cpu,
1271 address_word cia,
1272 int CCA,
1273 address_word pAddr,
1274 address_word vAddr,
1275 int DATA,
1276 int hint)
1277 {
1278 #ifdef DEBUG
1279 sim_io_printf(sd,"Prefetch(%d,0x%s,0x%s,%d,%d);\n",CCA,pr_addr(pAddr),pr_addr(vAddr),DATA,hint);
1280 #endif /* DEBUG */
1281
1282 /* For our simple memory model we do nothing */
1283 return;
1284 }
1285
1286 /* Description from page A-22 of the "MIPS IV Instruction Set" manual
1287 (revision 3.1) */
1288 /* Load a value from memory. Use the cache and main memory as
1289 specified in the Cache Coherence Algorithm (CCA) and the sort of
1290 access (IorD) to find the contents of AccessLength memory bytes
1291 starting at physical location pAddr. The data is returned in the
1292 fixed width naturally-aligned memory element (MemElem). The
1293 low-order two (or three) bits of the address and the AccessLength
1294 indicate which of the bytes within MemElem needs to be given to the
1295 processor. If the memory access type of the reference is uncached
1296 then only the referenced bytes are read from memory and valid
1297 within the memory element. If the access type is cached, and the
1298 data is not present in cache, an implementation specific size and
1299 alignment block of memory is read and loaded into the cache to
1300 satisfy a load reference. At a minimum, the block is the entire
1301 memory element. */
1302 void
1303 load_memory (SIM_DESC sd,
1304 sim_cpu *cpu,
1305 address_word cia,
1306 uword64* memvalp,
1307 uword64* memval1p,
1308 int CCA,
1309 int AccessLength,
1310 address_word pAddr,
1311 address_word vAddr,
1312 int IorD)
1313 {
1314 uword64 value = 0;
1315 uword64 value1 = 0;
1316
1317 #ifdef DEBUG
1318 sim_io_printf(sd,"DBG: LoadMemory(%p,%p,%d,%d,0x%s,0x%s,%s)\n",memvalp,memval1p,CCA,AccessLength,pr_addr(pAddr),pr_addr(vAddr),(IorD ? "isDATA" : "isINSTRUCTION"));
1319 #endif /* DEBUG */
1320
1321 #if defined(WARN_MEM)
1322 if (CCA != uncached)
1323 sim_io_eprintf(sd,"LoadMemory CCA (%d) is not uncached (currently all accesses treated as cached)\n",CCA);
1324 #endif /* WARN_MEM */
1325
1326 /* If instruction fetch then we need to check that the two lo-order
1327 bits are zero, otherwise raise a InstructionFetch exception: */
1328 if ((IorD == isINSTRUCTION)
1329 && ((pAddr & 0x3) != 0)
1330 && (((pAddr & 0x1) != 0) || ((vAddr & 0x1) == 0)))
1331 SignalExceptionInstructionFetch ();
1332
1333 if (((pAddr & LOADDRMASK) + AccessLength) > LOADDRMASK)
1334 {
1335 /* In reality this should be a Bus Error */
1336 sim_io_error (sd, "AccessLength of %d would extend over %dbit aligned boundary for physical address 0x%s\n",
1337 AccessLength,
1338 (LOADDRMASK + 1) << 2,
1339 pr_addr (pAddr));
1340 }
1341
1342 #if defined(TRACE)
1343 dotrace (SD, CPU, tracefh,((IorD == isDATA) ? 0 : 2),(unsigned int)(pAddr&0xFFFFFFFF),(AccessLength + 1),"load%s",((IorD == isDATA) ? "" : " instruction"));
1344 #endif /* TRACE */
1345
1346 /* Read the specified number of bytes from memory. Adjust for
1347 host/target byte ordering/ Align the least significant byte
1348 read. */
1349
1350 switch (AccessLength)
1351 {
1352 case AccessLength_QUADWORD :
1353 {
1354 unsigned_16 val = sim_core_read_aligned_16 (cpu, NULL_CIA,
1355 sim_core_read_map, pAddr);
1356 value1 = VH8_16 (val);
1357 value = VL8_16 (val);
1358 break;
1359 }
1360 case AccessLength_DOUBLEWORD :
1361 value = sim_core_read_aligned_8 (cpu, NULL_CIA,
1362 sim_core_read_map, pAddr);
1363 break;
1364 case AccessLength_SEPTIBYTE :
1365 value = sim_core_read_misaligned_7 (cpu, NULL_CIA,
1366 sim_core_read_map, pAddr);
1367 case AccessLength_SEXTIBYTE :
1368 value = sim_core_read_misaligned_6 (cpu, NULL_CIA,
1369 sim_core_read_map, pAddr);
1370 case AccessLength_QUINTIBYTE :
1371 value = sim_core_read_misaligned_5 (cpu, NULL_CIA,
1372 sim_core_read_map, pAddr);
1373 case AccessLength_WORD :
1374 value = sim_core_read_aligned_4 (cpu, NULL_CIA,
1375 sim_core_read_map, pAddr);
1376 break;
1377 case AccessLength_TRIPLEBYTE :
1378 value = sim_core_read_misaligned_3 (cpu, NULL_CIA,
1379 sim_core_read_map, pAddr);
1380 case AccessLength_HALFWORD :
1381 value = sim_core_read_aligned_2 (cpu, NULL_CIA,
1382 sim_core_read_map, pAddr);
1383 break;
1384 case AccessLength_BYTE :
1385 value = sim_core_read_aligned_1 (cpu, NULL_CIA,
1386 sim_core_read_map, pAddr);
1387 break;
1388 default:
1389 abort ();
1390 }
1391
1392 #ifdef DEBUG
1393 printf("DBG: LoadMemory() : (offset %d) : value = 0x%s%s\n",
1394 (int)(pAddr & LOADDRMASK),pr_uword64(value1),pr_uword64(value));
1395 #endif /* DEBUG */
1396
1397 /* See also store_memory. */
1398 if (AccessLength <= AccessLength_DOUBLEWORD)
1399 {
1400 if (BigEndianMem)
1401 /* for big endian target, byte (pAddr&LOADDRMASK == 0) is
1402 shifted to the most significant byte position. */
1403 value <<= (((7 - (pAddr & LOADDRMASK)) - AccessLength) * 8);
1404 else
1405 /* For little endian target, byte (pAddr&LOADDRMASK == 0)
1406 is already in the correct postition. */
1407 value <<= ((pAddr & LOADDRMASK) * 8);
1408 }
1409
1410 #ifdef DEBUG
1411 printf("DBG: LoadMemory() : shifted value = 0x%s%s\n",
1412 pr_uword64(value1),pr_uword64(value));
1413 #endif /* DEBUG */
1414
1415 *memvalp = value;
1416 if (memval1p) *memval1p = value1;
1417 }
1418
1419
1420 /* Description from page A-23 of the "MIPS IV Instruction Set" manual
1421 (revision 3.1) */
1422 /* Store a value to memory. The specified data is stored into the
1423 physical location pAddr using the memory hierarchy (data caches and
1424 main memory) as specified by the Cache Coherence Algorithm
1425 (CCA). The MemElem contains the data for an aligned, fixed-width
1426 memory element (word for 32-bit processors, doubleword for 64-bit
1427 processors), though only the bytes that will actually be stored to
1428 memory need to be valid. The low-order two (or three) bits of pAddr
1429 and the AccessLength field indicates which of the bytes within the
1430 MemElem data should actually be stored; only these bytes in memory
1431 will be changed. */
1432
1433 void
1434 store_memory (SIM_DESC sd,
1435 sim_cpu *cpu,
1436 address_word cia,
1437 int CCA,
1438 int AccessLength,
1439 uword64 MemElem,
1440 uword64 MemElem1, /* High order 64 bits */
1441 address_word pAddr,
1442 address_word vAddr)
1443 {
1444 #ifdef DEBUG
1445 sim_io_printf(sd,"DBG: StoreMemory(%d,%d,0x%s,0x%s,0x%s,0x%s)\n",CCA,AccessLength,pr_uword64(MemElem),pr_uword64(MemElem1),pr_addr(pAddr),pr_addr(vAddr));
1446 #endif /* DEBUG */
1447
1448 #if defined(WARN_MEM)
1449 if (CCA != uncached)
1450 sim_io_eprintf(sd,"StoreMemory CCA (%d) is not uncached (currently all accesses treated as cached)\n",CCA);
1451 #endif /* WARN_MEM */
1452
1453 if (((pAddr & LOADDRMASK) + AccessLength) > LOADDRMASK)
1454 sim_io_error(sd,"AccessLength of %d would extend over %dbit aligned boundary for physical address 0x%s\n",AccessLength,(LOADDRMASK + 1)<<2,pr_addr(pAddr));
1455
1456 #if defined(TRACE)
1457 dotrace (SD, CPU, tracefh,1,(unsigned int)(pAddr&0xFFFFFFFF),(AccessLength + 1),"store");
1458 #endif /* TRACE */
1459
1460 #ifdef DEBUG
1461 printf("DBG: StoreMemory: offset = %d MemElem = 0x%s%s\n",(unsigned int)(pAddr & LOADDRMASK),pr_uword64(MemElem1),pr_uword64(MemElem));
1462 #endif /* DEBUG */
1463
1464 /* See also load_memory */
1465 if (AccessLength <= AccessLength_DOUBLEWORD)
1466 {
1467 if (BigEndianMem)
1468 /* for big endian target, byte (pAddr&LOADDRMASK == 0) is
1469 shifted to the most significant byte position. */
1470 MemElem >>= (((7 - (pAddr & LOADDRMASK)) - AccessLength) * 8);
1471 else
1472 /* For little endian target, byte (pAddr&LOADDRMASK == 0)
1473 is already in the correct postition. */
1474 MemElem >>= ((pAddr & LOADDRMASK) * 8);
1475 }
1476
1477 #ifdef DEBUG
1478 printf("DBG: StoreMemory: shift = %d MemElem = 0x%s%s\n",shift,pr_uword64(MemElem1),pr_uword64(MemElem));
1479 #endif /* DEBUG */
1480
1481 switch (AccessLength)
1482 {
1483 case AccessLength_QUADWORD :
1484 {
1485 unsigned_16 val = U16_8 (MemElem1, MemElem);
1486 sim_core_write_aligned_16 (cpu, NULL_CIA,
1487 sim_core_write_map, pAddr, val);
1488 break;
1489 }
1490 case AccessLength_DOUBLEWORD :
1491 sim_core_write_aligned_8 (cpu, NULL_CIA,
1492 sim_core_write_map, pAddr, MemElem);
1493 break;
1494 case AccessLength_SEPTIBYTE :
1495 sim_core_write_misaligned_7 (cpu, NULL_CIA,
1496 sim_core_write_map, pAddr, MemElem);
1497 break;
1498 case AccessLength_SEXTIBYTE :
1499 sim_core_write_misaligned_6 (cpu, NULL_CIA,
1500 sim_core_write_map, pAddr, MemElem);
1501 break;
1502 case AccessLength_QUINTIBYTE :
1503 sim_core_write_misaligned_5 (cpu, NULL_CIA,
1504 sim_core_write_map, pAddr, MemElem);
1505 break;
1506 case AccessLength_WORD :
1507 sim_core_write_aligned_4 (cpu, NULL_CIA,
1508 sim_core_write_map, pAddr, MemElem);
1509 break;
1510 case AccessLength_TRIPLEBYTE :
1511 sim_core_write_misaligned_3 (cpu, NULL_CIA,
1512 sim_core_write_map, pAddr, MemElem);
1513 break;
1514 case AccessLength_HALFWORD :
1515 sim_core_write_aligned_2 (cpu, NULL_CIA,
1516 sim_core_write_map, pAddr, MemElem);
1517 break;
1518 case AccessLength_BYTE :
1519 sim_core_write_aligned_1 (cpu, NULL_CIA,
1520 sim_core_write_map, pAddr, MemElem);
1521 break;
1522 default:
1523 abort ();
1524 }
1525
1526 return;
1527 }
1528
1529
1530 unsigned32
1531 ifetch32 (SIM_DESC sd,
1532 sim_cpu *cpu,
1533 address_word cia,
1534 address_word vaddr)
1535 {
1536 /* Copy the action of the LW instruction */
1537 address_word reverse = (ReverseEndian ? (LOADDRMASK >> 2) : 0);
1538 address_word bigend = (BigEndianCPU ? (LOADDRMASK >> 2) : 0);
1539 unsigned64 value;
1540 address_word paddr;
1541 unsigned32 instruction;
1542 unsigned byte;
1543 int cca;
1544 AddressTranslation (vaddr, isINSTRUCTION, isLOAD, &paddr, &cca, isTARGET, isREAL);
1545 paddr = ((paddr & ~LOADDRMASK) | ((paddr & LOADDRMASK) ^ (reverse << 2)));
1546 LoadMemory (&value, NULL, cca, AccessLength_WORD, paddr, vaddr, isINSTRUCTION, isREAL);
1547 byte = ((vaddr & LOADDRMASK) ^ (bigend << 2));
1548 instruction = ((value >> (8 * byte)) & 0xFFFFFFFF);
1549 return instruction;
1550 }
1551
1552
1553 /* Description from page A-26 of the "MIPS IV Instruction Set" manual (revision 3.1) */
1554 /* Order loads and stores to synchronise shared memory. Perform the
1555 action necessary to make the effects of groups of synchronizable
1556 loads and stores indicated by stype occur in the same order for all
1557 processors. */
1558 void
1559 sync_operation (SIM_DESC sd,
1560 sim_cpu *cpu,
1561 address_word cia,
1562 int stype)
1563 {
1564 #ifdef DEBUG
1565 sim_io_printf(sd,"SyncOperation(%d) : TODO\n",stype);
1566 #endif /* DEBUG */
1567 return;
1568 }
1569
1570 /* Description from page A-26 of the "MIPS IV Instruction Set" manual (revision 3.1) */
1571 /* Signal an exception condition. This will result in an exception
1572 that aborts the instruction. The instruction operation pseudocode
1573 will never see a return from this function call. */
1574
1575 void
1576 signal_exception (SIM_DESC sd,
1577 sim_cpu *cpu,
1578 address_word cia,
1579 int exception,...)
1580 {
1581 int vector;
1582
1583 #ifdef DEBUG
1584 sim_io_printf(sd,"DBG: SignalException(%d) PC = 0x%s\n",exception,pr_addr(cia));
1585 #endif /* DEBUG */
1586
1587 /* Ensure that any active atomic read/modify/write operation will fail: */
1588 LLBIT = 0;
1589
1590 switch (exception) {
1591 /* TODO: For testing purposes I have been ignoring TRAPs. In
1592 reality we should either simulate them, or allow the user to
1593 ignore them at run-time.
1594 Same for SYSCALL */
1595 case Trap :
1596 sim_io_eprintf(sd,"Ignoring instruction TRAP (PC 0x%s)\n",pr_addr(cia));
1597 break;
1598
1599 case SystemCall :
1600 {
1601 va_list ap;
1602 unsigned int instruction;
1603 unsigned int code;
1604
1605 va_start(ap,exception);
1606 instruction = va_arg(ap,unsigned int);
1607 va_end(ap);
1608
1609 code = (instruction >> 6) & 0xFFFFF;
1610
1611 sim_io_eprintf(sd,"Ignoring instruction `syscall %d' (PC 0x%s)\n",
1612 code, pr_addr(cia));
1613 }
1614 break;
1615
1616 case DebugBreakPoint :
1617 if (! (Debug & Debug_DM))
1618 {
1619 if (INDELAYSLOT())
1620 {
1621 CANCELDELAYSLOT();
1622
1623 Debug |= Debug_DBD; /* signaled from within in delay slot */
1624 DEPC = cia - 4; /* reference the branch instruction */
1625 }
1626 else
1627 {
1628 Debug &= ~Debug_DBD; /* not signaled from within a delay slot */
1629 DEPC = cia;
1630 }
1631
1632 Debug |= Debug_DM; /* in debugging mode */
1633 Debug |= Debug_DBp; /* raising a DBp exception */
1634 PC = 0xBFC00200;
1635 sim_engine_restart (SD, CPU, NULL, NULL_CIA);
1636 }
1637 break;
1638
1639 case ReservedInstruction :
1640 {
1641 va_list ap;
1642 unsigned int instruction;
1643 va_start(ap,exception);
1644 instruction = va_arg(ap,unsigned int);
1645 va_end(ap);
1646 /* Provide simple monitor support using ReservedInstruction
1647 exceptions. The following code simulates the fixed vector
1648 entry points into the IDT monitor by causing a simulator
1649 trap, performing the monitor operation, and returning to
1650 the address held in the $ra register (standard PCS return
1651 address). This means we only need to pre-load the vector
1652 space with suitable instruction values. For systems were
1653 actual trap instructions are used, we would not need to
1654 perform this magic. */
1655 if ((instruction & RSVD_INSTRUCTION_MASK) == RSVD_INSTRUCTION)
1656 {
1657 sim_monitor (SD, CPU, cia, ((instruction >> RSVD_INSTRUCTION_ARG_SHIFT) & RSVD_INSTRUCTION_ARG_MASK) );
1658 /* NOTE: This assumes that a branch-and-link style
1659 instruction was used to enter the vector (which is the
1660 case with the current IDT monitor). */
1661 sim_engine_restart (SD, CPU, NULL, RA);
1662 }
1663 /* Look for the mips16 entry and exit instructions, and
1664 simulate a handler for them. */
1665 else if ((cia & 1) != 0
1666 && (instruction & 0xf81f) == 0xe809
1667 && (instruction & 0x0c0) != 0x0c0)
1668 {
1669 mips16_entry (SD, CPU, cia, instruction);
1670 sim_engine_restart (sd, NULL, NULL, NULL_CIA);
1671 }
1672 /* else fall through to normal exception processing */
1673 sim_io_eprintf(sd,"ReservedInstruction 0x%08X at PC = 0x%s\n",instruction,pr_addr(cia));
1674 }
1675
1676 case BreakPoint:
1677 #ifdef DEBUG
1678 sim_io_printf(sd,"DBG: SignalException(%d) PC = 0x%s\n",exception,pr_addr(cia));
1679 #endif /* DEBUG */
1680 /* Keep a copy of the current A0 in-case this is the program exit
1681 breakpoint: */
1682 {
1683 va_list ap;
1684 unsigned int instruction;
1685 va_start(ap,exception);
1686 instruction = va_arg(ap,unsigned int);
1687 va_end(ap);
1688 /* Check for our special terminating BREAK: */
1689 if ((instruction & 0x03FFFFC0) == 0x03ff0000) {
1690 sim_engine_halt (SD, CPU, NULL, cia,
1691 sim_exited, (unsigned int)(A0 & 0xFFFFFFFF));
1692 }
1693 }
1694 if (STATE & simDELAYSLOT)
1695 PC = cia - 4; /* reference the branch instruction */
1696 else
1697 PC = cia;
1698 sim_engine_halt (SD, CPU, NULL, cia,
1699 sim_stopped, SIM_SIGTRAP);
1700
1701 default:
1702 /* Store exception code into current exception id variable (used
1703 by exit code): */
1704
1705 /* TODO: If not simulating exceptions then stop the simulator
1706 execution. At the moment we always stop the simulation. */
1707
1708 /* See figure 5-17 for an outline of the code below */
1709 if (! (SR & status_EXL))
1710 {
1711 CAUSE = (exception << 2);
1712 if (STATE & simDELAYSLOT)
1713 {
1714 STATE &= ~simDELAYSLOT;
1715 CAUSE |= cause_BD;
1716 EPC = (cia - 4); /* reference the branch instruction */
1717 }
1718 else
1719 EPC = cia;
1720 /* FIXME: TLB et.al. */
1721 vector = 0x180;
1722 }
1723 else
1724 {
1725 CAUSE = (exception << 2);
1726 vector = 0x180;
1727 }
1728 SR |= status_EXL;
1729 /* Store exception code into current exception id variable (used
1730 by exit code): */
1731 if (SR & status_BEV)
1732 PC = (signed)0xBFC00200 + 0x180;
1733 else
1734 PC = (signed)0x80000000 + 0x180;
1735
1736 switch ((CAUSE >> 2) & 0x1F)
1737 {
1738 case Interrupt:
1739 /* Interrupts arrive during event processing, no need to
1740 restart */
1741 return;
1742
1743 case TLBModification:
1744 case TLBLoad:
1745 case TLBStore:
1746 case AddressLoad:
1747 case AddressStore:
1748 case InstructionFetch:
1749 case DataReference:
1750 /* The following is so that the simulator will continue from the
1751 exception address on breakpoint operations. */
1752 PC = EPC;
1753 sim_engine_halt (SD, CPU, NULL, NULL_CIA,
1754 sim_stopped, SIM_SIGBUS);
1755
1756 case ReservedInstruction:
1757 case CoProcessorUnusable:
1758 PC = EPC;
1759 sim_engine_halt (SD, CPU, NULL, NULL_CIA,
1760 sim_stopped, SIM_SIGILL);
1761
1762 case IntegerOverflow:
1763 case FPE:
1764 sim_engine_halt (SD, CPU, NULL, NULL_CIA,
1765 sim_stopped, SIM_SIGFPE);
1766
1767 case Trap:
1768 case Watch:
1769 case SystemCall:
1770 PC = EPC;
1771 sim_engine_halt (SD, CPU, NULL, NULL_CIA,
1772 sim_stopped, SIM_SIGTRAP);
1773
1774 case BreakPoint:
1775 PC = EPC;
1776 sim_engine_abort (SD, CPU, NULL_CIA,
1777 "FATAL: Should not encounter a breakpoint\n");
1778
1779 default : /* Unknown internal exception */
1780 PC = EPC;
1781 sim_engine_halt (SD, CPU, NULL, NULL_CIA,
1782 sim_stopped, SIM_SIGABRT);
1783
1784 }
1785
1786 case SimulatorFault:
1787 {
1788 va_list ap;
1789 char *msg;
1790 va_start(ap,exception);
1791 msg = va_arg(ap,char *);
1792 va_end(ap);
1793 sim_engine_abort (SD, CPU, NULL_CIA,
1794 "FATAL: Simulator error \"%s\"\n",msg);
1795 }
1796 }
1797
1798 return;
1799 }
1800
1801 #if defined(WARN_RESULT)
1802 /* Description from page A-26 of the "MIPS IV Instruction Set" manual (revision 3.1) */
1803 /* This function indicates that the result of the operation is
1804 undefined. However, this should not affect the instruction
1805 stream. All that is meant to happen is that the destination
1806 register is set to an undefined result. To keep the simulator
1807 simple, we just don't bother updating the destination register, so
1808 the overall result will be undefined. If desired we can stop the
1809 simulator by raising a pseudo-exception. */
1810 #define UndefinedResult() undefined_result (sd,cia)
1811 static void
1812 undefined_result(sd,cia)
1813 SIM_DESC sd;
1814 address_word cia;
1815 {
1816 sim_io_eprintf(sd,"UndefinedResult: PC = 0x%s\n",pr_addr(cia));
1817 #if 0 /* Disabled for the moment, since it actually happens a lot at the moment. */
1818 state |= simSTOP;
1819 #endif
1820 return;
1821 }
1822 #endif /* WARN_RESULT */
1823
1824 void
1825 cache_op (SIM_DESC sd,
1826 sim_cpu *cpu,
1827 address_word cia,
1828 int op,
1829 address_word pAddr,
1830 address_word vAddr,
1831 unsigned int instruction)
1832 {
1833 #if 1 /* stop warning message being displayed (we should really just remove the code) */
1834 static int icache_warning = 1;
1835 static int dcache_warning = 1;
1836 #else
1837 static int icache_warning = 0;
1838 static int dcache_warning = 0;
1839 #endif
1840
1841 /* If CP0 is not useable (User or Supervisor mode) and the CP0
1842 enable bit in the Status Register is clear - a coprocessor
1843 unusable exception is taken. */
1844 #if 0
1845 sim_io_printf(sd,"TODO: Cache availability checking (PC = 0x%s)\n",pr_addr(cia));
1846 #endif
1847
1848 switch (op & 0x3) {
1849 case 0: /* instruction cache */
1850 switch (op >> 2) {
1851 case 0: /* Index Invalidate */
1852 case 1: /* Index Load Tag */
1853 case 2: /* Index Store Tag */
1854 case 4: /* Hit Invalidate */
1855 case 5: /* Fill */
1856 case 6: /* Hit Writeback */
1857 if (!icache_warning)
1858 {
1859 sim_io_eprintf(sd,"Instruction CACHE operation %d to be coded\n",(op >> 2));
1860 icache_warning = 1;
1861 }
1862 break;
1863
1864 default:
1865 SignalException(ReservedInstruction,instruction);
1866 break;
1867 }
1868 break;
1869
1870 case 1: /* data cache */
1871 switch (op >> 2) {
1872 case 0: /* Index Writeback Invalidate */
1873 case 1: /* Index Load Tag */
1874 case 2: /* Index Store Tag */
1875 case 3: /* Create Dirty */
1876 case 4: /* Hit Invalidate */
1877 case 5: /* Hit Writeback Invalidate */
1878 case 6: /* Hit Writeback */
1879 if (!dcache_warning)
1880 {
1881 sim_io_eprintf(sd,"Data CACHE operation %d to be coded\n",(op >> 2));
1882 dcache_warning = 1;
1883 }
1884 break;
1885
1886 default:
1887 SignalException(ReservedInstruction,instruction);
1888 break;
1889 }
1890 break;
1891
1892 default: /* unrecognised cache ID */
1893 SignalException(ReservedInstruction,instruction);
1894 break;
1895 }
1896
1897 return;
1898 }
1899
1900 /*-- FPU support routines ---------------------------------------------------*/
1901
1902 /* Numbers are held in normalized form. The SINGLE and DOUBLE binary
1903 formats conform to ANSI/IEEE Std 754-1985. */
1904 /* SINGLE precision floating:
1905 * seeeeeeeefffffffffffffffffffffff
1906 * s = 1bit = sign
1907 * e = 8bits = exponent
1908 * f = 23bits = fraction
1909 */
1910 /* SINGLE precision fixed:
1911 * siiiiiiiiiiiiiiiiiiiiiiiiiiiiiii
1912 * s = 1bit = sign
1913 * i = 31bits = integer
1914 */
1915 /* DOUBLE precision floating:
1916 * seeeeeeeeeeeffffffffffffffffffffffffffffffffffffffffffffffffffff
1917 * s = 1bit = sign
1918 * e = 11bits = exponent
1919 * f = 52bits = fraction
1920 */
1921 /* DOUBLE precision fixed:
1922 * siiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiiii
1923 * s = 1bit = sign
1924 * i = 63bits = integer
1925 */
1926
1927 /* Extract sign-bit: */
1928 #define FP_S_s(v) (((v) & ((unsigned)1 << 31)) ? 1 : 0)
1929 #define FP_D_s(v) (((v) & ((uword64)1 << 63)) ? 1 : 0)
1930 /* Extract biased exponent: */
1931 #define FP_S_be(v) (((v) >> 23) & 0xFF)
1932 #define FP_D_be(v) (((v) >> 52) & 0x7FF)
1933 /* Extract unbiased Exponent: */
1934 #define FP_S_e(v) (FP_S_be(v) - 0x7F)
1935 #define FP_D_e(v) (FP_D_be(v) - 0x3FF)
1936 /* Extract complete fraction field: */
1937 #define FP_S_f(v) ((v) & ~((unsigned)0x1FF << 23))
1938 #define FP_D_f(v) ((v) & ~((uword64)0xFFF << 52))
1939 /* Extract numbered fraction bit: */
1940 #define FP_S_fb(b,v) (((v) & (1 << (23 - (b)))) ? 1 : 0)
1941 #define FP_D_fb(b,v) (((v) & (1 << (52 - (b)))) ? 1 : 0)
1942
1943 /* Explicit QNaN values used when value required: */
1944 #define FPQNaN_SINGLE (0x7FBFFFFF)
1945 #define FPQNaN_WORD (0x7FFFFFFF)
1946 #define FPQNaN_DOUBLE (((uword64)0x7FF7FFFF << 32) | 0xFFFFFFFF)
1947 #define FPQNaN_LONG (((uword64)0x7FFFFFFF << 32) | 0xFFFFFFFF)
1948
1949 /* Explicit Infinity values used when required: */
1950 #define FPINF_SINGLE (0x7F800000)
1951 #define FPINF_DOUBLE (((uword64)0x7FF00000 << 32) | 0x00000000)
1952
1953 #if 1 /* def DEBUG */
1954 #define RMMODE(v) (((v) == FP_RM_NEAREST) ? "Round" : (((v) == FP_RM_TOZERO) ? "Trunc" : (((v) == FP_RM_TOPINF) ? "Ceil" : "Floor")))
1955 #define DOFMT(v) (((v) == fmt_single) ? "single" : (((v) == fmt_double) ? "double" : (((v) == fmt_word) ? "word" : (((v) == fmt_long) ? "long" : (((v) == fmt_unknown) ? "<unknown>" : (((v) == fmt_uninterpreted) ? "<uninterpreted>" : "<format error>"))))))
1956 #endif /* DEBUG */
1957
1958 uword64
1959 value_fpr (SIM_DESC sd,
1960 sim_cpu *cpu,
1961 address_word cia,
1962 int fpr,
1963 FP_formats fmt)
1964 {
1965 uword64 value = 0;
1966 int err = 0;
1967
1968 /* Treat unused register values, as fixed-point 64bit values: */
1969 if ((fmt == fmt_uninterpreted) || (fmt == fmt_unknown))
1970 #if 1
1971 /* If request to read data as "uninterpreted", then use the current
1972 encoding: */
1973 fmt = FPR_STATE[fpr];
1974 #else
1975 fmt = fmt_long;
1976 #endif
1977
1978 /* For values not yet accessed, set to the desired format: */
1979 if (FPR_STATE[fpr] == fmt_uninterpreted) {
1980 FPR_STATE[fpr] = fmt;
1981 #ifdef DEBUG
1982 printf("DBG: Register %d was fmt_uninterpreted. Now %s\n",fpr,DOFMT(fmt));
1983 #endif /* DEBUG */
1984 }
1985 if (fmt != FPR_STATE[fpr]) {
1986 sim_io_eprintf(sd,"FPR %d (format %s) being accessed with format %s - setting to unknown (PC = 0x%s)\n",fpr,DOFMT(FPR_STATE[fpr]),DOFMT(fmt),pr_addr(cia));
1987 FPR_STATE[fpr] = fmt_unknown;
1988 }
1989
1990 if (FPR_STATE[fpr] == fmt_unknown) {
1991 /* Set QNaN value: */
1992 switch (fmt) {
1993 case fmt_single:
1994 value = FPQNaN_SINGLE;
1995 break;
1996
1997 case fmt_double:
1998 value = FPQNaN_DOUBLE;
1999 break;
2000
2001 case fmt_word:
2002 value = FPQNaN_WORD;
2003 break;
2004
2005 case fmt_long:
2006 value = FPQNaN_LONG;
2007 break;
2008
2009 default:
2010 err = -1;
2011 break;
2012 }
2013 } else if (SizeFGR() == 64) {
2014 switch (fmt) {
2015 case fmt_single:
2016 case fmt_word:
2017 value = (FGR[fpr] & 0xFFFFFFFF);
2018 break;
2019
2020 case fmt_uninterpreted:
2021 case fmt_double:
2022 case fmt_long:
2023 value = FGR[fpr];
2024 break;
2025
2026 default :
2027 err = -1;
2028 break;
2029 }
2030 } else {
2031 switch (fmt) {
2032 case fmt_single:
2033 case fmt_word:
2034 value = (FGR[fpr] & 0xFFFFFFFF);
2035 break;
2036
2037 case fmt_uninterpreted:
2038 case fmt_double:
2039 case fmt_long:
2040 if ((fpr & 1) == 0) { /* even registers only */
2041 value = ((((uword64)FGR[fpr+1]) << 32) | (FGR[fpr] & 0xFFFFFFFF));
2042 } else {
2043 SignalException(ReservedInstruction,0);
2044 }
2045 break;
2046
2047 default :
2048 err = -1;
2049 break;
2050 }
2051 }
2052
2053 if (err)
2054 SignalExceptionSimulatorFault ("Unrecognised FP format in ValueFPR()");
2055
2056 #ifdef DEBUG
2057 printf("DBG: ValueFPR: fpr = %d, fmt = %s, value = 0x%s : PC = 0x%s : SizeFGR() = %d\n",fpr,DOFMT(fmt),pr_addr(value),pr_addr(cia),SizeFGR());
2058 #endif /* DEBUG */
2059
2060 return(value);
2061 }
2062
2063 void
2064 store_fpr (SIM_DESC sd,
2065 sim_cpu *cpu,
2066 address_word cia,
2067 int fpr,
2068 FP_formats fmt,
2069 uword64 value)
2070 {
2071 int err = 0;
2072
2073 #ifdef DEBUG
2074 printf("DBG: StoreFPR: fpr = %d, fmt = %s, value = 0x%s : PC = 0x%s : SizeFGR() = %d\n",fpr,DOFMT(fmt),pr_addr(value),pr_addr(cia),SizeFGR());
2075 #endif /* DEBUG */
2076
2077 if (SizeFGR() == 64) {
2078 switch (fmt) {
2079 case fmt_uninterpreted_32:
2080 fmt = fmt_uninterpreted;
2081 case fmt_single :
2082 case fmt_word :
2083 FGR[fpr] = (((uword64)0xDEADC0DE << 32) | (value & 0xFFFFFFFF));
2084 FPR_STATE[fpr] = fmt;
2085 break;
2086
2087 case fmt_uninterpreted_64:
2088 fmt = fmt_uninterpreted;
2089 case fmt_uninterpreted:
2090 case fmt_double :
2091 case fmt_long :
2092 FGR[fpr] = value;
2093 FPR_STATE[fpr] = fmt;
2094 break;
2095
2096 default :
2097 FPR_STATE[fpr] = fmt_unknown;
2098 err = -1;
2099 break;
2100 }
2101 } else {
2102 switch (fmt) {
2103 case fmt_uninterpreted_32:
2104 fmt = fmt_uninterpreted;
2105 case fmt_single :
2106 case fmt_word :
2107 FGR[fpr] = (value & 0xFFFFFFFF);
2108 FPR_STATE[fpr] = fmt;
2109 break;
2110
2111 case fmt_uninterpreted_64:
2112 fmt = fmt_uninterpreted;
2113 case fmt_uninterpreted:
2114 case fmt_double :
2115 case fmt_long :
2116 if ((fpr & 1) == 0) { /* even register number only */
2117 FGR[fpr+1] = (value >> 32);
2118 FGR[fpr] = (value & 0xFFFFFFFF);
2119 FPR_STATE[fpr + 1] = fmt;
2120 FPR_STATE[fpr] = fmt;
2121 } else {
2122 FPR_STATE[fpr] = fmt_unknown;
2123 FPR_STATE[fpr + 1] = fmt_unknown;
2124 SignalException(ReservedInstruction,0);
2125 }
2126 break;
2127
2128 default :
2129 FPR_STATE[fpr] = fmt_unknown;
2130 err = -1;
2131 break;
2132 }
2133 }
2134 #if defined(WARN_RESULT)
2135 else
2136 UndefinedResult();
2137 #endif /* WARN_RESULT */
2138
2139 if (err)
2140 SignalExceptionSimulatorFault ("Unrecognised FP format in StoreFPR()");
2141
2142 #ifdef DEBUG
2143 printf("DBG: StoreFPR: fpr[%d] = 0x%s (format %s)\n",fpr,pr_addr(FGR[fpr]),DOFMT(fmt));
2144 #endif /* DEBUG */
2145
2146 return;
2147 }
2148
2149 int
2150 NaN(op,fmt)
2151 uword64 op;
2152 FP_formats fmt;
2153 {
2154 int boolean = 0;
2155 switch (fmt) {
2156 case fmt_single:
2157 case fmt_word:
2158 {
2159 sim_fpu wop;
2160 sim_fpu_32to (&wop, op);
2161 boolean = sim_fpu_is_nan (&wop);
2162 break;
2163 }
2164 case fmt_double:
2165 case fmt_long:
2166 {
2167 sim_fpu wop;
2168 sim_fpu_64to (&wop, op);
2169 boolean = sim_fpu_is_nan (&wop);
2170 break;
2171 }
2172 default:
2173 fprintf (stderr, "Bad switch\n");
2174 abort ();
2175 }
2176
2177 #ifdef DEBUG
2178 printf("DBG: NaN: returning %d for 0x%s (format = %s)\n",boolean,pr_addr(op),DOFMT(fmt));
2179 #endif /* DEBUG */
2180
2181 return(boolean);
2182 }
2183
2184 int
2185 Infinity(op,fmt)
2186 uword64 op;
2187 FP_formats fmt;
2188 {
2189 int boolean = 0;
2190
2191 #ifdef DEBUG
2192 printf("DBG: Infinity: format %s 0x%s\n",DOFMT(fmt),pr_addr(op));
2193 #endif /* DEBUG */
2194
2195 switch (fmt) {
2196 case fmt_single:
2197 {
2198 sim_fpu wop;
2199 sim_fpu_32to (&wop, op);
2200 boolean = sim_fpu_is_infinity (&wop);
2201 break;
2202 }
2203 case fmt_double:
2204 {
2205 sim_fpu wop;
2206 sim_fpu_64to (&wop, op);
2207 boolean = sim_fpu_is_infinity (&wop);
2208 break;
2209 }
2210 default:
2211 printf("DBG: TODO: unrecognised format (%s) for Infinity check\n",DOFMT(fmt));
2212 break;
2213 }
2214
2215 #ifdef DEBUG
2216 printf("DBG: Infinity: returning %d for 0x%s (format = %s)\n",boolean,pr_addr(op),DOFMT(fmt));
2217 #endif /* DEBUG */
2218
2219 return(boolean);
2220 }
2221
2222 int
2223 Less(op1,op2,fmt)
2224 uword64 op1;
2225 uword64 op2;
2226 FP_formats fmt;
2227 {
2228 int boolean = 0;
2229
2230 /* Argument checking already performed by the FPCOMPARE code */
2231
2232 #ifdef DEBUG
2233 printf("DBG: Less: %s: op1 = 0x%s : op2 = 0x%s\n",DOFMT(fmt),pr_addr(op1),pr_addr(op2));
2234 #endif /* DEBUG */
2235
2236 /* The format type should already have been checked: */
2237 switch (fmt) {
2238 case fmt_single:
2239 {
2240 sim_fpu wop1;
2241 sim_fpu wop2;
2242 sim_fpu_32to (&wop1, op1);
2243 sim_fpu_32to (&wop2, op2);
2244 boolean = sim_fpu_is_lt (&wop1, &wop2);
2245 break;
2246 }
2247 case fmt_double:
2248 {
2249 sim_fpu wop1;
2250 sim_fpu wop2;
2251 sim_fpu_64to (&wop1, op1);
2252 sim_fpu_64to (&wop2, op2);
2253 boolean = sim_fpu_is_lt (&wop1, &wop2);
2254 break;
2255 }
2256 default:
2257 fprintf (stderr, "Bad switch\n");
2258 abort ();
2259 }
2260
2261 #ifdef DEBUG
2262 printf("DBG: Less: returning %d (format = %s)\n",boolean,DOFMT(fmt));
2263 #endif /* DEBUG */
2264
2265 return(boolean);
2266 }
2267
2268 int
2269 Equal(op1,op2,fmt)
2270 uword64 op1;
2271 uword64 op2;
2272 FP_formats fmt;
2273 {
2274 int boolean = 0;
2275
2276 /* Argument checking already performed by the FPCOMPARE code */
2277
2278 #ifdef DEBUG
2279 printf("DBG: Equal: %s: op1 = 0x%s : op2 = 0x%s\n",DOFMT(fmt),pr_addr(op1),pr_addr(op2));
2280 #endif /* DEBUG */
2281
2282 /* The format type should already have been checked: */
2283 switch (fmt) {
2284 case fmt_single:
2285 {
2286 sim_fpu wop1;
2287 sim_fpu wop2;
2288 sim_fpu_32to (&wop1, op1);
2289 sim_fpu_32to (&wop2, op2);
2290 boolean = sim_fpu_is_eq (&wop1, &wop2);
2291 break;
2292 }
2293 case fmt_double:
2294 {
2295 sim_fpu wop1;
2296 sim_fpu wop2;
2297 sim_fpu_64to (&wop1, op1);
2298 sim_fpu_64to (&wop2, op2);
2299 boolean = sim_fpu_is_eq (&wop1, &wop2);
2300 break;
2301 }
2302 default:
2303 fprintf (stderr, "Bad switch\n");
2304 abort ();
2305 }
2306
2307 #ifdef DEBUG
2308 printf("DBG: Equal: returning %d (format = %s)\n",boolean,DOFMT(fmt));
2309 #endif /* DEBUG */
2310
2311 return(boolean);
2312 }
2313
2314 uword64
2315 AbsoluteValue(op,fmt)
2316 uword64 op;
2317 FP_formats fmt;
2318 {
2319 uword64 result = 0;
2320
2321 #ifdef DEBUG
2322 printf("DBG: AbsoluteValue: %s: op = 0x%s\n",DOFMT(fmt),pr_addr(op));
2323 #endif /* DEBUG */
2324
2325 /* The format type should already have been checked: */
2326 switch (fmt) {
2327 case fmt_single:
2328 {
2329 sim_fpu wop;
2330 unsigned32 ans;
2331 sim_fpu_32to (&wop, op);
2332 sim_fpu_abs (&wop, &wop);
2333 sim_fpu_to32 (&ans, &wop);
2334 result = ans;
2335 break;
2336 }
2337 case fmt_double:
2338 {
2339 sim_fpu wop;
2340 unsigned64 ans;
2341 sim_fpu_64to (&wop, op);
2342 sim_fpu_abs (&wop, &wop);
2343 sim_fpu_to64 (&ans, &wop);
2344 result = ans;
2345 break;
2346 }
2347 default:
2348 fprintf (stderr, "Bad switch\n");
2349 abort ();
2350 }
2351
2352 return(result);
2353 }
2354
2355 uword64
2356 Negate(op,fmt)
2357 uword64 op;
2358 FP_formats fmt;
2359 {
2360 uword64 result = 0;
2361
2362 #ifdef DEBUG
2363 printf("DBG: Negate: %s: op = 0x%s\n",DOFMT(fmt),pr_addr(op));
2364 #endif /* DEBUG */
2365
2366 /* The format type should already have been checked: */
2367 switch (fmt) {
2368 case fmt_single:
2369 {
2370 sim_fpu wop;
2371 unsigned32 ans;
2372 sim_fpu_32to (&wop, op);
2373 sim_fpu_neg (&wop, &wop);
2374 sim_fpu_to32 (&ans, &wop);
2375 result = ans;
2376 break;
2377 }
2378 case fmt_double:
2379 {
2380 sim_fpu wop;
2381 unsigned64 ans;
2382 sim_fpu_64to (&wop, op);
2383 sim_fpu_neg (&wop, &wop);
2384 sim_fpu_to64 (&ans, &wop);
2385 result = ans;
2386 break;
2387 }
2388 default:
2389 fprintf (stderr, "Bad switch\n");
2390 abort ();
2391 }
2392
2393 return(result);
2394 }
2395
2396 uword64
2397 Add(op1,op2,fmt)
2398 uword64 op1;
2399 uword64 op2;
2400 FP_formats fmt;
2401 {
2402 uword64 result = 0;
2403
2404 #ifdef DEBUG
2405 printf("DBG: Add: %s: op1 = 0x%s : op2 = 0x%s\n",DOFMT(fmt),pr_addr(op1),pr_addr(op2));
2406 #endif /* DEBUG */
2407
2408 /* The registers must specify FPRs valid for operands of type
2409 "fmt". If they are not valid, the result is undefined. */
2410
2411 /* The format type should already have been checked: */
2412 switch (fmt) {
2413 case fmt_single:
2414 {
2415 sim_fpu wop1;
2416 sim_fpu wop2;
2417 sim_fpu ans;
2418 unsigned32 res;
2419 sim_fpu_32to (&wop1, op1);
2420 sim_fpu_32to (&wop2, op2);
2421 sim_fpu_add (&ans, &wop1, &wop2);
2422 sim_fpu_to32 (&res, &ans);
2423 result = res;
2424 break;
2425 }
2426 case fmt_double:
2427 {
2428 sim_fpu wop1;
2429 sim_fpu wop2;
2430 sim_fpu ans;
2431 unsigned64 res;
2432 sim_fpu_64to (&wop1, op1);
2433 sim_fpu_64to (&wop2, op2);
2434 sim_fpu_add (&ans, &wop1, &wop2);
2435 sim_fpu_to64 (&res, &ans);
2436 result = res;
2437 break;
2438 }
2439 default:
2440 fprintf (stderr, "Bad switch\n");
2441 abort ();
2442 }
2443
2444 #ifdef DEBUG
2445 printf("DBG: Add: returning 0x%s (format = %s)\n",pr_addr(result),DOFMT(fmt));
2446 #endif /* DEBUG */
2447
2448 return(result);
2449 }
2450
2451 uword64
2452 Sub(op1,op2,fmt)
2453 uword64 op1;
2454 uword64 op2;
2455 FP_formats fmt;
2456 {
2457 uword64 result = 0;
2458
2459 #ifdef DEBUG
2460 printf("DBG: Sub: %s: op1 = 0x%s : op2 = 0x%s\n",DOFMT(fmt),pr_addr(op1),pr_addr(op2));
2461 #endif /* DEBUG */
2462
2463 /* The registers must specify FPRs valid for operands of type
2464 "fmt". If they are not valid, the result is undefined. */
2465
2466 /* The format type should already have been checked: */
2467 switch (fmt) {
2468 case fmt_single:
2469 {
2470 sim_fpu wop1;
2471 sim_fpu wop2;
2472 sim_fpu ans;
2473 unsigned32 res;
2474 sim_fpu_32to (&wop1, op1);
2475 sim_fpu_32to (&wop2, op2);
2476 sim_fpu_sub (&ans, &wop1, &wop2);
2477 sim_fpu_to32 (&res, &ans);
2478 result = res;
2479 }
2480 break;
2481 case fmt_double:
2482 {
2483 sim_fpu wop1;
2484 sim_fpu wop2;
2485 sim_fpu ans;
2486 unsigned64 res;
2487 sim_fpu_64to (&wop1, op1);
2488 sim_fpu_64to (&wop2, op2);
2489 sim_fpu_sub (&ans, &wop1, &wop2);
2490 sim_fpu_to64 (&res, &ans);
2491 result = res;
2492 }
2493 break;
2494 default:
2495 fprintf (stderr, "Bad switch\n");
2496 abort ();
2497 }
2498
2499 #ifdef DEBUG
2500 printf("DBG: Sub: returning 0x%s (format = %s)\n",pr_addr(result),DOFMT(fmt));
2501 #endif /* DEBUG */
2502
2503 return(result);
2504 }
2505
2506 uword64
2507 Multiply(op1,op2,fmt)
2508 uword64 op1;
2509 uword64 op2;
2510 FP_formats fmt;
2511 {
2512 uword64 result = 0;
2513
2514 #ifdef DEBUG
2515 printf("DBG: Multiply: %s: op1 = 0x%s : op2 = 0x%s\n",DOFMT(fmt),pr_addr(op1),pr_addr(op2));
2516 #endif /* DEBUG */
2517
2518 /* The registers must specify FPRs valid for operands of type
2519 "fmt". If they are not valid, the result is undefined. */
2520
2521 /* The format type should already have been checked: */
2522 switch (fmt) {
2523 case fmt_single:
2524 {
2525 sim_fpu wop1;
2526 sim_fpu wop2;
2527 sim_fpu ans;
2528 unsigned32 res;
2529 sim_fpu_32to (&wop1, op1);
2530 sim_fpu_32to (&wop2, op2);
2531 sim_fpu_mul (&ans, &wop1, &wop2);
2532 sim_fpu_to32 (&res, &ans);
2533 result = res;
2534 break;
2535 }
2536 case fmt_double:
2537 {
2538 sim_fpu wop1;
2539 sim_fpu wop2;
2540 sim_fpu ans;
2541 unsigned64 res;
2542 sim_fpu_64to (&wop1, op1);
2543 sim_fpu_64to (&wop2, op2);
2544 sim_fpu_mul (&ans, &wop1, &wop2);
2545 sim_fpu_to64 (&res, &ans);
2546 result = res;
2547 break;
2548 }
2549 default:
2550 fprintf (stderr, "Bad switch\n");
2551 abort ();
2552 }
2553
2554 #ifdef DEBUG
2555 printf("DBG: Multiply: returning 0x%s (format = %s)\n",pr_addr(result),DOFMT(fmt));
2556 #endif /* DEBUG */
2557
2558 return(result);
2559 }
2560
2561 uword64
2562 Divide(op1,op2,fmt)
2563 uword64 op1;
2564 uword64 op2;
2565 FP_formats fmt;
2566 {
2567 uword64 result = 0;
2568
2569 #ifdef DEBUG
2570 printf("DBG: Divide: %s: op1 = 0x%s : op2 = 0x%s\n",DOFMT(fmt),pr_addr(op1),pr_addr(op2));
2571 #endif /* DEBUG */
2572
2573 /* The registers must specify FPRs valid for operands of type
2574 "fmt". If they are not valid, the result is undefined. */
2575
2576 /* The format type should already have been checked: */
2577 switch (fmt) {
2578 case fmt_single:
2579 {
2580 sim_fpu wop1;
2581 sim_fpu wop2;
2582 sim_fpu ans;
2583 unsigned32 res;
2584 sim_fpu_32to (&wop1, op1);
2585 sim_fpu_32to (&wop2, op2);
2586 sim_fpu_div (&ans, &wop1, &wop2);
2587 sim_fpu_to32 (&res, &ans);
2588 result = res;
2589 break;
2590 }
2591 case fmt_double:
2592 {
2593 sim_fpu wop1;
2594 sim_fpu wop2;
2595 sim_fpu ans;
2596 unsigned64 res;
2597 sim_fpu_64to (&wop1, op1);
2598 sim_fpu_64to (&wop2, op2);
2599 sim_fpu_div (&ans, &wop1, &wop2);
2600 sim_fpu_to64 (&res, &ans);
2601 result = res;
2602 break;
2603 }
2604 default:
2605 fprintf (stderr, "Bad switch\n");
2606 abort ();
2607 }
2608
2609 #ifdef DEBUG
2610 printf("DBG: Divide: returning 0x%s (format = %s)\n",pr_addr(result),DOFMT(fmt));
2611 #endif /* DEBUG */
2612
2613 return(result);
2614 }
2615
2616 uword64 UNUSED
2617 Recip(op,fmt)
2618 uword64 op;
2619 FP_formats fmt;
2620 {
2621 uword64 result = 0;
2622
2623 #ifdef DEBUG
2624 printf("DBG: Recip: %s: op = 0x%s\n",DOFMT(fmt),pr_addr(op));
2625 #endif /* DEBUG */
2626
2627 /* The registers must specify FPRs valid for operands of type
2628 "fmt". If they are not valid, the result is undefined. */
2629
2630 /* The format type should already have been checked: */
2631 switch (fmt) {
2632 case fmt_single:
2633 {
2634 sim_fpu wop;
2635 sim_fpu ans;
2636 unsigned32 res;
2637 sim_fpu_32to (&wop, op);
2638 sim_fpu_inv (&ans, &wop);
2639 sim_fpu_to32 (&res, &ans);
2640 result = res;
2641 break;
2642 }
2643 case fmt_double:
2644 {
2645 sim_fpu wop;
2646 sim_fpu ans;
2647 unsigned64 res;
2648 sim_fpu_64to (&wop, op);
2649 sim_fpu_inv (&ans, &wop);
2650 sim_fpu_to64 (&res, &ans);
2651 result = res;
2652 break;
2653 }
2654 default:
2655 fprintf (stderr, "Bad switch\n");
2656 abort ();
2657 }
2658
2659 #ifdef DEBUG
2660 printf("DBG: Recip: returning 0x%s (format = %s)\n",pr_addr(result),DOFMT(fmt));
2661 #endif /* DEBUG */
2662
2663 return(result);
2664 }
2665
2666 uword64
2667 SquareRoot(op,fmt)
2668 uword64 op;
2669 FP_formats fmt;
2670 {
2671 uword64 result = 0;
2672
2673 #ifdef DEBUG
2674 printf("DBG: SquareRoot: %s: op = 0x%s\n",DOFMT(fmt),pr_addr(op));
2675 #endif /* DEBUG */
2676
2677 /* The registers must specify FPRs valid for operands of type
2678 "fmt". If they are not valid, the result is undefined. */
2679
2680 /* The format type should already have been checked: */
2681 switch (fmt) {
2682 case fmt_single:
2683 {
2684 sim_fpu wop;
2685 sim_fpu ans;
2686 unsigned32 res;
2687 sim_fpu_32to (&wop, op);
2688 sim_fpu_sqrt (&ans, &wop);
2689 sim_fpu_to32 (&res, &ans);
2690 result = res;
2691 break;
2692 }
2693 case fmt_double:
2694 {
2695 sim_fpu wop;
2696 sim_fpu ans;
2697 unsigned64 res;
2698 sim_fpu_64to (&wop, op);
2699 sim_fpu_sqrt (&ans, &wop);
2700 sim_fpu_to64 (&res, &ans);
2701 result = res;
2702 break;
2703 }
2704 default:
2705 fprintf (stderr, "Bad switch\n");
2706 abort ();
2707 }
2708
2709 #ifdef DEBUG
2710 printf("DBG: SquareRoot: returning 0x%s (format = %s)\n",pr_addr(result),DOFMT(fmt));
2711 #endif /* DEBUG */
2712
2713 return(result);
2714 }
2715
2716 uword64
2717 convert (SIM_DESC sd,
2718 sim_cpu *cpu,
2719 address_word cia,
2720 int rm,
2721 uword64 op,
2722 FP_formats from,
2723 FP_formats to)
2724 {
2725 sim_fpu wop;
2726 sim_fpu_round round;
2727 unsigned32 result32;
2728 unsigned64 result64;
2729
2730 #ifdef DEBUG
2731 printf("DBG: Convert: mode %s : op 0x%s : from %s : to %s : (PC = 0x%s)\n",RMMODE(rm),pr_addr(op),DOFMT(from),DOFMT(to),pr_addr(IPC));
2732 #endif /* DEBUG */
2733
2734 switch (rm)
2735 {
2736 case FP_RM_NEAREST:
2737 /* Round result to nearest representable value. When two
2738 representable values are equally near, round to the value
2739 that has a least significant bit of zero (i.e. is even). */
2740 round = sim_fpu_round_near;
2741 break;
2742 case FP_RM_TOZERO:
2743 /* Round result to the value closest to, and not greater in
2744 magnitude than, the result. */
2745 round = sim_fpu_round_zero;
2746 break;
2747 case FP_RM_TOPINF:
2748 /* Round result to the value closest to, and not less than,
2749 the result. */
2750 round = sim_fpu_round_up;
2751 break;
2752
2753 case FP_RM_TOMINF:
2754 /* Round result to the value closest to, and not greater than,
2755 the result. */
2756 round = sim_fpu_round_down;
2757 break;
2758 default:
2759 round = 0;
2760 fprintf (stderr, "Bad switch\n");
2761 abort ();
2762 }
2763
2764 /* Convert the input to sim_fpu internal format */
2765 switch (from)
2766 {
2767 case fmt_double:
2768 sim_fpu_64to (&wop, op);
2769 break;
2770 case fmt_single:
2771 sim_fpu_32to (&wop, op);
2772 break;
2773 case fmt_word:
2774 sim_fpu_i32to (&wop, op, round);
2775 break;
2776 case fmt_long:
2777 sim_fpu_i64to (&wop, op, round);
2778 break;
2779 default:
2780 fprintf (stderr, "Bad switch\n");
2781 abort ();
2782 }
2783
2784 /* Convert sim_fpu format into the output */
2785 /* The value WOP is converted to the destination format, rounding
2786 using mode RM. When the destination is a fixed-point format, then
2787 a source value of Infinity, NaN or one which would round to an
2788 integer outside the fixed point range then an IEEE Invalid
2789 Operation condition is raised. */
2790 switch (to)
2791 {
2792 case fmt_single:
2793 sim_fpu_round_32 (&wop, round, 0);
2794 sim_fpu_to32 (&result32, &wop);
2795 result64 = result32;
2796 break;
2797 case fmt_double:
2798 sim_fpu_round_64 (&wop, round, 0);
2799 sim_fpu_to64 (&result64, &wop);
2800 break;
2801 case fmt_word:
2802 sim_fpu_to32i (&result32, &wop, round);
2803 result64 = result32;
2804 break;
2805 case fmt_long:
2806 sim_fpu_to64i (&result64, &wop, round);
2807 break;
2808 default:
2809 result64 = 0;
2810 fprintf (stderr, "Bad switch\n");
2811 abort ();
2812 }
2813
2814 #ifdef DEBUG
2815 printf("DBG: Convert: returning 0x%s (to format = %s)\n",pr_addr(result64),DOFMT(to));
2816 #endif /* DEBUG */
2817
2818 return(result64);
2819 }
2820
2821
2822 /*-- co-processor support routines ------------------------------------------*/
2823
2824 static int UNUSED
2825 CoProcPresent(coproc_number)
2826 unsigned int coproc_number;
2827 {
2828 /* Return TRUE if simulator provides a model for the given co-processor number */
2829 return(0);
2830 }
2831
2832 void
2833 cop_lw (SIM_DESC sd,
2834 sim_cpu *cpu,
2835 address_word cia,
2836 int coproc_num,
2837 int coproc_reg,
2838 unsigned int memword)
2839 {
2840 switch (coproc_num)
2841 {
2842 case 1:
2843 if (CURRENT_FLOATING_POINT == HARD_FLOATING_POINT)
2844 {
2845 #ifdef DEBUG
2846 printf("DBG: COP_LW: memword = 0x%08X (uword64)memword = 0x%s\n",memword,pr_addr(memword));
2847 #endif
2848 StoreFPR(coproc_reg,fmt_word,(uword64)memword);
2849 FPR_STATE[coproc_reg] = fmt_uninterpreted;
2850 break;
2851 }
2852
2853 default:
2854 #if 0 /* this should be controlled by a configuration option */
2855 sim_io_printf(sd,"COP_LW(%d,%d,0x%08X) at PC = 0x%s : TODO (architecture specific)\n",coproc_num,coproc_reg,memword,pr_addr(cia));
2856 #endif
2857 break;
2858 }
2859
2860 return;
2861 }
2862
2863 void
2864 cop_ld (SIM_DESC sd,
2865 sim_cpu *cpu,
2866 address_word cia,
2867 int coproc_num,
2868 int coproc_reg,
2869 uword64 memword)
2870 {
2871 switch (coproc_num) {
2872 case 1:
2873 if (CURRENT_FLOATING_POINT == HARD_FLOATING_POINT)
2874 {
2875 StoreFPR(coproc_reg,fmt_uninterpreted,memword);
2876 break;
2877 }
2878
2879 default:
2880 #if 0 /* this message should be controlled by a configuration option */
2881 sim_io_printf(sd,"COP_LD(%d,%d,0x%s) at PC = 0x%s : TODO (architecture specific)\n",coproc_num,coproc_reg,pr_addr(memword),pr_addr(cia));
2882 #endif
2883 break;
2884 }
2885
2886 return;
2887 }
2888
2889 unsigned int
2890 cop_sw (SIM_DESC sd,
2891 sim_cpu *cpu,
2892 address_word cia,
2893 int coproc_num,
2894 int coproc_reg)
2895 {
2896 unsigned int value = 0;
2897
2898 switch (coproc_num)
2899 {
2900 case 1:
2901 if (CURRENT_FLOATING_POINT == HARD_FLOATING_POINT)
2902 {
2903 FP_formats hold;
2904 hold = FPR_STATE[coproc_reg];
2905 FPR_STATE[coproc_reg] = fmt_word;
2906 value = (unsigned int)ValueFPR(coproc_reg,fmt_uninterpreted);
2907 FPR_STATE[coproc_reg] = hold;
2908 break;
2909 }
2910
2911 default:
2912 #if 0 /* should be controlled by configuration option */
2913 sim_io_printf(sd,"COP_SW(%d,%d) at PC = 0x%s : TODO (architecture specific)\n",coproc_num,coproc_reg,pr_addr(cia));
2914 #endif
2915 break;
2916 }
2917
2918 return(value);
2919 }
2920
2921 uword64
2922 cop_sd (SIM_DESC sd,
2923 sim_cpu *cpu,
2924 address_word cia,
2925 int coproc_num,
2926 int coproc_reg)
2927 {
2928 uword64 value = 0;
2929 switch (coproc_num)
2930 {
2931 case 1:
2932 if (CURRENT_FLOATING_POINT == HARD_FLOATING_POINT)
2933 {
2934 value = ValueFPR(coproc_reg,fmt_uninterpreted);
2935 break;
2936 }
2937
2938 default:
2939 #if 0 /* should be controlled by configuration option */
2940 sim_io_printf(sd,"COP_SD(%d,%d) at PC = 0x%s : TODO (architecture specific)\n",coproc_num,coproc_reg,pr_addr(cia));
2941 #endif
2942 break;
2943 }
2944
2945 return(value);
2946 }
2947
2948 void
2949 decode_coproc (SIM_DESC sd,
2950 sim_cpu *cpu,
2951 address_word cia,
2952 unsigned int instruction)
2953 {
2954 int coprocnum = ((instruction >> 26) & 3);
2955
2956 switch (coprocnum)
2957 {
2958 case 0: /* standard CPU control and cache registers */
2959 {
2960 int code = ((instruction >> 21) & 0x1F);
2961 /* R4000 Users Manual (second edition) lists the following CP0
2962 instructions:
2963 DMFC0 Doubleword Move From CP0 (VR4100 = 01000000001tttttddddd00000000000)
2964 DMTC0 Doubleword Move To CP0 (VR4100 = 01000000101tttttddddd00000000000)
2965 MFC0 word Move From CP0 (VR4100 = 01000000000tttttddddd00000000000)
2966 MTC0 word Move To CP0 (VR4100 = 01000000100tttttddddd00000000000)
2967 TLBR Read Indexed TLB Entry (VR4100 = 01000010000000000000000000000001)
2968 TLBWI Write Indexed TLB Entry (VR4100 = 01000010000000000000000000000010)
2969 TLBWR Write Random TLB Entry (VR4100 = 01000010000000000000000000000110)
2970 TLBP Probe TLB for Matching Entry (VR4100 = 01000010000000000000000000001000)
2971 CACHE Cache operation (VR4100 = 101111bbbbbpppppiiiiiiiiiiiiiiii)
2972 ERET Exception return (VR4100 = 01000010000000000000000000011000)
2973 */
2974 if (((code == 0x00) || (code == 0x04)) && ((instruction & 0x7FF) == 0))
2975 {
2976 int rt = ((instruction >> 16) & 0x1F);
2977 int rd = ((instruction >> 11) & 0x1F);
2978
2979 switch (rd) /* NOTEs: Standard CP0 registers */
2980 {
2981 /* 0 = Index R4000 VR4100 VR4300 */
2982 /* 1 = Random R4000 VR4100 VR4300 */
2983 /* 2 = EntryLo0 R4000 VR4100 VR4300 */
2984 /* 3 = EntryLo1 R4000 VR4100 VR4300 */
2985 /* 4 = Context R4000 VR4100 VR4300 */
2986 /* 5 = PageMask R4000 VR4100 VR4300 */
2987 /* 6 = Wired R4000 VR4100 VR4300 */
2988 /* 8 = BadVAddr R4000 VR4100 VR4300 */
2989 /* 9 = Count R4000 VR4100 VR4300 */
2990 /* 10 = EntryHi R4000 VR4100 VR4300 */
2991 /* 11 = Compare R4000 VR4100 VR4300 */
2992 /* 12 = SR R4000 VR4100 VR4300 */
2993 case 12:
2994 if (code == 0x00)
2995 GPR[rt] = SR;
2996 else
2997 SR = GPR[rt];
2998 break;
2999 /* 13 = Cause R4000 VR4100 VR4300 */
3000 case 13:
3001 if (code == 0x00)
3002 GPR[rt] = CAUSE;
3003 else
3004 CAUSE = GPR[rt];
3005 break;
3006 /* 14 = EPC R4000 VR4100 VR4300 */
3007 /* 15 = PRId R4000 VR4100 VR4300 */
3008 #ifdef SUBTARGET_R3900
3009 /* 16 = Debug */
3010 case 16:
3011 if (code == 0x00)
3012 GPR[rt] = Debug;
3013 else
3014 Debug = GPR[rt];
3015 break;
3016 #else
3017 /* 16 = Config R4000 VR4100 VR4300 */
3018 case 16:
3019 if (code == 0x00)
3020 GPR[rt] = C0_CONFIG;
3021 else
3022 C0_CONFIG = GPR[rt];
3023 break;
3024 #endif
3025 #ifdef SUBTARGET_R3900
3026 /* 17 = Debug */
3027 case 17:
3028 if (code == 0x00)
3029 GPR[rt] = DEPC;
3030 else
3031 DEPC = GPR[rt];
3032 break;
3033 #else
3034 /* 17 = LLAddr R4000 VR4100 VR4300 */
3035 #endif
3036 /* 18 = WatchLo R4000 VR4100 VR4300 */
3037 /* 19 = WatchHi R4000 VR4100 VR4300 */
3038 /* 20 = XContext R4000 VR4100 VR4300 */
3039 /* 26 = PErr or ECC R4000 VR4100 VR4300 */
3040 /* 27 = CacheErr R4000 VR4100 */
3041 /* 28 = TagLo R4000 VR4100 VR4300 */
3042 /* 29 = TagHi R4000 VR4100 VR4300 */
3043 /* 30 = ErrorEPC R4000 VR4100 VR4300 */
3044 GPR[rt] = 0xDEADC0DE; /* CPR[0,rd] */
3045 /* CPR[0,rd] = GPR[rt]; */
3046 default:
3047 if (code == 0x00)
3048 sim_io_printf(sd,"Warning: MFC0 %d,%d ignored (architecture specific)\n",rt,rd);
3049 else
3050 sim_io_printf(sd,"Warning: MTC0 %d,%d ignored (architecture specific)\n",rt,rd);
3051 }
3052 }
3053 else if (code == 0x10 && (instruction & 0x3f) == 0x18)
3054 {
3055 /* ERET */
3056 if (SR & status_ERL)
3057 {
3058 /* Oops, not yet available */
3059 sim_io_printf(sd,"Warning: ERET when SR[ERL] set not handled yet");
3060 PC = EPC;
3061 SR &= ~status_ERL;
3062 }
3063 else
3064 {
3065 PC = EPC;
3066 SR &= ~status_EXL;
3067 }
3068 }
3069 else if (code == 0x10 && (instruction & 0x3f) == 0x10)
3070 {
3071 /* RFE */
3072 }
3073 else if (code == 0x10 && (instruction & 0x3f) == 0x1F)
3074 {
3075 /* DERET */
3076 Debug &= ~Debug_DM;
3077 DELAYSLOT();
3078 DSPC = DEPC;
3079 }
3080 else
3081 sim_io_eprintf(sd,"Unrecognised COP0 instruction 0x%08X at PC = 0x%s : No handler present\n",instruction,pr_addr(cia));
3082 /* TODO: When executing an ERET or RFE instruction we should
3083 clear LLBIT, to ensure that any out-standing atomic
3084 read/modify/write sequence fails. */
3085 }
3086 break;
3087
3088 case 2: /* undefined co-processor */
3089 sim_io_eprintf(sd,"COP2 instruction 0x%08X at PC = 0x%s : No handler present\n",instruction,pr_addr(cia));
3090 break;
3091
3092 case 1: /* should not occur (FPU co-processor) */
3093 case 3: /* should not occur (FPU co-processor) */
3094 SignalException(ReservedInstruction,instruction);
3095 break;
3096 }
3097
3098 return;
3099 }
3100
3101 /*-- instruction simulation -------------------------------------------------*/
3102
3103 /* When the IGEN simulator is being built, the function below is be
3104 replaced by a generated version. However, WITH_IGEN == 2 indicates
3105 that the fubction below should be compiled but under a different
3106 name (to allow backward compatibility) */
3107
3108 #if (WITH_IGEN != 1)
3109 #if (WITH_IGEN > 1)
3110 void old_engine_run PARAMS ((SIM_DESC sd, int next_cpu_nr, int siggnal));
3111 void
3112 old_engine_run (sd, next_cpu_nr, nr_cpus, siggnal)
3113 #else
3114 void
3115 sim_engine_run (sd, next_cpu_nr, nr_cpus, siggnal)
3116 #endif
3117 SIM_DESC sd;
3118 int next_cpu_nr; /* ignore */
3119 int nr_cpus; /* ignore */
3120 int siggnal; /* ignore */
3121 {
3122 sim_cpu *cpu = STATE_CPU (sd, 0); /* hardwire to cpu 0 */
3123 #if !defined(FASTSIM)
3124 unsigned int pipeline_count = 1;
3125 #endif
3126
3127 #ifdef DEBUG
3128 if (STATE_MEMORY (sd) == NULL) {
3129 printf("DBG: simulate() entered with no memory\n");
3130 exit(1);
3131 }
3132 #endif /* DEBUG */
3133
3134 #if 0 /* Disabled to check that everything works OK */
3135 /* The VR4300 seems to sign-extend the PC on its first
3136 access. However, this may just be because it is currently
3137 configured in 32bit mode. However... */
3138 PC = SIGNEXTEND(PC,32);
3139 #endif
3140
3141 /* main controlling loop */
3142 while (1) {
3143 /* vaddr is slowly being replaced with cia - current instruction
3144 address */
3145 address_word cia = (uword64)PC;
3146 address_word vaddr = cia;
3147 address_word paddr;
3148 int cca;
3149 unsigned int instruction; /* uword64? what's this used for? FIXME! */
3150
3151 #ifdef DEBUG
3152 {
3153 printf("DBG: state = 0x%08X :",state);
3154 if (state & simHALTEX) printf(" simHALTEX");
3155 if (state & simHALTIN) printf(" simHALTIN");
3156 printf("\n");
3157 }
3158 #endif /* DEBUG */
3159
3160 DSSTATE = (STATE & simDELAYSLOT);
3161 #ifdef DEBUG
3162 if (dsstate)
3163 sim_io_printf(sd,"DBG: DSPC = 0x%s\n",pr_addr(DSPC));
3164 #endif /* DEBUG */
3165
3166 /* Fetch the next instruction from the simulator memory: */
3167 if (AddressTranslation(cia,isINSTRUCTION,isLOAD,&paddr,&cca,isTARGET,isREAL)) {
3168 if ((vaddr & 1) == 0) {
3169 /* Copy the action of the LW instruction */
3170 unsigned int reverse = (ReverseEndian ? (LOADDRMASK >> 2) : 0);
3171 unsigned int bigend = (BigEndianCPU ? (LOADDRMASK >> 2) : 0);
3172 uword64 value;
3173 unsigned int byte;
3174 paddr = ((paddr & ~LOADDRMASK) | ((paddr & LOADDRMASK) ^ (reverse << 2)));
3175 LoadMemory(&value,NULL,cca,AccessLength_WORD,paddr,vaddr,isINSTRUCTION,isREAL);
3176 byte = ((vaddr & LOADDRMASK) ^ (bigend << 2));
3177 instruction = ((value >> (8 * byte)) & 0xFFFFFFFF);
3178 } else {
3179 /* Copy the action of the LH instruction */
3180 unsigned int reverse = (ReverseEndian ? (LOADDRMASK >> 1) : 0);
3181 unsigned int bigend = (BigEndianCPU ? (LOADDRMASK >> 1) : 0);
3182 uword64 value;
3183 unsigned int byte;
3184 paddr = (((paddr & ~ (uword64) 1) & ~LOADDRMASK)
3185 | (((paddr & ~ (uword64) 1) & LOADDRMASK) ^ (reverse << 1)));
3186 LoadMemory(&value,NULL,cca, AccessLength_HALFWORD,
3187 paddr & ~ (uword64) 1,
3188 vaddr, isINSTRUCTION, isREAL);
3189 byte = (((vaddr &~ (uword64) 1) & LOADDRMASK) ^ (bigend << 1));
3190 instruction = ((value >> (8 * byte)) & 0xFFFF);
3191 }
3192 } else {
3193 fprintf(stderr,"Cannot translate address for PC = 0x%s failed\n",pr_addr(PC));
3194 exit(1);
3195 }
3196
3197 #ifdef DEBUG
3198 sim_io_printf(sd,"DBG: fetched 0x%08X from PC = 0x%s\n",instruction,pr_addr(PC));
3199 #endif /* DEBUG */
3200
3201 /* This is required by exception processing, to ensure that we can
3202 cope with exceptions in the delay slots of branches that may
3203 already have changed the PC. */
3204 if ((vaddr & 1) == 0)
3205 PC += 4; /* increment ready for the next fetch */
3206 else
3207 PC += 2;
3208 /* NOTE: If we perform a delay slot change to the PC, this
3209 increment is not requuired. However, it would make the
3210 simulator more complicated to try and avoid this small hit. */
3211
3212 /* Currently this code provides a simple model. For more
3213 complicated models we could perform exception status checks at
3214 this point, and set the simSTOP state as required. This could
3215 also include processing any hardware interrupts raised by any
3216 I/O model attached to the simulator context.
3217
3218 Support for "asynchronous" I/O events within the simulated world
3219 could be providing by managing a counter, and calling a I/O
3220 specific handler when a particular threshold is reached. On most
3221 architectures a decrement and check for zero operation is
3222 usually quicker than an increment and compare. However, the
3223 process of managing a known value decrement to zero, is higher
3224 than the cost of using an explicit value UINT_MAX into the
3225 future. Which system is used will depend on how complicated the
3226 I/O model is, and how much it is likely to affect the simulator
3227 bandwidth.
3228
3229 If events need to be scheduled further in the future than
3230 UINT_MAX event ticks, then the I/O model should just provide its
3231 own counter, triggered from the event system. */
3232
3233 /* MIPS pipeline ticks. To allow for future support where the
3234 pipeline hit of individual instructions is known, this control
3235 loop manages a "pipeline_count" variable. It is initialised to
3236 1 (one), and will only be changed by the simulator engine when
3237 executing an instruction. If the engine does not have access to
3238 pipeline cycle count information then all instructions will be
3239 treated as using a single cycle. NOTE: A standard system is not
3240 provided by the default simulator because different MIPS
3241 architectures have different cycle counts for the same
3242 instructions.
3243
3244 [NOTE: pipeline_count has been replaced the event queue] */
3245
3246 /* shuffle the floating point status pipeline state */
3247 ENGINE_ISSUE_PREFIX_HOOK();
3248
3249 /* NOTE: For multi-context simulation environments the "instruction"
3250 variable should be local to this routine. */
3251
3252 /* Shorthand accesses for engine. Note: If we wanted to use global
3253 variables (and a single-threaded simulator engine), then we can
3254 create the actual variables with these names. */
3255
3256 if (!(STATE & simSKIPNEXT)) {
3257 /* Include the simulator engine */
3258 #include "oengine.c"
3259 #if ((GPRLEN == 64) && !PROCESSOR_64BIT) || ((GPRLEN == 32) && PROCESSOR_64BIT)
3260 #error "Mismatch between run-time simulator code and simulation engine"
3261 #endif
3262 #if (WITH_TARGET_WORD_BITSIZE != GPRLEN)
3263 #error "Mismatch between configure WITH_TARGET_WORD_BITSIZE and gencode GPRLEN"
3264 #endif
3265 #if ((WITH_FLOATING_POINT == HARD_FLOATING_POINT) != defined (HASFPU))
3266 #error "Mismatch between configure WITH_FLOATING_POINT and gencode HASFPU"
3267 #endif
3268
3269 #if defined(WARN_LOHI)
3270 /* Decrement the HI/LO validity ticks */
3271 if (HIACCESS > 0)
3272 HIACCESS--;
3273 if (LOACCESS > 0)
3274 LOACCESS--;
3275 /* start-sanitize-r5900 */
3276 if (HI1ACCESS > 0)
3277 HI1ACCESS--;
3278 if (LO1ACCESS > 0)
3279 LO1ACCESS--;
3280 /* end-sanitize-r5900 */
3281 #endif /* WARN_LOHI */
3282
3283 /* For certain MIPS architectures, GPR[0] is hardwired to zero. We
3284 should check for it being changed. It is better doing it here,
3285 than within the simulator, since it will help keep the simulator
3286 small. */
3287 if (ZERO != 0) {
3288 #if defined(WARN_ZERO)
3289 sim_io_eprintf(sd,"The ZERO register has been updated with 0x%s (PC = 0x%s) (reset back to zero)\n",pr_addr(ZERO),pr_addr(cia));
3290 #endif /* WARN_ZERO */
3291 ZERO = 0; /* reset back to zero before next instruction */
3292 }
3293 } else /* simSKIPNEXT check */
3294 STATE &= ~simSKIPNEXT;
3295
3296 /* If the delay slot was active before the instruction is
3297 executed, then update the PC to its new value: */
3298 if (DSSTATE) {
3299 #ifdef DEBUG
3300 printf("DBG: dsstate set before instruction execution - updating PC to 0x%s\n",pr_addr(DSPC));
3301 #endif /* DEBUG */
3302 PC = DSPC;
3303 CANCELDELAYSLOT();
3304 }
3305
3306 if (MIPSISA < 4)
3307 PENDING_TICK();
3308
3309 #if !defined(FASTSIM)
3310 if (sim_events_tickn (sd, pipeline_count))
3311 {
3312 /* cpu->cia = cia; */
3313 sim_events_process (sd);
3314 }
3315 #else
3316 if (sim_events_tick (sd))
3317 {
3318 /* cpu->cia = cia; */
3319 sim_events_process (sd);
3320 }
3321 #endif /* FASTSIM */
3322 }
3323 }
3324 #endif
3325
3326
3327 /* This code copied from gdb's utils.c. Would like to share this code,
3328 but don't know of a common place where both could get to it. */
3329
3330 /* Temporary storage using circular buffer */
3331 #define NUMCELLS 16
3332 #define CELLSIZE 32
3333 static char*
3334 get_cell()
3335 {
3336 static char buf[NUMCELLS][CELLSIZE];
3337 static int cell=0;
3338 if (++cell>=NUMCELLS) cell=0;
3339 return buf[cell];
3340 }
3341
3342 /* Print routines to handle variable size regs, etc */
3343
3344 /* Eliminate warning from compiler on 32-bit systems */
3345 static int thirty_two = 32;
3346
3347 char*
3348 pr_addr(addr)
3349 SIM_ADDR addr;
3350 {
3351 char *paddr_str=get_cell();
3352 switch (sizeof(addr))
3353 {
3354 case 8:
3355 sprintf(paddr_str,"%08lx%08lx",
3356 (unsigned long)(addr>>thirty_two),(unsigned long)(addr&0xffffffff));
3357 break;
3358 case 4:
3359 sprintf(paddr_str,"%08lx",(unsigned long)addr);
3360 break;
3361 case 2:
3362 sprintf(paddr_str,"%04x",(unsigned short)(addr&0xffff));
3363 break;
3364 default:
3365 sprintf(paddr_str,"%x",addr);
3366 }
3367 return paddr_str;
3368 }
3369
3370 char*
3371 pr_uword64(addr)
3372 uword64 addr;
3373 {
3374 char *paddr_str=get_cell();
3375 sprintf(paddr_str,"%08lx%08lx",
3376 (unsigned long)(addr>>thirty_two),(unsigned long)(addr&0xffffffff));
3377 return paddr_str;
3378 }
3379
3380
3381 void
3382 pending_tick (SIM_DESC sd,
3383 sim_cpu *cpu,
3384 address_word cia)
3385 {
3386 if (PENDING_TRACE)
3387 sim_io_printf (sd, "PENDING_DRAIN - pending_in = %d, pending_out = %d, pending_total = %d\n", PENDING_IN, PENDING_OUT, PENDING_TOTAL);
3388 if (PENDING_OUT != PENDING_IN)
3389 {
3390 int loop;
3391 int index = PENDING_OUT;
3392 int total = PENDING_TOTAL;
3393 if (PENDING_TOTAL == 0)
3394 sim_engine_abort (SD, CPU, cia, "PENDING_DRAIN - Mis-match on pending update pointers\n");
3395 for (loop = 0; (loop < total); loop++)
3396 {
3397 if (PENDING_SLOT_DEST[index] != NULL)
3398 {
3399 PENDING_SLOT_DELAY[index] -= 1;
3400 if (PENDING_SLOT_DELAY[index] == 0)
3401 {
3402 if (PENDING_SLOT_BIT[index] >= 0)
3403 switch (PENDING_SLOT_SIZE[index])
3404 {
3405 case 32:
3406 if (PENDING_SLOT_VALUE[index])
3407 *(unsigned32*)PENDING_SLOT_DEST[index] |=
3408 BIT32 (PENDING_SLOT_BIT[index]);
3409 else
3410 *(unsigned32*)PENDING_SLOT_DEST[index] &=
3411 BIT32 (PENDING_SLOT_BIT[index]);
3412 break;
3413 case 64:
3414 if (PENDING_SLOT_VALUE[index])
3415 *(unsigned64*)PENDING_SLOT_DEST[index] |=
3416 BIT64 (PENDING_SLOT_BIT[index]);
3417 else
3418 *(unsigned64*)PENDING_SLOT_DEST[index] &=
3419 BIT64 (PENDING_SLOT_BIT[index]);
3420 break;
3421 break;
3422 }
3423 else
3424 switch (PENDING_SLOT_SIZE[index])
3425 {
3426 case 32:
3427 *(unsigned32*)PENDING_SLOT_DEST[index] =
3428 PENDING_SLOT_VALUE[index];
3429 break;
3430 case 64:
3431 *(unsigned64*)PENDING_SLOT_DEST[index] =
3432 PENDING_SLOT_VALUE[index];
3433 break;
3434 }
3435 }
3436 if (PENDING_OUT == index)
3437 {
3438 PENDING_SLOT_DEST[index] = NULL;
3439 PENDING_OUT = (PENDING_OUT + 1) % PSLOTS;
3440 PENDING_TOTAL--;
3441 }
3442 }
3443 }
3444 index = (index + 1) % PSLOTS;
3445 }
3446 }
3447
3448 /*---------------------------------------------------------------------------*/
3449 /*> EOF interp.c <*/
GDB Binutils - Deliverables
This page took 0.157409 seconds and 4 git commands to generate.