You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
204 lines
5.8 KiB
204 lines
5.8 KiB
library ieee;
|
|
use ieee.std_logic_1164.all;
|
|
|
|
--+ including vhdl 2008 libraries
|
|
--+ These lines can be commented out when using
|
|
--+ a simulator with built-in VHDL 2008 support
|
|
library ieee_proposed;
|
|
use ieee_proposed.standard_additions.all;
|
|
use ieee_proposed.std_logic_1164_additions.all;
|
|
|
|
|
|
package QueueP is
|
|
|
|
|
|
-- simple queue interface
|
|
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;
|
|
|
|
|
|
-- linked list queue interface
|
|
type t_list_queue is protected
|
|
|
|
procedure push (data : in std_logic_vector);
|
|
procedure pop (data : inout std_logic_vector);
|
|
procedure init (depth : in natural; logging : in boolean := false);
|
|
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_list_queue;
|
|
|
|
|
|
end package QueueP;
|
|
|
|
|
|
|
|
package body QueueP is
|
|
|
|
|
|
-- simple queue implementation
|
|
-- inspired by noasic article http://noasic.com/blog/a-simple-fifo-using-vhdl-protected-types/
|
|
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;
|
|
|
|
|
|
-- linked liste queue implementation
|
|
type t_list_queue is protected body
|
|
|
|
|
|
variable v_queue_depth : natural := 0;
|
|
constant C_QUEUE_WIDTH : natural := 8;
|
|
|
|
type t_entry;
|
|
type t_entry_ptr is access t_entry;
|
|
|
|
type t_entry is record
|
|
data : std_logic_vector(C_QUEUE_WIDTH-1 downto 0);
|
|
last_entry : t_entry_ptr;
|
|
next_entry : t_entry_ptr;
|
|
end record t_entry;
|
|
|
|
variable v_head : t_entry_ptr;
|
|
variable v_tail : t_entry_ptr;
|
|
variable v_count : natural := 0;
|
|
variable v_logging : boolean := false;
|
|
|
|
-- write one entry into queue by
|
|
-- creating new entry at head of list
|
|
procedure push (data : in std_logic_vector) is
|
|
begin
|
|
assert not(is_full)
|
|
report "push into full queue -> discarded"
|
|
severity failure;
|
|
if (v_count /= 0) then
|
|
v_head := new t_entry'(data, v_head, null);
|
|
v_head.last_entry.next_entry := v_head;
|
|
else
|
|
v_head := new t_entry'(data, null, null);
|
|
v_tail := v_head;
|
|
end if;
|
|
v_count := v_count + 1;
|
|
if v_logging then
|
|
report t_list_queue'instance_name & " pushed 0x" & to_hstring(data) & " into queue";
|
|
end if;
|
|
end procedure push;
|
|
|
|
-- read one entry from queue at tail of list and
|
|
-- delete that entry from list after read
|
|
procedure pop (data : inout std_logic_vector) is
|
|
variable v_entry : t_entry_ptr;
|
|
begin
|
|
assert not(is_empty)
|
|
report "pop from empty queue -> discarded"
|
|
severity failure;
|
|
data := v_tail.data;
|
|
v_entry := v_tail;
|
|
v_tail := v_tail.next_entry;
|
|
deallocate(v_entry);
|
|
v_count := v_count - 1;
|
|
if v_logging then
|
|
report t_list_queue'instance_name & " popped 0x" & to_hstring(data) & " from queue";
|
|
end if;
|
|
end procedure pop;
|
|
|
|
procedure init (depth : in natural; logging : in boolean := false) is
|
|
begin
|
|
v_queue_depth := depth;
|
|
v_logging := logging;
|
|
end procedure init;
|
|
|
|
-- returns true if queue is empty, false otherwise
|
|
impure function is_empty return boolean is
|
|
begin
|
|
return v_tail = null;
|
|
end function is_empty;
|
|
|
|
-- returns true if queue is full, false otherwise
|
|
impure function is_full return boolean is
|
|
begin
|
|
return v_count = v_queue_depth;
|
|
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 v_queue_depth - v_count;
|
|
end function freeslots;
|
|
|
|
end protected body t_list_queue;
|
|
|
|
|
|
end package body QueueP;
|