-- simple queue protected type
|
|
-- inspired by noasic article http://noasic.com/blog/a-simple-fifo-using-vhdl-protected-types/
|
|
|
|
|
|
library ieee;
|
|
use ieee.std_logic_1164.all;
|
|
|
|
|
|
|
|
package QueueP is
|
|
|
|
|
|
type t_simple_queue is protected
|
|
|
|
procedure push (data : in std_logic_vector);
|
|
procedure pop (data : out std_logic_vector);
|
|
impure function is_empty return boolean;
|
|
impure function is_full return boolean;
|
|
impure function fillstate return natural;
|
|
impure function freeslots return natural;
|
|
|
|
end protected t_simple_queue;
|
|
|
|
|
|
end package QueueP;
|
|
|
|
|
|
|
|
package body QueueP is
|
|
|
|
|
|
type t_simple_queue is protected body
|
|
|
|
constant C_QUEUE_DEPTH : natural := 64;
|
|
constant C_QUEUE_WIDTH : natural := 64;
|
|
|
|
type t_queue_array is array (0 to C_QUEUE_DEPTH-1) of std_logic_vector(C_QUEUE_WIDTH-1 downto 0);
|
|
|
|
variable v_queue : t_queue_array := (others => (others => '0'));
|
|
variable v_count : natural range 0 to t_queue_array'length := 0;
|
|
variable v_head : natural range 0 to t_queue_array'high := 0;
|
|
variable v_tail : natural range 0 to t_queue_array'high := 0;
|
|
|
|
-- write one entry into queue
|
|
procedure push (data : in std_logic_vector) is
|
|
begin
|
|
assert not(is_full)
|
|
report "push into full queue -> discarded"
|
|
severity failure;
|
|
v_queue(v_head) := data;
|
|
v_head := (v_head + 1) mod t_queue_array'length;
|
|
v_count := v_count + 1;
|
|
end procedure push;
|
|
|
|
-- read one entry from queue
|
|
procedure pop (data : out std_logic_vector) is
|
|
begin
|
|
assert not(is_empty)
|
|
report "pop from empty queue -> discarded"
|
|
severity failure;
|
|
data := v_queue(v_tail);
|
|
v_tail := (v_tail + 1) mod t_queue_array'length;
|
|
v_count := v_count - 1;
|
|
end procedure pop;
|
|
|
|
-- returns true if queue is empty, false otherwise
|
|
impure function is_empty return boolean is
|
|
begin
|
|
return v_count = 0;
|
|
end function is_empty;
|
|
|
|
-- returns true if queue is full, false otherwise
|
|
impure function is_full return boolean is
|
|
begin
|
|
return v_count = t_queue_array'length;
|
|
end function is_full;
|
|
|
|
-- returns number of filled slots in queue
|
|
impure function fillstate return natural is
|
|
begin
|
|
return v_count;
|
|
end function fillstate;
|
|
|
|
-- returns number of free slots in queue
|
|
impure function freeslots return natural is
|
|
begin
|
|
return t_queue_array'length - v_count;
|
|
end function freeslots;
|
|
|
|
end protected body t_simple_queue;
|
|
|
|
|
|
end package body QueueP;
|