?
This commit is contained in:
520
5i24/configs/hostmot2/source/d8o8sqwsb.vhd
Executable file
520
5i24/configs/hostmot2/source/d8o8sqwsb.vhd
Executable file
@@ -0,0 +1,520 @@
|
||||
library IEEE;
|
||||
use IEEE.STD_LOGIC_1164.all;
|
||||
use IEEE.STD_LOGIC_ARITH.all;
|
||||
use IEEE.STD_LOGIC_UNSIGNED.all;
|
||||
--
|
||||
-- Copyright (C) 2007, Peter C. Wallace, Mesa Electronics
|
||||
-- http://www.mesanet.com
|
||||
--
|
||||
-- This program is is licensed under a disjunctive dual license giving you
|
||||
-- the choice of one of the two following sets of free software/open source
|
||||
-- licensing terms:
|
||||
--
|
||||
-- * GNU General Public License (GPL), version 2.0 or later
|
||||
-- * 3-clause BSD License
|
||||
--
|
||||
--
|
||||
-- The GNU GPL License:
|
||||
--
|
||||
-- This program is free software; you can redistribute it and/or modify
|
||||
-- it under the terms of the GNU General Public License as published by
|
||||
-- the Free Software Foundation; either version 2 of the License, or
|
||||
-- (at your option) any later version.
|
||||
--
|
||||
-- This program is distributed in the hope that it will be useful,
|
||||
-- but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
-- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
-- GNU General Public License for more details.
|
||||
--
|
||||
-- You should have received a copy of the GNU General Public License
|
||||
-- along with this program; if not, write to the Free Software
|
||||
-- Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
||||
--
|
||||
--
|
||||
-- The 3-clause BSD License:
|
||||
--
|
||||
-- Redistribution and use in source and binary forms, with or without
|
||||
-- modification, are permitted provided that the following conditions
|
||||
-- are met:
|
||||
--
|
||||
-- * Redistributions of source code must retain the above copyright
|
||||
-- notice, this list of conditions and the following disclaimer.
|
||||
--
|
||||
-- * Redistributions in binary form must reproduce the above
|
||||
-- copyright notice, this list of conditions and the following
|
||||
-- disclaimer in the documentation and/or other materials
|
||||
-- provided with the distribution.
|
||||
--
|
||||
-- * Neither the name of Mesa Electronics nor the names of its
|
||||
-- contributors may be used to endorse or promote products
|
||||
-- derived from this software without specific prior written
|
||||
-- permission.
|
||||
--
|
||||
--
|
||||
-- Disclaimer:
|
||||
--
|
||||
-- THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||
-- "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||
-- LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||||
-- FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
||||
-- COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||
-- INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||||
-- BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
||||
-- LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
|
||||
-- CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
||||
-- LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
|
||||
-- ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||
-- POSSIBILITY OF SUCH DAMAGE.
|
||||
--
|
||||
|
||||
|
||||
|
||||
-------------------------------------------------------------------------------
|
||||
-- Small 8 bit Harvard Arch accumulator oriented processor ~200 slices:
|
||||
-- 1 clk/inst (except taken cond jumps = 3),
|
||||
-- > 120 MHz operation in Spartan6 >80 MHz operation in Spartan3 >50 MHz in Spartan2
|
||||
-- 8 bit data, 16 bit instruction width
|
||||
-- 6 JMP instructions:
|
||||
-- JMP, JMPNZ, JMPZ, JMPNC, JMPC, JSR
|
||||
-- 9 basic memory reference instructions:
|
||||
-- OR, XOR, AND, ADD, ADDC, SUB, SUBB, LDA, STA
|
||||
-- All memory reference instructions have writeback option (except LDA and STA)
|
||||
-- ORTO, XORTO, ANDTO, ADDTO, ADDCTO, SUBTO, SUBBTO
|
||||
-- 25 operate instructions, load immediate, rotate, index load/store:
|
||||
-- LDI, RCL, RCR, SHNL, SHNR, LDXL, LDYL, STXL, STYL, LDXH, LDYH, STXH, STYH, RTT, TTR,
|
||||
-- ADDIX, ADDIY LDZL, LDTL, STZL, STTL, LDZH, LDTH, STZH, STXH, ADDIZ, ADDIT
|
||||
-- 4K words instruction space: Note direct jumps are not allowed in the last 256 bytes
|
||||
-- of address space since access to this area indicates an indirect jump (from stack)
|
||||
-- 4K words data space
|
||||
-- Four 12 bit index registers (X,Y,Z,T) for indirect memory access
|
||||
-- 7 bit offset for indirect addressing (ADD sinetable(6) etc)
|
||||
-- 10 bit direct memory addressing range
|
||||
-- 12 bit indirect addressing range with 7 bit offset
|
||||
-- 16 levels of subroutine call/return
|
||||
-- Starts at address 0 from reset
|
||||
-- THE BAD NEWS: pipelined processor with no locks so --->
|
||||
-- Instruction hazards:
|
||||
-- PUSH must precede JMP@ by at least 2 instructions
|
||||
-- Data hazards:
|
||||
-- Stored data requires 3 instructions before fetch
|
||||
-- No reads with side effects in conditional jump shadow (2 inst after cond jump)
|
||||
-- PC Hazards:
|
||||
-- No unconditional jumps in jump shadow (2 inst after conditional jump)
|
||||
-- Address hazards:
|
||||
-- Fetches via index register require 3 instructions from ST(X,Y,Z,T) or ADDI(X,Y,Z,T)
|
||||
-- to actual fetch (STA via index takes 2 instruction delay)
|
||||
-- addix,y,z,t must have inst between successive adds that is addix,1 addix,7 wont work
|
||||
-- this may be a pipeline bug, FIXME
|
||||
|
||||
-------------------------------------------------------------------------------
|
||||
|
||||
entity DumbAss8sqwsb is -- s --> jump shadow nop q--> quad index w --> writeback
|
||||
generic( -- b= 4K program. note dont mix this processor up with plain DumbAss8sq
|
||||
width : integer := 8; -- data width
|
||||
iwidth : integer := 16; -- instruction width
|
||||
maddwidth : integer := 12; -- memory address width
|
||||
paddwidth : integer := 12 -- program counter width
|
||||
|
||||
);
|
||||
port (
|
||||
clk : in std_logic;
|
||||
reset : in std_logic;
|
||||
iabus : out std_logic_vector(paddwidth-1 downto 0); -- program address bus
|
||||
idbus : in std_logic_vector(iwidth-1 downto 0); -- program data bus
|
||||
mradd : out std_logic_vector(maddwidth-1 downto 0); -- memory read address
|
||||
mwadd : out std_logic_vector(maddwidth-1 downto 0); -- memory write address
|
||||
mibus : in std_logic_vector(width-1 downto 0); -- memory data in bus
|
||||
mobus : out std_logic_vector(width-1 downto 0); -- memory data out bus
|
||||
mwrite: out std_logic; -- memory write signal
|
||||
mread: out std_logic; -- memory read signal
|
||||
carryflg : out std_logic -- carry flag
|
||||
);
|
||||
end DumbAss8sqwsb;
|
||||
|
||||
|
||||
architecture Behavioral of DumbAss8sqwsb is
|
||||
|
||||
|
||||
constant carrymask : std_logic_vector := b"0_1111_1111"; -- mask to drop carry bit
|
||||
|
||||
-- basic op codes
|
||||
-- Beware, certain bits are used to simpilfy decoding - dont change without knowing what you are doing...
|
||||
constant opr : std_logic_vector (3 downto 0) := x"0";
|
||||
constant jmp : std_logic_vector (3 downto 0) := x"1";
|
||||
constant jmpnz : std_logic_vector (3 downto 0) := x"2";
|
||||
constant jmpz : std_logic_vector (3 downto 0) := x"3";
|
||||
constant jmpnc : std_logic_vector (3 downto 0) := x"4";
|
||||
constant jmpc : std_logic_vector (3 downto 0) := x"5";
|
||||
constant jsr : std_logic_vector (3 downto 0) := x"6";
|
||||
constant lda : std_logic_vector (3 downto 0) := x"7";
|
||||
constant lor : std_logic_vector (3 downto 0) := x"8";
|
||||
constant lxor : std_logic_vector (3 downto 0) := x"9";
|
||||
constant land : std_logic_vector (3 downto 0) := x"A";
|
||||
constant sta : std_logic_vector (3 downto 0) := x"B";
|
||||
constant add : std_logic_vector (3 downto 0) := x"C"; -- beware magic decoding of carry ops
|
||||
constant addc : std_logic_vector (3 downto 0) := x"D";
|
||||
constant sub : std_logic_vector (3 downto 0) := x"E";
|
||||
constant subc : std_logic_vector (3 downto 0) := x"F";
|
||||
|
||||
-- operate instructions
|
||||
constant nop : std_logic_vector (3 downto 0) := x"0";
|
||||
|
||||
-- immediate load type
|
||||
constant ldi : std_logic_vector (3 downto 0) := x"1";
|
||||
|
||||
-- accumulator operate type
|
||||
|
||||
constant rotcl : std_logic_vector (4 downto 0) := "00100"; -- x20
|
||||
constant shnl : std_logic_vector (4 downto 0) := "00101"; -- x28
|
||||
constant rotcr : std_logic_vector (4 downto 0) := "00110"; -- x30
|
||||
constant shnr : std_logic_vector (4 downto 0) := "00111"; -- x38
|
||||
|
||||
-- index register load/store in address order Beware! this encodes index specifier
|
||||
constant ldxl : std_logic_vector (4 downto 0) := "01000"; -- x40
|
||||
constant ldyl : std_logic_vector (4 downto 0) := "01010"; -- x50
|
||||
constant ldzl : std_logic_vector (4 downto 0) := "01100"; -- x60
|
||||
constant ldtl : std_logic_vector (4 downto 0) := "01110"; -- x70
|
||||
|
||||
constant ldxh : std_logic_vector (4 downto 0) := "01001"; -- x48
|
||||
constant ldyh : std_logic_vector (4 downto 0) := "01011"; -- x58
|
||||
constant ldzh : std_logic_vector (4 downto 0) := "01101"; -- x68
|
||||
constant ldth : std_logic_vector (4 downto 0) := "01111"; -- x78
|
||||
|
||||
constant stxl : std_logic_vector (4 downto 0) := "10000"; -- x80
|
||||
constant styl : std_logic_vector (4 downto 0) := "10010"; -- x90
|
||||
constant stzl : std_logic_vector (4 downto 0) := "10100"; -- xA0
|
||||
constant sttl : std_logic_vector (4 downto 0) := "10110"; -- xB0
|
||||
|
||||
constant stxh : std_logic_vector (4 downto 0) := "10001"; -- x88
|
||||
constant styh : std_logic_vector (4 downto 0) := "10011"; -- x98
|
||||
constant stzh : std_logic_vector (4 downto 0) := "10101"; -- xA8
|
||||
constant stth : std_logic_vector (4 downto 0) := "10111"; -- xB8
|
||||
|
||||
constant addix : std_logic_vector (4 downto 0) := "11000"; -- xC0
|
||||
constant addiy : std_logic_vector (4 downto 0) := "11010"; -- xD0
|
||||
constant addiz : std_logic_vector (4 downto 0) := "11100"; -- xE0
|
||||
constant addit : std_logic_vector (4 downto 0) := "11110"; -- xF0
|
||||
|
||||
-- return register save/restore
|
||||
constant pop : std_logic_vector (4 downto 0) := "11001"; -- xC8
|
||||
constant push : std_logic_vector (4 downto 0) := "11011"; -- xD8
|
||||
constant ldsp : std_logic_vector (4 downto 0) := "11101"; -- xE8
|
||||
constant stsp : std_logic_vector (4 downto 0) := "11111"; -- xF8
|
||||
-- basic signals
|
||||
|
||||
signal accumcar : std_logic_vector (width downto 0); -- accumulator+carry
|
||||
alias accum : std_logic_vector (width-1 downto 0) is accumcar(width-1 downto 0);
|
||||
alias carrybit : std_logic is accumcar(width);
|
||||
signal maskedcarry : std_logic;
|
||||
|
||||
signal pc : std_logic_vector (paddwidth -1 downto 0); -- program counter - 12 bits = 4k
|
||||
signal mra : std_logic_vector (maddwidth -1 downto 0); -- memory read address - 12 bits = 4k max
|
||||
signal mwa : std_logic_vector (maddwidth -1 downto 0); -- memory write address - 12 bits = 4k max
|
||||
signal id1 : std_logic_vector (iwidth -1 downto 0); -- instruction pipeline 1
|
||||
signal id2 : std_logic_vector (iwidth -1 downto 0); -- instruction pipeline 2
|
||||
alias opcode0 : std_logic_vector (3 downto 0) is idbus (iwidth-1 downto iwidth-4); -- main opcode at pipe0
|
||||
alias opcode2 : std_logic_vector (3 downto 0) is id2 (iwidth-1 downto iwidth-4); -- main opcode at pipe2
|
||||
signal opcode3 : std_logic_vector (3 downto 0);
|
||||
alias Arith : std_logic_vector (1 downto 0) is id2 (iwidth-1 downto iwidth-2);
|
||||
alias WithCarry : std_logic is id2(iwidth-4); -- indicates add with carry or subtract with borrow
|
||||
alias Minus is id2(iwidth-3); -- indicates subtract
|
||||
alias opradd0 : std_logic_vector (maddwidth -3 downto 0) is idbus (maddwidth -3 downto 0); -- operand address at pipe0
|
||||
alias opradd2 : std_logic_vector (maddwidth -3 downto 0) is id2 (maddwidth -3 downto 0); -- operand address at pipe2
|
||||
alias ind0 : std_logic is idbus(iwidth -6);
|
||||
alias ind2 : std_logic is id2(iwidth -6);
|
||||
alias jind0 : std_logic_vector(3 downto 0) is idbus(iwidth -5 downto iwidth -8);
|
||||
alias jind2 : std_logic_vector(3 downto 0) is id2(iwidth -5 downto iwidth -8);
|
||||
alias wbena2 : std_logic is id2(iwidth-1);
|
||||
alias writeback2 : std_logic is id2(iwidth-5);
|
||||
signal wbena3 : std_logic;
|
||||
signal writeback3: std_logic;
|
||||
alias ireg0 : std_logic_vector(1 downto 0) is idbus(iwidth -7 downto iwidth -8);
|
||||
alias ireg2 : std_logic_vector(1 downto 0) is id2(iwidth -7 downto iwidth -8);
|
||||
alias offset0 : std_logic_vector (iwidth-10 downto 0) is idbus(iwidth-10 downto 0);
|
||||
alias offset2 : std_logic_vector (iwidth-10 downto 0) is id2(iwidth-10 downto 0);
|
||||
alias opropcode0 : std_logic_vector (3 downto 0) is idbus(iwidth-5 downto iwidth-8); -- operate opcode at pipe2 alias iopr2 : std_logic_vector (7 downto 0) is id2 (7 downto 0); -- immediate operand at pipe2
|
||||
alias liopropcode2 : std_logic_vector (3 downto 0) is id2(iwidth-5 downto iwidth-8); -- operate opcode at pipe2 alias iopr2 : std_logic_vector (7 downto 0) is id2 (7 downto 0); -- immediate operand at pipe2
|
||||
alias opropcode2 : std_logic_vector (4 downto 0) is id2(iwidth-5 downto iwidth-9); -- operate opcode at pipe2 alias iopr2 : std_logic_vector (7 downto 0) is id2 (7 downto 0); -- immediate operand at pipe2
|
||||
alias idxopcode2 : std_logic_vector (4 downto 0) is id2(iwidth-5 downto iwidth-9); -- index opcode at pipe2 alias iopr2 : std_logic_vector (7 downto 0) is id2 (7 downto 0); -- immediate operand at pipe2
|
||||
alias iopr2 : std_logic_vector (7 downto 0) is id2 (7 downto 0); -- immediate operand at pipe2
|
||||
signal oprr : std_logic_vector (width -1 downto 0); -- operand register
|
||||
signal idx : std_logic_vector (maddwidth -1 downto 0);
|
||||
signal idy : std_logic_vector (maddwidth -1 downto 0);
|
||||
signal idz : std_logic_vector (maddwidth -1 downto 0);
|
||||
signal idt : std_logic_vector (maddwidth -1 downto 0);
|
||||
signal idn0 : std_logic_vector (maddwidth -1 downto 0);
|
||||
signal maddpipe1 : std_logic_vector (maddwidth -1 downto 0);
|
||||
signal maddpipe2 : std_logic_vector (maddwidth -1 downto 0);
|
||||
signal maddpipe3 : std_logic_vector (maddwidth -1 downto 0);
|
||||
signal nextpc : std_logic_vector (paddwidth -1 downto 0);
|
||||
signal pcplus1 : std_logic_vector (paddwidth -1 downto 0);
|
||||
signal zero : std_logic;
|
||||
signal spw: std_logic_vector (3 downto 0);
|
||||
signal spr: std_logic_vector (3 downto 0);
|
||||
signal stackdin: std_logic_vector (paddwidth-1 downto 0);
|
||||
signal stackdout: std_logic_vector (paddwidth-1 downto 0);
|
||||
signal stackwe: std_logic;
|
||||
signal dopush: std_logic;
|
||||
signal dopop: std_logic;
|
||||
|
||||
function rotcleft(v : std_logic_vector ) return std_logic_vector is
|
||||
variable result : std_logic_vector(width downto 0);
|
||||
begin
|
||||
result(width downto 1) := v(width-1 downto 0);
|
||||
result(0) := v(width);
|
||||
return result;
|
||||
end rotcleft;
|
||||
|
||||
function rotcright(v : std_logic_vector ) return std_logic_vector is
|
||||
variable result : std_logic_vector(width downto 0);
|
||||
begin
|
||||
result(width -1 downto 0) := v(width downto 1);
|
||||
result(width) := v(0);
|
||||
return result;
|
||||
end rotcright;
|
||||
|
||||
begin -- the CPU
|
||||
|
||||
StackRam : entity work.adpram
|
||||
generic map (
|
||||
width => paddwidth,
|
||||
depth => 16
|
||||
)
|
||||
port map(
|
||||
addra => spw,
|
||||
addrb => spr,
|
||||
clk => clk,
|
||||
dina => stackdin,
|
||||
-- douta =>
|
||||
doutb => stackdout,
|
||||
wea => stackwe
|
||||
);
|
||||
|
||||
nextpcproc : process (clk, reset, pc, zero, nextpc, id2,
|
||||
ind0, ind2, idbus, opcode0, jind0, jind2,
|
||||
opcode2, carrybit,pcplus1, stackdout) -- next pc calculation - jump decode
|
||||
begin
|
||||
pcplus1 <= pc + '1';
|
||||
iabus <= nextpc; -- program memory address from combinatorial
|
||||
if reset = '1' then -- nextpc since blockram has built in addr register
|
||||
nextpc <= (others => '0');
|
||||
else
|
||||
if (opcode0 = jmp) or (opcode0 = jsr) then
|
||||
if jind0 = "1111" then -- indirect
|
||||
nextpc <= stackdout;
|
||||
else -- direct
|
||||
nextpc <= idbus(paddwidth -1 downto 0);
|
||||
end if;
|
||||
elsif
|
||||
((opcode2 = jmpnz) and (zero = '0')) or
|
||||
((opcode2 = jmpz) and (zero = '1')) or
|
||||
((opcode2 = jmpnc) and (carrybit = '0')) or
|
||||
((opcode2 = jmpc) and (carrybit = '1')) then
|
||||
if jind2 = "1111" then -- indirect
|
||||
nextpc <= stackdout;
|
||||
else -- direct
|
||||
nextpc <= id2(paddwidth -1 downto 0);
|
||||
end if;
|
||||
else
|
||||
nextpc <= pcplus1;
|
||||
end if; -- opcode = jmp
|
||||
end if; -- no reset
|
||||
|
||||
if clk'event and clk = '1' then
|
||||
pc <= nextpc;
|
||||
id1 <= idbus;
|
||||
id2 <= id1;
|
||||
if
|
||||
((opcode2 = jmpnz) and (zero = '0')) or
|
||||
((opcode2 = jmpz) and (zero = '1')) or
|
||||
((opcode2 = jmpnc) and (carrybit = '0')) or
|
||||
((opcode2 = jmpc) and (carrybit = '1')) or
|
||||
(reset = '1') then
|
||||
id1 <= (others => '0'); -- on reset or taken conditional jump
|
||||
id2 <= (others => '0'); -- fill inst pipeline with two 0s (nop)
|
||||
end if;
|
||||
writeback3 <= writeback2; -- the writeback bit
|
||||
wbena3 <= wbena2; -- determines writeback suitable instructions
|
||||
opcode3 <= opcode2; -- for late decode of STA
|
||||
end if; -- if clk
|
||||
end process nextpcproc;
|
||||
|
||||
mraproc : process (idbus, idx, idy, idz, idt, mra, ind0,
|
||||
idn0, ireg0,
|
||||
offset0, opcode0, opradd0, clk) -- memory read address generation
|
||||
begin
|
||||
mradd <= mra;
|
||||
case ireg0 is
|
||||
when "00" => idn0 <= idx; -- beware! encoded in memory reference _and_ addix,y,z,t
|
||||
when "01" => idn0 <= idy;
|
||||
when "10" => idn0 <= idz;
|
||||
when "11" => idn0 <= idt;
|
||||
when others => null;
|
||||
end case;
|
||||
-- mux
|
||||
if ((opcode0 /= opr) and (ind0 = '0')) then
|
||||
mra <= "00"&opradd0; -- 10 bit address range for direct access
|
||||
else
|
||||
mra <= idn0 + ("00000"&offset0); -- 12 bit address range for indirect access (w 7 bit offset)
|
||||
end if;
|
||||
|
||||
|
||||
if clk'event and clk = '1' then
|
||||
maddpipe3 <= maddpipe2;
|
||||
maddpipe2 <= maddpipe1;
|
||||
maddpipe1 <= mra;
|
||||
if (opcode0 = lda) or (opcode0 = lor) or (opcode0 = lxor) or (opcode0 = land)
|
||||
or (opcode0 = add) or (opcode0 = addc) or (opcode0 = sub) or (opcode0 = subc) then
|
||||
mread <= '1';
|
||||
else
|
||||
mread <= '0';
|
||||
end if;
|
||||
end if;
|
||||
end process mraproc;
|
||||
|
||||
oprrproc : process (clk) -- memory operand register -- could remove to
|
||||
begin -- reduce pipelining depth but would impact I/O read
|
||||
if clk'event and clk = '1' then -- access time --> not good for larger systems
|
||||
oprr <= mibus;
|
||||
end if;
|
||||
end process oprrproc;
|
||||
|
||||
accumproc : process (clk, accum, carrybit, accumcar, id2, opcode0,
|
||||
pcplus1, opcode2, opropcode2, jind0, spw) -- accumulator instruction decode - operate
|
||||
begin
|
||||
carryflg <= carrybit;
|
||||
if accum = x"00" then
|
||||
zero <= '1';
|
||||
else
|
||||
zero <= '0';
|
||||
end if;
|
||||
maskedcarry <= carrybit and WithCarry;
|
||||
|
||||
if clk'event and clk = '1' then
|
||||
case opcode2 is -- memory reference first
|
||||
when land => accum <= accum and oprr;
|
||||
when lor => accum <= accum or oprr;
|
||||
when lxor => accum <= accum xor oprr;
|
||||
when lda => accum <= oprr;
|
||||
|
||||
when opr => -- operate
|
||||
case liopropcode2 is
|
||||
when ldi => accum <= iopr2; -- load immediate byte
|
||||
when others => null;
|
||||
end case;
|
||||
case opropcode2 is
|
||||
when rotcl => accumcar <= rotcleft(accumcar); -- rotate left through carry
|
||||
when rotcr => accumcar <= rotcright(accumcar); -- rotate right through carry
|
||||
when shnl => accumcar(width downto 4) <= accumcar(width-4 downto 0);
|
||||
accumcar(width-4 downto 0) <= (others => '0');
|
||||
when shnr => accumcar(width-4 downto 0) <= accumcar(width downto 4);
|
||||
accumcar(width downto 4) <= (others => '0');
|
||||
when pop => accum <= stackdout(width-1 downto 0);
|
||||
when stsp => spw <= accum(3 downto 0);
|
||||
when ldsp => accum(3 downto 0) <= spw;
|
||||
accum(width-1 downto 4) <= (others => '0');
|
||||
when others => null;
|
||||
end case;
|
||||
|
||||
case idxopcode2 is
|
||||
when ldxl => accum <= idx(width-1 downto 0); -- index operate
|
||||
when ldyl => accum <= idy(width-1 downto 0);
|
||||
when ldzl => accum <= idz(width-1 downto 0);
|
||||
when ldtl => accum <= idt(width-1 downto 0);
|
||||
|
||||
when stxl => idx(width-1 downto 0) <= accum;
|
||||
when styl => idy(width-1 downto 0) <= accum;
|
||||
when stzl => idz(width-1 downto 0) <= accum;
|
||||
when sttl => idt(width-1 downto 0) <= accum;
|
||||
|
||||
when ldxh => accum((maddwidth-width)-1 downto 0) <= idx(maddwidth-1 downto width);
|
||||
accum(width-1 downto maddwidth-width) <= (others => '0');
|
||||
when ldyh => accum((maddwidth-width)-1 downto 0) <= idy(maddwidth-1 downto width);
|
||||
accum(width-1 downto maddwidth-width) <= (others => '0');
|
||||
when ldzh => accum((maddwidth-width)-1 downto 0) <= idz(maddwidth-1 downto width);
|
||||
accum(width-1 downto maddwidth-width) <= (others => '0');
|
||||
when ldth => accum((maddwidth-width)-1 downto 0) <= idt(maddwidth-1 downto width);
|
||||
accum(width-1 downto maddwidth-width) <= (others => '0');
|
||||
|
||||
when stxh => idx(maddwidth-1 downto width) <= accum((maddwidth-width)-1 downto 0);
|
||||
when styh => idy(maddwidth-1 downto width) <= accum((maddwidth-width)-1 downto 0);
|
||||
when stzh => idz(maddwidth-1 downto width) <= accum((maddwidth-width)-1 downto 0);
|
||||
when stth => idt(maddwidth-1 downto width) <= accum((maddwidth-width)-1 downto 0);
|
||||
|
||||
when addix => idx <= maddpipe2; -- share the offset address adder for addix
|
||||
when addiy => idy <= maddpipe2; -- same for Y
|
||||
when addiz => idz <= maddpipe2; -- same for Z
|
||||
when addit => idt <= maddpipe2; -- same for T
|
||||
when others => null;
|
||||
end case;
|
||||
when others => null;
|
||||
end case;
|
||||
if Arith = "11" then
|
||||
if Minus = '0' then
|
||||
accumcar <= '0'&accum + oprr + maskedcarry; -- add/addc
|
||||
else
|
||||
accumcar <= '0'&accum - oprr - maskedcarry; -- sub/subc
|
||||
end if;
|
||||
end if;
|
||||
|
||||
if dopush = '1' then
|
||||
spw <= spw +1;
|
||||
end if;
|
||||
if dopop = '1' then
|
||||
spw <= spw -1;
|
||||
end if;
|
||||
|
||||
-- if opcode0 = opr then -- this can be done at pipe 0 at the cost of 6 or so slices
|
||||
-- if opropcode0 = addix then
|
||||
-- idx <= mra;
|
||||
-- end if;
|
||||
-- if opropcode0 = addiy then
|
||||
-- idy <= mra;
|
||||
-- end if;
|
||||
-- if opropcode0 = addiz then
|
||||
-- idz <= mra;
|
||||
-- end if;
|
||||
-- if opropcode0 = addit then
|
||||
-- idt <= mra;
|
||||
-- end if;
|
||||
-- end if;
|
||||
end if; -- clk
|
||||
|
||||
if opcode0 = jsr then
|
||||
stackdin <= pcplus1; -- a jsr (note jsr has priority)
|
||||
else
|
||||
stackdin(width-1 downto 0) <= accum; -- default push data is accum (and zero top bits)
|
||||
stackdin(paddwidth-1 downto width) <=(others => '0');
|
||||
end if;
|
||||
|
||||
if (opcode0 = jsr) or ((opcode2 = opr) and (opropcode2 = push)) then
|
||||
stackwe <= '1';
|
||||
dopush <= '1';
|
||||
else
|
||||
stackwe <= '0';
|
||||
dopush <= '0';
|
||||
end if;
|
||||
|
||||
if ((opcode0= jmp) and (jind0 = "1111")) -- jmp indirect is a return
|
||||
or ((opcode2 = opr)and (opropcode2 = pop)) then
|
||||
dopop <= '1';
|
||||
else
|
||||
dopop <= '0';
|
||||
end if;
|
||||
|
||||
spr <= spw -1;
|
||||
|
||||
end process accumproc;
|
||||
|
||||
staproc : process (clk, accum, maddpipe3, opcode3, writeback3, wbena3, accumcar, id2) -- sta decode -- not much to do but enable mwrite
|
||||
begin
|
||||
mobus <= accum;
|
||||
mwadd <= maddpipe3; -- address at pipe 3 to match latched accumulator timimg
|
||||
if opcode3 = sta or ((writeback3 = '1') and (wbena3 = '1')) then
|
||||
mwrite <= '1';
|
||||
else
|
||||
mwrite <= '0';
|
||||
end if;
|
||||
end process staproc;
|
||||
|
||||
end Behavioral;
|
||||
Reference in New Issue
Block a user