vhdl: implement multiple strands

This commit is contained in:
Xiretza 2022-06-06 12:58:41 +02:00
parent 24e3b11588
commit 40caa85d92

View file

@ -22,16 +22,20 @@ entity splink is
end entity; end entity;
architecture a of splink is architecture a of splink is
signal driver_out : std_logic;
constant BITS_PER_LED: natural := 24; constant BITS_PER_LED: natural := 24;
subtype color_t is std_logic_vector(BITS_PER_LED-1 downto 0); subtype color_t is std_logic_vector(BITS_PER_LED-1 downto 0);
type strand_store_t is array(0 to MAX_STRAND_LEN) of color_t;
signal strand_store: strand_store_t;
signal led_addr : std_logic_vector(7 downto 0); type led_data_t is record
signal current_color : color_t; addr : std_logic_vector(7 downto 0);
current_color : color_t;
was_written : std_logic;
end record;
type led_data_arr_t is array(0 to NUM_STRANDS-1) of led_data_t;
signal led_data_arr : led_data_arr_t;
begin begin
driver_gen: for i in 0 to NUM_STRANDS-1 generate
ws2812_inst: entity work.ws2812 ws2812_inst: entity work.ws2812
generic map ( generic map (
NUM_LEDS => MAX_STRAND_LEN, NUM_LEDS => MAX_STRAND_LEN,
@ -49,33 +53,73 @@ begin
n_reset => not reset, n_reset => not reset,
clk => clk, clk => clk,
led_addr => led_addr, led_addr => led_data_arr(i).addr,
led_red => current_color(23 downto 16), led_red => led_data_arr(i).current_color(23 downto 16),
led_green => current_color(15 downto 8), led_green => led_data_arr(i).current_color(15 downto 8),
led_blue => current_color(7 downto 0), led_blue => led_data_arr(i).current_color(7 downto 0),
dout => driver_out dout => drivers(i)
); );
end generate;
-- https://github.com/YosysHQ/yosys/issues/3360
drivers <= (19 => driver_out, others => '0');
writer: process(clk) writer: process(clk)
type strand_store_t is array(0 to MAX_STRAND_LEN-1) of color_t;
type strand_stores_t is array(0 to NUM_STRANDS-1) of strand_store_t;
variable strand_stores: strand_stores_t;
variable active_strand: natural range 0 to NUM_STRANDS-1;
variable packet_len: natural range 1 to MAX_STRAND_LEN;
variable frame_number: unsigned(31 downto 0);
variable store_counter: natural range 0 to MAX_STRAND_LEN-1; variable store_counter: natural range 0 to MAX_STRAND_LEN-1;
type receive_state_t is (FRAME_NUM, STRAND_NUM, DATA, DROP);
variable receive_state : receive_state_t;
begin begin
if rising_edge(clk) then if rising_edge(clk) then
frame_done <= '0'; frame_done <= '0';
current_color <= strand_store(to_integer(unsigned(led_addr)));
for i in 0 to NUM_STRANDS-1 loop
led_data_arr(i).current_color <= strand_stores(i)(to_integer(unsigned(led_data_arr(i).addr)));
end loop;
if udp_valid then if udp_valid then
strand_store(store_counter) <= udp_data(23 downto 0); case receive_state is
when STRAND_NUM =>
-- TODO udp_length, range check with MAX_STRAND_LEN
packet_len := MAX_STRAND_LEN;
-- FIXME bounds check
active_strand := to_integer(unsigned(udp_data));
receive_state := FRAME_NUM;
when FRAME_NUM =>
frame_number := unsigned(udp_data);
store_counter := 0;
receive_state := DATA;
when DATA =>
strand_stores(active_strand)(store_counter) := udp_data(23 downto 0);
if store_counter = packet_len then
if udp_last then
--led_data_arr(active_strand).was_written <= '1';
else
-- packet too long
receive_state := DROP;
end if;
else
store_counter := store_counter + 1;
end if;
when DROP =>
-- wait until udp_last
end case;
if udp_last then if udp_last then
frame_done <= '1'; receive_state := STRAND_NUM;
store_counter := 0;
elsif store_counter /= MAX_STRAND_LEN-1 then
store_counter := store_counter + 1;
end if; end if;
end if; end if;
end if; end if;