@ -339,10 +339,17 @@ package body ppc_fx_insns is
tmp2 := (others => '0');
tmp2 := (others => '0');
if hi < lo then
if hi < lo then
-- Mask wraps around
-- Mask wraps around
tmp2(63 downto lo) := tmp1(63 downto lo);
for i in 0 to 63 loop
tmp2(hi downto 0) := tmp1(hi downto 0);
if i <= hi or i >= lo then
tmp2(i) := tmp1(i);
end if;
end loop;
else
else
tmp2(hi downto lo) := tmp1(hi downto lo);
for i in 0 to 63 loop
if i >= lo and i <= hi then
tmp2(i) := tmp1(i);
end if;
end loop;
end if;
end if;
return tmp2;
return tmp2;
end;
end;
@ -360,10 +367,17 @@ package body ppc_fx_insns is
tmp2 := (others => '0');
tmp2 := (others => '0');
if hi < lo then
if hi < lo then
-- Mask wraps around
-- Mask wraps around
tmp2(63 downto lo) := tmp1(63 downto lo);
for i in 0 to 63 loop
tmp2(hi downto 0) := tmp1(hi downto 0);
if i <= hi or i >= lo then
tmp2(i) := tmp1(i);
end if;
end loop;
else
else
tmp2(hi downto lo) := tmp1(hi downto lo);
for i in 0 to 63 loop
if i >= lo and i <= hi then
tmp2(i) := tmp1(i);
end if;
end loop;
end if;
end if;
return tmp2;
return tmp2;
end;
end;
@ -379,10 +393,17 @@ package body ppc_fx_insns is
tmp2 := ra;
tmp2 := ra;
if hi < lo then
if hi < lo then
-- Mask wraps around
-- Mask wraps around
tmp2(63 downto lo) := tmp1(63 downto lo);
for i in 0 to 63 loop
tmp2(hi downto 0) := tmp1(hi downto 0);
if i <= hi or i >= lo then
tmp2(i) := tmp1(i);
end if;
end loop;
else
else
tmp2(hi downto lo) := tmp1(hi downto lo);
for i in 0 to 63 loop
if i >= lo and i <= hi then
tmp2(i) := tmp1(i);
end if;
end loop;
end if;
end if;
return tmp2;
return tmp2;
end;
end;
@ -394,7 +415,11 @@ package body ppc_fx_insns is
hi := 63-to_integer(unsigned(mb));
hi := 63-to_integer(unsigned(mb));
tmp1 := std_ulogic_vector(rotate_left(unsigned(rs), to_integer(unsigned(sh))));
tmp1 := std_ulogic_vector(rotate_left(unsigned(rs), to_integer(unsigned(sh))));
tmp2 := (others => '0');
tmp2 := (others => '0');
tmp2(hi downto 0) := tmp1(hi downto 0);
for i in 0 to 63 loop
if i <= hi then
tmp2(i) := tmp1(i);
end if;
end loop;
return tmp2;
return tmp2;
end;
end;
@ -405,7 +430,11 @@ package body ppc_fx_insns is
lo := 63-to_integer(unsigned(me));
lo := 63-to_integer(unsigned(me));
tmp1 := std_ulogic_vector(rotate_left(unsigned(rs), to_integer(unsigned(sh))));
tmp1 := std_ulogic_vector(rotate_left(unsigned(rs), to_integer(unsigned(sh))));
tmp2 := (others => '0');
tmp2 := (others => '0');
tmp2(63 downto lo) := tmp1(63 downto lo);
for i in 0 to 63 loop
if i >= lo then
tmp2(i) := tmp1(i);
end if;
end loop;
return tmp2;
return tmp2;
end;
end;
@ -419,10 +448,17 @@ package body ppc_fx_insns is
tmp2 := (others => '0');
tmp2 := (others => '0');
if hi < lo then
if hi < lo then
-- Mask wraps around
-- Mask wraps around
tmp2(63 downto lo) := tmp1(63 downto lo);
for i in 0 to 63 loop
tmp2(hi downto 0) := tmp1(hi downto 0);
if i <= hi or i >= lo then
tmp2(i) := tmp1(i);
end if;
end loop;
else
else
tmp2(hi downto lo) := tmp1(hi downto lo);
for i in 0 to 63 loop
if i >= lo and i <= hi then
tmp2(i) := tmp1(i);
end if;
end loop;
end if;
end if;
return tmp2;
return tmp2;
end;
end;
@ -434,7 +470,11 @@ package body ppc_fx_insns is
hi := 63-to_integer(unsigned(mb));
hi := 63-to_integer(unsigned(mb));
tmp1 := std_ulogic_vector(rotate_left(unsigned(rs), to_integer(unsigned(rb(5 downto 0)))));
tmp1 := std_ulogic_vector(rotate_left(unsigned(rs), to_integer(unsigned(rb(5 downto 0)))));
tmp2 := (others => '0');
tmp2 := (others => '0');
tmp2(hi downto 0) := tmp1(hi downto 0);
for i in 0 to 63 loop
if i <= hi then
tmp2(i) := tmp1(i);
end if;
end loop;
return tmp2;
return tmp2;
end;
end;
@ -445,7 +485,11 @@ package body ppc_fx_insns is
lo := 63-to_integer(unsigned(me));
lo := 63-to_integer(unsigned(me));
tmp1 := std_ulogic_vector(rotate_left(unsigned(rs), to_integer(unsigned(rb(5 downto 0)))));
tmp1 := std_ulogic_vector(rotate_left(unsigned(rs), to_integer(unsigned(rb(5 downto 0)))));
tmp2 := (others => '0');
tmp2 := (others => '0');
tmp2(63 downto lo) := tmp1(63 downto lo);
for i in 0 to 63 loop
if i >= lo then
tmp2(i) := tmp1(i);
end if;
end loop;
return tmp2;
return tmp2;
end;
end;
@ -459,10 +503,17 @@ package body ppc_fx_insns is
tmp2 := ra;
tmp2 := ra;
if hi < lo then
if hi < lo then
-- Mask wraps around
-- Mask wraps around
tmp2(63 downto lo) := tmp1(63 downto lo);
for i in 0 to 63 loop
tmp2(hi downto 0) := tmp1(hi downto 0);
if i <= hi or i >= lo then
tmp2(i) := tmp1(i);
end if;
end loop;
else
else
tmp2(hi downto lo) := tmp1(hi downto lo);
for i in 0 to 63 loop
if i >= lo and i <= hi then
tmp2(i) := tmp1(i);
end if;
end loop;
end if;
end if;
return tmp2;
return tmp2;
end;
end;
@ -490,12 +541,19 @@ package body ppc_fx_insns is
function ppc_srawi (rs : std_ulogic_vector(63 downto 0); sh: std_ulogic_vector(5 downto 0)) return std_ulogic_vector is
function ppc_srawi (rs : std_ulogic_vector(63 downto 0); sh: std_ulogic_vector(5 downto 0)) return std_ulogic_vector is
variable n : integer;
variable n : integer;
variable tmp : signed(31 downto 0);
variable tmp : signed(31 downto 0);
variable mask : std_ulogic_vector(63 downto 0);
variable carry: std_ulogic;
variable carry: std_ulogic;
begin
begin
n := to_integer(unsigned(sh));
n := to_integer(unsigned(sh));
tmp := shift_right(signed(rs(31 downto 0)), n);
tmp := shift_right(signed(rs(31 downto 0)), n);
-- what about n = 0?
-- what about n = 0?
carry := or rs(n-1 downto 0) and rs(31);
mask := (others => '0');
for i in 0 to 63 loop
if i < n then
mask(i) := '1';
end if;
end loop;
carry := '0' when (rs and mask) = (63 downto 0 => '0') else rs(31);
return carry & std_ulogic_vector(resize(tmp, rs'length));
return carry & std_ulogic_vector(resize(tmp, rs'length));
end;
end;
@ -503,13 +561,19 @@ package body ppc_fx_insns is
function ppc_sraw (rs, rb: std_ulogic_vector(63 downto 0)) return std_ulogic_vector is
function ppc_sraw (rs, rb: std_ulogic_vector(63 downto 0)) return std_ulogic_vector is
variable n : natural;
variable n : natural;
variable tmp : signed(31 downto 0);
variable tmp : signed(31 downto 0);
variable mask : std_ulogic_vector(63 downto 0);
variable carry: std_ulogic;
variable carry: std_ulogic;
begin
begin
n := to_integer(unsigned(rb(5 downto 0)));
n := to_integer(unsigned(rb(5 downto 0)));
tmp := shift_right(signed(rs(31 downto 0)), n);
tmp := shift_right(signed(rs(31 downto 0)), n);
-- what about n = 0?
-- what about n = 0?
carry := or rs(n-1 downto 0) and rs(31);
mask := (others => '0');
for i in 0 to 63 loop
if i < n then
mask(i) := '1';
end if;
end loop;
carry := or (rs and mask) and rs(31);
return carry & std_ulogic_vector(resize(tmp, rs'length));
return carry & std_ulogic_vector(resize(tmp, rs'length));
end;
end;
@ -530,10 +594,17 @@ package body ppc_fx_insns is
function ppc_sradi (rs: std_ulogic_vector(63 downto 0); sh: std_ulogic_vector(5 downto 0)) return std_ulogic_vector is
function ppc_sradi (rs: std_ulogic_vector(63 downto 0); sh: std_ulogic_vector(5 downto 0)) return std_ulogic_vector is
variable n : integer;
variable n : integer;
variable carry: std_ulogic;
variable carry: std_ulogic;
variable mask : std_ulogic_vector(63 downto 0);
begin
begin
n := to_integer(unsigned(sh));
n := to_integer(unsigned(sh));
-- what about n = 0?
-- what about n = 0?
carry := or rs(n-1 downto 0) and rs(63);
mask := (others => '0');
for i in 0 to 63 loop
if i < n then
mask(i) := '1';
end if;
end loop;
carry := '0' when (rs and mask) = (63 downto 0 => '0') else rs(63);
return carry & std_ulogic_vector(shift_right(signed(rs), n));
return carry & std_ulogic_vector(shift_right(signed(rs), n));
end;
end;
@ -541,10 +612,17 @@ package body ppc_fx_insns is
function ppc_srad (rs, rb: std_ulogic_vector(63 downto 0)) return std_ulogic_vector is
function ppc_srad (rs, rb: std_ulogic_vector(63 downto 0)) return std_ulogic_vector is
variable n : integer;
variable n : integer;
variable carry: std_ulogic;
variable carry: std_ulogic;
variable mask : std_ulogic_vector(63 downto 0);
begin
begin
n := to_integer(unsigned(rb(6 downto 0)));
n := to_integer(unsigned(rb(6 downto 0)));
-- what about n = 0?
-- what about n = 0?
carry := or rs(n-1 downto 0) and rs(63);
mask := (others => '0');
for i in 0 to 63 loop
if i < n then
mask(i) := '1';
end if;
end loop;
carry := '0' when (rs and mask) = (63 downto 0 => '0') else rs(63);
return carry & std_ulogic_vector(shift_right(signed(rs), n));
return carry & std_ulogic_vector(shift_right(signed(rs), n));
end;
end;