Add timer component and testbench for it
This commit is contained in:
@@ -28,6 +28,7 @@ package config is
|
||||
constant CFG_DMEM : integer := CFG_MEM+1;
|
||||
constant CFG_LED : integer := CFG_DMEM+1;
|
||||
constant CFG_SW : integer := CFG_LED+1;
|
||||
constant CFG_TIMER : integer := CFG_SW+1;
|
||||
|
||||
-----------------------------
|
||||
-- base address (BADR) & mask address (MADR)
|
||||
@@ -38,6 +39,7 @@ package config is
|
||||
--constant CFG_BADR_NEXTFREEADDRESS : generic_addr_type := 16#00000800#;
|
||||
constant CFG_BADR_LED : generic_addr_type := 16#000F0000#;
|
||||
constant CFG_BADR_SW : generic_addr_type := 16#000F0004#;
|
||||
constant CFG_BADR_TIMER : generic_addr_type := 16#000F0008#;
|
||||
|
||||
-- mask addr
|
||||
constant CFG_MADR_ZERO : generic_mask_type := 0;
|
||||
@@ -46,6 +48,7 @@ package config is
|
||||
constant CFG_MADR_DMEM : generic_mask_type := 16#3FFFFF# - (256 -1); -- uses 6 word-bits, size 256 byte
|
||||
constant CFG_MADR_LED : generic_mask_type := 16#3FFFFF#; -- size=1 byte
|
||||
constant CFG_MADR_SW : generic_mask_type := 16#3FFFFF# - (4 - 1); -- size=4 byte
|
||||
constant CFG_MADR_TIMER : generic_mask_type := 16#3FFFFF# - (8 - 1); -- size=8 byte (2 words)
|
||||
|
||||
end package config;
|
||||
|
||||
|
||||
@@ -28,8 +28,8 @@ package lt16soc_peripherals is
|
||||
|
||||
component wb_switches is
|
||||
generic(
|
||||
memaddr : generic_addr_type; --:= CFG_BADR_LED;
|
||||
addrmask : generic_mask_type --:= CFG_MADR_LED;
|
||||
memaddr : generic_addr_type; --:= CFG_BADR_SW;
|
||||
addrmask : generic_mask_type --:= CFG_MADR_SW;
|
||||
);
|
||||
port(
|
||||
clk : in std_logic;
|
||||
@@ -42,6 +42,21 @@ package lt16soc_peripherals is
|
||||
);
|
||||
end component;
|
||||
|
||||
component wb_timer is
|
||||
generic(
|
||||
memaddr : generic_addr_type; --:= CFG_BADR_TIMER;
|
||||
addrmask : generic_mask_type --:= CFG_MADR_TIMER;
|
||||
);
|
||||
port(
|
||||
clk : in std_logic;
|
||||
rst : in std_logic;
|
||||
wslvi : in wb_slv_in_type;
|
||||
wslvo : out wb_slv_out_type;
|
||||
|
||||
interrupt : out std_logic
|
||||
);
|
||||
end component;
|
||||
|
||||
end lt16soc_peripherals;
|
||||
|
||||
package body lt16soc_peripherals is
|
||||
|
||||
133
soc/peripheral/timer.vhd
Normal file
133
soc/peripheral/timer.vhd
Normal file
@@ -0,0 +1,133 @@
|
||||
-- See the file "LICENSE" for the full license governing this code. --
|
||||
|
||||
library ieee;
|
||||
use ieee.std_logic_1164.all;
|
||||
use ieee.numeric_std.all;
|
||||
use work.lt16x32_global.all;
|
||||
use work.wishbone.all;
|
||||
use work.config.all;
|
||||
|
||||
entity wb_timer is
|
||||
generic(
|
||||
memaddr : generic_addr_type; --:= CFG_BADR_TIMER;
|
||||
addrmask : generic_mask_type --:= CFG_MADR_TIMER;
|
||||
);
|
||||
port(
|
||||
clk : in std_logic;
|
||||
rst : in std_logic;
|
||||
wslvi : in wb_slv_in_type;
|
||||
wslvo : out wb_slv_out_type;
|
||||
|
||||
interrupt : out std_logic
|
||||
);
|
||||
end wb_timer;
|
||||
|
||||
architecture Behavioral of wb_timer is
|
||||
constant COUNT_MAX : integer := 32 - 1;
|
||||
|
||||
signal ack : std_logic;
|
||||
|
||||
signal counter : integer range 0 to COUNT_MAX;
|
||||
|
||||
signal enable : std_logic;
|
||||
signal repeat : std_logic;
|
||||
signal reset : std_logic;
|
||||
|
||||
signal counter_vector : std_logic_vector(31 downto 0);
|
||||
signal status_register : std_logic_vector(31 downto 0);
|
||||
|
||||
signal data_in : std_logic_vector(2 downto 0);
|
||||
signal data_in_changed : std_logic;
|
||||
|
||||
begin
|
||||
|
||||
process(clk)
|
||||
begin
|
||||
if clk'event and clk='1' then
|
||||
if rst = '1' then
|
||||
counter <= 0;
|
||||
else
|
||||
if reset = '1' then -- reset register
|
||||
counter <= 0;
|
||||
else
|
||||
if enable = '1' then
|
||||
if counter = COUNT_MAX then
|
||||
counter <= 0;
|
||||
else
|
||||
counter <= counter + 1;
|
||||
end if;
|
||||
end if;
|
||||
end if;
|
||||
end if;
|
||||
end if;
|
||||
end process;
|
||||
|
||||
process(clk)
|
||||
begin
|
||||
if clk'event and clk='1' then
|
||||
if rst = '1' then
|
||||
enable <= '0';
|
||||
repeat <= '0';
|
||||
reset <= '0';
|
||||
else
|
||||
reset <= '0';
|
||||
|
||||
if data_in_changed = '1' then
|
||||
enable <= data_in(0);
|
||||
repeat <= data_in(1);
|
||||
reset <= data_in(2);
|
||||
end if;
|
||||
|
||||
-- Reset enable bit
|
||||
if counter = COUNT_MAX and repeat = '0' then
|
||||
enable <= '0';
|
||||
end if;
|
||||
end if;
|
||||
end if;
|
||||
end process;
|
||||
|
||||
process(clk)
|
||||
begin
|
||||
if clk'event and clk='1' then
|
||||
if rst = '1' then
|
||||
ack <= '0';
|
||||
data_in <= (others => '0');
|
||||
data_in_changed <= '0';
|
||||
else
|
||||
data_in <= (others => '0');
|
||||
data_in_changed <= '0';
|
||||
|
||||
if wslvi.stb = '1' and wslvi.cyc = '1' then
|
||||
if wslvi.we='1' and wslvi.adr(2) = '1' then
|
||||
data_in <= dec_wb_dat(wslvi.sel,wslvi.dat)(2 downto 0);
|
||||
data_in_changed <= '1';
|
||||
end if;
|
||||
|
||||
if ack = '0' then
|
||||
ack <= '1';
|
||||
else
|
||||
ack <= '0';
|
||||
end if;
|
||||
else
|
||||
ack <= '0';
|
||||
end if;
|
||||
end if;
|
||||
end if;
|
||||
end process;
|
||||
|
||||
counter_vector <= std_logic_vector(to_unsigned(counter, counter_vector'length));
|
||||
|
||||
status_register(0) <= enable; -- enable
|
||||
status_register(1) <= repeat; -- repeat
|
||||
status_register(31 downto 2) <= (others => '0'); -- reset bit always reads as 0
|
||||
|
||||
wslvo.dat <= counter_vector when wslvi.adr(2) = '0'
|
||||
else status_register when wslvi.adr(2) = '1'
|
||||
else (others => '0');
|
||||
|
||||
interrupt <= '1' when counter = COUNT_MAX else '0';
|
||||
|
||||
wslvo.ack <= ack;
|
||||
wslvo.wbcfg <= wb_membar(memaddr, addrmask);
|
||||
|
||||
end Behavioral;
|
||||
99
soc/testbench/timer_tb.vhd
Normal file
99
soc/testbench/timer_tb.vhd
Normal file
@@ -0,0 +1,99 @@
|
||||
-- See the file "LICENSE" for the full license governing this code. --
|
||||
LIBRARY ieee;
|
||||
USE ieee.std_logic_1164.ALL;
|
||||
USE ieee.numeric_std.ALL;
|
||||
|
||||
LIBRARY work;
|
||||
USE work.lt16soc_peripherals.ALL;
|
||||
USE work.wishbone.ALL;
|
||||
USE work.wb_tp.ALL;
|
||||
USE work.config.ALL;
|
||||
|
||||
ENTITY timer_tb IS
|
||||
END ENTITY;
|
||||
|
||||
ARCHITECTURE sim OF timer_tb IS
|
||||
|
||||
constant CLK_PERIOD : time := 10 ns;
|
||||
|
||||
signal clk : std_logic := '0';
|
||||
signal rst : std_logic;
|
||||
signal data : std_logic_vector(WB_PORT_SIZE-1 downto 0);
|
||||
|
||||
signal interrupt : std_logic;
|
||||
|
||||
signal slvi : wb_slv_in_type;
|
||||
signal slvo : wb_slv_out_type;
|
||||
|
||||
BEGIN
|
||||
|
||||
SIM_SLV: wb_timer
|
||||
generic map(
|
||||
memaddr => CFG_BADR_TIMER,
|
||||
addrmask => CFG_MADR_TIMER
|
||||
)
|
||||
port map(
|
||||
clk => clk,
|
||||
rst => rst,
|
||||
wslvi => slvi,
|
||||
wslvo => slvo,
|
||||
interrupt => interrupt
|
||||
);
|
||||
|
||||
clk_gen: process
|
||||
begin
|
||||
clk <= not clk;
|
||||
wait for CLK_PERIOD/2;
|
||||
end process clk_gen;
|
||||
|
||||
stimuli: process
|
||||
begin
|
||||
rst <= '1';
|
||||
wait for CLK_PERIOD;
|
||||
rst <= '0';
|
||||
wait for CLK_PERIOD;
|
||||
wait for CLK_PERIOD;
|
||||
wait for CLK_PERIOD;
|
||||
|
||||
-- Configure timer...
|
||||
data <= (others => '0');
|
||||
data(0) <= '1'; -- enable
|
||||
data(1) <= '1'; -- repeat
|
||||
generate_sync_wb_single_write(slvi,slvo,clk,data, ADR_OFFSET => 4);
|
||||
|
||||
wait until interrupt = '1';
|
||||
wait for CLK_PERIOD*20;
|
||||
|
||||
-- Read counter value
|
||||
data <= (others => '0');
|
||||
generate_sync_wb_single_read(slvi,slvo,clk,data);
|
||||
|
||||
wait for CLK_PERIOD*4;
|
||||
|
||||
-- Disable repeat and reset timer...
|
||||
data <= (others => '0');
|
||||
data(1) <= '0'; -- repeat
|
||||
data(2) <= '1'; -- reset
|
||||
generate_sync_wb_single_write(slvi,slvo,clk,data, ADR_OFFSET => 4);
|
||||
|
||||
wait until interrupt = '1';
|
||||
wait for CLK_PERIOD*20;
|
||||
|
||||
-- Restart timer...
|
||||
data <= (others => '0');
|
||||
data(0) <= '1'; -- enable
|
||||
generate_sync_wb_single_write(slvi,slvo,clk,data, ADR_OFFSET => 4);
|
||||
|
||||
wait for CLK_PERIOD*20;
|
||||
|
||||
-- Read status register
|
||||
data <= (others => '0');
|
||||
generate_sync_wb_single_read(slvi,slvo,clk,data, ADR_OFFSET => 4);
|
||||
|
||||
wait for CLK_PERIOD * 2;
|
||||
assert false report "Simulation terminated!" severity failure;
|
||||
|
||||
wait;
|
||||
end process stimuli;
|
||||
|
||||
END ARCHITECTURE;
|
||||
Reference in New Issue
Block a user