diff --git a/MacPlus.sv b/MacPlus.sv
index 701a0d4..6f98618 100644
--- a/MacPlus.sv
+++ b/MacPlus.sv
@@ -291,7 +291,7 @@ wire cpu_clkena = cep && (cpuBusControl || (cpu_busstate == 2'b01));
reg [15:0] cpuDataIn;
always @(posedge clk_sys) if(cel && cpuBusControl && ~cpu_busstate[0] && _cpuRW) cpuDataIn <= dataControllerDataOut;
-TG68KdotC_Kernel #(0,0,0,0,0,0) m68k
+TG68KdotC_Kernel #(0,0,0,0,0,0, 0,1) m68k
(
.clk ( clk_sys ),
.nReset ( _cpuReset ),
@@ -302,7 +302,7 @@ TG68KdotC_Kernel #(0,0,0,0,0,0) m68k
.berr ( 1'b0 ),
.clr_berr ( 1'b0 ),
.CPU ( 2'b00 ), // 00=68000
- .addr ( {cpuAddrHi, cpuAddr} ),
+ .addr_out ( {cpuAddrHi, cpuAddr} ),
.data_write ( cpuDataOut ),
.nUDS ( _cpuUDS ),
.nLDS ( _cpuLDS ),
diff --git a/src/tg68k/TG68K_ALU.vhd b/src/tg68k/TG68K_ALU.vhd
index dceb2c7..9ddd1b6 100644
--- a/src/tg68k/TG68K_ALU.vhd
+++ b/src/tg68k/TG68K_ALU.vhd
@@ -1,932 +1,1279 @@
-------------------------------------------------------------------------------
-------------------------------------------------------------------------------
--- --
--- Copyright (c) 2009-2011 Tobias Gubener --
--- Subdesign fAMpIGA by TobiFlex --
--- --
--- This source file is free software: you can redistribute it and/or modify --
--- it under the terms of the GNU General Public License as published --
--- by the Free Software Foundation, either version 3 of the License, or --
--- (at your option) any later version. --
--- --
--- This source file is distributed in the hope that it will be useful, --
--- but WITHOUT ANY WARRANTY; without even the implied warranty of --
--- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the --
--- GNU General Public License for more details. --
--- --
--- You should have received a copy of the GNU General Public License --
--- along with this program. If not, see . --
--- --
-------------------------------------------------------------------------------
-------------------------------------------------------------------------------
-
-library ieee;
-use ieee.std_logic_1164.all;
-use ieee.std_logic_unsigned.all;
-use IEEE.numeric_std.all;
-use work.TG68K_Pack.all;
-
-entity TG68K_ALU is
-generic(
- MUL_Mode : integer := 0; --0=>16Bit, 1=>32Bit, 2=>switchable with CPU(1), 3=>no MUL,
- DIV_Mode : integer := 0 --0=>16Bit, 1=>32Bit, 2=>switchable with CPU(1), 3=>no DIV,
- );
- port(clk : in std_logic;
- Reset : in std_logic;
- clkena_lw : in std_logic:='1';
- execOPC : in bit;
- exe_condition : in std_logic;
- exec_tas : in std_logic;
- long_start : in bit;
- movem_presub : in bit;
- set_stop : in bit;
- Z_error : in bit;
- rot_bits : in std_logic_vector(1 downto 0);
- exec : in bit_vector(lastOpcBit downto 0);
- OP1out : in std_logic_vector(31 downto 0);
- OP2out : in std_logic_vector(31 downto 0);
- reg_QA : in std_logic_vector(31 downto 0);
- reg_QB : in std_logic_vector(31 downto 0);
- opcode : in std_logic_vector(15 downto 0);
- datatype : in std_logic_vector(1 downto 0);
- exe_opcode : in std_logic_vector(15 downto 0);
- exe_datatype : in std_logic_vector(1 downto 0);
- sndOPC : in std_logic_vector(15 downto 0);
- last_data_read : in std_logic_vector(15 downto 0);
- data_read : in std_logic_vector(15 downto 0);
- FlagsSR : in std_logic_vector(7 downto 0);
- micro_state : in micro_states;
- bf_ext_in : in std_logic_vector(7 downto 0);
- bf_ext_out : out std_logic_vector(7 downto 0);
- bf_shift : in std_logic_vector(5 downto 0);
- bf_width : in std_logic_vector(5 downto 0);
- bf_loffset : in std_logic_vector(4 downto 0);
-
- set_V_Flag : buffer bit;
- Flags : buffer std_logic_vector(7 downto 0);
- c_out : buffer std_logic_vector(2 downto 0);
- addsub_q : buffer std_logic_vector(31 downto 0);
- ALUout : out std_logic_vector(31 downto 0)
- );
-end TG68K_ALU;
-
-architecture logic of TG68K_ALU is
------------------------------------------------------------------------------
------------------------------------------------------------------------------
--- ALU and more
------------------------------------------------------------------------------
------------------------------------------------------------------------------
- signal OP1in : std_logic_vector(31 downto 0);
- signal addsub_a : std_logic_vector(31 downto 0);
- signal addsub_b : std_logic_vector(31 downto 0);
- signal notaddsub_b : std_logic_vector(33 downto 0);
- signal add_result : std_logic_vector(33 downto 0);
- signal addsub_ofl : std_logic_vector(2 downto 0);
- signal opaddsub : bit;
- signal c_in : std_logic_vector(3 downto 0);
- signal flag_z : std_logic_vector(2 downto 0);
- signal set_Flags : std_logic_vector(3 downto 0); --NZVC
- signal CCRin : std_logic_vector(7 downto 0);
-
- signal niba_l : std_logic_vector(5 downto 0);
- signal niba_h : std_logic_vector(5 downto 0);
- signal niba_lc : std_logic;
- signal niba_hc : std_logic;
- signal bcda_lc : std_logic;
- signal bcda_hc : std_logic;
- signal nibs_l : std_logic_vector(5 downto 0);
- signal nibs_h : std_logic_vector(5 downto 0);
- signal nibs_lc : std_logic;
- signal nibs_hc : std_logic;
-
- signal bcd_a : std_logic_vector(8 downto 0);
- signal bcd_s : std_logic_vector(8 downto 0);
- signal pack_out : std_logic_vector(15 downto 0);
- signal pack_a : std_logic_vector(15 downto 0);
- signal result_mulu : std_logic_vector(63 downto 0);
- signal result_div : std_logic_vector(63 downto 0);
- signal set_mV_Flag : std_logic;
- signal V_Flag : bit;
-
- signal rot_rot : std_logic;
- signal rot_lsb : std_logic;
- signal rot_msb : std_logic;
- signal rot_X : std_logic;
- signal rot_C : std_logic;
- signal rot_out : std_logic_vector(31 downto 0);
- signal asl_VFlag : std_logic;
- signal bit_bits : std_logic_vector(1 downto 0);
- signal bit_number : std_logic_vector(4 downto 0);
- signal bits_out : std_logic_vector(31 downto 0);
- signal one_bit_in : std_logic;
- signal bchg : std_logic;
- signal bset : std_logic;
-
- signal mulu_sign : std_logic;
- signal mulu_signext : std_logic_vector(16 downto 0);
- signal muls_msb : std_logic;
- signal mulu_reg : std_logic_vector(63 downto 0);
- signal FAsign : std_logic;
- signal faktorA : std_logic_vector(31 downto 0);
- signal faktorB : std_logic_vector(31 downto 0);
-
- signal div_reg : std_logic_vector(63 downto 0);
- signal div_quot : std_logic_vector(63 downto 0);
- signal div_ovl : std_logic;
- signal div_neg : std_logic;
- signal div_bit : std_logic;
- signal div_sub : std_logic_vector(32 downto 0);
- signal div_over : std_logic_vector(32 downto 0);
- signal nozero : std_logic;
- signal div_qsign : std_logic;
- signal divisor : std_logic_vector(63 downto 0);
- signal divs : std_logic;
- signal signedOP : std_logic;
- signal OP1_sign : std_logic;
- signal OP2_sign : std_logic;
- signal OP2outext : std_logic_vector(15 downto 0);
-
- signal in_offset : std_logic_vector(5 downto 0);
--- signal in_width : std_logic_vector(5 downto 0);
- signal datareg : std_logic_vector(31 downto 0);
- signal insert : std_logic_vector(31 downto 0);
--- signal bf_result : std_logic_vector(31 downto 0);
--- signal bf_offset : std_logic_vector(5 downto 0);
--- signal bf_width : std_logic_vector(5 downto 0);
--- signal bf_firstbit : std_logic_vector(5 downto 0);
- signal bf_datareg : std_logic_vector(31 downto 0);
--- signal bf_out : std_logic_vector(31 downto 0);
- signal result : std_logic_vector(39 downto 0);
- signal result_tmp : std_logic_vector(39 downto 0);
- signal sign : std_logic_vector(31 downto 0);
- signal bf_set1 : std_logic_vector(39 downto 0);
- signal inmux0 : std_logic_vector(39 downto 0);
- signal inmux1 : std_logic_vector(39 downto 0);
- signal inmux2 : std_logic_vector(39 downto 0);
- signal inmux3 : std_logic_vector(31 downto 0);
- signal copymux0 : std_logic_vector(39 downto 0);
- signal copymux1 : std_logic_vector(39 downto 0);
- signal copymux2 : std_logic_vector(39 downto 0);
- signal copymux3 : std_logic_vector(31 downto 0);
- signal bf_set2 : std_logic_vector(31 downto 0);
--- signal bf_set3 : std_logic_vector(31 downto 0);
- signal shift : std_logic_vector(39 downto 0);
- signal copy : std_logic_vector(39 downto 0);
--- signal offset : std_logic_vector(5 downto 0);
--- signal width : std_logic_vector(5 downto 0);
- signal bf_firstbit : std_logic_vector(5 downto 0);
- signal mux : std_logic_vector(3 downto 0);
- signal bitnr : std_logic_vector(4 downto 0);
- signal mask : std_logic_vector(31 downto 0);
- signal bf_bset : std_logic;
- signal bf_NFlag : std_logic;
- signal bf_bchg : std_logic;
- signal bf_ins : std_logic;
- signal bf_exts : std_logic;
- signal bf_fffo : std_logic;
- signal bf_d32 : std_logic;
- signal bf_s32 : std_logic;
- signal index : std_logic_vector(4 downto 0);
--- signal i : integer range 0 to 31;
--- signal i : integer range 0 to 31;
--- signal i : std_logic_vector(5 downto 0);
-BEGIN
------------------------------------------------------------------------------
--- set OP1in
------------------------------------------------------------------------------
-PROCESS (OP2out, reg_QB, opcode, OP1out, OP1in, exe_datatype, addsub_q, execOPC, exec,
- pack_out, bcd_a, bcd_s, result_mulu, result_div, exe_condition, bf_shift,
- Flags, FlagsSR, bits_out, exec_tas, rot_out, exe_opcode, result, bf_fffo, bf_firstbit, bf_datareg)
- BEGIN
- ALUout <= OP1in;
- ALUout(7) <= OP1in(7) OR exec_tas;
- IF exec(opcBFwb)='1' THEN
- ALUout <= result(31 downto 0);
- IF bf_fffo='1' THEN
- ALUout <= (OTHERS =>'0');
- ALUout(5 downto 0) <= bf_firstbit + bf_shift;
- END IF;
- END IF;
-
- OP1in <= addsub_q;
- IF exec(opcABCD)='1' THEN
- OP1in(7 downto 0) <= bcd_a(7 downto 0);
- ELSIF exec(opcSBCD)='1' THEN
- OP1in(7 downto 0) <= bcd_s(7 downto 0);
- ELSIF exec(opcMULU)='1' AND MUL_Mode/=3 THEN
- IF exec(write_lowlong)='1' AND (MUL_Mode=1 OR MUL_Mode=2) THEN
- OP1in <= result_mulu(31 downto 0);
- ELSE
- OP1in <= result_mulu(63 downto 32);
- END IF;
- ELSIF exec(opcDIVU)='1' AND DIV_Mode/=3 THEN
- IF exe_opcode(15)='1' OR DIV_Mode=0 THEN
--- IF exe_opcode(15)='1' THEN
- OP1in <= result_div(47 downto 32)&result_div(15 downto 0);
- ELSE --64bit
- IF exec(write_reminder)='1' THEN
- OP1in <= result_div(63 downto 32);
- ELSE
- OP1in <= result_div(31 downto 0);
- END IF;
- END IF;
- ELSIF exec(opcOR)='1' THEN
- OP1in <= OP2out OR OP1out;
- ELSIF exec(opcAND)='1' THEN
- OP1in <= OP2out AND OP1out;
- ELSIF exec(opcScc)='1' THEN
- OP1in(7 downto 0) <= (others=>exe_condition);
- ELSIF exec(opcEOR)='1' THEN
- OP1in <= OP2out XOR OP1out;
- ELSIF exec(opcMOVE)='1' OR exec(exg)='1' THEN
--- OP1in <= OP2out(31 downto 8)&(OP2out(7)OR exec_tas)&OP2out(6 downto 0);
- OP1in <= OP2out;
- ELSIF exec(opcROT)='1' THEN
- OP1in <= rot_out;
- ELSIF exec(opcSWAP)='1' THEN
- OP1in <= OP1out(15 downto 0)& OP1out(31 downto 16);
- ELSIF exec(opcBITS)='1' THEN
- OP1in <= bits_out;
- ELSIF exec(opcBF)='1' THEN
- OP1in <= bf_datareg;
- ELSIF exec(opcMOVESR)='1' THEN
- OP1in(7 downto 0) <= Flags;
- IF exe_datatype="00" THEN
- OP1in(15 downto 8) <= "00000000";
- ELSE
- OP1in(15 downto 8) <= FlagsSR;
- END IF;
- ELSIF exec(opcPACK)='1' THEN
- OP1in(15 downto 0) <= pack_out;
- END IF;
- END PROCESS;
-
------------------------------------------------------------------------------
--- addsub
------------------------------------------------------------------------------
-PROCESS (OP1out, OP2out, execOPC, datatype, Flags, long_start, movem_presub, exe_datatype, exec, addsub_a, addsub_b, opaddsub,
- notaddsub_b, add_result, c_in, sndOPC)
- BEGIN
- addsub_a <= OP1out;
- IF exec(get_bfoffset)='1' THEN
- IF sndOPC(11)='1' THEN
- addsub_a <= OP1out(31)&OP1out(31)&OP1out(31)&OP1out(31 downto 3);
- ELSE
- addsub_a <= "000000000000000000000000000000"&sndOPC(10 downto 9);
- END IF;
- END IF;
-
- IF exec(subidx)='1' THEN
- opaddsub <= '1';
- ELSE
- opaddsub <= '0';
- END IF;
-
- c_in(0) <='0';
- addsub_b <= OP2out;
- IF execOPC='0' AND exec(OP2out_one)='0' AND exec(get_bfoffset)='0'THEN
- IF long_start='0' AND datatype="00" AND exec(use_SP)='0' THEN
- addsub_b <= "00000000000000000000000000000001";
- ELSIF long_start='0' AND exe_datatype="10" AND (exec(presub) OR exec(postadd) OR movem_presub)='1' THEN
- IF exec(movem_action)='1' THEN
- addsub_b <= "00000000000000000000000000000110";
- ELSE
- addsub_b <= "00000000000000000000000000000100";
- END IF;
- ELSE
- addsub_b <= "00000000000000000000000000000010";
- END IF;
- ELSE
- IF (exec(use_XZFlag)='1' AND Flags(4)='1') OR exec(opcCHK)='1' THEN
- c_in(0) <= '1';
- END IF;
- opaddsub <= exec(addsub);
- END IF;
-
- IF opaddsub='0' OR long_start='1' THEN --ADD
- notaddsub_b <= '0'&addsub_b&c_in(0);
- ELSE --SUB
- notaddsub_b <= NOT ('0'&addsub_b&c_in(0));
- END IF;
- add_result <= (('0'&addsub_a¬addsub_b(0))+notaddsub_b);
- c_in(1) <= add_result(9) XOR addsub_a(8) XOR addsub_b(8);
- c_in(2) <= add_result(17) XOR addsub_a(16) XOR addsub_b(16);
- c_in(3) <= add_result(33);
- addsub_q <= add_result(32 downto 1);
- addsub_ofl(0) <= (c_in(1) XOR add_result(8) XOR addsub_a(7) XOR addsub_b(7)); --V Byte
- addsub_ofl(1) <= (c_in(2) XOR add_result(16) XOR addsub_a(15) XOR addsub_b(15)); --V Word
- addsub_ofl(2) <= (c_in(3) XOR add_result(32) XOR addsub_a(31) XOR addsub_b(31)); --V Long
- c_out <= c_in(3 downto 1);
- END PROCESS;
-
-------------------------------------------------------------------------------
---ALU
-------------------------------------------------------------------------------
-PROCESS (OP1out, OP2out, pack_a, niba_hc, niba_h, niba_l, niba_lc, nibs_hc, nibs_h, nibs_l, nibs_lc, Flags, exe_opcode)
- BEGIN
- IF exe_opcode(7 downto 6) = "01" THEN
- -- PACK
- pack_a <= std_logic_vector(unsigned(OP1out(15 downto 0))+unsigned(OP2out(15 downto 0)));
- pack_out <= "00000000" & pack_a(11 downto 8) & pack_a(3 downto 0);
- ELSE
- -- UNPK
- pack_a <= "0000" & OP2out(7 downto 4) & "0000" & OP2out(3 downto 0);
- pack_out <= std_logic_vector(unsigned(OP1out(15 downto 0))+unsigned(pack_a));
- END IF;
-
---BCD_ARITH-------------------------------------------------------------------
- --ADC
- bcd_a <= niba_hc&(niba_h(4 downto 1)+('0',niba_hc,niba_hc,'0'))&(niba_l(4 downto 1)+('0',niba_lc,niba_lc,'0'));
- niba_l <= ('0'&OP1out(3 downto 0)&'1') + ('0'&OP2out(3 downto 0)&Flags(4));
- niba_lc <= niba_l(5) OR (niba_l(4) AND niba_l(3)) OR (niba_l(4) AND niba_l(2));
-
- niba_h <= ('0'&OP1out(7 downto 4)&'1') + ('0'&OP2out(7 downto 4)&niba_lc);
- niba_hc <= niba_h(5) OR (niba_h(4) AND niba_h(3)) OR (niba_h(4) AND niba_h(2));
- --SBC
- bcd_s <= nibs_hc&(nibs_h(4 downto 1)-('0',nibs_hc,nibs_hc,'0'))&(nibs_l(4 downto 1)-('0',nibs_lc,nibs_lc,'0'));
- nibs_l <= ('0'&OP1out(3 downto 0)&'0') - ('0'&OP2out(3 downto 0)&Flags(4));
- nibs_lc <= nibs_l(5);
-
- nibs_h <= ('0'&OP1out(7 downto 4)&'0') - ('0'&OP2out(7 downto 4)&nibs_lc);
- nibs_hc <= nibs_h(5);
- END PROCESS;
-
------------------------------------------------------------------------------
--- Bits
------------------------------------------------------------------------------
-PROCESS (clk, exe_opcode, OP1out, OP2out, one_bit_in, bchg, bset, bit_Number, sndOPC, reg_QB)
- BEGIN
- IF rising_edge(clk) THEN
- IF clkena_lw = '1' THEN
- bchg <= '0';
- bset <= '0';
- CASE opcode(7 downto 6) IS
- WHEN "01" => --bchg
- bchg <= '1';
- WHEN "11" => --bset
- bset <= '1';
- WHEN OTHERS => NULL;
- END CASE;
- END IF;
- END IF;
-
- IF exe_opcode(8)='0' THEN
- IF exe_opcode(5 downto 4)="00" THEN
- bit_number <= sndOPC(4 downto 0);
- ELSE
- bit_number <= "00"&sndOPC(2 downto 0);
- END IF;
- ELSE
- IF exe_opcode(5 downto 4)="00" THEN
- bit_number <= reg_QB(4 downto 0);
- ELSE
- bit_number <= "00"®_QB(2 downto 0);
- END IF;
- END IF;
-
- one_bit_in <= OP1out(to_integer(unsigned(bit_Number)));
- bits_out <= OP1out;
- bits_out(to_integer(unsigned(bit_Number))) <= (bchg AND NOT one_bit_in) OR bset ;
- END PROCESS;
-
------------------------------------------------------------------------------
--- Bit Field
------------------------------------------------------------------------------
-PROCESS (clk, mux, mask, bitnr, bf_ins, bf_bchg, bf_bset, bf_exts, bf_shift, inmux0, inmux1, inmux2, inmux3, bf_set2, OP1out, OP2out, result_tmp, bf_ext_in,
- shift, datareg, bf_NFlag, result, reg_QB, sign, bf_d32, bf_s32, copy, bf_loffset, copymux0, copymux1, copymux2, copymux3, bf_width)
- BEGIN
- IF rising_edge(clk) THEN
- IF clkena_lw = '1' THEN
- bf_bset <= '0';
- bf_bchg <= '0';
- bf_ins <= '0';
- bf_exts <= '0';
- bf_fffo <= '0';
- bf_d32 <= '0';
- bf_s32 <= '0';
- CASE opcode(10 downto 8) IS
- WHEN "010" => bf_bchg <= '1'; --BFCHG
- WHEN "011" => bf_exts <= '1'; --BFEXTS
--- WHEN "100" => insert <= (OTHERS =>'0'); --BFCLR
- WHEN "101" => bf_fffo <= '1'; --BFFFO
- WHEN "110" => bf_bset <= '1'; --BFSET
- WHEN "111" => bf_ins <= '1'; --BFINS
- bf_s32 <= '1';
- WHEN OTHERS => NULL;
- END CASE;
- IF opcode(4 downto 3)="00" THEN
- bf_d32 <= '1';
- END IF;
- bf_ext_out <= result(39 downto 32);
- END IF;
- END IF;
- shift <= bf_ext_in&OP2out;
- IF bf_s32='1' THEN
- shift(39 downto 32) <= OP2out(7 downto 0);
- END IF;
-
- IF bf_shift(0)='1' THEN
- inmux0 <= shift(0)&shift(39 downto 1);
- ELSE
- inmux0 <= shift;
- END IF;
- IF bf_shift(1)='1' THEN
- inmux1 <= inmux0(1 downto 0)&inmux0(39 downto 2);
- ELSE
- inmux1 <= inmux0;
- END IF;
- IF bf_shift(2)='1' THEN
- inmux2 <= inmux1(3 downto 0)&inmux1(39 downto 4);
- ELSE
- inmux2 <= inmux1;
- END IF;
- IF bf_shift(3)='1' THEN
- inmux3 <= inmux2(7 downto 0)&inmux2(31 downto 8);
- ELSE
- inmux3 <= inmux2(31 downto 0);
- END IF;
- IF bf_shift(4)='1' THEN
- bf_set2(31 downto 0) <= inmux3(15 downto 0)&inmux3(31 downto 16);
- ELSE
- bf_set2(31 downto 0) <= inmux3;
- END IF;
-
- IF bf_loffset(4)='1' THEN
- copymux3 <= sign(15 downto 0)&sign(31 downto 16);
- ELSE
- copymux3 <= sign;
- END IF;
- IF bf_loffset(3)='1' THEN
- copymux2(31 downto 0) <= copymux3(23 downto 0)©mux3(31 downto 24);
- ELSE
- copymux2(31 downto 0) <= copymux3;
- END IF;
- IF bf_d32='1' THEN
- copymux2(39 downto 32) <= copymux3(7 downto 0);
- ELSE
- copymux2(39 downto 32) <= "11111111";
- END IF;
- IF bf_loffset(2)='1' THEN
- copymux1 <= copymux2(35 downto 0)©mux2(39 downto 36);
- ELSE
- copymux1 <= copymux2;
- END IF;
- IF bf_loffset(1)='1' THEN
- copymux0 <= copymux1(37 downto 0)©mux1(39 downto 38);
- ELSE
- copymux0 <= copymux1;
- END IF;
- IF bf_loffset(0)='1' THEN
- copy <= copymux0(38 downto 0)©mux0(39);
- ELSE
- copy <= copymux0;
- END IF;
-
- result_tmp <= bf_ext_in&OP1out;
- IF bf_ins='1' THEN
- datareg <= reg_QB;
- ELSE
- datareg <= bf_set2;
- END IF;
- IF bf_ins='1' THEN
- result(31 downto 0) <= bf_set2;
- result(39 downto 32) <= bf_set2(7 downto 0);
- ELSIF bf_bchg='1' THEN
- result(31 downto 0) <= NOT OP1out;
- result(39 downto 32) <= NOT bf_ext_in;
- ELSE
- result <= (OTHERS => '0');
- END IF;
- IF bf_bset='1' THEN
- result <= (OTHERS => '1');
- END IF;
-
- sign <= (OTHERS => '0');
- bf_NFlag <= datareg(to_integer(unsigned(bf_width)));
- FOR i in 0 to 31 LOOP
- IF i>bf_width(4 downto 0) THEN
- datareg(i) <= '0';
- sign(i) <= '1';
- END IF;
- END LOOP;
-
- FOR i in 0 to 39 LOOP
- IF copy(i)='1' THEN
- result(i) <= result_tmp(i);
- END IF;
- END LOOP;
-
- IF bf_exts='1' AND bf_NFlag='1' THEN
- bf_datareg <= datareg OR sign;
- ELSE
- bf_datareg <= datareg;
- END IF;
--- bf_datareg <= copy(31 downto 0);
--- result(31 downto 0)<=datareg;
---BFFFO
- mask <= datareg;
- bf_firstbit <= '0'&bitnr;
- bitnr <= "11111";
- IF mask(31 downto 28)="0000" THEN
- IF mask(27 downto 24)="0000" THEN
- IF mask(23 downto 20)="0000" THEN
- IF mask(19 downto 16)="0000" THEN
- bitnr(4) <= '0';
- IF mask(15 downto 12)="0000" THEN
- IF mask(11 downto 8)="0000" THEN
- bitnr(3) <= '0';
- IF mask(7 downto 4)="0000" THEN
- bitnr(2) <= '0';
- mux <= mask(3 downto 0);
- ELSE
- mux <= mask(7 downto 4);
- END IF;
- ELSE
- mux <= mask(11 downto 8);
- bitnr(2) <= '0';
- END IF;
- ELSE
- mux <= mask(15 downto 12);
- END IF;
- ELSE
- mux <= mask(19 downto 16);
- bitnr(3) <= '0';
- bitnr(2) <= '0';
- END IF;
- ELSE
- mux <= mask(23 downto 20);
- bitnr(3) <= '0';
- END IF;
- ELSE
- mux <= mask(27 downto 24);
- bitnr(2) <= '0';
- END IF;
- ELSE
- mux <= mask(31 downto 28);
- END IF;
-
- IF mux(3 downto 2)="00" THEN
- bitnr(1) <= '0';
- IF mux(1)='0' THEN
- bitnr(0) <= '0';
- END IF;
- ELSE
- IF mux(3)='0' THEN
- bitnr(0) <= '0';
- END IF;
- END IF;
- END PROCESS;
-
------------------------------------------------------------------------------
--- Rotation
------------------------------------------------------------------------------
-PROCESS (exe_opcode, OP1out, Flags, rot_bits, rot_msb, rot_lsb, rot_rot, exec)
- BEGIN
- CASE exe_opcode(7 downto 6) IS
- WHEN "00" => --Byte
- rot_rot <= OP1out(7);
- WHEN "01"|"11" => --Word
- rot_rot <= OP1out(15);
- WHEN "10" => --Long
- rot_rot <= OP1out(31);
- WHEN OTHERS => NULL;
- END CASE;
-
- CASE rot_bits IS
- WHEN "00" => --ASL, ASR
- rot_lsb <= '0';
- rot_msb <= rot_rot;
- WHEN "01" => --LSL, LSR
- rot_lsb <= '0';
- rot_msb <= '0';
- WHEN "10" => --ROXL, ROXR
- rot_lsb <= Flags(4);
- rot_msb <= Flags(4);
- WHEN "11" => --ROL, ROR
- rot_lsb <= rot_rot;
- rot_msb <= OP1out(0);
- WHEN OTHERS => NULL;
- END CASE;
-
- IF exec(rot_nop)='1' THEN
- rot_out <= OP1out;
- rot_X <= Flags(4);
- IF rot_bits="10" THEN --ROXL, ROXR
- rot_C <= Flags(4);
- ELSE
- rot_C <= '0';
- END IF;
- ELSE
- IF exe_opcode(8)='1' THEN --left
- rot_out <= OP1out(30 downto 0)&rot_lsb;
- rot_X <= rot_rot;
- rot_C <= rot_rot;
- ELSE --right
- rot_X <= OP1out(0);
- rot_C <= OP1out(0);
- rot_out <= rot_msb&OP1out(31 downto 1);
- CASE exe_opcode(7 downto 6) IS
- WHEN "00" => --Byte
- rot_out(7) <= rot_msb;
- WHEN "01"|"11" => --Word
- rot_out(15) <= rot_msb;
- WHEN OTHERS => NULL;
- END CASE;
- END IF;
- END IF;
- END PROCESS;
-
-------------------------------------------------------------------------------
---CCR op
-------------------------------------------------------------------------------
-PROCESS (clk, Reset, exe_opcode, exe_datatype, Flags, last_data_read, OP2out, flag_z, OP1IN, c_out, addsub_ofl,
- bcd_s, bcd_a, exec)
- BEGIN
- IF exec(andiSR)='1' THEN
- CCRin <= Flags AND last_data_read(7 downto 0);
- ELSIF exec(eoriSR)='1' THEN
- CCRin <= Flags XOR last_data_read(7 downto 0);
- ELSIF exec(oriSR)='1' THEN
- CCRin <= Flags OR last_data_read(7 downto 0);
- ELSE
- CCRin <= OP2out(7 downto 0);
- END IF;
-
-------------------------------------------------------------------------------
---Flags
-------------------------------------------------------------------------------
- flag_z <= "000";
- IF exec(use_XZFlag)='1' AND flags(2)='0' THEN
- flag_z <= "000";
- ELSIF OP1in(7 downto 0)="00000000" THEN
- flag_z(0) <= '1';
- IF OP1in(15 downto 8)="00000000" THEN
- flag_z(1) <= '1';
- IF OP1in(31 downto 16)="0000000000000000" THEN
- flag_z(2) <= '1';
- END IF;
- END IF;
- END IF;
-
--- --Flags NZVC
- IF exe_datatype="00" THEN --Byte
- set_flags <= OP1IN(7)&flag_z(0)&addsub_ofl(0)&c_out(0);
- IF exec(opcABCD)='1' THEN
- set_flags(0) <= bcd_a(8);
- ELSIF exec(opcSBCD)='1' THEN
- set_flags(0) <= bcd_s(8);
- END IF;
- ELSIF exe_datatype="10" OR exec(opcCPMAW)='1' THEN --Long
- set_flags <= OP1IN(31)&flag_z(2)&addsub_ofl(2)&c_out(2);
- ELSE --Word
- set_flags <= OP1IN(15)&flag_z(1)&addsub_ofl(1)&c_out(1);
- END IF;
-
- IF rising_edge(clk) THEN
- IF clkena_lw = '1' THEN
- IF exec(directSR)='1' OR set_stop='1' THEN
- Flags(7 downto 0) <= data_read(7 downto 0);
- END IF;
- IF exec(directCCR)='1' THEN
- Flags(7 downto 0) <= data_read(7 downto 0);
- END IF;
-
- IF exec(opcROT)='1' THEN
- asl_VFlag <= ((set_flags(3) XOR rot_rot) OR asl_VFlag);
- ELSE
- asl_VFlag <= '0';
- END IF;
- IF exec(to_CCR)='1' THEN
- Flags(7 downto 0) <= CCRin(7 downto 0); --CCR
- ELSIF Z_error='1' THEN
- IF exe_opcode(8)='0' THEN
- Flags(3 downto 0) <= reg_QA(31)&"000";
- ELSE
- Flags(3 downto 0) <= "0100";
- END IF;
- ELSIF exec(no_Flags)='0' THEN
- IF exec(opcADD)='1' THEN
- Flags(4) <= set_flags(0);
- ELSIF exec(opcROT)='1' AND rot_bits/="11" AND exec(rot_nop)='0' THEN
- Flags(4) <= rot_X;
- END IF;
-
- IF (exec(opcADD) OR exec(opcCMP))='1' THEN
- Flags(3 downto 0) <= set_flags;
- ELSIF exec(opcDIVU)='1' AND DIV_Mode/=3 THEN
- IF V_Flag='1' THEN
- Flags(3 downto 0) <= "1010";
- ELSE
- Flags(3 downto 0) <= OP1IN(15)&flag_z(1)&"00";
- END IF;
- ELSIF exec(write_reminder)='1' AND MUL_Mode/=3 THEN -- z-flag MULU.l
- Flags(3) <= set_flags(3);
- Flags(2) <= set_flags(2) AND Flags(2);
- Flags(1) <= '0';
- Flags(0) <= '0';
- ELSIF exec(write_lowlong)='1' AND (MUL_Mode=1 OR MUL_Mode=2) THEN -- flag MULU.l
- Flags(3) <= set_flags(3);
- Flags(2) <= set_flags(2);
- Flags(1) <= set_mV_Flag; --V
- Flags(0) <= '0';
- ELSIF exec(opcOR)='1' OR exec(opcAND)='1' OR exec(opcEOR)='1' OR exec(opcMOVE)='1' OR exec(opcMOVEQ)='1' OR exec(opcSWAP)='1' OR exec(opcBF)='1' OR (exec(opcMULU)='1' AND MUL_Mode/=3) THEN
- Flags(1 downto 0) <= "00";
- Flags(3 downto 2) <= set_flags(3 downto 2);
- IF exec(opcBF)='1' THEN
- Flags(3) <= bf_NFlag;
- END IF;
- ELSIF exec(opcROT)='1' THEN
- Flags(3 downto 2) <= set_flags(3 downto 2);
- Flags(0) <= rot_C;
- IF rot_bits="00" AND ((set_flags(3) XOR rot_rot) OR asl_VFlag)='1' THEN --ASL/ASR
- Flags(1) <= '1';
- ELSE
- Flags(1) <= '0';
- END IF;
- ELSIF exec(opcBITS)='1' THEN
- Flags(2) <= NOT one_bit_in;
- ELSIF exec(opcCHK)='1' THEN
- IF exe_datatype="01" THEN --Word
- Flags(3) <= OP1out(15);
- ELSE
- Flags(3) <= OP1out(31);
- END IF;
- IF OP1out(15 downto 0)=X"0000" AND (exe_datatype="01" OR OP1out(31 downto 16)=X"0000") THEN
- Flags(2) <='1';
- ELSE
- Flags(2) <='0';
- END IF;
- Flags(1 downto 0) <= "00";
- END IF;
- END IF;
- END IF;
- Flags(7 downto 5) <= "000";
- END IF;
- END PROCESS;
-
--------------------------------------------------------------------------------
----- MULU/MULS
--------------------------------------------------------------------------------
-PROCESS (exe_opcode, OP2out, muls_msb, mulu_reg, FAsign, mulu_sign, reg_QA, faktorB, result_mulu, signedOP)
- BEGIN
- IF (signedOP='1' AND faktorB(31)='1') OR FAsign='1' THEN
- muls_msb <= mulu_reg(63);
- ELSE
- muls_msb <= '0';
- END IF;
-
- IF signedOP='1' AND faktorB(31)='1' THEN
- mulu_sign <= '1';
- ELSE
- mulu_sign <= '0';
- END IF;
-
- IF MUL_Mode=0 THEN -- 16 Bit
- result_mulu(63 downto 32) <= muls_msb&mulu_reg(63 downto 33);
- result_mulu(15 downto 0) <= 'X'&mulu_reg(15 downto 1);
- IF mulu_reg(0)='1' THEN
- IF FAsign='1' THEN
- result_mulu(63 downto 47) <= (muls_msb&mulu_reg(63 downto 48)-(mulu_sign&faktorB(31 downto 16)));
- ELSE
- result_mulu(63 downto 47) <= (muls_msb&mulu_reg(63 downto 48)+(mulu_sign&faktorB(31 downto 16)));
- END IF;
- END IF;
- ELSE -- 32 Bit
- result_mulu <= muls_msb&mulu_reg(63 downto 1);
- IF mulu_reg(0)='1' THEN
- IF FAsign='1' THEN
- result_mulu(63 downto 31) <= (muls_msb&mulu_reg(63 downto 32)-(mulu_sign&faktorB));
- ELSE
- result_mulu(63 downto 31) <= (muls_msb&mulu_reg(63 downto 32)+(mulu_sign&faktorB));
- END IF;
- END IF;
- END IF;
- IF exe_opcode(15)='1' OR MUL_Mode=0 THEN
- faktorB(31 downto 16) <= OP2out(15 downto 0);
- faktorB(15 downto 0) <= (OTHERS=>'0');
- ELSE
- faktorB <= OP2out;
- END IF;
- IF (result_mulu(63 downto 32)=X"00000000" AND (signedOP='0' OR result_mulu(31)='0')) OR
- (result_mulu(63 downto 32)=X"FFFFFFFF" AND signedOP='1' AND result_mulu(31)='1') THEN
- set_mV_Flag <= '0';
- ELSE
- set_mV_Flag <= '1';
- END IF;
- END PROCESS;
-
-PROCESS (clk)
- BEGIN
- IF rising_edge(clk) THEN
- IF clkena_lw='1' THEN
- IF micro_state=mul1 THEN
- mulu_reg(63 downto 32) <= (OTHERS=>'0');
- IF divs='1' AND ((exe_opcode(15)='1' AND reg_QA(15)='1') OR (exe_opcode(15)='0' AND reg_QA(31)='1')) THEN --MULS Neg faktor
- FAsign <= '1';
- mulu_reg(31 downto 0) <= 0-reg_QA;
- ELSE
- FAsign <= '0';
- mulu_reg(31 downto 0) <= reg_QA;
- END IF;
- ELSIF exec(opcMULU)='0' THEN
- mulu_reg <= result_mulu;
- END IF;
- END IF;
- END IF;
- END PROCESS;
-
--------------------------------------------------------------------------------
----- DIVU/DIVS
--------------------------------------------------------------------------------
-
-PROCESS (execOPC, OP1out, OP2out, div_reg, div_neg, div_bit, div_sub, div_quot, OP1_sign, div_over, result_div, reg_QA, opcode, sndOPC, divs, exe_opcode, reg_QB,
- signedOP, nozero, div_qsign, OP2outext)
- BEGIN
- divs <= (opcode(15) AND opcode(8)) OR (NOT opcode(15) AND sndOPC(11));
- divisor(15 downto 0) <= (OTHERS=> '0');
- divisor(63 downto 32) <= (OTHERS=> divs AND reg_QA(31));
- IF exe_opcode(15)='1' OR DIV_Mode=0 THEN
- divisor(47 downto 16) <= reg_QA;
- ELSE
- divisor(31 downto 0) <= reg_QA;
- IF exe_opcode(14)='1' AND sndOPC(10)='1' THEN
- divisor(63 downto 32) <= reg_QB;
- END IF;
- END IF;
- IF signedOP='1' OR opcode(15)='0' THEN
- OP2outext <= OP2out(31 downto 16);
- ELSE
- OP2outext <= (OTHERS=> '0');
- END IF;
- IF signedOP='1' AND OP2out(31) ='1' THEN
- div_sub <= (div_reg(63 downto 31))+('1'&OP2out(31 downto 0));
- ELSE
- div_sub <= (div_reg(63 downto 31))-('0'&OP2outext(15 downto 0)&OP2out(15 downto 0));
- END IF;
- IF DIV_Mode=0 THEN
- div_bit <= div_sub(16);
- ELSE
- div_bit <= div_sub(32);
- END IF;
- IF div_bit='1' THEN
- div_quot(63 downto 32) <= div_reg(62 downto 31);
- ELSE
- div_quot(63 downto 32) <= div_sub(31 downto 0);
- END IF;
- div_quot(31 downto 0) <= div_reg(30 downto 0)&NOT div_bit;
-
-
- IF ((nozero='1' AND signedOP='1' AND (OP2out(31) XOR OP1_sign XOR div_neg XOR div_qsign)='1' ) --Overflow DIVS
- OR (signedOP='0' AND div_over(32)='0')) AND DIV_Mode/=3 THEN --Overflow DIVU
- set_V_Flag <= '1';
- ELSE
- set_V_Flag <= '0';
- END IF;
- END PROCESS;
-
-PROCESS (clk)
- BEGIN
- IF rising_edge(clk) THEN
- IF clkena_lw='1' THEN
- V_Flag <= set_V_Flag;
- signedOP <= divs;
- IF micro_state=div1 THEN
- nozero <= '0';
- IF divs='1' AND divisor(63)='1' THEN -- Neg divisor
- OP1_sign <= '1';
- div_reg <= 0-divisor;
- ELSE
- OP1_sign <= '0';
- div_reg <= divisor;
- END IF;
- ELSE
- div_reg <= div_quot;
- nozero <= NOT div_bit OR nozero;
- END IF;
- IF micro_state=div2 THEN
- div_qsign <= NOT div_bit;
- div_neg <= signedOP AND (OP2out(31) XOR OP1_sign);
- IF DIV_Mode=0 THEN
- div_over(32 downto 16) <= ('0'&div_reg(47 downto 32))-('0'&OP2out(15 downto 0));
- ELSE
- div_over <= ('0'&div_reg(63 downto 32))-('0'&OP2out);
- END IF;
- END IF;
- IF exec(write_reminder)='0' THEN
--- IF exec_DIVU='0' THEN
- IF div_neg='1' THEN
- result_div(31 downto 0) <= 0-div_quot(31 downto 0);
- ELSE
- result_div(31 downto 0) <= div_quot(31 downto 0);
- END IF;
-
- IF OP1_sign='1' THEN
- result_div(63 downto 32) <= 0-div_quot(63 downto 32);
- ELSE
- result_div(63 downto 32) <= div_quot(63 downto 32);
- END IF;
- END IF;
- END IF;
- END IF;
- END PROCESS;
-END;
+------------------------------------------------------------------------------
+------------------------------------------------------------------------------
+-- --
+-- Copyright (c) 2009-2020 Tobias Gubener --
+-- Patches by MikeJ, Till Harbaum, Rok Krajnk, ... --
+-- Subdesign fAMpIGA by TobiFlex --
+-- --
+-- This source file is free software: you can redistribute it and/or modify --
+-- it under the terms of the GNU Lesser General Public License as published --
+-- by the Free Software Foundation, either version 3 of the License, or --
+-- (at your option) any later version. --
+-- --
+-- This source file is distributed in the hope that it will be useful, --
+-- but WITHOUT ANY WARRANTY; without even the implied warranty of --
+-- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the --
+-- GNU General Public License for more details. --
+-- --
+-- You should have received a copy of the GNU General Public License --
+-- along with this program. If not, see . --
+-- --
+------------------------------------------------------------------------------
+------------------------------------------------------------------------------
+
+library ieee;
+use ieee.std_logic_1164.all;
+use ieee.std_logic_unsigned.all;
+use IEEE.numeric_std.all;
+use work.TG68K_Pack.all;
+
+entity TG68K_ALU is
+generic(
+ MUL_Mode : integer; --0=>16Bit, 1=>32Bit, 2=>switchable with CPU(1), 3=>no MUL,
+ MUL_Hardware : integer; --0=>no, 1=>yes,
+ DIV_Mode : integer; --0=>16Bit, 1=>32Bit, 2=>switchable with CPU(1), 3=>no DIV,
+ BarrelShifter :integer --0=>no, 1=>yes, 2=>switchable with CPU(1)
+ );
+ port(clk : in std_logic;
+ Reset : in std_logic;
+ clkena_lw : in std_logic:='1';
+ CPU : in std_logic_vector(1 downto 0):="00"; -- 00->68000 01->68010 11->68020(only some parts - yet)
+ execOPC : in bit;
+ decodeOPC : in bit;
+ exe_condition : in std_logic;
+ exec_tas : in std_logic;
+ long_start : in bit;
+ non_aligned : in std_logic;
+ movem_presub : in bit;
+ set_stop : in bit;
+ Z_error : in bit;
+ rot_bits : in std_logic_vector(1 downto 0);
+ exec : in bit_vector(lastOpcBit downto 0);
+ OP1out : in std_logic_vector(31 downto 0);
+ OP2out : in std_logic_vector(31 downto 0);
+ reg_QA : in std_logic_vector(31 downto 0);
+ reg_QB : in std_logic_vector(31 downto 0);
+ opcode : in std_logic_vector(15 downto 0);
+ exe_opcode : in std_logic_vector(15 downto 0);
+ exe_datatype : in std_logic_vector(1 downto 0);
+ sndOPC : in std_logic_vector(15 downto 0);
+ last_data_read : in std_logic_vector(15 downto 0);
+ data_read : in std_logic_vector(15 downto 0);
+ FlagsSR : in std_logic_vector(7 downto 0);
+ micro_state : in micro_states;
+ bf_ext_in : in std_logic_vector(7 downto 0);
+ bf_ext_out : out std_logic_vector(7 downto 0);
+ bf_shift : in std_logic_vector(5 downto 0);
+ bf_width : in std_logic_vector(5 downto 0);
+ bf_ffo_offset : in std_logic_vector(31 downto 0);
+ bf_loffset : in std_logic_vector(4 downto 0);
+
+ set_V_Flag : buffer bit;
+ Flags : buffer std_logic_vector(7 downto 0);
+ c_out : buffer std_logic_vector(2 downto 0);
+ addsub_q : buffer std_logic_vector(31 downto 0);
+ ALUout : out std_logic_vector(31 downto 0)
+ );
+end TG68K_ALU;
+
+architecture logic of TG68K_ALU is
+-----------------------------------------------------------------------------
+-----------------------------------------------------------------------------
+-- ALU and more
+-----------------------------------------------------------------------------
+-----------------------------------------------------------------------------
+ signal OP1in : std_logic_vector(31 downto 0);
+ signal addsub_a : std_logic_vector(31 downto 0);
+ signal addsub_b : std_logic_vector(31 downto 0);
+ signal notaddsub_b : std_logic_vector(33 downto 0);
+ signal add_result : std_logic_vector(33 downto 0);
+ signal addsub_ofl : std_logic_vector(2 downto 0);
+ signal opaddsub : bit;
+ signal c_in : std_logic_vector(3 downto 0);
+ signal flag_z : std_logic_vector(2 downto 0);
+ signal set_Flags : std_logic_vector(3 downto 0); --NZVC
+ signal CCRin : std_logic_vector(7 downto 0);
+ signal last_Flags1 : std_logic_vector(3 downto 0); --NZVC
+
+--BCD
+ signal bcd_pur : std_logic_vector(9 downto 0);
+ signal bcd_kor : std_logic_vector(8 downto 0);
+ signal halve_carry : std_logic;
+ signal Vflag_a : std_logic;
+ signal bcd_a_carry : std_logic;
+ signal bcd_a : std_logic_vector(8 downto 0);
+ signal result_mulu : std_logic_vector(127 downto 0);
+ signal result_div : std_logic_vector(63 downto 0);
+ signal result_div_pre : std_logic_vector(31 downto 0);
+ signal set_mV_Flag : std_logic;
+ signal V_Flag : bit;
+
+ signal rot_rot : std_logic;
+ signal rot_lsb : std_logic;
+ signal rot_msb : std_logic;
+ signal rot_X : std_logic;
+ signal rot_C : std_logic;
+ signal rot_out : std_logic_vector(31 downto 0);
+ signal asl_VFlag : std_logic;
+ signal bit_bits : std_logic_vector(1 downto 0);
+ signal bit_number : std_logic_vector(4 downto 0);
+ signal bits_out : std_logic_vector(31 downto 0);
+ signal one_bit_in : std_logic;
+ signal bchg : std_logic;
+ signal bset : std_logic;
+
+ signal mulu_sign : std_logic;
+ signal mulu_signext : std_logic_vector(16 downto 0);
+ signal muls_msb : std_logic;
+ signal mulu_reg : std_logic_vector(63 downto 0);
+ signal FAsign : std_logic;
+ signal faktorA : std_logic_vector(31 downto 0);
+ signal faktorB : std_logic_vector(31 downto 0);
+
+ signal div_reg : std_logic_vector(63 downto 0);
+ signal div_quot : std_logic_vector(63 downto 0);
+ signal div_ovl : std_logic;
+ signal div_neg : std_logic;
+ signal div_bit : std_logic;
+ signal div_sub : std_logic_vector(32 downto 0);
+ signal div_over : std_logic_vector(32 downto 0);
+ signal nozero : std_logic;
+ signal div_qsign : std_logic;
+ signal dividend : std_logic_vector(63 downto 0);
+ signal divs : std_logic;
+ signal signedOP : std_logic;
+ signal OP1_sign : std_logic;
+ signal OP2_sign : std_logic;
+ signal OP2outext : std_logic_vector(15 downto 0);
+
+ signal in_offset : std_logic_vector(5 downto 0);
+ signal datareg : std_logic_vector(31 downto 0);
+ signal insert : std_logic_vector(31 downto 0);
+ signal bf_datareg : std_logic_vector(31 downto 0);
+ signal result : std_logic_vector(39 downto 0);
+ signal result_tmp : std_logic_vector(39 downto 0);
+ signal unshifted_bitmask: std_logic_vector(31 downto 0);
+ signal bf_set1 : std_logic_vector(39 downto 0);
+ signal inmux0 : std_logic_vector(39 downto 0);
+ signal inmux1 : std_logic_vector(39 downto 0);
+ signal inmux2 : std_logic_vector(39 downto 0);
+ signal inmux3 : std_logic_vector(31 downto 0);
+ signal shifted_bitmask : std_logic_vector(39 downto 0);
+ signal bitmaskmux0 : std_logic_vector(37 downto 0);
+ signal bitmaskmux1 : std_logic_vector(35 downto 0);
+ signal bitmaskmux2 : std_logic_vector(31 downto 0);
+ signal bitmaskmux3 : std_logic_vector(31 downto 0);
+ signal bf_set2 : std_logic_vector(31 downto 0);
+ signal shift : std_logic_vector(39 downto 0);
+ signal bf_firstbit : std_logic_vector(5 downto 0);
+ signal mux : std_logic_vector(3 downto 0);
+ signal bitnr : std_logic_vector(4 downto 0);
+ signal mask : std_logic_vector(31 downto 0);
+ signal mask_not_zero : std_logic;
+ signal bf_bset : std_logic;
+ signal bf_NFlag : std_logic;
+ signal bf_bchg : std_logic;
+ signal bf_ins : std_logic;
+ signal bf_exts : std_logic;
+ signal bf_fffo : std_logic;
+ signal bf_d32 : std_logic;
+ signal bf_s32 : std_logic;
+ signal index : std_logic_vector(4 downto 0);
+-- signal i : integer range 0 to 31;
+-- signal i : integer range 0 to 31;
+-- signal i : std_logic_vector(5 downto 0);
+
+ signal hot_msb : std_logic_vector(33 downto 0);
+ signal vector : std_logic_vector(32 downto 0);
+ signal result_bs : std_logic_vector(65 downto 0);
+ signal bit_nr : std_logic_vector(5 downto 0);
+ signal bit_msb : std_logic_vector(5 downto 0);
+ signal bs_shift : std_logic_vector(5 downto 0);
+ signal bs_shift_mod : std_logic_vector(5 downto 0);
+ signal asl_over : std_logic_vector(32 downto 0);
+ signal asl_over_xor : std_logic_vector(32 downto 0);
+ signal asr_sign : std_logic_vector(32 downto 0);
+ signal msb : std_logic;
+ signal ring : std_logic_vector(5 downto 0);
+ signal ALU : std_logic_vector(31 downto 0);
+ signal BSout : std_logic_vector(31 downto 0);
+ signal bs_V : std_logic;
+ signal bs_C : std_logic;
+ signal bs_X : std_logic;
+
+
+BEGIN
+-----------------------------------------------------------------------------
+-- set OP1in
+-----------------------------------------------------------------------------
+PROCESS (OP2out, reg_QB, opcode, OP1out, OP1in, exe_datatype, addsub_q, execOPC, exec,
+ bcd_a, result_mulu, result_div, exe_condition, bf_shift, bf_ffo_offset, mulu_reg, BSout,
+ Flags, FlagsSR, bits_out, exec_tas, rot_out, exe_opcode, result, bf_fffo, bf_firstbit, bf_datareg)
+ BEGIN
+ ALUout <= OP1in;
+ ALUout(7) <= OP1in(7) OR exec_tas;
+ IF exec(opcBFwb)='1' THEN
+ ALUout <= result(31 downto 0);
+ IF bf_fffo='1' THEN
+ ALUout <= bf_ffo_offset - bf_firstbit;
+ END IF;
+ END IF;
+
+ OP1in <= addsub_q;
+ IF exec(opcABCD)='1' OR exec(opcSBCD)='1' THEN
+ OP1in(7 downto 0) <= bcd_a(7 downto 0);
+ ELSIF exec(opcMULU)='1' AND MUL_Mode/=3 THEN
+ IF MUL_Hardware=0 THEN
+ IF exec(write_lowlong)='1' AND (MUL_Mode=1 OR MUL_Mode=2) THEN
+ OP1in <= result_mulu(31 downto 0);
+ ELSE
+ OP1in <= result_mulu(63 downto 32);
+ END IF;
+ ELSE
+ IF exec(write_lowlong)='1' THEN --AND (MUL_Mode=1 OR MUL_Mode=2) THEN
+ OP1in <= result_mulu(31 downto 0);
+ ELSE
+-- OP1in <= result_mulu(63 downto 32);
+ OP1in <= mulu_reg(31 downto 0);
+ END IF;
+ END IF;
+ ELSIF exec(opcDIVU)='1' AND DIV_Mode/=3 THEN
+ IF exe_opcode(15)='1' OR DIV_Mode=0 THEN
+-- IF exe_opcode(15)='1' THEN
+ OP1in <= result_div(47 downto 32)&result_div(15 downto 0); --word
+ ELSE --64bit
+ IF exec(write_reminder)='1' THEN
+ OP1in <= result_div(63 downto 32);
+ ELSE
+ OP1in <= result_div(31 downto 0);
+ END IF;
+ END IF;
+ ELSIF exec(opcOR)='1' THEN
+ OP1in <= OP2out OR OP1out;
+ ELSIF exec(opcAND)='1' THEN
+ OP1in <= OP2out AND OP1out;
+ ELSIF exec(opcScc)='1' THEN
+ OP1in(7 downto 0) <= (others=>exe_condition);
+ ELSIF exec(opcEOR)='1' THEN
+ OP1in <= OP2out XOR OP1out;
+-- ELSIF exec(alu_move)='1' OR exec(exg)='1' THEN
+ ELSIF exec(alu_move)='1' THEN
+-- OP1in <= OP2out(31 downto 8)&(OP2out(7)OR exec_tas)&OP2out(6 downto 0);
+ OP1in <= OP2out;
+ ELSIF exec(opcROT)='1' THEN
+ OP1in <= rot_out;
+ ELSIF exec(exec_BS)='1' THEN
+ OP1in <= BSout;
+ ELSIF exec(opcSWAP)='1' THEN
+ OP1in <= OP1out(15 downto 0)& OP1out(31 downto 16);
+ ELSIF exec(opcBITS)='1' THEN
+ OP1in <= bits_out;
+ ELSIF exec(opcBF)='1' THEN
+ OP1in <= bf_datareg; --new bitfieldvector for bfins - for others the old bitfieldvector
+ ELSIF exec(opcMOVESR)='1' THEN
+ OP1in(7 downto 0) <= Flags;
+ IF exe_opcode(9)='1' THEN
+ OP1in(15 downto 8) <= "00000000";
+ ELSE
+ OP1in(15 downto 8) <= FlagsSR;
+ END IF;
+ ELSIF exec(opcPACK)='1' THEN
+ OP1in(7 downto 0) <= addsub_q(11 downto 8) & addsub_q(3 downto 0);
+ END IF;
+ END PROCESS;
+
+-----------------------------------------------------------------------------
+-- addsub
+-----------------------------------------------------------------------------
+PROCESS (OP1out, OP2out, execOPC, Flags, long_start, movem_presub, exe_datatype, exec, addsub_a, addsub_b, opaddsub,
+ notaddsub_b, add_result, c_in, sndOPC, non_aligned)
+ BEGIN
+ addsub_a <= OP1out;
+ IF exec(get_bfoffset)='1' THEN
+ IF sndOPC(11)='1' THEN
+ addsub_a <= OP1out(31)&OP1out(31)&OP1out(31)&OP1out(31 downto 3);
+ ELSE
+ addsub_a <= "000000000000000000000000000000"&sndOPC(10 downto 9);
+ END IF;
+ END IF;
+
+ IF exec(subidx)='1' THEN
+ opaddsub <= '1';
+ ELSE
+ opaddsub <= '0';
+ END IF;
+
+ c_in(0) <='0';
+ addsub_b <= OP2out;
+ IF exec(opcUNPACK)='1' THEN
+ addsub_b(15 downto 0) <= "0000" & OP2out(7 downto 4) & "0000" & OP2out(3 downto 0);
+ ELSIF execOPC='0' AND exec(OP2out_one)='0' AND exec(get_bfoffset)='0'THEN
+ IF long_start='0' AND exe_datatype="00" AND exec(use_SP)='0' THEN
+ addsub_b <= "00000000000000000000000000000001";
+ ELSIF long_start='0' AND exe_datatype="10" AND (exec(presub) OR exec(postadd) OR movem_presub)='1' THEN
+ IF exec(movem_action)='1' THEN
+ addsub_b <= "00000000000000000000000000000110";
+ ELSE
+ addsub_b <= "00000000000000000000000000000100";
+ END IF;
+ ELSE
+ addsub_b <= "00000000000000000000000000000010";
+ END IF;
+ ELSE
+ IF (exec(use_XZFlag)='1' AND Flags(4)='1') OR exec(opcCHK)='1' THEN
+ c_in(0) <= '1';
+ END IF;
+ opaddsub <= exec(addsub);
+ END IF;
+
+ -- patch for un-aligned movem --mikej
+ if (exec(movem_action) = '1') then
+ if (movem_presub = '0') then -- up
+ if (non_aligned = '1') and (long_start = '0') then -- hold
+ addsub_b <= (others => '0');
+ end if;
+ else
+ if (non_aligned = '1') and (long_start = '0') then
+ if (exe_datatype = "10") then
+ addsub_b <= "00000000000000000000000000001000";
+ else
+ addsub_b <= "00000000000000000000000000000100";
+ end if;
+ end if;
+ end if;
+ end if;
+
+ IF opaddsub='0' OR long_start='1' THEN --ADD
+ notaddsub_b <= '0'&addsub_b&c_in(0);
+ ELSE --SUB
+ notaddsub_b <= NOT ('0'&addsub_b&c_in(0));
+ END IF;
+ add_result <= (('0'&addsub_a¬addsub_b(0))+notaddsub_b);
+ c_in(1) <= add_result(9) XOR addsub_a(8) XOR addsub_b(8);
+ c_in(2) <= add_result(17) XOR addsub_a(16) XOR addsub_b(16);
+ c_in(3) <= add_result(33);
+ addsub_q <= add_result(32 downto 1);
+ addsub_ofl(0) <= (c_in(1) XOR add_result(8) XOR addsub_a(7) XOR addsub_b(7)); --V Byte
+ addsub_ofl(1) <= (c_in(2) XOR add_result(16) XOR addsub_a(15) XOR addsub_b(15)); --V Word
+ addsub_ofl(2) <= (c_in(3) XOR add_result(32) XOR addsub_a(31) XOR addsub_b(31)); --V Long
+ c_out <= c_in(3 downto 1);
+ END PROCESS;
+
+------------------------------------------------------------------------------
+--ALU
+------------------------------------------------------------------------------
+PROCESS (OP1out, OP2out, CPU, exec, add_result, bcd_pur, bcd_a, bcd_kor, halve_carry, c_in)
+ BEGIN
+--BCD_ARITH-------------------------------------------------------------------
+--04.04.2017 by Tobiflex - BCD handling with all undefined behavior!
+ bcd_pur <= c_in(1)&add_result(8 downto 0);
+ bcd_kor <= "000000000";
+ halve_carry <= OP1out(4) XOR OP2out(4) XOR bcd_pur(5);
+ IF halve_carry='1' THEN
+ bcd_kor(3 downto 0) <= "0110"; -- -6
+ END IF;
+ IF bcd_pur(9)='1' THEN
+ bcd_kor(7 downto 4) <= "0110"; -- -60
+ END IF;
+ IF exec(opcABCD)='1' THEN
+ Vflag_a <= NOT bcd_pur(8) AND bcd_a(7);
+-- bcd_pur <= ('0'&OP1out(7 downto 0)&'1') + ('0'&OP2out(7 downto 0)&Flags(4));
+ bcd_a <= bcd_pur(9 downto 1) + bcd_kor;
+ IF (bcd_pur(4) AND (bcd_pur(3) OR bcd_pur(2)))='1' THEN
+ bcd_kor(3 downto 0) <= "0110"; -- +6
+ END IF;
+ IF (bcd_pur(8) AND (bcd_pur(7) OR bcd_pur(6) OR (bcd_pur(5) AND bcd_pur(4) AND (bcd_pur(3) OR bcd_pur(2)))))='1' THEN
+ bcd_kor(7 downto 4) <= "0110"; -- +60
+ END IF;
+ ELSE --opcSBCD
+ Vflag_a <= bcd_pur(8) AND NOT bcd_a(7);
+-- bcd_pur <= ('0'&OP1out(7 downto 0)&'0') - ('0'&OP2out(7 downto 0)&Flags(4));
+ bcd_a <= bcd_pur(9 downto 1) - bcd_kor;
+ END IF;
+ IF cpu(1)='1' THEN
+ Vflag_a <= '0'; --68020
+ END IF;
+ bcd_a_carry <= bcd_pur(9) OR bcd_a(8);
+ END PROCESS;
+
+-----------------------------------------------------------------------------
+-- Bits
+-----------------------------------------------------------------------------
+PROCESS (clk, exe_opcode, OP1out, OP2out, reg_QB, one_bit_in, bchg, bset, bit_Number, sndOPC)
+ BEGIN
+ IF rising_edge(clk) THEN
+ IF clkena_lw = '1' THEN
+ bchg <= '0';
+ bset <= '0';
+ CASE opcode(7 downto 6) IS
+ WHEN "01" => --bchg
+ bchg <= '1';
+ WHEN "11" => --bset
+ bset <= '1';
+ WHEN OTHERS => NULL;
+ END CASE;
+ END IF;
+ END IF;
+
+ IF exe_opcode(8)='0' THEN
+ IF exe_opcode(5 downto 4)="00" THEN
+ bit_number <= sndOPC(4 downto 0);
+ ELSE
+ bit_number <= "00"&sndOPC(2 downto 0);
+ END IF;
+ ELSE
+ IF exe_opcode(5 downto 4)="00" THEN
+ bit_number <= reg_QB(4 downto 0);
+ ELSE
+ bit_number <= "00"®_QB(2 downto 0);
+ END IF;
+ END IF;
+
+ one_bit_in <= OP1out(conv_integer(bit_Number));
+ bits_out <= OP1out;
+ bits_out(conv_integer(bit_Number)) <= (bchg AND NOT one_bit_in) OR bset ;
+ END PROCESS;
+
+-----------------------------------------------------------------------------
+-- Bit Field
+-----------------------------------------------------------------------------
+
+PROCESS (clk, mux, mask, bitnr, bf_ins, bf_bchg, bf_bset, bf_exts, bf_shift, inmux0, inmux1, inmux2, inmux3, bf_set2, OP1out, OP2out,
+ result_tmp, bf_ext_in, mask_not_zero, exec, shift, datareg, bf_NFlag, result, reg_QB, unshifted_bitmask, bf_d32, bf_s32,
+ shifted_bitmask, bf_loffset, bitmaskmux0, bitmaskmux1, bitmaskmux2, bitmaskmux3, bf_width)
+ BEGIN
+ IF rising_edge(clk) THEN
+ IF clkena_lw = '1' THEN
+ bf_bset <= '0';
+ bf_bchg <= '0';
+ bf_ins <= '0';
+ bf_exts <= '0';
+ bf_fffo <= '0';
+ bf_d32 <= '0';
+ bf_s32 <= '0';
+-- 000-bftst, 001-bfextu, 010-bfchg, 011-bfexts, 100-bfclr, 101-bfff0, 110-bfset, 111-bfins
+ IF opcode(5 downto 4) ="00" THEN
+ bf_s32 <= '1';
+ END IF;
+ CASE opcode(10 downto 8) IS
+ WHEN "010" => bf_bchg <= '1'; --BFCHG
+ WHEN "011" => bf_exts <= '1'; --BFEXTS
+-- WHEN "100" => insert <= (OTHERS =>'0'); --BFCLR
+ WHEN "101" => bf_fffo <= '1'; --BFFFO
+ WHEN "110" => bf_bset <= '1'; --BFSET
+ WHEN "111" => bf_ins <= '1'; --BFINS
+ bf_s32 <= '1';
+ WHEN OTHERS => NULL;
+ END CASE;
+ IF opcode(4 downto 3)="00" THEN
+ bf_d32 <= '1';
+ END IF;
+ bf_ext_out <= result(39 downto 32);
+ END IF;
+ END IF;
+
+ IF bf_ins='1' THEN
+ datareg <= reg_QB;
+ ELSE
+ datareg <= bf_set2;
+ END IF;
+
+
+-- create bitmask for operation
+-- unshifted bitmask '0' => bit is in the Bitfieldvector
+-- '1' => bit isn't in the Bitfieldvector
+-- Example bf_with=11 => "11111111 11111111 11111000 00000000"
+-- datareg
+ unshifted_bitmask <= (OTHERS => '0');
+ FOR i in 0 to 31 LOOP
+ IF i>bf_width(4 downto 0) THEN
+ datareg(i) <= '0';
+ unshifted_bitmask(i) <= '1';
+ END IF;
+ END LOOP;
+
+ bf_NFlag <= datareg(conv_integer(bf_width));
+ IF bf_exts='1' AND bf_NFlag='1' THEN
+ bf_datareg <= datareg OR unshifted_bitmask;
+ ELSE
+ bf_datareg <= datareg;
+ END IF;
+
+-- shift bitmask for operation
+ IF bf_loffset(4)='1' THEN
+ bitmaskmux3 <= unshifted_bitmask(15 downto 0)&unshifted_bitmask(31 downto 16);
+ ELSE
+ bitmaskmux3 <= unshifted_bitmask;
+ END IF;
+ IF bf_loffset(3)='1' THEN
+ bitmaskmux2(31 downto 0) <= bitmaskmux3(23 downto 0)&bitmaskmux3(31 downto 24);
+ ELSE
+ bitmaskmux2(31 downto 0) <= bitmaskmux3;
+ END IF;
+ IF bf_loffset(2)='1' THEN
+ bitmaskmux1 <= bitmaskmux2&"1111";
+ IF bf_d32='1' THEN
+ bitmaskmux1(3 downto 0) <= bitmaskmux2(31 downto 28);
+ END IF;
+ ELSE
+ bitmaskmux1 <= "1111"&bitmaskmux2;
+ END IF;
+ IF bf_loffset(1)='1' THEN
+ bitmaskmux0 <= bitmaskmux1&"11";
+ IF bf_d32='1' THEN
+ bitmaskmux0(1 downto 0) <= bitmaskmux1(31 downto 30);
+ END IF;
+ ELSE
+ bitmaskmux0 <= "11"&bitmaskmux1;
+ END IF;
+ IF bf_loffset(0)='1' THEN
+ shifted_bitmask <= '1'&bitmaskmux0&'1';
+ IF bf_d32='1' THEN
+ shifted_bitmask(0) <= bitmaskmux0(31);
+ END IF;
+ ELSE
+ shifted_bitmask <= "11"&bitmaskmux0;
+ END IF;
+
+
+-- shift for ins
+ shift <= bf_ext_in&OP2out;
+ IF bf_s32='1' THEN
+ shift(39 downto 32) <= OP2out(7 downto 0);
+ END IF;
+
+ IF bf_shift(0)='1' THEN
+ inmux0 <= shift(0)&shift(39 downto 1);
+ ELSE
+ inmux0 <= shift;
+ END IF;
+ IF bf_shift(1)='1' THEN
+ inmux1 <= inmux0(1 downto 0)&inmux0(39 downto 2);
+ ELSE
+ inmux1 <= inmux0;
+ END IF;
+ IF bf_shift(2)='1' THEN
+ inmux2 <= inmux1(3 downto 0)&inmux1(39 downto 4);
+ ELSE
+ inmux2 <= inmux1;
+ END IF;
+ IF bf_shift(3)='1' THEN
+ inmux3 <= inmux2(7 downto 0)&inmux2(31 downto 8);
+ ELSE
+ inmux3 <= inmux2(31 downto 0);
+ END IF;
+ IF bf_shift(4)='1' THEN
+ bf_set2(31 downto 0) <= inmux3(15 downto 0)&inmux3(31 downto 16);
+ ELSE
+ bf_set2(31 downto 0) <= inmux3;
+ END IF;
+
+ IF bf_ins='1' THEN
+ result(31 downto 0) <= bf_set2;
+ result(39 downto 32) <= bf_set2(7 downto 0);
+ ELSIF bf_bchg='1' THEN
+ result(31 downto 0) <= NOT OP2out;
+ result(39 downto 32) <= NOT bf_ext_in;
+ ELSE
+ result <= (OTHERS => '0');
+ END IF;
+ IF bf_bset='1' THEN
+ result <= (OTHERS => '1');
+ END IF;
+--
+ IF bf_ins='1' THEN
+ result_tmp <= bf_ext_in&OP1out;
+ ELSE
+ result_tmp <= bf_ext_in&OP2out;
+ END IF;
+ FOR i in 0 to 39 LOOP
+ IF shifted_bitmask(i)='1' THEN
+ result(i) <= result_tmp(i); --restore old data
+ END IF;
+ END LOOP;
+
+--BFFFO
+ mask <= datareg;
+ bf_firstbit <= ('0'&bitnr)+mask_not_zero;
+ bitnr <= "11111";
+ mask_not_zero <= '1';
+ IF mask(31 downto 28)="0000" THEN
+ IF mask(27 downto 24)="0000" THEN
+ IF mask(23 downto 20)="0000" THEN
+ IF mask(19 downto 16)="0000" THEN
+ bitnr(4) <= '0';
+ IF mask(15 downto 12)="0000" THEN
+ IF mask(11 downto 8)="0000" THEN
+ bitnr(3) <= '0';
+ IF mask(7 downto 4)="0000" THEN
+ bitnr(2) <= '0';
+ mux <= mask(3 downto 0);
+ ELSE
+ mux <= mask(7 downto 4);
+ END IF;
+ ELSE
+ mux <= mask(11 downto 8);
+ bitnr(2) <= '0';
+ END IF;
+ ELSE
+ mux <= mask(15 downto 12);
+ END IF;
+ ELSE
+ mux <= mask(19 downto 16);
+ bitnr(3) <= '0';
+ bitnr(2) <= '0';
+ END IF;
+ ELSE
+ mux <= mask(23 downto 20);
+ bitnr(3) <= '0';
+ END IF;
+ ELSE
+ mux <= mask(27 downto 24);
+ bitnr(2) <= '0';
+ END IF;
+ ELSE
+ mux <= mask(31 downto 28);
+ END IF;
+
+ IF mux(3 downto 2)="00" THEN
+ bitnr(1) <= '0';
+ IF mux(1)='0' THEN
+ bitnr(0) <= '0';
+ IF mux(0)='0' THEN
+ mask_not_zero <= '0';
+ END IF;
+ END IF;
+ ELSE
+ IF mux(3)='0' THEN
+ bitnr(0) <= '0';
+ END IF;
+ END IF;
+ END PROCESS;
+
+-----------------------------------------------------------------------------
+-- Rotation
+-----------------------------------------------------------------------------
+PROCESS (exe_opcode, OP1out, Flags, rot_bits, rot_msb, rot_lsb, rot_rot, exec, BSout)
+ BEGIN
+ CASE exe_opcode(7 downto 6) IS
+ WHEN "00" => --Byte
+ rot_rot <= OP1out(7);
+ WHEN "01"|"11" => --Word
+ rot_rot <= OP1out(15);
+ WHEN "10" => --Long
+ rot_rot <= OP1out(31);
+ WHEN OTHERS => NULL;
+ END CASE;
+
+ CASE rot_bits IS
+ WHEN "00" => --ASL, ASR
+ rot_lsb <= '0';
+ rot_msb <= rot_rot;
+ WHEN "01" => --LSL, LSR
+ rot_lsb <= '0';
+ rot_msb <= '0';
+ WHEN "10" => --ROXL, ROXR
+ rot_lsb <= Flags(4);
+ rot_msb <= Flags(4);
+ WHEN "11" => --ROL, ROR
+ rot_lsb <= rot_rot;
+ rot_msb <= OP1out(0);
+ WHEN OTHERS => NULL;
+ END CASE;
+
+ IF exec(rot_nop)='1' THEN
+ rot_out <= OP1out;
+ rot_X <= Flags(4);
+ IF rot_bits="10" THEN --ROXL, ROXR
+ rot_C <= Flags(4);
+ ELSE
+ rot_C <= '0';
+ END IF;
+ ELSE
+ IF exe_opcode(8)='1' THEN --left
+ rot_out <= OP1out(30 downto 0)&rot_lsb;
+ rot_X <= rot_rot;
+ rot_C <= rot_rot;
+ ELSE --right
+ rot_X <= OP1out(0);
+ rot_C <= OP1out(0);
+ rot_out <= rot_msb&OP1out(31 downto 1);
+ CASE exe_opcode(7 downto 6) IS
+ WHEN "00" => --Byte
+ rot_out(7) <= rot_msb;
+ WHEN "01"|"11" => --Word
+ rot_out(15) <= rot_msb;
+ WHEN OTHERS => NULL;
+ END CASE;
+ END IF;
+ IF BarrelShifter/=0 THEN
+ rot_out <= BSout;
+ END IF;
+ END IF;
+ END PROCESS;
+
+-----------------------------------------------------------------------------
+-- Barrel Shifter
+-----------------------------------------------------------------------------
+process (OP1out, OP2out, opcode, bit_nr, bit_msb, bs_shift, bs_shift_mod, ring, result_bs, exe_opcode, vector,
+ rot_bits, Flags, bs_C, msb, hot_msb, asl_over, asl_over_xor, ALU, asr_sign, exec)
+ begin
+ ring <= "100000";
+ IF rot_bits="10" THEN --ROX L/R
+ CASE exe_opcode(7 downto 6) IS
+ WHEN "00" => --Byte
+ ring <= "001001";
+ WHEN "01"|"11" => --Word
+ ring <= "010001";
+ WHEN "10" => --Long
+ ring <= "100001";
+ WHEN OTHERS => NULL;
+ END CASE;
+ ELSE
+ CASE exe_opcode(7 downto 6) IS
+ WHEN "00" => --Byte
+ ring <= "001000";
+ WHEN "01"|"11" => --Word
+ ring <= "010000";
+ WHEN "10" => --Long
+ ring <= "100000";
+ WHEN OTHERS => NULL;
+ END CASE;
+ END IF;
+
+ IF exe_opcode(7 downto 6)="11" OR exec(exec_BS)='0' THEN
+ bs_shift <="000001";
+ ELSIF exe_opcode(5)='1' THEN
+ bs_shift <= OP2out(5 downto 0);
+ ELSE
+ bs_shift(2 downto 0) <= exe_opcode(11 downto 9);
+ IF exe_opcode(11 downto 9)="000" THEN
+ bs_shift(5 downto 3) <="001";
+ ELSE
+ bs_shift(5 downto 3) <="000";
+ END IF;
+ END IF;
+
+-- calc V-Flag by ASL
+ bit_msb <= "000000";
+ hot_msb <= (OTHERS =>'0');
+ hot_msb(conv_integer(bit_msb)) <= '1';
+ IF bs_shift < ring THEN
+ bit_msb <= ring-bs_shift;
+ END IF;
+ asl_over_xor <= (('0'&vector(30 downto 0)) XOR ('0'&vector(31 downto 1)))&msb;
+ CASE exe_opcode(7 downto 6) IS
+ WHEN "00" => --Byte
+ asl_over_xor(8) <= '0';
+ WHEN "01"|"11" => --Word
+ asl_over_xor(16) <= '0';
+ WHEN OTHERS => NULL;
+ END CASE;
+ asl_over <= asl_over_xor - ('0'&hot_msb(31 downto 0));
+ bs_V <= '0';
+ IF rot_bits="00" AND exe_opcode(8)='1' THEN --ASL
+ bs_V <= not asl_over(32);
+ END IF;
+
+ bs_X <= bs_C;
+ IF exe_opcode(8)='0' THEN --right shift
+ bs_C <= result_bs(31);
+ ELSE --left shift
+ CASE exe_opcode(7 downto 6) IS
+ WHEN "00" => --Byte
+ bs_C <= result_bs(8);
+ WHEN "01"|"11" => --Word
+ bs_C <= result_bs(16);
+ WHEN "10" => --Long
+ bs_C <= result_bs(32);
+ WHEN OTHERS => NULL;
+ END CASE;
+ END IF;
+
+ ALU <= (others=>'-');
+ IF rot_bits="11" THEN --RO L/R
+ bs_X <= Flags(4);
+ CASE exe_opcode(7 downto 6) IS
+ WHEN "00" => --Byte
+ ALU(7 downto 0) <= result_bs(7 downto 0) OR result_bs(15 downto 8);
+ bs_C <= ALU(7);
+ WHEN "01"|"11" => --Word
+ ALU(15 downto 0) <= result_bs(15 downto 0) OR result_bs(31 downto 16);
+ bs_C <= ALU(15);
+ WHEN "10" => --Long
+ ALU <= result_bs(31 downto 0) OR result_bs(63 downto 32);
+ bs_C <= ALU(31);
+ WHEN OTHERS => NULL;
+ END CASE;
+ IF exe_opcode(8)='1' THEN --left shift
+ bs_C <= ALU(0);
+ END IF;
+ ELSIF rot_bits="10" THEN --ROX L/R
+ CASE exe_opcode(7 downto 6) IS
+ WHEN "00" => --Byte
+ ALU(7 downto 0) <= result_bs(7 downto 0) OR result_bs(16 downto 9);
+ bs_C <= result_bs(8) OR result_bs(17);
+ WHEN "01"|"11" => --Word
+ ALU(15 downto 0) <= result_bs(15 downto 0) OR result_bs(32 downto 17);
+ bs_C <= result_bs(16) OR result_bs(33);
+ WHEN "10" => --Long
+ ALU <= result_bs(31 downto 0) OR result_bs(64 downto 33);
+ bs_C <= result_bs(32) OR result_bs(65);
+ WHEN OTHERS => NULL;
+ END CASE;
+ ELSE
+ IF exe_opcode(8)='0' THEN --right shift
+ ALU <= result_bs(63 downto 32);
+ ELSE --left shift
+ ALU <= result_bs(31 downto 0);
+ END IF;
+ END IF;
+
+ IF(bs_shift = "000000") THEN
+ IF rot_bits="10" THEN --ROX L/R
+ bs_C <= Flags(4);
+ ELSE
+ bs_C <= '0';
+ END IF;
+ bs_X <= Flags(4);
+ bs_V <= '0';
+ END IF;
+
+-- calc shift count
+ bs_shift_mod <= std_logic_vector(unsigned(bs_shift) rem unsigned(ring));
+ bit_nr <= bs_shift_mod(5 downto 0);
+ IF exe_opcode(8)='0' THEN --right shift
+ bit_nr <= ring-bs_shift_mod;
+ END IF;
+ IF rot_bits(1)='0' THEN --only shift
+ IF exe_opcode(8)='0' THEN --right shift
+ bit_nr <= 32-bs_shift_mod;
+ END IF;
+ IF bs_shift = ring THEN
+ IF exe_opcode(8)='0' THEN --right shift
+ bit_nr <= 32-ring;
+ ELSE
+ bit_nr <= ring;
+ END IF;
+ END IF;
+ IF bs_shift > ring THEN
+ IF exe_opcode(8)='0' THEN --right shift
+ bit_nr <= "000000";
+ bs_C <= '0';
+ ELSE
+ bit_nr <= ring+1;
+ END IF;
+ END IF;
+ END IF;
+
+-- calc ASR sign
+ BSout <= ALU;
+ asr_sign <= (OTHERS =>'0');
+ asr_sign(32 downto 1) <= asr_sign(31 downto 0) OR hot_msb(31 downto 0);
+ IF rot_bits="00" AND exe_opcode(8)='0' AND msb='1' THEN --ASR
+ BSout <= ALU or asr_sign(32 downto 1);
+ IF bs_shift > ring THEN
+ bs_C <= '1';
+ END IF;
+ END IF;
+
+ vector(32 downto 0) <= '0'&OP1out;
+ CASE exe_opcode(7 downto 6) IS
+ WHEN "00" => --Byte
+ msb <= OP1out(7);
+ vector(31 downto 8) <= X"000000";
+ BSout(31 downto 8) <= X"000000";
+ IF rot_bits="10" THEN --ROX L/R
+ vector(8) <= Flags(4);
+ END IF;
+ WHEN "01"|"11" => --Word
+ msb <= OP1out(15);
+ vector(31 downto 16) <= X"0000";
+ BSout(31 downto 16) <= X"0000";
+ IF rot_bits="10" THEN --ROX L/R
+ vector(16) <= Flags(4);
+ END IF;
+ WHEN "10" => --Long
+ msb <= OP1out(31);
+ IF rot_bits="10" THEN --ROX L/R
+ vector(32) <= Flags(4);
+ END IF;
+ WHEN OTHERS => NULL;
+ END CASE;
+ result_bs <= std_logic_vector(unsigned('0'&X"00000000"&vector) sll to_integer(unsigned(bit_nr(5 downto 0))));
+
+ end process;
+
+
+------------------------------------------------------------------------------
+--CCR op
+------------------------------------------------------------------------------
+PROCESS (clk, Reset, exe_opcode, exe_datatype, Flags, last_data_read, OP2out, flag_z, OP1IN, c_out, addsub_ofl,
+ bcd_a, bcd_a_carry, Vflag_a, exec)
+ BEGIN
+ IF exec(andiSR)='1' THEN
+ CCRin <= Flags AND last_data_read(7 downto 0);
+ ELSIF exec(eoriSR)='1' THEN
+ CCRin <= Flags XOR last_data_read(7 downto 0);
+ ELSIF exec(oriSR)='1' THEN
+ CCRin <= Flags OR last_data_read(7 downto 0);
+ ELSE
+ CCRin <= OP2out(7 downto 0);
+ END IF;
+
+------------------------------------------------------------------------------
+--Flags
+------------------------------------------------------------------------------
+ flag_z <= "000";
+ IF exec(use_XZFlag)='1' AND flags(2)='0' THEN
+ flag_z <= "000";
+ ELSIF OP1in(7 downto 0)="00000000" THEN
+ flag_z(0) <= '1';
+ IF OP1in(15 downto 8)="00000000" THEN
+ flag_z(1) <= '1';
+ IF OP1in(31 downto 16)="0000000000000000" THEN
+ flag_z(2) <= '1';
+ END IF;
+ END IF;
+ END IF;
+
+-- --Flags NZVC
+ IF exe_datatype="00" THEN --Byte
+ set_flags <= OP1IN(7)&flag_z(0)&addsub_ofl(0)&c_out(0);
+ IF exec(opcABCD)='1' OR exec(opcSBCD)='1' THEN
+ set_flags(0) <= bcd_a_carry;
+ set_flags(1) <= Vflag_a;
+ END IF;
+ ELSIF exe_datatype="10" OR exec(opcCPMAW)='1' THEN --Long
+ set_flags <= OP1IN(31)&flag_z(2)&addsub_ofl(2)&c_out(2);
+ ELSE --Word
+ set_flags <= OP1IN(15)&flag_z(1)&addsub_ofl(1)&c_out(1);
+ END IF;
+
+ IF rising_edge(clk) THEN
+ IF Reset='1' THEN
+ Flags(7 downto 0) <= "00000000";
+ ELSIF clkena_lw = '1' THEN
+ IF exec(directSR)='1' OR set_stop='1' THEN
+ Flags(7 downto 0) <= data_read(7 downto 0);
+ END IF;
+ IF exec(directCCR)='1' THEN
+ Flags(7 downto 0) <= data_read(7 downto 0);
+ END IF;
+
+ IF exec(opcROT)='1' AND decodeOPC='0' THEN
+ asl_VFlag <= ((set_flags(3) XOR rot_rot) OR asl_VFlag);
+ ELSE
+ asl_VFlag <= '0';
+ END IF;
+ IF exec(to_CCR)='1' THEN
+ Flags(7 downto 0) <= CCRin(7 downto 0); --CCR
+ ELSIF Z_error='1' THEN
+ IF exe_opcode(8)='0' THEN
+-- Flags(3 downto 0) <= reg_QA(31)&"000";
+ Flags(3 downto 0) <= '0'&NOT reg_QA(31)&"00";
+ ELSE
+ Flags(3 downto 0) <= "0100";
+ END IF;
+ ELSIF exec(no_Flags)='0' THEN
+ last_Flags1 <= Flags(3 downto 0);
+ IF exec(opcADD)='1' THEN
+ Flags(4) <= set_flags(0);
+ ELSIF exec(opcROT)='1' AND rot_bits/="11" AND exec(rot_nop)='0' THEN
+ Flags(4) <= rot_X;
+ ELSIF exec(exec_BS)='1' THEN
+ Flags(4) <= BS_X;
+ END IF;
+
+ IF (exec(opcCMP) OR exec(alu_setFlags))='1' THEN
+ Flags(3 downto 0) <= set_flags;
+ ELSIF exec(opcDIVU)='1' AND DIV_Mode/=3 THEN
+ IF V_Flag='1' THEN
+ Flags(3 downto 0) <= "1010";
+ ELSIF exe_opcode(15)='1' OR DIV_Mode=0 THEN
+ Flags(3 downto 0) <= OP1IN(15)&flag_z(1)&"00";
+ ELSE
+ Flags(3 downto 0) <= OP1IN(31)&flag_z(2)&"00";
+ END IF;
+ ELSIF exec(write_reminder)='1' AND MUL_Mode/=3 THEN -- z-flag MULU.l
+ Flags(3) <= set_flags(3);
+ Flags(2) <= set_flags(2) AND Flags(2);
+ Flags(1) <= '0';
+ Flags(0) <= '0';
+ ELSIF exec(write_lowlong)='1' AND (MUL_Mode=1 OR MUL_Mode=2) THEN -- flag MULU.l
+ Flags(3) <= set_flags(3);
+ Flags(2) <= set_flags(2);
+ Flags(1) <= set_mV_Flag; --V
+ Flags(0) <= '0';
+ ELSIF exec(opcOR)='1' OR exec(opcAND)='1' OR exec(opcEOR)='1' OR exec(opcMOVE)='1' OR exec(opcMOVEQ)='1' OR exec(opcSWAP)='1' OR exec(opcBF)='1' OR (exec(opcMULU)='1' AND MUL_Mode/=3) THEN
+ Flags(1 downto 0) <= "00";
+ Flags(3 downto 2) <= set_flags(3 downto 2);
+ IF exec(opcBF)='1' THEN
+ Flags(3) <= bf_NFlag;
+ END IF;
+ ELSIF exec(opcROT)='1' THEN
+ Flags(3 downto 2) <= set_flags(3 downto 2);
+ Flags(0) <= rot_C;
+ IF rot_bits="00" AND ((set_flags(3) XOR rot_rot) OR asl_VFlag)='1' THEN --ASL/ASR
+ Flags(1) <= '1';
+ ELSE
+ Flags(1) <= '0';
+ END IF;
+ ELSIF exec(exec_BS)='1' THEN
+ Flags(3 downto 2) <= set_flags(3 downto 2);
+ Flags(0) <= BS_C;
+ Flags(1) <= BS_V;
+ ELSIF exec(opcBITS)='1' THEN
+ Flags(2) <= NOT one_bit_in;
+ ELSIF exec(opcCHK2)='1' THEN
+ Flags(0) <= '0';
+ Flags(2) <= Flags(2) OR set_flags(2);
+----lower bound first
+ IF last_Flags1(0)='0' THEN --unsigned OP
+ Flags(0) <= Flags(0) OR (NOT set_flags(0) AND NOT set_flags(2));
+ ELSE --signed OP
+ Flags(0) <= (Flags(3) AND NOT Flags(1)) OR (NOT Flags(3) AND Flags(1)) OR --LT
+ (set_flags(3) AND set_flags(1) AND NOT set_flags(2)) OR (NOT set_flags(3) AND NOT set_flags(1) AND NOT set_flags(2)); --GT
+ END IF;
+ ELSIF exec(opcCHK)='1' THEN
+ IF exe_datatype="01" THEN --Word
+ Flags(3) <= OP1out(15);
+ ELSE
+ Flags(3) <= OP1out(31);
+ END IF;
+ IF OP1out(15 downto 0)=X"0000" AND (exe_datatype="01" OR OP1out(31 downto 16)=X"0000") THEN
+ Flags(2) <='1';
+ ELSE
+ Flags(2) <='0';
+ END IF;
+ Flags(1) <= '0';
+ Flags(0) <= '0';
+ END IF;
+ END IF;
+ END IF;
+ Flags(7 downto 5) <= "000";
+ END IF;
+ END PROCESS;
+
+---------------------------------------------------------------------------------
+------ MULU/MULS
+---------------------------------------------------------------------------------
+PROCESS (exe_opcode, OP2out, muls_msb, mulu_reg, FAsign, mulu_sign, reg_QA, faktorA, faktorB, result_mulu, signedOP)
+--PROCESS (exec, reg_QA, OP2out, faktorA, faktorB, signedOP)
+ BEGIN
+ IF MUL_Hardware=1 THEN
+-- IF exe_opcode(15)='1' OR MUL_Mode=0 THEN -- 16 Bit
+ IF MUL_Mode=0 THEN -- 16 Bit
+ IF signedOP='1' AND reg_QA(15)='1' THEN
+ faktorA <= X"FFFFFFFF";
+ ELSE
+ faktorA <= X"00000000";
+ END IF;
+ IF signedOP='1' AND OP2out(15)='1' THEN
+ faktorB <= X"FFFFFFFF";
+ ELSE
+ faktorB <= X"00000000";
+ END IF;
+ result_mulu(63 downto 0) <= (faktorA(15 downto 0) & reg_QA(15 downto 0)) * (faktorB(15 downto 0) & OP2out(15 downto 0));
+ ELSE
+ IF exe_opcode(15)='1' THEN -- 16 Bit
+ IF signedOP='1' AND reg_QA(15)='1' THEN
+ faktorA <= X"FFFFFFFF";
+ ELSE
+ faktorA <= X"00000000";
+ END IF;
+ IF signedOP='1' AND OP2out(15)='1' THEN
+ faktorB <= X"FFFFFFFF";
+ ELSE
+ faktorB <= X"00000000";
+ END IF;
+ ELSE
+ faktorA(15 downto 0) <= reg_QA(31 downto 16);
+ faktorB(15 downto 0) <= OP2out(31 downto 16);
+ IF signedOP='1' AND reg_QA(31)='1' THEN
+ faktorA(31 downto 16) <= X"FFFF";
+ ELSE
+ faktorA(31 downto 16) <= X"0000";
+ END IF;
+ IF signedOP='1' AND OP2out(31)='1' THEN
+ faktorB(31 downto 16) <= X"FFFF";
+ ELSE
+ faktorB(31 downto 16) <= X"0000";
+ END IF;
+ END IF;
+ result_mulu(127 downto 0) <= (faktorA(31 downto 16) & faktorA(31 downto 0) & reg_QA(15 downto 0)) * (faktorB(31 downto 16) & faktorB(31 downto 0) & OP2out(15 downto 0));
+ END IF;
+-- END PROCESS;
+-------------------------------------------------------------------------------
+---- MULU/MULS
+-------------------------------------------------------------------------------
+--PROCESS (exe_opcode, OP2out, muls_msb, mulu_reg, FAsign, mulu_sign, reg_QA, faktorB, result_mulu, signedOP)
+-- BEGIN
+ ELSE
+ IF (signedOP='1' AND faktorB(31)='1') OR FAsign='1' THEN
+ muls_msb <= mulu_reg(63);
+ ELSE
+ muls_msb <= '0';
+ END IF;
+
+ IF signedOP='1' AND faktorB(31)='1' THEN
+ mulu_sign <= '1';
+ ELSE
+ mulu_sign <= '0';
+ END IF;
+
+ IF MUL_Mode=0 THEN -- 16 Bit
+ result_mulu(63 downto 32) <= muls_msb&mulu_reg(63 downto 33);
+ result_mulu(15 downto 0) <= 'X'&mulu_reg(15 downto 1);
+ IF mulu_reg(0)='1' THEN
+ IF FAsign='1' THEN
+ result_mulu(63 downto 47) <= (muls_msb&mulu_reg(63 downto 48)-(mulu_sign&faktorB(31 downto 16)));
+ ELSE
+ result_mulu(63 downto 47) <= (muls_msb&mulu_reg(63 downto 48)+(mulu_sign&faktorB(31 downto 16)));
+ END IF;
+ END IF;
+ ELSE -- 32 Bit
+ result_mulu(63 downto 0) <= muls_msb&mulu_reg(63 downto 1);
+ IF mulu_reg(0)='1' THEN
+ IF FAsign='1' THEN
+ result_mulu(63 downto 31) <= (muls_msb&mulu_reg(63 downto 32)-(mulu_sign&faktorB));
+ ELSE
+ result_mulu(63 downto 31) <= (muls_msb&mulu_reg(63 downto 32)+(mulu_sign&faktorB));
+ END IF;
+ END IF;
+ END IF;
+ IF exe_opcode(15)='1' OR MUL_Mode=0 THEN
+ faktorB(31 downto 16) <= OP2out(15 downto 0);
+ faktorB(15 downto 0) <= (OTHERS=>'0');
+ ELSE
+ faktorB <= OP2out;
+ END IF;
+ END IF;
+ IF (result_mulu(63 downto 32)=X"00000000" AND (signedOP='0' OR result_mulu(31)='0')) OR
+ (result_mulu(63 downto 32)=X"FFFFFFFF" AND signedOP='1' AND result_mulu(31)='1') THEN
+ set_mV_Flag <= '0';
+ ELSE
+ set_mV_Flag <= '1';
+ END IF;
+ END PROCESS;
+
+PROCESS (clk)
+ BEGIN
+ IF rising_edge(clk) THEN
+ IF clkena_lw='1' THEN
+ IF MUL_Hardware=0 THEN
+ IF micro_state=mul1 THEN
+ mulu_reg(63 downto 32) <= (OTHERS=>'0');
+ IF divs='1' AND ((exe_opcode(15)='1' AND reg_QA(15)='1') OR (exe_opcode(15)='0' AND reg_QA(31)='1')) THEN --MULS Neg faktor
+ FAsign <= '1';
+ mulu_reg(31 downto 0) <= 0-reg_QA;
+ ELSE
+ FAsign <= '0';
+ mulu_reg(31 downto 0) <= reg_QA;
+ END IF;
+ ELSIF exec(opcMULU)='0' THEN
+ mulu_reg <= result_mulu(63 downto 0);
+ END IF;
+ ELSE
+ mulu_reg(31 downto 0) <= result_mulu(63 downto 32);
+ END IF;
+ END IF;
+ END IF;
+ END PROCESS;
+
+-------------------------------------------------------------------------------
+---- DIVU/DIVS
+-------------------------------------------------------------------------------
+
+PROCESS (execOPC, OP1out, OP2out, div_reg, div_neg, div_bit, div_sub, div_quot, OP1_sign, div_over, result_div, reg_QA, opcode, sndOPC, divs, exe_opcode, reg_QB,
+ signedOP, nozero, div_qsign, OP2outext, result_div_pre)
+ BEGIN
+ divs <= (opcode(15) AND opcode(8)) OR (NOT opcode(15) AND sndOPC(11));
+ dividend(15 downto 0) <= (OTHERS=> '0');
+ dividend(63 downto 32) <= (OTHERS=> divs AND reg_QA(31));
+ IF exe_opcode(15)='1' OR DIV_Mode=0 THEN --DIV.W
+ dividend(47 downto 16) <= reg_QA;
+ div_qsign <= result_div_pre(15);
+ ELSE --DIV.l
+ dividend(31 downto 0) <= reg_QA;
+ IF exe_opcode(14)='1' AND sndOPC(10)='1' THEN
+ dividend(63 downto 32) <= reg_QB;
+ END IF;
+ div_qsign <= result_div_pre(31);
+ END IF;
+ IF signedOP='1' OR opcode(15)='0' THEN
+ OP2outext <= OP2out(31 downto 16);
+ ELSE
+ OP2outext <= (OTHERS=> '0');
+ END IF;
+ IF signedOP='1' AND OP2out(31) ='1' THEN
+ div_sub <= (div_reg(63 downto 31))+('1'&OP2out(31 downto 0));
+ ELSE
+ div_sub <= (div_reg(63 downto 31))-('0'&OP2outext(15 downto 0)&OP2out(15 downto 0));
+ END IF;
+ IF DIV_Mode=0 THEN
+ div_bit <= div_sub(16);
+ ELSE
+ div_bit <= div_sub(32);
+ END IF;
+ IF div_bit='1' THEN
+ div_quot(63 downto 32) <= div_reg(62 downto 31);
+ ELSE
+ div_quot(63 downto 32) <= div_sub(31 downto 0);
+ END IF;
+ div_quot(31 downto 0) <= div_reg(30 downto 0)&NOT div_bit;
+
+ IF div_neg='1' THEN
+ result_div_pre(31 downto 0) <= 0-div_quot(31 downto 0);
+
+ ELSE
+ result_div_pre(31 downto 0) <= div_quot(31 downto 0);
+ END IF;
+
+ IF (((nozero='1' OR div_bit='0') AND signedOP='1' AND (OP2out(31) XOR OP1_sign XOR div_qsign)='1' ) --Overflow DIVS
+ OR (signedOP='0' AND div_over(32)='0')) AND DIV_Mode/=3 THEN --Overflow DIVU
+ set_V_Flag <= '1';
+ ELSE
+ set_V_Flag <= '0';
+ END IF;
+ END PROCESS;
+
+PROCESS (clk)
+ BEGIN
+ IF rising_edge(clk) THEN
+ IF clkena_lw='1' THEN
+ V_Flag <= set_V_Flag;
+ signedOP <= divs;
+ IF micro_state=div1 THEN
+ nozero <= '0';
+ IF divs='1' AND dividend(63)='1' THEN -- Neg dividend
+ OP1_sign <= '1';
+ div_reg <= 0-dividend;
+ ELSE
+ OP1_sign <= '0';
+ div_reg <= dividend;
+ END IF;
+ ELSE
+ div_reg <= div_quot;
+ nozero <= NOT div_bit OR nozero;
+ END IF;
+ IF micro_state=div2 THEN
+ div_neg <= signedOP AND (OP2out(31) XOR OP1_sign);
+ IF DIV_Mode=0 THEN
+ div_over(32 downto 16) <= ('0'&div_reg(47 downto 32))-('0'&OP2out(15 downto 0));
+ ELSE
+ div_over <= ('0'&div_reg(63 downto 32))-('0'&OP2out);
+ END IF;
+ END IF;
+ IF exec(write_reminder)='0' THEN
+ result_div(31 downto 0) <= result_div_pre;
+ IF OP1_sign='1' THEN
+ result_div(63 downto 32) <= 0-div_quot(63 downto 32);
+ ELSE
+ result_div(63 downto 32) <= div_quot(63 downto 32);
+ END IF;
+ END IF;
+ END IF;
+ END IF;
+ END PROCESS;
+END;
diff --git a/src/tg68k/TG68K_Pack.vhd b/src/tg68k/TG68K_Pack.vhd
index fd3c8f4..1d5eb5d 100644
--- a/src/tg68k/TG68K_Pack.vhd
+++ b/src/tg68k/TG68K_Pack.vhd
@@ -1,250 +1,180 @@
-------------------------------------------------------------------------------
-------------------------------------------------------------------------------
--- --
--- Copyright (c) 2009-2013 Tobias Gubener --
--- Subdesign fAMpIGA by TobiFlex --
--- --
--- This source file is free software: you can redistribute it and/or modify --
--- it under the terms of the GNU General Public License as published --
--- by the Free Software Foundation, either version 3 of the License, or --
--- (at your option) any later version. --
--- --
--- This source file is distributed in the hope that it will be useful, --
--- but WITHOUT ANY WARRANTY; without even the implied warranty of --
--- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the --
--- GNU General Public License for more details. --
--- --
--- You should have received a copy of the GNU General Public License --
--- along with this program. If not, see . --
--- --
-------------------------------------------------------------------------------
-------------------------------------------------------------------------------
-library IEEE;
-use IEEE.std_logic_1164.all;
-
-package TG68K_Pack is
-
- type micro_states is (idle, nop, ld_nn, st_nn, ld_dAn1, ld_AnXn1, ld_AnXn2, st_dAn1, ld_AnXnbd1, ld_AnXnbd2, ld_AnXnbd3,
- ld_229_1, ld_229_2, ld_229_3, ld_229_4, st_229_1, st_229_2, st_229_3, st_229_4,
- st_AnXn1, st_AnXn2, bra1, bsr1, bsr2, nopnop, dbcc1, movem1, movem2, movem3,
- andi, op_AxAy, cmpm, link1, link2, unlink1, unlink2, int1, int2, int3, int4, rte1, rte2, rte3, trap0, trap1, trap2, trap3,
- trap4, trap5, trap6, movec1, movep1, movep2, movep3, movep4, movep5, rota1, bf1,
- mul1, mul2, mul_end1, mul_end2, div1, div2, div3, div4, div_end1, div_end2, pack1, pack2, pack3);
-
- constant opcMOVE : integer := 0; --
- constant opcMOVEQ : integer := 1; --
- constant opcMOVESR : integer := 2; --
- constant opcADD : integer := 3; --
- constant opcADDQ : integer := 4; --
- constant opcOR : integer := 5; --
- constant opcAND : integer := 6; --
- constant opcEOR : integer := 7; --
- constant opcCMP : integer := 8; --
- constant opcROT : integer := 9; --
- constant opcCPMAW : integer := 10;
- constant opcEXT : integer := 11; --
- constant opcABCD : integer := 12; --
- constant opcSBCD : integer := 13; --
- constant opcBITS : integer := 14; --
- constant opcSWAP : integer := 15; --
- constant opcScc : integer := 16; --
- constant andiSR : integer := 17; --
- constant eoriSR : integer := 18; --
- constant oriSR : integer := 19; --
- constant opcMULU : integer := 20; --
- constant opcDIVU : integer := 21; --
- constant dispouter : integer := 22; --
- constant rot_nop : integer := 23; --
- constant ld_rot_cnt : integer := 24; --
- constant writePC_add : integer := 25; --
- constant ea_data_OP1 : integer := 26; --
- constant ea_data_OP2 : integer := 27; --
- constant use_XZFlag : integer := 28; --
- constant get_bfoffset : integer := 29; --
- constant save_memaddr : integer := 30; --
- constant opcCHK : integer := 31; --
- constant movec_rd : integer := 32; --
- constant movec_wr : integer := 33; --
- constant Regwrena : integer := 34; --
- constant update_FC : integer := 35; --
- constant linksp : integer := 36; --
- constant movepl : integer := 37; --
- constant update_ld : integer := 38; --
- constant OP1addr : integer := 39; --
- constant write_reg : integer := 40; --
- constant changeMode : integer := 41; --
- constant ea_build : integer := 42; --
- constant trap_chk : integer := 43; --
- constant store_ea_data : integer := 44; --
- constant addrlong : integer := 45; --
- constant postadd : integer := 46; --
- constant presub : integer := 47; --
- constant subidx : integer := 48; --
- constant no_Flags : integer := 49; --
- constant use_SP : integer := 50; --
- constant to_CCR : integer := 51; --
- constant to_SR : integer := 52; --
- constant OP2out_one : integer := 53; --
- constant OP1out_zero : integer := 54; --
- constant mem_addsub : integer := 55; --
- constant addsub : integer := 56; --
- constant directPC : integer := 57; --
- constant direct_delta : integer := 58; --
- constant directSR : integer := 59; --
- constant directCCR : integer := 60; --
- constant exg : integer := 61; --
- constant get_ea_now : integer := 62; --
- constant ea_to_pc : integer := 63; --
- constant hold_dwr : integer := 64; --
- constant to_USP : integer := 65; --
- constant from_USP : integer := 66; --
- constant write_lowlong : integer := 67; --
- constant write_reminder : integer := 68; --
- constant movem_action : integer := 69; --
- constant briefext : integer := 70; --
- constant get_2ndOPC : integer := 71; --
- constant mem_byte : integer := 72; --
- constant longaktion : integer := 73; --
- constant opcRESET : integer := 74; --
- constant opcBF : integer := 75; --
- constant opcBFwb : integer := 76; --
- constant s2nd_hbits : integer := 77; --
- constant opcPACK : integer := 77; --
--- constant s2nd_hbits : integer := 77; --
-
-
--- constant : integer := 75; --
--- constant : integer := 76; --
--- constant : integer := 7; --
--- constant : integer := 7; --
--- constant : integer := 7; --
-
- constant lastOpcBit : integer := 77;
-
- type rTG68K_opc is record
- opcMOVE : bit;
- opcMOVEQ : bit;
- opcMOVESR : bit;
- opcADD : bit;
- opcADDQ : bit;
- opcOR : bit;
- opcAND : bit;
- opcEOR : bit;
- opcCMP : bit;
- opcROT : bit;
- opcCPMAW : bit;
- opcEXT : bit;
- opcABCD : bit;
- opcSBCD : bit;
- opcBITS : bit;
- opcSWAP : bit;
- opcScc : bit;
- andiSR : bit;
- eoriSR : bit;
- oriSR : bit;
- opcMULU : bit;
- opcDIVU : bit;
- dispouter : bit;
- rot_nop : bit;
- ld_rot_cnt : bit;
- writePC_add : bit;
- ea_data_OP1 : bit;
- ea_data_OP2 : bit;
- use_XZFlag : bit;
- get_bfoffset : bit;
- save_memaddr : bit;
- opcCHK : bit;
- movec_rd : bit;
- movec_wr : bit;
- Regwrena : bit;
- update_FC : bit;
- linksp : bit;
- movepl : bit;
- update_ld : bit;
- OP1addr : bit;
- write_reg : bit;
- changeMode : bit;
- ea_build : bit;
- trap_chk : bit;
- store_ea_data : bit;
- addrlong : bit;
- postadd : bit;
- presub : bit;
- subidx : bit;
- no_Flags : bit;
- use_SP : bit;
- to_CCR : bit;
- to_SR : bit;
- OP2out_one : bit;
- OP1out_zero : bit;
- mem_addsub : bit;
- addsub : bit;
- directPC : bit;
- direct_delta : bit;
- directSR : bit;
- directCCR : bit;
- exg : bit;
- get_ea_now : bit;
- ea_to_pc : bit;
- hold_dwr : bit;
- to_USP : bit;
- from_USP : bit;
- write_lowlong : bit;
- write_reminder : bit;
- movem_action : bit;
- briefext : bit;
- get_2ndOPC : bit;
- mem_byte : bit;
- longaktion : bit;
- opcRESET : bit;
- opcBF : bit;
- opcBFwb : bit;
- s2nd_hbits : bit;
- end record;
-
- component TG68K_ALU
- generic(
- MUL_Mode : integer := 0; --0=>16Bit, 1=>32Bit, 2=>switchable with CPU(1), 3=>no MUL,
- DIV_Mode : integer := 0 --0=>16Bit, 1=>32Bit, 2=>switchable with CPU(1), 3=>no DIV,
- );
- port(
- clk : in std_logic;
- Reset : in std_logic;
- clkena_lw : in std_logic:='1';
- execOPC : in bit;
- exe_condition : in std_logic;
- exec_tas : in std_logic;
- long_start : in bit;
- movem_presub : in bit;
- set_stop : in bit;
- Z_error : in bit;
- rot_bits : in std_logic_vector(1 downto 0);
- exec : in bit_vector(lastOpcBit downto 0);
- OP1out : in std_logic_vector(31 downto 0);
- OP2out : in std_logic_vector(31 downto 0);
- reg_QA : in std_logic_vector(31 downto 0);
- reg_QB : in std_logic_vector(31 downto 0);
- opcode : in std_logic_vector(15 downto 0);
- datatype : in std_logic_vector(1 downto 0);
- exe_opcode : in std_logic_vector(15 downto 0);
- exe_datatype : in std_logic_vector(1 downto 0);
- sndOPC : in std_logic_vector(15 downto 0);
- last_data_read : in std_logic_vector(15 downto 0);
- data_read : in std_logic_vector(15 downto 0);
- FlagsSR : in std_logic_vector(7 downto 0);
- micro_state : in micro_states;
- bf_ext_in : in std_logic_vector(7 downto 0);
- bf_ext_out : out std_logic_vector(7 downto 0);
- bf_shift : in std_logic_vector(5 downto 0);
- bf_width : in std_logic_vector(5 downto 0);
- bf_loffset : in std_logic_vector(4 downto 0);
-
- set_V_Flag : buffer bit;
- Flags : buffer std_logic_vector(7 downto 0);
- c_out : buffer std_logic_vector(2 downto 0);
- addsub_q : buffer std_logic_vector(31 downto 0);
- ALUout : out std_logic_vector(31 downto 0)
- );
- end component;
-
-end;
+------------------------------------------------------------------------------
+------------------------------------------------------------------------------
+-- --
+-- Copyright (c) 2009-2020 Tobias Gubener --
+-- Patches by MikeJ, Till Harbaum, Rok Krajnk, ... --
+-- Subdesign fAMpIGA by TobiFlex --
+-- --
+-- This source file is free software: you can redistribute it and/or modify --
+-- it under the terms of the GNU Lesser General Public License as published --
+-- by the Free Software Foundation, either version 3 of the License, or --
+-- (at your option) any later version. --
+-- --
+-- This source file is distributed in the hope that it will be useful, --
+-- but WITHOUT ANY WARRANTY; without even the implied warranty of --
+-- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the --
+-- GNU General Public License for more details. --
+-- --
+-- You should have received a copy of the GNU General Public License --
+-- along with this program. If not, see . --
+-- --
+------------------------------------------------------------------------------
+------------------------------------------------------------------------------
+library IEEE;
+use IEEE.std_logic_1164.all;
+
+package TG68K_Pack is
+
+ type micro_states is (idle, nop, ld_nn, st_nn, ld_dAn1, ld_AnXn1, ld_AnXn2, st_dAn1, ld_AnXnbd1, ld_AnXnbd2, ld_AnXnbd3,
+ ld_229_1, ld_229_2, ld_229_3, ld_229_4, st_229_1, st_229_2, st_229_3, st_229_4,
+ st_AnXn1, st_AnXn2, bra1, bsr1, bsr2, nopnop, dbcc1, movem1, movem2, movem3,
+ andi, pack1, pack2, pack3, op_AxAy, cmpm, link1, link2, unlink1, unlink2, int1, int2, int3, int4, rte1, rte2, rte3,
+ rte4, rte5, rtd1, rtd2, trap00, trap0, trap1, trap2, trap3, cas1, cas2, cas21, cas22, cas23, cas24,
+ cas25, cas26, cas27, cas28, chk20, chk21, chk22, chk23, chk24,
+ trap4, trap5, trap6, movec1, movep1, movep2, movep3, movep4, movep5, rota1, bf1,
+ mul1, mul2, mul_end1, mul_end2, div1, div2, div3, div4, div_end1, div_end2);
+
+ constant opcMOVE : integer := 0; --
+ constant opcMOVEQ : integer := 1; --
+ constant opcMOVESR : integer := 2; --
+ constant opcADD : integer := 3; --
+ constant opcADDQ : integer := 4; --
+ constant opcOR : integer := 5; --
+ constant opcAND : integer := 6; --
+ constant opcEOR : integer := 7; --
+ constant opcCMP : integer := 8; --
+ constant opcROT : integer := 9; --
+ constant opcCPMAW : integer := 10;
+ constant opcEXT : integer := 11; --
+ constant opcABCD : integer := 12; --
+ constant opcSBCD : integer := 13; --
+ constant opcBITS : integer := 14; --
+ constant opcSWAP : integer := 15; --
+ constant opcScc : integer := 16; --
+ constant andiSR : integer := 17; --
+ constant eoriSR : integer := 18; --
+ constant oriSR : integer := 19; --
+ constant opcMULU : integer := 20; --
+ constant opcDIVU : integer := 21; --
+ constant dispouter : integer := 22; --
+ constant rot_nop : integer := 23; --
+ constant ld_rot_cnt : integer := 24; --
+ constant writePC_add : integer := 25; --
+ constant ea_data_OP1 : integer := 26; --
+ constant ea_data_OP2 : integer := 27; --
+ constant use_XZFlag : integer := 28; --
+ constant get_bfoffset : integer := 29; --
+ constant save_memaddr : integer := 30; --
+ constant opcCHK : integer := 31; --
+ constant movec_rd : integer := 32; --
+ constant movec_wr : integer := 33; --
+ constant Regwrena : integer := 34; --
+ constant update_FC : integer := 35; --
+ constant linksp : integer := 36; --
+ constant movepl : integer := 37; --
+ constant update_ld : integer := 38; --
+ constant OP1addr : integer := 39; --
+ constant write_reg : integer := 40; --
+ constant changeMode : integer := 41; --
+ constant ea_build : integer := 42; --
+ constant trap_chk : integer := 43; --
+ constant store_ea_data : integer := 44; --
+ constant addrlong : integer := 45; --
+ constant postadd : integer := 46; --
+ constant presub : integer := 47; --
+ constant subidx : integer := 48; --
+ constant no_Flags : integer := 49; --
+ constant use_SP : integer := 50; --
+ constant to_CCR : integer := 51; --
+ constant to_SR : integer := 52; --
+ constant OP2out_one : integer := 53; --
+ constant OP1out_zero : integer := 54; --
+ constant mem_addsub : integer := 55; --
+ constant addsub : integer := 56; --
+ constant directPC : integer := 57; --
+ constant direct_delta : integer := 58; --
+ constant directSR : integer := 59; --
+ constant directCCR : integer := 60; --
+ constant exg : integer := 61; --
+ constant get_ea_now : integer := 62; --
+ constant ea_to_pc : integer := 63; --
+ constant hold_dwr : integer := 64; --
+ constant to_USP : integer := 65; --
+ constant from_USP : integer := 66; --
+ constant write_lowlong : integer := 67; --
+ constant write_reminder : integer := 68; --
+ constant movem_action : integer := 69; --
+ constant briefext : integer := 70; --
+ constant get_2ndOPC : integer := 71; --
+ constant mem_byte : integer := 72; --
+ constant longaktion : integer := 73; --
+ constant opcRESET : integer := 74; --
+ constant opcBF : integer := 75; --
+ constant opcBFwb : integer := 76; --
+ constant opcPACK : integer := 77; --
+ constant opcUNPACK : integer := 78; --
+ constant hold_ea_data : integer := 79; --
+ constant store_ea_packdata : integer := 80; --
+ constant exec_BS : integer := 81; --
+ constant hold_OP2 : integer := 82; --
+ constant restore_ADDR : integer := 83; --
+ constant alu_exec : integer := 84; --
+ constant alu_move : integer := 85; --
+ constant alu_setFlags : integer := 86; --
+ constant opcCHK2 : integer := 87; --
+ constant opcEXTB : integer := 88; --
+
+ constant lastOpcBit : integer := 88;
+
+ component TG68K_ALU
+ generic(
+ MUL_Mode :integer; --0=>16Bit, 1=>32Bit, 2=>switchable with CPU(1), 3=>no MUL,
+ MUL_Hardware :integer; --0=>no, 1=>yes,
+ DIV_Mode :integer; --0=>16Bit, 1=>32Bit, 2=>switchable with CPU(1), 3=>no DIV,
+ BarrelShifter :integer --0=>no, 1=>yes, 2=>switchable with CPU(1)
+ );
+ port(
+ clk : in std_logic;
+ Reset : in std_logic;
+ CPU : in std_logic_vector(1 downto 0):="00"; -- 00->68000 01->68010 11->68020(only some parts - yet)
+ clkena_lw : in std_logic:='1';
+ execOPC : in bit;
+ decodeOPC : in bit;
+ exe_condition : in std_logic;
+ exec_tas : in std_logic;
+ long_start : in bit;
+ non_aligned : in std_logic;
+ movem_presub : in bit;
+ set_stop : in bit;
+ Z_error : in bit;
+ rot_bits : in std_logic_vector(1 downto 0);
+ exec : in bit_vector(lastOpcBit downto 0);
+ OP1out : in std_logic_vector(31 downto 0);
+ OP2out : in std_logic_vector(31 downto 0);
+ reg_QA : in std_logic_vector(31 downto 0);
+ reg_QB : in std_logic_vector(31 downto 0);
+ opcode : in std_logic_vector(15 downto 0);
+-- datatype : in std_logic_vector(1 downto 0);
+ exe_opcode : in std_logic_vector(15 downto 0);
+ exe_datatype : in std_logic_vector(1 downto 0);
+ sndOPC : in std_logic_vector(15 downto 0);
+ last_data_read : in std_logic_vector(15 downto 0);
+ data_read : in std_logic_vector(15 downto 0);
+ FlagsSR : in std_logic_vector(7 downto 0);
+ micro_state : in micro_states;
+ bf_ext_in : in std_logic_vector(7 downto 0);
+ bf_ext_out : out std_logic_vector(7 downto 0);
+ bf_shift : in std_logic_vector(5 downto 0);
+ bf_width : in std_logic_vector(5 downto 0);
+ bf_ffo_offset : in std_logic_vector(31 downto 0);
+ bf_loffset : in std_logic_vector(4 downto 0);
+
+ set_V_Flag : buffer bit;
+ Flags : buffer std_logic_vector(7 downto 0);
+ c_out : buffer std_logic_vector(2 downto 0);
+ addsub_q : buffer std_logic_vector(31 downto 0);
+ ALUout : out std_logic_vector(31 downto 0)
+ );
+ end component;
+
+end;
\ No newline at end of file
diff --git a/src/tg68k/TG68KdotC_Kernel.vhd b/src/tg68k/TG68KdotC_Kernel.vhd
index b6c48e1..6bfcb01 100644
--- a/src/tg68k/TG68KdotC_Kernel.vhd
+++ b/src/tg68k/TG68KdotC_Kernel.vhd
@@ -1,12 +1,12 @@
------------------------------------------------------------------------------
------------------------------------------------------------------------------
-- --
--- Copyright (c) 2009-2013 Tobias Gubener --
--- Patches by MikeJ, Till Harbaum, Rok Krajnk, ... --
+-- Copyright (c) 2009-2020 Tobias Gubener --
+-- Patches by MikeJ, Till Harbaum, Rok Krajnk, ... --
-- Subdesign fAMpIGA by TobiFlex --
-- --
-- This source file is free software: you can redistribute it and/or modify --
--- it under the terms of the GNU General Public License as published --
+-- it under the terms of the GNU Lesser General Public License as published --
-- by the Free Software Foundation, either version 3 of the License, or --
-- (at your option) any later version. --
-- --
@@ -19,28 +19,72 @@
-- along with this program. If not, see . --
-- --
------------------------------------------------------------------------------
-------------------------------------------------------------------------------
-
--- optimize Register file
-
--- to do 68010:
+------------------------------------------------------------------------------
+
+-- 17.03.2020 TG bugfix move data to (extended address)
+-- 13.03.2020 TG bugfix extended addess mode - thanks Adam Polkosnik
+-- 15.02.2020 TG bugfix DIVS.W with result $8000
+-- 08.01.2020 TH fix the byte-mirroring
+-- 25.11.2019 TG bugfix ILLEGAL.B handling
+-- 24.11.2019 TG next try CMP2 and CHK2.l
+-- 24.11.2019 retrofun(RF) commit ILLEGAL.B handling
+-- 18.11.2019 TG insert CMP2 and CHK2.l
+-- 17.11.2019 TG insert CAS and CAS2
+-- 10.11.2019 TG insert TRAPcc
+-- 08.11.2019 TG bugfix movem in 68020 mode
+-- 06.11.2019 TG bugfix CHK
+-- 06.11.2019 TG bugfix flags and stackframe DIVU
+-- 04.11.2019 TG insert RTE from TH
+-- 03.11.2019 TG insert TrapV from TH
+-- 03.11.2019 TG bugfix MUL 64Bit
+-- 03.11.2019 TG rework barrel shifter - some other tweaks
+-- 02.11.2019 TG bugfig N-Flag and Z-Flag for DIV
+-- 30.10.2019 TG bugfix RTR in 68020-mode
+-- 30.10.2019 TG bugfix BFINS again
+-- 19.10.2019 TG insert some bugfixes from apolkosnik
+-- 05.12.2018 TG insert RTD opcode
+-- 03.12.2018 TG insert barrel shifter
+-- 01.11.2017 TG bugfix V-Flag for ASL/ASR - thanks Peter Graf
+-- 29.05.2017 TG decode 0x4AFB as illegal, needed for QL BKP - thanks Peter Graf
+-- 21.05.2017 TG insert generic for hardware multiplier for MULU & MULS
+-- 04.04.2017 TG change GPL to LGPL
+-- 04.04.2017 TG BCD handling with all undefined behavior!
+-- 02.04.2017 TG bugfix Bitfield Opcodes
+-- 19.03.2017 TG insert PACK/UNPACK
+-- 19.03.2017 TG bugfix CMPI ...(PC) - thanks Till Harbaum
+-- ??? MJ bugfix non_aligned movem access
+-- add berr handling 10.03.2013 - needed for ATARI Core
+
+-- bugfix session 07/08.Feb.2013
+-- movem ,-(an)
+-- movem (an)+, - thanks Gerhard Suttner
+-- btst dn,#data - thanks Peter Graf
+-- movep - thanks Till Harbaum
+-- IPL vector - thanks Till Harbaum
+--
+
+-- optimize Register file
+
+-- to do 68010:
-- (MOVEC)
-- BKPT
--- RTD
-- MOVES
--
-- to do 68020:
-- (CALLM)
-- (RETM)
--- CAS, CAS2
+-- bugfix CHK2, CMP2
+-- rework barrel shifter
-- CHK2
-- CMP2
-- cpXXX Coprozessor stuff
--- TRAPcc
--- done 020:
--- PACK, UNPK
+-- done 020:
+-- CAS, CAS2
+-- TRAPcc
+-- PACK
+-- UNPK
-- Bitfields
-- address modes
-- long bra
@@ -56,321 +100,361 @@ use work.TG68K_Pack.all;
entity TG68KdotC_Kernel is
generic(
- SR_Read : integer := 0; --0=>user, 1=>privileged, 2=>switchable with CPU(0)
- VBR_Stackframe : integer := 0; --0=>no, 1=>yes/extended, 2=>switchable with CPU(0)
- extAddr_Mode : integer := 0; --0=>no, 1=>yes, 2=>switchable with CPU(1)
- MUL_Mode : integer := 0; --0=>16Bit, 1=>32Bit, 2=>switchable with CPU(1), 3=>no MUL,
- DIV_Mode : integer := 0; --0=>16Bit, 1=>32Bit, 2=>switchable with CPU(1), 3=>no DIV,
- BitField : integer := 0 --0=>no, 1=>yes, 2=>switchable with CPU(1)
+ SR_Read : integer:= 2; --0=>user, 1=>privileged, 2=>switchable with CPU(0)
+ VBR_Stackframe : integer:= 2; --0=>no, 1=>yes/extended, 2=>switchable with CPU(0)
+ extAddr_Mode : integer:= 2; --0=>no, 1=>yes, 2=>switchable with CPU(1)
+ MUL_Mode : integer := 2; --0=>16Bit, 1=>32Bit, 2=>switchable with CPU(1), 3=>no MUL,
+ DIV_Mode : integer := 2; --0=>16Bit, 1=>32Bit, 2=>switchable with CPU(1), 3=>no DIV,
+ BitField : integer := 2; --0=>no, 1=>yes, 2=>switchable with CPU(1)
+
+ BarrelShifter : integer := 1; --0=>no, 1=>yes, 2=>switchable with CPU(1)
+ MUL_Hardware : integer := 1 --0=>no, 1=>yes,
);
- port(clk : in std_logic;
- nReset : in std_logic; --low active
- clkena_in : in std_logic:='1';
- data_in : in std_logic_vector(15 downto 0);
- IPL : in std_logic_vector(2 downto 0):="111";
- IPL_autovector : in std_logic:='0';
- berr : in std_logic:='0'; -- only 68000 Stackpointer dummy
- CPU : in std_logic_vector(1 downto 0):="00"; -- 00->68000 01->68010 11->68020(only some parts - yet)
- addr : buffer std_logic_vector(31 downto 0);
- data_write : out std_logic_vector(15 downto 0);
- nWr : out std_logic;
- nUDS : out std_logic;
- nLDS : out std_logic;
- busstate : out std_logic_vector(1 downto 0); -- 00-> fetch code 10->read data 11->write data 01->no memaccess
- nResetOut : out std_logic;
- FC : out std_logic_vector(2 downto 0);
- clr_berr : out std_logic;
+ port(clk : in std_logic;
+ nReset : in std_logic; --low active
+ clkena_in : in std_logic:='1';
+ data_in : in std_logic_vector(15 downto 0);
+ IPL : in std_logic_vector(2 downto 0):="111";
+ IPL_autovector : in std_logic:='0';
+ berr : in std_logic:='0'; -- only 68000 Stackpointer dummy
+ CPU : in std_logic_vector(1 downto 0):="00"; -- 00->68000 01->68010 11->68020(only some parts - yet)
+ addr_out : out std_logic_vector(31 downto 0);
+ data_write : out std_logic_vector(15 downto 0);
+ nWr : out std_logic;
+ nUDS : out std_logic;
+ nLDS : out std_logic;
+ busstate : out std_logic_vector(1 downto 0); -- 00-> fetch code 10->read data 11->write data 01->no memaccess
+ nResetOut : out std_logic;
+ FC : out std_logic_vector(2 downto 0);
+ clr_berr : out std_logic;
-- for debug
- skipFetch : out std_logic;
- regin : buffer std_logic_vector(31 downto 0);
- CACR_out : buffer std_logic_vector(3 downto 0);
- VBR_out : buffer std_logic_vector(31 downto 0)
- );
+ skipFetch : out std_logic;
+ regin_out : out std_logic_vector(31 downto 0);
+ CACR_out : out std_logic_vector( 3 downto 0);
+ VBR_out : out std_logic_vector(31 downto 0)
+ );
end TG68KdotC_Kernel;
---nBS : std_logic_vector(3 downto 0); -- nBS0 is 31..24 3 is 7..0, active LOW
---SIZ : std_logic_vector(1 downto 0);
---ACK for 16/32 bit transfer?
architecture logic of TG68KdotC_Kernel is
- signal syncReset : std_logic_vector(3 downto 0);
- signal Reset : std_logic;
- signal clkena_lw : std_logic;
- signal TG68_PC : std_logic_vector(31 downto 0);
- signal tmp_TG68_PC : std_logic_vector(31 downto 0);
- signal TG68_PC_add : std_logic_vector(31 downto 0);
- signal PC_dataa : std_logic_vector(31 downto 0);
- signal PC_datab : std_logic_vector(31 downto 0);
- signal memaddr : std_logic_vector(31 downto 0);
- signal state : std_logic_vector(1 downto 0);
- signal datatype : std_logic_vector(1 downto 0);
- signal set_datatype : std_logic_vector(1 downto 0);
- signal exe_datatype : std_logic_vector(1 downto 0);
- signal setstate : std_logic_vector(1 downto 0);
+ signal use_VBR_Stackframe : std_logic;
+
+ signal syncReset : std_logic_vector(3 downto 0);
+ signal Reset : std_logic;
+ signal clkena_lw : std_logic;
+ signal TG68_PC : std_logic_vector(31 downto 0);
+ signal tmp_TG68_PC : std_logic_vector(31 downto 0);
+ signal TG68_PC_add : std_logic_vector(31 downto 0);
+ signal PC_dataa : std_logic_vector(31 downto 0);
+ signal PC_datab : std_logic_vector(31 downto 0);
+ signal memaddr : std_logic_vector(31 downto 0);
+ signal state : std_logic_vector(1 downto 0);
+ signal datatype : std_logic_vector(1 downto 0);
+ signal set_datatype : std_logic_vector(1 downto 0);
+ signal exe_datatype : std_logic_vector(1 downto 0);
+ signal setstate : std_logic_vector(1 downto 0);
+ signal setaddrvalue : std_logic;
+ signal addrvalue : std_logic;
- signal opcode : std_logic_vector(15 downto 0);
- signal exe_opcode : std_logic_vector(15 downto 0);
- signal sndOPC : std_logic_vector(15 downto 0);
+ signal opcode : std_logic_vector(15 downto 0);
+ signal exe_opcode : std_logic_vector(15 downto 0);
+ signal sndOPC : std_logic_vector(15 downto 0);
- signal last_opc_read : std_logic_vector(15 downto 0);
- signal registerin : std_logic_vector(31 downto 0);
- signal reg_QA : std_logic_vector(31 downto 0);
- signal reg_QB : std_logic_vector(31 downto 0);
- signal Wwrena,Lwrena : bit;
- signal Bwrena : bit;
- signal Regwrena_now : bit;
- signal rf_dest_addr : std_logic_vector(3 downto 0);
- signal rf_source_addr : std_logic_vector(3 downto 0);
- signal rf_source_addrd : std_logic_vector(3 downto 0);
-
- type regfile_t is array(0 to 15) of std_logic_vector(31 downto 0);
- signal regfile : regfile_t := (others => (others =>'0')); -- mikej stops sim X issues;
- signal RDindex_A : integer range 0 to 15;
- signal RDindex_B : integer range 0 to 15;
- signal WR_AReg : std_logic;
+ signal exe_pc : std_logic_vector(31 downto 0);--TH
+ signal last_opc_pc : std_logic_vector(31 downto 0);--TH
+ signal last_opc_read : std_logic_vector(15 downto 0);
+ signal registerin : std_logic_vector(31 downto 0);
+ signal reg_QA : std_logic_vector(31 downto 0);
+ signal reg_QB : std_logic_vector(31 downto 0);
+ signal Wwrena,Lwrena : bit;
+ signal Bwrena : bit;
+ signal Regwrena_now : bit;
+ signal rf_dest_addr : std_logic_vector(3 downto 0);
+ signal rf_source_addr : std_logic_vector(3 downto 0);
+ signal rf_source_addrd : std_logic_vector(3 downto 0);
+
+ signal regin : std_logic_vector(31 downto 0);
+ type regfile_t is array(0 to 15) of std_logic_vector(31 downto 0);
+ signal regfile : regfile_t := (OTHERS => (OTHERS => '0')); -- mikej stops sim X issues;
+ signal RDindex_A : integer range 0 to 15;
+ signal RDindex_B : integer range 0 to 15;
+ signal WR_AReg : std_logic;
- signal memaddr_reg : std_logic_vector(31 downto 0);
- signal memaddr_delta : std_logic_vector(31 downto 0);
- signal use_base : bit;
-
- signal ea_data : std_logic_vector(31 downto 0);
- signal OP1out : std_logic_vector(31 downto 0);
- signal OP2out : std_logic_vector(31 downto 0);
- signal OP1outbrief : std_logic_vector(15 downto 0);
- signal OP1in : std_logic_vector(31 downto 0);
- signal ALUout : std_logic_vector(31 downto 0);
- signal data_write_i : std_logic_vector(15 downto 0);
- signal data_write_tmp : std_logic_vector(31 downto 0);
- signal data_write_muxin : std_logic_vector(31 downto 0);
- signal data_write_mux : std_logic_vector(47 downto 0);
- signal nextpass : bit;
- signal setnextpass : bit;
- signal setdispbyte : bit;
- signal setdisp : bit;
- signal regdirectsource : bit; -- checken !!!
- signal addsub_q : std_logic_vector(31 downto 0);
- signal briefdata : std_logic_vector(31 downto 0);
--- signal c_in : std_logic_vector(3 downto 0);
- signal c_out : std_logic_vector(2 downto 0);
-
- signal mem_address : std_logic_vector(31 downto 0);
- signal memaddr_a : std_logic_vector(31 downto 0);
-
- signal TG68_PC_brw : bit;
- signal TG68_PC_word : bit;
- signal getbrief : bit;
- signal brief : std_logic_vector(15 downto 0);
- signal dest_areg : std_logic;
- signal source_areg : std_logic;
- signal data_is_source : bit;
- signal store_in_tmp : bit;
- signal write_back : bit;
- signal exec_write_back : bit;
- signal setstackaddr : bit;
- signal writePC : bit;
- signal writePCbig : bit;
- signal set_writePCbig : bit;
- signal setopcode : bit;
- signal decodeOPC : bit;
- signal execOPC : bit;
- signal setexecOPC : bit;
- signal endOPC : bit;
- signal setendOPC : bit;
- signal Flags : std_logic_vector(7 downto 0); -- ...XNZVC
- signal FlagsSR : std_logic_vector(7 downto 0); -- T.S..III
- signal SRin : std_logic_vector(7 downto 0);
- signal exec_DIRECT : bit;
- signal exec_tas : std_logic;
- signal set_exec_tas : std_logic;
-
- signal exe_condition : std_logic;
- signal ea_only : bit;
- signal source_lowbits : bit;
- signal source_2ndHbits : bit;
- signal source_2ndLbits : bit;
- signal dest_2ndHbits : bit;
- signal dest_hbits : bit;
- signal rot_bits : std_logic_vector(1 downto 0);
- signal set_rot_bits : std_logic_vector(1 downto 0);
- signal rot_cnt : std_logic_vector(5 downto 0);
- signal set_rot_cnt : std_logic_vector(5 downto 0);
- signal movem_actiond : bit;
- signal movem_regaddr : std_logic_vector(3 downto 0);
- signal movem_mux : std_logic_vector(3 downto 0);
- signal movem_presub : bit;
- signal movem_run : bit;
- signal ea_calc_b : std_logic_vector(31 downto 0);
- signal set_direct_data : bit;
- signal use_direct_data : bit;
- signal direct_data : bit;
-
- signal set_V_Flag : bit;
- signal set_vectoraddr : bit;
- signal writeSR : bit;
- signal trap_berr : bit;
- signal trap_illegal : bit;
- signal trap_addr_error : bit;
- signal trap_priv : bit;
- signal trap_trace : bit;
- signal trap_1010 : bit;
- signal trap_1111 : bit;
- signal trap_trap : bit;
- signal trap_trapv : bit;
- signal trap_interrupt : bit;
- signal trapmake : bit;
- signal trapd : bit;
- signal trap_SR : std_logic_vector(7 downto 0);
- signal make_trace : std_logic;
- signal make_berr : std_logic;
-
- signal set_stop : bit;
- signal stop : bit;
- signal trap_vector : std_logic_vector(31 downto 0);
- signal trap_vector_vbr : std_logic_vector(31 downto 0);
- signal USP : std_logic_vector(31 downto 0);
-
- signal IPL_nr : std_logic_vector(2 downto 0);
- signal rIPL_nr : std_logic_vector(2 downto 0);
- signal IPL_vec : std_logic_vector(7 downto 0);
- signal interrupt : bit;
- signal setinterrupt : bit;
- signal SVmode : std_logic;
- signal preSVmode : std_logic;
- signal Suppress_Base : bit;
- signal set_Suppress_Base : bit;
- signal set_Z_error : bit;
- signal Z_error : bit;
- signal ea_build_now : bit;
- signal build_logical : bit;
- signal build_bcd : bit;
-
- signal data_read : std_logic_vector(31 downto 0);
- signal bf_ext_in : std_logic_vector(7 downto 0);
- signal bf_ext_out : std_logic_vector(7 downto 0);
- signal long_start : bit;
- signal long_start_alu : bit;
- signal long_done : bit;
- signal memmask : std_logic_vector(5 downto 0);
- signal set_memmask : std_logic_vector(5 downto 0);
- signal memread : std_logic_vector(3 downto 0);
- signal wbmemmask : std_logic_vector(5 downto 0);
- signal memmaskmux : std_logic_vector(5 downto 0);
- signal oddout : std_logic;
- signal set_oddout : std_logic;
- signal PCbase : std_logic;
- signal set_PCbase : std_logic;
-
- signal last_data_read : std_logic_vector(31 downto 0);
- signal last_data_in : std_logic_vector(31 downto 0);
-
- signal bf_offset : std_logic_vector(5 downto 0);
- signal bf_width : std_logic_vector(5 downto 0);
- signal bf_bhits : std_logic_vector(5 downto 0);
- signal bf_shift : std_logic_vector(5 downto 0);
- signal alu_width : std_logic_vector(5 downto 0);
- signal alu_bf_shift : std_logic_vector(5 downto 0);
- signal bf_loffset : std_logic_vector(5 downto 0);
- signal alu_bf_loffset : std_logic_vector(5 downto 0);
-
- signal movec_data : std_logic_vector(31 downto 0);
- signal VBR : std_logic_vector(31 downto 0);
- signal CACR : std_logic_vector(3 downto 0);
- signal DFC : std_logic_vector(2 downto 0);
- signal SFC : std_logic_vector(2 downto 0);
-
-
- signal set : bit_vector(lastOpcBit downto 0);
- signal set_exec : bit_vector(lastOpcBit downto 0);
- signal exec : bit_vector(lastOpcBit downto 0);
-
- signal micro_state : micro_states;
- signal next_micro_state : micro_states;
-
- attribute syn_ramstyle : string;
- attribute syn_ramstyle of regfile : signal is "logic";
-
+ signal addr : std_logic_vector(31 downto 0);
+ signal memaddr_reg : std_logic_vector(31 downto 0);
+ signal memaddr_delta : std_logic_vector(31 downto 0);
+ signal use_base : bit;
-BEGIN
-ALU: TG68K_ALU
+ signal ea_data : std_logic_vector(31 downto 0);
+ signal OP1out : std_logic_vector(31 downto 0);
+ signal OP2out : std_logic_vector(31 downto 0);
+ signal OP1outbrief : std_logic_vector(15 downto 0);
+ signal OP1in : std_logic_vector(31 downto 0);
+ signal ALUout : std_logic_vector(31 downto 0);
+ signal data_write_tmp : std_logic_vector(31 downto 0);
+ signal data_write_muxin : std_logic_vector(31 downto 0);
+ signal data_write_mux : std_logic_vector(47 downto 0);
+ signal nextpass : bit;
+ signal setnextpass : bit;
+ signal setdispbyte : bit;
+ signal setdisp : bit;
+ signal regdirectsource :bit; -- checken !!!
+ signal addsub_q : std_logic_vector(31 downto 0);
+ signal briefdata : std_logic_vector(31 downto 0);
+ signal c_out : std_logic_vector(2 downto 0);
+
+ signal mem_address : std_logic_vector(31 downto 0);
+ signal memaddr_a : std_logic_vector(31 downto 0);
+
+ signal TG68_PC_brw : bit;
+ signal TG68_PC_word : bit;
+ signal getbrief : bit;
+ signal brief : std_logic_vector(15 downto 0);
+ signal data_is_source : bit;
+ signal store_in_tmp : bit;
+ signal write_back : bit;
+ signal exec_write_back : bit;
+ signal setstackaddr : bit;
+ signal writePC : bit;
+ signal writePCbig : bit;
+ signal set_writePCbig : bit;
+ signal setopcode : bit;
+ signal decodeOPC : bit;
+ signal execOPC : bit;
+ signal execOPC_ALU : bit;
+ signal setexecOPC : bit;
+ signal endOPC : bit;
+ signal setendOPC : bit;
+ signal Flags : std_logic_vector(7 downto 0); -- ...XNZVC
+ signal FlagsSR : std_logic_vector(7 downto 0); -- T.S.0III
+ signal SRin : std_logic_vector(7 downto 0);
+ signal exec_DIRECT : bit;
+ signal exec_tas : std_logic;
+ signal set_exec_tas : std_logic;
+
+ signal exe_condition : std_logic;
+ signal ea_only : bit;
+ signal source_areg : std_logic;
+ signal source_lowbits : bit;
+ signal source_LDRLbits : bit;
+ signal source_LDRMbits : bit;
+ signal source_2ndHbits : bit;
+ signal source_2ndMbits : bit;
+ signal source_2ndLbits : bit;
+ signal dest_areg : std_logic;
+ signal dest_LDRareg : std_logic;
+ signal dest_LDRHbits : bit;
+ signal dest_LDRLbits : bit;
+ signal dest_2ndHbits : bit;
+ signal dest_2ndLbits : bit;
+ signal dest_hbits : bit;
+ signal rot_bits : std_logic_vector(1 downto 0);
+ signal set_rot_bits : std_logic_vector(1 downto 0);
+ signal rot_cnt : std_logic_vector(5 downto 0);
+ signal set_rot_cnt : std_logic_vector(5 downto 0);
+ signal movem_actiond : bit;
+ signal movem_regaddr : std_logic_vector(3 downto 0);
+ signal movem_mux : std_logic_vector(3 downto 0);
+ signal movem_presub : bit;
+ signal movem_run : bit;
+ signal ea_calc_b : std_logic_vector(31 downto 0);
+ signal set_direct_data : bit;
+ signal use_direct_data : bit;
+ signal direct_data : bit;
+
+ signal set_V_Flag : bit;
+ signal set_vectoraddr : bit;
+ signal writeSR : bit;
+ signal trap_berr : bit;
+ signal trap_illegal : bit;
+ signal trap_addr_error : bit;
+ signal trap_priv : bit;
+ signal trap_trace : bit;
+ signal trap_1010 : bit;
+ signal trap_1111 : bit;
+ signal trap_trap : bit;
+ signal trap_trapv : bit;
+ signal trap_interrupt : bit;
+ signal trapmake : bit;
+ signal trapd : bit;
+ signal trap_SR : std_logic_vector(7 downto 0);
+ signal make_trace : std_logic;
+ signal make_berr : std_logic;
+ signal useStackframe2 : std_logic;
+
+ signal set_stop : bit;
+ signal stop : bit;
+ signal trap_vector : std_logic_vector(31 downto 0);
+ signal trap_vector_vbr : std_logic_vector(31 downto 0);
+ signal USP : std_logic_vector(31 downto 0);
+-- signal illegal_write_mode : bit;
+-- signal illegal_read_mode : bit;
+-- signal illegal_byteaddr : bit;
+
+ signal IPL_nr : std_logic_vector(2 downto 0);
+ signal rIPL_nr : std_logic_vector(2 downto 0);
+ signal IPL_vec : std_logic_vector(7 downto 0);
+ signal interrupt : bit;
+ signal setinterrupt : bit;
+ signal SVmode : std_logic;
+ signal preSVmode : std_logic;
+ signal Suppress_Base : bit;
+ signal set_Suppress_Base: bit;
+ signal set_Z_error : bit;
+ signal Z_error : bit;
+ signal ea_build_now : bit;
+ signal build_logical : bit;
+ signal build_bcd : bit;
+
+ signal data_read : std_logic_vector(31 downto 0);
+ signal bf_ext_in : std_logic_vector(7 downto 0);
+ signal bf_ext_out : std_logic_vector(7 downto 0);
+-- signal byte : bit;
+ signal long_start : bit;
+ signal long_start_alu : bit;
+ signal non_aligned : std_logic;
+ signal long_done : bit;
+ signal memmask : std_logic_vector(5 downto 0);
+ signal set_memmask : std_logic_vector(5 downto 0);
+ signal memread : std_logic_vector(3 downto 0);
+ signal wbmemmask : std_logic_vector(5 downto 0);
+ signal memmaskmux : std_logic_vector(5 downto 0);
+ signal oddout : std_logic;
+ signal set_oddout : std_logic;
+ signal PCbase : std_logic;
+ signal set_PCbase : std_logic;
+
+ signal last_data_read : std_logic_vector(31 downto 0);
+ signal last_data_in : std_logic_vector(31 downto 0);
+
+ signal bf_offset : std_logic_vector(5 downto 0);
+ signal bf_width : std_logic_vector(5 downto 0);
+ signal bf_bhits : std_logic_vector(5 downto 0);
+ signal bf_shift : std_logic_vector(5 downto 0);
+ signal alu_width : std_logic_vector(5 downto 0);
+ signal alu_bf_shift : std_logic_vector(5 downto 0);
+ signal bf_loffset : std_logic_vector(5 downto 0);
+ signal bf_full_offset : std_logic_vector(31 downto 0);
+ signal alu_bf_ffo_offset: std_logic_vector(31 downto 0);
+ signal alu_bf_loffset : std_logic_vector(5 downto 0);
+
+ signal movec_data : std_logic_vector(31 downto 0);
+ signal VBR : std_logic_vector(31 downto 0);
+ signal CACR : std_logic_vector(3 downto 0);
+ signal DFC : std_logic_vector(2 downto 0);
+ signal SFC : std_logic_vector(2 downto 0);
+
+
+ signal set : bit_vector(lastOpcBit downto 0);
+ signal set_exec : bit_vector(lastOpcBit downto 0);
+ signal exec : bit_vector(lastOpcBit downto 0);
+
+ signal micro_state : micro_states;
+ signal next_micro_state : micro_states;
+
+
+
+BEGIN
+
+ALU: TG68K_ALU
generic map(
- MUL_Mode => MUL_Mode, --0=>16Bit, 1=>32Bit, 2=>switchable with CPU(1), 3=>no MUL,
- DIV_Mode => DIV_Mode --0=>16Bit, 1=>32Bit, 2=>switchable with CPU(1), 3=>no DIV,
+ MUL_Mode => MUL_Mode, --0=>16Bit, 1=>32Bit, 2=>switchable with CPU(1), 3=>no MUL,
+ MUL_Hardware => MUL_Hardware, --0=>no, 1=>yes,
+ DIV_Mode => DIV_Mode, --0=>16Bit, 1=>32Bit, 2=>switchable with CPU(1), 3=>no DIV,
+ BarrelShifter => BarrelShifter --0=>no, 1=>yes, 2=>switchable with CPU(1)
)
port map(
- clk => clk, --: in std_logic;
- Reset => Reset, --: in std_logic;
- clkena_lw => clkena_lw, --: in std_logic:='1';
- execOPC => execOPC, --: in bit;
- exe_condition => exe_condition, --: in std_logic;
- exec_tas => exec_tas, --: in std_logic;
- long_start => long_start_alu, --: in bit;
- movem_presub => movem_presub, --: in bit;
- set_stop => set_stop, --: in bit;
- Z_error => Z_error, --: in bit;
- rot_bits => rot_bits, --: in std_logic_vector(1 downto 0);
- exec => exec, --: in bit_vector(lastOpcBit downto 0);
- OP1out => OP1out, --: in std_logic_vector(31 downto 0);
- OP2out => OP2out, --: in std_logic_vector(31 downto 0);
- reg_QA => reg_QA, --: in std_logic_vector(31 downto 0);
- reg_QB => reg_QB, --: in std_logic_vector(31 downto 0);
- opcode => opcode, --: in std_logic_vector(15 downto 0);
- datatype => datatype, --: in std_logic_vector(1 downto 0);
- exe_opcode => exe_opcode, --: in std_logic_vector(15 downto 0);
- exe_datatype => exe_datatype, --: in std_logic_vector(1 downto 0);
- sndOPC => sndOPC, --: in std_logic_vector(15 downto 0);
- last_data_read => last_data_read(15 downto 0), --: in std_logic_vector(31 downto 0);
- data_read => data_read(15 downto 0), --: in std_logic_vector(31 downto 0);
- FlagsSR => FlagsSR, --: in std_logic_vector(7 downto 0);
- micro_state => micro_state, --: in micro_states;
- bf_ext_in => bf_ext_in,
- bf_ext_out => bf_ext_out,
- bf_shift => alu_bf_shift,
- bf_width => alu_width,
- bf_loffset => alu_bf_loffset(4 downto 0),
- set_V_Flag => set_V_Flag, --: buffer bit;
- Flags => Flags, --: buffer std_logic_vector(8 downto 0);
- c_out => c_out, --: buffer std_logic_vector(2 downto 0);
- addsub_q => addsub_q, --: buffer std_logic_vector(31 downto 0);
- ALUout => ALUout --: buffer std_logic_vector(31 downto 0)
+ clk => clk, --: in std_logic;
+ Reset => Reset, --: in std_logic;
+ CPU => CPU, --: in std_logic_vector(1 downto 0):="00"; -- 00->68000 01->68010 11->68020(only some parts - yet)
+ clkena_lw => clkena_lw, --: in std_logic:='1';
+ execOPC => execOPC_ALU, --: in bit;
+ decodeOPC => decodeOPC, --: in bit;
+ exe_condition => exe_condition, --: in std_logic;
+ exec_tas => exec_tas, --: in std_logic;
+ long_start => long_start_alu, --: in bit;
+ non_aligned => non_aligned,
+ movem_presub => movem_presub, --: in bit;
+ set_stop => set_stop, --: in bit;
+ Z_error => Z_error, --: in bit;
+
+ rot_bits => rot_bits, --: in std_logic_vector(1 downto 0);
+ exec => exec, --: in bit_vector(lastOpcBit downto 0);
+ OP1out => OP1out, --: in std_logic_vector(31 downto 0);
+ OP2out => OP2out, --: in std_logic_vector(31 downto 0);
+ reg_QA => reg_QA, --: in std_logic_vector(31 downto 0);
+ reg_QB => reg_QB, --: in std_logic_vector(31 downto 0);
+ opcode => opcode, --: in std_logic_vector(15 downto 0);
+ exe_opcode => exe_opcode, --: in std_logic_vector(15 downto 0);
+ exe_datatype => exe_datatype, --: in std_logic_vector(1 downto 0);
+ sndOPC => sndOPC, --: in std_logic_vector(15 downto 0);
+ last_data_read => last_data_read(15 downto 0), --: in std_logic_vector(31 downto 0);
+ data_read => data_read(15 downto 0), --: in std_logic_vector(31 downto 0);
+ FlagsSR => FlagsSR, --: in std_logic_vector(7 downto 0);
+ micro_state => micro_state, --: in micro_states;
+ bf_ext_in => bf_ext_in,
+ bf_ext_out => bf_ext_out,
+ bf_shift => alu_bf_shift,
+ bf_width => alu_width,
+ bf_ffo_offset => alu_bf_ffo_offset,
+ bf_loffset => alu_bf_loffset(4 downto 0),
+
+ set_V_Flag => set_V_Flag, --: buffer bit;
+ Flags => Flags, --: buffer std_logic_vector(8 downto 0);
+ c_out => c_out, --: buffer std_logic_vector(2 downto 0);
+ addsub_q => addsub_q, --: buffer std_logic_vector(31 downto 0);
+ ALUout => ALUout --: buffer std_logic_vector(31 downto 0)
);
- long_start_alu <= to_bit(NOT memmaskmux(3));
+ long_start_alu <= to_bit(NOT memmaskmux(3));
+ execOPC_ALU <= execOPC OR exec(alu_exec);
+ process (memmaskmux)
+ begin
+ non_aligned <= '0';
+ if (memmaskmux(5 downto 4) = "01") or (memmaskmux(5 downto 4) = "10") then
+ non_aligned <= '1';
+ end if;
+ end process;
-----------------------------------------------------------------------------
-- Bus control
-----------------------------------------------------------------------------
+ regin_out <= regin;
+
+
nWr <= '0' WHEN state="11" ELSE '1';
busstate <= state;
- nResetOut <= '0' WHEN exec(opcRESET)='1' ELSE '1';
-
- -- does shift for byte access. Note active low me
- -- should produce address error on 68000
- memmaskmux <= memmask WHEN addr(0)='1' ELSE memmask(4 downto 0)&'1';
-
+ nResetOut <= '0' WHEN exec(opcRESET)='1' ELSE '1';
+
+ -- does shift for byte access. note active low me
+ -- should produce address error on 68000
+ memmaskmux <= memmask when addr(0) = '1' else memmask(4 downto 0) & '1';
nUDS <= memmaskmux(5);
nLDS <= memmaskmux(4);
-
- -- drive output data, output bytes on both half-words during byte write
- data_write( 7 downto 0) <= data_write_i( 7 downto 0) WHEN memmaskmux(4)='0' ELSE data_write_i(15 downto 8);
- data_write(15 downto 8) <= data_write_i(15 downto 8) WHEN memmaskmux(5)='0' ELSE data_write_i( 7 downto 0);
-
- clkena_lw <= '1' WHEN clkena_in='1' AND memmaskmux(3)='1' ELSE '0'; -- step
+ clkena_lw <= '1' WHEN clkena_in='1' AND memmaskmux(3)='1' ELSE '0';
clr_berr <= '1' WHEN setopcode='1' AND trap_berr='1' ELSE '0';
-
+
PROCESS (clk, nReset)
BEGIN
IF nReset='0' THEN
syncReset <= "0000";
- Reset <= '1';
- ELSIF rising_edge(clk) THEN
+ Reset <= '1';
+ ELSIF rising_edge(clk) THEN
IF clkena_in='1' THEN
syncReset <= syncReset(2 downto 0)&'1';
- Reset <= NOT syncReset(3);
+ Reset <= NOT syncReset(3);
END IF;
END IF;
- END PROCESS;
-
+ IF rising_edge(clk) THEN
+ IF VBR_Stackframe=1 or (cpu(0)='1' and VBR_Stackframe=2) THEN
+ use_VBR_Stackframe<='1';
+ ELSE
+ use_VBR_Stackframe<='0';
+ END IF;
+ END IF;
+ END PROCESS;
+
PROCESS (clk, long_done, last_data_in, data_in, addr, long_start, memmaskmux, memread, memmask, data_read)
BEGIN
IF memmaskmux(4)='0' THEN
@@ -380,20 +464,20 @@ PROCESS (clk, long_done, last_data_in, data_in, addr, long_start, memmaskmux, me
END IF;
IF memread(0)='1' OR (memread(1 downto 0)="10" AND memmaskmux(4)='1')THEN
data_read(31 downto 16) <= (OTHERS=>data_read(15));
- END IF;
-
- IF rising_edge(clk) THEN
+ END IF;
+
+ IF rising_edge(clk) THEN
IF clkena_lw='1' AND state="10" THEN
IF memmaskmux(4)='0' THEN
bf_ext_in <= last_data_in(23 downto 16);
ELSE
bf_ext_in <= last_data_in(31 downto 24);
END IF;
- END IF;
+ END IF;
IF Reset='1' THEN
last_data_read <= (OTHERS => '0');
ELSIF clkena_in='1' THEN
- IF state="00" OR exec(update_ld)='1' THEN
+ IF state="00" OR exec(update_ld)='1' THEN
last_data_read <= data_read;
IF state(1)='0' AND memmask(1)='0' THEN
last_data_read(31 downto 16) <= last_opc_read;
@@ -402,205 +486,220 @@ PROCESS (clk, long_done, last_data_in, data_in, addr, long_start, memmaskmux, me
END IF;
END IF;
last_data_in <= last_data_in(15 downto 0)&data_in(15 downto 0);
-
+
END IF;
END IF;
long_start <= to_bit(NOT memmask(1));
long_done <= to_bit(NOT memread(1));
END PROCESS;
-
-PROCESS (long_start, reg_QB, data_write_tmp, exec, data_read, data_write_mux, memmaskmux, bf_ext_out,
+
+PROCESS (long_start, reg_QB, data_write_tmp, exec, data_read, data_write_mux, memmaskmux, bf_ext_out,
data_write_muxin, memmask, oddout, addr)
BEGIN
IF exec(write_reg)='1' THEN
data_write_muxin <= reg_QB;
ELSE
data_write_muxin <= data_write_tmp;
- END IF;
-
- IF BitField=0 THEN
- IF oddout=addr(0) THEN
- data_write_mux <= "XXXXXXXX"&"XXXXXXXX"&data_write_muxin;
- ELSE
- data_write_mux <= "XXXXXXXX"&data_write_muxin&"XXXXXXXX";
- END IF;
- ELSE
- IF oddout=addr(0) THEN
- data_write_mux <= "XXXXXXXX"&bf_ext_out&data_write_muxin;
- ELSE
- data_write_mux <= bf_ext_out&data_write_muxin&"XXXXXXXX";
- END IF;
- END IF;
-
- IF memmaskmux(1)='0' THEN
- data_write_i <= data_write_mux(47 downto 32);
- ELSIF memmaskmux(3)='0' THEN
- data_write_i <= data_write_mux(31 downto 16);
- ELSE
- data_write_i <= data_write_mux(15 downto 0);
- END IF;
- IF exec(mem_byte)='1' THEN --movep
- data_write_i(7 downto 0) <= data_write_tmp(15 downto 8);
+ END IF;
+
+ IF BitField=0 THEN
+ IF oddout=addr(0) THEN
+ data_write_mux <= "--------"&"--------"&data_write_muxin;
+ ELSE
+ data_write_mux <= "--------"&data_write_muxin&"--------";
+ END IF;
+ ELSE
+ IF oddout=addr(0) THEN
+ data_write_mux <= "--------"&bf_ext_out&data_write_muxin;
+ ELSE
+ data_write_mux <= bf_ext_out&data_write_muxin&"--------";
+ END IF;
+ END IF;
+
+ IF memmaskmux(1)='0' THEN
+ data_write <= data_write_mux(47 downto 32);
+ ELSIF memmaskmux(3)='0' THEN
+ data_write <= data_write_mux(31 downto 16);
+ ELSE
+-- a single byte shows up on both bus halfs
+ IF memmaskmux(5 downto 4) = "10" THEN
+ data_write <= data_write_mux(7 downto 0) & data_write_mux(7 downto 0);
+ ELSIF memmaskmux(5 downto 4) = "01" THEN
+ data_write <= data_write_mux(15 downto 8) & data_write_mux(15 downto 8);
+ ELSE
+ data_write <= data_write_mux(15 downto 0);
+ END IF;
+ END IF;
+ IF exec(mem_byte)='1' THEN --movep
+ data_write(7 downto 0) <= data_write_tmp(15 downto 8);
END IF;
END PROCESS;
-
------------------------------------------------------------------------------
--- Registerfile
------------------------------------------------------------------------------
-PROCESS (clk, regfile, RDindex_A, RDindex_B, exec)
- BEGIN
- reg_QA <= regfile(RDindex_A);
- reg_QB <= regfile(RDindex_B);
- IF rising_edge(clk) THEN
- IF clkena_lw='1' THEN
- rf_source_addrd <= rf_source_addr;
- WR_AReg <= rf_dest_addr(3);
- RDindex_A <= conv_integer(rf_dest_addr(3 downto 0));
- RDindex_B <= conv_integer(rf_source_addr(3 downto 0));
- IF Wwrena='1' THEN
- regfile(RDindex_A) <= regin;
- END IF;
-
- IF exec(to_USP)='1' THEN
- USP <= reg_QA;
- END IF;
- END IF;
- END IF;
- END PROCESS;
-
------------------------------------------------------------------------------
--- Write Reg
------------------------------------------------------------------------------
-PROCESS (OP1in, reg_QA, Regwrena_now, Bwrena, Lwrena, exe_datatype, WR_AReg, movem_actiond, exec, ALUout, memaddr, memaddr_a, ea_only, USP, movec_data)
- BEGIN
- regin <= ALUout;
- IF exec(save_memaddr)='1' THEN
- regin <= memaddr;
- ELSIF exec(get_ea_now)='1' AND ea_only='1' THEN
- regin <= memaddr_a;
- ELSIF exec(from_USP)='1' THEN
- regin <= USP;
- ELSIF exec(movec_rd)='1' THEN
- regin <= movec_data;
- END IF;
-
- IF Bwrena='1' THEN
- regin(15 downto 8) <= reg_QA(15 downto 8);
- END IF;
- IF Lwrena='0' THEN
- regin(31 downto 16) <= reg_QA(31 downto 16);
- END IF;
-
- Bwrena <= '0';
- Wwrena <= '0';
- Lwrena <= '0';
- IF exec(presub)='1' OR exec(postadd)='1' OR exec(changeMode)='1' THEN -- -(An)+
- Wwrena <= '1';
- Lwrena <= '1';
- ELSIF Regwrena_now='1' THEN --dbcc
- Wwrena <= '1';
- ELSIF exec(Regwrena)='1' THEN --read (mem)
- Wwrena <= '1';
- CASE exe_datatype IS
- WHEN "00" => --BYTE
- Bwrena <= '1';
- WHEN "01" => --WORD
- IF WR_AReg='1' OR movem_actiond='1' THEN
- Lwrena <='1';
- END IF;
- WHEN OTHERS => --LONG
- Lwrena <= '1';
- END CASE;
- END IF;
- END PROCESS;
-
+
+-----------------------------------------------------------------------------
+-- Registerfile
+-----------------------------------------------------------------------------
+PROCESS (clk, regfile, RDindex_A, RDindex_B, exec)
+ BEGIN
+ reg_QA <= regfile(RDindex_A);
+ reg_QB <= regfile(RDindex_B);
+ IF rising_edge(clk) THEN
+ IF clkena_lw='1' THEN
+ rf_source_addrd <= rf_source_addr;
+ WR_AReg <= rf_dest_addr(3);
+ RDindex_A <= conv_integer(rf_dest_addr(3 downto 0));
+ RDindex_B <= conv_integer(rf_source_addr(3 downto 0));
+ IF Wwrena='1' THEN
+ regfile(RDindex_A) <= regin;
+ END IF;
+
+ IF exec(to_USP)='1' THEN
+ USP <= reg_QA;
+ END IF;
+ END IF;
+ END IF;
+ END PROCESS;
+
+-----------------------------------------------------------------------------
+-- Write Reg
+-----------------------------------------------------------------------------
+PROCESS (OP1in, reg_QA, Regwrena_now, Bwrena, Lwrena, exe_datatype, WR_AReg, movem_actiond, exec, ALUout, memaddr, memaddr_a, ea_only, USP, movec_data)
+ BEGIN
+ regin <= ALUout;
+ IF exec(save_memaddr)='1' THEN
+ regin <= memaddr;
+ ELSIF exec(get_ea_now)='1' AND ea_only='1' THEN
+ regin <= memaddr_a;
+ ELSIF exec(from_USP)='1' THEN
+ regin <= USP;
+ ELSIF exec(movec_rd)='1' THEN
+ regin <= movec_data;
+ END IF;
+
+ IF Bwrena='1' THEN
+ regin(15 downto 8) <= reg_QA(15 downto 8);
+ END IF;
+ IF Lwrena='0' THEN
+ regin(31 downto 16) <= reg_QA(31 downto 16);
+ END IF;
+
+ Bwrena <= '0';
+ Wwrena <= '0';
+ Lwrena <= '0';
+ IF exec(presub)='1' OR exec(postadd)='1' OR exec(changeMode)='1' THEN -- -(An)+
+ Wwrena <= '1';
+ Lwrena <= '1';
+ ELSIF Regwrena_now='1' THEN --dbcc
+ Wwrena <= '1';
+ ELSIF exec(Regwrena)='1' THEN --read (mem)
+ Wwrena <= '1';
+ CASE exe_datatype IS
+ WHEN "00" => --BYTE
+ Bwrena <= '1';
+ WHEN "01" => --WORD
+ IF WR_AReg='1' OR movem_actiond='1' THEN
+ Lwrena <='1';
+ END IF;
+ WHEN OTHERS => --LONG
+ Lwrena <= '1';
+ END CASE;
+ END IF;
+ END PROCESS;
+
-----------------------------------------------------------------------------
-- set dest regaddr
-----------------------------------------------------------------------------
-PROCESS (opcode, rf_source_addrd, brief, setstackaddr, dest_hbits, dest_areg, data_is_source, sndOPC, exec, set, dest_2ndHbits)
+PROCESS (opcode, rf_source_addrd, brief, setstackaddr, dest_hbits, dest_areg, dest_LDRareg, data_is_source, sndOPC, exec, set, dest_2ndHbits, dest_2ndLbits, dest_LDRHbits, dest_LDRLbits, last_data_read)
BEGIN
IF exec(movem_action) ='1' THEN
rf_dest_addr <= rf_source_addrd;
ELSIF set(briefext)='1' THEN
rf_dest_addr <= brief(15 downto 12);
- ELSIF set(get_bfoffset)='1' THEN
- rf_dest_addr <= sndOPC(9 downto 6);
+ ELSIF set(get_bfoffset)='1' THEN
+-- IF opcode(15 downto 12)="1110" THEN
+ rf_dest_addr <= '0'&sndOPC(8 downto 6);
+-- ELSE
+-- rf_dest_addr <= sndOPC(9 downto 6);
+-- END IF;
ELSIF dest_2ndHbits='1' THEN
- rf_dest_addr <= sndOPC(15 downto 12);
- ELSIF set(write_reminder)='1' THEN
- rf_dest_addr <= sndOPC(3 downto 0);
- ELSIF setstackaddr='1' THEN
+ rf_dest_addr <= dest_LDRareg&sndOPC(14 downto 12);
+ ELSIF dest_LDRHbits='1' THEN
+ rf_dest_addr <= last_data_read(15 downto 12);
+ ELSIF dest_LDRLbits='1' THEN
+ rf_dest_addr <= '0'&last_data_read(2 downto 0);
+ ELSIF dest_2ndLbits='1' THEN
+ rf_dest_addr <= '0'&sndOPC(2 downto 0);
+ ELSIF setstackaddr='1' THEN
rf_dest_addr <= "1111";
- ELSIF dest_hbits='1' THEN
+ ELSIF dest_hbits='1' THEN
rf_dest_addr <= dest_areg&opcode(11 downto 9);
ELSE
- IF opcode(5 downto 3)="000" OR data_is_source='1' THEN
+ IF opcode(5 downto 3)="000" OR data_is_source='1' THEN
rf_dest_addr <= dest_areg&opcode(2 downto 0);
ELSE
rf_dest_addr <= '1'&opcode(2 downto 0);
END IF;
- END IF;
+ END IF;
END PROCESS;
-
+
-----------------------------------------------------------------------------
-- set source regaddr
-----------------------------------------------------------------------------
-PROCESS (opcode, movem_presub, movem_regaddr, source_lowbits, source_areg, sndOPC, exec, set, source_2ndLbits, source_2ndHbits)
+PROCESS (opcode, movem_presub, movem_regaddr, source_lowbits, source_areg, sndOPC, exec, set, source_2ndLbits, source_2ndHbits, source_LDRLbits, source_LDRMbits, last_data_read, source_2ndMbits)
BEGIN
IF exec(movem_action)='1' OR set(movem_action) ='1' THEN
IF movem_presub='1' THEN
rf_source_addr <= movem_regaddr XOR "1111";
ELSE
rf_source_addr <= movem_regaddr;
- END IF;
+ END IF;
ELSIF source_2ndLbits='1' THEN
- rf_source_addr <= sndOPC(3 downto 0);
+ rf_source_addr <= '0'&sndOPC(2 downto 0);
ELSIF source_2ndHbits='1' THEN
- rf_source_addr <= sndOPC(15 downto 12);
+ rf_source_addr <= '0'&sndOPC(14 downto 12);
+ ELSIF source_2ndMbits='1' THEN
+ rf_source_addr <= '0'&sndOPC(8 downto 6);
+ ELSIF source_LDRLbits='1' THEN
+ rf_source_addr <= '0'&last_data_read(2 downto 0);
+ ELSIF source_LDRMbits='1' THEN
+ rf_source_addr <= '0'&last_data_read(8 downto 6);
ELSIF source_lowbits='1' THEN
rf_source_addr <= source_areg&opcode(2 downto 0);
ELSIF exec(linksp)='1' THEN
rf_source_addr <= "1111";
ELSE
rf_source_addr <= source_areg&opcode(11 downto 9);
- END IF;
+ END IF;
END PROCESS;
-
+
-----------------------------------------------------------------------------
-- set OP1out
-----------------------------------------------------------------------------
-PROCESS (reg_QA, store_in_tmp, ea_data, long_start, addr, exec, memmaskmux, data_write_tmp)
+PROCESS (reg_QA, store_in_tmp, ea_data, long_start, addr, exec, memmaskmux)
BEGIN
OP1out <= reg_QA;
IF exec(OP1out_zero)='1' THEN
- OP1out <= (OTHERS => '0');
+ OP1out <= (OTHERS => '0');
ELSIF exec(ea_data_OP1)='1' AND store_in_tmp='1' THEN
OP1out <= ea_data;
- ELSIF exec(opcPACK)='1' THEN
- OP1out <= data_write_tmp;
- ELSIF exec(movem_action)='1' OR memmaskmux(3)='0' OR exec(OP1addr)='1' THEN
+ ELSIF exec(movem_action)='1' OR memmaskmux(3)='0' OR exec(OP1addr)='1' THEN
OP1out <= addr;
END IF;
END PROCESS;
-
+
-----------------------------------------------------------------------------
-- set OP2out
-----------------------------------------------------------------------------
-PROCESS (OP2out, reg_QB, exe_opcode, exe_datatype, execOPC, exec, use_direct_data,
- store_in_tmp, data_write_tmp, ea_data)
+PROCESS (OP2out, reg_QB, exe_opcode, exe_datatype, execOPC, exec, use_direct_data,
+ store_in_tmp, data_write_tmp, ea_data)
BEGIN
OP2out(15 downto 0) <= reg_QB(15 downto 0);
OP2out(31 downto 16) <= (OTHERS => OP2out(15));
IF exec(OP2out_one)='1' THEN
OP2out(15 downto 0) <= "1111111111111111";
- ELSIF exec(opcEXT)='1' THEN
- IF exe_opcode(6)='0' OR exe_opcode(8)='1' THEN --ext.w
- OP2out(15 downto 8) <= (OTHERS => OP2out(7));
- END IF;
- ELSIF (use_direct_data='1' AND exec(opcPACK)='0') OR (exec(exg)='1' AND execOPC='1') OR exec(get_bfoffset)='1' THEN
- OP2out <= data_write_tmp;
+ ELSIF use_direct_data='1' OR (exec(exg)='1' AND execOPC='1') OR exec(get_bfoffset)='1' THEN
+ OP2out <= data_write_tmp;
ELSIF (exec(ea_data_OP1)='0' AND store_in_tmp='1') OR exec(ea_data_OP2)='1' THEN
- OP2out <= ea_data;
+ OP2out <= ea_data;
ELSIF exec(opcMOVEQ)='1' THEN
OP2out(7 downto 0) <= exe_opcode(7 downto 0);
OP2out(15 downto 8) <= (OTHERS => exe_opcode(7));
@@ -612,84 +711,95 @@ PROCESS (OP2out, reg_QB, exe_opcode, exe_datatype, execOPC, exec, use_direct_dat
OP2out(3) <='0';
END IF;
OP2out(15 downto 4) <= (OTHERS => '0');
- ELSIF exe_datatype="10" THEN
+ ELSIF exe_datatype="10" AND exec(opcEXT)='0' THEN
OP2out(31 downto 16) <= reg_QB(31 downto 16);
END IF;
+ IF exec(opcEXTB)='1' THEN
+ OP2out(31 downto 8) <= (OTHERS => OP2out(7));
+ END IF;
END PROCESS;
-
+
-----------------------------------------------------------------------------
-- handle EA_data, data_write
-----------------------------------------------------------------------------
PROCESS (clk)
BEGIN
- IF rising_edge(clk) THEN
+ IF rising_edge(clk) THEN
IF Reset = '1' THEN
store_in_tmp <='0';
- exec_write_back <= '0';
direct_data <= '0';
use_direct_data <= '0';
Z_error <= '0';
ELSIF clkena_lw='1' THEN
+ useStackframe2<='0';
direct_data <= '0';
- IF state="11" THEN
- exec_write_back <= '0';
- ELSIF setstate="10" AND write_back='1' THEN
- exec_write_back <= '1';
+ IF exec(hold_OP2)='1' THEN
+ use_direct_data <= '1';
END IF;
-
-
IF set_direct_data='1' THEN
- direct_data <= '1';
- IF set_exec(opcPACK)='1' THEN
- use_direct_data <= '0';
- ELSE
- use_direct_data <= '1';
- END IF;
- ELSIF endOPC='1' THEN
+ direct_data <= '1';
+ use_direct_data <= '1';
+ ELSIF endOPC='1' OR set(ea_data_OP2)='1' THEN
use_direct_data <= '0';
- END IF;
+ END IF;
exec_DIRECT <= set_exec(opcMOVE);
-
+
IF endOPC='1' THEN
store_in_tmp <='0';
Z_error <= '0';
ELSE
IF set_Z_error='1' THEN
Z_error <= '1';
- END IF;
+ END IF;
IF set_exec(opcMOVE)='1' AND state="11" THEN
use_direct_data <= '1';
END IF;
- IF state="10" THEN
- store_in_tmp <= '1';
+ IF state="10" OR exec(store_ea_packdata)='1' THEN
+ store_in_tmp <= '1';
END IF;
IF direct_data='1' AND state="00" THEN
- store_in_tmp <= '1';
- END IF;
- END IF;
- IF state="10" THEN
+ store_in_tmp <= '1';
+ END IF;
+ END IF;
+
+ IF state="10" AND exec(hold_ea_data)='0' THEN
ea_data <= data_read;
- ELSIF exec(get_2ndOPC)='1' OR set_PCbase='1' THEN --TH cmpi (d16,PC) fix
+ ELSIF exec(get_2ndOPC)='1' THEN
ea_data <= addr;
ELSIF exec(store_ea_data)='1' OR (direct_data='1' AND state="00") THEN
ea_data <= last_data_read;
- END IF;
-
+ END IF;
+
IF writePC='1' THEN
data_write_tmp <= TG68_PC;
ELSIF exec(writePC_add)='1' THEN
data_write_tmp <= TG68_PC_add;
- ELSIF micro_state=trap0 THEN
- data_write_tmp(15 downto 0) <= trap_vector(15 downto 0);
- ELSIF exec(hold_dwr)='1' THEN
+-- paste and copy form TH ---------
+ elsif micro_state=trap00 THEN
+ data_write_tmp <= exe_pc; --TH
+ useStackframe2<='1';
+ elsif micro_state = trap0 then
+ -- this is only active for 010+ since in 000 writePC is
+ -- true in state trap0
+-- if trap_trace='1' or set_exec(opcTRAPV)='1' or Z_error='1' then
+ IF useStackframe2='1' THEN
+ -- stack frame format #2
+ data_write_tmp(15 downto 0) <= "0010" & trap_vector(11 downto 0); --TH
+ else
+ data_write_tmp(15 downto 0) <= "0000" & trap_vector(11 downto 0);
+ end if;
+------------------------------------
+-- ELSIF micro_state=trap0 THEN
+-- data_write_tmp(15 downto 0) <= trap_vector(15 downto 0);
+ ELSIF exec(hold_dwr)='1' THEN
data_write_tmp <= data_write_tmp;
- ELSIF exec(exg)='1' THEN
+ ELSIF exec(exg)='1' THEN
data_write_tmp <= OP1out;
- ELSIF exec(get_ea_now)='1' AND ea_only='1' THEN -- ist for pea
+ ELSIF exec(get_ea_now)='1' AND ea_only='1' THEN -- ist for pea
data_write_tmp <= addr;
- ELSIF execOPC='1' or micro_state=pack2 THEN
+ ELSIF execOPC='1' THEN
data_write_tmp <= ALUout;
ELSIF (exec_DIRECT='1' AND state="10") THEN
data_write_tmp <= data_read;
@@ -702,13 +812,13 @@ PROCESS (clk)
data_write_tmp <= last_data_read;
ELSIF writeSR='1'THEN
data_write_tmp(15 downto 0) <= trap_SR(7 downto 0)& Flags(7 downto 0);
- ELSE
+ ELSE
data_write_tmp <= OP2out;
END IF;
- END IF;
- END IF;
+ END IF;
+ END IF;
END PROCESS;
-
+
-----------------------------------------------------------------------------
-- brief
-----------------------------------------------------------------------------
@@ -721,7 +831,7 @@ PROCESS (brief, OP1out, OP1outbrief, cpu)
END IF;
briefdata <= OP1outbrief&OP1out(15 downto 0);
IF extAddr_Mode=1 OR (cpu(1)='1' AND extAddr_Mode=2) THEN
- CASE brief(10 downto 9) IS -- mikej SCALE factor
+ CASE brief(10 downto 9) IS
WHEN "00" => briefdata <= OP1outbrief&OP1out(15 downto 0);
WHEN "01" => briefdata <= OP1outbrief(14 downto 0)&OP1out(15 downto 0)&'0';
WHEN "10" => briefdata <= OP1outbrief(13 downto 0)&OP1out(15 downto 0)&"00";
@@ -732,60 +842,59 @@ PROCESS (brief, OP1out, OP1outbrief, cpu)
END PROCESS;
-----------------------------------------------------------------------------
--- MEM_IO
+-- MEM_IO
-----------------------------------------------------------------------------
-PROCESS (clk, setdisp, memaddr_a, briefdata, memaddr_delta, setdispbyte, datatype, interrupt, rIPL_nr, IPL_vec,
- memaddr_reg, reg_QA, use_base, VBR, last_data_read, trap_vector, exec, set, cpu)
+PROCESS (clk, setdisp, memaddr_a, briefdata, memaddr_delta, setdispbyte, datatype, interrupt, rIPL_nr, IPL_vec,
+ memaddr_reg, reg_QA, use_base, VBR, last_data_read, trap_vector, exec, set, cpu, use_VBR_Stackframe)
BEGIN
-
+
IF rising_edge(clk) THEN
- IF clkena_lw='1' THEN
- trap_vector(31 downto 8) <= (others => '0');
+ IF clkena_lw='1' THEN
+ trap_vector(31 downto 10) <= (others => '0');
IF trap_berr='1' THEN
- trap_vector(7 downto 0) <= X"08";
+ trap_vector(9 downto 0) <= "00" & X"08";
END IF;
IF trap_addr_error='1' THEN
- trap_vector(7 downto 0) <= X"0C";
- END IF;
+ trap_vector(9 downto 0) <= "00" & X"0C";
+ END IF;
IF trap_illegal='1' THEN
- trap_vector(7 downto 0) <= X"10";
- END IF;
- IF z_error='1' THEN
- trap_vector(7 downto 0) <= X"14";
- END IF;
+ trap_vector(9 downto 0) <= "00" & X"10";
+ END IF;
+ IF set_Z_error='1' THEN
+ trap_vector(9 downto 0) <= "00" & X"14";
+ END IF;
IF exec(trap_chk)='1' THEN
- trap_vector(7 downto 0) <= X"18";
- END IF;
+ trap_vector(9 downto 0) <= "00" & X"18";
+ END IF;
IF trap_trapv='1' THEN
- trap_vector(7 downto 0) <= X"1C";
- END IF;
+ trap_vector(9 downto 0) <= "00" & X"1C";
+ END IF;
IF trap_priv='1' THEN
- trap_vector(7 downto 0) <= X"20";
- END IF;
+ trap_vector(9 downto 0) <= "00" & X"20";
+ END IF;
IF trap_trace='1' THEN
- trap_vector(7 downto 0) <= X"24";
- END IF;
+ trap_vector(9 downto 0) <= "00" & X"24";
+ END IF;
IF trap_1010='1' THEN
- trap_vector(7 downto 0) <= X"28";
- END IF;
+ trap_vector(9 downto 0) <= "00" & X"28";
+ END IF;
IF trap_1111='1' THEN
- trap_vector(7 downto 0) <= X"2C";
- END IF;
+ trap_vector(9 downto 0) <= "00" & X"2C";
+ END IF;
IF trap_trap='1' THEN
- trap_vector(7 downto 0) <= "10"&opcode(3 downto 0)&"00";
- END IF;
- IF trap_interrupt='1' THEN
- trap_vector(9 downto 0) <= IPL_vec & "00"; --TH
- END IF;
- -- TH TODO: non-autovector IRQs
+ trap_vector(9 downto 0) <= "0010" & opcode(3 downto 0) & "00";
+ END IF;
+ IF trap_interrupt='1' or set_vectoraddr = '1' THEN
+ trap_vector(9 downto 0) <= IPL_vec & "00"; --TH
+ END IF;
END IF;
END IF;
- IF VBR_Stackframe=0 OR (cpu(0)='0' AND VBR_Stackframe=2) THEN
- trap_vector_vbr <= trap_vector;
- ELSE
+ IF use_VBR_Stackframe='1' THEN
trap_vector_vbr <= trap_vector+VBR;
- END IF;
-
+ ELSE
+ trap_vector_vbr <= trap_vector;
+ END IF;
+
memaddr_a(4 downto 0) <= "00000";
memaddr_a(7 downto 5) <= (OTHERS=>memaddr_a(4));
memaddr_a(15 downto 8) <= (OTHERS=>memaddr_a(7));
@@ -797,36 +906,28 @@ PROCESS (clk, setdisp, memaddr_a, briefdata, memaddr_delta, setdispbyte, datatyp
memaddr_a(7 downto 0) <= last_data_read(7 downto 0);
ELSE
memaddr_a <= last_data_read;
- END IF;
+ END IF;
ELSIF set(presub)='1' THEN
- IF set(longaktion)='1' THEN
+ IF set(longaktion)='1' THEN
memaddr_a(4 downto 0) <= "11100";
ELSIF datatype="00" AND set(use_SP)='0' THEN
memaddr_a(4 downto 0) <= "11111";
ELSE
memaddr_a(4 downto 0) <= "11110";
- END IF;
+ END IF;
ELSIF interrupt='1' THEN
- memaddr_a(4 downto 0) <= '1'&rIPL_nr&'0';
- END IF;
-
+ memaddr_a(4 downto 0) <= '1'&rIPL_nr&'0';
+ END IF;
+
IF rising_edge(clk) THEN
IF clkena_in='1' THEN
IF exec(get_2ndOPC)='1' OR (state="10" AND memread(0)='1') THEN
tmp_TG68_PC <= addr;
END IF;
- use_base <= '0';
-
- IF memmaskmux(3)='0' THEN
- memaddr_delta <= addsub_q;
- ELSIF exec(mem_addsub)='1' THEN
- -- note, this should give an exception for 68000
- if exec(movem_action) = '1' and memmaskmux(3) = '1' and (memmaskmux(5 downto 4) = "10" or memmaskmux(5 downto 4) = "01") and (movem_presub = '0') then
- memaddr_delta <= addr; -- hold for non-aligned case, only when incrementing
- else
- memaddr_delta <= addsub_q;
- end if;
- ELSIF state="01" AND exec_write_back='1' THEN
+ use_base <= '0';
+ IF memmaskmux(3)='0' OR exec(mem_addsub)='1' THEN
+ memaddr_delta <= addsub_q;
+ ELSIF set(restore_ADDR)='1' THEN
memaddr_delta <= tmp_TG68_PC;
ELSIF exec(direct_delta)='1' THEN
memaddr_delta <= data_read;
@@ -834,46 +935,51 @@ PROCESS (clk, setdisp, memaddr_a, briefdata, memaddr_delta, setdispbyte, datatyp
memaddr_delta <= addr;
ELSIF set(addrlong)='1' THEN
memaddr_delta <= last_data_read;
- ELSIF setstate="00" THEN
+ ELSIF setstate="00" THEN
memaddr_delta <= TG68_PC_add;
ELSIF exec(dispouter)='1' THEN
memaddr_delta <= ea_data+memaddr_a;
- ELSIF set_vectoraddr='1' THEN
+ ELSIF set_vectoraddr='1' THEN
memaddr_delta <= trap_vector_vbr;
- ELSE
+ ELSE
memaddr_delta <= memaddr_a;
IF interrupt='0' AND Suppress_Base='0' THEN
--- IF interrupt='0' AND Suppress_Base='0' AND setstate(1)='1' THEN
+-- IF interrupt='0' AND Suppress_Base='0' AND setstate(1)='1' THEN
use_base <= '1';
+ END IF;
+ END IF;
+
+ -- only used for movem address update
+-- IF (long_done='0' AND state(1)='1') OR movem_presub='0' THEN
+ if ((memread(0) = '1') and state(1) = '1') or movem_presub = '0' then -- fix for unaligned movem mikej
+ memaddr <= addr;
END IF;
- END IF;
-
- IF (long_done='0' AND state(1)='1') OR movem_presub='0' THEN
- memaddr <= addr;
- END IF;
END IF;
END IF;
- -- if access done, and not aligned, don't increment
+
+ -- if access done, and not aligned, don't increment
addr <= memaddr_reg+memaddr_delta;
+ addr_out <= memaddr_reg + memaddr_delta;
+
IF use_base='0' THEN
memaddr_reg <= (others=>'0');
- ELSE
+ ELSE
memaddr_reg <= reg_QA;
- END IF;
- END PROCESS;
-
+ END IF;
+ END PROCESS;
+
-----------------------------------------------------------------------------
-- PC Calc + fetch opcode
-----------------------------------------------------------------------------
-PROCESS (clk, IPL, setstate, state, exec_write_back, set_direct_data, next_micro_state, stop, make_trace, make_berr, IPL_nr, FlagsSR, set_rot_cnt, opcode, writePCbig, set_exec, exec,
- PC_dataa, PC_datab, setnextpass, last_data_read, TG68_PC_brw, TG68_PC_word, Z_error, trap_trap, trap_trapv, interrupt, tmp_TG68_PC, TG68_PC)
+PROCESS (clk, IPL, setstate, addrvalue, state, exec_write_back, set_direct_data, next_micro_state, stop, make_trace, make_berr, IPL_nr, FlagsSR, set_rot_cnt, opcode, writePCbig, set_exec, exec,
+ PC_dataa, PC_datab, setnextpass, last_data_read, TG68_PC_brw, TG68_PC_word, Z_error, trap_trap, trap_trapv, interrupt, tmp_TG68_PC, TG68_PC)
BEGIN
-
+
PC_dataa <= TG68_PC;
IF TG68_PC_brw = '1' THEN
PC_dataa <= tmp_TG68_PC;
END IF;
-
+
PC_datab(2 downto 0) <= (others => '0');
PC_datab(3) <= PC_datab(2);
PC_datab(7 downto 4) <= (others => PC_datab(3));
@@ -886,16 +992,16 @@ PROCESS (clk, IPL, setstate, state, exec_write_back, set_direct_data, next_micro
IF writePCbig='1' THEN
PC_datab(3) <= '1';
PC_datab(1) <= '1';
- ELSE
+ ELSE
PC_datab(2) <= '1';
END IF;
- IF trap_trap='1' OR trap_trapv='1' OR exec(trap_chk)='1' OR Z_error='1' THEN
+ IF trap_trap='1' OR trap_trapv='1' OR exec(trap_chk)='1' OR Z_error='1' THEN
PC_datab(1) <= '1';
END IF;
ELSIF state="00" THEN
PC_datab(1) <= '1';
- END IF;
- IF TG68_PC_brw = '1' THEN
+ END IF;
+ IF TG68_PC_brw = '1' THEN
IF TG68_PC_word='1' THEN
PC_datab <= last_data_read;
ELSE
@@ -904,126 +1010,149 @@ PROCESS (clk, IPL, setstate, state, exec_write_back, set_direct_data, next_micro
END IF;
TG68_PC_add <= PC_dataa+PC_datab;
-
+
setopcode <= '0';
setendOPC <= '0';
setinterrupt <= '0';
IF setstate="00" AND next_micro_state=idle AND setnextpass='0' AND (exec_write_back='0' OR state="11") AND set_rot_cnt="000001" AND set_exec(opcCHK)='0'THEN
setendOPC <= '1';
- IF FlagsSR(2 downto 0) '0');
+ bf_full_offset(4 downto 0) <= sndOPC(10 downto 6);
+ END IF;
+
bf_width(5) <= '0';
IF sndOPC(5)='1' THEN
bf_width(4 downto 0) <= reg_QB(4 downto 0)-1;
ELSE
bf_width(4 downto 0) <= sndOPC(4 downto 0)-1;
- END IF;
+ END IF;
bf_bhits <= bf_width+bf_offset;
set_oddout <= NOT bf_bhits(3);
-
+
+
+-- bf_loffset is used for the shifted_bitmask
IF opcode(10 downto 8)="111" THEN --INS
bf_loffset <= 32-bf_shift;
ELSE
bf_loffset <= bf_shift;
END IF;
bf_loffset(5) <= '0';
-
+
IF opcode(4 downto 3)="00" THEN
IF opcode(10 downto 8)="111" THEN --INS
bf_shift <= bf_bhits+1;
@@ -1155,34 +1298,35 @@ PROCESS (clk, Reset, sndOPC, reg_QA, reg_QB, bf_width, bf_offset, bf_bhits, opco
END IF;
bf_shift(5) <= '0';
ELSE
- IF opcode(10 downto 8)="111" THEN --INS
- bf_shift <= "011"&("001"+bf_bhits(2 downto 0));
+ IF opcode(10 downto 8)="111" THEN --INS
+ bf_shift <= "011001"+("000"&bf_bhits(2 downto 0));
+ bf_shift(5) <= '0';
ELSE
bf_shift <= "000"&("111"-bf_bhits(2 downto 0));
END IF;
bf_offset(4 downto 3) <= "00";
END IF;
-
- CASE bf_bhits(5 downto 3) IS
- WHEN "000" =>
- set_memmask <= "101111";
- WHEN "001" =>
- set_memmask <= "100111";
- WHEN "010" =>
- set_memmask <= "100011";
- WHEN "011" =>
- set_memmask <= "100001";
- WHEN OTHERS =>
- set_memmask <= "100000";
- END CASE;
- IF setstate="00" THEN
+
+ CASE bf_bhits(5 downto 3) IS
+ WHEN "000" =>
+ set_memmask <= "101111";
+ WHEN "001" =>
set_memmask <= "100111";
- END IF;
- END PROCESS;
-
+ WHEN "010" =>
+ set_memmask <= "100011";
+ WHEN "011" =>
+ set_memmask <= "100001";
+ WHEN OTHERS =>
+ set_memmask <= "100000";
+ END CASE;
+ IF setstate="00" THEN
+ set_memmask <= "100111";
+ END IF;
+ END PROCESS;
+
------------------------------------------------------------------------------
--SR op
-------------------------------------------------------------------------------
+------------------------------------------------------------------------------
PROCESS (clk, Reset, FlagsSR, last_data_read, OP2out, exec)
BEGIN
IF exec(andiSR)='1' THEN
@@ -1191,27 +1335,26 @@ PROCESS (clk, Reset, FlagsSR, last_data_read, OP2out, exec)
SRin <= FlagsSR XOR last_data_read(15 downto 8);
ELSIF exec(oriSR)='1' THEN
SRin <= FlagsSR OR last_data_read(15 downto 8);
- ELSE
+ ELSE
SRin <= OP2out(15 downto 8);
- END IF;
-
+ END IF;
+
IF rising_edge(clk) THEN
IF Reset='1' THEN
- FlagsSR(5) <= '1';
FC(2) <= '1';
SVmode <= '1';
preSVmode <= '1';
- FlagsSR(2 downto 0) <= "111";
+ FlagsSR <= "00100111";
make_trace <= '0';
ELSIF clkena_lw = '1' THEN
IF setopcode='1' THEN
make_trace <= FlagsSR(7);
IF set(changeMode)='1' THEN
- SVmode <= NOT SVmode;
+ SVmode <= NOT SVmode;
ELSE
SVmode <= preSVmode;
- END IF;
- END IF;
+ END IF;
+ END IF;
IF set(changeMode)='1' THEN
preSVmode <= NOT preSVmode;
FlagsSR(5) <= NOT preSVmode;
@@ -1225,23 +1368,26 @@ PROCESS (clk, Reset, FlagsSR, last_data_read, OP2out, exec)
END IF;
IF exec(directSR)='1' OR set_stop='1' THEN
FlagsSR <= data_read(15 downto 8);
- END IF;
+ END IF;
IF interrupt='1' AND trap_interrupt='1' THEN
FlagsSR(2 downto 0) <=rIPL_nr;
- END IF;
--- IF exec(to_CCR)='1' AND exec(to_SR)='1' THEN
+ END IF;
IF exec(to_SR)='1' THEN
- FlagsSR(7 downto 0) <= SRin; --SR
+ FlagsSR(7 downto 0) <= SRin; --SR
FC(2) <= SRin(5);
--- END IF;
ELSIF exec(update_FC)='1' THEN
FC(2) <= FlagsSR(5);
END IF;
IF interrupt='1' THEN
FC(2) <= '1';
+ END IF;
+ IF cpu(1)='0' THEN
+ FlagsSR(4) <= '0';
+ FlagsSR(6) <= '0';
END IF;
+ FlagsSR(3) <= '0';
END IF;
- END IF;
+ END IF;
END PROCESS;
-----------------------------------------------------------------------------
@@ -1249,12 +1395,13 @@ PROCESS (clk, Reset, FlagsSR, last_data_read, OP2out, exec)
-----------------------------------------------------------------------------
PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state, decodeOPC, state, setexecOPC, Flags, FlagsSR, direct_data, build_logical,
build_bcd, set_Z_error, trapd, movem_run, last_data_read, set, set_V_Flag, z_error, trap_trace, trap_interrupt,
- SVmode, preSVmode, stop, long_done, ea_only, setstate, execOPC, exec_write_back, exe_datatype,
- datatype, interrupt, c_out, trapmake, rot_cnt, brief, addr,
+ SVmode, preSVmode, stop, long_done, ea_only, setstate, addrvalue, execOPC, exec_write_back, exe_datatype,
+ datatype, interrupt, c_out, trapmake, rot_cnt, brief, addr, trap_trapv, last_data_in, use_VBR_Stackframe,
long_start, set_datatype, sndOPC, set_exec, exec, ea_build_now, reg_QA, reg_QB, make_berr, trap_berr)
BEGIN
- TG68_PC_brw <= '0';
- setstate <= "00";
+ TG68_PC_brw <= '0';
+ setstate <= "00";
+ setaddrvalue <= '0';
Regwrena_now <= '0';
movem_presub <= '0';
setnextpass <= '0';
@@ -1262,20 +1409,28 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
setdisp <= '0';
setdispbyte <= '0';
getbrief <= '0';
- dest_areg <= '0';
+ dest_LDRareg <= '0';
+ dest_areg <= '0';
source_areg <= '0';
data_is_source <= '0';
write_back <= '0';
setstackaddr <= '0';
writePC <= '0';
ea_build_now <= '0';
- set_rot_bits <= "XX";
+-- set_rot_bits <= "00";
+ set_rot_bits <= opcode(4 downto 3);
set_rot_cnt <= "000001";
dest_hbits <= '0';
- source_lowbits <= '0';
+ source_lowbits <= '0';
+ source_LDRLbits <= '0';
+ source_LDRMbits <= '0';
source_2ndHbits <= '0';
+ source_2ndMbits <= '0';
source_2ndLbits <= '0';
+ dest_LDRHbits <= '0';
+ dest_LDRLbits <= '0';
dest_2ndHbits <= '0';
+ dest_2ndLbits <= '0';
ea_only <= '0';
set_direct_data <= '0';
set_exec_tas <= '0';
@@ -1290,6 +1445,9 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
set_vectoraddr <='0';
writeSR <= '0';
set_stop <= '0';
+-- illegal_write_mode <= '0';
+-- illegal_read_mode <= '0';
+-- illegal_byteaddr <= '0';
set_Z_error <= '0';
next_micro_state <= idle;
@@ -1297,80 +1455,102 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
build_bcd <= '0';
skipFetch <= make_berr;
set_writePCbig <= '0';
--- set_recall_last <= '0';
+-- set_recall_last <= '0';
set_Suppress_Base <= '0';
set_PCbase <= '0';
-
+
IF rot_cnt/="000001" THEN
set_rot_cnt <= rot_cnt-1;
- END IF;
+ END IF;
set_datatype <= datatype;
-
+
set <= (OTHERS=>'0');
set_exec <= (OTHERS=>'0');
set(update_ld) <= '0';
--- odd_start <= '0';
+-- odd_start <= '0';
------------------------------------------------------------------------------
--Sourcepass
-------------------------------------------------------------------------------
+------------------------------------------------------------------------------
CASE opcode(7 downto 6) IS
- WHEN "00" => datatype <= "00"; --Byte
- WHEN "01" => datatype <= "01"; --Word
- WHEN OTHERS => datatype <= "10"; --Long
+ WHEN "00" => datatype <= "00"; --Byte
+ WHEN "01" => datatype <= "01"; --Word
+ WHEN OTHERS => datatype <= "10"; --Long
END CASE;
-
- IF trapmake='1' AND trapd='0' THEN
- next_micro_state <= trap0;
- IF VBR_Stackframe=0 OR (cpu(0)='0' AND VBR_Stackframe=2) THEN
+
+ IF execOPC='1' AND exec_write_back='1' THEN
+ set(restore_ADDR) <= '1';
+ END IF;
+
+ IF interrupt='1' AND trap_berr='1' THEN
+ next_micro_state <= trap0;
+ IF preSVmode='0' THEN
+ set(changeMode) <= '1';
+ END IF;
+ setstate <= "01";
+ END IF;
+ IF trapmake='1' AND trapd='0' THEN
+-- IF use_VBR_Stackframe='1' AND (trap_trapv='1' OR set_Z_error='1' OR exec(opcCHK)='1') THEN
+ IF use_VBR_Stackframe='1' AND (trap_trapv='1' OR set_Z_error='1' OR exec(trap_chk)='1') THEN
+ next_micro_state <= trap00;
+ else
+ next_micro_state <= trap0;
+ end if;
+ IF use_VBR_Stackframe='0' THEN
set(writePC_add) <= '1';
--- set_datatype <= "10";
+-- set_datatype <= "10";
END IF;
IF preSVmode='0' THEN
set(changeMode) <= '1';
END IF;
setstate <= "01";
- END IF;
- IF interrupt='1' AND trap_berr='1' THEN
- next_micro_state <= trap0;
- IF preSVmode='0' THEN
- set(changeMode) <= '1';
- END IF;
- setstate <= "01";
END IF;
IF micro_state=int1 OR (interrupt='1' AND trap_trace='1') THEN
- next_micro_state <= trap0;
--- IF cpu(0)='0' THEN
--- set_datatype <= "10";
--- END IF;
+-- paste and copy form TH ---------
+ if trap_trace='1' AND use_VBR_Stackframe='1' then
+ next_micro_state <= trap00; --TH
+ else
+ next_micro_state <= trap0;
+ end if;
+------------------------------------
+-- next_micro_state <= trap0;
+-- IF cpu(0)='0' THEN
+-- set_datatype <= "10";
+-- END IF;
IF preSVmode='0' THEN
set(changeMode) <= '1';
END IF;
setstate <= "01";
- END IF;
-
+ END IF;
+ if micro_state = int1 or (interrupt = '1' and trap_trace = '1') then
+ if preSVmode = '0' then
+ set(changeMode) <= '1';
+ end if;
+ setstate <= "01";
+ end if;
+
IF setexecOPC='1' AND FlagsSR(5)/=preSVmode THEN
set(changeMode) <= '1';
--- setstate <= "01";
--- next_micro_state <= nop;
+-- setstate <= "01";
+-- next_micro_state <= nop;
END IF;
IF interrupt='1' AND trap_interrupt='1'THEN
--- skipFetch <= '1';
+-- skipFetch <= '1';
next_micro_state <= int1;
set(update_ld) <= '1';
setstate <= "10";
END IF;
-
- IF set(changeMode)='1' THEN
+
+ IF set(changeMode)='1' THEN
set(to_USP) <= '1';
set(from_USP) <= '1';
setstackaddr <='1';
END IF;
-
+
IF ea_only='0' AND set(get_ea_now)='1' THEN
setstate <= "10";
--- set_recall_last <= '1';
--- set(update_ld) <= '0';
+-- set_recall_last <= '1';
+-- set(update_ld) <= '0';
END IF;
IF setstate(1)='1' AND set_datatype(1)='1' THEN
@@ -1378,46 +1558,46 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
END IF;
IF (ea_build_now='1' AND decodeOPC='1') OR exec(ea_build)='1' THEN
- CASE opcode(5 downto 3) IS --source
- WHEN "010"|"011"|"100" => -- -(An)+
+ CASE opcode(5 downto 3) IS --source
+ WHEN "010"|"011"|"100" => -- -(An)+
set(get_ea_now) <='1';
setnextpass <= '1';
- IF opcode(3)='1' THEN --(An)+
+ IF opcode(3)='1' THEN --(An)+
set(postadd) <= '1';
IF opcode(2 downto 0)="111" THEN
set(use_SP) <= '1';
END IF;
- END IF;
- IF opcode(5)='1' THEN -- -(An)
- set(presub) <= '1';
+ END IF;
+ IF opcode(5)='1' THEN -- -(An)
+ set(presub) <= '1';
IF opcode(2 downto 0)="111" THEN
set(use_SP) <= '1';
END IF;
- END IF;
- WHEN "101" => --(d16,An)
+ END IF;
+ WHEN "101" => --(d16,An)
next_micro_state <= ld_dAn1;
- WHEN "110" => --(d8,An,Xn)
+ WHEN "110" => --(d8,An,Xn)
next_micro_state <= ld_AnXn1;
getbrief <='1';
WHEN "111" =>
CASE opcode(2 downto 0) IS
- WHEN "000" => --(xxxx).w
+ WHEN "000" => --(xxxx).w
next_micro_state <= ld_nn;
- WHEN "001" => --(xxxx).l
+ WHEN "001" => --(xxxx).l
set(longaktion) <= '1';
next_micro_state <= ld_nn;
- WHEN "010" => --(d16,PC)
+ WHEN "010" => --(d16,PC)
next_micro_state <= ld_dAn1;
set(dispouter) <= '1';
set_Suppress_Base <= '1';
set_PCbase <= '1';
- WHEN "011" => --(d8,PC,Xn)
+ WHEN "011" => --(d8,PC,Xn)
next_micro_state <= ld_AnXn1;
getbrief <= '1';
set(dispouter) <= '1';
set_Suppress_Base <= '1';
set_PCbase <= '1';
- WHEN "100" => --#data
+ WHEN "100" => --#data
setnextpass <= '1';
set_direct_data <= '1';
IF datatype="10" THEN
@@ -1429,14 +1609,14 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
END CASE;
END IF;
------------------------------------------------------------------------------
---prepere opcode
+--prepare opcode
------------------------------------------------------------------------------
CASE opcode(15 downto 12) IS
-- 0000 ----------------------------------------------------------------------------
WHEN "0000" =>
IF opcode(8)='1' AND opcode(5 downto 3)="001" THEN --movep
- datatype <= "00"; --Byte
- set(use_SP) <= '1'; --addr+2
+ datatype <= "00"; --Byte
+ set(use_SP) <= '1'; --addr+2
set(no_Flags) <='1';
IF opcode(7)='0' THEN --to register
set_exec(Regwrena) <= '1';
@@ -1448,7 +1628,7 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
set(movepl) <= '1';
END IF;
IF opcode(7)='0' THEN
- set_direct_data <= '1'; -- to register
+ set_direct_data <= '1'; -- to register
END IF;
next_micro_state <= movep1;
END IF;
@@ -1456,190 +1636,320 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
dest_hbits <='1';
END IF;
ELSE
- IF opcode(8)='1' OR opcode(11 downto 9)="100" THEN --Bits
- set_exec(opcBITS) <= '1';
- set_exec(ea_data_OP1) <= '1';
- IF opcode(7 downto 6)/="00" THEN
- IF opcode(5 downto 4)="00" THEN
- set_exec(Regwrena) <= '1';
- END IF;
- write_back <= '1';
- END IF;
- IF opcode(5 downto 4)="00" THEN
- datatype <= "10"; --Long
- ELSE
- datatype <= "00"; --Byte
- END IF;
- IF opcode(8)='0' THEN
- IF decodeOPC='1' THEN
- next_micro_state <= nop;
- set(get_2ndOPC) <= '1';
- set(ea_build) <= '1';
- END IF;
- ELSE
- ea_build_now <= '1';
- END IF;
- ELSIF opcode(11 downto 9)="111" THEN --MOVES not in 68000
- trap_illegal <= '1';
--- trap_addr_error <= '1';
- trapmake <= '1';
- ELSE --andi, ...xxxi
- IF opcode(11 downto 9)="000" THEN --ORI
- set_exec(opcOR) <= '1';
- END IF;
- IF opcode(11 downto 9)="001" THEN --ANDI
- set_exec(opcAND) <= '1';
- END IF;
- IF opcode(11 downto 9)="010" OR opcode(11 downto 9)="011" THEN --SUBI, ADDI
- set_exec(opcADD) <= '1';
- END IF;
- IF opcode(11 downto 9)="101" THEN --EORI
- set_exec(opcEOR) <= '1';
- END IF;
- IF opcode(11 downto 9)="110" THEN --CMPI
- set_exec(opcCMP) <= '1';
- END IF;
- IF opcode(7)='0' AND opcode(5 downto 0)="111100" AND (set_exec(opcAND) OR set_exec(opcOR) OR set_exec(opcEOR))='1' THEN --SR
- IF decodeOPC='1' AND SVmode='0' AND opcode(6)='1' THEN --SR
- trap_priv <= '1';
- trapmake <= '1';
- ELSE
- set(no_Flags) <= '1';
- IF decodeOPC='1' THEN
- IF opcode(6)='1' THEN
- set(to_SR) <= '1';
- END IF;
- set(to_CCR) <= '1';
- set(andiSR) <= set_exec(opcAND);
- set(eoriSR) <= set_exec(opcEOR);
- set(oriSR) <= set_exec(opcOR);
- setstate <= "01";
- next_micro_state <= nopnop;
- END IF;
- END IF;
- ELSE
- IF decodeOPC='1' THEN
- next_micro_state <= andi;
- set(ea_build) <= '1';
- set_direct_data <= '1';
- IF datatype="10" THEN
- set(longaktion) <= '1';
- END IF;
- END IF;
- IF opcode(5 downto 4)/="00" THEN
- set_exec(ea_data_OP1) <= '1';
- END IF;
- IF opcode(11 downto 9)/="110" THEN --CMPI
+ IF opcode(8)='1' OR opcode(11 downto 9)="100" THEN --Bits
+ IF opcode(5 downto 3)/="001" AND --ea An illegal mode
+ (opcode(8 downto 3)/="000111" OR opcode(2)='0') AND --BTST bit number static illegal modes
+ (opcode(8 downto 2)/="1001111" OR opcode(1 downto 0)="00") AND --BTST bit number dynamic illegal modes
+ (opcode(7 downto 6)="00" OR opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00") THEN --BCHG, BCLR, BSET illegal modes
+ set_exec(opcBITS) <= '1';
+ set_exec(ea_data_OP1) <= '1';
+ IF opcode(7 downto 6)/="00" THEN
IF opcode(5 downto 4)="00" THEN
set_exec(Regwrena) <= '1';
END IF;
write_back <= '1';
END IF;
- IF opcode(10 downto 9)="10" THEN --CMPI, SUBI
- set(addsub) <= '1';
+ IF opcode(5 downto 4)="00" THEN
+ datatype <= "10"; --Long
+ ELSE
+ datatype <= "00"; --Byte
END IF;
+ IF opcode(8)='0' THEN
+ IF decodeOPC='1' THEN
+ next_micro_state <= nop;
+ set(get_2ndOPC) <= '1';
+ set(ea_build) <= '1';
+ END IF;
+ ELSE
+ ea_build_now <= '1';
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSIF opcode(8 downto 6)="011" THEN --CAS/CAS2/CMP2/CHK2
+ IF cpu(1)='1' THEN
+ IF opcode(11)='1' THEN --CAS/CAS2
+ IF (opcode(10 downto 9)/="00" AND --CAS illegal size
+ opcode(5 downto 4)/="00" AND (opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00")) OR --ea illegal modes
+ (opcode(10)='1' AND opcode(5 downto 0)="111100") THEN --CAS2
+ CASE opcode(10 downto 9) IS
+ WHEN "01" => datatype <= "00"; --Byte
+ WHEN "10" => datatype <= "01"; --Word
+ WHEN OTHERS => datatype <= "10"; --Long
+ END CASE;
+ IF opcode(10)='1' AND opcode(5 downto 0)="111100" THEN --CAS2
+ IF decodeOPC='1' THEN
+ set(get_2ndOPC) <= '1';
+ next_micro_state <= cas21;
+ END IF;
+ ELSE --CAS
+ IF decodeOPC='1' THEN
+ next_micro_state <= nop;
+ set(get_2ndOPC) <= '1';
+ set(ea_build) <= '1';
+ END IF;
+ IF micro_state=idle AND nextpass='1' THEN
+ source_2ndLbits <= '1';
+ set(ea_data_OP1) <= '1';
+ set(addsub) <= '1';
+ set(alu_exec) <= '1';
+ set(alu_setFlags) <= '1';
+ setstate <= "01";
+ next_micro_state <= cas1;
+ END IF;
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE --CMP2/CHK2
+ IF opcode(10 downto 9)/="11" AND --illegal size
+ opcode(5 downto 4)/="00" AND opcode(5 downto 3)/="011" AND opcode(5 downto 3)/="100" AND opcode(5 downto 2)/="1111" THEN --ea illegal modes
+ set(trap_chk) <= '1';
+ datatype <= opcode(10 downto 9);
+ IF decodeOPC='1' THEN
+ next_micro_state <= nop;
+ set(get_2ndOPC) <= '1';
+ set(ea_build) <= '1';
+ END IF;
+ IF set(get_ea_now)='1' THEN
+ set(mem_addsub) <= '1';
+ set(OP1addr) <= '1';
+ END IF;
+ IF micro_state=idle AND nextpass='1' THEN
+ setstate <= "10";
+ set(hold_OP2) <='1';
+ next_micro_state <= chk20;
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSIF opcode(11 downto 9)="111" THEN --MOVES not in 68000
+ IF cpu(0)='1' AND opcode(7 downto 6)/="11" AND opcode(5 downto 4)/="00" AND (opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00") THEN
+ IF SVmode='1' THEN
+ --TODO: implement MOVES
+ trap_illegal <= '1';
+ trapmake <= '1';
+ ELSE
+ trap_priv <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE --andi, ...xxxi
+ IF opcode(7 downto 6)/="11" AND opcode(5 downto 3)/="001" THEN --ea An illegal mode
+ IF opcode(11 downto 9)="000" THEN --ORI
+ IF opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00" OR opcode(2 downto 0)="100" THEN
+ set_exec(opcOR) <= '1';
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ END IF;
+ IF opcode(11 downto 9)="001" THEN --ANDI
+ IF opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00" OR opcode(2 downto 0)="100" THEN
+ set_exec(opcAND) <= '1';
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ END IF;
+ IF opcode(11 downto 9)="010" OR opcode(11 downto 9)="011" THEN --SUBI, ADDI
+ IF opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00" THEN
+ set_exec(opcADD) <= '1';
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ END IF;
+ IF opcode(11 downto 9)="101" THEN --EORI
+ IF opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00" OR opcode(2 downto 0)="100" THEN
+ set_exec(opcEOR) <= '1';
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ END IF;
+ IF opcode(11 downto 9)="110" THEN --CMPI
+ IF opcode(5 downto 3)/="111" OR opcode(2)='0' THEN
+ set_exec(opcCMP) <= '1';
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ END IF;
+ IF (set_exec(opcor) OR set_exec(opcand) OR set_exec(opcADD) OR set_exec(opcEor) OR set_exec(opcCMP))='1' THEN
+ IF opcode(7)='0' AND opcode(5 downto 0)="111100" AND (set_exec(opcAND) OR set_exec(opcOR) OR set_exec(opcEOR))='1' THEN --SR
+ IF decodeOPC='1' AND SVmode='0' AND opcode(6)='1' THEN --SR
+ trap_priv <= '1';
+ trapmake <= '1';
+ ELSE
+ set(no_Flags) <= '1';
+ IF decodeOPC='1' THEN
+ IF opcode(6)='1' THEN
+ set(to_SR) <= '1';
+ END IF;
+ set(to_CCR) <= '1';
+ set(andiSR) <= set_exec(opcAND);
+ set(eoriSR) <= set_exec(opcEOR);
+ set(oriSR) <= set_exec(opcOR);
+ setstate <= "01";
+ next_micro_state <= nopnop;
+ END IF;
+ END IF;
+ ELSIF opcode(7)='0' OR opcode(5 downto 0)/="111100" OR (set_exec(opcand) OR set_exec(opcor) OR set_exec(opcEor))='0' THEN
+ IF decodeOPC='1' THEN
+ next_micro_state <= andi;
+ set(get_2ndOPC) <='1';
+ set(ea_build) <= '1';
+ set_direct_data <= '1';
+ IF datatype="10" THEN
+ set(longaktion) <= '1';
+ END IF;
+ END IF;
+ IF opcode(5 downto 4)/="00" THEN
+ set_exec(ea_data_OP1) <= '1';
+ END IF;
+ IF opcode(11 downto 9)/="110" THEN --CMPI
+ IF opcode(5 downto 4)="00" THEN
+ set_exec(Regwrena) <= '1';
+ END IF;
+ write_back <= '1';
+ END IF;
+ IF opcode(10 downto 9)="10" THEN --CMPI, SUBI
+ set(addsub) <= '1';
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
END IF;
END IF;
END IF;
-
+
-- 0001, 0010, 0011 -----------------------------------------------------------------
- WHEN "0001"|"0010"|"0011" => --move.b, move.l, move.w
- set_exec(opcMOVE) <= '1';
- ea_build_now <= '1';
- IF opcode(8 downto 6)="001" THEN
- set(no_Flags) <= '1';
- END IF;
- IF opcode(5 downto 4)="00" THEN --Dn, An
- IF opcode(8 downto 7)="00" THEN
- set_exec(Regwrena) <= '1';
+ WHEN "0001"|"0010"|"0011" => --move.b, move.l, move.w
+ IF ((opcode(11 downto 10)="00" OR opcode(8 downto 6)/="111") AND --illegal dest ea
+ (opcode(5 downto 2)/="1111" OR opcode(1 downto 0)="00") AND --illegal src ea
+ (opcode(13)='1' OR (opcode(8 downto 6)/="001" AND opcode(5 downto 3)/="001"))) THEN --byte src address reg direct, byte movea
+ set_exec(opcMOVE) <= '1';
+ ea_build_now <= '1';
+ IF opcode(8 downto 6)="001" THEN
+ set(no_Flags) <= '1';
END IF;
- END IF;
- CASE opcode(13 downto 12) IS
- WHEN "01" => datatype <= "00"; --Byte
- WHEN "10" => datatype <= "10"; --Long
- WHEN OTHERS => datatype <= "01"; --Word
- END CASE;
- source_lowbits <= '1'; -- Dn=> An=>
- IF opcode(3)='1' THEN
- source_areg <= '1';
- END IF;
-
- IF nextpass='1' OR opcode(5 downto 4)="00" THEN
- dest_hbits <= '1';
- IF opcode(8 downto 6)/="000" THEN
- dest_areg <= '1';
+ IF opcode(5 downto 4)="00" THEN --Dn, An
+ IF opcode(8 downto 7)="00" THEN
+ set_exec(Regwrena) <= '1';
+ END IF;
END IF;
- END IF;
--- IF setstate="10" THEN
--- set(update_ld) <= '0';
--- END IF;
---
- IF micro_state=idle AND (nextpass='1' OR (opcode(5 downto 4)="00" AND decodeOPC='1')) THEN
- CASE opcode(8 downto 6) IS --destination
- WHEN "000"|"001" => --Dn,An
- set_exec(Regwrena) <= '1';
- WHEN "010"|"011"|"100" => --destination -(an)+
- IF opcode(6)='1' THEN --(An)+
- set(postadd) <= '1';
- IF opcode(11 downto 9)="111" THEN
- set(use_SP) <= '1';
- END IF;
- END IF;
- IF opcode(8)='1' THEN -- -(An)
- set(presub) <= '1';
- IF opcode(11 downto 9)="111" THEN
- set(use_SP) <= '1';
- END IF;
- END IF;
- setstate <= "11";
- next_micro_state <= nop;
- IF nextpass='0' THEN
- set(write_reg) <= '1';
- END IF;
- WHEN "101" => --(d16,An)
- next_micro_state <= st_dAn1;
--- getbrief <= '1';
- WHEN "110" => --(d8,An,Xn)
- next_micro_state <= st_AnXn1;
- getbrief <= '1';
- WHEN "111" =>
- CASE opcode(11 downto 9) IS
- WHEN "000" => --(xxxx).w
- next_micro_state <= st_nn;
- WHEN "001" => --(xxxx).l
- set(longaktion) <= '1';
- next_micro_state <= st_nn;
- WHEN OTHERS => NULL;
- END CASE;
- WHEN OTHERS => NULL;
+ CASE opcode(13 downto 12) IS
+ WHEN "01" => datatype <= "00"; --Byte
+ WHEN "10" => datatype <= "10"; --Long
+ WHEN OTHERS => datatype <= "01"; --Word
END CASE;
+ source_lowbits <= '1'; -- Dn=> An=>
+ IF opcode(3)='1' THEN
+ source_areg <= '1';
+ END IF;
+
+ IF nextpass='1' OR opcode(5 downto 4)="00" THEN
+ dest_hbits <= '1';
+ IF opcode(8 downto 6)/="000" THEN
+ dest_areg <= '1';
+ END IF;
+ END IF;
+
+ IF micro_state=idle AND (nextpass='1' OR (opcode(5 downto 4)="00" AND decodeOPC='1')) THEN
+ CASE opcode(8 downto 6) IS --destination
+ WHEN "000"|"001" => --Dn,An
+ set_exec(Regwrena) <= '1';
+ WHEN "010"|"011"|"100" => --destination -(an)+
+ IF opcode(6)='1' THEN --(An)+
+ set(postadd) <= '1';
+ IF opcode(11 downto 9)="111" THEN
+ set(use_SP) <= '1';
+ END IF;
+ END IF;
+ IF opcode(8)='1' THEN -- -(An)
+ set(presub) <= '1';
+ IF opcode(11 downto 9)="111" THEN
+ set(use_SP) <= '1';
+ END IF;
+ END IF;
+ setstate <= "11";
+ next_micro_state <= nop;
+ IF nextpass='0' THEN
+ set(write_reg) <= '1';
+ END IF;
+ WHEN "101" => --(d16,An)
+ next_micro_state <= st_dAn1;
+-- getbrief <= '1';
+ WHEN "110" => --(d8,An,Xn)
+ next_micro_state <= st_AnXn1;
+ getbrief <= '1';
+ WHEN "111" =>
+ CASE opcode(11 downto 9) IS
+ WHEN "000" => --(xxxx).w
+ next_micro_state <= st_nn;
+ WHEN "001" => --(xxxx).l
+ set(longaktion) <= '1';
+ next_micro_state <= st_nn;
+ WHEN OTHERS => NULL;
+ END CASE;
+ WHEN OTHERS => NULL;
+ END CASE;
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
END IF;
----- 0100 ----------------------------------------------------------------------------
- WHEN "0100" => --rts_group
- IF opcode(8)='1' THEN --lea
- IF opcode(6)='1' THEN --lea
- IF opcode(7)='1' THEN
- source_lowbits <= '1';
--- IF opcode(5 downto 3)="000" AND opcode(10)='0' THEN --ext
- IF opcode(5 downto 4)="00" THEN --extb.l
+---- 0100 ----------------------------------------------------------------------------
+ WHEN "0100" => --rts_group
+ IF opcode(8)='1' THEN --lea, extb.l, chk
+ IF opcode(6)='1' THEN --lea, extb.l
+ IF opcode(11 downto 9)="100" AND opcode(5 downto 3)="000" THEN --extb.l
+ IF opcode(7)='1' AND cpu(1)='1' THEN
+ source_lowbits <= '1';
set_exec(opcEXT) <= '1';
+ set_exec(opcEXTB) <= '1';
set_exec(opcMOVE) <= '1';
set_exec(Regwrena) <= '1';
--- IF opcode(6)='0' THEN
--- datatype <= "01"; --WORD
--- END IF;
ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE
+ IF opcode(7)='1' AND
+ (opcode(5)='1' OR opcode(4 downto 3)="10") AND
+ opcode(5 downto 3)/="100" AND opcode(5 downto 2)/="1111" THEN --ea illegal opcodes
+ source_lowbits <= '1';
source_areg <= '1';
ea_only <= '1';
set_exec(Regwrena) <= '1';
set_exec(opcMOVE) <='1';
set(no_Flags) <='1';
- IF opcode(5 downto 3)="010" THEN --lea (Am),An
+ IF opcode(5 downto 3)="010" THEN --lea (Am),An
dest_areg <= '1';
dest_hbits <= '1';
ELSE
ea_build_now <= '1';
- END IF;
+ END IF;
IF set(get_ea_now)='1' THEN
setstate <= "01";
set_direct_data <= '1';
@@ -1648,210 +1958,288 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
dest_areg <= '1';
dest_hbits <= '1';
END IF;
+ ELSE
+ trap_illegal <='1';
+ trapmake <='1';
+ END IF;
+ END IF;
+ ELSE --chk
+ IF opcode(5 downto 3)/="001" AND --ea An illegal mode
+ (opcode(5 downto 2)/="1111" OR opcode(1 downto 0)="00") THEN --ea illegal modes
+ IF opcode(7)='1' THEN
+ datatype <= "01"; --Word
+ set(trap_chk) <= '1';
+ IF (c_out(1)='0' OR OP1out(15)='1' OR OP2out(15)='1') AND exec(opcCHK)='1' THEN
+ trapmake <= '1';
+ END IF;
+ ELSIF cpu(1)='1' THEN --chk long for 68020
+ datatype <= "10"; --Long
+ set(trap_chk) <= '1';
+ IF (c_out(2)='0' OR OP1out(31)='1' OR OP2out(31)='1') AND exec(opcCHK)='1' THEN
+ trapmake <= '1';
+ END IF;
+ ELSE
+ trap_illegal <= '1'; -- chk long for 68020
+ trapmake <= '1';
+ END IF;
+ IF opcode(7)='1' OR cpu(1)='1' THEN
+ IF (nextpass='1' OR opcode(5 downto 4)="00") AND exec(opcCHK)='0' AND micro_state=idle THEN
+ set_exec(opcCHK) <= '1';
+ END IF;
+ ea_build_now <= '1';
+ set(addsub) <= '1';
+ IF setexecOPC='1' THEN
+ dest_hbits <= '1';
+ source_lowbits <='1';
+ END IF;
END IF;
ELSE
trap_illegal <= '1';
trapmake <= '1';
END IF;
- ELSE --chk
- IF opcode(7)='1' THEN
- datatype <= "01"; --Word
- set(trap_chk) <= '1';
- IF (c_out(1)='0' OR OP1out(15)='1' OR OP2out(15)='1') AND exec(opcCHK)='1' THEN
- trapmake <= '1';
- END IF;
- ELSIF cpu(1)='1' THEN --chk long for 68020
- datatype <= "10"; --Long
- set(trap_chk) <= '1';
- IF (c_out(2)='1' OR OP1out(31)='1' OR OP2out(31)='1') AND exec(opcCHK)='1' THEN
- trapmake <= '1';
- END IF;
- ELSE
- trap_illegal <= '1'; -- chk long for 68020
- trapmake <= '1';
- END IF;
- IF opcode(7)='1' OR cpu(1)='1' THEN
- IF (nextpass='1' OR opcode(5 downto 4)="00") AND exec(opcCHK)='0' AND micro_state=idle THEN
- set_exec(opcCHK) <= '1';
- END IF;
- ea_build_now <= '1';
- set(addsub) <= '1';
- IF setexecOPC='1' THEN
- dest_hbits <= '1';
- source_lowbits <='1';
- END IF;
- END IF;
END IF;
ELSE
CASE opcode(11 downto 9) IS
WHEN "000"=>
- IF opcode(7 downto 6)="11" THEN --move from SR
- IF SR_Read=0 OR (cpu(0)='0' AND SR_Read=2) OR SVmode='1' THEN
--- IF SVmode='1' THEN
- ea_build_now <= '1';
- set_exec(opcMOVESR) <= '1';
- datatype <= "01";
- write_back <='1'; -- im 68000 wird auch erst gelesen
- IF cpu(0)='1' AND state="10" THEN
- skipFetch <= '1';
+ IF (opcode(5 downto 3)/="001" AND --ea An illegal mode
+ (opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00")) THEN --ea illegal modes
+ IF opcode(7 downto 6)="11" THEN --move from SR
+ IF SR_Read=0 OR (cpu(0)='0' AND SR_Read=2) OR SVmode='1' THEN
+ ea_build_now <= '1';
+ set_exec(opcMOVESR) <= '1';
+ datatype <= "01";
+ write_back <='1'; -- im 68000 wird auch erst gelesen
+ IF cpu(0)='1' AND state="10" AND addrvalue='0' THEN
+ skipFetch <= '1';
+ END IF;
+ IF opcode(5 downto 4)="00" THEN
+ set_exec(Regwrena) <= '1';
+ END IF;
+ ELSE
+ trap_priv <= '1';
+ trapmake <= '1';
END IF;
+ ELSE --negx
+ ea_build_now <= '1';
+ set_exec(use_XZFlag) <= '1';
+ write_back <='1';
+ set_exec(opcADD) <= '1';
+ set(addsub) <= '1';
+ source_lowbits <= '1';
IF opcode(5 downto 4)="00" THEN
set_exec(Regwrena) <= '1';
END IF;
- ELSE
- trap_priv <= '1';
- trapmake <= '1';
- END IF;
- ELSE --negx
- ea_build_now <= '1';
- set_exec(use_XZFlag) <= '1';
- write_back <='1';
- set_exec(opcADD) <= '1';
- set(addsub) <= '1';
- source_lowbits <= '1';
- IF opcode(5 downto 4)="00" THEN
- set_exec(Regwrena) <= '1';
- END IF;
- IF setexecOPC='1' THEN
- set(OP1out_zero) <= '1';
+ IF setexecOPC='1' THEN
+ set(OP1out_zero) <= '1';
+ END IF;
END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
END IF;
WHEN "001"=>
- IF opcode(7 downto 6)="11" THEN --move from CCR 68010
- IF SR_Read=1 OR (cpu(0)='1' AND SR_Read=2) THEN
+ IF (opcode(5 downto 3)/="001" AND --ea An illegal mode
+ (opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00")) THEN --ea illegal modes
+ IF opcode(7 downto 6)="11" THEN --move from CCR 68010
+ IF SR_Read=1 OR (cpu(0)='1' AND SR_Read=2) THEN
+ ea_build_now <= '1';
+ set_exec(opcMOVESR) <= '1';
+ datatype <= "01";
+ write_back <='1'; -- im 68000 wird auch erst gelesen
+-- IF state="10" THEN
+-- skipFetch <= '1';
+-- END IF;
+ IF opcode(5 downto 4)="00" THEN
+ set_exec(Regwrena) <= '1';
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE --clr
ea_build_now <= '1';
- set_exec(opcMOVESR) <= '1';
- datatype <= "00";
- write_back <='1'; -- im 68000 wird auch erst gelesen
+ write_back <='1';
+ set_exec(opcAND) <= '1';
+ IF cpu(0)='1' AND state="10" AND addrvalue='0' THEN
+ skipFetch <= '1';
+ END IF;
+ IF setexecOPC='1' THEN
+ set(OP1out_zero) <= '1';
+ END IF;
IF opcode(5 downto 4)="00" THEN
set_exec(Regwrena) <= '1';
END IF;
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ WHEN "010"=>
+ IF opcode(7 downto 6)="11" THEN --move to CCR
+ IF opcode(5 downto 3)/="001" AND --ea An illegal mode
+ (opcode(5 downto 2)/="1111" OR opcode(1 downto 0)="00") THEN --ea illegal modes
+ ea_build_now <= '1';
+ datatype <= "01";
+ source_lowbits <= '1';
+ IF (decodeOPC='1' AND opcode(5 downto 4)="00") OR (state="10" AND addrvalue='0') OR direct_data='1' THEN
+ set(to_CCR) <= '1';
+ END IF;
ELSE
trap_illegal <= '1';
trapmake <= '1';
END IF;
- ELSE --clr
- ea_build_now <= '1';
- write_back <='1';
- set_exec(opcAND) <= '1';
- IF cpu(0)='1' AND state="10" THEN
- skipFetch <= '1';
- END IF;
- IF setexecOPC='1' THEN
- set(OP1out_zero) <= '1';
- END IF;
- IF opcode(5 downto 4)="00" THEN
- set_exec(Regwrena) <= '1';
- END IF;
- END IF;
- WHEN "010"=>
- ea_build_now <= '1';
- IF opcode(7 downto 6)="11" THEN --move to CCR
- datatype <= "01";
- source_lowbits <= '1';
- IF (decodeOPC='1' AND opcode(5 downto 4)="00") OR state="10" OR direct_data='1' THEN
- set(to_CCR) <= '1';
- END IF;
- ELSE --neg
- write_back <='1';
- set_exec(opcADD) <= '1';
- set(addsub) <= '1';
- source_lowbits <= '1';
- IF opcode(5 downto 4)="00" THEN
- set_exec(Regwrena) <= '1';
- END IF;
- IF setexecOPC='1' THEN
- set(OP1out_zero) <= '1';
- END IF;
- END IF;
- WHEN "011"=> --not, move toSR
- IF opcode(7 downto 6)="11" THEN --move to SR
- IF SVmode='1' THEN
+ ELSE --neg
+ IF (opcode(5 downto 3)/="001" AND --ea An illegal mode
+ (opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00")) THEN --ea illegal modes
ea_build_now <= '1';
- datatype <= "01";
+ write_back <='1';
+ set_exec(opcADD) <= '1';
+ set(addsub) <= '1';
source_lowbits <= '1';
- IF (decodeOPC='1' AND opcode(5 downto 4)="00") OR state="10" OR direct_data='1' THEN
- set(to_SR) <= '1';
- set(to_CCR) <= '1';
+ IF opcode(5 downto 4)="00" THEN
+ set_exec(Regwrena) <= '1';
END IF;
- IF exec(to_SR)='1' OR (decodeOPC='1' AND opcode(5 downto 4)="00") OR state="10" OR direct_data='1' THEN
- setstate <="01";
+ IF setexecOPC='1' THEN
+ set(OP1out_zero) <= '1';
END IF;
ELSE
- trap_priv <= '1';
+ trap_illegal <= '1';
trapmake <= '1';
END IF;
- ELSE --not
- ea_build_now <= '1';
- write_back <='1';
- set_exec(opcEOR) <= '1';
- set_exec(ea_data_OP1) <= '1';
- IF opcode(5 downto 3)="000" THEN
- set_exec(Regwrena) <= '1';
+ END IF;
+ WHEN "011"=> --not, move toSR
+ IF opcode(7 downto 6)="11" THEN --move to SR
+ IF opcode(5 downto 3)/="001" AND --ea An illegal mode
+ (opcode(5 downto 2)/="1111" OR opcode(1 downto 0)="00") THEN --ea illegal modes
+ IF SVmode='1' THEN
+ ea_build_now <= '1';
+ datatype <= "01";
+ source_lowbits <= '1';
+ IF (decodeOPC='1' AND opcode(5 downto 4)="00") OR (state="10" AND addrvalue='0') OR direct_data='1' THEN
+ set(to_SR) <= '1';
+ set(to_CCR) <= '1';
+ END IF;
+ IF exec(to_SR)='1' OR (decodeOPC='1' AND opcode(5 downto 4)="00") OR (state="10" AND addrvalue='0') OR direct_data='1' THEN
+ setstate <="01";
+ END IF;
+ ELSE
+ trap_priv <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
END IF;
- IF setexecOPC='1' THEN
- set(OP2out_one) <= '1';
+ ELSE --not
+ IF opcode(5 downto 3)/="001" AND --ea An illegal mode
+ (opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00") THEN --ea illegal modes
+ ea_build_now <= '1';
+ write_back <='1';
+ set_exec(opcEOR) <= '1';
+ set_exec(ea_data_OP1) <= '1';
+ IF opcode(5 downto 3)="000" THEN
+ set_exec(Regwrena) <= '1';
+ END IF;
+ IF setexecOPC='1' THEN
+ set(OP2out_one) <= '1';
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
END IF;
END IF;
WHEN "100"|"110"=>
- IF opcode(7)='1' THEN --movem, ext
- IF opcode(5 downto 3)="000" AND opcode(10)='0' THEN --ext
+ IF opcode(7)='1' THEN --movem, ext
+ IF opcode(5 downto 3)="000" AND opcode(10)='0' THEN --ext
source_lowbits <= '1';
set_exec(opcEXT) <= '1';
set_exec(opcMOVE) <= '1';
- set_exec(Regwrena) <= '1';
+ set_exec(Regwrena) <= '1';
IF opcode(6)='0' THEN
- datatype <= "01"; --WORD
+ datatype <= "01"; --WORD
+ set_exec(opcEXTB) <= '1';
END IF;
- ELSE --movem
--- IF opcode(11 downto 7)="10001" OR opcode(11 downto 7)="11001" THEN --MOVEM
- ea_only <= '1';
- set(no_Flags) <= '1';
- IF opcode(6)='0' THEN
- datatype <= "01"; --Word transfer
+ ELSE --movem
+-- IF opcode(11 downto 7)="10001" OR opcode(11 downto 7)="11001" THEN --MOVEM
+ IF (opcode(10)='1' OR ((opcode(5)='1' OR opcode(4 downto 3)="10") AND
+ (opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00"))) AND
+ (opcode(10)='0' OR (opcode(5 downto 4)/="00" AND
+ opcode(5 downto 3)/="100" AND
+ opcode(5 downto 2)/="1111")) THEN --ea illegal modes
+ ea_only <= '1';
+ set(no_Flags) <= '1';
+ IF opcode(6)='0' THEN
+ datatype <= "01"; --Word transfer
+ END IF;
+ IF (opcode(5 downto 3)="100" OR opcode(5 downto 3)="011") AND state="01" THEN -- -(An), (An)+
+ set_exec(save_memaddr) <= '1';
+ set_exec(Regwrena) <= '1';
+ END IF;
+ IF opcode(5 downto 3)="100" THEN -- -(An)
+ movem_presub <= '1';
+ set(subidx) <= '1';
+ END IF;
+ IF state="10" AND addrvalue='0' THEN
+ set(Regwrena) <= '1';
+ set(opcMOVE) <= '1';
+ END IF;
+ IF decodeOPC='1' THEN
+ set(get_2ndOPC) <='1';
+ IF opcode(5 downto 3)="010" OR opcode(5 downto 3)="011" OR opcode(5 downto 3)="100" THEN
+ next_micro_state <= movem1;
+ ELSE
+ next_micro_state <= nop;
+ set(ea_build) <= '1';
+ END IF;
+ END IF;
+ IF set(get_ea_now)='1' THEN
+ IF movem_run='1' THEN
+ set(movem_action) <= '1';
+ IF opcode(10)='0' THEN
+ setstate <="11";
+ set(write_reg) <= '1';
+ ELSE
+ setstate <="10";
+ END IF;
+ next_micro_state <= movem2;
+ set(mem_addsub) <= '1';
+ ELSE
+ setstate <="01";
+ END IF;
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
END IF;
- IF (opcode(5 downto 3)="100" OR opcode(5 downto 3)="011") AND state="01" THEN -- -(An), (An)+
- set_exec(save_memaddr) <= '1';
- set_exec(Regwrena) <= '1';
- END IF;
- IF opcode(5 downto 3)="100" THEN -- -(An)
- movem_presub <= '1';
- set(subidx) <= '1';
- END IF;
- IF state="10" THEN
- set(Regwrena) <= '1';
- set(opcMOVE) <= '1';
- END IF;
- IF decodeOPC='1' THEN
- set(get_2ndOPC) <='1';
- IF opcode(5 downto 3)="010" OR opcode(5 downto 3)="011" OR opcode(5 downto 3)="100" THEN
- next_micro_state <= movem1;
- ELSE
+ END IF;
+ ELSE
+ IF opcode(10)='1' THEN --MUL.L, DIV.L 68020
+ --FPGA Multiplier for long
+ IF opcode(8 downto 7)="00" AND opcode(5 downto 3)/="001" AND (opcode(5 downto 2)/="1111" OR opcode(1 downto 0)="00") AND--ea An illegal mode
+ MUL_Hardware=1 AND (opcode(6)='0' AND (MUL_Mode=1 OR (cpu(1)='1' AND MUL_Mode=2))) THEN
+ IF decodeOPC='1' THEN
next_micro_state <= nop;
+ set(get_2ndOPC) <= '1';
set(ea_build) <= '1';
END IF;
- END IF;
- IF set(get_ea_now)='1' THEN
- IF movem_run='1' THEN
- set(movem_action) <= '1';
- IF opcode(10)='0' THEN
- setstate <="11";
- set(write_reg) <= '1';
- ELSE
- setstate <="10";
+ IF (micro_state=idle AND nextpass='1') OR (opcode(5 downto 4)="00" AND exec(ea_build)='1') THEN
+ dest_2ndHbits <= '1';
+ datatype <= "10";
+ set(opcMULU) <= '1';
+ set(write_lowlong) <= '1';
+ IF sndOPC(10)='1' THEN
+ setstate <="01";
+ next_micro_state <= mul_end2;
END IF;
- next_micro_state <= movem2;
- set(mem_addsub) <= '1';
- ELSE
- setstate <="01";
+ set(Regwrena) <= '1';
END IF;
- END IF;
- END IF;
- ELSE
- IF opcode(10)='1' THEN --MUL.L, DIV.L 68020
--- IF cpu(1)='1' THEN
- IF (opcode(6)='1' AND (DIV_Mode=1 OR (cpu(1)='1' AND DIV_Mode=2))) OR
- (opcode(6)='0' AND (MUL_Mode=1 OR (cpu(1)='1' AND MUL_Mode=2))) THEN
+ source_lowbits <='1';
+ datatype <= "10";
+
+ --no FPGA Multiplier
+ ELSIF opcode(8 downto 7)="00" AND opcode(5 downto 3)/="001" AND (opcode(5 downto 2)/="1111" OR opcode(1 downto 0)="00") AND --ea An illegal mode
+ ((opcode(6)='1' AND (DIV_Mode=1 OR (cpu(1)='1' AND DIV_Mode=2))) OR
+ (opcode(6)='0' AND (MUL_Mode=1 OR (cpu(1)='1' AND MUL_Mode=2)))) THEN
IF decodeOPC='1' THEN
next_micro_state <= nop;
set(get_2ndOPC) <= '1';
@@ -1863,16 +2251,13 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
source_2ndLbits <= '1';
IF opcode(6)='1' THEN
next_micro_state <= div1;
- ELSE
+ ELSE
next_micro_state <= mul1;
set(ld_rot_cnt) <= '1';
END IF;
END IF;
- IF z_error='0' AND set_V_Flag='0' AND set(opcDIVU)='1' THEN
- set(Regwrena) <= '1';
- END IF;
source_lowbits <='1';
- IF nextpass='1' OR (opcode(5 downto 4)="00" AND decodeOPC='1') THEN
+ IF nextpass='1' OR (opcode(5 downto 4)="00" AND decodeOPC='1') THEN
dest_hbits <= '1';
END IF;
datatype <= "10";
@@ -1880,32 +2265,40 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
trap_illegal <= '1';
trapmake <= '1';
END IF;
-
- ELSE --pea, swap
+
+ ELSE --pea, swap
IF opcode(6)='1' THEN
datatype <= "10";
- IF opcode(5 downto 3)="000" THEN --swap
+ IF opcode(5 downto 3)="000" THEN --swap
set_exec(opcSWAP) <= '1';
- set_exec(Regwrena) <= '1';
- ELSIF opcode(5 downto 3)="001" THEN --bkpt
-
- ELSE --pea
- ea_only <= '1';
- ea_build_now <= '1';
- IF nextpass='1' AND micro_state=idle THEN
- set(presub) <= '1';
- setstackaddr <='1';
- setstate <="11";
- next_micro_state <= nop;
- END IF;
- IF set(get_ea_now)='1' THEN
- setstate <="01";
+ set_exec(Regwrena) <= '1';
+ ELSIF opcode(5 downto 3)="001" THEN --bkpt
+ trap_illegal <= '1';
+ trapmake <= '1';
+ ELSE --pea
+ IF (opcode(5)='1' OR opcode(4 downto 3)="10") AND
+ opcode(5 downto 3)/="100" AND
+ opcode(5 downto 2)/="1111" THEN --ea illegal modes
+ ea_only <= '1';
+ ea_build_now <= '1';
+ IF nextpass='1' AND micro_state=idle THEN
+ set(presub) <= '1';
+ setstackaddr <='1';
+ setstate <="11";
+ next_micro_state <= nop;
+ END IF;
+ IF set(get_ea_now)='1' THEN
+ setstate <="01";
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
END IF;
END IF;
ELSE
IF opcode(5 downto 3)="001" THEN --link.l
datatype <= "10";
- set_exec(opcADD) <= '1'; --for displacement
+ set_exec(opcADD) <= '1'; --for displacement
set_exec(Regwrena) <= '1';
set(no_Flags) <= '1';
IF decodeOPC='1' THEN
@@ -1919,102 +2312,126 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
source_areg <= '1';
set(store_ea_data) <= '1';
END IF;
- ELSE --nbcd
- ea_build_now <= '1';
- set_exec(use_XZFlag) <= '1';
- write_back <='1';
- set_exec(opcADD) <= '1';
- set_exec(opcSBCD) <= '1';
- source_lowbits <= '1';
- IF opcode(5 downto 4)="00" THEN
- set_exec(Regwrena) <= '1';
+ ELSE --nbcd
+ IF opcode(5 downto 3)/="001" AND --ea An illegal mode
+ (opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00") THEN --ea illegal modes
+ ea_build_now <= '1';
+ set_exec(use_XZFlag) <= '1';
+ write_back <='1';
+ set_exec(opcADD) <= '1';
+ set_exec(opcSBCD) <= '1';
+ set(addsub) <= '1';
+ source_lowbits <= '1';
+ IF opcode(5 downto 4)="00" THEN
+ set_exec(Regwrena) <= '1';
+ END IF;
+ IF setexecOPC='1' THEN
+ set(OP1out_zero) <= '1';
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
END IF;
- IF setexecOPC='1' THEN
- set(OP1out_zero) <= '1';
- END IF;
- END IF;
+ END IF;
END IF;
END IF;
END IF;
---
- WHEN "101"=> --tst, tas 4aFC - illegal
- IF opcode(7 downto 2)="111111" THEN --illegal
+--0x4AXX
+ WHEN "101"=> --tst, tas 4aFC - illegal
+-- IF opcode(7 downto 2)="111111" THEN --illegal
+ IF opcode(7 downto 3)="11111" AND opcode(2 downto 1)/="00" THEN --0x4AFC illegal --0x4AFB BKP Sinclair QL
trap_illegal <= '1';
trapmake <= '1';
ELSE
- ea_build_now <= '1';
- IF setexecOPC='1' THEN
- source_lowbits <= '1';
- IF opcode(3)='1' THEN --MC68020...
- source_areg <= '1';
+ IF (opcode(7 downto 6)/="11" OR --tas
+ (opcode(5 downto 3)/="001" AND --ea An illegal mode
+ (opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00"))) AND --ea illegal modes
+ ((opcode(7 downto 6)/="00" OR (opcode(5 downto 3)/="001")) AND
+ (opcode(5 downto 2)/="1111" OR opcode(1 downto 0)="00")) THEN
+ ea_build_now <= '1';
+ IF setexecOPC='1' THEN
+ source_lowbits <= '1';
+ IF opcode(3)='1' THEN --MC68020...
+ source_areg <= '1';
+ END IF;
END IF;
- END IF;
- set_exec(opcMOVE) <= '1';
- IF opcode(7 downto 6)="11" THEN --tas
- set_exec_tas <= '1';
- write_back <= '1';
- datatype <= "00"; --Byte
- IF opcode(5 downto 4)="00" THEN
- set_exec(Regwrena) <= '1';
+ set_exec(opcMOVE) <= '1';
+ IF opcode(7 downto 6)="11" THEN --tas
+ set_exec_tas <= '1';
+ write_back <= '1';
+ datatype <= "00"; --Byte
+ IF opcode(5 downto 4)="00" THEN
+ set_exec(Regwrena) <= '1';
+ END IF;
END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
END IF;
END IF;
----- WHEN "110"=>
- WHEN "111"=> --4EXX
+---- WHEN "110"=>
+ WHEN "111"=> --4EXX
--
--- ea_only <= '1';
--- ea_build_now <= '1';
--- IF nextpass='1' AND micro_state=idle THEN
--- set(presub) <= '1';
--- setstackaddr <='1';
--- set(mem_addsub) <= '1';
--- setstate <="11";
--- next_micro_state <= nop;
--- END IF;
--- IF set(get_ea_now)='1' THEN
--- setstate <="01";
--- END IF;
---
-
-
-
- IF opcode(7)='1' THEN --jsr, jmp
- datatype <= "10";
- ea_only <= '1';
- ea_build_now <= '1';
- IF exec(ea_to_pc)='1' THEN
- next_micro_state <= nop;
- END IF;
- IF nextpass='1' AND micro_state=idle AND opcode(6)='0' THEN
- set(presub) <= '1';
- setstackaddr <='1';
- setstate <="11";
- next_micro_state <= nopnop;
- END IF;
--- achtung buggefahr
- IF micro_state=ld_AnXn1 AND brief(8)='0'THEN --JMP/JSR n(Ax,Dn)
- skipFetch <= '1';
- END IF;
- IF state="00" THEN
- writePC <= '1';
- END IF;
- set(hold_dwr) <= '1';
- IF set(get_ea_now)='1' THEN --jsr
- IF exec(longaktion)='0' OR long_done='1' THEN
+-- ea_only <= '1';
+-- ea_build_now <= '1';
+-- IF nextpass='1' AND micro_state=idle THEN
+-- set(presub) <= '1';
+-- setstackaddr <='1';
+-- set(mem_addsub) <= '1';
+-- setstate <="11";
+-- next_micro_state <= nop;
+-- END IF;
+-- IF set(get_ea_now)='1' THEN
+-- setstate <="01";
+-- END IF;
+--
+
+
+
+ IF opcode(7)='1' THEN --jsr, jmp
+ IF (opcode(5)='1' OR opcode(4 downto 3)="10") AND
+ opcode(5 downto 3)/="100" AND opcode(5 downto 2)/="1111" THEN --ea illegal modes
+ datatype <= "10";
+ ea_only <= '1';
+ ea_build_now <= '1';
+ IF exec(ea_to_pc)='1' THEN
+ next_micro_state <= nop;
+ END IF;
+ IF nextpass='1' AND micro_state=idle AND opcode(6)='0' THEN
+ set(presub) <= '1';
+ setstackaddr <='1';
+ setstate <="11";
+ next_micro_state <= nopnop;
+ END IF;
+
+ IF micro_state=ld_AnXn1 AND brief(8)='0'THEN --JMP/JSR n(Ax,Dn)
skipFetch <= '1';
END IF;
- setstate <="01";
- set(ea_to_pc) <= '1';
+ IF state="00" THEN
+ writePC <= '1';
+ END IF;
+ set(hold_dwr) <= '1';
+ IF set(get_ea_now)='1' THEN --jsr
+ IF exec(longaktion)='0' OR long_done='1' THEN
+ skipFetch <= '1';
+ END IF;
+ setstate <="01";
+ set(ea_to_pc) <= '1';
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
END IF;
- ELSE --
+ ELSE --
CASE opcode(6 downto 0) IS
- WHEN "1000000"|"1000001"|"1000010"|"1000011"|"1000100"|"1000101"|"1000110"|"1000111"| --trap
- "1001000"|"1001001"|"1001010"|"1001011"|"1001100"|"1001101"|"1001110"|"1001111" => --trap
+ WHEN "1000000"|"1000001"|"1000010"|"1000011"|"1000100"|"1000101"|"1000110"|"1000111"| --trap
+ "1001000"|"1001001"|"1001010"|"1001011"|"1001100"|"1001101"|"1001110"|"1001111" => --trap
trap_trap <='1';
trapmake <= '1';
- WHEN "1010000"|"1010001"|"1010010"|"1010011"|"1010100"|"1010101"|"1010110"|"1010111"=> --link
+
+ WHEN "1010000"|"1010001"|"1010010"|"1010011"|"1010100"|"1010101"|"1010110"|"1010111"=> --link word
datatype <= "10";
- set_exec(opcADD) <= '1'; --for displacement
+ set_exec(opcADD) <= '1'; --for displacement
set_exec(Regwrena) <= '1';
set(no_Flags) <= '1';
IF decodeOPC='1' THEN
@@ -2026,11 +2443,11 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
source_areg <= '1';
set(store_ea_data) <= '1';
END IF;
-
- WHEN "1011000"|"1011001"|"1011010"|"1011011"|"1011100"|"1011101"|"1011110"|"1011111" => --unlink
+
+ WHEN "1011000"|"1011001"|"1011010"|"1011011"|"1011100"|"1011101"|"1011110"|"1011111" => --unlink
datatype <= "10";
set_exec(Regwrena) <= '1';
- set_exec(opcMOVE) <= '1';
+ set_exec(opcMOVE) <= '1';
set(no_Flags) <= '1';
IF decodeOPC='1' THEN
setstate <= "01";
@@ -2041,10 +2458,10 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
source_lowbits <= '1';
source_areg <= '1';
END IF;
-
- WHEN "1100000"|"1100001"|"1100010"|"1100011"|"1100100"|"1100101"|"1100110"|"1100111" => --move An,USP
+
+ WHEN "1100000"|"1100001"|"1100010"|"1100011"|"1100100"|"1100101"|"1100110"|"1100111" => --move An,USP
IF SVmode='1' THEN
--- set(no_Flags) <= '1';
+-- set(no_Flags) <= '1';
set(to_USP) <= '1';
source_lowbits <= '1';
source_areg <= '1';
@@ -2053,9 +2470,10 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
trap_priv <= '1';
trapmake <= '1';
END IF;
- WHEN "1101000"|"1101001"|"1101010"|"1101011"|"1101100"|"1101101"|"1101110"|"1101111" => --move USP,An
+
+ WHEN "1101000"|"1101001"|"1101010"|"1101011"|"1101100"|"1101101"|"1101110"|"1101111" => --move USP,An
IF SVmode='1' THEN
--- set(no_Flags) <= '1';
+-- set(no_Flags) <= '1';
set(from_USP) <= '1';
datatype <= "10";
set_exec(Regwrena) <= '1';
@@ -2063,37 +2481,37 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
trap_priv <= '1';
trapmake <= '1';
END IF;
-
- WHEN "1110000" => --reset
+
+ WHEN "1110000" => --reset
IF SVmode='0' THEN
trap_priv <= '1';
trapmake <= '1';
ELSE
set(opcRESET) <= '1';
IF decodeOPC='1' THEN
- set(ld_rot_cnt) <= '1';
+ set(ld_rot_cnt) <= '1';
set_rot_cnt <= "000000";
END IF;
END IF;
-
- WHEN "1110001" => --nop
-
- WHEN "1110010" => --stop
+
+ WHEN "1110001" => --nop
+
+ WHEN "1110010" => --stop
IF SVmode='0' THEN
trap_priv <= '1';
trapmake <= '1';
ELSE
IF decodeOPC='1' THEN
setnextpass <= '1';
- set_stop <= '1';
+ set_stop <= '1';
END IF;
IF stop='1' THEN
skipFetch <= '1';
- END IF;
-
+ END IF;
+
END IF;
-
- WHEN "1110011"|"1110111" => --rte/rtr
+
+ WHEN "1110011"|"1110111" => --rte/rtr
IF SVmode='1' OR opcode(2)='1' THEN
IF decodeOPC='1' THEN
setstate <= "10";
@@ -2101,8 +2519,8 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
setstackaddr <= '1';
IF opcode(2)='1' THEN
set(directCCR) <= '1';
- ELSE
- set(directSR) <= '1';
+ ELSE
+ set(directSR) <= '1';
END IF;
next_micro_state <= rte1;
END IF;
@@ -2110,8 +2528,8 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
trap_priv <= '1';
trapmake <= '1';
END IF;
-
- WHEN "1110101" => --rts
+
+ WHEN "1110100" => --rtd
datatype <= "10";
IF decodeOPC='1' THEN
setstate <= "10";
@@ -2119,27 +2537,40 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
setstackaddr <= '1';
set(direct_delta) <= '1';
set(directPC) <= '1';
+ set_direct_data <= '1';
+ next_micro_state <= rtd1;
+ END IF;
+
+
+ WHEN "1110101" => --rts
+ datatype <= "10";
+ IF decodeOPC='1' THEN
+ setstate <= "10";
+ set(postadd) <= '1';
+ setstackaddr <= '1';
+ set(direct_delta) <= '1';
+ set(directPC) <= '1';
next_micro_state <= nopnop;
END IF;
-
- WHEN "1110110" => --trapv
+
+ WHEN "1110110" => --trapv
IF decodeOPC='1' THEN
setstate <= "01";
- END IF;
+ END IF;
IF Flags(1)='1' AND state="01" THEN
trap_trapv <= '1';
trapmake <= '1';
END IF;
-
- WHEN "1111010"|"1111011" => --movec
- IF VBR_Stackframe=0 OR (cpu(0)='0' AND VBR_Stackframe=2) THEN
+
+ WHEN "1111010"|"1111011" => --movec
+ IF cpu="00" THEN
trap_illegal <= '1';
trapmake <= '1';
ELSIF SVmode='0' THEN
trap_priv <= '1';
trapmake <= '1';
ELSE
- datatype <= "10"; --Long
+ datatype <= "10"; --Long
IF last_data_read(11 downto 0)=X"800" THEN
set(from_USP) <= '1';
IF opcode(0)='1' THEN
@@ -2148,7 +2579,7 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
END IF;
IF opcode(0)='0' THEN
set_exec(movec_rd) <= '1';
- ELSE
+ ELSE
set_exec(movec_wr) <= '1';
END IF;
IF decodeOPC='1' THEN
@@ -2156,19 +2587,18 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
getbrief <='1';
END IF;
END IF;
-
- WHEN OTHERS =>
+
+ WHEN OTHERS =>
trap_illegal <= '1';
trapmake <= '1';
- END CASE;
+ END CASE;
END IF;
WHEN OTHERS => NULL;
END CASE;
- END IF;
---
+ END IF;
+--
---- 0101 ----------------------------------------------------------------------------
- WHEN "0101" => --subq, addq
-
+ WHEN "0101" => --subq, addq
IF opcode(7 downto 6)="11" THEN --dbcc
IF opcode(5 downto 3)="001" THEN --dbcc
IF decodeOPC='1' THEN
@@ -2176,41 +2606,69 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
set(OP2out_one) <= '1';
data_is_source <= '1';
END IF;
- ELSE --Scc
- datatype <= "00"; --Byte
+ ELSIF opcode(5 downto 3)="111" AND (opcode(2 downto 1)="01" OR opcode(2 downto 0)="100") THEN --trapcc
+ IF cpu(1)='1' THEN -- only 68020+
+ IF opcode(2 downto 1)="01" THEN
+ IF decodeOPC='1' THEN
+ IF opcode(0)='1' THEN --long
+ set(longaktion) <= '1';
+ END IF;
+ next_micro_state <= nop;
+ END IF;
+ ELSE
+ IF decodeOPC='1' THEN
+ setstate <= "01";
+ END IF;
+ END IF;
+ IF exe_condition='1' AND decodeOPC='0' THEN
+ trap_trapv <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE --Scc
+ datatype <= "00"; --Byte
ea_build_now <= '1';
write_back <= '1';
set_exec(opcScc) <= '1';
- IF cpu(0)='1' AND state="10" THEN
+ IF cpu(0)='1' AND state="10" AND addrvalue='0' THEN
skipFetch <= '1';
END IF;
IF opcode(5 downto 4)="00" THEN
set_exec(Regwrena) <= '1';
END IF;
END IF;
- ELSE --addq, subq
- ea_build_now <= '1';
- IF opcode(5 downto 3)="001" THEN
- set(no_Flags) <= '1';
- END IF;
- IF opcode(8)='1' THEN
- set(addsub) <= '1';
- END IF;
- write_back <= '1';
- set_exec(opcADDQ) <= '1';
- set_exec(opcADD) <= '1';
- set_exec(ea_data_OP1) <= '1';
- IF opcode(5 downto 4)="00" THEN
- set_exec(Regwrena) <= '1';
+ ELSE --addq, subq
+ IF opcode(7 downto 3)/="00001" AND
+ (opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00") THEN --ea illegal modes
+ ea_build_now <= '1';
+ IF opcode(5 downto 3)="001" THEN
+ set(no_Flags) <= '1';
+ END IF;
+ IF opcode(8)='1' THEN
+ set(addsub) <= '1';
+ END IF;
+ write_back <= '1';
+ set_exec(opcADDQ) <= '1';
+ set_exec(opcADD) <= '1';
+ set_exec(ea_data_OP1) <= '1';
+ IF opcode(5 downto 4)="00" THEN
+ set_exec(Regwrena) <= '1';
+ END IF;
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
END IF;
END IF;
---
----- 0110 ----------------------------------------------------------------------------
- WHEN "0110" => --bra,bsr,bcc
+--
+---- 0110 ----------------------------------------------------------------------------
+ WHEN "0110" => --bra,bsr,bcc
datatype <= "10";
-
+
IF micro_state=idle THEN
- IF opcode(11 downto 8)="0001" THEN --bsr
+ IF opcode(11 downto 8)="0001" THEN --bsr
set(presub) <= '1';
setstackaddr <='1';
IF opcode(7 downto 0)="11111111" THEN
@@ -2218,12 +2676,12 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
set(longaktion) <= '1';
ELSIF opcode(7 downto 0)="00000000" THEN
next_micro_state <= bsr2;
- ELSE
+ ELSE
next_micro_state <= bsr1;
setstate <= "11";
writePC <= '1';
END IF;
- ELSE --bra
+ ELSE --bra
IF opcode(7 downto 0)="11111111" THEN
next_micro_state <= bra1;
set(longaktion) <= '1';
@@ -2234,28 +2692,27 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
next_micro_state <= bra1;
END IF;
END IF;
+ END IF;
+
+-- 0111 ----------------------------------------------------------------------------
+ WHEN "0111" => --moveq
+ IF opcode(8)='0' THEN
+ datatype <= "10"; --Long
+ set_exec(Regwrena) <= '1';
+ set_exec(opcMOVEQ) <= '1';
+ set_exec(opcMOVE) <= '1';
+ dest_hbits <= '1';
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
END IF;
-
--- 0111 ----------------------------------------------------------------------------
- WHEN "0111" => --moveq
--- IF opcode(8)='0' THEN -- Cloanto's Amiga Forver ROMs have mangled movq instructions with a 1 here...
- IF trap_interrupt='0' AND trap_trace='0' THEN
- datatype <= "10"; --Long
- set_exec(Regwrena) <= '1';
- set_exec(opcMOVEQ) <= '1';
- set_exec(opcMOVE) <= '1';
- dest_hbits <= '1';
- END IF;
--- ELSE
--- trap_illegal <= '1';
--- trapmake <= '1';
--- END IF;
-
----- 1000 ----------------------------------------------------------------------------
- WHEN "1000" => --or
- IF opcode(7 downto 6)="11" THEN --divu, divs
- IF DIV_Mode/=3 THEN
- IF opcode(5 downto 4)="00" THEN --Dn, An
+
+---- 1000 ----------------------------------------------------------------------------
+ WHEN "1000" => --or
+ IF opcode(7 downto 6)="11" THEN --divu, divs
+ IF DIV_Mode/=3 AND
+ opcode(5 downto 3)/="001" AND (opcode(5 downto 2)/="1111" OR opcode(1 downto 0)="00") THEN --ea illegal modes
+ IF opcode(5 downto 4)="00" THEN --Dn, An
regdirectsource <= '1';
END IF;
IF (micro_state=idle AND nextpass='1') OR (opcode(5 downto 4)="00" AND decodeOPC='1') THEN
@@ -2275,123 +2732,132 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
trap_illegal <= '1';
trapmake <= '1';
END IF;
-
- ELSIF opcode(8)='1' AND opcode(5 downto 4)="00" THEN --sbcd, pack , unpack
- IF opcode(7 downto 6)="00" THEN --sbcd
+ ELSIF opcode(8)='1' AND opcode(5 downto 4)="00" THEN --sbcd, pack , unpack
+ IF opcode(7 downto 6)="00" THEN --sbcd
build_bcd <= '1';
set_exec(opcADD) <= '1';
set_exec(opcSBCD) <= '1';
- ELSIF cpu(1)='1' AND (opcode(7 downto 6)="01" OR opcode(7 downto 6)="10") THEN --pack, unpack
- datatype <= "01"; --Word
- set_exec(opcPACK) <= '1';
- set(no_Flags) <= '1'; -- this command modifies no flags
-
- -- immediate value is kept in op1
- -- source value is in op2
-
- -- xyz
- if opcode(3)='0' then -- R/M bit = 0 -> Dy->Dy, 1 -(Ax),-(Ay)
- dest_hbits <='1'; -- dest register is encoded in bits 9-11
- source_lowbits <= '1'; -- source register is encoded in bits 0-2
-
- set_exec(Regwrena) <= '1'; -- write result into register
- set_exec(ea_data_OP1) <= '1'; -- immediate value goes into op2
- set(hold_dwr) <= '1';
-
- -- pack writes a byte only
- IF opcode(7 downto 6) = "01" THEN
- datatype <= "00"; --Byte
- ELSE
- datatype <= "01"; --Word
- END IF;
-
- IF decodeOPC='1' THEN
- next_micro_state <= nop;
- set_direct_data <= '1';
- END IF;
- else
- set_exec(ea_data_OP1) <= '1';
- source_lowbits <= '1'; -- source register is encoded in bits 0-2
-
- IF decodeOPC='1' THEN
- -- first step: read source value
- IF opcode(7 downto 6) = "10" THEN -- UNPK reads a byte
- datatype <= "00"; -- Byte
- END IF;
- set_direct_data <= '1';
- setstate <= "10";
- set(update_ld) <= '1';
- set(presub) <= '1';
- next_micro_state <= pack1;
- dest_areg <= '1'; --???
- end IF;
- end IF;
- ELSE
+ set(addsub) <= '1';
+ ELSIF opcode(7 downto 6)="01" OR opcode(7 downto 6)="10" THEN --pack , unpack
+ set_exec(ea_data_OP1) <= '1';
+ set(no_Flags) <= '1';
+ source_lowbits <='1';
+ IF opcode(7 downto 6) = "01" THEN --pack
+ set_exec(opcPACK) <= '1';
+ datatype <= "01"; --Word
+ ELSE --unpk
+ set_exec(opcUNPACK) <= '1';
+ datatype <= "00"; --Byte
+ END IF;
+ IF opcode(3)='0' THEN
+ IF opcode(7 downto 6) = "01" THEN --pack
+ set_datatype <= "00"; --Byte
+ ELSE --unpk
+ set_datatype <= "01"; --Word
+ END IF;
+ set_exec(Regwrena) <= '1';
+ dest_hbits <= '1';
+ IF decodeOPC='1' THEN
+ next_micro_state <= nop;
+-- set_direct_data <= '1';
+ set(store_ea_packdata) <= '1';
+ set(store_ea_data) <= '1';
+ END IF;
+ ELSE -- pack -(Ax),-(Ay)
+ write_back <= '1';
+ IF decodeOPC='1' THEN
+ next_micro_state <= pack1;
+ set_direct_data <= '1';
+ END IF;
+ END IF;
+ ELSE
trap_illegal <= '1';
trapmake <= '1';
END IF;
- ELSE --or
- set_exec(opcOR) <= '1';
- build_logical <= '1';
- END IF;
-
----- 1001, 1101 -----------------------------------------------------------------------
- WHEN "1001"|"1101" => --sub, add
- set_exec(opcADD) <= '1';
- ea_build_now <= '1';
- IF opcode(14)='0' THEN
- set(addsub) <= '1';
- END IF;
- IF opcode(7 downto 6)="11" THEN -- --adda, suba
- IF opcode(8)='0' THEN --adda.w, suba.w
- datatype <= "01"; --Word
- END IF;
- set_exec(Regwrena) <= '1';
- source_lowbits <='1';
- IF opcode(3)='1' THEN
- source_areg <= '1';
- END IF;
- set(no_Flags) <= '1';
- IF setexecOPC='1' THEN
- dest_areg <='1';
- dest_hbits <= '1';
- END IF;
- ELSE
- IF opcode(8)='1' AND opcode(5 downto 4)="00" THEN --addx, subx
- build_bcd <= '1';
- ELSE --sub, add
+ ELSE --or
+ IF opcode(7 downto 6)/="11" AND --illegal opmode
+ ((opcode(8)='0' AND opcode(5 downto 3)/="001" AND (opcode(5 downto 2)/="1111" OR opcode(1 downto 0)="00")) OR --illegal src ea
+ (opcode(8)='1' AND opcode(5 downto 4)/="00" AND (opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00"))) THEN --illegal dst ea
+ set_exec(opcOR) <= '1';
build_logical <= '1';
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
END IF;
END IF;
-
---
----- 1010 ----------------------------------------------------------------------------
- WHEN "1010" => --Trap 1010
- trap_1010 <= '1';
- trapmake <= '1';
----- 1011 ----------------------------------------------------------------------------
- WHEN "1011" => --eor, cmp
- ea_build_now <= '1';
- IF opcode(7 downto 6)="11" THEN --CMPA
- IF opcode(8)='0' THEN --cmpa.w
- datatype <= "01"; --Word
- set_exec(opcCPMAW) <= '1';
+
+---- 1001, 1101 -----------------------------------------------------------------------
+ WHEN "1001"|"1101" => --sub, add
+ IF opcode(8 downto 3)/="000001" AND --byte src address reg direct
+ (((opcode(8)='0' OR opcode(7 downto 6)="11") AND (opcode(5 downto 2)/="1111" OR opcode(1 downto 0)="00")) OR --illegal src ea
+ (opcode(8)='1' AND (opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00"))) THEN --illegal dst ea
+ set_exec(opcADD) <= '1';
+ ea_build_now <= '1';
+ IF opcode(14)='0' THEN
+ set(addsub) <= '1';
END IF;
- set_exec(opcCMP) <= '1';
- IF setexecOPC='1' THEN
+ IF opcode(7 downto 6)="11" THEN -- --adda, suba
+ IF opcode(8)='0' THEN --adda.w, suba.w
+ datatype <= "01"; --Word
+ END IF;
+ set_exec(Regwrena) <= '1';
source_lowbits <='1';
IF opcode(3)='1' THEN
source_areg <= '1';
END IF;
- dest_areg <='1';
- dest_hbits <= '1';
+ set(no_Flags) <= '1';
+ IF setexecOPC='1' THEN
+ dest_areg <='1';
+ dest_hbits <= '1';
+ END IF;
+ ELSE
+ IF opcode(8)='1' AND opcode(5 downto 4)="00" THEN --addx, subx
+ build_bcd <= '1';
+ ELSE --sub, add
+ build_logical <= '1';
+ END IF;
END IF;
- set(addsub) <= '1';
ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+--
+---- 1010 ----------------------------------------------------------------------------
+ WHEN "1010" => --Trap 1010
+ trap_1010 <= '1';
+ trapmake <= '1';
+---- 1011 ----------------------------------------------------------------------------
+ WHEN "1011" => --eor, cmp
+ IF opcode(7 downto 6)="11" THEN --CMPA
+ IF opcode(5 downto 2)/="1111" OR opcode(1 downto 0)="00" THEN --illegal src ea
+ ea_build_now <= '1';
+ IF opcode(8)='0' THEN --cmpa.w
+ datatype <= "01"; --Word
+ set_exec(opcCPMAW) <= '1';
+ END IF;
+ set_exec(opcCMP) <= '1';
+ IF setexecOPC='1' THEN
+ source_lowbits <='1';
+ IF opcode(3)='1' THEN
+ source_areg <= '1';
+ END IF;
+ dest_areg <='1';
+ dest_hbits <= '1';
+ END IF;
+ set(addsub) <= '1';
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE --cmpm, eor, cmp
IF opcode(8)='1' THEN
- IF opcode(5 downto 3)="001" THEN --cmpm
+ IF opcode(5 downto 3)="001" THEN --cmpm
+ ea_build_now <= '1';
set_exec(opcCMP) <= '1';
IF decodeOPC='1' THEN
+ IF opcode(2 downto 0)="111" THEN
+ set(use_SP) <= '1';
+ END IF;
setstate <= "10";
set(update_ld) <= '1';
set(postadd) <= '1';
@@ -2399,28 +2865,47 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
END IF;
set_exec(ea_data_OP1) <= '1';
set(addsub) <= '1';
- ELSE --EOR
- build_logical <= '1';
- set_exec(opcEOR) <= '1';
+ ELSE --EOR
+ IF opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00" THEN --illegal dst ea
+ ea_build_now <= '1';
+ build_logical <= '1';
+ set_exec(opcEOR) <= '1';
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ END IF;
+ ELSE --CMP
+ IF opcode(8 downto 3)/="000001" AND --byte src address reg direct
+ (opcode(5 downto 2)/="1111" OR opcode(1 downto 0)="00") THEN --illegal src ea
+ ea_build_now <= '1';
+ build_logical <= '1';
+ set_exec(opcCMP) <= '1';
+ set(addsub) <= '1';
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
END IF;
- ELSE --CMP
- build_logical <= '1';
- set_exec(opcCMP) <= '1';
- set(addsub) <= '1';
END IF;
END IF;
---
----- 1100 ----------------------------------------------------------------------------
- WHEN "1100" => --and, exg
- IF opcode(7 downto 6)="11" THEN --mulu, muls
- IF MUL_Mode/=3 THEN
- IF opcode(5 downto 4)="00" THEN --Dn, An
+--
+---- 1100 ----------------------------------------------------------------------------
+ WHEN "1100" => --and, exg
+ IF opcode(7 downto 6)="11" THEN --mulu, muls
+ IF MUL_Mode/=3 AND
+ opcode(5 downto 3)/="001" AND (opcode(5 downto 2)/="1111" OR opcode(1 downto 0)="00") THEN --ea illegal modes
+ IF opcode(5 downto 4)="00" THEN --Dn, An
regdirectsource <= '1';
END IF;
- IF (micro_state=idle AND nextpass='1') OR (opcode(5 downto 4)="00" AND decodeOPC='1') THEN
- setstate <="01";
- set(ld_rot_cnt) <= '1';
- next_micro_state <= mul1;
+ IF (micro_state=idle AND nextpass='1') OR (opcode(5 downto 4)="00" AND decodeOPC='1') THEN
+ IF MUL_Hardware=0 THEN
+ setstate <="01";
+ set(ld_rot_cnt) <= '1';
+ next_micro_state <= mul1;
+ ELSE
+ set_exec(write_lowlong) <= '1';
+ set_exec(opcMULU) <= '1';
+ END IF;
END IF;
ea_build_now <= '1';
set_exec(Regwrena) <= '1';
@@ -2429,47 +2914,75 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
dest_hbits <= '1';
END IF;
datatype <= "01";
+ IF setexecOPC='1' THEN
+ datatype <= "10";
+ END IF;
ELSE
trap_illegal <= '1';
trapmake <= '1';
END IF;
-
- ELSIF opcode(8)='1' AND opcode(5 downto 4)="00" THEN --exg, abcd
- IF opcode(7 downto 6)="00" THEN --abcd
+ ELSIF opcode(8)='1' AND opcode(5 downto 4)="00" THEN --exg, abcd
+ IF opcode(7 downto 6)="00" THEN --abcd
build_bcd <= '1';
set_exec(opcADD) <= '1';
set_exec(opcABCD) <= '1';
- ELSE --exg
- datatype <= "10";
- set(Regwrena) <= '1';
- set(exg) <= '1';
- IF opcode(6)='1' AND opcode(3)='1' THEN
- dest_areg <= '1';
- source_areg <= '1';
- END IF;
- IF decodeOPC='1' THEN
- setstate <= "01";
+ ELSE --exg
+ IF opcode(7 downto 4)="0100" OR opcode(7 downto 3)="10001" THEN
+ datatype <= "10";
+ set(Regwrena) <= '1';
+ set(exg) <= '1';
+ set(alu_move) <= '1';
+ IF opcode(6)='1' AND opcode(3)='1' THEN
+ dest_areg <= '1';
+ source_areg <= '1';
+ END IF;
+ IF decodeOPC='1' THEN
+ setstate <= "01";
+ ELSE
+ dest_hbits <= '1';
+ END IF;
ELSE
- dest_hbits <= '1';
+ trap_illegal <= '1';
+ trapmake <= '1';
END IF;
END IF;
- ELSE --and
- set_exec(opcAND) <= '1';
- build_logical <= '1';
+ ELSE --and
+ IF opcode(7 downto 6)/="11" AND --illegal opmode
+ ((opcode(8)='0' AND opcode(5 downto 3)/="001" AND (opcode(5 downto 2)/="1111" OR opcode(1 downto 0)="00")) OR --illegal src ea
+ (opcode(8)='1' AND opcode(5 downto 4)/="00" AND (opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00"))) THEN --illegal dst ea
+ set_exec(opcAND) <= '1';
+ build_logical <= '1';
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
END IF;
---
----- 1110 ----------------------------------------------------------------------------
- WHEN "1110" => --rotation / bitfield
+--
+---- 1110 ----------------------------------------------------------------------------
+ WHEN "1110" => --rotation / bitfield
IF opcode(7 downto 6)="11" THEN
IF opcode(11)='0' THEN
- set_exec(opcROT) <= '1';
- ea_build_now <= '1';
- datatype <= "01";
- set_rot_bits <= opcode(10 downto 9);
- set_exec(ea_data_OP1) <= '1';
- write_back <= '1';
- ELSE --bitfield
- IF BitField=0 OR (cpu(1)='0' AND BitField=2) THEN
+ IF (opcode(5 downto 4)/="00" AND (opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00")) THEN --ea illegal modes
+ IF BarrelShifter=0 THEN
+ set_exec(opcROT) <= '1';
+ ELSE
+ set_exec(exec_BS) <='1';
+ END IF;
+ ea_build_now <= '1';
+ datatype <= "01";
+ set_rot_bits <= opcode(10 downto 9);
+ set_exec(ea_data_OP1) <= '1';
+ write_back <= '1';
+ ELSE
+ trap_illegal <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE --bitfield
+ IF BitField=0 OR (cpu(1)='0' AND BitField=2) OR
+ ((opcode(10 downto 9)="11" OR opcode(10 downto 8)="010" OR opcode(10 downto 8)="100") AND
+ (opcode(5 downto 3)="001" OR opcode(5 downto 3)="011" OR opcode(5 downto 3)="100" OR (opcode(5 downto 3)="111" AND opcode(2 downto 1)/="00"))) OR
+ ((opcode(10 downto 9)="00" OR opcode(10 downto 8)="011" OR opcode(10 downto 8)="101") AND
+ (opcode(5 downto 3)="001" OR opcode(5 downto 3)="011" OR opcode(5 downto 3)="100" OR opcode(5 downto 2)="1111")) THEN
trap_illegal <= '1';
trapmake <= '1';
ELSE
@@ -2479,26 +2992,24 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
set(ea_build) <= '1';
END IF;
set_exec(opcBF) <= '1';
+-- 000-bftst, 001-bfextu, 010-bfchg, 011-bfexts, 100-bfclr, 101-bfff0, 110-bfset, 111-bfins
IF opcode(10)='1' OR opcode(8)='0' THEN
- set_exec(opcBFwb) <= '1';
- IF opcode(10 downto 8)/="111" THEN -- bfins
- set_exec(ea_data_OP2) <= '1'; -- for the flags
- END IF;
+ set_exec(opcBFwb) <= '1'; --'1' for tst,chg,clr,ffo,set,ins --'0' for extu,exts
+ END IF;
+ IF opcode(10 downto 8)="111" THEN --BFINS
set_exec(ea_data_OP1) <= '1';
END IF;
-
- -- BFCHG, BFCLR, BFSET, BFINS
IF opcode(10 downto 8)="010" OR opcode(10 downto 8)="100" OR opcode(10 downto 8)="110" OR opcode(10 downto 8)="111" THEN
write_back <= '1';
END IF;
ea_only <= '1';
- -- BFEXTU, BFEXTS, BFFFO
IF opcode(10 downto 8)="001" OR opcode(10 downto 8)="011" OR opcode(10 downto 8)="101" THEN
set_exec(Regwrena) <= '1';
END IF;
- -- register destination
IF opcode(4 downto 3)="00" THEN
- set_exec(Regwrena) <= '1';
+ IF opcode(10 downto 8)/="000" THEN
+ set_exec(Regwrena) <= '1';
+ END IF;
IF exec(ea_build)='1' THEN
dest_2ndHbits <= '1';
source_2ndLbits <= '1';
@@ -2517,45 +3028,122 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
set(mem_addsub) <='1';
next_micro_state <= bf1;
END IF;
-
--- BFINS D1,D0 s2ndHbits < D0
--- BFEXT D0,D1 sLbits >>D0 -> D1 d2ndHbits
--- BFINS D1,(A0) s2ndHbits < (A0)
--- BFEXT (A0),D1 >>(A0) -> D1 d2ndHbits
IF setexecOPC='1' THEN
- IF opcode(10 downto 8)="111" THEN --BFINS
+ IF opcode(10 downto 8)="111" THEN --BFINS
source_2ndHbits <= '1';
- ELSIF opcode(10 downto 8)="001" or opcode(10 downto 8)="011" THEN --BFEXT
+ ELSE
source_lowbits <= '1';
+ END IF;
+ IF opcode(10 downto 8)="001" OR opcode(10 downto 8)="011" OR opcode(10 downto 8)="101" THEN --BFEXT, BFFFO
dest_2ndHbits <= '1';
END IF;
END IF;
END IF;
END IF;
ELSE
- set_exec(opcROT) <= '1';
- set_rot_bits <= opcode(4 downto 3);
data_is_source <= '1';
- set_exec(Regwrena) <= '1';
- IF decodeOPC='1' THEN
- IF opcode(5)='1' THEN
- next_micro_state <= rota1;
- set(ld_rot_cnt) <= '1';
- setstate <= "01";
- ELSE
- set_rot_cnt(2 downto 0) <= opcode(11 downto 9);
- IF opcode(11 downto 9)="000" THEN
- set_rot_cnt(3) <='1';
+ IF BarrelShifter=0 OR (cpu(1)='0' AND BarrelShifter=2) THEN
+ set_exec(opcROT) <= '1';
+ set_rot_bits <= opcode(4 downto 3);
+ set_exec(Regwrena) <= '1';
+ IF decodeOPC='1' THEN
+ IF opcode(5)='1' THEN
+ next_micro_state <= rota1;
+ set(ld_rot_cnt) <= '1';
+ setstate <= "01";
ELSE
- set_rot_cnt(3) <='0';
+ set_rot_cnt(2 downto 0) <= opcode(11 downto 9);
+ IF opcode(11 downto 9)="000" THEN
+ set_rot_cnt(3) <='1';
+ ELSE
+ set_rot_cnt(3) <='0';
+ END IF;
END IF;
END IF;
+ ELSE
+ set_exec(exec_BS) <='1';
+ set_rot_bits <= opcode(4 downto 3);
+ set_exec(Regwrena) <= '1';
END IF;
END IF;
---
----- ----------------------------------------------------------------------------
+--
+---- 1111 ----------------------------------------------------------------------------
+ WHEN "1111" =>
+ IF cpu(1)='1' AND opcode(8 downto 6)="100" THEN --cpSAVE
+ IF opcode(5 downto 4)/="00" AND opcode(5 downto 3)/="011" AND
+ (opcode(5 downto 3)/="111" OR opcode(2 downto 1)="00") THEN --ea illegal modes
+ IF opcode(11 downto 9)/="000" THEN
+ IF SVmode='1' THEN
+ IF opcode(5)='0' AND opcode(5 downto 4)/="01" THEN
+ --never reached according to cputest?!
+ --cpSAVE not implemented
+ trap_illegal <= '1';
+ trapmake <= '1';
+ ELSE
+ trap_1111 <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE
+ trap_priv <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE
+ IF SVmode='1' THEN
+ trap_1111 <= '1';
+ trapmake <= '1';
+ ELSE
+ trap_priv <= '1';
+ trapmake <= '1';
+ END IF;
+ END IF;
+ ELSE
+ trap_1111 <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSIF cpu(1)='1' AND opcode(8 downto 6)="101" THEN --cpRESTORE
+ IF opcode(5 downto 4)/="00" AND opcode(5 downto 3)/="100" AND
+ (opcode(5 downto 3)/="111" OR (opcode(2 downto 1)/="11" AND
+ opcode(2 downto 0)/="101")) THEN --ea illegal modes
+ IF opcode(5 downto 1)/="11110" THEN
+ IF opcode(11 downto 9)="001" OR opcode(11 downto 9)="010" THEN
+ IF SVmode='1' THEN
+ IF opcode(5 downto 3)="101" THEN
+ --cpRESTORE not implemented
+ trap_illegal <= '1';
+ trapmake <= '1';
+ ELSE
+ trap_1111 <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE
+ trap_priv <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE
+ IF SVmode='1' THEN
+ trap_1111 <= '1';
+ trapmake <= '1';
+ ELSE
+ trap_priv <= '1';
+ trapmake <= '1';
+ END IF;
+ END IF;
+ ELSE
+ trap_1111 <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE
+ trap_1111 <= '1';
+ trapmake <= '1';
+ END IF;
+ ELSE
+ trap_1111 <= '1';
+ trapmake <= '1';
+ END IF;
+--
+---- ----------------------------------------------------------------------------
WHEN OTHERS =>
- trap_1111 <= '1';
+ trap_illegal <= '1';
trapmake <= '1';
END CASE;
@@ -2563,7 +3151,7 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
-- use for AND, OR, EOR, CMP
IF build_logical='1' THEN
ea_build_now <= '1';
- IF set_exec(opcCMP)='0' AND (opcode(8)='0' OR opcode(5 downto 4)="00" ) THEN
+ IF set_exec(opcCMP)='0' AND (opcode(8)='0' OR opcode(5 downto 4)="00" ) THEN
set_exec(Regwrena) <= '1';
END IF;
IF opcode(8)='1' THEN
@@ -2571,7 +3159,7 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
set_exec(ea_data_OP1) <= '1';
ELSE
source_lowbits <='1';
- IF opcode(3)='1' THEN --use for cmp
+ IF opcode(3)='1' THEN --use for cmp
source_areg <= '1';
END IF;
IF setexecOPC='1' THEN
@@ -2579,7 +3167,7 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
END IF;
END IF;
END IF;
-
+
-- use for ABCD, SBCD
IF build_bcd='1' THEN
set_exec(use_XZFlag) <= '1';
@@ -2588,33 +3176,36 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
source_lowbits <='1';
IF opcode(3)='1' THEN
IF decodeOPC='1' THEN
+ IF opcode(2 downto 0)="111" THEN
+ set(use_SP) <= '1';
+ END IF;
setstate <= "10";
set(update_ld) <= '1';
set(presub) <= '1';
next_micro_state <= op_AxAy;
- dest_areg <= '1'; --???
+ dest_areg <= '1'; --???
END IF;
ELSE
dest_hbits <= '1';
set_exec(Regwrena) <= '1';
END IF;
END IF;
+
-
-------------------------------------------------------------------------------
-------------------------------------------------------------------------------
- IF set_Z_error='1' THEN -- divu by zero
- trapmake <= '1'; --wichtig for USP
+------------------------------------------------------------------------------
+------------------------------------------------------------------------------
+ IF set_Z_error='1' THEN -- divu by zero
+ trapmake <= '1'; --wichtig for USP
IF trapd='0' THEN
writePC <= '1';
- END IF;
- END IF;
-
+ END IF;
+ END IF;
+
-----------------------------------------------------------------------------
-- execute microcode
-----------------------------------------------------------------------------
IF rising_edge(clk) THEN
- IF Reset='1' THEN
+ IF Reset='1' THEN
micro_state <= ld_nn;
ELSIF clkena_lw='1' THEN
trapd <= trapmake;
@@ -2623,31 +3214,30 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
END IF;
CASE micro_state IS
- WHEN ld_nn => -- (nnnn).w/l=>
+ WHEN ld_nn => -- (nnnn).w/l=>
set(get_ea_now) <='1';
setnextpass <= '1';
set(addrlong) <= '1';
-
- WHEN st_nn => -- =>(nnnn).w/l
+
+ WHEN st_nn => -- =>(nnnn).w/l
setstate <= "11";
set(addrlong) <= '1';
next_micro_state <= nop;
-
- WHEN ld_dAn1 => -- d(An)=>, --d(PC)=>
+
+ WHEN ld_dAn1 => -- d(An)=>, --d(PC)=>
set(get_ea_now) <='1';
- setdisp <= '1'; --word
+ setdisp <= '1'; --word
setnextpass <= '1';
-
- WHEN ld_AnXn1 => -- d(An,Xn)=>, --d(PC,Xn)=>
+
+ WHEN ld_AnXn1 => -- d(An,Xn)=>, --d(PC,Xn)=>
IF brief(8)='0' OR extAddr_Mode=0 OR (cpu(1)='0' AND extAddr_Mode=2) THEN
- -- mikej brief extension word only
- setdisp <= '1'; --byte
+ setdisp <= '1'; --byte
setdispbyte <= '1';
setstate <= "01";
set(briefext) <= '1';
next_micro_state <= ld_AnXn2;
- ELSE
- IF brief(7)='1'THEN --suppress Base
+ ELSE
+ IF brief(7)='1'THEN --suppress Base
set_suppress_base <= '1';
ELSIF exec(dispouter)='1' THEN
set(dispouter) <= '1';
@@ -2661,46 +3251,48 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
END IF;
next_micro_state <= ld_229_1;
END IF;
-
+
WHEN ld_AnXn2 =>
set(get_ea_now) <='1';
- setdisp <= '1'; --brief
+ setdisp <= '1'; --brief
setnextpass <= '1';
-
--------------------------------------------------------------------------------------
-
- WHEN ld_229_1 => -- (bd,An,Xn)=>, --(bd,PC,Xn)=>
+
+-------------------------------------------------------------------------------------
+
+ WHEN ld_229_1 => -- (bd,An,Xn)=>, --(bd,PC,Xn)=>
IF brief(5)='1' THEN --Base Displacement
- setdisp <= '1'; --add last_data_read
+ setdisp <= '1'; --add last_data_read
END IF;
IF brief(6)='0' AND brief(2)='0' THEN --Preindex or Index
set(briefext) <= '1';
setstate <= "01";
IF brief(1 downto 0)="00" THEN
next_micro_state <= ld_AnXn2;
- ELSE
+ ELSE
next_micro_state <= ld_229_2;
- END IF;
+ END IF;
ELSE
IF brief(1 downto 0)="00" THEN
set(get_ea_now) <='1';
setnextpass <= '1';
ELSE
- setstate <= "10";
+ setstate <= "10";
+ setaddrvalue <= '1';
set(longaktion) <= '1';
next_micro_state <= ld_229_3;
END IF;
END IF;
-
- WHEN ld_229_2 => -- (bd,An,Xn)=>, --(bd,PC,Xn)=>
- setdisp <= '1'; -- add Index
+
+ WHEN ld_229_2 => -- (bd,An,Xn)=>, --(bd,PC,Xn)=>
+ setdisp <= '1'; -- add Index
setstate <= "10";
+ setaddrvalue <= '1';
set(longaktion) <= '1';
next_micro_state <= ld_229_3;
-
- WHEN ld_229_3 => -- (bd,An,Xn)=>, --(bd,PC,Xn)=>
+
+ WHEN ld_229_3 => -- (bd,An,Xn)=>, --(bd,PC,Xn)=>
set_suppress_base <= '1';
- set(dispouter) <= '1';
+ set(dispouter) <= '1';
IF brief(1)='0' THEN --NULL Outer Displacement
setstate <= "01";
ELSE --WORD Outer Displacement
@@ -2709,10 +3301,10 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
END IF;
END IF;
next_micro_state <= ld_229_4;
-
- WHEN ld_229_4 => -- (bd,An,Xn)=>, --(bd,PC,Xn)=>
+
+ WHEN ld_229_4 => -- (bd,An,Xn)=>, --(bd,PC,Xn)=>
IF brief(1)='1' THEN -- Outer Displacement
- setdisp <= '1'; --add last_data_read
+ setdisp <= '1'; --add last_data_read
END IF;
IF brief(6)='0' AND brief(2)='1' THEN --Postindex
set(briefext) <= '1';
@@ -2722,25 +3314,25 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
set(get_ea_now) <='1';
setnextpass <= '1';
END IF;
-
-----------------------------------------------------------------------------------------
- WHEN st_dAn1 => -- =>d(An)
+
+----------------------------------------------------------------------------------------
+ WHEN st_dAn1 => -- =>d(An)
setstate <= "11";
- setdisp <= '1'; --word
+ setdisp <= '1'; --word
next_micro_state <= nop;
-
- WHEN st_AnXn1 => -- =>d(An,Xn)
+
+ WHEN st_AnXn1 => -- =>d(An,Xn)
IF brief(8)='0' OR extAddr_Mode=0 OR (cpu(1)='0' AND extAddr_Mode=2) THEN
- setdisp <= '1'; --byte
+ setdisp <= '1'; --byte
setdispbyte <= '1';
setstate <= "01";
set(briefext) <= '1';
next_micro_state <= st_AnXn2;
- ELSE
- IF brief(7)='1'THEN --suppress Base
+ ELSE
+ IF brief(7)='1'THEN --suppress Base
set_suppress_base <= '1';
--- ELSIF exec(dispouter)='1' THEN
--- set(dispouter) <= '1';
+-- ELSIF exec(dispouter)='1' THEN
+-- set(dispouter) <= '1';
END IF;
IF brief(5)='0' THEN --NULL Base Displacement
setstate <= "01";
@@ -2751,26 +3343,27 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
END IF;
next_micro_state <= st_229_1;
END IF;
-
+
WHEN st_AnXn2 =>
setstate <= "11";
- setdisp <= '1'; --brief
+ setdisp <= '1'; --brief
+ set(hold_dwr) <= '1';
next_micro_state <= nop;
-
--------------------------------------------------------------------------------------
-
- WHEN st_229_1 => -- (bd,An,Xn)=>, --(bd,PC,Xn)=>
+
+-------------------------------------------------------------------------------------
+
+ WHEN st_229_1 => -- (bd,An,Xn)=>, --(bd,PC,Xn)=>
IF brief(5)='1' THEN --Base Displacement
- setdisp <= '1'; --add last_data_read
+ setdisp <= '1'; --add last_data_read
END IF;
IF brief(6)='0' AND brief(2)='0' THEN --Preindex or Index
set(briefext) <= '1';
setstate <= "01";
IF brief(1 downto 0)="00" THEN
next_micro_state <= st_AnXn2;
- ELSE
+ ELSE
next_micro_state <= st_229_2;
- END IF;
+ END IF;
ELSE
IF brief(1 downto 0)="00" THEN
setstate <= "11";
@@ -2782,18 +3375,18 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
next_micro_state <= st_229_3;
END IF;
END IF;
-
- WHEN st_229_2 => -- (bd,An,Xn)=>, --(bd,PC,Xn)=>
- setdisp <= '1'; -- add Index
+
+ WHEN st_229_2 => -- (bd,An,Xn)=>, --(bd,PC,Xn)=>
+ setdisp <= '1'; -- add Index
set(hold_dwr) <= '1';
setstate <= "10";
set(longaktion) <= '1';
next_micro_state <= st_229_3;
-
- WHEN st_229_3 => -- (bd,An,Xn)=>, --(bd,PC,Xn)=>
+
+ WHEN st_229_3 => -- (bd,An,Xn)=>, --(bd,PC,Xn)=>
set(hold_dwr) <= '1';
set_suppress_base <= '1';
- set(dispouter) <= '1';
+ set(dispouter) <= '1';
IF brief(1)='0' THEN --NULL Outer Displacement
setstate <= "01";
ELSE --WORD Outer Displacement
@@ -2802,11 +3395,11 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
END IF;
END IF;
next_micro_state <= st_229_4;
-
- WHEN st_229_4 => -- (bd,An,Xn)=>, --(bd,PC,Xn)=>
+
+ WHEN st_229_4 => -- (bd,An,Xn)=>, --(bd,PC,Xn)=>
set(hold_dwr) <= '1';
IF brief(1)='1' THEN -- Outer Displacement
- setdisp <= '1'; --add last_data_read
+ setdisp <= '1'; --add last_data_read
END IF;
IF brief(6)='0' AND brief(2)='1' THEN --Postindex
set(briefext) <= '1';
@@ -2816,54 +3409,181 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
setstate <= "11";
next_micro_state <= nop;
END IF;
-
-----------------------------------------------------------------------------------------
- WHEN bra1 => --bra
+
+----------------------------------------------------------------------------------------
+ WHEN bra1 => --bra
IF exe_condition='1' THEN
- TG68_PC_brw <= '1'; --pc+0000
+ TG68_PC_brw <= '1'; --pc+0000
next_micro_state <= nop;
- skipFetch <= '1';
+ skipFetch <= '1';
END IF;
-
- WHEN bsr1 => --bsr short
- TG68_PC_brw <= '1';
+
+ WHEN bsr1 => --bsr short
+ TG68_PC_brw <= '1';
next_micro_state <= nop;
-
- WHEN bsr2 => --bsr
- IF long_start='0' THEN
- TG68_PC_brw <= '1';
+
+ WHEN bsr2 => --bsr
+ IF long_start='0' THEN
+ TG68_PC_brw <= '1';
END IF;
- skipFetch <= '1';
+ skipFetch <= '1';
set(longaktion) <= '1';
writePC <= '1';
setstate <= "11";
next_micro_state <= nopnop;
setstackaddr <='1';
- WHEN nopnop => --bsr
+ WHEN nopnop => --bsr
next_micro_state <= nop;
- WHEN dbcc1 => --dbcc
+ WHEN dbcc1 => --dbcc
IF exe_condition='0' THEN
Regwrena_now <= '1';
IF c_out(1)='1' THEN
- skipFetch <= '1';
+ skipFetch <= '1';
next_micro_state <= nop;
- TG68_PC_brw <= '1';
- END IF;
- END IF;
-
- WHEN movem1 => --movem
+ TG68_PC_brw <= '1';
+ END IF;
+ END IF;
+
+ WHEN chk20 => --if C is set -> signed compare
+ set(ea_data_OP1) <= '1';
+ set(addsub) <= '1';
+ set(alu_exec) <= '1';
+ set(alu_setFlags) <= '1';
+ setstate <="01";
+ next_micro_state <= chk21;
+ WHEN chk21 => -- check lower bound
+ dest_2ndHbits <= '1';
+ IF sndOPC(15)='1' THEN
+ set_datatype <="10"; --long
+ dest_LDRareg <= '1';
+ IF opcode(10 downto 9)="00" THEN
+ set(opcEXTB) <= '1';
+ END IF;
+ END IF;
+ set(addsub) <= '1';
+ set(alu_exec) <= '1';
+ set(alu_setFlags) <= '1';
+ setstate <="01";
+ next_micro_state <= chk22;
+ WHEN chk22 => --check upper bound
+ dest_2ndHbits <= '1';
+ set(ea_data_OP2) <= '1';
+ IF sndOPC(15)='1' THEN
+ set_datatype <="10"; --long
+ dest_LDRareg <= '1';
+ END IF;
+ set(addsub) <= '1';
+ set(alu_exec) <= '1';
+ set(opcCHK2) <= '1';
+ set(opcEXTB) <= exec(opcEXTB);
+ IF sndOPC(11)='1' THEN
+ setstate <="01";
+ next_micro_state <= chk23;
+ END IF;
+ WHEN chk23 =>
+ setstate <="01";
+ next_micro_state <= chk24;
+ WHEN chk24 =>
+ IF Flags(0)='1'THEN
+ trapmake <= '1';
+ END IF;
+
+
+ WHEN cas1 =>
+ setstate <="01";
+ next_micro_state <= cas2;
+ WHEN cas2 =>
+ source_2ndMbits <= '1';
+ IF Flags(2)='1'THEN
+ setstate<="11";
+ set(write_reg) <= '1';
+ set(restore_ADDR) <= '1';
+ next_micro_state <= nop;
+ ELSE
+ set(Regwrena) <= '1';
+ set(ea_data_OP2) <='1';
+ dest_2ndLbits <= '1';
+ set(alu_move) <= '1';
+ END IF;
+
+ WHEN cas21 =>
+ dest_2ndHbits <= '1';
+ dest_LDRareg <= sndOPC(15);
+ set(get_ea_now) <='1';
+ next_micro_state <= cas22;
+ WHEN cas22 =>
+ setstate <= "01";
+ source_2ndLbits <= '1';
+ set(ea_data_OP1) <= '1';
+ set(addsub) <= '1';
+ set(alu_exec) <= '1';
+ set(alu_setFlags) <= '1';
+ next_micro_state <= cas23;
+ WHEN cas23 =>
+ dest_LDRHbits <= '1';
+ set(get_ea_now) <='1';
+ next_micro_state <= cas24;
+ WHEN cas24 =>
+ IF Flags(2)='1'THEN
+ set(alu_setFlags) <= '1';
+ END IF;
+ setstate <="01";
+ set(hold_dwr) <= '1';
+ source_LDRLbits <= '1';
+ set(ea_data_OP1) <= '1';
+ set(addsub) <= '1';
+ set(alu_exec) <= '1';
+ next_micro_state <= cas25;
+ WHEN cas25 =>
+ setstate <= "01";
+ set(hold_dwr) <= '1';
+ next_micro_state <= cas26;
+ WHEN cas26 =>
+ IF Flags(2)='1'THEN -- write Update 1 to Destination 1
+ source_2ndMbits <= '1';
+ set(write_reg) <= '1';
+ dest_2ndHbits <= '1';
+ dest_LDRareg <= sndOPC(15);
+ setstate <= "11";
+ set(get_ea_now) <='1';
+ next_micro_state <= cas27;
+ ELSE -- write Destination 2 to Compare 2 first
+ set(hold_dwr) <= '1';
+ set(hold_OP2) <='1';
+ dest_LDRLbits <= '1';
+ set(alu_move) <= '1';
+ set(Regwrena) <= '1';
+ set(ea_data_OP2) <='1';
+ next_micro_state <= cas28;
+ END IF;
+ WHEN cas27 => -- write Update 2 to Destination 2
+ source_LDRMbits <= '1';
+ set(write_reg) <= '1';
+ dest_LDRHbits <= '1';
+ setstate <= "11";
+ set(get_ea_now) <='1';
+ next_micro_state <= nopnop;
+ WHEN cas28 => -- write Destination 1 to Compare 1 second
+ dest_2ndLbits <= '1';
+ set(alu_move) <= '1';
+ set(Regwrena) <= '1';
+
+ WHEN movem1 => --movem
IF last_data_read(15 downto 0)/=X"0000" THEN
setstate <="01";
IF opcode(5 downto 3)="100" THEN
- set(mem_addsub) <= '1';
+ set(mem_addsub) <= '1';
+ IF cpu(1)='1' THEN
+ set(Regwrena) <= '1'; --tg
+ END IF;
END IF;
next_micro_state <= movem2;
END IF;
- WHEN movem2 => --movem
+ WHEN movem2 => --movem
IF movem_run='0' THEN
setstate <="01";
- ELSE
+ ELSE
set(movem_action) <= '1';
set(mem_addsub) <= '1';
next_micro_state <= movem2;
@@ -2873,53 +3593,96 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
ELSE
setstate <="10";
END IF;
- END IF;
+ END IF;
- WHEN andi => --andi
+ WHEN andi => --andi
IF opcode(5 downto 4)/="00" THEN
setnextpass <= '1';
END IF;
- WHEN op_AxAy => -- op -(Ax),-(Ay)
- set_direct_data <= '1';
+ WHEN pack1 => -- pack -(Ax),-(Ay)
+ IF opcode(2 downto 0)="111" THEN
+ set(use_SP) <= '1';
+ END IF;
+ set(hold_ea_data) <= '1';
+ set(update_ld) <= '1';
+ setstate <= "10";
+ set(presub) <= '1';
+ next_micro_state <= pack2;
+ dest_areg <= '1';
+ WHEN pack2 =>
+ IF opcode(11 downto 9)="111" THEN
+ set(use_SP) <= '1';
+ END IF;
+ set(hold_ea_data) <= '1';
+ set_direct_data <= '1';
+ IF opcode(7 downto 6) = "01" THEN --pack
+ datatype <= "00"; --Byte
+ ELSE --unpk
+ datatype <= "01"; --Word
+ END IF;
+ set(presub) <= '1';
+ dest_hbits <= '1';
+ dest_areg <= '1';
+ setstate <= "10";
+ next_micro_state <= pack3;
+ WHEN pack3 =>
+ skipFetch <= '1';
+
+ WHEN op_AxAy => -- op -(Ax),-(Ay)
+ IF opcode(11 downto 9)="111" THEN
+ set(use_SP) <= '1';
+ END IF;
+ set_direct_data <= '1';
set(presub) <= '1';
- dest_hbits <= '1';
+ dest_hbits <= '1';
dest_areg <= '1';
setstate <= "10";
- WHEN cmpm => -- cmpm (Ay)+,(Ax)+
+ WHEN cmpm => -- cmpm (Ay)+,(Ax)+
+ IF opcode(11 downto 9)="111" THEN
+ set(use_SP) <= '1';
+ END IF;
set_direct_data <= '1';
set(postadd) <= '1';
- dest_hbits <= '1';
+ dest_hbits <= '1';
dest_areg <= '1';
setstate <= "10";
-
- WHEN link1 => -- link
+
+ WHEN link1 => -- link
setstate <="11";
source_areg <= '1';
set(opcMOVE) <= '1';
set(Regwrena) <= '1';
next_micro_state <= link2;
- WHEN link2 => -- link
+ WHEN link2 => -- link
setstackaddr <='1';
set(ea_data_OP2) <= '1';
-
- WHEN unlink1 => -- unlink
+
+ WHEN unlink1 => -- unlink
setstate <="10";
setstackaddr <='1';
set(postadd) <= '1';
next_micro_state <= unlink2;
- WHEN unlink2 => -- unlink
- set(ea_data_OP2) <= '1';
-
- WHEN trap0 => -- TRAP
+ WHEN unlink2 => -- unlink
+ set(ea_data_OP2) <= '1';
+
+-- paste and copy form TH ---------
+ WHEN trap00 => -- TRAP format #2
+ next_micro_state <= trap0;
+ set(presub) <= '1';
+ setstackaddr <='1';
+ setstate <= "11";
+ datatype <= "10";
+------------------------------------
+ WHEN trap0 => -- TRAP
set(presub) <= '1';
setstackaddr <='1';
setstate <= "11";
- IF VBR_Stackframe=1 OR (cpu(0)='1' AND VBR_Stackframe=2) THEN --68010
+ IF use_VBR_Stackframe='1' THEN --68010
set(writePC_add) <= '1';
datatype <= "01";
--- set_datatype <= "10";
+-- set_datatype <= "10";
next_micro_state <= trap1;
ELSE
IF trap_interrupt='1' OR trap_trace='1' OR trap_berr='1' THEN
@@ -2927,8 +3690,9 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
END IF;
datatype <= "10";
next_micro_state <= trap2;
- END IF;
- WHEN trap1 => -- TRAP
+ END IF;
+
+ WHEN trap1 => -- TRAP
IF trap_interrupt='1' OR trap_trace='1' THEN
writePC <= '1';
END IF;
@@ -2937,59 +3701,69 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
setstate <= "11";
datatype <= "10";
next_micro_state <= trap2;
- WHEN trap2 => -- TRAP
+ WHEN trap2 => -- TRAP
set(presub) <= '1';
setstackaddr <='1';
setstate <= "11";
datatype <= "01";
writeSR <= '1';
- IF trap_berr='1' THEN
- next_micro_state <= trap4;
+ IF trap_berr='1' THEN
+ next_micro_state <= trap4;
ELSE
- next_micro_state <= trap3;
+ next_micro_state <= trap3;
END IF;
- WHEN trap3 => -- TRAP
+ WHEN trap3 => -- TRAP
set_vectoraddr <= '1';
datatype <= "10";
- set(direct_delta) <= '1';
+ set(direct_delta) <= '1';
set(directPC) <= '1';
- setstate <= "10";
- next_micro_state <= nopnop;
- WHEN trap4 => -- TRAP
- set(presub) <= '1';
- setstackaddr <='1';
- setstate <= "11";
- datatype <= "01";
- writeSR <= '1';
- next_micro_state <= trap5;
- WHEN trap5 => -- TRAP
- set(presub) <= '1';
- setstackaddr <='1';
- setstate <= "11";
- datatype <= "10";
- writeSR <= '1';
- next_micro_state <= trap6;
- WHEN trap6 => -- TRAP
- set(presub) <= '1';
- setstackaddr <='1';
- setstate <= "11";
- datatype <= "01";
- writeSR <= '1';
- next_micro_state <= trap3;
- WHEN rte1 => -- RTE
+ setstate <= "10";
+ next_micro_state <= nopnop;
+ WHEN trap4 => -- TRAP
+ set(presub) <= '1';
+ setstackaddr <='1';
+ setstate <= "11";
+ datatype <= "01";
+ writeSR <= '1';
+ next_micro_state <= trap5;
+ WHEN trap5 => -- TRAP
+ set(presub) <= '1';
+ setstackaddr <='1';
+ setstate <= "11";
+ datatype <= "10";
+ writeSR <= '1';
+ next_micro_state <= trap6;
+ WHEN trap6 => -- TRAP
+ set(presub) <= '1';
+ setstackaddr <='1';
+ setstate <= "11";
+ datatype <= "01";
+ writeSR <= '1';
+ next_micro_state <= trap3;
+
+ -- return from exception - RTE
+ -- fetch PC and status register from stack
+ -- 010+ fetches another word containing
+ -- the 12 bit vector offset and the
+ -- frame format. If the frame format is
+ -- 2 another two words have to be taken
+ -- from the stack
+ WHEN rte1 => -- RTE
datatype <= "10";
setstate <= "10";
set(postadd) <= '1';
setstackaddr <= '1';
- IF VBR_Stackframe=0 OR (cpu(0)='0' AND VBR_Stackframe=2) THEN
- set(direct_delta) <= '1';
+ set(directPC) <= '1';
+ IF use_VBR_Stackframe='0' OR opcode(2)='1' THEN --opcode(2)='1' => opcode is RTR
+ set(update_FC) <= '1';
+ set(direct_delta) <= '1';
END IF;
- set(directPC) <= '1';
next_micro_state <= rte2;
- WHEN rte2 => -- RTE
+ WHEN rte2 => -- RTE
datatype <= "01";
set(update_FC) <= '1';
- IF VBR_Stackframe=1 OR (cpu(0)='1' AND VBR_Stackframe=2) THEN
+ IF use_VBR_Stackframe='1' AND opcode(2)='0' THEN
+ -- 010+ reads another word
setstate <= "10";
set(postadd) <= '1';
setstackaddr <= '1';
@@ -2997,31 +3771,59 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
ELSE
next_micro_state <= nop;
END IF;
- WHEN rte3 => -- RTE
- next_micro_state <= nop;
--- set(update_FC) <= '1';
+-- WHEN rte3 => -- RTE
+-- next_micro_state <= nop;
+---- set(update_FC) <= '1';
+-- paste and copy form TH ---------
+ when rte3 => -- RTE
+ setstate <= "01"; -- idle state to wait
+ -- for input data to
+ -- arrive
+ next_micro_state <= rte4;
+ WHEN rte4 => -- RTE
+ -- check for stack frame format #2
+ if last_data_in(15 downto 12)="0010" then
+ -- read another 32 bits in this case
+ setstate <= "10"; -- read
+ datatype <= "10"; -- long word
+ set(postadd) <= '1';
+ setstackaddr <= '1';
+ next_micro_state <= rte5;
+ else
+ datatype <= "01";
+ next_micro_state <= nop;
+ end if;
+ WHEN rte5 => -- RTE
+ next_micro_state <= nop;
+-------------------------------------
- WHEN movec1 => -- MOVEC
+ WHEN rtd1 => -- RTD
+ next_micro_state <= rtd2;
+ WHEN rtd2 => -- RTD
+ setstackaddr <= '1';
+ set(Regwrena) <= '1';
+
+ WHEN movec1 => -- MOVEC
set(briefext) <= '1';
set_writePCbig <='1';
- IF (brief(11 downto 0)=X"000" OR brief(11 downto 0)=X"001" OR brief(11 downto 0)=X"800" OR brief(11 downto 0)=X"801") OR
+ IF (brief(11 downto 0)=X"000" OR brief(11 downto 0)=X"001" OR brief(11 downto 0)=X"800" OR brief(11 downto 0)=X"801") OR
(cpu(1)='1' AND (brief(11 downto 0)=X"002" OR brief(11 downto 0)=X"802" OR brief(11 downto 0)=X"803" OR brief(11 downto 0)=X"804")) THEN
IF opcode(0)='0' THEN
set(Regwrena) <= '1';
END IF;
--- ELSIF brief(11 downto 0)=X"800"OR brief(11 downto 0)=X"001" OR brief(11 downto 0)=X"000" THEN
--- trap_addr_error <= '1';
--- trapmake <= '1';
+-- ELSIF brief(11 downto 0)=X"800"OR brief(11 downto 0)=X"001" OR brief(11 downto 0)=X"000" THEN
+-- trap_addr_error <= '1';
+-- trapmake <= '1';
ELSE
trap_illegal <= '1';
trapmake <= '1';
END IF;
-
- WHEN movep1 => -- MOVEP d(An)
- setdisp <= '1';
- set(mem_addsub) <= '1';
+
+ WHEN movep1 => -- MOVEP d(An)
+ setdisp <= '1';
+ set(mem_addsub) <= '1';
set(mem_byte) <= '1';
- set(OP1addr) <= '1';
+ set(OP1addr) <= '1';
IF opcode(6)='1' THEN
set(movepl) <= '1';
END IF;
@@ -3031,10 +3833,10 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
setstate <= "11";
END IF;
next_micro_state <= movep2;
- WHEN movep2 =>
+ WHEN movep2 =>
IF opcode(6)='1' THEN
- set(mem_addsub) <= '1';
- set(OP1addr) <= '1';
+ set(mem_addsub) <= '1';
+ set(OP1addr) <= '1';
END IF;
IF opcode(7)='0' THEN
setstate <= "10";
@@ -3042,10 +3844,10 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
setstate <= "11";
END IF;
next_micro_state <= movep3;
- WHEN movep3 =>
+ WHEN movep3 =>
IF opcode(6)='1' THEN
- set(mem_addsub) <= '1';
- set(OP1addr) <= '1';
+ set(mem_addsub) <= '1';
+ set(OP1addr) <= '1';
set(mem_byte) <= '1';
IF opcode(7)='0' THEN
setstate <= "10";
@@ -3053,20 +3855,20 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
setstate <= "11";
END IF;
next_micro_state <= movep4;
- ELSE
- datatype <= "01"; --Word
+ ELSE
+ datatype <= "01"; --Word
END IF;
- WHEN movep4 =>
+ WHEN movep4 =>
IF opcode(7)='0' THEN
setstate <= "10";
ELSE
setstate <= "11";
END IF;
next_micro_state <= movep5;
- WHEN movep5 =>
- datatype <= "10"; --Long
-
- WHEN mul1 => -- mulu
+ WHEN movep5 =>
+ datatype <= "10"; --Long
+
+ WHEN mul1 => -- mulu
IF opcode(15)='1' OR MUL_Mode=0 THEN
set_rot_cnt <= "001110";
ELSE
@@ -3074,44 +3876,48 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
END IF;
setstate <="01";
next_micro_state <= mul2;
- WHEN mul2 => -- mulu
- setstate <="01";
+ WHEN mul2 => -- mulu
+ setstate <="01";
IF rot_cnt="00001" THEN
- next_micro_state <= mul_end1;
- ELSE
+ next_micro_state <= mul_end1;
+
+ ELSE
next_micro_state <= mul2;
END IF;
- WHEN mul_end1 => -- mulu
+ WHEN mul_end1 => -- mulu
+ IF opcode(15)='0' THEN
+ set(hold_OP2) <= '1';
+ END IF;
datatype <= "10";
set(opcMULU) <= '1';
IF opcode(15)='0' AND (MUL_Mode=1 OR MUL_Mode=2) THEN
dest_2ndHbits <= '1';
- source_2ndLbits <= '1';--???
set(write_lowlong) <= '1';
IF sndOPC(10)='1' THEN
setstate <="01";
next_micro_state <= mul_end2;
- END IF;
+ END IF;
set(Regwrena) <= '1';
END IF;
datatype <= "10";
- WHEN mul_end2 => -- divu
+ WHEN mul_end2 => -- divu
+ dest_2ndLbits <= '1';
set(write_reminder) <= '1';
set(Regwrena) <= '1';
set(opcMULU) <= '1';
- WHEN div1 => -- divu
+ WHEN div1 => -- divu
setstate <="01";
next_micro_state <= div2;
- WHEN div2 => -- divu
- IF (OP2out(31 downto 16)=x"0000" OR opcode(15)='1' OR DIV_Mode=0) AND OP2out(15 downto 0)=x"0000" THEN --div zero
+ WHEN div2 => -- divu
+ IF (OP2out(31 downto 16)=x"0000" OR opcode(15)='1' OR DIV_Mode=0) AND OP2out(15 downto 0)=x"0000" THEN --div zero
set_Z_error <= '1';
ELSE
next_micro_state <= div3;
END IF;
- set(ld_rot_cnt) <= '1';
+ set(ld_rot_cnt) <= '1';
setstate <="01";
- WHEN div3 => -- divu
+ WHEN div3 => -- divu
IF opcode(15)='1' OR DIV_Mode=0 THEN
set_rot_cnt <= "001101";
ELSE
@@ -3119,64 +3925,44 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
END IF;
setstate <="01";
next_micro_state <= div4;
- WHEN div4 => -- divu
+ WHEN div4 => -- divu
setstate <="01";
IF rot_cnt="00001" THEN
next_micro_state <= div_end1;
- ELSE
+ ELSE
next_micro_state <= div4;
END IF;
- WHEN div_end1 => -- divu
+ WHEN div_end1 => -- divu
+ IF z_error='0' AND set_V_Flag='0' THEN
+ set(Regwrena) <= '1';
+ END IF;
IF opcode(15)='0' AND (DIV_Mode=1 OR DIV_Mode=2) THEN
+ dest_2ndLbits <= '1';
set(write_reminder) <= '1';
next_micro_state <= div_end2;
setstate <="01";
END IF;
set(opcDIVU) <= '1';
datatype <= "10";
- WHEN div_end2 => -- divu
+ WHEN div_end2 => -- divu
+ IF exec(Regwrena)='1' THEN
+ set(Regwrena) <= '1';
+ ELSE
+ set(no_Flags) <= '1';
+ END IF;
dest_2ndHbits <= '1';
- source_2ndLbits <= '1';--???
set(opcDIVU) <= '1';
-
- WHEN rota1 =>
+
+ WHEN rota1 =>
IF OP2out(5 downto 0)/="000000" THEN
set_rot_cnt <= OP2out(5 downto 0);
ELSE
set_exec(rot_nop) <= '1';
END IF;
-
+
WHEN bf1 =>
setstate <="10";
-
- when pack1 =>
- -- result computation
- IF opcode(7 downto 6) = "10" THEN -- UNPK reads a byte
- datatype <= "00"; -- Byte
- END IF;
- set(ea_data_OP2) <= '1';
- set(opcPACK) <= '1';
- next_micro_state <= pack2;
-
- when pack2 =>
- -- write result
- IF opcode(7 downto 6) = "01" THEN -- PACK writes a byte
- datatype <= "00";
- END IF;
- set(presub) <= '1';
- setstate <= "11";
- dest_hbits <= '1';
- dest_areg <= '1';
- next_micro_state <= pack3;
-
- when pack3 =>
- -- this is just to keep datatype == 00
- -- for byte writes
- -- write result
- IF opcode(7 downto 6) = "01" THEN -- PACK writes a byte
- datatype <= "00";
- END IF;
-
+
WHEN OTHERS => NULL;
END CASE;
END PROCESS;
@@ -3184,33 +3970,41 @@ PROCESS (clk, cpu, OP1out, OP2out, opcode, exe_condition, nextpass, micro_state,
-----------------------------------------------------------------------------
-- MOVEC
-----------------------------------------------------------------------------
-PROCESS (clk, VBR, CACR, brief)
- BEGIN
- IF rising_edge(clk) THEN
- IF Reset = '1' THEN
- VBR <= (OTHERS => '0');
- CACR <= (OTHERS => '0');
- ELSIF clkena_lw='1' AND exec(movec_wr)='1' THEN
- CASE brief(11 downto 0) IS
- WHEN X"002" => CACR <= reg_QA(3 downto 0);
- WHEN X"801" => VBR <= reg_QA;
- WHEN OTHERS => NULL;
- END CASE;
- END IF;
- END IF;
- movec_data <= (OTHERS=>'0');
- CASE brief(11 downto 0) IS
- WHEN X"002" => movec_data <= "0000000000000000000000000000" & (CACR AND "0011");
- WHEN X"801" => --IF VBR_Stackframe=1 OR (cpu(0)='1' AND VBR_Stackframe=2) THEN
- movec_data <= VBR;
- --END IF;
- WHEN OTHERS => NULL;
- END CASE;
- END PROCESS;
-
- CACR_out <= CACR;
- VBR_out <= VBR;
-
+ process (clk, VBR, CACR, brief)
+ begin
+ -- all other hexa codes should give illegal isntruction exception
+ if rising_edge(clk) then
+ if Reset = '1' then
+ VBR <= (others => '0');
+ CACR <= (others => '0');
+ elsif clkena_lw = '1' and exec(movec_wr) = '1' then
+ case brief(11 downto 0) is
+ when X"000" => NULL; -- SFC -- 68010+
+ when X"001" => NULL; -- DFC -- 68010+
+ when X"002" => CACR <= reg_QA(3 downto 0); -- 68020+
+ when X"800" => NULL; -- USP -- 68010+
+ when X"801" => VBR <= reg_QA; -- 68010+
+ when X"802" => NULL; -- CAAR -- 68020+
+ when X"803" => NULL; -- MSP -- 68020+
+ when X"804" => NULL; -- isP -- 68020+
+ when others => NULL;
+ end case;
+ end if;
+ end if;
+
+ movec_data <= (others => '0');
+ case brief(11 downto 0) is
+ when X"002" => movec_data <= "0000000000000000000000000000" & (CACR AND "0011");
+
+ when X"801" =>
+ movec_data <= VBR;
+ --end if;
+ when others => NULL;
+ end case;
+ end process;
+
+ CACR_out <= CACR;
+ VBR_out <= VBR;
-----------------------------------------------------------------------------
-- Conditions
-----------------------------------------------------------------------------
@@ -3236,7 +4030,7 @@ PROCESS (exe_opcode, Flags)
WHEN OTHERS => NULL;
END CASE;
END PROCESS;
-
+
-----------------------------------------------------------------------------
-- Movem
-----------------------------------------------------------------------------
@@ -3244,7 +4038,7 @@ PROCESS (clk)
BEGIN
IF rising_edge(clk) THEN
IF clkena_lw='1' THEN
- movem_actiond <= exec(movem_action);
+ movem_actiond <= exec(movem_action);
IF decodeOPC='1' THEN
sndOPC <= data_read(15 downto 0);
ELSIF exec(movem_action)='1' OR set(movem_action) ='1' THEN
@@ -3271,7 +4065,7 @@ PROCESS (clk)
END IF;
END IF;
END PROCESS;
-
+
PROCESS (sndOPC, movem_mux)
BEGIN
movem_regaddr <="0000";
@@ -3299,20 +4093,11 @@ PROCESS (sndOPC, movem_mux)
movem_regaddr(1) <= '1';
IF movem_mux(2)='0' THEN
movem_regaddr(0) <= '1';
- END IF;
- ELSE
+ END IF;
+ ELSE
IF movem_mux(0)='0' THEN
movem_regaddr(0) <= '1';
- END IF;
+ END IF;
END IF;
END PROCESS;
-
---When the instruction has completed, the decremented address
---register contains the address of the last operand stored. For
---the MC68020, MC68030, and MC68040, if the addressing
---register is also moved to memory, the value written is the
---initial register value decremented by the size of the oper-
---ation. The MC68000 writes the initial register value
---(not decremented).
-
-END;
+END;