forked from cores/microwatt
core: Add framework for an FPU
This adds the skeleton of a floating-point unit and implements the mffs and mtfsf instructions. Execute1 sends FP instructions to the FPU and receives busy, exception, FP interrupt and illegal interrupt signals from it. Signed-off-by: Paul Mackerras <paulus@ozlabs.org>jtag-port
parent
76ec1a2f0a
commit
856e9e955f
@ -0,0 +1,185 @@
|
|||||||
|
-- Floating-point unit for Microwatt
|
||||||
|
|
||||||
|
library ieee;
|
||||||
|
use ieee.std_logic_1164.all;
|
||||||
|
use ieee.numeric_std.all;
|
||||||
|
|
||||||
|
library work;
|
||||||
|
use work.insn_helpers.all;
|
||||||
|
use work.decode_types.all;
|
||||||
|
use work.crhelpers.all;
|
||||||
|
use work.helpers.all;
|
||||||
|
use work.common.all;
|
||||||
|
|
||||||
|
entity fpu is
|
||||||
|
port (
|
||||||
|
clk : in std_ulogic;
|
||||||
|
rst : in std_ulogic;
|
||||||
|
|
||||||
|
e_in : in Execute1toFPUType;
|
||||||
|
e_out : out FPUToExecute1Type;
|
||||||
|
|
||||||
|
w_out : out FPUToWritebackType
|
||||||
|
);
|
||||||
|
end entity fpu;
|
||||||
|
|
||||||
|
architecture behaviour of fpu is
|
||||||
|
|
||||||
|
type state_t is (IDLE,
|
||||||
|
DO_MFFS, DO_MTFSF);
|
||||||
|
|
||||||
|
type reg_type is record
|
||||||
|
state : state_t;
|
||||||
|
busy : std_ulogic;
|
||||||
|
instr_done : std_ulogic;
|
||||||
|
do_intr : std_ulogic;
|
||||||
|
op : insn_type_t;
|
||||||
|
insn : std_ulogic_vector(31 downto 0);
|
||||||
|
dest_fpr : gspr_index_t;
|
||||||
|
fe_mode : std_ulogic;
|
||||||
|
rc : std_ulogic;
|
||||||
|
is_cmp : std_ulogic;
|
||||||
|
single_prec : std_ulogic;
|
||||||
|
fpscr : std_ulogic_vector(31 downto 0);
|
||||||
|
b : std_ulogic_vector(63 downto 0);
|
||||||
|
writing_back : std_ulogic;
|
||||||
|
cr_result : std_ulogic_vector(3 downto 0);
|
||||||
|
cr_mask : std_ulogic_vector(7 downto 0);
|
||||||
|
end record;
|
||||||
|
|
||||||
|
signal r, rin : reg_type;
|
||||||
|
|
||||||
|
signal fp_result : std_ulogic_vector(63 downto 0);
|
||||||
|
|
||||||
|
begin
|
||||||
|
fpu_0: process(clk)
|
||||||
|
begin
|
||||||
|
if rising_edge(clk) then
|
||||||
|
if rst = '1' then
|
||||||
|
r.state <= IDLE;
|
||||||
|
r.busy <= '0';
|
||||||
|
r.instr_done <= '0';
|
||||||
|
r.do_intr <= '0';
|
||||||
|
r.fpscr <= (others => '0');
|
||||||
|
r.writing_back <= '0';
|
||||||
|
else
|
||||||
|
assert not (r.state /= IDLE and e_in.valid = '1') severity failure;
|
||||||
|
r <= rin;
|
||||||
|
end if;
|
||||||
|
end if;
|
||||||
|
end process;
|
||||||
|
|
||||||
|
e_out.busy <= r.busy;
|
||||||
|
e_out.exception <= r.fpscr(FPSCR_FEX);
|
||||||
|
e_out.interrupt <= r.do_intr;
|
||||||
|
|
||||||
|
w_out.valid <= r.instr_done and not r.do_intr;
|
||||||
|
w_out.write_enable <= r.writing_back;
|
||||||
|
w_out.write_reg <= r.dest_fpr;
|
||||||
|
w_out.write_data <= fp_result;
|
||||||
|
w_out.write_cr_enable <= r.instr_done and r.rc;
|
||||||
|
w_out.write_cr_mask <= r.cr_mask;
|
||||||
|
w_out.write_cr_data <= r.cr_result & r.cr_result & r.cr_result & r.cr_result &
|
||||||
|
r.cr_result & r.cr_result & r.cr_result & r.cr_result;
|
||||||
|
|
||||||
|
fpu_1: process(all)
|
||||||
|
variable v : reg_type;
|
||||||
|
variable illegal : std_ulogic;
|
||||||
|
variable j, k : integer;
|
||||||
|
variable flm : std_ulogic_vector(7 downto 0);
|
||||||
|
begin
|
||||||
|
v := r;
|
||||||
|
illegal := '0';
|
||||||
|
v.busy := '0';
|
||||||
|
|
||||||
|
-- capture incoming instruction
|
||||||
|
if e_in.valid = '1' then
|
||||||
|
v.insn := e_in.insn;
|
||||||
|
v.op := e_in.op;
|
||||||
|
v.fe_mode := or (e_in.fe_mode);
|
||||||
|
v.dest_fpr := e_in.frt;
|
||||||
|
v.single_prec := e_in.single;
|
||||||
|
v.rc := e_in.rc;
|
||||||
|
v.is_cmp := e_in.out_cr;
|
||||||
|
v.cr_mask := num_to_fxm(1);
|
||||||
|
v.b := e_in.frb;
|
||||||
|
end if;
|
||||||
|
|
||||||
|
v.writing_back := '0';
|
||||||
|
v.instr_done := '0';
|
||||||
|
|
||||||
|
case r.state is
|
||||||
|
when IDLE =>
|
||||||
|
if e_in.valid = '1' then
|
||||||
|
case e_in.insn(5 downto 1) is
|
||||||
|
when "00111" =>
|
||||||
|
if e_in.insn(8) = '0' then
|
||||||
|
v.state := DO_MFFS;
|
||||||
|
else
|
||||||
|
v.state := DO_MTFSF;
|
||||||
|
end if;
|
||||||
|
when others =>
|
||||||
|
illegal := '1';
|
||||||
|
end case;
|
||||||
|
end if;
|
||||||
|
|
||||||
|
when DO_MFFS =>
|
||||||
|
v.writing_back := '1';
|
||||||
|
case r.insn(20 downto 16) is
|
||||||
|
when "00000" =>
|
||||||
|
-- mffs
|
||||||
|
when others =>
|
||||||
|
illegal := '1';
|
||||||
|
end case;
|
||||||
|
v.instr_done := '1';
|
||||||
|
v.state := IDLE;
|
||||||
|
|
||||||
|
when DO_MTFSF =>
|
||||||
|
if r.insn(25) = '1' then
|
||||||
|
flm := x"FF";
|
||||||
|
elsif r.insn(16) = '1' then
|
||||||
|
flm := x"00";
|
||||||
|
else
|
||||||
|
flm := r.insn(24 downto 17);
|
||||||
|
end if;
|
||||||
|
for i in 0 to 7 loop
|
||||||
|
k := i * 4;
|
||||||
|
if flm(i) = '1' then
|
||||||
|
v.fpscr(k + 3 downto k) := r.b(k + 3 downto k);
|
||||||
|
end if;
|
||||||
|
end loop;
|
||||||
|
v.instr_done := '1';
|
||||||
|
v.state := IDLE;
|
||||||
|
|
||||||
|
end case;
|
||||||
|
|
||||||
|
-- Data path.
|
||||||
|
-- Just enough to read FPSCR for now.
|
||||||
|
fp_result <= x"00000000" & r.fpscr;
|
||||||
|
|
||||||
|
v.fpscr(FPSCR_VX) := (or (v.fpscr(FPSCR_VXSNAN downto FPSCR_VXVC))) or
|
||||||
|
(or (v.fpscr(FPSCR_VXSOFT downto FPSCR_VXCVI)));
|
||||||
|
v.fpscr(FPSCR_FEX) := or (v.fpscr(FPSCR_VX downto FPSCR_XX) and
|
||||||
|
v.fpscr(FPSCR_VE downto FPSCR_XE));
|
||||||
|
if r.rc = '1' then
|
||||||
|
v.cr_result := v.fpscr(FPSCR_FX downto FPSCR_OX);
|
||||||
|
end if;
|
||||||
|
|
||||||
|
if illegal = '1' then
|
||||||
|
v.instr_done := '0';
|
||||||
|
v.do_intr := '0';
|
||||||
|
v.writing_back := '0';
|
||||||
|
v.busy := '0';
|
||||||
|
v.state := IDLE;
|
||||||
|
else
|
||||||
|
v.do_intr := v.instr_done and v.fpscr(FPSCR_FEX) and r.fe_mode;
|
||||||
|
if v.state /= IDLE or v.do_intr = '1' then
|
||||||
|
v.busy := '1';
|
||||||
|
end if;
|
||||||
|
end if;
|
||||||
|
|
||||||
|
rin <= v;
|
||||||
|
e_out.illegal <= illegal;
|
||||||
|
end process;
|
||||||
|
|
||||||
|
end architecture behaviour;
|
||||||
Loading…
Reference in New Issue