/* hp2100_cpu.c: HP 2100 CPU simulator | |
Copyright (c) 1993-2004, Robert M. Supnik | |
Permission is hereby granted, free of charge, to any person obtaining a | |
copy of this software and associated documentation files (the "Software"), | |
to deal in the Software without restriction, including without limitation | |
the rights to use, copy, modify, merge, publish, distribute, sublicense, | |
and/or sell copies of the Software, and to permit persons to whom the | |
Software is furnished to do so, subject to the following conditions: | |
The above copyright notice and this permission notice shall be included in | |
all copies or substantial portions of the Software. | |
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | |
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | |
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL | |
ROBERT M SUPNIK BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER | |
IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | |
CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. | |
Except as contained in this notice, the name of Robert M Supnik shall not | |
be used in advertising or otherwise to promote the sale, use or other dealings | |
in this Software without prior written authorization from Robert M Supnik. | |
20-Jul-04 RMS Fixed bug in breakpoint test (reported by Dave Bryan) | |
Back up PC on instruction errors (from Dave Bryan) | |
14-May-04 RMS Fixed bugs and added features from Dave Bryan | |
- SBT increments B after store | |
- DMS console map must check dms_enb | |
- SFS x,C and SFC x,C work | |
- MP violation clears automatically on interrupt | |
- SFS/SFC 5 is not gated by protection enabled | |
- DMS enable does not disable mem prot checks | |
- DMS status inconsistent at simulator halt | |
- Examine/deposit are checking wrong addresses | |
- Physical addresses are 20b not 15b | |
- Revised DMS to use memory rather than internal format | |
- Added instruction printout to HALT message | |
- Added M and T internal registers | |
- Added N, S, and U breakpoints | |
Revised IBL facility to conform to microcode | |
Added DMA EDT I/O pseudo-opcode | |
Separated DMA SRQ (service request) from FLG | |
12-Mar-03 RMS Added logical name support | |
02-Feb-03 RMS Fixed last cycle bug in DMA output (found by Mike Gemeny) | |
22-Nov-02 RMS Added 21MX IOP support | |
24-Oct-02 RMS Fixed bugs in IOP and extended instructions | |
Fixed bugs in memory protection and DMS | |
Added clock calibration | |
25-Sep-02 RMS Fixed bug in DMS decode (found by Robert Alan Byer) | |
26-Jul-02 RMS Restructured extended instructions, added IOP support | |
22-Mar-02 RMS Changed to allocate memory array dynamically | |
11-Mar-02 RMS Cleaned up setjmp/auto variable interaction | |
17-Feb-02 RMS Added DMS support | |
Fixed bugs in extended instructions | |
03-Feb-02 RMS Added terminal multiplexor support | |
Changed PCQ macro to use unmodified PC | |
Fixed flop restore logic (found by Bill McDermith) | |
Fixed SZx,SLx,RSS bug (found by Bill McDermith) | |
Added floating point support | |
16-Jan-02 RMS Added additional device support | |
07-Jan-02 RMS Fixed DMA register tables (found by Bill McDermith) | |
07-Dec-01 RMS Revised to use breakpoint package | |
03-Dec-01 RMS Added extended SET/SHOW support | |
10-Aug-01 RMS Removed register in declarations | |
26-Nov-00 RMS Fixed bug in dual device number routine | |
21-Nov-00 RMS Fixed bug in reset routine | |
15-Oct-00 RMS Added dynamic device number support | |
The register state for the HP 2116 CPU is: | |
AR<15:0> A register - addressable as location 0 | |
BR<15:0> B register - addressable as location 1 | |
PC<14:0> P register (program counter) | |
SR<15:0> S register | |
MR<14:0> M register - memory address | |
TR<15:0> T register - memory data | |
E extend flag (carry out) | |
O overflow flag | |
The 2100 adds memory protection logic: | |
mp_fence<14:0> memory fence register | |
mp_viol<15:0> memory protection violation register (F register) | |
The 21MX adds a pair of index registers and memory expansion logic: | |
XR<15:0> X register | |
YR<15:0> Y register | |
dms_sr<15:0> dynamic memory system status register | |
dms_vr<15:0> dynamic memory system violation register | |
The original HP 2116 has four instruction formats: memory reference, | |
shift, alter/skip, and I/O. The HP 2100 added extended memory reference | |
and extended arithmetic. The HP21MX added extended byte, bit, and word | |
instructions as well as extended memory. | |
The memory reference format is: | |
15 14 13 12 11 10 9 8 7 6 5 4 3 2 1 0 | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
|in| op |cp| offset | memory reference | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
<14:11> mnemonic action | |
0010 AND A = A & M[MA] | |
0011 JSB M[MA] = P, P = MA + 1 | |
0100 XOR A = A ^ M[MA] | |
0101 JMP P = MA | |
0110 IOR A = A | M[MA] | |
0111 ISZ M[MA] = M[MA] + 1, skip if M[MA] == 0 | |
1000 ADA A = A + M[MA] | |
1001 ADB B = B + M[MA] | |
1010 CPA skip if A != M[MA] | |
1011 CPB skip if B != M[MA] | |
1100 LDA A = M[MA] | |
1101 LDB B = M[MA] | |
1110 STA M[MA] = A | |
1111 STB M[MA] = B | |
<15,10> mode action | |
0,0 page zero direct MA = IR<9:0> | |
0,1 current page direct MA = PC<14:0>'IR,9:0> | |
1,0 page zero indirect MA = M[IR<9:0>] | |
1,1 current page indirect MA = M[PC<14:10>'IR<9:0>] | |
Memory reference instructions can access an address space of 32K words. | |
An instruction can directly reference the first 1024 words of memory | |
(called page zero), as well as 1024 words of the current page; it can | |
indirectly access all 32K. | |
*/ | |
/* The shift format is: | |
15 14 13 12 11 10 9 8 7 6 5 4 3 2 1 0 | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
| 0 0 0 0|ab| 0|s1| op1 |ce|s2|sl| op2 | shift | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
| | \---+---/ | | | \---+---/ | |
| | | | | | | | |
| | | | | | +---- shift 2 opcode | |
| | | | | +---------- skip if low bit == 0 | |
| | | | +------------- shift 2 enable | |
| | | +---------------- clear Extend | |
| | +---------------------- shift 1 opcode | |
| +---------------------------- shift 1 enable | |
+---------------------------------- A/B select | |
The alter/skip format is: | |
15 14 13 12 11 10 9 8 7 6 5 4 3 2 1 0 | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
| 0 0 0 0|ab| 1|regop| e op|se|ss|sl|in|sz|rs| alter/skip | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
| \-+-/ \-+-/ | | | | | | | |
| | | | | | | | +- reverse skip sense | |
| | | | | | | +---- skip if register == 0 | |
| | | | | | +------- increment register | |
| | | | | +---------- skip if low bit == 0 | |
| | | | +------------- skip if sign bit == 0 | |
| | | +---------------- skip if Extend == 0 | |
| | +--------------------- clr/com/set Extend | |
| +--------------------------- clr/com/set register | |
+---------------------------------- A/B select | |
The I/O transfer format is: | |
15 14 13 12 11 10 9 8 7 6 5 4 3 2 1 0 | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
| 1 0 0 0|ab| 1|hc| opcode | device | I/O transfer | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
| | \---+---/\-------+-------/ | |
| | | | | |
| | | +--------- device select | |
| | +---------------------- opcode | |
| +---------------------------- hold/clear flag | |
+---------------------------------- A/B select | |
The IO transfer instruction controls the specified device. | |
Depending on the opcode, the instruction may set or clear | |
the device flag, start or stop I/O, or read or write data. | |
*/ | |
/* The 2100 added an extended memory reference instruction; | |
the 21MX added extended arithmetic, operate, byte, word, | |
and bit instructions. Note that the HP 21xx is, despite | |
the right-to-left bit numbering, a big endian system. | |
Bits <15:8> are byte 0, and bits <7:0> are byte 1. | |
The extended memory reference format (HP 2100) is: | |
15 14 13 12 11 10 9 8 7 6 5 4 3 2 1 0 | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
| 1| 0 0 0|op| 0| opcode | extended mem ref | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
|in| operand address | | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
The extended arithmetic format (HP 2100) is: | |
15 14 13 12 11 10 9 8 7 6 5 4 3 2 1 0 | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
| 1| 0 0 0 0 0|dr| 0 0| opcode |shift count| extended arithmetic | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
The extended operate format (HP 21MX) is: | |
15 14 13 12 11 10 9 8 7 6 5 4 3 2 1 0 | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
| 1| 0 0 0|op| 0| 1 1 1 1 1| opcode | extended operate | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
The extended byte and word format (HP 21MX) is: | |
15 14 13 12 11 10 9 8 7 6 5 4 3 2 1 0 | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
| 1| 0 0 0 1 0 1 1 1 1 1 1| opcode | extended byte/word | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
|in| operand address | | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
| 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0| | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
The extended bit operate format (HP 21MX) is: | |
15 14 13 12 11 10 9 8 7 6 5 4 3 2 1 0 | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
| 1| 0 0 0 1 0 1 1 1 1 1 1 1| opcode | extended bit operate | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
|in| operand address | | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
|in| operand address | | |
+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+ | |
*/ | |
/* This routine is the instruction decode routine for the HP 2100. | |
It is called from the simulator control program to execute | |
instructions in simulated memory, starting at the simulated PC. | |
It runs until 'reason' is set non-zero. | |
General notes: | |
1. Reasons to stop. The simulator can be stopped by: | |
HALT instruction | |
breakpoint encountered | |
infinite indirection loop | |
unimplemented instruction and stop_inst flag set | |
unknown I/O device and stop_dev flag set | |
I/O error in I/O simulator | |
2. Interrupts. I/O devices are modelled as five parallel arrays: | |
device commands as bit array dev_cmd[2][31..0] | |
device flags as bit array dev_flg[2][31..0] | |
device flag buffers as bit array dev_fbf[2][31..0] | |
device controls as bit array dev_ctl[2][31..0] | |
device service requests as bit array dev_srq[3][31..0] | |
The HP 2100 interrupt structure is based on flag, flag buffer,. | |
and control. If a device flag is set, the flag buffer is set, | |
the control bit is set, and the device is the highest priority | |
on the interrupt chain, it requests an interrupt. When the | |
interrupt is acknowledged, the flag buffer is cleared, preventing | |
further interrupt requests from that device. The combination of | |
flag and control set blocks interrupts from lower priority devices. | |
Command plays no direct role in interrupts. The command flop | |
tells whether a device is active. It is set by STC and cleared | |
by CLC; it is also cleared when the device flag is set. Simple | |
devices don't need to track command separately from control. | |
Service requests are used to trigger the DMA service logic. | |
3. Non-existent memory. On the HP 2100, reads to non-existent memory | |
return zero, and writes are ignored. In the simulator, the | |
largest possible memory is instantiated and initialized to zero. | |
Thus, only writes need be checked against actual memory size. | |
4. Adding I/O devices. These modules must be modified: | |
hp2100_defs.h add interrupt request definition | |
hp2100_sys.c add sim_devices table entry | |
5. Instruction interruptibility. The simulator is fast enough, compared | |
to the run-time of the longest instructions, for interruptibility not | |
to matter. But the HP diagnostics explicitly test interruptibility in | |
EIS and DMS instructions, and long indirect address chains. Accordingly, | |
the simulator does "just enough" to pass these tests. In particular, if | |
an interrupt is pending but deferred at the beginning of an interruptible | |
instruction, the interrupt is taken at the appropriate point; but there | |
is no testing for new interrupts during execution (that is, the event | |
timer is not called). | |
*/ | |
#include "hp2100_defs.h" | |
#include <setjmp.h> | |
#define PCQ_SIZE 64 /* must be 2**n */ | |
#define PCQ_MASK (PCQ_SIZE - 1) | |
#define PCQ_ENTRY pcq[pcq_p = (pcq_p - 1) & PCQ_MASK] = err_PC | |
#define UNIT_V_2100 (UNIT_V_UF + 0) /* 2100 */ | |
#define UNIT_V_21MX (UNIT_V_UF + 1) /* 21MX */ | |
#define UNIT_V_EAU (UNIT_V_UF + 2) /* EAU */ | |
#define UNIT_V_FP (UNIT_V_UF + 3) /* FP */ | |
#define UNIT_V_MPR (UNIT_V_UF + 4) /* mem prot */ | |
#define UNIT_V_DMS (UNIT_V_UF + 5) /* DMS */ | |
#define UNIT_V_IOP (UNIT_V_UF + 6) /* 2100 IOP */ | |
#define UNIT_V_IOPX (UNIT_V_UF + 7) /* 21MX IOP */ | |
#define UNIT_V_MSIZE (UNIT_V_UF + 8) /* dummy mask */ | |
#define UNIT_2100 (1 << UNIT_V_2100) | |
#define UNIT_21MX (1 << UNIT_V_21MX) | |
#define UNIT_EAU (1 << UNIT_V_EAU) | |
#define UNIT_FP (1 << UNIT_V_FP) | |
#define UNIT_MPR (1 << UNIT_V_MPR) | |
#define UNIT_DMS (1 << UNIT_V_DMS) | |
#define UNIT_IOP (1 << UNIT_V_IOP) | |
#define UNIT_IOPX (1 << UNIT_V_IOPX) | |
#define UNIT_MSIZE (1 << UNIT_V_MSIZE) | |
#define MOD_2116 1 | |
#define MOD_2100 2 | |
#define MOD_21MX 4 | |
#define ABORT(val) longjmp (save_env, (val)) | |
#define DMAR0 1 | |
#define DMAR1 2 | |
#define ALL_BKPTS (SWMASK('E')|SWMASK('N')|SWMASK('S')|SWMASK('U')) | |
uint16 *M = NULL; /* memory */ | |
uint32 saved_AR = 0; /* A register */ | |
uint32 saved_BR = 0; /* B register */ | |
uint32 PC = 0; /* P register */ | |
uint32 SR = 0; /* S register */ | |
uint32 MR = 0; /* M register */ | |
uint32 TR = 0; /* T register */ | |
uint32 XR = 0; /* X register */ | |
uint32 YR = 0; /* Y register */ | |
uint32 E = 0; /* E register */ | |
uint32 O = 0; /* O register */ | |
uint32 dev_cmd[2] = { 0 }; /* device command */ | |
uint32 dev_ctl[2] = { 0 }; /* device control */ | |
uint32 dev_flg[2] = { 0 }; /* device flags */ | |
uint32 dev_fbf[2] = { 0 }; /* device flag bufs */ | |
uint32 dev_srq[2] = { 0 }; /* device svc reqs */ | |
struct DMA dmac[2] = { { 0 }, { 0 } }; /* DMA channels */ | |
uint32 ion = 0; /* interrupt enable */ | |
uint32 ion_defer = 0; /* interrupt defer */ | |
uint32 intaddr = 0; /* interrupt addr */ | |
uint32 mp_fence = 0; /* mem prot fence */ | |
uint32 mp_viol = 0; /* mem prot viol reg */ | |
uint32 mp_mevff = 0; /* mem exp (dms) viol */ | |
uint32 mp_evrff = 1; /* update mp_viol */ | |
uint32 err_PC = 0; /* error PC */ | |
uint32 dms_enb = 0; /* dms enable */ | |
uint32 dms_ump = 0; /* dms user map */ | |
uint32 dms_sr = 0; /* dms status reg */ | |
uint32 dms_vr = 0; /* dms violation reg */ | |
uint16 dms_map[MAP_NUM * MAP_LNT] = { 0 }; /* dms maps */ | |
uint32 iop_sp = 0; /* iop stack */ | |
uint32 ind_max = 16; /* iadr nest limit */ | |
uint32 stop_inst = 1; /* stop on ill inst */ | |
uint32 stop_dev = 0; /* stop on ill dev */ | |
uint16 pcq[PCQ_SIZE] = { 0 }; /* PC queue */ | |
uint32 pcq_p = 0; /* PC queue ptr */ | |
REG *pcq_r = NULL; /* PC queue reg ptr */ | |
jmp_buf save_env; /* abort handler */ | |
struct opt_table { /* options table */ | |
int32 optf; | |
int32 cpuf; }; | |
static struct opt_table opt_val[] = { | |
{ UNIT_EAU, MOD_2116 }, | |
{ UNIT_FP, MOD_2100 }, | |
{ UNIT_MPR, MOD_2100 | MOD_21MX }, | |
{ UNIT_DMS, MOD_21MX }, | |
{ UNIT_IOP, MOD_2100 | MOD_21MX }, | |
{ 0, 0 } }; | |
extern int32 sim_interval; | |
extern int32 sim_int_char; | |
extern int32 sim_brk_types, sim_brk_dflt, sim_brk_summ; /* breakpoint info */ | |
extern FILE *sim_log; | |
extern DEVICE *sim_devices[]; | |
extern char halt_msg[]; | |
t_stat Ea (uint32 IR, uint32 *addr, uint32 irq); | |
t_stat Ea1 (uint32 *addr, uint32 irq); | |
uint8 ReadB (uint32 addr); | |
uint8 ReadBA (uint32 addr); | |
uint16 ReadW (uint32 addr); | |
uint16 ReadWA (uint32 addr); | |
uint32 ReadF (uint32 addr); | |
uint16 ReadIO (uint32 addr, uint32 map); | |
void WriteB (uint32 addr, uint32 dat); | |
void WriteBA (uint32 addr, uint32 dat); | |
void WriteW (uint32 addr, uint32 dat); | |
void WriteWA (uint32 addr, uint32 dat); | |
void WriteIO (uint32 addr, uint32 dat, uint32 map); | |
t_stat iogrp (uint32 ir, uint32 iotrap); | |
uint32 dms (uint32 va, uint32 map, uint32 prot); | |
uint32 dms_io (uint32 va, uint32 map); | |
void mp_dms_jmp (uint32 va); | |
uint16 dms_rmap (uint32 mapi); | |
void dms_wmap (uint32 mapi, uint32 dat); | |
void dms_viol (uint32 va, uint32 st); | |
uint32 dms_upd_sr (void); | |
uint32 shift (uint32 inval, uint32 flag, uint32 oper); | |
uint32 calc_dma (void); | |
uint32 calc_int (void); | |
void dma_cycle (uint32 chan, uint32 map); | |
t_stat cpu_ex (t_value *vptr, t_addr addr, UNIT *uptr, int32 sw); | |
t_stat cpu_dep (t_value val, t_addr addr, UNIT *uptr, int32 sw); | |
t_stat cpu_reset (DEVICE *dptr); | |
t_stat cpu_boot (int32 unitno, DEVICE *dptr); | |
t_stat dma0_reset (DEVICE *dptr); | |
t_stat dma1_reset (DEVICE *dptr); | |
t_stat cpu_set_size (UNIT *uptr, int32 val, char *cptr, void *desc); | |
t_stat cpu_set_opt (UNIT *uptr, int32 val, char *cptr, void *desc); | |
t_bool dev_conflict (void); | |
extern uint32 f_as (uint32 op, t_bool sub); | |
extern uint32 f_mul (uint32 op); | |
extern uint32 f_div (uint32 op); | |
extern uint32 f_fix (void); | |
extern uint32 f_flt (void); | |
extern int32 clk_delay (int32 flg); | |
/* CPU data structures | |
cpu_dev CPU device descriptor | |
cpu_unit CPU unit descriptor | |
cpu_reg CPU register list | |
cpu_mod CPU modifiers list | |
*/ | |
UNIT cpu_unit = { UDATA (NULL, UNIT_FIX + UNIT_BINK, VASIZE) }; | |
REG cpu_reg[] = { | |
{ ORDATA (P, PC, 15) }, | |
{ ORDATA (A, saved_AR, 16) }, | |
{ ORDATA (B, saved_BR, 16) }, | |
{ ORDATA (M, MR, 15) }, | |
{ ORDATA (T, TR, 16), REG_RO }, | |
{ ORDATA (X, XR, 16) }, | |
{ ORDATA (Y, YR, 16) }, | |
{ ORDATA (S, SR, 16) }, | |
{ FLDATA (E, E, 0) }, | |
{ FLDATA (O, O, 0) }, | |
{ FLDATA (ION, ion, 0) }, | |
{ FLDATA (ION_DEFER, ion_defer, 0) }, | |
{ ORDATA (CIR, intaddr, 6) }, | |
{ FLDATA (MPCTL, dev_ctl[PRO/32], INT_V (PRO)) }, | |
{ FLDATA (MPFLG, dev_flg[PRO/32], INT_V (PRO)) }, | |
{ FLDATA (MPFBF, dev_fbf[PRO/32], INT_V (PRO)) }, | |
{ ORDATA (MPFR, mp_fence, 15) }, | |
{ ORDATA (MPVR, mp_viol, 16) }, | |
{ FLDATA (MPMEV, mp_mevff, 0) }, | |
{ FLDATA (MPEVR, mp_evrff, 0) }, | |
{ FLDATA (DMSENB, dms_enb, 0) }, | |
{ FLDATA (DMSCUR, dms_ump, VA_N_PAG) }, | |
{ ORDATA (DMSSR, dms_sr, 16) }, | |
{ ORDATA (DMSVR, dms_vr, 16) }, | |
{ BRDATA (DMSMAP, dms_map, 8, 16, MAP_NUM * MAP_LNT) }, | |
{ ORDATA (IOPSP, iop_sp, 16) }, | |
{ FLDATA (STOP_INST, stop_inst, 0) }, | |
{ FLDATA (STOP_DEV, stop_dev, 1) }, | |
{ DRDATA (INDMAX, ind_max, 16), REG_NZ + PV_LEFT }, | |
{ BRDATA (PCQ, pcq, 8, 15, PCQ_SIZE), REG_RO+REG_CIRC }, | |
{ ORDATA (PCQP, pcq_p, 6), REG_HRO }, | |
{ ORDATA (WRU, sim_int_char, 8) }, | |
{ ORDATA (HCMD, dev_cmd[0], 32), REG_HRO }, | |
{ ORDATA (LCMD, dev_cmd[1], 32), REG_HRO }, | |
{ ORDATA (HCTL, dev_ctl[0], 32), REG_HRO }, | |
{ ORDATA (LCTL, dev_ctl[1], 32), REG_HRO }, | |
{ ORDATA (HFLG, dev_flg[0], 32), REG_HRO }, | |
{ ORDATA (LFLG, dev_flg[1], 32), REG_HRO }, | |
{ ORDATA (HFBF, dev_fbf[0], 32), REG_HRO }, | |
{ ORDATA (LFBF, dev_fbf[1], 32), REG_HRO }, | |
{ ORDATA (HSRQ, dev_srq[0], 32), REG_HRO }, | |
{ ORDATA (LSRQ, dev_srq[1], 32), REG_HRO }, | |
{ NULL } }; | |
MTAB cpu_mod[] = { | |
{ UNIT_2100+UNIT_21MX+UNIT_EAU+UNIT_FP+UNIT_MPR+UNIT_DMS+UNIT_IOP+UNIT_IOPX, | |
0, NULL, "2116", NULL }, | |
{ UNIT_2100+UNIT_21MX+UNIT_EAU+UNIT_FP+UNIT_MPR+UNIT_DMS+UNIT_IOP+UNIT_IOPX, | |
UNIT_2100+UNIT_EAU, NULL, "2100", NULL }, | |
{ UNIT_2100+UNIT_21MX+UNIT_EAU+UNIT_FP+UNIT_MPR+UNIT_DMS+UNIT_IOP+UNIT_IOPX, | |
UNIT_21MX+UNIT_EAU+UNIT_FP+UNIT_MPR+UNIT_DMS, NULL, "21MX", NULL }, | |
{ UNIT_2100+UNIT_21MX, 0, "2116", NULL, NULL }, | |
{ UNIT_2100+UNIT_21MX, UNIT_2100, "2100", NULL, NULL }, | |
{ UNIT_2100+UNIT_21MX, UNIT_21MX, "21MX", NULL, NULL }, | |
{ UNIT_EAU, UNIT_EAU, "EAU", "EAU", &cpu_set_opt, | |
NULL, (void *) UNIT_EAU }, | |
{ UNIT_EAU, 0, "no EAU", "NOEAU", &cpu_set_opt, | |
NULL, (void *) UNIT_EAU }, | |
{ UNIT_FP, UNIT_FP, "FP", "FP", &cpu_set_opt, | |
NULL, (void *) UNIT_FP }, | |
{ UNIT_FP, 0, "no FP", "NOFP", &cpu_set_opt, | |
NULL, (void *) UNIT_FP }, | |
{ UNIT_MPR, UNIT_MPR, "MPR", "MPR", &cpu_set_opt, | |
NULL, (void *) UNIT_MPR }, | |
{ UNIT_MPR, 0, "no MPR", "NOMPR", &cpu_set_opt, | |
NULL, (void *) UNIT_MPR }, | |
{ UNIT_DMS, UNIT_DMS, "DMS", "DMS", &cpu_set_opt, | |
NULL, (void *) UNIT_DMS }, | |
{ UNIT_DMS, 0, "no DMS", "NODMS", &cpu_set_opt, | |
NULL, (void *) UNIT_DMS }, | |
{ UNIT_MSIZE, 2, NULL, "IOP", &cpu_set_opt, | |
NULL, (void *) UNIT_IOP }, | |
{ UNIT_IOP+UNIT_IOPX, UNIT_IOP, "IOP", NULL, NULL }, | |
{ UNIT_IOP+UNIT_IOPX, UNIT_IOPX, "IOP", NULL, NULL }, | |
{ UNIT_IOP+UNIT_IOPX, 0, "no IOP", "NOIOP", &cpu_set_opt, | |
NULL, (void *) UNIT_IOP }, | |
{ UNIT_MSIZE, 4096, NULL, "4K", &cpu_set_size }, | |
{ UNIT_MSIZE, 8192, NULL, "8K", &cpu_set_size }, | |
{ UNIT_MSIZE, 16384, NULL, "16K", &cpu_set_size }, | |
{ UNIT_MSIZE, 32768, NULL, "32K", &cpu_set_size }, | |
{ UNIT_MSIZE, 65536, NULL, "64K", &cpu_set_size }, | |
{ UNIT_MSIZE, 131072, NULL, "128K", &cpu_set_size }, | |
{ UNIT_MSIZE, 262144, NULL, "256K", &cpu_set_size }, | |
{ UNIT_MSIZE, 524288, NULL, "512K", &cpu_set_size }, | |
{ UNIT_MSIZE, 1048576, NULL, "1024K", &cpu_set_size }, | |
{ 0 } }; | |
DEVICE cpu_dev = { | |
"CPU", &cpu_unit, cpu_reg, cpu_mod, | |
1, 8, PA_N_SIZE, 1, 8, 16, | |
&cpu_ex, &cpu_dep, &cpu_reset, | |
&cpu_boot, NULL, NULL }; | |
/* DMA controller data structures | |
dmax_dev DMAx device descriptor | |
dmax_reg DMAx register list | |
*/ | |
UNIT dma0_unit = { UDATA (NULL, 0, 0) }; | |
REG dma0_reg[] = { | |
{ FLDATA (CMD, dev_cmd[DMA0/32], INT_V (DMA0)) }, | |
{ FLDATA (CTL, dev_ctl[DMA0/32], INT_V (DMA0)) }, | |
{ FLDATA (FLG, dev_flg[DMA0/32], INT_V (DMA0)) }, | |
{ FLDATA (FBF, dev_fbf[DMA0/32], INT_V (DMA0)) }, | |
{ ORDATA (CW1, dmac[0].cw1, 16) }, | |
{ ORDATA (CW2, dmac[0].cw2, 16) }, | |
{ ORDATA (CW3, dmac[0].cw3, 16) }, | |
{ NULL } }; | |
DEVICE dma0_dev = { | |
"DMA0", &dma0_unit, dma0_reg, NULL, | |
1, 8, 1, 1, 8, 16, | |
NULL, NULL, &dma0_reset, | |
NULL, NULL, NULL }; | |
UNIT dma1_unit = { UDATA (NULL, 0, 0) }; | |
REG dma1_reg[] = { | |
{ FLDATA (CMD, dev_cmd[DMA1/32], INT_V (DMA1)) }, | |
{ FLDATA (CTL, dev_ctl[DMA1/32], INT_V (DMA1)) }, | |
{ FLDATA (FLG, dev_flg[DMA1/32], INT_V (DMA1)) }, | |
{ FLDATA (FBF, dev_fbf[DMA1/32], INT_V (DMA1)) }, | |
{ ORDATA (CW1, dmac[1].cw1, 16) }, | |
{ ORDATA (CW2, dmac[1].cw2, 16) }, | |
{ ORDATA (CW3, dmac[1].cw3, 16) }, | |
{ NULL } }; | |
DEVICE dma1_dev = { | |
"DMA1", &dma1_unit, dma1_reg, NULL, | |
1, 8, 1, 1, 8, 16, | |
NULL, NULL, &dma1_reset, | |
NULL, NULL, NULL }; | |
/* Extended instruction decode tables */ | |
#define E_V_FL 0 /* flags */ | |
#define E_M_FL 0xFF | |
#define E_FP (UNIT_FP >> (UNIT_V_UF - E_V_FL)) | |
#define E_21MX (UNIT_21MX >> (UNIT_V_UF - E_V_FL)) | |
#define E_DMS (UNIT_DMS >> (UNIT_V_UF - E_V_FL)) | |
#define E_IOP (UNIT_IOP >> (UNIT_V_UF - E_V_FL)) | |
#define E_IOPX (UNIT_IOPX >> (UNIT_V_UF - E_V_FL)) | |
#define E_V_TY 8 /* type */ | |
#define E_M_TY 0xF | |
#define E_NO 0 /* no operands */ | |
#define E_CN 1 /* PC+1: count */ | |
#define E_AD 2 /* PC+1: addr */ | |
#define E_AA 3 /* PC+1,2: addr */ | |
#define E_AC 4 /* PC+1: addr, +2: count */ | |
#define E_AZ 5 /* PC+1: addr, +2: zero */ | |
#define ET_NO (E_NO << E_V_TY) | |
#define ET_AD (E_AD << E_V_TY) | |
#define ET_AA (E_AA << E_V_TY) | |
#define ET_CN (E_CN << E_V_TY) | |
#define ET_AC (E_AC << E_V_TY) | |
#define ET_AZ (E_AZ << E_V_TY) | |
#define E_V_TYI 12 /* type if 2100 IOP */ | |
#define E_GETFL(x) (((x) >> E_V_FL) & E_M_FL) | |
#define E_GETTY(f,x) (((x) >> \ | |
((((f) & E_IOP) && (cpu_unit.flags & UNIT_IOP))? \ | |
E_V_TYI: E_V_TY)) & E_M_TY) | |
#define F_NO E_FP | ET_NO | |
#define F_MR E_FP | ET_AD | |
#define X_NO E_21MX | ET_NO | |
#define X_MR E_21MX | ET_AD | |
#define X_AA E_21MX | ET_AA | |
#define X_AZ E_21MX | ET_AZ | |
#define D_NO E_DMS | ET_NO | |
#define D_MR E_DMS | ET_AD | |
#define D_AA E_DMS | ET_AA | |
#define M_NO E_IOPX | ET_NO | |
#define M_CN E_IOPX | ET_CN | |
#define M_AC E_IOPX | ET_AC | |
#define I_NO E_IOP | (ET_NO << (E_V_TYI - E_V_TY)) | |
#define I_CN E_IOP | (ET_CN << (E_V_TYI - E_V_TY)) | |
#define I_AC E_IOP | (ET_AC << (E_V_TYI - E_V_TY)) | |
#define I_AZ E_IOP | (ET_AZ << (E_V_TYI - E_V_TY)) | |
static const uint32 e_inst[512] = { | |
F_MR | I_AC,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* FAD/ILIST */ | |
F_MR | I_NO,I_NO,I_NO,I_NO,I_NO,I_NO,I_NO,I_NO, /* FSB/LAI- */ | |
I_NO,I_NO,I_NO,I_NO,I_NO,I_NO,I_NO,I_NO, | |
F_MR | I_NO,I_NO,I_NO,I_NO,I_NO,I_NO,I_NO,I_NO, /* FMP/LAI+ */ | |
I_NO,I_NO,I_NO,I_NO,I_NO,I_NO,I_NO,I_NO, | |
F_MR | I_NO,I_NO,I_NO,I_NO,I_NO,I_NO,I_NO,I_NO, /* FDV/SAI- */ | |
I_NO,I_NO,I_NO,I_NO,I_NO,I_NO,I_NO,I_NO, | |
F_NO | I_NO,I_NO,I_NO,I_NO,I_NO,I_NO,I_NO,I_NO, /* FIX/SAI+ */ | |
I_NO,I_NO,I_NO,I_NO,I_NO,I_NO,I_NO,I_NO, | |
F_NO | I_AZ,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* FLT/MBYTE */ | |
0,0,0,0,0,0,0,0,I_CN,0,0,0,0,0,0,0, /* CRC */ | |
I_CN,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* TRSLT */ | |
I_AZ,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* WMOVE */ | |
I_NO,I_NO,I_NO,I_NO,0,0,0,0,0,0,0,0,0,0,0,0, /* READF,PFRIO,PFREI,PFREX */ | |
I_NO,0,0,0,0,0,0,0,0,0,0,0,0,0,0,I_NO, /* ENQ,PENQ */ | |
I_NO,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* DEQ */ | |
I_NO,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* SBYTE */ | |
I_NO,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* LBYTE */ | |
I_NO,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* REST */ | |
0,0,I_NO,0,0,0,0,0,0,0,0,0,0,0,0,0, /* SAVE */ | |
M_NO,M_NO,M_NO,M_NO,M_NO,M_NO,M_NO,M_NO, /* LAI-/SAI- */ | |
M_NO,M_NO,M_NO,M_NO,M_NO,M_NO,M_NO,M_NO, | |
M_NO,M_NO,M_NO,M_NO,M_NO,M_NO,M_NO,M_NO, /* LAI+/SAI+ */ | |
M_NO,M_NO,M_NO,M_NO,M_NO,M_NO,M_NO,M_NO, | |
0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* 0440 */ | |
M_CN,M_NO,M_NO,M_NO,M_NO,M_NO,M_NO,M_CN, /* CRC,REST,READF,INS,ENQ,PENQ,DEQ,TR */ | |
M_AC,M_NO,M_NO,M_NO,M_NO,0,0,0, /* ILIST,PFREI,PFREX,PFRIO,SAVE */ | |
0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* 0500 */ | |
0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* 0520 */ | |
0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* 0540 */ | |
0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* 0560 */ | |
0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* 0600 */ | |
0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* 0620 */ | |
0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* 0640 */ | |
0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0, /* 0660 */ | |
D_NO,D_NO,D_NO,D_NO,D_NO,D_NO,D_NO,D_NO, /* XMM,test,MBI,MBF,MBW,MWI,MWF,MWW */ | |
D_NO,D_NO,D_NO,D_NO,D_MR,D_AA,D_NO,D_NO, /* SY*,US*,PA*,PB*,SSM,JRS,nop,nop */ | |
D_NO,D_NO,D_NO,D_NO,D_MR,D_MR,D_MR,D_NO, /* XMM,XMS,XM*,nop,XL*,XS*,XC*,LF* */ | |
D_NO,D_NO,D_MR,D_MR,D_MR,D_MR,D_MR,D_MR, /* RS*,RV*,DJP,DJS,SJP,SJS,UJP,UJS */ | |
X_MR,X_NO,X_MR,X_MR,X_NO,X_MR,X_MR,X_NO, /* S*X,C*X,L*X,STX,CX*,LDX,ADX,X*X */ | |
X_MR,X_NO,X_MR,X_MR,X_NO,X_MR,X_MR,X_NO, /* S*Y,C*Y,L*Y,STY,CY*,LDY,ADY,X*Y */ | |
X_NO,X_NO,X_MR,X_NO,X_NO,X_AZ,X_AZ,X_NO, /* ISX,DSX,JLY,LBT,SBT,MBT,CBT,SFB */ | |
X_NO,X_NO,X_MR,X_AA,X_AA,X_AA,X_AZ,X_AZ }; /* ISY,DSY,JPY,SBS,CBS,TBS,CMW,MVW */ | |
/* Interrupt defer table */ | |
static const int32 defer_tab[] = { 0, 1, 1, 1, 0, 0, 0, 1 }; | |
/* Device dispatch table */ | |
uint32 devdisp (uint32 devno, uint32 inst, uint32 IR, uint32 outdat); | |
int32 cpuio (int32 op, int32 IR, int32 outdat); | |
int32 ovfio (int32 op, int32 IR, int32 outdat); | |
int32 pwrio (int32 op, int32 IR, int32 outdat); | |
int32 proio (int32 op, int32 IR, int32 outdat); | |
int32 dmsio (int32 op, int32 IR, int32 outdat); | |
int32 dmpio (int32 op, int32 IR, int32 outdat); | |
int32 nulio (int32 op, int32 IR, int32 outdat); | |
int32 (*dtab[64])() = { | |
&cpuio, &ovfio, &dmsio, &dmsio, &pwrio, &proio, &dmpio, &dmpio, | |
NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | |
NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | |
NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | |
NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | |
NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | |
NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL, | |
NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL }; | |
t_stat sim_instr (void) | |
{ | |
uint32 intrq, dmarq; /* set after setjmp */ | |
uint32 iotrap = 0; /* set after setjmp */ | |
t_stat reason; /* set after setjmp */ | |
int32 i, dev; /* temp */ | |
DEVICE *dptr; /* temp */ | |
DIB *dibp; /* temp */ | |
int abortval; | |
/* Restore register state */ | |
if (dev_conflict ()) return SCPE_STOP; /* check consistency */ | |
AR = saved_AR & DMASK; /* restore reg */ | |
BR = saved_BR & DMASK; | |
err_PC = PC = PC & VAMASK; /* load local PC */ | |
reason = 0; | |
/* Restore I/O state */ | |
for (i = VARDEV; i <= I_DEVMASK; i++) dtab[i] = NULL; /* clr disp table */ | |
dev_cmd[0] = dev_cmd[0] & M_FXDEV; /* clear dynamic info */ | |
dev_ctl[0] = dev_ctl[0] & M_FXDEV; | |
dev_flg[0] = dev_flg[0] & M_FXDEV; | |
dev_fbf[0] = dev_fbf[0] & M_FXDEV; | |
dev_srq[0] = dev_srq[1] = 0; /* init svc requests */ | |
dev_cmd[1] = dev_ctl[1] = dev_flg[1] = dev_fbf[1] = 0; | |
for (i = 0; dptr = sim_devices[i]; i++) { /* loop thru dev */ | |
dibp = (DIB *) dptr->ctxt; /* get DIB */ | |
if (dibp && !(dptr->flags & DEV_DIS)) { /* exist, enabled? */ | |
dev = dibp->devno; /* get dev # */ | |
if (dibp->cmd) { setCMD (dev); } /* restore cmd */ | |
if (dibp->ctl) { setCTL (dev); } /* restore ctl */ | |
if (dibp->flg) { setFLG (dev); } /* restore flg */ | |
clrFBF (dev); /* also sets fbf */ | |
if (dibp->fbf) { setFBF (dev); } /* restore fbf */ | |
if (dibp->srq) { setSRQ (dev); } /* restore srq */ | |
dtab[dev] = dibp->iot; } } /* set I/O dispatch */ | |
sim_rtc_init (clk_delay (0)); /* recalibrate clock */ | |
/* Abort handling | |
If an abort occurs in memory protection, the relocation routine | |
executes a longjmp to this area OUTSIDE the main simulation loop. | |
Memory protection errors are the only sources of aborts in the | |
HP 2100. All referenced variables must be globals, and all sim_instr | |
scoped automatics must be set after the setjmp. | |
*/ | |
abortval = setjmp (save_env); /* set abort hdlr */ | |
if (abortval != 0) { /* mem mgt abort? */ | |
setFLG (PRO); /* req interrupt */ | |
mp_evrff = 0; } /* block mp_viol upd */ | |
dmarq = calc_dma (); /* recalc DMA masks */ | |
intrq = calc_int (); /* recalc interrupts */ | |
/* Main instruction fetch/decode loop */ | |
while (reason == 0) { /* loop until halted */ | |
uint32 IR, MA, M1, absel, v1, v2, t; | |
uint32 fop, eop, etype, eflag; | |
uint32 skip, mapi, mapj, qs, rs; | |
uint32 awc, sc, wc, hp, tp; | |
int32 sop1, sop2; | |
if (sim_interval <= 0) { /* check clock queue */ | |
if (reason = sim_process_event ()) break; | |
dmarq = calc_dma (); /* recalc DMA reqs */ | |
intrq = calc_int (); } /* recalc interrupts */ | |
if (dmarq) { | |
if (dmarq & DMAR0) dma_cycle (0, PAMAP); /* DMA1 cycle? */ | |
if (dmarq & DMAR1) dma_cycle (1, PBMAP); /* DMA2 cycle? */ | |
dmarq = calc_dma (); /* recalc DMA reqs */ | |
intrq = calc_int (); } /* recalc interrupts */ | |
/* (From Dave Bryan) | |
Unlike most other I/O devices, the MP flag flip-flop is cleared | |
automatically when the interrupt is acknowledged and not by a programmed | |
instruction (CLF and STF affect the parity error enable FF instead). | |
Section 4.4.3 "Memory Protect and I/O Interrupt Generation" of the "HP 1000 | |
M/E/F-Series Computers Engineering and Reference Documentation" (HP | |
92851-90001) says: | |
"When IAK occurs and IRQ5 is asserted, the FLAGBFF is cleared, FLAGFF | |
clocked off at next T2, and IRQ5 will no longer occur." */ | |
if (intrq && ((intrq <= PRO) || !ion_defer)) { /* interrupt request? */ | |
iotrap = 1; /* I/O trap cell instr */ | |
clrFBF (intrq); /* clear flag buffer */ | |
if (intrq == PRO) clrFLG (PRO); /* MP flag follows flag buffer */ | |
intaddr = intrq; /* save int addr */ | |
if (dms_enb) dms_sr = dms_sr | MST_ENBI; /* dms enabled? */ | |
else dms_sr = dms_sr & ~MST_ENBI; | |
if (dms_ump) { /* user map? */ | |
dms_sr = dms_sr | MST_UMPI; | |
dms_ump = SMAP; } /* switch to system */ | |
else dms_sr = dms_sr & ~MST_UMPI; | |
IR = ReadW (intrq); /* get dispatch instr */ | |
ion_defer = 1; /* defer interrupts */ | |
intrq = 0; /* clear request */ | |
if (((IR & I_NMRMASK) != I_IO) || /* if not I/O or */ | |
(I_GETIOOP (IR) == ioHLT)) /* if halt, */ | |
clrCTL (PRO); } /* protection off */ | |
else { iotrap = 0; /* normal instruction */ | |
err_PC = PC; /* save PC for error */ | |
if (sim_brk_summ && /* any breakpoints? */ | |
sim_brk_test (PC, SWMASK ('E') | /* unconditional or */ | |
(dms_enb? (dms_ump? SWMASK ('U'): SWMASK ('S')): | |
SWMASK ('N')))) { /* or right type for DMS? */ | |
reason = STOP_IBKPT; /* stop simulation */ | |
break; } | |
if (mp_evrff) mp_viol = PC; /* if ok, upd mp_viol */ | |
IR = ReadW (PC); /* fetch instr */ | |
PC = (PC + 1) & VAMASK; | |
sim_interval = sim_interval - 1; | |
ion_defer = 0; } | |
/* Instruction decode. The 21MX does a 256-way decode on IR<15:8> | |
15 14 13 12 11 10 09 08 instruction | |
x <-!= 0-> x x x x memory reference | |
0 0 0 0 x 0 x x shift | |
0 0 0 0 x 0 x x alter-skip | |
1 0 0 0 x 1 x x IO | |
1 0 0 0 0 0 x 0 extended arithmetic | |
1 0 0 0 0 0 0 1 divide (decoded as 100400) | |
1 0 0 0 1 0 0 0 double load (decoded as 104000) | |
1 0 0 0 1 0 0 1 double store (decoded as 104400) | |
1 0 0 0 1 0 1 0 extended instr group 0 (A/B must be set) | |
1 0 0 0 x 0 1 1 extended instr group 1 (A/B ignored) */ | |
absel = (IR & I_AB)? 1: 0; /* get A/B select */ | |
switch ((IR >> 8) & 0377) { /* decode IR<15:8> */ | |
/* Memory reference instructions */ | |
case 0020:case 0021:case 0022:case 0023: | |
case 0024:case 0025:case 0026:case 0027: | |
case 0220:case 0221:case 0222:case 0223: | |
case 0224:case 0225:case 0226:case 0227: | |
if (reason = Ea (IR, &MA, intrq)) break; /* AND */ | |
AR = AR & ReadW (MA); | |
break; | |
case 0030:case 0031:case 0032:case 0033: | |
case 0034:case 0035:case 0036:case 0037: | |
case 0230:case 0231:case 0232:case 0233: | |
case 0234:case 0235:case 0236:case 0237: | |
if (reason = Ea (IR, &MA, intrq)) break; /* JSB */ | |
WriteW (MA, PC); /* store PC */ | |
PCQ_ENTRY; | |
PC = (MA + 1) & VAMASK; /* jump */ | |
if (IR & I_IA) ion_defer = 1; /* ind? defer intr */ | |
break; | |
case 0040:case 0041:case 0042:case 0043: | |
case 0044:case 0045:case 0046:case 0047: | |
case 0240:case 0241:case 0242:case 0243: | |
case 0244:case 0245:case 0246:case 0247: | |
if (reason = Ea (IR, &MA, intrq)) break; /* XOR */ | |
AR = AR ^ ReadW (MA); | |
break; | |
case 0050:case 0051:case 0052:case 0053: | |
case 0054:case 0055:case 0056:case 0057: | |
case 0250:case 0251:case 0252:case 0253: | |
case 0254:case 0255:case 0256:case 0257: | |
if (reason = Ea (IR, &MA, intrq)) break; /* JMP */ | |
mp_dms_jmp (MA); /* validate jump addr */ | |
PCQ_ENTRY; | |
PC = MA; /* jump */ | |
if (IR & I_IA) ion_defer = 1; /* ind? defer int */ | |
break; | |
case 0060:case 0061:case 0062:case 0063: | |
case 0064:case 0065:case 0066:case 0067: | |
case 0260:case 0261:case 0262:case 0263: | |
case 0264:case 0265:case 0266:case 0267: | |
if (reason = Ea (IR, &MA, intrq)) break; /* IOR */ | |
AR = AR | ReadW (MA); | |
break; | |
case 0070:case 0071:case 0072:case 0073: | |
case 0074:case 0075:case 0076:case 0077: | |
case 0270:case 0271:case 0272:case 0273: | |
case 0274:case 0275:case 0276:case 0277: | |
if (reason = Ea (IR, &MA, intrq)) break; /* ISZ */ | |
t = (ReadW (MA) + 1) & DMASK; | |
WriteW (MA, t); | |
if (t == 0) PC = (PC + 1) & VAMASK; | |
break; | |
/* Memory reference instructions, continued */ | |
case 0100:case 0101:case 0102:case 0103: | |
case 0104:case 0105:case 0106:case 0107: | |
case 0300:case 0301:case 0302:case 0303: | |
case 0304:case 0305:case 0306:case 0307: | |
if (reason = Ea (IR, &MA, intrq)) break; /* ADA */ | |
v1 = ReadW (MA); | |
t = AR + v1; | |
if (t > DMASK) E = 1; | |
if (((~AR ^ v1) & (AR ^ t)) & SIGN) O = 1; | |
AR = t & DMASK; | |
break; | |
case 0110:case 0111:case 0112:case 0113: | |
case 0114:case 0115:case 0116:case 0117: | |
case 0310:case 0311:case 0312:case 0313: | |
case 0314:case 0315:case 0316:case 0317: | |
if (reason = Ea (IR, &MA, intrq)) break; /* ADB */ | |
v1 = ReadW (MA); | |
t = BR + v1; | |
if (t > DMASK) E = 1; | |
if (((~BR ^ v1) & (BR ^ t)) & SIGN) O = 1; | |
BR = t & DMASK; | |
break; | |
case 0120:case 0121:case 0122:case 0123: | |
case 0124:case 0125:case 0126:case 0127: | |
case 0320:case 0321:case 0322:case 0323: | |
case 0324:case 0325:case 0326:case 0327: | |
if (reason = Ea (IR, &MA, intrq)) break; /* CPA */ | |
if (AR != ReadW (MA)) PC = (PC + 1) & VAMASK; | |
break; | |
case 0130:case 0131:case 0132:case 0133: | |
case 0134:case 0135:case 0136:case 0137: | |
case 0330:case 0331:case 0332:case 0333: | |
case 0334:case 0335:case 0336:case 0337: | |
if (reason = Ea (IR, &MA, intrq)) break; /* CPB */ | |
if (BR != ReadW (MA)) PC = (PC + 1) & VAMASK; | |
break; | |
case 0140:case 0141:case 0142:case 0143: | |
case 0144:case 0145:case 0146:case 0147: | |
case 0340:case 0341:case 0342:case 0343: | |
case 0344:case 0345:case 0346:case 0347: | |
if (reason = Ea (IR, &MA, intrq)) break; /* LDA */ | |
AR = ReadW (MA); | |
break; | |
case 0150:case 0151:case 0152:case 0153: | |
case 0154:case 0155:case 0156:case 0157: | |
case 0350:case 0351:case 0352:case 0353: | |
case 0354:case 0355:case 0356:case 0357: | |
if (reason = Ea (IR, &MA, intrq)) break; /* LDB */ | |
BR = ReadW (MA); | |
break; | |
case 0160:case 0161:case 0162:case 0163: | |
case 0164:case 0165:case 0166:case 0167: | |
case 0360:case 0361:case 0362:case 0363: | |
case 0364:case 0365:case 0366:case 0367: | |
if (reason = Ea (IR, &MA, intrq)) break; /* STA */ | |
WriteW (MA, AR); | |
break; | |
case 0170:case 0171:case 0172:case 0173: | |
case 0174:case 0175:case 0176:case 0177: | |
case 0370:case 0371:case 0372:case 0373: | |
case 0374:case 0375:case 0376:case 0377: | |
if (reason = Ea (IR, &MA, intrq)) break; /* STB */ | |
WriteW (MA, BR); | |
break; | |
/* Alter/skip instructions */ | |
case 0004:case 0005:case 0006:case 0007: | |
case 0014:case 0015:case 0016:case 0017: | |
skip = 0; /* no skip */ | |
if (IR & 000400) t = 0; /* CLx */ | |
else t = ABREG[absel]; | |
if (IR & 001000) t = t ^ DMASK; /* CMx */ | |
if (IR & 000001) { /* RSS? */ | |
if ((IR & 000040) && (E != 0)) skip = 1; /* SEZ,RSS */ | |
if (IR & 000100) E = 0; /* CLE */ | |
if (IR & 000200) E = E ^ 1; /* CME */ | |
if (((IR & 000030) == 000030) && /* SSx,SLx,RSS */ | |
((t & 0100001) == 0100001)) skip = 1; | |
if (((IR & 000030) == 000020) && /* SSx,RSS */ | |
((t & SIGN) != 0)) skip = 1; | |
if (((IR & 000030) == 000010) && /* SLx,RSS */ | |
((t & 1) != 0)) skip = 1; | |
if (IR & 000004) { /* INx */ | |
t = (t + 1) & DMASK; | |
if (t == 0) E = 1; | |
if (t == SIGN) O = 1; } | |
if ((IR & 000002) && (t != 0)) skip = 1; /* SZx,RSS */ | |
if ((IR & 000072) == 0) skip = 1; /* RSS */ | |
} /* end if RSS */ | |
else { | |
if ((IR & 000040) && (E == 0)) skip = 1; /* SEZ */ | |
if (IR & 000100) E = 0; /* CLE */ | |
if (IR & 000200) E = E ^ 1; /* CME */ | |
if ((IR & 000020) && /* SSx */ | |
((t & SIGN) == 0)) skip = 1; | |
if ((IR & 000010) && /* SLx */ | |
((t & 1) == 0)) skip = 1; | |
if (IR & 000004) { /* INx */ | |
t = (t + 1) & DMASK; | |
if (t == 0) E = 1; | |
if (t == SIGN) O = 1; } | |
if ((IR & 000002) && (t == 0)) skip = 1; /* SZx */ | |
} /* end if ~RSS */ | |
ABREG[absel] = t; /* store result */ | |
PC = (PC + skip) & VAMASK; /* add in skip */ | |
break; /* end if alter/skip */ | |
/* Shift instructions */ | |
case 0000:case 0001:case 0002:case 0003: | |
case 0010:case 0011:case 0012:case 0013: | |
t = shift (ABREG[absel], IR & 01000, IR >> 6); /* do first shift */ | |
if (IR & 000040) E = 0; /* CLE */ | |
if ((IR & 000010) && ((t & 1) == 0)) /* SLx */ | |
PC = (PC + 1) & VAMASK; | |
ABREG[absel] = shift (t, IR & 00020, IR); /* do second shift */ | |
break; /* end if shift */ | |
/* I/O instructions */ | |
case 0204:case 0205:case 0206:case 0207: | |
case 0214:case 0215:case 0216:case 0217: | |
reason = iogrp (IR, iotrap); /* execute instr */ | |
dmarq = calc_dma (); /* recalc DMA */ | |
intrq = calc_int (); /* recalc interrupts */ | |
break; /* end if I/O */ | |
/* Extended arithmetic */ | |
case 0200: /* EAU group 0 */ | |
if ((cpu_unit.flags & UNIT_EAU) == 0) { /* implemented? */ | |
reason = stop_inst; | |
break; } | |
switch ((IR >> 4) & 017) { /* decode IR<7:4> */ | |
case 000: /* diagnostic */ | |
break; | |
case 001: /* ASL */ | |
sc = (IR & 017)? (IR & 017): 16; /* get sc */ | |
O = 0; /* clear ovflo */ | |
while (sc-- != 0) { /* bit by bit */ | |
t = BR << 1; /* shift B */ | |
BR = (BR & SIGN) | (t & 077777) | (AR >> 15); | |
AR = (AR << 1) & DMASK; | |
if ((BR ^ t) & SIGN) O = 1; } | |
break; | |
case 002: /* LSL */ | |
sc = (IR & 017)? (IR & 017): 16; /* get sc */ | |
BR = ((BR << sc) | (AR >> (16 - sc))) & DMASK; | |
AR = (AR << sc) & DMASK; /* BR'AR lsh left */ | |
break; | |
case 003: /* TIMER */ | |
BR = (BR + 1) & DMASK; /* increment B */ | |
if (BR) PC = err_PC; /* if !=0, repeat */ | |
break; | |
case 004: /* RRL */ | |
sc = (IR & 017)? (IR & 017): 16; /* get sc */ | |
t = BR; /* BR'AR rot left */ | |
BR = ((BR << sc) | (AR >> (16 - sc))) & DMASK; | |
AR = ((AR << sc) | (t >> (16 - sc))) & DMASK; | |
break; | |
case 010: /* MPY */ | |
if (reason = Ea1 (&MA, intrq)) break; /* get opnd addr */ | |
sop1 = SEXT (AR); /* sext AR */ | |
sop2 = SEXT (ReadW (MA)); /* sext mem */ | |
sop1 = sop1 * sop2; /* signed mpy */ | |
BR = (sop1 >> 16) & DMASK; /* to BR'AR */ | |
AR = sop1 & DMASK; | |
O = 0; /* no overflow */ | |
break; | |
default: | |
reason = stop_inst; | |
break; } | |
break; | |
case 0201: /* divide */ | |
if ((cpu_unit.flags & UNIT_EAU) == 0) { /* implemented? */ | |
reason = stop_inst; | |
break; } | |
if (reason = Ea1 (&MA, intrq)) break; /* get opnd addr */ | |
if (rs = qs = BR & SIGN) { /* save divd sign, neg? */ | |
AR = (~AR + 1) & DMASK; /* make B'A pos */ | |
BR = (~BR + (AR == 0)) & DMASK; } /* make divd pos */ | |
v2 = ReadW (MA); /* divr = mem */ | |
if (v2 & SIGN) { /* neg? */ | |
v2 = (~v2 + 1) & DMASK; /* make divr pos */ | |
qs = qs ^ SIGN; } /* sign of quotient */ | |
if (BR >= v2) O = 1; /* divide work? */ | |
else { /* maybe... */ | |
O = 0; /* assume ok */ | |
v1 = (BR << 16) | AR; /* 32b divd */ | |
AR = (v1 / v2) & DMASK; /* quotient */ | |
BR = (v1 % v2) & DMASK; /* remainder */ | |
if (AR) { /* quotient > 0? */ | |
if (qs) AR = (~AR + 1) & DMASK; /* apply quo sign */ | |
if ((AR ^ qs) & SIGN) O = 1; } /* still wrong? ovflo */ | |
if (rs) BR = (~BR + 1) & DMASK; } /* apply rem sign */ | |
break; | |
case 0202: /* EAU group 2 */ | |
if ((cpu_unit.flags & UNIT_EAU) == 0) { /* implemented? */ | |
reason = stop_inst; | |
break; } | |
switch ((IR >> 4) & 017) { /* decode IR<7:4> */ | |
case 001: /* ASR */ | |
sc = (IR & 017)? (IR & 017): 16; /* get sc */ | |
AR = ((BR << (16 - sc)) | (AR >> sc)) & DMASK; | |
BR = (SEXT (BR) >> sc) & DMASK; /* BR'AR ash right */ | |
O = 0; | |
break; | |
case 002: /* LSR */ | |
sc = (IR & 017)? (IR & 017): 16; /* get sc */ | |
AR = ((BR << (16 - sc)) | (AR >> sc)) & DMASK; | |
BR = BR >> sc; /* BR'AR log right */ | |
break; | |
case 004: /* RRR */ | |
sc = (IR & 017)? (IR & 017): 16; /* get sc */ | |
t = AR; /* BR'AR rot right */ | |
AR = ((AR >> sc) | (BR << (16 - sc))) & DMASK; | |
BR = ((BR >> sc) | (t << (16 - sc))) & DMASK; | |
break; | |
default: | |
reason = stop_inst; | |
break; } | |
break; | |
case 0210: /* DLD */ | |
if ((cpu_unit.flags & UNIT_EAU) == 0) { /* implemented? */ | |
reason = stop_inst; | |
break; } | |
if (reason = Ea1 (&MA, intrq)) break; /* get opnd addr */ | |
AR = ReadW (MA); /* load AR */ | |
MA = (MA + 1) & VAMASK; | |
BR = ReadW (MA); /* load BR */ | |
break; | |
case 0211: /* DST */ | |
if ((cpu_unit.flags & UNIT_EAU) == 0) { /* get opnd addr */ | |
reason = stop_inst; | |
break; } | |
if (reason = Ea1 (&MA, intrq)) break; /* get opnd addr */ | |
WriteW (MA, AR); /* store AR */ | |
MA = (MA + 1) & VAMASK; | |
WriteW (MA, BR); /* store BR */ | |
break; | |
/* Extended instructions */ | |
case 0212: /* MAC0 ext */ | |
case 0203:case 0213: /* MAC1 ext */ | |
eop = IR & 0777; /* extended opcode */ | |
eflag = E_GETFL (e_inst[eop]); /* get flags */ | |
if ((eflag & (cpu_unit.flags >> UNIT_V_UF)) == 0) { | |
reason = stop_inst; /* invalid? error */ | |
break; } | |
etype = E_GETTY (eflag, e_inst[eop]); /* get format */ | |
if (etype > E_CN) { /* at least 1 addr? */ | |
if (reason = Ea1 (&MA, intrq)) break; } /* get first address */ | |
if ((etype == E_AC) || (etype == E_CN)) { /* addr + cnt, cnt */ | |
wc = ReadW (PC); /* get count */ | |
awc = PC; /* addr of count */ | |
PC = (PC + 1) & VAMASK; } | |
else if (etype == E_AZ) { /* addr + zero */ | |
wc = ReadW (MA); /* get wc */ | |
awc = PC; /* addr of interim */ | |
if (wc) { /* wc > 0? */ | |
if (t = ReadW (PC)) wc = t; } /* use interim if nz */ | |
WriteW (awc, 0); /* clear interim */ | |
PC = (PC + 1) & VAMASK; } | |
else if (etype == E_AA) { /* second addr */ | |
if (reason = Ea1 (&M1, intrq)) break; } /* get second address */ | |
switch (eop) { /* decode IR<8:0> */ | |
/* Floating point instructions */ | |
case 0000: /* IOP ILIST/FAD */ | |
if (cpu_unit.flags & UNIT_IOP) /* ILIST (E_AC) */ | |
goto IOP_ILIST; | |
fop = ReadF (MA); /* get fop */ | |
O = f_as (fop, 0); /* add, upd ovflo */ | |
break; | |
case 0020: /* IOP LAI-/FSB */ | |
if (cpu_unit.flags & UNIT_IOP) /* LAI -20 (I_NO) */ | |
goto IOP_LAIM; | |
fop = ReadF (MA); /* get fop */ | |
O = f_as (fop, 1); /* sub, upd ovflo */ | |
break; | |
case 0040: /* IOP LAI+/FMP */ | |
if (cpu_unit.flags & UNIT_IOP) /* LAI 0 (I_NO) */ | |
goto IOP_LAIP; | |
fop = ReadF (MA); /* get fop */ | |
O = f_mul (fop); /* mul, upd ovflo */ | |
break; | |
case 0060: /* IOP SAI-/FDV */ | |
if (cpu_unit.flags & UNIT_IOP) /* SAI -20 (I_NO) */ | |
goto IOP_SAIM; | |
fop = ReadF (MA); /* get fop */ | |
O = f_div (fop); /* div, upd ovflo */ | |
break; | |
case 0100: /* IOP SAI+/FIX */ | |
if (cpu_unit.flags & UNIT_IOP) /* SAI 0 (I_NO) */ | |
goto IOP_SAIP; | |
O = f_fix (); /* FIX (E_NO) */ | |
break; | |
case 0120: /* IOP MBYTE/FLT */ | |
if (cpu_unit.flags & UNIT_IOP) /* MBYTE (I_AZ) */ | |
goto IOP_MBYTE; | |
O = f_flt (); /* FLT (E_NO) */ | |
break; | |
/* 2100 (and 21MX) IOP instructions */ | |
IOP_LAIM: case 0021: case 0022: case 0023: /* IOP LAI- (I_NO) */ | |
case 0024: case 0025: case 0026: case 0027: | |
case 0030: case 0031: case 0032: case 0033: | |
case 0034: case 0035: case 0036: case 0037: | |
MA = ((IR | 0177760) + BR) & VAMASK; /* IR<3:0> = -offset */ | |
AR = ReadW (MA); /* load AR */ | |
break; | |
IOP_LAIP: case 0041: case 0042: case 0043: /* IOP LAI+ (I_NO) */ | |
case 0044: case 0045: case 0046: case 0047: | |
case 0050: case 0051: case 0052: case 0053: | |
case 0054: case 0055: case 0056: case 0057: | |
MA = ((IR & 017) + BR) & VAMASK; /* IR<3:0> = +offset */ | |
AR = ReadW (MA); /* load AR */ | |
break; | |
IOP_SAIM: case 0061: case 0062: case 0063: /* IOP SAI- (I_NO) */ | |
case 0064: case 0065: case 0066: case 0067: | |
case 0070: case 0071: case 0072: case 0073: | |
case 0074: case 0075: case 0076: case 0077: | |
MA = ((IR | 0177760) + BR) & VAMASK; /* IR<3:0> = -offset */ | |
WriteW (MA, AR); /* store AR */ | |
break; | |
IOP_SAIP: case 0101: case 0102: case 0103: /* IOP SAI+ (I_NO) */ | |
case 0104: case 0105: case 0106: case 0107: | |
case 0110: case 0111: case 0112: case 0113: | |
case 0114: case 0115: case 0116: case 0117: | |
MA = ((IR & 017) + BR) & VAMASK; /* IR<3:0> = +offset */ | |
WriteW (MA, AR); /* store AR */ | |
break; | |
case 0150: /* IOP CRC (I_CN) */ | |
case 0460: /* IOPX CRC (I_CN) */ | |
t = (AR & 0xFF) ^ wc; /* start CRC */ | |
for (i = 0; i < 8; i++) { /* apply polynomial */ | |
t = (t >> 1) | ((t & 1) << 15); /* rotate right */ | |
if (t & SIGN) t = t ^ 020001; } /* old t<0>? xor */ | |
WriteW (awc, t); /* rewrite CRC */ | |
break; | |
case 0160: /* IOP TRSLT (I_CN) */ | |
case 0467: /* IOPX TRSLT (I_CN) */ | |
if (wc & SIGN) break; /* cnt < 0? */ | |
while (wc != 0) { /* loop */ | |
MA = (AR + AR + ReadB (BR)) & VAMASK; | |
t = ReadB (MA); /* xlate */ | |
WriteB (BR, t); /* store char */ | |
BR = (BR + 1) & DMASK; /* incr ptr */ | |
wc = (wc - 1) & DMASK; /* decr cnt */ | |
WriteW (awc, wc); | |
if (wc && intrq) { /* more and intr? */ | |
PC = err_PC; /* stop for now */ | |
break; } } | |
break; | |
case 0220: /* IOP READF (I_NO) */ | |
case 0462: /* IOPX READF (I_NO) */ | |
AR = iop_sp; /* copy stk ptr */ | |
break; | |
case 0221: /* IOP PRFIO (I_NO) */ | |
case 0473: /* IOPX PFRIO (I_NO) */ | |
t = ReadW (PC); /* get IO instr */ | |
PC = (PC + 1) & VAMASK; | |
WriteW (PC, 1); /* set flag */ | |
PC = (PC + 1) & VAMASK; | |
reason = iogrp (t, 0); /* execute instr */ | |
dmarq = calc_dma (); /* recalc DMA */ | |
intrq = calc_int (); /* recalc interrupts */ | |
break; | |
case 0222: /* IOP PRFEI (I_NO) */ | |
case 0471: /* IOPX PFREI (I_NO) */ | |
t = ReadW (PC); /* get IO instr */ | |
PC = (PC + 1) & VAMASK; | |
WriteW (PC, 1); /* set flag */ | |
PC = (PC + 1) & VAMASK; | |
reason = iogrp (t, 0); /* execute instr */ | |
dmarq = calc_dma (); /* recalc DMA */ | |
intrq = calc_int (); /* recalc interrupts */ | |
/* fall through */ | |
case 0223: /* IOP PRFEX (I_NO) */ | |
case 0472: /* IOPX PFREX (I_NO) */ | |
MA = ReadW (PC); /* exit addr */ | |
PCQ_ENTRY; | |
PC = ReadW (MA) & VAMASK; /* jump indirect */ | |
WriteW (MA, 0); /* clear exit */ | |
break; | |
case 0240: /* IOP ENQ (I_NO) */ | |
case 0464: /* IOPX ENQ (I_NO) */ | |
hp = ReadW (AR & VAMASK); /* addr of head */ | |
tp = ReadW ((AR + 1) & VAMASK); /* addr of tail */ | |
WriteW ((BR - 1) & VAMASK, 0); /* entry link */ | |
WriteW ((tp - 1) & VAMASK, BR); /* tail link */ | |
WriteW ((AR + 1) & VAMASK, BR); /* queue tail */ | |
if (hp != 0) PC = (PC + 1) & VAMASK; /* q not empty? skip */ | |
break; | |
case 0257: /* IOP PENQ (I_NO) */ | |
case 0465: /* IOPX PENQ (I_NO) */ | |
hp = ReadW (AR & VAMASK); /* addr of head */ | |
WriteW ((BR - 1) & VAMASK, hp); /* becomes entry link */ | |
WriteW (AR & VAMASK, BR); /* queue head */ | |
if (hp == 0) /* q empty? */ | |
WriteW ((AR + 1) & VAMASK, BR); /* queue tail */ | |
else PC = (PC + 1) & VAMASK; /* skip */ | |
break; | |
case 0260: /* IOP DEQ (I_NO) */ | |
case 0466: /* IOPX DEQ (I_NO) */ | |
BR = ReadW (AR & VAMASK); /* addr of head */ | |
if (BR) { /* queue not empty? */ | |
hp = ReadW ((BR - 1) & VAMASK); /* read hd entry link */ | |
WriteW (AR & VAMASK, hp); /* becomes queue head */ | |
if (hp == 0) /* q now empty? */ | |
WriteW ((AR + 1) & VAMASK, (AR + 1) & DMASK); | |
PC = (PC + 1) & VAMASK; } /* skip */ | |
break; | |
case 0300: /* IOP SBYTE (I_NO) */ | |
WriteB (BR, AR); /* store byte */ | |
BR = (BR + 1) & DMASK; /* incr ptr */ | |
break; | |
case 0320: /* IOP LBYTE (I_NO) */ | |
AR = ReadB (BR); /* load byte */ | |
BR = (BR + 1) & DMASK; /* incr ptr */ | |
break; | |
case 0340: /* IOP REST (I_NO) */ | |
case 0461: /* IOPX REST (I_NO) */ | |
iop_sp = (iop_sp - 1) & VAMASK; /* pop E/~O,BR,AR */ | |
t = ReadW (iop_sp); | |
O = ((t >> 1) ^ 1) & 1; | |
E = t & 1; | |
iop_sp = (iop_sp - 1) & VAMASK; | |
BR = ReadW (iop_sp); | |
iop_sp = (iop_sp - 1) & VAMASK; | |
AR = ReadW (iop_sp); | |
if (cpu_unit.flags & UNIT_2100) mp_fence = iop_sp; | |
break; | |
case 0362: /* IOP SAVE (I_NO) */ | |
case 0474: /* IOPX SAVE (I_NO) */ | |
WriteW (iop_sp, AR); /* push AR,BR,E/~O */ | |
iop_sp = (iop_sp + 1) & VAMASK; | |
WriteW (iop_sp, BR); | |
iop_sp = (iop_sp + 1) & VAMASK; | |
t = ((O ^ 1) << 1) | E; | |
WriteW (iop_sp, t); | |
iop_sp = (iop_sp + 1) & VAMASK; | |
if (cpu_unit.flags & UNIT_2100) mp_fence = iop_sp; | |
break; | |
case 0400: case 0401: case 0402: case 0403: /* IOPX LAI-/SAI- (I_NO) */ | |
case 0404: case 0405: case 0406: case 0407: | |
case 0410: case 0411: case 0412: case 0413: | |
case 0414: case 0415: case 0416: case 0417: | |
MA = ((IR | 0177760) + BR) & VAMASK; /* IR<3:0> = -offset */ | |
if (IR & I_AB) AR = ReadW (MA); /* AB = 1? LAI */ | |
else WriteW (MA, AR); /* AB = 0? SAI */ | |
break; | |
case 0420: case 0421: case 0422: case 0423: /* IOPX LAI+/SAI+ (I_NO) */ | |
case 0424: case 0425: case 0426: case 0427: | |
case 0430: case 0431: case 0432: case 0433: | |
case 0434: case 0435: case 0436: case 0437: | |
MA = ((IR & 017) + BR) & VAMASK; /* IR<3:0> = +offset */ | |
if (IR & I_AB) AR = ReadW (MA); /* AB = 1? LAI */ | |
else WriteW (MA, AR); /* AB = 0? SAI */ | |
break; | |
case 0463: /* IOPX INS (I_NO) */ | |
iop_sp = AR; /* init stk ptr */ | |
break; | |
case 0470: /* IOPX ILIST (I_CN) */ | |
IOP_ILIST: | |
do { /* for count */ | |
WriteW (MA, AR); /* write AR to mem */ | |
AR = (AR + 1) & DMASK; /* incr AR */ | |
MA = (MA + 1) & VAMASK; /* incr MA */ | |
wc = (wc - 1) & DMASK; } /* decr count */ | |
while (wc != 0); | |
break; | |
/* DMS instructions, move alternate - interruptible | |
DMS privilege violation rules are | |
- load map and CTL set (XMM, XMS, XM*, SY*, US*, PA*, PB*) | |
- load state or fence and UMAP set (JRS, DJP, DJS, SJP, SJS, UJP, UJS, LF*) | |
The 21MX manual is incorrect in stating that M*I, M*W, XS* are privileged */ | |
case 0701: /* self test */ | |
ABREG[absel] = ABREG[absel] ^ DMASK; /* CMA or CMB */ | |
break; | |
case 0702: /* MBI (E_NO) */ | |
AR = AR & ~1; /* force A, B even */ | |
BR = BR & ~1; | |
while (XR != 0) { /* loop */ | |
t = ReadB (AR); /* read curr */ | |
WriteBA (BR, t); /* write alt */ | |
AR = (AR + 1) & DMASK; /* incr ptrs */ | |
BR = (BR + 1) & DMASK; | |
XR = (XR - 1) & DMASK; | |
if (XR && intrq && !(AR & 1)) { /* more, int, even? */ | |
PC = err_PC; /* stop for now */ | |
break; } } | |
break; | |
case 0703: /* MBF (E_NO) */ | |
AR = AR & ~1; /* force A, B even */ | |
BR = BR & ~1; | |
while (XR != 0) { /* loop */ | |
t = ReadBA (AR); /* read alt */ | |
WriteB (BR, t); /* write curr */ | |
AR = (AR + 1) & DMASK; /* incr ptrs */ | |
BR = (BR + 1) & DMASK; | |
XR = (XR - 1) & DMASK; | |
if (XR && intrq && !(AR & 1)) { /* more, int, even? */ | |
PC = err_PC; /* stop for now */ | |
break; } } | |
break; | |
case 0704: /* MBW (E_NO) */ | |
AR = AR & ~1; /* force A, B even */ | |
BR = BR & ~1; | |
while (XR != 0) { /* loop */ | |
t = ReadBA (AR); /* read alt */ | |
WriteBA (BR, t); /* write alt */ | |
AR = (AR + 1) & DMASK; /* incr ptrs */ | |
BR = (BR + 1) & DMASK; | |
XR = (XR - 1) & DMASK; | |
if (XR && intrq && !(AR & 1)) { /* more, int, even? */ | |
PC = err_PC; /* stop for now */ | |
break; } } | |
break; | |
case 0705: /* MWI (E_NO) */ | |
while (XR != 0) { /* loop */ | |
t = ReadW (AR & VAMASK); /* read curr */ | |
WriteWA (BR & VAMASK, t); /* write alt */ | |
AR = (AR + 1) & DMASK; /* incr ptrs */ | |
BR = (BR + 1) & DMASK; | |
XR = (XR - 1) & DMASK; | |
if (XR && intrq) { /* more and intr? */ | |
PC = err_PC; /* stop for now */ | |
break; } } | |
break; | |
case 0706: /* MWF (E_NO) */ | |
while (XR != 0) { /* loop */ | |
t = ReadWA (AR & VAMASK); /* read alt */ | |
WriteW (BR & VAMASK, t); /* write curr */ | |
AR = (AR + 1) & DMASK; /* incr ptrs */ | |
BR = (BR + 1) & DMASK; | |
XR = (XR - 1) & DMASK; | |
if (XR && intrq) { /* more and intr? */ | |
PC = err_PC; /* stop for now */ | |
break; } } | |
break; | |
case 0707: /* MWW (E_NO) */ | |
while (XR != 0) { /* loop */ | |
t = ReadWA (AR & VAMASK); /* read alt */ | |
WriteWA (BR & VAMASK, t); /* write alt */ | |
AR = (AR + 1) & DMASK; /* incr ptrs */ | |
BR = (BR + 1) & DMASK; | |
XR = (XR - 1) & DMASK; | |
if (XR && intrq) { /* more and intr? */ | |
PC = err_PC; /* stop for now */ | |
break; } } | |
break; | |
/* DMS, continued */ | |
case 0710: /* SYA, SYB (E_NO) */ | |
case 0711: /* USA, USB (E_NO) */ | |
case 0712: /* PAA, PAB (E_NO) */ | |
case 0713: /* PBA, PBB (E_NO) */ | |
mapi = (IR & 03) << VA_N_PAG; /* map base */ | |
if (ABREG[absel] & SIGN) { /* store? */ | |
for (i = 0; i < MAP_LNT; i++) { | |
t = dms_rmap (mapi + i); /* map to memory */ | |
WriteW ((ABREG[absel] + i) & VAMASK, t); } } | |
else { /* load */ | |
dms_viol (err_PC, MVI_PRV); /* priv if PRO */ | |
for (i = 0; i < MAP_LNT; i++) { | |
t = ReadW ((ABREG[absel] + i) & VAMASK); | |
dms_wmap (mapi + i, t); } } /* mem to map */ | |
ABREG[absel] = (ABREG[absel] + MAP_LNT) & DMASK; | |
break; | |
case 0714: /* SSM (E_AD) */ | |
WriteW (MA, dms_upd_sr ()); /* store stat */ | |
break; | |
case 0715: /* JRS (E_AA) */ | |
if (dms_ump) dms_viol (err_PC, MVI_PRV); | |
t = ReadW (MA); /* get status */ | |
dms_enb = 0; /* assume off */ | |
dms_ump = SMAP; | |
if (t & 0100000) { /* set enable? */ | |
dms_enb = 1; | |
if (t & 0040000) dms_ump = UMAP; } /* set/clr usr */ | |
PCQ_ENTRY; /* save old PC */ | |
PC = M1; /* jump */ | |
ion_defer = 1; /* defer intr */ | |
break; | |
/* DMS, continued */ | |
case 0700: case 0720: /* XMM (E_NO) */ | |
if (XR == 0) break; /* nop? */ | |
while (XR != 0) { /* loop */ | |
if (XR & SIGN) { /* store? */ | |
t = dms_rmap (AR); /* map to mem */ | |
WriteW (BR & VAMASK, t); | |
XR = (XR + 1) & DMASK; } | |
else { /* load */ | |
dms_viol (err_PC, MVI_PRV); /* priv if PRO */ | |
t = ReadW (BR & VAMASK); /* mem to map */ | |
dms_wmap (AR, t); | |
XR = (XR - 1) & DMASK; } | |
AR = (AR + 1) & DMASK; | |
BR = (BR + 1) & DMASK; | |
if (intrq && ((XR & 0xF) == 0xF)) { /* intr, cnt4 = F? */ | |
PC = err_PC; /* stop for now */ | |
break; } } | |
break; | |
case 0721: /* XMS (E_NO) */ | |
if ((XR & SIGN) || (XR == 0)) break; /* nop? */ | |
dms_viol (err_PC, MVI_PRV); /* priv if PRO */ | |
while (XR != 0) { | |
dms_wmap (AR, BR); /* AR to map */ | |
XR = (XR - 1) & DMASK; | |
AR = (AR + 1) & DMASK; | |
BR = (BR + 1) & DMASK; | |
if (intrq && ((XR & 0xF) == 0xF)) { /* intr, cnt4 = F? */ | |
PC = err_PC; | |
break; } } | |
break; | |
case 0722: /* XMA, XMB (E_NO) */ | |
dms_viol (err_PC, MVI_PRV); /* priv if PRO */ | |
if (ABREG[absel] & 0100000) mapi = UMAP; | |
else mapi = SMAP; | |
if (ABREG[absel] & 0000001) mapj = PBMAP; | |
else mapj = PAMAP; | |
for (i = 0; i < MAP_LNT; i++) { | |
t = dms_rmap (mapi + i); /* read map */ | |
dms_wmap (mapj + i, t); } /* write map */ | |
break; | |
case 0724: /* XLA, XLB (E_AD) */ | |
ABREG[absel] = ReadWA (MA); /* load alt */ | |
break; | |
case 0725: /* XSA, XSB (E_AD) */ | |
WriteWA (MA, ABREG[absel]); /* store alt */ | |
break; | |
case 0726: /* XCA, XCB (E_AD) */ | |
if (ABREG[absel] != ReadWA (MA)) /* compare alt */ | |
PC = (PC + 1) & VAMASK; | |
break; | |
case 0727: /* LFA, LFB (E_NO) */ | |
if (dms_ump) dms_viol (err_PC, MVI_PRV); | |
dms_sr = (dms_sr & ~(MST_FLT | MST_FENCE)) | | |
(ABREG[absel] & (MST_FLT | MST_FENCE)); | |
break; | |
/* DMS, continued */ | |
case 0730: /* RSA, RSB (E_NO) */ | |
ABREG[absel] = dms_upd_sr (); /* save stat */ | |
break; | |
case 0731: /* RVA, RVB (E_NO) */ | |
ABREG[absel] = dms_vr; /* save viol */ | |
break; | |
case 0732: /* DJP (E_AD) */ | |
if (dms_ump) dms_viol (err_PC, MVI_PRV); | |
mp_dms_jmp (MA); /* validate jump addr */ | |
PCQ_ENTRY; /* save curr PC */ | |
PC = MA; /* new PC */ | |
dms_enb = 0; /* disable map */ | |
dms_ump = SMAP; | |
ion_defer = 1; | |
break; | |
case 0733: /* DJS (E_AD) */ | |
if (dms_ump) dms_viol (err_PC, MVI_PRV); | |
WriteW (MA, PC); /* store ret addr */ | |
PCQ_ENTRY; /* save curr PC */ | |
PC = (MA + 1) & VAMASK; /* new PC */ | |
dms_enb = 0; /* disable map */ | |
dms_ump = SMAP; | |
ion_defer = 1; /* defer intr */ | |
break; | |
case 0734: /* SJP (E_AD) */ | |
if (dms_ump) dms_viol (err_PC, MVI_PRV); | |
mp_dms_jmp (MA); /* validate jump addr */ | |
PCQ_ENTRY; /* save curr PC */ | |
PC = MA; /* jump */ | |
dms_enb = 1; /* enable system */ | |
dms_ump = SMAP; | |
ion_defer = 1; /* defer intr */ | |
break; | |
case 0735: /* SJS (E_AD) */ | |
if (dms_ump) dms_viol (err_PC, MVI_PRV); | |
t = PC; /* save retn addr */ | |
PCQ_ENTRY; /* save curr PC */ | |
PC = (MA + 1) & VAMASK; /* new PC */ | |
dms_enb = 1; /* enable system */ | |
dms_ump = SMAP; | |
WriteW (MA, t); /* store ret addr */ | |
ion_defer = 1; /* defer intr */ | |
break; | |
case 0736: /* UJP (E_AD) */ | |
if (dms_ump) dms_viol (err_PC, MVI_PRV); | |
mp_dms_jmp (MA); /* validate jump addr */ | |
PCQ_ENTRY; /* save curr PC */ | |
PC = MA; /* jump */ | |
dms_enb = 1; /* enable user */ | |
dms_ump = UMAP; | |
ion_defer = 1; /* defer intr */ | |
break; | |
case 0737: /* UJS (E_AD) */ | |
if (dms_ump) dms_viol (err_PC, MVI_PRV); | |
t = PC; /* save retn addr */ | |
PCQ_ENTRY; /* save curr PC */ | |
PC = (MA + 1) & VAMASK; /* new PC */ | |
dms_enb = 1; /* enable user */ | |
dms_ump = UMAP; | |
WriteW (MA, t); /* store ret addr */ | |
ion_defer = 1; /* defer intr */ | |
break; | |
/* Index register instructions */ | |
case 0740: /* SAX, SBX (E_AD) */ | |
MA = (MA + XR) & VAMASK; /* indexed addr */ | |
WriteW (MA, ABREG[absel]); /* store */ | |
break; | |
case 0741: /* CAX, CBX (E_NO) */ | |
XR = ABREG[absel]; /* copy to XR */ | |
break; | |
case 0742: /* LAX, LBX (E_AD) */ | |
MA = (MA + XR) & VAMASK; /* indexed addr */ | |
ABREG[absel] = ReadW (MA); /* load */ | |
break; | |
case 0743: /* STX (E_AD) */ | |
WriteW (MA, XR); /* store XR */ | |
break; | |
case 0744: /* CXA, CXB (E_NO) */ | |
ABREG[absel] = XR; /* copy from XR */ | |
break; | |
case 0745: /* LDX (E_AD)*/ | |
XR = ReadW (MA); /* load XR */ | |
break; | |
case 0746: /* ADX (E_AD) */ | |
v1 = ReadW (MA); /* add to XR */ | |
t = XR + v1; | |
if (t > DMASK) E = 1; /* set E, O */ | |
if (((~XR ^ v1) & (XR ^ t)) & SIGN) O = 1; | |
XR = t & DMASK; | |
break; | |
case 0747: /* XAX, XBX (E_NO) */ | |
t = XR; /* exchange XR */ | |
XR = ABREG[absel]; | |
ABREG[absel] = t; | |
break; | |
case 0750: /* SAY, SBY (E_AD) */ | |
MA = (MA + YR) & VAMASK; /* indexed addr */ | |
WriteW (MA, ABREG[absel]); /* store */ | |
break; | |
case 0751: /* CAY, CBY (E_NO) */ | |
YR = ABREG[absel]; /* copy to YR */ | |
break; | |
case 0752: /* LAY, LBY (E_AD) */ | |
MA = (MA + YR) & VAMASK; /* indexed addr */ | |
ABREG[absel] = ReadW (MA); /* load */ | |
break; | |
case 0753: /* STY (E_AD) */ | |
WriteW (MA, YR); /* store YR */ | |
break; | |
case 0754: /* CYA, CYB (E_NO) */ | |
ABREG[absel] = YR; /* copy from YR */ | |
break; | |
case 0755: /* LDY (E_AD) */ | |
YR = ReadW (MA); /* load YR */ | |
break; | |
case 0756: /* ADY (E_AD) */ | |
v1 = ReadW (MA); /* add to YR */ | |
t = YR + v1; | |
if (t > DMASK) E = 1; /* set E, O */ | |
if (((~YR ^ v1) & (YR ^ t)) & SIGN) O = 1; | |
YR = t & DMASK; | |
break; | |
case 0757: /* XAY, XBY (E_NO) */ | |
t = YR; /* exchange YR */ | |
YR = ABREG[absel]; | |
ABREG[absel] = t; | |
break; | |
case 0760: /* ISX (E_NO) */ | |
XR = (XR + 1) & DMASK; /* incr XR */ | |
if (XR == 0) PC = (PC + 1) & VAMASK; /* skip if zero */ | |
break; | |
case 0761: /* DSX (E_NO) */ | |
XR = (XR - 1) & DMASK; /* decr XR */ | |
if (XR == 0) PC = (PC + 1) & VAMASK; /* skip if zero */ | |
break; | |
case 0762: /* JLY (E_AD) */ | |
mp_dms_jmp (MA); /* validate jump addr */ | |
PCQ_ENTRY; | |
YR = PC; /* ret addr to YR */ | |
PC = MA; /* jump */ | |
break; | |
case 0770: /* ISY (E_NO) */ | |
YR = (YR + 1) & DMASK; /* incr YR */ | |
if (YR == 0) PC = (PC + 1) & VAMASK; /* skip if zero */ | |
break; | |
case 0771: /* DSY (E_NO) */ | |
YR = (YR - 1) & DMASK; /* decr YR */ | |
if (YR == 0) PC = (PC + 1) & VAMASK; /* skip if zero */ | |
break; | |
case 0772: /* JPY (E_NO) */ | |
MA = (ReadW (PC) + YR) & VAMASK; /* index, no indir */ | |
PC = (PC + 1) & VAMASK; | |
mp_dms_jmp (MA); /* validate jump addr */ | |
PCQ_ENTRY; | |
PC = MA; /* jump */ | |
break; | |
/* Byte instructions */ | |
case 0763: /* LBT (E_NO) */ | |
AR = ReadB (BR); /* load byte */ | |
BR = (BR + 1) & DMASK; /* incr ptr */ | |
break; | |
case 0764: /* SBT (E_NO) */ | |
WriteB (BR, AR); /* store byte */ | |
BR = (BR + 1) & DMASK; /* incr ptr */ | |
break; | |
IOP_MBYTE: /* IOP MBYTE (I_AZ) */ | |
if (wc & SIGN) break; /* must be positive */ | |
case 0765: /* MBT (E_AZ) */ | |
while (wc != 0) { /* while count */ | |
WriteW (awc, wc); /* for abort */ | |
t = ReadB (AR); /* move byte */ | |
WriteB (BR, t); | |
AR = (AR + 1) & DMASK; /* incr src */ | |
BR = (BR + 1) & DMASK; /* incr dst */ | |
wc = (wc - 1) & DMASK; /* decr cnt */ | |
if (intrq && wc) { /* intr, more to do? */ | |
PC = err_PC; /* back up PC */ | |
break; } } /* take intr */ | |
WriteW (awc, wc); /* clean up inline */ | |
break; | |
case 0766: /* CBT (E_AZ) */ | |
while (wc != 0) { /* while count */ | |
WriteW (awc, wc); /* for abort */ | |
v1 = ReadB (AR); /* get src1 */ | |
v2 = ReadB (BR); /* get src2 */ | |
if (v1 != v2) { /* compare */ | |
PC = (PC + 1 + (v1 > v2)) & VAMASK; | |
BR = (BR + wc) & DMASK; /* update BR */ | |
wc = 0; /* clr interim */ | |
break; } | |
AR = (AR + 1) & DMASK; /* incr src1 */ | |
BR = (BR + 1) & DMASK; /* incr src2 */ | |
wc = (wc - 1) & DMASK; /* decr cnt */ | |
if (intrq && wc) { /* intr, more to do? */ | |
PC = err_PC; /* back up PC */ | |
break; } } /* take intr */ | |
WriteW (awc, wc); /* clean up inline */ | |
break; | |
case 0767: /* SFB (E_NO) */ | |
v1 = AR & 0377; /* test byte */ | |
v2 = (AR >> 8) & 0377; /* term byte */ | |
for (;;) { /* scan */ | |
t = ReadB (BR); /* read byte */ | |
if (t == v1) break; /* test match? */ | |
BR = (BR + 1) & DMASK; | |
if (t == v2) { /* term match? */ | |
PC = (PC + 1) & VAMASK; | |
break; } | |
if (intrq) { /* int pending? */ | |
PC = err_PC; /* back up PC */ | |
break; } } /* take intr */ | |
break; | |
/* Bit, word instructions */ | |
case 0773: /* SBS (E_AA) */ | |
WriteW (M1, M[M1] | M [MA]); /* set bit */ | |
break; | |
case 0774: /* CBS (E_AA) */ | |
WriteW (M1, M[M1] & ~M[MA]); /* clear bit */ | |
break; | |
case 0775: /* TBS (E_AA) */ | |
if ((M[MA] & M[M1]) != M[MA]) /* test bit */ | |
PC = (PC + 1) & VAMASK; | |
break; | |
case 0776: /* CMW (E_AZ) */ | |
while (wc != 0) { /* while count */ | |
WriteW (awc, wc); /* for abort */ | |
v1 = ReadW (AR & VAMASK); /* first op */ | |
v2 = ReadW (BR & VAMASK); /* second op */ | |
sop1 = (int32) SEXT (v1); /* signed */ | |
sop2 = (int32) SEXT (v2); | |
if (sop1 != sop2) { /* compare */ | |
PC = (PC + 1 + (sop1 > sop2)) & VAMASK; | |
BR = (BR + wc) & DMASK; /* update BR */ | |
wc = 0; /* clr interim */ | |
break; } | |
AR = (AR + 1) & DMASK; /* incr src1 */ | |
BR = (BR + 1) & DMASK; /* incr src2 */ | |
wc = (wc - 1) & DMASK; /* decr cnt */ | |
if (intrq && wc) { /* intr, more to do? */ | |
PC = err_PC; /* back up PC */ | |
break; } } /* take intr */ | |
WriteW (awc, wc); /* clean up inline */ | |
break; | |
case 0200: /* IOP WMOVE (I_AZ) */ | |
if (wc & SIGN) break; /* must be positive */ | |
case 0777: /* MVW (E_AZ) */ | |
while (wc != 0) { /* while count */ | |
WriteW (awc, wc); /* for abort */ | |
t = ReadW (AR & VAMASK); /* move word */ | |
WriteW (BR & VAMASK, t); | |
AR = (AR + 1) & DMASK; /* incr src */ | |
BR = (BR + 1) & DMASK; /* incr dst */ | |
wc = (wc - 1) & DMASK; /* decr cnt */ | |
if (intrq && wc) { /* intr, more to do? */ | |
PC = err_PC; /* back up PC */ | |
break; } } /* take intr */ | |
WriteW (awc, wc); /* clean up inline */ | |
break; | |
default: /* all others NOP */ | |
break; } /* end case ext */ | |
break; } /* end case IR */ | |
if (reason == STOP_INDINT) { /* indirect intr? */ | |
PC = err_PC; /* back out of inst */ | |
ion_defer = 0; /* clear defer */ | |
reason = 0; } /* continue */ | |
} /* end while */ | |
/* Simulation halted */ | |
if (iotrap && (reason == STOP_HALT)) MR = intaddr; /* HLT in trap cell? */ | |
else MR = (PC - 1) & VAMASK; /* no, M = P - 1 */ | |
TR = ReadIO (MR, dms_ump); /* last word fetched */ | |
if ((reason == STOP_RSRV) || (reason == STOP_IODV) || /* instr error? */ | |
(reason == STOP_IND)) PC = err_PC; /* back up PC */ | |
saved_AR = AR & DMASK; | |
saved_BR = BR & DMASK; | |
dms_upd_sr (); /* update dms_sr */ | |
for (i = 0; dptr = sim_devices[i]; i++) { /* loop thru dev */ | |
dibp = (DIB *) dptr->ctxt; /* get DIB */ | |
if (dibp) { /* exist? */ | |
dev = dibp->devno; | |
dibp->cmd = CMD (dev); | |
dibp->ctl = CTL (dev); | |
dibp->flg = FLG (dev); | |
dibp->fbf = FBF (dev); | |
dibp->srq = SRQ (dev); } } | |
pcq_r->qptr = pcq_p; /* update pc q ptr */ | |
return reason; | |
} | |
/* Effective address calculation */ | |
t_stat Ea (uint32 IR, uint32 *addr, uint32 irq) | |
{ | |
uint32 i, MA; | |
MA = IR & (I_IA | I_DISP); /* ind + disp */ | |
if (IR & I_CP) MA = ((PC - 1) & I_PAGENO) | MA; /* current page? */ | |
for (i = 0; (i < ind_max) && (MA & I_IA); i++) { /* resolve multilevel */ | |
if ((i >= 2) && irq && /* >3 levels, int req, */ | |
(cpu_unit.flags & UNIT_MPR)) /* mprot installed? */ | |
return STOP_INDINT; /* break out */ | |
MA = ReadW (MA & VAMASK); } | |
if (i >= ind_max) return STOP_IND; /* indirect loop? */ | |
*addr = MA; | |
return SCPE_OK; | |
} | |
/* Effective address, two words */ | |
t_stat Ea1 (uint32 *addr, uint32 irq) | |
{ | |
uint32 i, MA; | |
MA = ReadW (PC); /* get next address */ | |
PC = (PC + 1) & VAMASK; | |
for (i = 0; (i < ind_max) && (MA & I_IA); i++) { /* resolve multilevel */ | |
if ((i >= 2) && irq && /* >3 levels, int req, */ | |
(cpu_unit.flags & UNIT_MPR)) /* mprot installed? */ | |
return STOP_INDINT; /* break out */ | |
MA = ReadW (MA & VAMASK); } | |
if (i >= ind_max) return STOP_IND; /* indirect loop? */ | |
*addr = MA; | |
return SCPE_OK; | |
} | |
/* Shift micro operation */ | |
uint32 shift (uint32 t, uint32 flag, uint32 op) | |
{ | |
uint32 oldE; | |
op = op & 07; /* get shift op */ | |
if (flag) { /* enabled? */ | |
switch (op) { /* case on operation */ | |
case 00: /* signed left shift */ | |
return ((t & SIGN) | ((t << 1) & 077777)); | |
case 01: /* signed right shift */ | |
return ((t & SIGN) | (t >> 1)); | |
case 02: /* rotate left */ | |
return (((t << 1) | (t >> 15)) & DMASK); | |
case 03: /* rotate right */ | |
return (((t >> 1) | (t << 15)) & DMASK); | |
case 04: /* left shift, 0 sign */ | |
return ((t << 1) & 077777); | |
case 05: /* ext right rotate */ | |
oldE = E; | |
E = t & 1; | |
return ((t >> 1) | (oldE << 15)); | |
case 06: /* ext left rotate */ | |
oldE = E; | |
E = (t >> 15) & 1; | |
return (((t << 1) | oldE) & DMASK); | |
case 07: /* rotate left four */ | |
return (((t << 4) | (t >> 12)) & DMASK); | |
} /* end case */ | |
} /* end if */ | |
if (op == 05) E = t & 1; /* disabled ext rgt rot */ | |
if (op == 06) E = (t >> 15) & 1; /* disabled ext lft rot */ | |
return t; /* input unchanged */ | |
} | |
/* IO instruction decode */ | |
t_stat iogrp (uint32 ir, uint32 iotrap) | |
{ | |
uint32 dev, sop, iodata, ab; | |
ab = (ir & I_AB)? 1: 0; /* get A/B select */ | |
dev = ir & I_DEVMASK; /* get device */ | |
sop = I_GETIOOP (ir); /* get subopcode */ | |
if (!iotrap && CTL (PRO) && ((sop == ioHLT) || (dev != OVF))) { /* protected? */ | |
if (sop == ioLIX) ABREG[ab] = 0; /* A/B writes anyway */ | |
ABORT (ABORT_PRO); } | |
iodata = devdisp (dev, sop, ir, ABREG[ab]); /* process I/O */ | |
ion_defer = defer_tab[sop]; /* set defer */ | |
if ((sop == ioMIX) || (sop == ioLIX)) /* store ret data */ | |
ABREG[ab] = iodata & DMASK; | |
if (sop == ioHLT) { /* halt? */ | |
int32 len = strlen (halt_msg); /* find end msg */ | |
sprintf (&halt_msg[len - 6], "%06o", ir); /* add the halt */ | |
return STOP_HALT; } | |
return (iodata >> IOT_V_REASON); /* return status */ | |
} | |
/* Device dispatch */ | |
uint32 devdisp (uint32 devno, uint32 inst, uint32 IR, uint32 dat) | |
{ | |
if (dtab[devno]) return dtab[devno] (inst, IR, dat); | |
else return nulio (inst, IR, dat); | |
} | |
/* Calculate DMA requests */ | |
uint32 calc_dma (void) | |
{ | |
uint32 r = 0; | |
if (CMD (DMA0) && SRQ (dmac[0].cw1 & I_DEVMASK)) /* check DMA0 cycle */ | |
r = r | DMAR0; | |
if (CMD (DMA1) && SRQ (dmac[1].cw1 & I_DEVMASK)) /* check DMA1 cycle */ | |
r = r | DMAR1; | |
return r; | |
} | |
/* Calculate interrupt requests | |
This routine takes into account all the relevant state of the | |
interrupt system: ion, dev_flg, dev_fbf, and dev_ctl. | |
1. dev_flg & dev_ctl determines the end of the priority grant. | |
The break in the chain will occur at the first device for | |
which dev_flg & dev_ctl is true. This is determined by | |
AND'ing the set bits with their 2's complement; only the low | |
order (highest priority) bit will differ. 1 less than | |
that, or'd with the single set bit itself, is the mask of | |
possible interrupting devices. If ION is clear, only devices | |
4 and 5 are eligible to interrupt. | |
2. dev_flg & dev_ctl & dev_fbf determines the outstanding | |
interrupt requests. All three bits must be on for a device | |
to request an interrupt. This is the masked under the | |
result from #1 to determine the highest priority interrupt, | |
if any. | |
*/ | |
uint32 calc_int (void) | |
{ | |
int32 j, lomask, mask[2], req[2]; | |
lomask = dev_flg[0] & dev_ctl[0] & ~M_NXDEV; /* start chain calc */ | |
req[0] = lomask & dev_fbf[0]; /* calc requests */ | |
lomask = lomask & (-lomask); /* chain & -chain */ | |
mask[0] = lomask | (lomask - 1); /* enabled devices */ | |
req[0] = req[0] & mask[0]; /* highest request */ | |
if (ion) { /* ion? */ | |
if (lomask == 0) { /* no break in chn? */ | |
mask[1] = dev_flg[1] & dev_ctl[1]; /* do all devices */ | |
req[1] = mask[1] & dev_fbf[1]; | |
mask[1] = mask[1] & (-mask[1]); | |
mask[1] = mask[1] | (mask[1] - 1); | |
req[1] = req[1] & mask[1]; } | |
else req[1] = 0; } | |
else { req[0] = req[0] & (INT_M (PWR) | INT_M (PRO)); | |
req[1] = 0; } | |
if (req[0]) { /* if low request */ | |
for (j = 0; j < 32; j++) { /* find dev # */ | |
if (req[0] & INT_M (j)) return j; } } | |
if (req[1]) { /* if hi request */ | |
for (j = 0; j < 32; j++) { /* find dev # */ | |
if (req[1] & INT_M (j)) return (32 + j); } } | |
return 0; | |
} | |
/* Memory access routines */ | |
uint8 ReadB (uint32 va) | |
{ | |
int32 pa; | |
if (dms_enb) pa = dms (va >> 1, dms_ump, RD); | |
else pa = va >> 1; | |
if (va & 1) return (M[pa] & 0377); | |
else return ((M[pa] >> 8) & 0377); | |
} | |
uint8 ReadBA (uint32 va) | |
{ | |
uint32 pa; | |
if (dms_enb) pa = dms (va >> 1, dms_ump ^ MAP_LNT, RD); | |
else pa = va >> 1; | |
if (va & 1) return (M[pa] & 0377); | |
else return ((M[pa] >> 8) & 0377); | |
} | |
uint16 ReadW (uint32 va) | |
{ | |
uint32 pa; | |
if (dms_enb) pa = dms (va, dms_ump, RD); | |
else pa = va; | |
return M[pa]; | |
} | |
uint16 ReadWA (uint32 va) | |
{ | |
uint32 pa; | |
if (dms_enb) pa = dms (va, dms_ump ^ MAP_LNT, RD); | |
else pa = va; | |
return M[pa]; | |
} | |
uint32 ReadF (uint32 va) | |
{ | |
uint32 t = ReadW (va); | |
uint32 t1 = ReadW ((va + 1) & VAMASK); | |
return (t << 16) | t1; | |
} | |
uint16 ReadIO (uint32 va, uint32 map) | |
{ | |
uint32 pa; | |
if (dms_enb) pa = dms_io (va, map); | |
else pa = va; | |
return M[pa]; | |
} | |
/* Memory protection test for writes | |
From Dave Bryan: The problem is that memory writes aren't being checked for | |
an MP violation if DMS is enabled, i.e., if DMS is enabled, and the page is | |
writable, then whether the target is below the MP fence is not checked. [The | |
simulator must] do MP check on all writes after DMS translation and violation | |
checks are done (so, to pass, the page must be writable AND the target must | |
be above the MP fence). */ | |
#define MP_TEST(x) (CTL (PRO) && ((x) > 1) && ((x) < mp_fence)) | |
void WriteB (uint32 va, uint32 dat) | |
{ | |
uint32 pa; | |
if (dms_enb) pa = dms (va >> 1, dms_ump, WR); | |
else pa = va >> 1; | |
if (MP_TEST (va >> 1)) ABORT (ABORT_PRO); | |
if (MEM_ADDR_OK (pa)) { | |
if (va & 1) M[pa] = (M[pa] & 0177400) | (dat & 0377); | |
else M[pa] = (M[pa] & 0377) | ((dat & 0377) << 8); } | |
return; | |
} | |
void WriteBA (uint32 va, uint32 dat) | |
{ | |
uint32 pa; | |
if (dms_enb) { | |
dms_viol (va >> 1, MVI_WPR); /* viol if prot */ | |
pa = dms (va >> 1, dms_ump ^ MAP_LNT, WR); } | |
else pa = va >> 1; | |
if (MP_TEST (va >> 1)) ABORT (ABORT_PRO); | |
if (MEM_ADDR_OK (pa)) { | |
if (va & 1) M[pa] = (M[pa] & 0177400) | (dat & 0377); | |
else M[pa] = (M[pa] & 0377) | ((dat & 0377) << 8); } | |
return; | |
} | |
void WriteW (uint32 va, uint32 dat) | |
{ | |
uint32 pa; | |
if (dms_enb) pa = dms (va, dms_ump, WR); | |
else pa = va; | |
if (MP_TEST (va)) ABORT (ABORT_PRO); | |
if (MEM_ADDR_OK (pa)) M[pa] = dat; | |
return; | |
} | |
void WriteWA (uint32 va, uint32 dat) | |
{ | |
int32 pa; | |
if (dms_enb) { | |
dms_viol (va, MVI_WPR); /* viol if prot */ | |
pa = dms (va, dms_ump ^ MAP_LNT, WR); } | |
else pa = va; | |
if (MP_TEST (va)) ABORT (ABORT_PRO); | |
if (MEM_ADDR_OK (pa)) M[pa] = dat; | |
return; | |
} | |
void WriteIO (uint32 va, uint32 dat, uint32 map) | |
{ | |
uint32 pa; | |
if (dms_enb) pa = dms_io (va, map); | |
else pa = va; | |
if (MEM_ADDR_OK (pa)) M[pa] = dat; | |
return; | |
} | |
/* DMS relocation for CPU access */ | |
uint32 dms (uint32 va, uint32 map, uint32 prot) | |
{ | |
uint32 pgn, mpr; | |
if (va <= 1) return va; /* A, B */ | |
pgn = VA_GETPAG (va); /* get page num */ | |
if (pgn == 0) { /* base page? */ | |
uint32 dms_fence = dms_sr & MST_FENCE; /* get fence value */ | |
if ((dms_sr & MST_FLT)? /* check unmapped */ | |
(va >= dms_fence): /* 1B10: >= fence */ | |
(va < dms_fence)) { /* 0B10: < fence */ | |
if (prot == WR) dms_viol (va, MVI_BPG); /* if W, viol */ | |
return va; } } /* no mapping */ | |
mpr = dms_map[map + pgn]; /* get map reg */ | |
if (mpr & prot) dms_viol (va, prot); /* prot violation? */ | |
return (MAP_GETPAG (mpr) | VA_GETOFF (va)); | |
} | |
/* DMS relocation for IO access */ | |
uint32 dms_io (uint32 va, uint32 map) | |
{ | |
uint32 pgn, mpr; | |
if (va <= 1) return va; /* A, B */ | |
pgn = VA_GETPAG (va); /* get page num */ | |
if (pgn == 0) { /* base page? */ | |
uint32 dms_fence = dms_sr & MST_FENCE; /* get fence value */ | |
if ((dms_sr & MST_FLT)? /* check unmapped */ | |
(va >= dms_fence): /* 1B10: >= fence */ | |
(va < dms_fence)) { /* 0B10: < fence */ | |
return va; } } /* no mapping */ | |
mpr = dms_map[map + pgn]; /* get map reg */ | |
return (MAP_GETPAG (mpr) | VA_GETOFF (va)); | |
} | |
/* DMS relocation for console access */ | |
uint32 dms_cons (uint32 va, int32 sw) | |
{ | |
uint32 map_sel; | |
if (sw & SWMASK ('V')) map_sel = dms_ump; /* switch? select map */ | |
else if (sw & SWMASK ('S')) map_sel = SMAP; | |
else if (sw & SWMASK ('U')) map_sel = UMAP; | |
else if (sw & SWMASK ('P')) map_sel = PAMAP; | |
else if (sw & SWMASK ('Q')) map_sel = PBMAP; | |
else return va; /* no switch, physical */ | |
if (va >= VASIZE) return MEMSIZE; /* virtual, must be 15b */ | |
else if (dms_enb) return dms_io (va, map_sel); /* DMS on? go thru map */ | |
else return va; /* else return virtual */ | |
} | |
/* Mem protect and DMS validation for jumps */ | |
void mp_dms_jmp (uint32 va) | |
{ | |
uint32 pgn = VA_GETPAG (va); /* get page num */ | |
if ((pgn == 0) && (va > 1)) { /* base page? */ | |
uint32 dms_fence = dms_sr & MST_FENCE; /* get fence value */ | |
if ((dms_sr & MST_FLT)? /* check unmapped */ | |
(va >= dms_fence): /* 1B10: >= fence */ | |
(va < dms_fence)) { /* 0B10: < fence */ | |
dms_viol (va, MVI_BPG); /* if W, viol */ | |
return; } } /* PRO not set */ | |
if (CTL (PRO) && (va < mp_fence)) ABORT (ABORT_PRO); /* base page MPR */ | |
return; | |
} | |
/* DMS read and write maps */ | |
uint16 dms_rmap (uint32 mapi) | |
{ | |
mapi = mapi & MAP_MASK; | |
return (dms_map[mapi] & ~MAP_MBZ); | |
} | |
void dms_wmap (uint32 mapi, uint32 dat) | |
{ | |
mapi = mapi & MAP_MASK; | |
dms_map[mapi] = (uint16) (dat & ~MAP_MBZ); | |
return; | |
} | |
/* DMS violation */ | |
void dms_viol (uint32 va, uint32 st) | |
{ | |
dms_vr = st | VA_GETPAG (va) | | |
((st & (MVI_RPR | MVI_WPR))? MVI_MEB: 0) | /* set MEB */ | |
(dms_enb? MVI_MEM: 0) | /* set MEM */ | |
(dms_ump? MVI_UMP: 0); /* set UMAP */ | |
if (CTL (PRO)) { /* protected? */ | |
mp_mevff = 1; /* signal dms */ | |
ABORT (ABORT_PRO); } /* abort */ | |
return; | |
} | |
/* DMS update status */ | |
uint32 dms_upd_sr (void) | |
{ | |
dms_sr = dms_sr & ~(MST_ENB | MST_UMP | MST_PRO); | |
if (dms_enb) dms_sr = dms_sr | MST_ENB; | |
if (dms_ump) dms_sr = dms_sr | MST_UMP; | |
if (CTL (PRO)) dms_sr = dms_sr | MST_PRO; | |
return dms_sr; | |
} | |
/* Device 0 (CPU) I/O routine | |
From Dave Bryan: RTE uses the undocumented instruction "SFS 0,C" to both test | |
and turn off the interrupt system. This is confirmed in the "RTE-6/VM | |
Technical Specifications" manual (HP 92084-90015), section 2.3.1 "Process | |
the Interrupt", subsection "A.1 $CIC": | |
"Test to see if the interrupt system is on or off. This is done with the | |
SFS 0,C instruction. In either case, turn it off (the ,C does it)." | |
...and in section 5.8, "Parity Error Detection": | |
"Because parity error interrupts can occur even when the interrupt system | |
is off, the code at $CIC must be able to save the complete system status. | |
The major hole in being able to save the complete state is in saving the | |
interrupt system state. In order to do this in both the 21MX and the 21XE | |
the instruction 103300 was used to both test the interrupt system and | |
turn it off." */ | |
int32 cpuio (int32 inst, int32 IR, int32 dat) | |
{ | |
int i; | |
switch (inst) { /* case on opcode */ | |
case ioFLG: /* flag */ | |
ion = (IR & I_HC)? 0: 1; /* interrupts off/on */ | |
return dat; | |
case ioSFC: /* skip flag clear */ | |
if (!ion) PC = (PC + 1) & VAMASK; | |
break; | |
case ioSFS: /* skip flag set */ | |
if (ion) PC = (PC + 1) & VAMASK; | |
break; | |
case ioLIX: /* load */ | |
dat = 0; /* returns 0 */ | |
break; | |
case ioCTL: /* control */ | |
if (IR & I_CTL) { /* =CLC 02,03,06..77 */ | |
devdisp (DMALT0, inst, I_CTL + DMALT0, 0); | |
devdisp (DMALT1, inst, I_CTL + DMALT1, 0); | |
for (i = 6; i <= I_DEVMASK; i++) | |
devdisp (i, inst, I_CTL + i, 0); } | |
break; | |
default: | |
break; } | |
if (IR & I_HC) ion = 0; /* HC option */ | |
return dat; | |
} | |
/* Device 1 (overflow) I/O routine */ | |
int32 ovfio (int32 inst, int32 IR, int32 dat) | |
{ | |
switch (inst) { /* case on opcode */ | |
case ioFLG: /* flag */ | |
O = (IR & I_HC)? 0: 1; /* clear/set overflow */ | |
return dat; | |
case ioSFC: /* skip flag clear */ | |
if (!O) PC = (PC + 1) & VAMASK; | |
break; /* can clear flag */ | |
case ioSFS: /* skip flag set */ | |
if (O) PC = (PC + 1) & VAMASK; | |
break; /* can clear flag */ | |
case ioMIX: /* merge */ | |
dat = dat | SR; | |
break; | |
case ioLIX: /* load */ | |
dat = SR; | |
break; | |
case ioOTX: /* output */ | |
SR = dat; | |
break; | |
default: | |
break; } | |
if (IR & I_HC) O = 0; /* HC option */ | |
return dat; | |
} | |
/* Device 4 (power fail) I/O routine */ | |
int32 pwrio (int32 inst, int32 IR, int32 dat) | |
{ | |
switch (inst) { /* case on opcode */ | |
case ioMIX: /* merge */ | |
dat = dat | intaddr; | |
break; | |
case ioLIX: /* load */ | |
dat = intaddr; | |
break; | |
default: | |
break; } | |
return dat; | |
} | |
/* Device 5 (memory protect) I/O routine | |
From Dave Bryan: Examination of the schematics for the MP card in the | |
engineering documentation shows that the SFS and SFC I/O backplane signals | |
gate the output of the MEVFF onto the SKF line unconditionally. */ | |
int32 proio (int32 inst, int32 IR, int32 dat) | |
{ | |
if ((cpu_unit.flags & UNIT_MPR) == 0) /* not installed? */ | |
return nulio (inst, IR, dat); /* non-existent dev */ | |
switch (inst) { /* case on opcode */ | |
case ioSFC: /* skip flag clear */ | |
if (!mp_mevff) PC = (PC + 1) & VAMASK; /* skip if mem prot */ | |
break; | |
case ioSFS: /* skip flag set */ | |
if (mp_mevff) PC = (PC + 1) & VAMASK; /* skip if DMS */ | |
break; | |
case ioMIX: /* merge */ | |
dat = dat | mp_viol; | |
break; | |
case ioLIX: /* load */ | |
dat = mp_viol; | |
break; | |
case ioOTX: /* output */ | |
mp_fence = dat & VAMASK; | |
if (cpu_unit.flags & UNIT_2100) iop_sp = mp_fence; | |
break; | |
case ioCTL: /* control clear/set */ | |
if ((IR & I_CTL) == 0) { /* STC */ | |
setCTL (PRO); | |
dms_vr = 0; | |
mp_evrff = 1; /* allow mp_viol upd */ | |
mp_mevff = 0; } /* clear DMS flag */ | |
break; | |
default: | |
break; } | |
if (IR & I_HC) { clrFLG (PRO); } /* HC option */ | |
return dat; | |
} | |
/* Devices 2,3 (secondary DMA) I/O routine */ | |
int32 dmsio (int32 inst, int32 IR, int32 dat) | |
{ | |
int32 ch; | |
ch = IR & 1; /* get channel num */ | |
switch (inst) { /* case on opcode */ | |
case ioMIX: /* merge */ | |
dat = dat | dmac[ch].cw3; | |
break; | |
case ioLIX: /* load */ | |
dat = dmac[ch].cw3; | |
break; | |
case ioOTX: /* output */ | |
if (CTL (DMALT0 + ch)) dmac[ch].cw3 = dat; | |
else dmac[ch].cw2 = dat; | |
break; | |
case ioCTL: /* control clear/set */ | |
if (IR & I_CTL) { clrCTL (DMALT0 + ch); } /* CLC */ | |
else { setCTL (DMALT0 + ch); } /* STC */ | |
break; | |
default: | |
break; } | |
return dat; | |
} | |
/* Devices 6,7 (primary DMA) I/O routine */ | |
int32 dmpio (int32 inst, int32 IR, int32 dat) | |
{ | |
int32 ch; | |
ch = IR & 1; /* get channel number */ | |
switch (inst) { /* case on opcode */ | |
case ioFLG: /* flag */ | |
if ((IR & I_HC) == 0) { /* set->abort */ | |
setFLG (DMA0 + ch); /* set flag */ | |
clrCMD (DMA0 + ch); } /* clr cmd */ | |
break; | |
case ioSFC: /* skip flag clear */ | |
if (FLG (DMA0 + ch) == 0) PC = (PC + 1) & VAMASK; | |
break; | |
case ioSFS: /* skip flag set */ | |
if (FLG (DMA0 + ch) != 0) PC = (PC + 1) & VAMASK; | |
break; | |
case ioMIX: case ioLIX: /* load, merge */ | |
dat = DMASK; | |
break; | |
case ioOTX: /* output */ | |
dmac[ch].cw1 = dat; | |
break; | |
case ioCTL: /* control */ | |
if (IR & I_CTL) { clrCTL (DMA0 + ch); } /* CLC: cmd unchgd */ | |
else { /* STC */ | |
setCTL (DMA0 + ch); /* set ctl, cmd */ | |
setCMD (DMA0 + ch); } | |
break; | |
default: | |
break; } | |
if (IR & I_HC) { clrFLG (DMA0 + ch); } /* HC option */ | |
return dat; | |
} | |
/* DMA cycle routine | |
The last cycle (word count reaches 0) logic is quite tricky. | |
Input cases: | |
- CLC requested: issue CLC | |
Output cases: | |
- neither STC nor CLC requested: issue CLF | |
- STC requested but not CLC: issue STC,C | |
- CLC requested but not STC: issue CLC,C | |
- STC and CLC both requested: issue STC,C and CLC,C, in that order | |
Either: issue EDT | |
*/ | |
void dma_cycle (uint32 ch, uint32 map) | |
{ | |
int32 temp, dev, MA; | |
int32 inp = dmac[ch].cw2 & DMA2_OI; /* input flag */ | |
dev = dmac[ch].cw1 & I_DEVMASK; /* get device */ | |
MA = dmac[ch].cw2 & VAMASK; /* get mem addr */ | |
if (inp) { /* input? */ | |
temp = devdisp (dev, ioLIX, dev, 0); /* do LIA dev */ | |
WriteIO (MA, temp, map); } /* store data */ | |
else { temp = ReadIO (MA, map); /* read data */ | |
devdisp (dev, ioOTX, dev, temp); } /* do OTA dev */ | |
dmac[ch].cw2 = (dmac[ch].cw2 & DMA2_OI) | ((dmac[ch].cw2 + 1) & VAMASK); | |
dmac[ch].cw3 = (dmac[ch].cw3 + 1) & DMASK; /* incr wcount */ | |
if (dmac[ch].cw3) { /* more to do? */ | |
if (dmac[ch].cw1 & DMA1_STC) /* if STC flag, */ | |
devdisp (dev, ioCTL, I_HC + dev, 0); /* do STC,C dev */ | |
else devdisp (dev, ioFLG, I_HC + dev, 0); /* else CLF dev */ | |
} | |
else { if (inp) { /* last cycle, input? */ | |
if (dmac[ch].cw1 & DMA1_CLC) /* CLC at end? */ | |
devdisp (dev, ioCTL, I_CTL + dev, 0); /* yes */ | |
} /* end input */ | |
else { /* output */ | |
if ((dmac[ch].cw1 & (DMA1_STC | DMA1_CLC)) == 0) | |
devdisp (dev, ioFLG, I_HC + dev, 0); /* clear flag */ | |
if (dmac[ch].cw1 & DMA1_STC) /* if STC flag, */ | |
devdisp (dev, ioCTL, I_HC + dev, 0); /* do STC,C dev */ | |
if (dmac[ch].cw1 & DMA1_CLC) /* CLC at end? */ | |
devdisp (dev, ioCTL, I_HC + I_CTL + dev, 0); /* yes */ | |
} /* end output */ | |
setFLG (DMA0 + ch); /* set DMA flg */ | |
clrCMD (DMA0 + ch); /* clr DMA cmd */ | |
devdisp (dev, ioEDT, dev, 0); /* do EDT */ | |
} | |
return; | |
} | |
/* Unimplemented device routine */ | |
int32 nulio (int32 inst, int32 IR, int32 dat) | |
{ | |
switch (inst) { /* case on opcode */ | |
case ioSFC: /* skip flag clear */ | |
PC = (PC + 1) & VAMASK; | |
return (stop_dev << IOT_V_REASON) | dat; | |
case ioSFS: /* skip flag set */ | |
return (stop_dev << IOT_V_REASON) | dat; | |
default: | |
break; } | |
if (IR & I_HC) { clrFLG (IR & I_DEVMASK); } /* HC option */ | |
return (stop_dev << IOT_V_REASON) | dat; | |
} | |
/* Reset routines */ | |
t_stat cpu_reset (DEVICE *dptr) | |
{ | |
E = 0; | |
O = 0; | |
ion = ion_defer = 0; | |
clrCMD (PWR); | |
clrCTL (PWR); | |
clrFLG (PWR); | |
clrFBF (PWR); | |
clrCMD (PRO); | |
clrCTL (PRO); | |
clrFLG (PRO); | |
clrFBF (PRO); | |
dev_srq[0] = dev_srq[0] & ~M_FXDEV; | |
mp_fence = 0; /* init mprot */ | |
mp_viol = 0; | |
mp_mevff = 0; | |
mp_evrff = 1; | |
dms_enb = dms_ump = 0; /* init DMS */ | |
dms_sr = 0; | |
dms_vr = 0; | |
pcq_r = find_reg ("PCQ", NULL, dptr); | |
sim_brk_types = ALL_BKPTS; | |
sim_brk_dflt = SWMASK ('E'); | |
if (M == NULL) M = calloc (PASIZE, sizeof (unsigned int16)); | |
if (M == NULL) return SCPE_MEM; | |
if (pcq_r) pcq_r->qptr = 0; | |
else return SCPE_IERR; | |
return SCPE_OK; | |
} | |
t_stat dma0_reset (DEVICE *tptr) | |
{ | |
clrCMD (DMA0); | |
clrCTL (DMA0); | |
setFLG (DMA0); | |
clrSRQ (DMA0); | |
dmac[0].cw1 = dmac[0].cw2 = dmac[0].cw3 = 0; | |
return SCPE_OK; | |
} | |
t_stat dma1_reset (DEVICE *tptr) | |
{ | |
clrCMD (DMA1); | |
clrCTL (DMA1); | |
setFLG (DMA1); | |
clrSRQ (DMA1); | |
dmac[1].cw1 = dmac[1].cw2 = dmac[1].cw3 = 0; | |
return SCPE_OK; | |
} | |
/* Memory examine */ | |
t_stat cpu_ex (t_value *vptr, t_addr addr, UNIT *uptr, int32 sw) | |
{ | |
int32 d; | |
addr = dms_cons (addr, sw); | |
if (addr >= MEMSIZE) return SCPE_NXM; | |
if (addr == 0) d = saved_AR; | |
else if (addr == 1) d = saved_BR; | |
else d = M[addr]; | |
if (vptr != NULL) *vptr = d & DMASK; | |
return SCPE_OK; | |
} | |
/* Memory deposit */ | |
t_stat cpu_dep (t_value val, t_addr addr, UNIT *uptr, int32 sw) | |
{ | |
addr = dms_cons (addr, sw); | |
if (addr >= MEMSIZE) return SCPE_NXM; | |
if (addr == 0) saved_AR = val & DMASK; | |
else if (addr == 1) saved_BR = val & DMASK; | |
else M[addr] = val & DMASK; | |
return SCPE_OK; | |
} | |
/* Memory size validation */ | |
t_stat cpu_set_size (UNIT *uptr, int32 val, char *cptr, void *desc) | |
{ | |
int32 mc = 0; | |
uint32 i; | |
if ((val <= 0) || (val > PASIZE) || ((val & 07777) != 0) || | |
(!(uptr->flags & UNIT_21MX) && (val > 32768))) | |
return SCPE_ARG; | |
for (i = val; i < MEMSIZE; i++) mc = mc | M[i]; | |
if ((mc != 0) && (!get_yn ("Really truncate memory [N]?", FALSE))) | |
return SCPE_OK; | |
MEMSIZE = val; | |
for (i = MEMSIZE; i < PASIZE; i++) M[i] = 0; | |
return SCPE_OK; | |
} | |
/* Set device number */ | |
t_stat hp_setdev (UNIT *uptr, int32 num, char *cptr, void *desc) | |
{ | |
DEVICE *dptr = (DEVICE *) desc; | |
DIB *dibp; | |
int32 i, newdev; | |
t_stat r; | |
if (cptr == NULL) return SCPE_ARG; | |
if ((desc == NULL) || (num > 1)) return SCPE_IERR; | |
dibp = (DIB *) dptr->ctxt; | |
if (dibp == NULL) return SCPE_IERR; | |
newdev = get_uint (cptr, 8, I_DEVMASK - num, &r); | |
if (r != SCPE_OK) return r; | |
if (newdev < VARDEV) return SCPE_ARG; | |
for (i = 0; i <= num; i++, dibp++) dibp->devno = newdev + i; | |
return SCPE_OK; | |
} | |
/* Show device number */ | |
t_stat hp_showdev (FILE *st, UNIT *uptr, int32 num, void *desc) | |
{ | |
DEVICE *dptr = (DEVICE *) desc; | |
DIB *dibp; | |
int32 i; | |
if ((desc == NULL) || (num > 1)) return SCPE_IERR; | |
dibp = (DIB *) dptr->ctxt; | |
if (dibp == NULL) return SCPE_IERR; | |
fprintf (st, "devno=%o", dibp->devno); | |
for (i = 1; i <= num; i++) fprintf (st, "/%o", dibp->devno + i); | |
return SCPE_OK; | |
} | |
/* Make a pair of devices consistent */ | |
void hp_enbdis_pair (DEVICE *ccp, DEVICE *dcp) | |
{ | |
if (ccp->flags & DEV_DIS) dcp->flags = dcp->flags | DEV_DIS; | |
else dcp->flags = dcp->flags & ~DEV_DIS; | |
return; | |
} | |
/* Test for device conflict */ | |
t_bool dev_conflict (void) | |
{ | |
DEVICE *dptr, *cdptr; | |
DIB *dibp, *chkp; | |
uint32 i, j, dno; | |
for (i = 0; cdptr = sim_devices[i]; i++) { | |
chkp = (DIB *) cdptr->ctxt; | |
if (chkp && !(cdptr->flags & DEV_DIS)) { | |
dno = chkp->devno; | |
for (j = 0; dptr = sim_devices[j]; j++) { | |
dibp = (DIB *) dptr->ctxt; | |
if (dibp && !(dptr->flags & DEV_DIS) && | |
(chkp != dibp) && (dno == dibp->devno)) { | |
printf ("%s device number conflict, devno = %d\n", | |
sim_dname (dptr), dno); | |
if (sim_log) fprintf (sim_log, | |
"%s device number conflict, devno = %d\n", | |
sim_dname (dptr), dno); | |
return TRUE; } } } } | |
return FALSE; | |
} | |
/* Configuration validation */ | |
t_bool cpu_set_opt (UNIT *uptr, int32 val, char *cptr, void *desc) | |
{ | |
int32 opt = (int32) desc; | |
int32 mod, i; | |
mod = MOD_2116; | |
if (uptr->flags & UNIT_2100) mod = MOD_2100; | |
else if (uptr->flags & UNIT_21MX) mod = MOD_21MX; | |
for (i = 0; opt_val[i].optf != 0; i++) { | |
if ((opt == opt_val[i].optf) && (mod & opt_val[i].cpuf)) { | |
if ((mod == MOD_2100) && (val == UNIT_FP)) | |
uptr->flags = uptr->flags & ~UNIT_IOP; | |
if ((opt == UNIT_IOP) && val) { | |
if (mod == MOD_2100) uptr->flags = | |
(uptr->flags & ~UNIT_FP) | UNIT_IOP | UNIT_MPR; | |
if (mod == MOD_21MX) uptr->flags |= UNIT_IOPX | UNIT_MPR; } | |
if (val == UNIT_DMS) uptr->flags |= UNIT_MPR; | |
return SCPE_OK; } } | |
return SCPE_NOFNC; | |
} | |
/* IBL routine (CPU boot) */ | |
t_stat cpu_boot (int32 unitno, DEVICE *dptr) | |
{ | |
extern const uint16 ptr_rom[IBL_LNT], dq_rom[IBL_LNT], ms_rom[IBL_LNT]; | |
int32 dev = (SR >> IBL_V_DEV) & I_DEVMASK; | |
int32 sel = (SR >> IBL_V_SEL) & IBL_M_SEL; | |
if (dev < 010) return SCPE_NOFNC; | |
switch (sel) { | |
case 0: /* PTR boot */ | |
ibl_copy (ptr_rom, dev); | |
break; | |
case 1: /* DP/DQ boot */ | |
ibl_copy (dq_rom, dev); | |
break; | |
case 2: /* MS boot */ | |
ibl_copy (ms_rom, dev); | |
break; | |
default: | |
return SCPE_NOFNC; } | |
return SCPE_OK; | |
} | |
/* IBL boot ROM copy | |
- Use memory size to set the initial PC and base of the boot area | |
- Copy boot ROM to memory, updating I/O instructions | |
- Place 2's complement of boot base in last location | |
Notes: | |
- SR settings are done by the caller | |
- Boot ROM's must be assembled with a device code of 10 (10 and 11 for | |
devices requiring two codes) | |
*/ | |
t_stat ibl_copy (const uint16 pboot[IBL_LNT], int32 dev) | |
{ | |
int32 i; | |
uint16 wd; | |
if (dev < 010) return SCPE_ARG; /* valid device? */ | |
PC = ((MEMSIZE - 1) & ~IBL_MASK) & VAMASK; /* start at mem top */ | |
for (i = 0; i < IBL_LNT; i++) { /* copy bootstrap */ | |
wd = pboot[i]; /* get word */ | |
if (((wd & I_NMRMASK) == I_IO) && /* IO instruction? */ | |
((wd & I_DEVMASK) >= 010) && /* dev >= 10? */ | |
(I_GETIOOP (wd) != ioHLT)) /* not a HALT? */ | |
M[PC + i] = (wd + (dev - 010)) & DMASK; /* change dev code */ | |
else M[PC + i] = wd; } /* leave unchanged */ | |
M[PC + IBL_DPC] = (M[PC + IBL_DPC] + (dev - 010)) & DMASK; /* patch DMA ctrl */ | |
M[PC + IBL_END] = (~PC + 1) & DMASK; /* fill in start of boot */ | |
return SCPE_OK; | |
} | |