Subversion Repositories v65c816

library IEEE;

use IEEE.std_logic_1164.all;  -- defines std_logic types

use IEEE.STD_LOGIC_unsigned.all;

use IEEE.STD_LOGIC_arith.all;

-- 8/16 bit stack pointer register "S"

entity spr is

  port(   clk:  in STD_LOGIC;

          clr:  in STD_LOGIC;

        fwait:  in STD_LOGIC;

                     em:  in STD_LOGIC;

         ld_l:  in STD_LOGIC;

         ld_h:  in STD_LOGIC;

            u:  in STD_LOGIC;

            d:  in STD_LOGIC;

          din:  in STD_LOGIC_VECTOR(15 downto 0);

         dout: out STD_LOGIC_VECTOR(15 downto 0)

      );

end spr;

architecture rtl of spr is

constant SP_6502_VALUE:    STD_LOGIC_VECTOR(15 downto 0)  := "0000000111111111"; -- $01FF standard 6502 stack pointer

signal   x: STD_LOGIC_VECTOR(3 downto 0);

signal reg: STD_LOGIC_VECTOR(15 downto 0);

begin

  x(0) <= ld_l;

  x(1) <= ld_h;

  x(2) <= u;

  x(3) <= d;

  process(clk)

    begin

      if (clk'event and clk = '1') then

        if fwait = '1' then

          reg <= reg;

        else

          if clr = '1' then

            reg <= SP_6502_VALUE;

          else

                           if em = '0' then                                                -- native mode (S full 16 bit) 

                                        case x is

                                          when "0001"  => reg(7 downto 0)  <= din(7 downto 0);

                                                                                        reg(15 downto 8) <= reg(15 downto 8);

                                          when "0010"  => reg(15 downto 8) <= din(7 downto 0);

                                                                                        reg(7 downto 0)  <= reg(7 downto 0);

                                          when "0011"  => reg <= din;

                                          when "0100"  => reg <= reg + 1;

                                          when "1000"  => reg <= reg - 1;

                                          when others  => reg <= reg;

                                        end case;

                                else                                                            -- emulation mode (S is forced to 0x01XX)

                                        case x is

                                          when "0001"  => reg(7 downto 0) <= din(7 downto 0);

                                          when "0011"  => reg(7 downto 0) <= din(7 downto 0);

                                          when "0100"  => reg(7 downto 0) <= reg(7 downto 0) + 1;

                                          when "1000"  => reg(7 downto 0) <= reg(7 downto 0) - 1;

                                          when others  => reg(7 downto 0) <= reg(7 downto 0);

                                        end case;

                                   reg(15 downto 8) <= SP_6502_VALUE(15 downto 8);

                                end if;

          end if;

        end if;

      end if;

  end process;

  dout <= reg;

end rtl;