123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682 |
- /* reg.c --- register set model for M32C simulator.
- Copyright (C) 2005-2022 Free Software Foundation, Inc.
- Contributed by Red Hat, Inc.
- This file is part of the GNU simulators.
- This program is free software; you can redistribute it and/or modify
- it under the terms of the GNU General Public License as published by
- the Free Software Foundation; either version 3 of the License, or
- (at your option) any later version.
- This program is distributed in the hope that it will be useful,
- but WITHOUT ANY WARRANTY; without even the implied warranty of
- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- GNU General Public License for more details.
- You should have received a copy of the GNU General Public License
- along with this program. If not, see <http://www.gnu.org/licenses/>. */
- /* This must come before any other includes. */
- #include "defs.h"
- #include <stdio.h>
- #include <stdlib.h>
- #include <string.h>
- #include "cpu.h"
- int verbose = 0;
- int trace = 0;
- int enable_counting = 0;
- int in_gdb = 1;
- regs_type regs;
- int addr_mask = 0xffff;
- int membus_mask = 0xfffff;
- int m32c_cpu = 0;
- int step_result;
- unsigned int heapbottom = 0;
- unsigned int heaptop = 0;
- char *reg_names[] = {
- "mem",
- "r0", "r0h", "r0l",
- "r1", "r1h", "r1l",
- "r2", "r2r0",
- "r3", "r3r1",
- "r3r1r2r0",
- "r3r2r1r0",
- "a0",
- "a1", "a1a0",
- "sb", "fb",
- "intb", "intbl", "intbh",
- "sp", "usp", "isp", "pc", "flags"
- };
- int reg_bytes[] = {
- 0,
- 2, 1, 1,
- 2, 1, 1,
- 2, 4,
- 2, 4,
- 8,
- 8,
- 2,
- 2, 4,
- 2, 2,
- 2, 1, 3,
- 2, 2, 2, 3, 2
- };
- unsigned int b2mask[] = { 0, 0xff, 0xffff, 0xffffff, 0xffffffff };
- unsigned int b2signbit[] = { 0, (1 << 7), (1 << 15), (1 << 24), (1 << 31) };
- int b2maxsigned[] = { 0, 0x7f, 0x7fff, 0x7fffff, 0x7fffffff };
- int b2minsigned[] = { 0, -128, -32768, -8388608, -2147483647 - 1 };
- static regs_type oldregs;
- int m32c_opcode_pc;
- void
- init_regs (void)
- {
- memset (®s, 0, sizeof (regs));
- memset (&oldregs, 0, sizeof (oldregs));
- }
- void
- set_pointer_width (int bytes)
- {
- if (bytes == 2)
- {
- addr_mask = 0xffff;
- membus_mask = 0x000fffff;
- reg_bytes[a0] = reg_bytes[a1] = reg_bytes[sb] = reg_bytes[fb] =
- reg_bytes[sp] = reg_bytes[usp] = reg_bytes[isp] = 2;
- }
- else
- {
- addr_mask = 0xffffff;
- membus_mask = 0x00ffffff;
- reg_bytes[a0] = reg_bytes[a1] = reg_bytes[sb] = reg_bytes[fb] =
- reg_bytes[sp] = reg_bytes[usp] = reg_bytes[isp] = 3;
- }
- }
- void
- m32c_set_cpu (int cpu)
- {
- switch (cpu)
- {
- case CPU_R8C:
- case CPU_M16C:
- set_pointer_width (2);
- decode_opcode = decode_r8c;
- break;
- case CPU_M32CM:
- case CPU_M32C:
- set_pointer_width (3);
- decode_opcode = decode_m32c;
- break;
- default:
- abort ();
- }
- m32c_cpu = cpu;
- }
- static unsigned int
- get_reg_i (reg_id id)
- {
- reg_bank_type *b = regs.r + (FLAG_B ? 1 : 0);
- switch (id)
- {
- case r0:
- return b->r_r0;
- case r0h:
- return b->r_r0 >> 8;
- case r0l:
- return b->r_r0 & 0xff;
- case r1:
- return b->r_r1;
- case r1h:
- return b->r_r1 >> 8;
- case r1l:
- return b->r_r1 & 0xff;
- case r2:
- return b->r_r2;
- case r2r0:
- return b->r_r2 * 65536 + b->r_r0;
- case r3:
- return b->r_r3;
- case r3r1:
- return b->r_r3 * 65536 + b->r_r1;
- case a0:
- return b->r_a0 & addr_mask;
- case a1:
- return b->r_a1 & addr_mask;
- case a1a0:
- return (b->r_a1 & 0xffff) * 65536 | (b->r_a0 & 0xffff);
- case sb:
- return b->r_sb & addr_mask;
- case fb:
- return b->r_fb & addr_mask;
- case intb:
- return regs.r_intbh * 65536 + regs.r_intbl;
- case intbl:
- return regs.r_intbl;
- case intbh:
- return regs.r_intbh;
- case sp:
- return ((regs.r_flags & FLAGBIT_U) ? regs.r_usp : regs.
- r_isp) & addr_mask;
- case usp:
- return regs.r_usp & addr_mask;
- case isp:
- return regs.r_isp & addr_mask;
- case pc:
- return regs.r_pc & membus_mask;
- case flags:
- return regs.r_flags;
- default:
- abort ();
- }
- }
- unsigned int
- get_reg (reg_id id)
- {
- unsigned int rv = get_reg_i (id);
- if (trace > ((id != pc && id != fb && id != sp) ? 0 : 1))
- printf ("get_reg (%s) = %0*x\n", reg_names[id], reg_bytes[id] * 2, rv);
- return rv;
- }
- DI
- get_reg_ll (reg_id id)
- {
- reg_bank_type *b = regs.r + (FLAG_B ? 1 : 0);
- switch (id)
- {
- case r3r1r2r0:
- return ((DI) b->r_r3 << 48
- | (DI) b->r_r1 << 32 | (DI) b->r_r2 << 16 | (DI) b->r_r0);
- case r3r2r1r0:
- return ((DI) b->r_r3 << 48
- | (DI) b->r_r2 << 32 | (DI) b->r_r1 << 16 | (DI) b->r_r0);
- default:
- return get_reg (id);
- }
- }
- static int highest_sp = 0, lowest_sp = 0xffffff;
- void
- stack_heap_stats (void)
- {
- printf ("heap: %08x - %08x (%d bytes)\n", heapbottom, heaptop,
- heaptop - heapbottom);
- printf ("stack: %08x - %08x (%d bytes)\n", lowest_sp, highest_sp,
- highest_sp - lowest_sp);
- }
- void
- put_reg (reg_id id, unsigned int v)
- {
- reg_bank_type *b = regs.r + (FLAG_B ? 1 : 0);
- if (trace > ((id != pc) ? 0 : 1))
- printf ("put_reg (%s) = %0*x\n", reg_names[id], reg_bytes[id] * 2, v);
- switch (id)
- {
- case r0:
- b->r_r0 = v;
- break;
- case r0h:
- b->r_r0 = (b->r_r0 & 0xff) | (v << 8);
- break;
- case r0l:
- b->r_r0 = (b->r_r0 & 0xff00) | (v & 0xff);
- break;
- case r1:
- b->r_r1 = v;
- break;
- case r1h:
- b->r_r1 = (b->r_r1 & 0xff) | (v << 8);
- break;
- case r1l:
- b->r_r1 = (b->r_r1 & 0xff00) | (v & 0xff);
- break;
- case r2:
- b->r_r2 = v;
- break;
- case r2r0:
- b->r_r0 = v & 0xffff;
- b->r_r2 = v >> 16;
- break;
- case r3:
- b->r_r3 = v;
- break;
- case r3r1:
- b->r_r1 = v & 0xffff;
- b->r_r3 = v >> 16;
- break;
- case a0:
- b->r_a0 = v & addr_mask;
- break;
- case a1:
- b->r_a1 = v & addr_mask;
- break;
- case a1a0:
- b->r_a0 = v & 0xffff;
- b->r_a1 = v >> 16;
- break;
- case sb:
- b->r_sb = v & addr_mask;
- break;
- case fb:
- b->r_fb = v & addr_mask;
- break;
- case intb:
- regs.r_intbl = v & 0xffff;
- regs.r_intbh = v >> 16;
- break;
- case intbl:
- regs.r_intbl = v & 0xffff;
- break;
- case intbh:
- regs.r_intbh = v & 0xff;
- break;
- case sp:
- {
- SI *spp;
- if (regs.r_flags & FLAGBIT_U)
- spp = ®s.r_usp;
- else
- spp = ®s.r_isp;
- *spp = v & addr_mask;
- if (*spp < heaptop)
- {
- printf ("collision: pc %08lx heap %08x stack %08lx\n", regs.r_pc,
- heaptop, *spp);
- exit (1);
- }
- if (*spp < lowest_sp)
- lowest_sp = *spp;
- if (*spp > highest_sp)
- highest_sp = *spp;
- break;
- }
- case usp:
- regs.r_usp = v & addr_mask;
- break;
- case isp:
- regs.r_isp = v & addr_mask;
- break;
- case pc:
- regs.r_pc = v & membus_mask;
- break;
- case flags:
- regs.r_flags = v;
- break;
- default:
- abort ();
- }
- }
- int
- condition_true (int cond_id)
- {
- int f;
- if (A16)
- {
- static const char *cond_name[] = {
- "C", "C&!Z", "Z", "S",
- "!C", "!(C&!Z)", "!Z", "!S",
- "(S^O)|Z", "O", "!(S^O)", "unk",
- "!((S^O)|Z)", "!O", "S^O", "unk"
- };
- switch (cond_id & 15)
- {
- case 0:
- f = FLAG_C;
- break; /* GEU/C */
- case 1:
- f = FLAG_C & !FLAG_Z;
- break; /* GTU */
- case 2:
- f = FLAG_Z;
- break; /* EQ/Z */
- case 3:
- f = FLAG_S;
- break; /* N */
- case 4:
- f = !FLAG_C;
- break; /* LTU/NC */
- case 5:
- f = !(FLAG_C & !FLAG_Z);
- break; /* LEU */
- case 6:
- f = !FLAG_Z;
- break; /* NE/NZ */
- case 7:
- f = !FLAG_S;
- break; /* PZ */
- case 8:
- f = (FLAG_S ^ FLAG_O) | FLAG_Z;
- break; /* LE */
- case 9:
- f = FLAG_O;
- break; /* O */
- case 10:
- f = !(FLAG_S ^ FLAG_O);
- break; /* GE */
- case 12:
- f = !((FLAG_S ^ FLAG_O) | FLAG_Z);
- break; /* GT */
- case 13:
- f = !FLAG_O;
- break; /* NO */
- case 14:
- f = FLAG_S ^ FLAG_O;
- break; /* LT */
- default:
- f = 0;
- break;
- }
- if (trace)
- printf ("cond[%d] %s = %s\n", cond_id, cond_name[cond_id & 15],
- f ? "true" : "false");
- }
- else
- {
- static const char *cond_name[] = {
- "!C", "LEU", "!Z", "PZ",
- "!O", "GT", "GE", "?",
- "C", "GTU", "Z", "N",
- "O", "LE", "LT", "!?"
- };
- switch (cond_id & 15)
- {
- case 0:
- f = !FLAG_C;
- break; /* LTU/NC */
- case 1:
- f = !(FLAG_C & !FLAG_Z);
- break; /* LEU */
- case 2:
- f = !FLAG_Z;
- break; /* NE/NZ */
- case 3:
- f = !FLAG_S;
- break; /* PZ */
- case 4:
- f = !FLAG_O;
- break; /* NO */
- case 5:
- f = !((FLAG_S ^ FLAG_O) | FLAG_Z);
- break; /* GT */
- case 6:
- f = !(FLAG_S ^ FLAG_O);
- break; /* GE */
- case 8:
- f = FLAG_C;
- break; /* GEU/C */
- case 9:
- f = FLAG_C & !FLAG_Z;
- break; /* GTU */
- case 10:
- f = FLAG_Z;
- break; /* EQ/Z */
- case 11:
- f = FLAG_S;
- break; /* N */
- case 12:
- f = FLAG_O;
- break; /* O */
- case 13:
- f = (FLAG_S ^ FLAG_O) | FLAG_Z;
- break; /* LE */
- case 14:
- f = FLAG_S ^ FLAG_O;
- break; /* LT */
- default:
- f = 0;
- break;
- }
- if (trace)
- printf ("cond[%d] %s = %s\n", cond_id, cond_name[cond_id & 15],
- f ? "true" : "false");
- }
- return f;
- }
- void
- set_flags (int mask, int newbits)
- {
- int i;
- regs.r_flags &= ~mask;
- regs.r_flags |= newbits & mask;
- if (trace)
- {
- printf ("flags now \033[32m %d", (regs.r_flags >> (A16 ? 8 : 12)) & 7);
- for (i = 7; i >= 0; i--)
- if (regs.r_flags & (1 << i))
- putchar ("CDZSBOIU"[i]);
- else
- putchar ('-');
- printf ("\033[0m\n");
- }
- }
- void
- set_oszc (int value, int b, int c)
- {
- int mask = b2mask[b];
- int f = 0;
- if (c)
- f |= FLAGBIT_C;
- if ((value & mask) == 0)
- f |= FLAGBIT_Z;
- if (value & b2signbit[b])
- f |= FLAGBIT_S;
- if ((value > b2maxsigned[b]) || (value < b2minsigned[b]))
- f |= FLAGBIT_O;
- set_flags (FLAGBIT_Z | FLAGBIT_S | FLAGBIT_O | FLAGBIT_C, f);
- }
- void
- set_szc (int value, int b, int c)
- {
- int mask = b2mask[b];
- int f = 0;
- if (c)
- f |= FLAGBIT_C;
- if ((value & mask) == 0)
- f |= FLAGBIT_Z;
- if (value & b2signbit[b])
- f |= FLAGBIT_S;
- set_flags (FLAGBIT_Z | FLAGBIT_S | FLAGBIT_C, f);
- }
- void
- set_osz (int value, int b)
- {
- int mask = b2mask[b];
- int f = 0;
- if ((value & mask) == 0)
- f |= FLAGBIT_Z;
- if (value & b2signbit[b])
- f |= FLAGBIT_S;
- if (value & ~mask && (value & ~mask) != ~mask)
- f |= FLAGBIT_O;
- set_flags (FLAGBIT_Z | FLAGBIT_S | FLAGBIT_O, f);
- }
- void
- set_sz (int value, int b)
- {
- int mask = b2mask[b];
- int f = 0;
- if ((value & mask) == 0)
- f |= FLAGBIT_Z;
- if (value & b2signbit[b])
- f |= FLAGBIT_S;
- set_flags (FLAGBIT_Z | FLAGBIT_S, f);
- }
- void
- set_zc (int z, int c)
- {
- set_flags (FLAGBIT_C | FLAGBIT_Z,
- (c ? FLAGBIT_C : 0) | (z ? FLAGBIT_Z : 0));
- }
- void
- set_c (int c)
- {
- set_flags (FLAGBIT_C, c ? FLAGBIT_C : 0);
- }
- void
- put_reg_ll (reg_id id, DI v)
- {
- reg_bank_type *b = regs.r + (FLAG_B ? 1 : 0);
- switch (id)
- {
- case r3r1r2r0:
- b->r_r3 = v >> 48;
- b->r_r1 = v >> 32;
- b->r_r2 = v >> 16;
- b->r_r0 = v;
- break;
- case r3r2r1r0:
- b->r_r3 = v >> 48;
- b->r_r2 = v >> 32;
- b->r_r1 = v >> 16;
- b->r_r0 = v;
- break;
- default:
- put_reg (id, v);
- }
- }
- static void
- print_flags (int f)
- {
- int i;
- static char fn[] = "CDZSBOIU";
- printf ("%d.", (f >> 12) & 7);
- for (i = 7; i >= 0; i--)
- if (f & (1 << i))
- putchar (fn[i]);
- }
- #define TRC(f,n, id) \
- if (oldregs.f != regs.f) \
- { \
- printf(" %s %0*x:%0*x", n, \
- reg_bytes[id]*2, (unsigned int)oldregs.f, \
- reg_bytes[id]*2, (unsigned int)regs.f); \
- oldregs.f = regs.f; \
- }
- void
- trace_register_changes (void)
- {
- if (!trace)
- return;
- printf ("\033[36mREGS:");
- TRC (r[0].r_r0, "r0", r0);
- TRC (r[0].r_r1, "r1", r1);
- TRC (r[0].r_r2, "r2", r2);
- TRC (r[0].r_r3, "r3", r3);
- TRC (r[0].r_a0, "a0", a0);
- TRC (r[0].r_a1, "a1", a1);
- TRC (r[0].r_sb, "sb", sb);
- TRC (r[0].r_fb, "fb", fb);
- TRC (r[1].r_r0, "r0'", r0);
- TRC (r[1].r_r1, "r1'", r1);
- TRC (r[1].r_r2, "r2'", r2);
- TRC (r[1].r_r3, "r3'", r3);
- TRC (r[1].r_a0, "a0'", a0);
- TRC (r[1].r_a1, "a1'", a1);
- TRC (r[1].r_sb, "sb'", sb);
- TRC (r[1].r_fb, "fb'", fb);
- TRC (r_intbh, "intbh", intbh);
- TRC (r_intbl, "intbl", intbl);
- TRC (r_usp, "usp", usp);
- TRC (r_isp, "isp", isp);
- TRC (r_pc, "pc", pc);
- if (oldregs.r_flags != regs.r_flags)
- {
- printf (" flags ");
- print_flags (oldregs.r_flags);
- printf (":");
- print_flags (regs.r_flags);
- }
- printf ("\033[0m\n");
- }
- #define DRC(f, n, id) \
- printf(" %-3s %0*x", n, \
- reg_bytes[id]*2, (unsigned int)regs.f); \
- void
- m32c_dump_all_registers (void)
- {
- printf ("\033[36mREGS:");
- DRC (r[0].r_r0, "r0", r0);
- DRC (r[0].r_r1, "r1", r1);
- DRC (r[0].r_r2, "r2", r2);
- DRC (r[0].r_r3, "r3", r3);
- DRC (r[0].r_a0, "a0", a0);
- DRC (r[0].r_a1, "a1", a1);
- DRC (r[0].r_sb, "sb", sb);
- DRC (r[0].r_fb, "fb", fb);
- printf ("\n ");
- DRC (r[1].r_r0, "r0'", r0);
- DRC (r[1].r_r1, "r1'", r1);
- DRC (r[1].r_r2, "r2'", r2);
- DRC (r[1].r_r3, "r3'", r3);
- DRC (r[1].r_a0, "a0'", a0);
- DRC (r[1].r_a1, "a1'", a1);
- DRC (r[1].r_sb, "sb'", sb);
- DRC (r[1].r_fb, "fb'", fb);
- printf (" \n");
- DRC (r_intbh, "intbh", intbh);
- DRC (r_intbl, "intbl", intbl);
- DRC (r_usp, "usp", usp);
- DRC (r_isp, "isp", isp);
- DRC (r_pc, "pc", pc);
- printf (" flags ");
- print_flags (regs.r_flags);
- printf ("\033[0m\n");
- /*sim_disasm_one (); */
- }
|