HMBSED3000-354. Fix library components to work with D3000 Zero gap

Implement inline merge / zero gap in D3000 Logic
This commit is contained in:
David Steele 2023-02-10 13:44:04 +00:00
commit f28e864d86
7 changed files with 523 additions and 421 deletions

View file

@ -50,6 +50,8 @@ entity fire_pulse_manager_7 is
stream_busy_a : in std_logic_vector(CH_NUM - 1 downto 0) := (others => '0');
stream_busy_b : in std_logic_vector(CH_NUM - 1 downto 0) := (others => '0');
dp_dir_out : out std_logic_vector(CH_NUM - 1 downto 0);
hd_leadng_edge_rev: out std_logic_vector(CH_NUM - 1 downto 0); -- Head will print with rear nozzles first (e.g. dcba cs abcd)
pg_vecb_spare : out std_logic_vector(32*CH_NUM - 1 downto 0); -- spare bits output from the pg sequencer vector B
abs_pos_out : out std_logic_vector(31 downto 0);
print_start : out std_logic;
mon_pt : out std_logic_vector(3 downto 0); -- Monitoring Points
@ -505,6 +507,8 @@ begin
enc_vel => vel_meas,
enc_speed_meas_w => vel_sampling_per(i),
dp_dir => dp_dir(i),
hd_leadng_edge_rev => hd_leadng_edge_rev(i),
pg_vecb_spare => pg_vecb_spare(i*7+6 downto i*7),
fire_req_vec => ch_fire_pulse(i),
start_of_image_vec => ch_start_of_image(i),
stream_busy_a => stream_busy_a(i),

View file

@ -50,6 +50,8 @@ entity fire_pulse_manager_8 is
stream_busy_a : in std_logic_vector(CH_NUM - 1 downto 0) := (others => '0');
stream_busy_b : in std_logic_vector(CH_NUM - 1 downto 0) := (others => '0');
dp_dir_out : out std_logic_vector(CH_NUM - 1 downto 0);
hd_leadng_edge_rev: out std_logic_vector(CH_NUM - 1 downto 0); -- Head will print with rear nozzles first (e.g. dcba cs abcd)
pg_vecb_spare : out std_logic_vector(32*CH_NUM - 1 downto 0); -- spare bits output from the pg sequencer vector B
abs_pos_out : out std_logic_vector(31 downto 0);
print_start : out std_logic;
mon_pt : out std_logic_vector(3 downto 0); -- Monitoring Points
@ -231,7 +233,7 @@ begin
-----------------------------------------------------------------------------
-- C&S Register Interface Splitting
-- C&S Register Interface Splitting
-----------------------------------------------------------------------------
iCS_BUS_ITF : entity work.cs_bus_ift_no_wait
@ -328,8 +330,8 @@ begin
fpm_generic_status(7) <= '1' when PULSE_DELAY_EQUAL_EN = true else '0';
fpm_generic_status(8) <= '1' when TOF_COMP_EN = true else '0';
fpm_generic_status(9) <= '1' when PIXEL_PITCH_CORR_EN = true else '0';
-----------------------------------------------------------------------------
-- I/Os selection
-----------------------------------------------------------------------------
@ -411,12 +413,12 @@ begin
begin
if (clk = '1' and clk'Event) then
init <= '0';
if fire_pulse_ctrl_init = '1' then -- signal from control registers
if fire_pulse_ctrl_init = '1' then -- signal from control registers
init <= '1';
elsif src_sel(SRC_SEL_ENC_PD_EMUL_EN) = '1' then -- setting the internal encoder position also re-initialises
init <= set_pos_ie; -- fpm_init_done should be polled by ESW before any further actions to ensure init is complete
elsif src_sel(SRC_SEL_SEB_EPD_EN) = '0' and remote_init = '1' then
-- source is not SEB-EPD (i.e. it's the SEB-PDW RX link) and we received an init signal over the POF RX link (it's a strobe)
-- source is not SEB-EPD (i.e. it's the SEB-PDW RX link) and we received an init signal over the POF RX link (it's a strobe)
init <= '1';
elsif src_sel(SRC_SEL_SEB_EPD_EN) = '0' and enable_rx = '0' then
-- source is not enc_pd_emul and is not SEB-EPD (i.e. it's the SEB-PDW RX link) but the RX link has been disabled
@ -507,6 +509,8 @@ begin
enc_vel => vel_meas,
enc_speed_meas_w => vel_sampling_per(i),
dp_dir => dp_dir(i),
hd_leadng_edge_rev => hd_leadng_edge_rev(i),
pg_vecb_spare => pg_vecb_spare(i*7+6 downto i*7),
fire_req_vec => ch_fire_pulse(i),
start_of_image_vec => ch_start_of_image(i),
stream_busy_a => stream_busy_a(i),
@ -584,7 +588,7 @@ begin
-----------------------------------------------------------------------------
-- EMS
-- EMS
-----------------------------------------------------------------------------
gEMS : if SEB_EPD_MODE = true generate

View file

@ -25,6 +25,7 @@ entity generic_sequencer_18 is
generic(
TRIGGER_WIDTH : natural range 1 to 16 := 16;
VECTOR_WIDTH : natural range 1 to 24 := 24;
VECTOR_WIDTHB : natural range 1 to 24 := 1;
RAMP_WIDTH : natural range 1 to 16 := 16; -- Must be less than or equal to VECTOR_WIDTH
BUS_WIDTH : natural range 1 to 32 := 32;
POS_WIDTH : natural range 1 to 32 := 32;
@ -39,32 +40,33 @@ entity generic_sequencer_18 is
DEVICE_FAMILY : string := "Cyclone V" -- "Cyclone 10 LP"
);
port(
--
--
clk : in std_logic;
reset_n : in std_logic;
--
--
avs_csr_address : in std_logic_vector(3 downto 0);
avs_csr_write : in std_logic;
avs_csr_writedata : in std_logic_vector(31 downto 0);
avs_csr_read : in std_logic;
avs_csr_readdata : out std_logic_vector(31 downto 0) := (others => '0');
--
--
avs_seq_address : in std_logic_vector(log2(SEQ_DEPTH) - 1 downto 0);
avs_seq_write : in std_logic;
avs_seq_writedata : in std_logic_vector(31 downto 0);
avs_seq_read : in std_logic;
avs_seq_readdata : out std_logic_vector(31 downto 0) := (others => '0');
--
--
start_req : in std_logic;
start_addr : in std_logic_vector(log2(SEQ_DEPTH) - 1 downto 0);
--
--
trigger_in : in std_logic_vector(TRIGGER_WIDTH - 1 downto 0);
pos_in : in std_logic_vector(POS_WIDTH - 1 downto 0);
--
--
busy : out std_logic := '1';
--
--
vector_out : out std_logic_vector(VECTOR_WIDTH - 1 downto 0);
--
vector_out_b : out std_logic_vector(VECTOR_WIDTHB - 1 downto 0);
--
bus_data : out std_logic_vector(BUS_WIDTH - 1 downto 0);
bus_valid : out std_logic;
bus_ack : in std_logic);
@ -123,6 +125,7 @@ architecture rtl of generic_sequencer_18 is
signal trig_int : std_logic;
signal vector_out_i : std_logic_vector(23 downto 0) := (others => '0');
signal vector_out_b_i : std_logic_vector(VECTOR_WIDTHB - 1 downto 0);
signal ramp_curr : std_logic_vector(RAMP_WIDTH - 1 downto 0);
signal ramp_next : std_logic_vector(RAMP_WIDTH - 1 downto 0);
signal ramp_final : std_logic_vector(RAMP_WIDTH - 1 downto 0);
@ -137,14 +140,14 @@ architecture rtl of generic_sequencer_18 is
signal r1, r1_data : std_logic_vector(11 downto 0);
signal r1_data_valid : std_logic; -- strobe to cause R1 to be updated with R1_data value
signal decode, clr_vec, ld_vec : std_logic;
signal decode, clr_vec_all, ld_vec : std_logic;
signal bus_valid_i : std_logic;
signal busy_i : std_logic := '1';
signal ld_start_addr, inc_ram_addr : std_logic;
signal ld_trig_mask, ld_trig_sel : std_logic;
signal ld_pos, ld_ramp : std_logic;
signal zero_flag, alu_upd : std_logic;
signal clr_vec_i, clr_vec_ii : std_logic;
signal clr_vec_a_i, clr_vec_b_i : std_logic;
signal fetch_op, ramp_up : std_logic;
signal op_cnt_done, inc_op_cnt : std_logic;
signal bus_pause, ld_jmp_addr : std_logic;
@ -203,7 +206,7 @@ begin
-- Clock and reset
clk => clk,
rst_n => reset_n,
-- auto-generated
-- Internal signal ports
@ -242,7 +245,7 @@ begin
pos_store => pos_store_csr,
seq_queue_r_queue_left => queue_left,
seq_queue_r_queue_exec => queue_exec,
-- end auto-generated
-- Slave bus port
@ -296,7 +299,7 @@ begin
end if;
if fsm = s_pos_wait and subcode = x"4" then
-- capture the comparator top bits
-- capture the comparator top bits
pos_comp_msbs <= operand_1(pos_comp_msbs'range);
end if;
@ -336,7 +339,7 @@ begin
--pragma translate_off
assert (to_integer(unsigned(trig_sel)) < TRIGGER_WIDTH) report "ERROR: trig_sel out of selectable trigger mask" severity failure;
assert (VECT_RAMP_EN = false or RAMP_WIDTH <= VECTOR_WIDTH) report "ERROR: Ramp Width must be <= Vector Width" severity failure;
--pragma translate_on
--pragma translate_on
-----------------------------------------------------------------------------
-- Dual-Port Memory buffer
@ -365,7 +368,7 @@ begin
-----------------------------------------------------------------------------
-- Sequencer Logic
-----------------------------------------------------------------------------
-----------------------------------------------------------------------------
start_req_i <= start_req and not start_req_d;
@ -388,7 +391,7 @@ begin
fsm_nxt <= fsm;
--
decode <= '0';
clr_vec_i <= '0';
clr_vec_all <= '0';
ld_vec <= '0';
ld_ramp <= '0';
busy_i <= '1';
@ -414,7 +417,7 @@ begin
if (seq_enable = '0') then
busy_i <= '0';
if (rst_vector_out = '1') then
clr_vec_i <= '1';
clr_vec_all <= '1';
end if;
fsm_nxt <= s_idle;
elsif (start_req_i = '1') then
@ -433,7 +436,7 @@ begin
when s_init =>
if (rst_vector_out = '1') then
clr_vec_i <= '1';
clr_vec_all <= '1';
end if;
fsm_nxt <= s_fetch;
@ -452,7 +455,7 @@ begin
case opcode is
--
when CMD_NOP => fsm_nxt <= s_fetch;
--
--
when CMD_TRIG_MASK => fsm_nxt <= s_trig_mask;
when CMD_TRIG_WAIT => fsm_nxt <= s_trig_wait;
when CMD_VEC_SET => fsm_nxt <= s_vec_set;
@ -563,11 +566,12 @@ begin
ld_trig_sel <= '1' when decode = '1' and (opcode = CMD_TRIG_WAIT or opcode = CMD_VEC_RAMP_UP or opcode = CMD_VEC_RAMP_DN or opcode = CMD_VEC_RAMP) else '0';
--
--
pSEQ_REGs : process(reset_n, clk)
begin
if (reset_n = '0') then
vector_out_i <= (others => '0');
vector_out_b_i <= (others => '0');
start_req_d <= '0';
fetch_enable <= '0';
pc_value <= (others => '0');
@ -577,12 +581,15 @@ begin
busy <= '1';
trig_mask <= (others => '0');
trig_sel <= (others => '0');
clr_vec_ii <= '0';
clr_vec_a_i <= '0';
clr_vec_b_i <= '0';
ramp_to_val <= '0';
return_addr <= (others => '0');
op_cnt <= (others => '0');
loop_active <= '0';
elsif (clk = '1' and clk'event) then
clr_vec_a_i <= '0';
clr_vec_b_i <= '0';
start_req_d <= start_req;
fetch_enable <= (not debug_mode) or (debug_mode and step_req);
if (fetch_op = '1') then
@ -608,15 +615,26 @@ begin
if (ld_trig_sel = '1') then
trig_sel <= subcode;
end if;
if (ld_vec = '1' and subcode = "0001") then
clr_vec_ii <= '1';
else
clr_vec_ii <= '0';
if (ld_vec = '1' and subcode(2 downto 0) = "001") then
if subcode(3) = '0' then
clr_vec_a_i <= '1';
else
clr_vec_b_i <= '1';
end if;
end if;
if (clr_vec = '1') then
vector_out_i <= (others => '0');
if clr_vec_all = '1' or clr_vec_a_i = '1' or clr_vec_b_i = '1' then
if clr_vec_all = '1' or clr_vec_a_i = '1' then
vector_out_i <= (others => '0');
end if;
if clr_vec_all = '1' or clr_vec_b_i = '1' then
vector_out_b_i <= (others => '0');
end if;
elsif (ld_vec = '1') then
vector_out_i(VECTOR_WIDTH - 1 downto 0) <= operand_comp(VECTOR_WIDTH - 1 downto 0);
if subcode(3) = '0' then
vector_out_i(VECTOR_WIDTH - 1 downto 0) <= operand_comp(VECTOR_WIDTH - 1 downto 0);
else
vector_out_b_i <= operand_comp(VECTOR_WIDTHB - 1 downto 0);
end if;
elsif (VECT_RAMP_EN = true and ld_ramp = '1') then
if (ramp_up = '1' and ramp_next(ramp_next'high) = '0' and vector_out_i(ramp_next'high) = '1') then
vector_out_i(RAMP_WIDTH - 1 downto 0) <= (others => '1');
@ -663,8 +681,6 @@ begin
operand_1 <= operand_comp(11 downto 0);
operand_2 <= operand_comp(23 downto 12);
clr_vec <= clr_vec_i or clr_vec_ii;
op_cnt_done <= '1' when op_cnt = operand_1 else '0';
jump_addr_ext <= operand_1 when jump_abs = '1' else
@ -687,14 +703,16 @@ begin
-----------------------------------------------------------------------------
gVECT_NO_PIPE : if ADD_VEC_PIPE = false generate
vector_out <= vector_out_i(vector_out'range);
vector_out <= vector_out_i(vector_out'range);
vector_out_b <= vector_out_b_i;
end generate gVECT_NO_PIPE;
gVECT_PIPE : if ADD_VEC_PIPE = true generate
pVECT_PIPE : process(clk)
begin
if (clk = '1' and clk'event) then
vector_out <= vector_out_i(vector_out'range);
vector_out <= vector_out_i(vector_out'range);
vector_out_b <= vector_out_b_i;
end if;
end process pVECT_PIPE;
end generate gVECT_PIPE;

View file

@ -199,6 +199,8 @@ architecture rtl of pixel_buffer_2 is
signal diag_peek_wren : std_logic_vector(MAX_OP_WIDTH-1 downto 0);
signal is_en_peek : std_logic;
signal is_not_last_wave : std_logic;
signal rdreq_vec_int : std_logic_vector(MAX_OP_WIDTH-1 downto 0);
signal rd_data_stripe_id : std_logic_vector(MAX_OP_WIDTH*STRIPE_ID_WIDTH-1 downto 0);
@ -378,6 +380,7 @@ begin
pixel_buf_wr_shft(0) <= '1';
word_count <= (others => '0');
is_last_wave <= '0';
is_not_last_wave <= '0';
overrun <= '0';
underrun <= '0';
pend_drop_detect <= '0';
@ -419,6 +422,7 @@ begin
pixel_buf_wr_shft(0) <= '1';
word_count <= (others => '0');
is_last_wave <= '0';
is_not_last_wave <= '0';
overrun <= '0';
underrun <= '0';
pend_drop_detect <= '0';
@ -490,6 +494,14 @@ begin
else
is_last_wave <= '0';
end if;
-- Only set when there are multiple playouts of the same address in the pixel buffer
-- This stops drop_stripe altering the rd_ptr until the previous stripe has finished
if start_req_first = '1' and start_req_last = '0' then
is_not_last_wave <= '1';
else
is_not_last_wave <= '0';
end if;
end if;
-- If pixel buffer peeking diags enabled, export the read and write pointers,
@ -626,9 +638,9 @@ begin
-- If a 'droppy' situation is outstanding, wait for the data path to go idle
-- and clear the contents of the next stripe
-- sequencers_busy = '0' covers the case where rd_req_vec reads at different times
-- is_last_wave and rd_ptr_all_equal ensures that we complete the stripe before completely before deleting this one
-- is_not_last_wave = 0 and rd_ptr_all_equal ensures that we complete the stripe before completely before deleting this one
stripe_dropped <= '0';
if pend_drop_detect = '1' and sequencers_busy = '0' and unsigned(wren) = 0 and word_count >= drop_adjust and unsigned(rdreq_vec_int) = 0 and is_last_wave = '1' and rd_ptr_all_equal = '1' then
if pend_drop_detect = '1' and sequencers_busy = '0' and unsigned(wren) = 0 and word_count >= drop_adjust and unsigned(rdreq_vec_int) = 0 and is_not_last_wave = '0' and rd_ptr_all_equal = '1' then
pend_drop_detect <= '0';
for i in 0 to MAX_OP_WIDTH-1 loop
rd_ptr(i) <= std_logic_vector(unsigned(rd_ptr(i)) + unsigned(drop_adjust));

View file

@ -86,7 +86,7 @@ entity pixel_buffer_zero_gap_2 IS
rdreq : in std_logic;
rdreq_vec : in std_logic_vector(MAX_OP_WIDTH-1 downto 0) := (others => '0');
rdreq_rdy : out std_logic;
q : out data_array_t(NUM_CHANS-1 downto 0)(MAX_OP_WIDTH*32-1 downto 0);
q : out std_logic_vector(MAX_OP_WIDTH*32-1 downto 0);
empty : out std_logic;
full : out std_logic;
@ -137,6 +137,7 @@ architecture rtl of pixel_buffer_zero_gap_2 is
constant TOTAL_DEPTH_LOG2 : integer := log2(PX_DEPTH + RSVD_DEPTH);
constant NUM_CHANS_LOG2 : integer := log2(NUM_CHANS);
signal q_int : data_array_t(NUM_CHANS-1 downto 0)(MAX_OP_WIDTH*32-1 downto 0);
signal rd_req_int : std_logic_vector(NUM_CHANS-1 downto 0);
type rdreq_vec_t is array (natural range <> ) of std_logic_vector;
signal rdreq_vec_int : rdreq_vec_t(NUM_CHANS-1 downto 0)(MAX_OP_WIDTH-1 downto 0);
@ -243,7 +244,7 @@ begin
clr_buf_active_rdreq(NUM_CHANS-1 downto 1)<= (others => '0');
GEN_TIE_OFF_Q : for i in 1 to NUM_CHANS-1 generate
q(i) <= (others => '0');
q_int(i) <= (others => '0');
end generate;
end generate;
@ -257,6 +258,10 @@ begin
-- Instantiate the pixel buffers, both normal and
-- (if enabled) auxiliary
-- -----------------------------------------------
GEN_Q_COMB : for j in 0 to (MAX_OP_WIDTH*32/4)-1 generate
q(j*4+3 downto j*4) <= q_int(0)(j*4+3 downto j*4) when (unsigned(q_int(0)(j*4+3 downto j*4)) > unsigned(q_int(1)(j*4+3 downto j*4)))
else q_int(1)(j*4+3 downto j*4);
end generate;
GEN_PX_BUF : for i in 0 to NUM_CHANS-1 generate
@ -264,89 +269,90 @@ begin
start_req_int(i) <= buf_active_int(0)(i) and seq_1st_start_req;
GEN_Q : for j in 0 to MAX_OP_WIDTH-1 generate
q(i)(j*32+31 downto j*32) <= rd_data(i)(j*32+31 downto j*32) when pb_data_enable(j)(i) else (others => '0');
GEN_Q : for j in 0 to MAX_OP_WIDTH-1 generate
q_int(i)(j*32+31 downto j*32) <= rd_data(i)(j*32+31 downto j*32) when pb_data_enable(j)(i) else (others => '0');
GEN_EN : if SUB_HEADS >= 4 and (MAX_OP_WIDTH/2) = SUB_HEADS generate
pb_data_enable(j)(i) <= buf_active_late_int(j/2)(i); -- 1536 must zero sub head data so merge works correctly
else generate
pb_data_enable(j)(i) <= buf_active_late_int(0)(i); -- Any Heads without Sub Heads - disable whole pixel buffer output
end generate;
GEN_EN : if SUB_HEADS >= 4 and (MAX_OP_WIDTH/2) = SUB_HEADS generate
pb_data_enable(j)(i) <= buf_active_late_int(j/2)(i); -- 1536 must zero sub head data so merge works correctly
else generate
pb_data_enable(j)(i) <= buf_active_late_int(0)(i); -- Any Heads without Sub Heads - disable whole pixel buffer output
end generate;
end generate;
clr_buf_active_rdreq(i) <= (last_stripe(i)(MAX_OP_WIDTH-1) and is_last_wave(i) and rd_req_int(i))
or last_stripe_dropped(i); -- if the last stripe of the image is dropped, the above case never happens
clr_buf_active_rdreq(i) <= (last_stripe(i)(MAX_OP_WIDTH-1) and is_last_wave(i) and rd_req_int(i))
or last_stripe_dropped(i); -- if the last stripe of the image is dropped, the above case never happens
GEN_SH: for j in 0 to SUB_HEADS-1 generate
clr_buf_active_rdvec(j)(i) <= (last_stripe(i)(j*2) and is_last_wave(i) and rdreq_vec_int(i)(j*2))
or last_stripe_dropped(i); -- if the last stripe of the image is dropped, the above case never happens
GEN_SH: for j in 0 to SUB_HEADS-1 generate
clr_buf_active_rdvec(j)(i) <= (last_stripe(i)(j*2) and is_last_wave(i) and rdreq_vec_int(i)(j*2))
or last_stripe_dropped(i); -- if the last stripe of the image is dropped, the above case never happens
clr_buf_active(j)(i) <= clr_buf_active_rdvec(j)(i) when VECTORED_RDREQ else clr_buf_active_rdreq(i);
end generate;
pixel_buf_inst : entity work.pixel_buffer_2
generic map (
MAX_OP_WIDTH => MAX_OP_WIDTH,
SHIFT_DEPTH => SHIFT_DEPTH,
PX_DEPTH => PX_DEPTH,
RSVD_DEPTH => RSVD_DEPTH,
FULL_MARGIN => FULL_MARGIN,
EN_PEEK => EN_PEEK,
VECTORED_RDREQ => VECTORED_RDREQ,
DEVICE_FAMILY => DEVICE_FAMILY,
ADD_PADDING => ADD_PADDING
)
port map
(
clk => clk,
rst_n => rst_n,
clr_buf_active(j)(i) <= clr_buf_active_rdvec(j)(i) when VECTORED_RDREQ else clr_buf_active_rdreq(i);
end generate;
pixel_buf_rdy => pixel_buf_rdy(i),
pixel_buf_inst : entity work.pixel_buffer_2
generic map (
MAX_OP_WIDTH => MAX_OP_WIDTH,
SHIFT_DEPTH => SHIFT_DEPTH,
PX_DEPTH => PX_DEPTH,
RSVD_DEPTH => RSVD_DEPTH,
FULL_MARGIN => FULL_MARGIN,
EN_PEEK => EN_PEEK,
VECTORED_RDREQ => VECTORED_RDREQ,
DEVICE_FAMILY => DEVICE_FAMILY,
ADD_PADDING => ADD_PADDING
)
port map
(
clk => clk,
rst_n => rst_n,
last_word => last_word(i),
data => data(i),
wrreq => wrreq(i),
pixel_buf_rdy => pixel_buf_rdy(i),
rdreq => rd_req_int(i),
rdreq_vec => rdreq_vec_int(i),
rdreq_rdy => rd_req_rdy_int(i),
q => rd_data(i),
last_word_op => last_stripe(i),
last_word => last_word(i),
data => data(i),
wrreq => wrreq(i),
empty => empty_int(i),
full => full_int(i),
overrun => overrun_int(i),
underrun => underrun_int(i),
dbl_drop => dbl_drop_int(i),
fp_drop => fp_drop_int(i),
rdreq => rd_req_int(i),
rdreq_vec => rdreq_vec_int(i),
rdreq_rdy => rd_req_rdy_int(i),
q => rd_data(i),
last_word_op => last_stripe(i),
print_data_width => print_data_width,
clear_buffer => clear_buffer,
empty => empty_int(i),
full => full_int(i),
overrun => overrun_int(i),
underrun => underrun_int(i),
dbl_drop => dbl_drop_int(i),
fp_drop => fp_drop_int(i),
start_req => start_req_int(i),
start_req_first => start_req_first,
start_req_last => start_req_last,
is_last_wave => is_last_wave(i),
print_data_width => print_data_width,
clear_buffer => clear_buffer,
all_on => all_on,
start_req => start_req_int(i),
start_req_first => start_req_first,
start_req_last => start_req_last,
is_last_wave => is_last_wave(i),
diag_peek_sel => diag_peek_sel,
diag_peek_addr => diag_peek_addr,
diag_peek_data => diag_peek_data_int(i),
diag_peek_rdptr => diag_peek_rdptr_int(i),
diag_peek_wrptr => diag_peek_wrptr_int(i),
diag_peek_wdata => diag_peek_wdata,
diag_peek_wr => diag_peek_wr,
all_on => all_on,
fire_req => fire_req, -- Was used for drop detect, but drop now signalled explicitly
drop_stripe => buf_active_int(0)(i) and drop_stripe_d, -- 1 clock delayed so that buf_active is already valid when pulsed
sequencers_busy => sequencers_busy_int(i),
last_stripe_dropped => last_stripe_dropped(i),
fp_holdoff_update => fp_holdoff_update,
wave_seq_len => wave_seq_len,
diag_peek_sel => diag_peek_sel,
diag_peek_addr => diag_peek_addr,
diag_peek_data => diag_peek_data_int(i),
diag_peek_rdptr => diag_peek_rdptr_int(i),
diag_peek_wrptr => diag_peek_wrptr_int(i),
diag_peek_wdata => diag_peek_wdata,
diag_peek_wr => diag_peek_wr,
diag_word_count => diag_word_count_int(i)
);
fire_req => fire_req, -- Was used for drop detect, but drop now signalled explicitly
drop_stripe => buf_active_int(0)(i) and drop_stripe_d, -- 1 clock delayed so that buf_active is already valid when pulsed
sequencers_busy => sequencers_busy_int(i),
last_stripe_dropped => last_stripe_dropped(i),
fp_holdoff_update => fp_holdoff_update,
wave_seq_len => wave_seq_len,
diag_word_count => diag_word_count_int(i)
);
end generate;
end generate;

View file

@ -6,8 +6,8 @@
-- Author : Gianmarco Girau
-- Company : Global Inkjet Systems
-- Created : 2016-10-24
-- Last update: 2021-04-12
-- SVN ID : Git
-- Last update: 2023-01-30
-- SVN ID : Git
-- Standard : VHDL'93
-------------------------------------------------------------------------------
-- Description:
@ -51,6 +51,8 @@ entity pulse_generator_5 is
enc_vel : in std_logic_vector(19 downto 0) := (others => '0');
enc_speed_meas_w : out std_logic_vector(19 downto 0);
dp_dir : out std_logic;
hd_leadng_edge_rev : out std_logic; -- Head will print with rear nozzles first (e.g. dcba cs abcd)
pg_vecb_spare : out std_logic_vector(7 downto 1); -- spare bits output from the pg sequencer vector B
fire_req_vec : out std_logic_vector(31 downto 0);
start_of_image_vec : out std_logic_vector(31 downto 0);
stream_busy_a : in std_logic := '0';
@ -92,7 +94,7 @@ architecture rtl of pulse_generator_5 is
-- constants
constant CSR_IP_ID : std_logic_vector(31 downto 0) := x"0000FF13";
constant CSR_IP_VER : std_logic_vector(31 downto 0) := x"00000303";
constant CSR_IP_VER : std_logic_vector(31 downto 0) := x"00000501";
constant TOF_COMP_LUT_DEPTH : natural := 512;
constant TOF_COMP_LUT_WIDTH : natural := 16;
@ -128,7 +130,7 @@ architecture rtl of pulse_generator_5 is
signal wh_apply_corr_en_d, wh_corr_start, wh_skip_corr : std_logic;
signal wh_img_2nd_half, wh_img_2nd_half_d : std_logic;
signal selected_pulse, selected_pulse_d, clr_pd_queue : std_logic;
signal zero_gap_mode, start_image_flag : std_logic;
signal zero_gap_mode, start_image_flag, start_image_flag_early : std_logic;
signal use_ch_offset_dir1, add_ppc_regs, add_tof_comp_regs : std_logic;
signal add_delay_eq_reg, add_diag_reg : std_logic;
--
@ -137,45 +139,47 @@ architecture rtl of pulse_generator_5 is
signal wh_corr_ready_v, ch_ctrl_trigger_in : std_logic_vector(5 downto 0);
signal avs_addr : std_logic_vector(4 downto 0);
signal subpix_phase_cnt, subpixel_phase_num : std_logic_vector(5 downto 0);
signal has_subpix_phases : std_logic;
signal init_v : std_logic_vector(7 downto 0);
signal ch_ctrl_start_addr, bpe_top : std_logic_vector(7 downto 0);
signal ch_ctrl_address : std_logic_vector(7 downto 0);
signal tof_lut_wr_addr, tof_lut_addr : std_logic_vector(8 downto 0);
signal wh_rotat_cnt, gnd_16 : std_logic_vector(15 downto 0);
signal wh_loop_filt_tot, wh_loop_filt_delta : std_logic_vector(15 downto 0);
signal ch_delay, ch_delay_i : std_logic_vector(15 downto 0);
signal enc_speed_norm_coeff, tof_lut_wr_data : std_logic_vector(15 downto 0);
signal tof_lut_wr_q, tof_lut_comp : std_logic_vector(15 downto 0);
signal tof_lut_comp_i : std_logic_vector(15 downto 0);
signal pd_cnt : std_logic_vector(15 downto 0);
signal enc_speed_meas_w_i, enc_vel_i : std_logic_vector(19 downto 0);
signal img_size, pixel_cnt : std_logic_vector(23 downto 0);
signal ch_ctrl_vector_out : std_logic_vector(23 downto 0);
signal wh_skip_corr_thres : std_logic_vector(23 downto 0);
signal wh_img_pixel_cnt, wh_image_pixel_len : std_logic_vector(23 downto 0);
signal basic_pos_error_sat : std_logic_vector(23 downto 0);
signal fire_req_cnt : std_logic_vector(23 downto 0);
signal norm_enc_vel : std_logic_vector(35 downto 0);
signal ch_offset, avs_readdata_i : std_logic_vector(31 downto 0);
signal ch_ctrl_writedata, ch_ctrl_readdata : std_logic_vector(31 downto 0);
signal ch_ctrl_csr_writedata : std_logic_vector(31 downto 0);
signal ch_ctrl_csr_readdata : std_logic_vector(31 downto 0);
signal ch_offset_dir0, ch_offset_dir1 : std_logic_vector(31 downto 0);
signal abs_pos_max, abs_pos_min : std_logic_vector(31 downto 0);
signal last_pd_pos, basic_pos_error : std_logic_vector(31 downto 0);
signal seq_bus_data, spit_nco, spit_nco_inc : std_logic_vector(31 downto 0);
signal start_pos, abs_pos_d : std_logic_vector(31 downto 0);
signal subpix_phase : std_logic_vector(31 downto 0);
signal wh_pos_err_2_corr : std_logic_vector(31 downto 0);
signal wh_pos_err_max, wh_pos_err_min : std_logic_vector(31 downto 0);
signal wh_pos_err, wh_pos_err_curr : std_logic_vector(31 downto 0);
signal wh_pos_err_old, wh_pos_err_abs : std_logic_vector(31 downto 0);
signal wh_tot_err, wh_delta_err : std_logic_vector(31 downto 0);
signal div_ratio, div_ratio_i : std_logic_vector(33 downto 0);
signal div_ratio_corr, div_ratio_corr_new : std_logic_vector(33 downto 0);
signal wh_loop_err_delta, wh_loop_err_tot : std_logic_vector(47 downto 0);
signal pos_error, wh_loop_err : std_logic_vector(47 downto 0);
signal div_ratio_corr_ext : std_logic_vector(63 downto 0);
signal wh_rotat_cnt, gnd_16 : std_logic_vector(15 downto 0);
signal wh_loop_filt_tot, wh_loop_filt_delta : std_logic_vector(15 downto 0);
signal ch_delay, ch_delay_i : std_logic_vector(15 downto 0);
signal enc_speed_norm_coeff, tof_lut_wr_data : std_logic_vector(15 downto 0);
signal tof_lut_wr_q, tof_lut_comp : std_logic_vector(15 downto 0);
signal tof_lut_comp_i : std_logic_vector(15 downto 0);
signal pd_cnt : std_logic_vector(15 downto 0);
signal enc_speed_meas_w_i, enc_vel_i : std_logic_vector(19 downto 0);
signal img_size, pixel_cnt : std_logic_vector(23 downto 0);
signal ch_ctrl_vector_out : std_logic_vector(23 downto 0);
signal ch_ctrl_vector_b_out : std_logic_vector(7 downto 0);
signal wh_skip_corr_thres : std_logic_vector(23 downto 0);
signal wh_img_pixel_cnt, wh_image_pixel_len : std_logic_vector(23 downto 0);
signal basic_pos_error_sat : std_logic_vector(23 downto 0);
signal fire_req_cnt : std_logic_vector(23 downto 0);
signal norm_enc_vel : std_logic_vector(35 downto 0);
signal ch_offset, avs_readdata_i : std_logic_vector(31 downto 0);
signal ch_ctrl_writedata, ch_ctrl_readdata : std_logic_vector(31 downto 0);
signal ch_ctrl_csr_writedata : std_logic_vector(31 downto 0);
signal ch_ctrl_csr_readdata : std_logic_vector(31 downto 0);
signal ch_offset_dir0, ch_offset_dir1 : std_logic_vector(31 downto 0);
signal abs_pos_max, abs_pos_min : std_logic_vector(31 downto 0);
signal last_pd_pos, basic_pos_error : std_logic_vector(31 downto 0);
signal seq_bus_data, spit_nco, spit_nco_inc : std_logic_vector(31 downto 0);
signal start_pos, abs_pos_d : std_logic_vector(31 downto 0);
signal subpix_phase : std_logic_vector(31 downto 0);
signal wh_pos_err_2_corr : std_logic_vector(31 downto 0);
signal wh_pos_err_max, wh_pos_err_min : std_logic_vector(31 downto 0);
signal wh_pos_err, wh_pos_err_curr : std_logic_vector(31 downto 0);
signal wh_pos_err_old, wh_pos_err_abs : std_logic_vector(31 downto 0);
signal wh_tot_err, wh_delta_err : std_logic_vector(31 downto 0);
signal div_ratio, div_ratio_i : std_logic_vector(33 downto 0);
signal div_ratio_corr, div_ratio_corr_new : std_logic_vector(33 downto 0);
signal wh_loop_err_delta, wh_loop_err_tot : std_logic_vector(47 downto 0);
signal pos_error, wh_loop_err : std_logic_vector(47 downto 0);
signal div_ratio_corr_ext : std_logic_vector(63 downto 0);
begin
@ -192,7 +196,7 @@ begin
gen_filt_pd <= '1' when pd_pulse = '1' and (first_pd = '1' or
(dp_dir_i = '0' and close_to_zero = '1' and signed(abs_position) > signed(last_pd_pos)) or
(dp_dir_i = '0' and close_to_mid = '1' and unsigned(abs_position) > unsigned(last_pd_pos)) or
(dp_dir_i = '1' and close_to_zero = '1' and signed(abs_position) < signed(last_pd_pos)) or
(dp_dir_i = '1' and close_to_zero = '1' and signed(abs_position) < signed(last_pd_pos)) or
(dp_dir_i = '1' and close_to_mid = '1' and unsigned(abs_position) < unsigned(last_pd_pos))) else '0';
close_to_zero <= '1' when abs_position(31 downto 30) = "00" or abs_position(31 downto 30) = "11" else '0';
@ -310,6 +314,8 @@ begin
dp_dir_i <= ch_ctrl_vector_out(0);
end if;
dp_dir_d <= dp_dir_i;
hd_leadng_edge_rev <= ch_ctrl_vector_b_out(0);
pg_vecb_spare <= ch_ctrl_vector_b_out(7 downto 1);
end if;
end process pDIR_CHG;
@ -331,6 +337,7 @@ begin
generic map( -- @suppress "Generic map uses default values. Missing optional actuals: RAMP_WIDTH, DEVICE_FAMILY"
TRIGGER_WIDTH => 6,
VECTOR_WIDTH => 24,
VECTOR_WIDTHB => 8,
BUS_WIDTH => 32,
POS_WIDTH => 32,
SEQ_DEPTH => 256,
@ -360,6 +367,7 @@ begin
pos_in => abs_position,
busy => ch_ctrl_busy,
vector_out => ch_ctrl_vector_out,
vector_out_b => ch_ctrl_vector_b_out,
bus_data => seq_bus_data,
bus_valid => seq_bus_valid,
bus_ack => '1');
@ -403,12 +411,28 @@ begin
if (start_img = '1' and (fire_enable = '0' or zero_gap_mode = '1')) then
pixel_cnt <= (others => '0');
elsif (fire_enable = '1' and new_pixel = '1') then
pixel_cnt <= std_logic_vector(unsigned(pixel_cnt) + 1);
if (start_image_flag_early = '1') then
pixel_cnt <= (others => '0');
else
pixel_cnt <= std_logic_vector(unsigned(pixel_cnt) + 1);
end if;
end if;
if (init = '1' or enable = '0' or new_pixel = '1') then
start_image_flag <= '0';
if (init = '1' or enable = '0') then
start_image_flag_early <= '0';
start_image_flag <= '0';
elsif new_pixel = '1' then
start_image_flag <= start_image_flag_early or start_img;
start_image_flag_early <= '0';
elsif (start_img = '1') then
start_image_flag <= '1';
-- starting a merge so FPM req vector will not line up with pd. So delay pd till next full sequence
-- The second pd could come in when the fire pulse phase is non zero. e.g. Fire pulse phases
-- 15->32 could be associated with start of second image. But 0->14 would never be signalled
-- as start of image. delay start image flag until just before fire pulse phase 0.
if fire_enable = '1' and has_subpix_phases = '1' then -- already running, make sure to wait for next sub pixel cycle
start_image_flag_early <= '1';
else
start_image_flag <= '1';
end if;
end if;
end if;
end process pGEN_IMAGE;
@ -599,7 +623,7 @@ begin
end generate gNOT_PP_CORR_GEN;
-----------------------------------------------------------------------------
-- Spitting logic
@ -632,7 +656,7 @@ begin
end generate gSPIT_LOGIC;
-----------------------------------------------------------------------------
-- Pulse Gating
-- Pulse Gating
-----------------------------------------------------------------------------
gated_pulse <= div_pulse and ch_mask_i and enable_out;
@ -722,12 +746,17 @@ begin
else
start_of_image_vec <= (others => '0');
end if;
if unsigned(subpixel_phase_num) > 1 then
has_subpix_phases <= '1';
else
has_subpix_phases <= '0';
end if;
end if;
end process pSUBPIXEL_GEN;
-- new pixel flag is asserted on the last phase of the pixel.
-- new pixel flag is asserted on the last phase of the pixel.
new_pixel <= '1' when subpix_phase_cnt = subpixel_phase_num else '0';
--fire_req_vec <= (0 => fire_req, others => '0');
--start_of_image_vec <= (0 => start_of_image, others => '0');
@ -747,7 +776,7 @@ begin
-- waste resources with the 2's complement).
-- Note: you don't really care to know whether the encoder speed
-- matches the direction used for generating fire-request, because
-- fire-request are not generated in the wrong direction
-- fire-request are not generated in the wrong direction
if (enc_vel(enc_vel'left) = '1') then
enc_vel_i <= not enc_vel;
else
@ -873,7 +902,7 @@ begin
ch_ctrl_writedata <= avs_writedata;
ch_ctrl_csr_writedata <= avs_writedata;
tof_lut_wr_data <= avs_writedata(tof_lut_wr_data'range);
pINIT : process(clk)
begin
@ -898,7 +927,7 @@ begin
-- Clock and reset
clk => clk,
rst_n => reset_n,
-- auto-generated
-- Internal signal ports
@ -950,7 +979,7 @@ begin
pixel_pitch_pos_err_min => wh_pos_err_min,
pixel_pitch_div_ratio_corr => div_ratio_corr(31 downto 0),
pixel_pitch_corr_cnt => wh_rotat_cnt,
-- end auto-generated
-- Slave bus port

View file

@ -6,7 +6,7 @@
-- Author : Gianmarco Girau
-- Company : Global Inkjet Systems
-- Created : 2016-10-24
-- Last update: 2021-04-12
-- Last update: 2023-01-30
-- SVN ID : Git
-- Standard : VHDL'93
-------------------------------------------------------------------------------
@ -53,6 +53,8 @@ entity pulse_generator_6 is
enc_vel : in std_logic_vector(19 downto 0) := (others => '0');
enc_speed_meas_w : out std_logic_vector(19 downto 0);
dp_dir : out std_logic;
hd_leadng_edge_rev : out std_logic; -- Head will print with rear nozzles first (e.g. dcba cs abcd)
pg_vecb_spare : out std_logic_vector(7 downto 1); -- spare bits output from the pg sequencer vector B
fire_req_vec : out std_logic_vector(31 downto 0);
start_of_image_vec : out std_logic_vector(31 downto 0);
stream_busy_a : in std_logic := '0';
@ -94,7 +96,7 @@ architecture rtl of pulse_generator_6 is
-- constants
constant CSR_IP_ID : std_logic_vector(31 downto 0) := x"0000FF13";
constant CSR_IP_VER : std_logic_vector(31 downto 0) := x"00000303";
constant CSR_IP_VER : std_logic_vector(31 downto 0) := x"00000601";
constant TOF_COMP_LUT_DEPTH : natural := 512;
constant TOF_COMP_LUT_WIDTH : natural := 16;
@ -130,7 +132,7 @@ architecture rtl of pulse_generator_6 is
signal wh_apply_corr_en_d, wh_corr_start, wh_skip_corr : std_logic;
signal wh_img_2nd_half, wh_img_2nd_half_d : std_logic;
signal selected_pulse, selected_pulse_d, clr_pd_queue : std_logic;
signal zero_gap_mode, start_image_flag : std_logic;
signal zero_gap_mode, start_image_flag, start_image_flag_early : std_logic;
signal use_ch_offset_dir1, add_ppc_regs, add_tof_comp_regs : std_logic;
signal add_delay_eq_reg, add_diag_reg : std_logic;
--
@ -139,6 +141,7 @@ architecture rtl of pulse_generator_6 is
signal wh_corr_ready_v, ch_ctrl_trigger_in : std_logic_vector( 5 downto 0);
signal avs_addr : std_logic_vector( 4 downto 0);
signal subpix_phase_cnt, subpixel_phase_num : std_logic_vector( 5 downto 0);
signal has_subpix_phases : std_logic;
signal init_v : std_logic_vector( 7 downto 0);
signal ch_ctrl_start_addr, bpe_top : std_logic_vector( 7 downto 0);
signal ch_ctrl_address : std_logic_vector( 7 downto 0);
@ -153,6 +156,7 @@ architecture rtl of pulse_generator_6 is
signal enc_speed_meas_w_i, enc_vel_i : std_logic_vector(19 downto 0);
signal img_size, pixel_cnt : std_logic_vector(23 downto 0);
signal ch_ctrl_vector_out : std_logic_vector(23 downto 0);
signal ch_ctrl_vector_b_out : std_logic_vector(7 downto 0);
signal wh_skip_corr_thres : std_logic_vector(23 downto 0);
signal wh_img_pixel_cnt, wh_image_pixel_len : std_logic_vector(23 downto 0);
signal basic_pos_error_sat : std_logic_vector(23 downto 0);
@ -193,33 +197,33 @@ begin
gen_filt_pd <= '1' when pd_pulse = '1' and (first_pd = '1' or
(dp_dir_i = '0' and close_to_zero = '1' and signed(abs_position) > signed(last_pd_pos)) or
(dp_dir_i = '0' and close_to_mid = '1' and unsigned(abs_position) > unsigned(last_pd_pos)) or
(dp_dir_i = '0' and close_to_mid = '1' and unsigned(abs_position) > unsigned(last_pd_pos)) or
(dp_dir_i = '1' and close_to_zero = '1' and signed(abs_position) < signed(last_pd_pos)) or
(dp_dir_i = '1' and close_to_mid = '1' and unsigned(abs_position) < unsigned(last_pd_pos))) else '0';
(dp_dir_i = '1' and close_to_mid = '1' and unsigned(abs_position) < unsigned(last_pd_pos))) else '0';
close_to_zero <= '1' when abs_position(31 downto 30) = "00" or abs_position(31 downto 30) = "11" else '0';
close_to_mid <= '1' when abs_position(31 downto 30) = "01" or abs_position(31 downto 30) = "10" else '0';
set_first_pd <= '1' when init_qd = '1' or (dp_dir_i = '0' and upd_max_pos_i = '1') or (dp_dir_i = '1' and upd_min_pos_i = '1') or rst_jitter = '1' or (mid_cross = '1' and mid_crossed = '0') else '0';
set_first_pd <= '1' when init_qd = '1' or (dp_dir_i = '0' and upd_max_pos_i = '1') or (dp_dir_i = '1' and upd_min_pos_i = '1') or rst_jitter = '1' or (mid_cross = '1' and mid_crossed = '0') else '0';
pPD_JITTER_MNG : process(clk)
begin
if(clk = '1' and clk'event) then
pd_in_d <= pd_in;
if(set_first_pd = '1') then
if (clk = '1' and clk'event) then
pd_in_d <= pd_in;
if (set_first_pd = '1') then
first_pd <= '1';
elsif(filt_pd = '1') then
elsif (filt_pd = '1') then
first_pd <= '0';
end if;
filt_pd <= gen_filt_pd;
filt_pd_d <= filt_pd;
if(set_first_pd = '1' or gen_filt_pd = '1') then
filt_pd <= gen_filt_pd;
filt_pd_d <= filt_pd;
if (set_first_pd = '1' or gen_filt_pd = '1') then
last_pd_pos <= abs_position;
end if;
abs_pos_msb_old <= abs_position(31 downto 30);
if(init_qd = '1' or zero_cross = '1') then
if (init_qd = '1' or zero_cross = '1') then
mid_crossed <= '0';
elsif(mid_cross = '1') then
elsif (mid_cross = '1') then
mid_crossed <= '1';
end if;
end if;
@ -240,11 +244,11 @@ begin
-- next increment of absolute position
pLOC_PD_IN : process(clk)
begin
if(clk = '1' and clk'event) then
if (clk = '1' and clk'event) then
abs_pos_lsb <= abs_position(0);
if(filt_pd = '1' and filt_pd_d = '0') then
if (filt_pd = '1' and filt_pd_d = '0') then
filt_pd_i <= '1';
elsif(init = '1' or (filt_pd = '0' and filt_pd_i = '1' and abs_position(0) /= abs_pos_lsb)) then
elsif (init = '1' or (filt_pd = '0' and filt_pd_i = '1' and abs_position(0) /= abs_pos_lsb)) then
filt_pd_i <= '0';
end if;
end if;
@ -258,7 +262,7 @@ begin
QUEUE_SIZE => 2*PD_QUEUE_SIZE,
DEVICE_FAMILY => DEVICE_FAMILY
)
port map (
port map(
rstN => reset_n,
clk => clk,
init => init_qd,
@ -272,7 +276,7 @@ begin
-- make sure the PD queue is always cleared whenever there is a change of direction
dir_change <= dp_dir_i xor dp_dir_d;
gBYDIR_CH_OFF: if BIDIR_CH_OFFSET_EN = true generate
gBYDIR_CH_OFF : if BIDIR_CH_OFFSET_EN = true generate
use_ch_offset_dir1 <= '1';
@ -285,9 +289,9 @@ begin
-- channel offset selection
pCH_OFF_SEL : process(clk)
begin
if(clk = '1' and clk'event) then
if(use_ch_offset_dir1 = '1') then
if(dp_dir_i = '0') then
if (clk = '1' and clk'event) then
if (use_ch_offset_dir1 = '1') then
if (dp_dir_i = '0') then
ch_offset <= ch_offset_dir0;
else
ch_offset <= ch_offset_dir1;
@ -306,14 +310,16 @@ begin
pDIR_CHG : process(clk)
begin
if(clk = '1' and clk'event) then
init_qd <= not enable or init or dir_change or clr_pd_queue or wh_corr_start;
if(bypass_ch_ctrl = '1') then
if (clk = '1' and clk'event) then
init_qd <= not enable or init or dir_change or clr_pd_queue or wh_corr_start;
if (bypass_ch_ctrl = '1') then
dp_dir_i <= sw_ctrl_dp_dir;
else
dp_dir_i <= ch_ctrl_vector_out(0);
end if;
dp_dir_d <= dp_dir_i;
hd_leadng_edge_rev <= ch_ctrl_vector_b_out(0);
pg_vecb_spare <= ch_ctrl_vector_b_out(7 downto 1);
end if;
end process pDIR_CHG;
@ -335,8 +341,9 @@ begin
generic map (
TRIGGER_WIDTH => 6,
VECTOR_WIDTH => 24,
VECTOR_WIDTHB => 8,
BUS_WIDTH => 32,
POS_WIDTH => 24,
POS_WIDTH => 32,
SEQ_DEPTH => 256,
ADD_VEC_PIPE => false,
VECT_CPU_EN => false,
@ -347,28 +354,29 @@ begin
QUEUE_EN => false,
DEVICE_FAMILY => DEVICE_FAMILY
)
port map (
clk => clk,
reset_n => reset_n,
avs_csr_address => ch_ctrl_csr_addr,
avs_csr_write => ch_ctrl_csr_write,
avs_csr_writedata => ch_ctrl_csr_writedata,
avs_csr_read => ch_ctrl_csr_read,
avs_csr_readdata => ch_ctrl_csr_readdata,
avs_seq_address => ch_ctrl_address,
avs_seq_write => ch_ctrl_write,
avs_seq_writedata => ch_ctrl_writedata,
avs_seq_read => ch_ctrl_read,
avs_seq_readdata => ch_ctrl_readdata,
start_req => ch_ctrl_start_req,
start_addr => ch_ctrl_start_addr,
trigger_in => ch_ctrl_trigger_in,
pos_in => abs_position(23 downto 0),
busy => ch_ctrl_busy,
vector_out => ch_ctrl_vector_out,
bus_data => seq_bus_data,
bus_valid => seq_bus_valid,
bus_ack => '1');
port map(
clk => clk,
reset_n => reset_n,
avs_csr_address => ch_ctrl_csr_addr,
avs_csr_write => ch_ctrl_csr_write,
avs_csr_writedata => ch_ctrl_csr_writedata,
avs_csr_read => ch_ctrl_csr_read,
avs_csr_readdata => ch_ctrl_csr_readdata,
avs_seq_address => ch_ctrl_address,
avs_seq_write => ch_ctrl_write,
avs_seq_writedata => ch_ctrl_writedata,
avs_seq_read => ch_ctrl_read,
avs_seq_readdata => ch_ctrl_readdata,
start_req => ch_ctrl_start_req,
start_addr => ch_ctrl_start_addr,
trigger_in => ch_ctrl_trigger_in,
pos_in => abs_position,
busy => ch_ctrl_busy,
vector_out => ch_ctrl_vector_out,
vector_out_b => ch_ctrl_vector_b_out,
bus_data => seq_bus_data,
bus_valid => seq_bus_valid,
bus_ack => '1');
ch_ctrl_trigger_in <= (0 => loc_pd, 1 => fire_enable, 2 => gated_pulse, 3 => (not fire_enable), 4 => (not stream_busy_a), 5 => (not stream_busy_b));
@ -386,42 +394,58 @@ begin
zero_gap_mode <= ch_ctrl_vector_out(7);
ch_ctrl_start_req_i <= ch_ctrl_start_req_ii and enable and not init;
ch_ctrl_start_req <= ch_ctrl_start_req_i and not ch_ctrl_start_req_d;
ch_ctrl_start_req <= ch_ctrl_start_req_i and not ch_ctrl_start_req_d;
pGEN_IMAGE: process(clk)
pGEN_IMAGE : process(clk)
begin
if(clk = '1' and clk'event) then
if (clk = '1' and clk'event) then
ch_ctrl_start_req_d <= ch_ctrl_start_req_i;
start_img_req_d <= start_img_req;
start_img_d <= start_img;
start_img_dd <= start_img_d;
add_img_size_d <= add_img_size;
if(img_completed = '1' or enable = '0' or abort_fire = '1') then
start_img_req_d <= start_img_req;
start_img_d <= start_img;
start_img_dd <= start_img_d;
add_img_size_d <= add_img_size;
if (img_completed = '1' or enable = '0' or abort_fire = '1') then
fire_enable <= '0';
elsif(start_img_dd = '1' and fire_enable = '0') then
elsif (start_img_dd = '1' and fire_enable = '0') then
fire_enable <= '1';
end if;
if(start_img = '1' and fire_enable = '0') then
img_size <= X"00" & ch_ctrl_vector_out(23 downto 8);
elsif(add_img_size = '1' and add_img_size_d = '0') then
img_size <= std_logic_vector(unsigned(img_size)+unsigned(ch_ctrl_vector_out(23 downto 8)));
if (start_img = '1' and fire_enable = '0') then
img_size <= X"00" & ch_ctrl_vector_out(23 downto 8);
elsif (add_img_size = '1' and add_img_size_d = '0') then
img_size <= std_logic_vector(unsigned(img_size) + unsigned(ch_ctrl_vector_out(23 downto 8)));
end if;
if (start_img = '1' and (fire_enable = '0' or zero_gap_mode = '1')) then
pixel_cnt <= (others => '0');
elsif(fire_enable = '1' and new_pixel = '1') then
pixel_cnt <= std_logic_vector(unsigned(pixel_cnt)+1);
pixel_cnt <= (others => '0');
elsif (fire_enable = '1' and new_pixel = '1') then
if (start_image_flag_early = '1') then
pixel_cnt <= (others => '0');
else
pixel_cnt <= std_logic_vector(unsigned(pixel_cnt) + 1);
end if;
end if;
if(init = '1' or enable = '0' or new_pixel = '1') then
start_image_flag <= '0';
elsif(start_img = '1') then
start_image_flag <= '1';
if (init = '1' or enable = '0') then
start_image_flag_early <= '0';
start_image_flag <= '0';
elsif new_pixel = '1' then
start_image_flag <= start_image_flag_early or start_img;
start_image_flag_early <= '0';
elsif (start_img = '1') then
-- starting a merge so FPM req vector will not line up with pd. So delay pd till next full sequence
-- The second pd could come in when the fire pulse phase is non zero. e.g. Fire pulse phases
-- 15->32 could be associated with start of second image. But 0->14 would never be signalled
-- as start of image. delay start image flag until just before fire pulse phase 0.
if fire_enable = '1' and has_subpix_phases = '1' then -- already running, make sure to wait for next sub pixel cycle
start_image_flag_early <= '1';
else
start_image_flag <= '1';
end if;
end if;
end if;
end process pGEN_IMAGE;
start_of_image <= start_image_flag and fire_req;
start_img <= start_img_req and not start_img_req_d;
start_img <= start_img_req and not start_img_req_d;
img_completed <= '1' when fire_enable = '1' and unsigned(pixel_cnt) = unsigned(img_size) else '0';
-----------------------------------------------------------------------------
@ -452,7 +476,7 @@ begin
p_pulse_div_switch : process(clk)
begin
if(clk = '1' and clk'event) then
if (clk = '1' and clk'event) then
rst_jitter <= ch_ctrl_vector_out(5);
upd_max_pos <= upd_max_pos_i or init_v(0) or dir_change or (rst_jitter and not dp_dir_i);
upd_min_pos <= upd_min_pos_i or init_v(0) or dir_change or (rst_jitter and dp_dir_i);
@ -467,101 +491,101 @@ begin
-- W&H Div-Ratio Correction for Flexo/CI cylinders
-----------------------------------------------------------------------------
gPP_CORR_GEN: if PIXEL_PITCH_CORR_EN = true generate
gPP_CORR_GEN : if PIXEL_PITCH_CORR_EN = true generate
add_ppc_regs <= '1';
pDIV_RATIO_CORR : process(clk)
begin
if(clk = '1' and clk'event) then
if (clk = '1' and clk'event) then
-- latch the absolute-position to prevent excessive degradation of timing
abs_pos_d <= abs_position;
if(init_wh = '1' or wh_img_end = '1') then
abs_pos_d <= abs_position;
if (init_wh = '1' or wh_img_end = '1') then
wh_img_pixel_cnt <= (others => '0');
elsif(fire_enable = '1' and div_pulse = '1') then
wh_img_pixel_cnt <= std_logic_vector(unsigned(wh_img_pixel_cnt)+1);
elsif (fire_enable = '1' and div_pulse = '1') then
wh_img_pixel_cnt <= std_logic_vector(unsigned(wh_img_pixel_cnt) + 1);
end if;
loc_pd_d <= loc_pd;
loc_pd_d <= loc_pd;
wh_apply_corr_en_d <= wh_apply_corr_en;
init_wh <= init or (not enable) or (not wh_apply_corr_en);
if(init_wh = '1') then
init_wh <= init or (not enable) or (not wh_apply_corr_en);
if (init_wh = '1') then
div_ratio_corr <= (others => '0');
elsif(wh_corr_ready = '1' and wh_skip_corr = '0') then
div_ratio_corr <= std_logic_vector(signed(div_ratio_corr)+signed(div_ratio_corr_new));
elsif (wh_corr_ready = '1' and wh_skip_corr = '0') then
div_ratio_corr <= std_logic_vector(signed(div_ratio_corr) + signed(div_ratio_corr_new));
end if;
div_ratio_i <= std_logic_vector(signed(div_ratio)+signed(div_ratio_corr));
wh_img_2nd_half_d <= wh_img_2nd_half;
if(init_wh = '1' or wh_skip_corr = '1') then
div_ratio_i <= std_logic_vector(signed(div_ratio) + signed(div_ratio_corr));
wh_img_2nd_half_d <= wh_img_2nd_half;
if (init_wh = '1' or wh_skip_corr = '1') then
first_img_started <= '0';
elsif(wh_img_2nd_half = '1' and wh_img_2nd_half_d = '0') then
elsif (wh_img_2nd_half = '1' and wh_img_2nd_half_d = '0') then
first_img_started <= '1';
end if;
if(init_wh = '1' or wh_skip_corr = '1') then
if (init_wh = '1' or wh_skip_corr = '1') then
wh_error_meas_started <= '0';
elsif(wh_meas_event = '1' and first_img_started = '1') then
elsif (wh_meas_event = '1' and first_img_started = '1') then
wh_error_meas_started <= not wh_error_meas_started;
end if;
if(wh_meas_event = '1' and wh_error_meas_started = '0') then
if (wh_meas_event = '1' and wh_error_meas_started = '0') then
start_pos <= abs_pos_d;
end if;
if((loc_pd_d and wh_img_end) = '1' or wh_skip_corr = '1') then
if ((loc_pd_d and wh_img_end) = '1' or wh_skip_corr = '1') then
basic_pos_error <= (others => '0');
elsif(wh_meas_event = '1' and wh_error_meas_started = '1') then
if(loc_pd_d = '1') then
basic_pos_error <= std_logic_vector(resize(signed(abs_pos_d)-signed(start_pos), basic_pos_error'length));
elsif (wh_meas_event = '1' and wh_error_meas_started = '1') then
if (loc_pd_d = '1') then
basic_pos_error <= std_logic_vector(resize(signed(abs_pos_d) - signed(start_pos), basic_pos_error'length));
else
basic_pos_error <= std_logic_vector(resize(signed(start_pos)-signed(abs_pos_d), basic_pos_error'length));
basic_pos_error <= std_logic_vector(resize(signed(start_pos) - signed(abs_pos_d), basic_pos_error'length));
end if;
end if;
if(wh_error_meas_started = '1' and (loc_pd_d or wh_img_end) = '1') then
if (wh_error_meas_started = '1' and (loc_pd_d or wh_img_end) = '1') then
wh_error_meas_avail <= '1';
else
wh_error_meas_avail <= '0';
end if;
wh_corr_ready_v <= wh_corr_ready_v(wh_corr_ready_v'left-1 downto 0) & wh_error_meas_avail;
pos_error <= std_logic_vector(signed(basic_pos_error_sat & 24x"0") - signed(div_ratio));
if(init_wh = '1' or wh_skip_corr = '1') then
wh_corr_ready_v <= wh_corr_ready_v(wh_corr_ready_v'left - 1 downto 0) & wh_error_meas_avail;
pos_error <= std_logic_vector(signed(basic_pos_error_sat & 24x"0") - signed(div_ratio));
if (init_wh = '1' or wh_skip_corr = '1') then
wh_pos_err_old <= (others => '0');
elsif(wh_corr_ready_v(0) = '1') then
elsif (wh_corr_ready_v(0) = '1') then
wh_pos_err_old <= wh_pos_err;
end if;
wh_loop_err_delta <= std_logic_vector(signed(wh_delta_err)*signed(wh_loop_filt_delta));
wh_loop_err_tot <= std_logic_vector(signed(wh_tot_err)*signed(wh_loop_filt_tot));
wh_loop_err <= std_logic_vector(signed(wh_loop_err_delta)+signed(wh_loop_err_tot));
if(wh_corr_ready_v(2) = '1') then
div_ratio_corr_ext <= std_logic_vector(signed(wh_loop_err(wh_loop_err'left-8 downto 8))*signed(wh_pos_err_2_corr));
wh_loop_err_delta <= std_logic_vector(signed(wh_delta_err) * signed(wh_loop_filt_delta));
wh_loop_err_tot <= std_logic_vector(signed(wh_tot_err) * signed(wh_loop_filt_tot));
wh_loop_err <= std_logic_vector(signed(wh_loop_err_delta) + signed(wh_loop_err_tot));
if (wh_corr_ready_v(2) = '1') then
div_ratio_corr_ext <= std_logic_vector(signed(wh_loop_err(wh_loop_err'left - 8 downto 8)) * signed(wh_pos_err_2_corr));
end if;
-- Compute the absolute value of the position-error. Use a simple 1's
-- complement if you need to do sign inversion
if(wh_pos_err(wh_pos_err'left) = '1') then
if (wh_pos_err(wh_pos_err'left) = '1') then
wh_pos_err_abs <= not wh_pos_err;
else
wh_pos_err_abs <= wh_pos_err;
end if;
if(init_wh = '1') then
if (init_wh = '1') then
wh_pos_err_curr <= (others => '0');
elsif(wh_corr_ready_v(0) = '1') then
elsif (wh_corr_ready_v(0) = '1') then
wh_pos_err_curr <= wh_pos_err;
end if;
if(wh_corr_ready_v(1) = '1' and unsigned(wh_pos_err_abs) > unsigned(wh_skip_corr_thres & X"00") and first_img_started = '1') then
if (wh_corr_ready_v(1) = '1' and unsigned(wh_pos_err_abs) > unsigned(wh_skip_corr_thres & X"00") and first_img_started = '1') then
wh_skip_corr <= '1';
elsif(loc_pd = '1') then
elsif (loc_pd = '1') then
wh_skip_corr <= '0';
end if;
if(init_wh = '1') then
if (init_wh = '1') then
wh_pos_err_max <= (others => '0');
elsif(wh_corr_ready = '1' and signed(wh_pos_err) > signed(wh_pos_err_max)) then
elsif (wh_corr_ready = '1' and signed(wh_pos_err) > signed(wh_pos_err_max)) then
wh_pos_err_max <= wh_pos_err;
end if;
if(init_wh = '1') then
if (init_wh = '1') then
wh_pos_err_min <= (others => '0');
elsif(wh_corr_ready = '1' and signed(wh_pos_err) < signed(wh_pos_err_min)) then
elsif (wh_corr_ready = '1' and signed(wh_pos_err) < signed(wh_pos_err_min)) then
wh_pos_err_min <= wh_pos_err;
end if;
if(init_wh = '1') then
if (init_wh = '1') then
wh_rotat_cnt <= (others => '0');
elsif(wh_corr_ready = '1') then
wh_rotat_cnt <= std_logic_vector(unsigned(wh_rotat_cnt)+1);
elsif (wh_corr_ready = '1') then
wh_rotat_cnt <= std_logic_vector(unsigned(wh_rotat_cnt) + 1);
end if;
end if;
end process pDIV_RATIO_CORR;
@ -574,26 +598,26 @@ begin
wh_meas_event <= loc_pd_d xor wh_img_end;
div_ratio_corr_new <= std_logic_vector(resize(signed(div_ratio_corr_ext(div_ratio_corr_ext'left downto 16)),div_ratio'length));
div_ratio_corr_new <= std_logic_vector(resize(signed(div_ratio_corr_ext(div_ratio_corr_ext'left downto 16)), div_ratio'length));
wh_corr_ready <= wh_corr_ready_v(wh_corr_ready_v'left);
-- saturate the basic position error when exceeding the size of a 24-bits
-- signed number
bpe_top <= basic_pos_error(31 downto 24);
bpe_top <= basic_pos_error(31 downto 24);
basic_pos_error_sat <= basic_pos_error(23 downto 0) when (signed(bpe_top) = 0 or signed(bpe_top) = -1) else X"7FFFFF" when signed(bpe_top) > 0 else X"800000";
-- No need to use 24 bits mantissa for pos_error, 8 bits are plenty
wh_pos_err <= pos_error(pos_error'left downto 16);
wh_tot_err <= wh_pos_err;
wh_delta_err <= std_logic_vector(signed(wh_pos_err)-signed(wh_pos_err_old));
wh_tot_err <= wh_pos_err;
wh_delta_err <= std_logic_vector(signed(wh_pos_err) - signed(wh_pos_err_old));
end generate gPP_CORR_GEN;
gNOT_PP_CORR_GEN: if PIXEL_PITCH_CORR_EN = false generate
gNOT_PP_CORR_GEN : if PIXEL_PITCH_CORR_EN = false generate
add_ppc_regs <= '0';
add_ppc_regs <= '0';
--
div_ratio_i <= div_ratio;
div_ratio_corr <= (others => '0');
@ -611,22 +635,22 @@ begin
-- Spitting logic
-----------------------------------------------------------------------------
gSPIT_LOGIC: if SPITTING_EN generate
gSPIT_LOGIC : if SPITTING_EN generate
pSPITTING_LOGIC : process(clk)
begin
if(clk = '1' and clk'event) then
if (clk = '1' and clk'event) then
spitting_enable <= ch_ctrl_vector_out(6);
if(seq_bus_valid = '1') then
if (seq_bus_valid = '1') then
spit_nco_inc <= seq_bus_data;
end if;
if(spitting_enable = '0') then
if (spitting_enable = '0') then
spit_nco <= (others => '0');
else
spit_nco <= std_logic_vector(unsigned(spit_nco)+unsigned(spit_nco_inc));
spit_nco <= std_logic_vector(unsigned(spit_nco) + unsigned(spit_nco_inc));
end if;
spit_nco_msb <= spit_nco(spit_nco'left);
spit_pulse <= spit_nco(spit_nco'left) and not spit_nco_msb;
spit_nco_msb <= spit_nco(spit_nco'left);
spit_pulse <= spit_nco(spit_nco'left) and not spit_nco_msb;
end if;
end process pSPITTING_LOGIC;
@ -675,7 +699,7 @@ begin
end generate gPULSE_DELAY_EQUAL;
gNOT_PULSE_DELAY_EQUAL: if PULSE_DELAY_EQUAL_EN = false generate
gNOT_PULSE_DELAY_EQUAL : if PULSE_DELAY_EQUAL_EN = false generate
add_delay_eq_reg <= '0';
@ -687,8 +711,8 @@ begin
p_delay_equal_switch : process(clk)
begin
if(clk = '1' and clk'event) then
if(bypass_delay_equal = '1') then
if (clk = '1' and clk'event) then
if (bypass_delay_equal = '1') then
selected_pulse <= gated_pulse;
else
selected_pulse <= retimed_pulse;
@ -709,27 +733,32 @@ begin
pSUBPIXEL_GEN : process(clk)
variable first_pixel : std_logic;
begin
if(clk = '1' and clk'event) then
if(fire_enable = '0' or new_pixel = '1') then
if (clk = '1' and clk'event) then
if (fire_enable = '0' or new_pixel = '1') then
subpix_phase_cnt <= (others => '0');
elsif(fire_req = '1') then
subpix_phase_cnt <= std_logic_vector(unsigned(subpix_phase_cnt)+1);
elsif (fire_req = '1') then
subpix_phase_cnt <= std_logic_vector(unsigned(subpix_phase_cnt) + 1);
end if;
if(fire_enable = '0' or new_pixel = '1') then
if (fire_enable = '0' or new_pixel = '1') then
subpix_phase <= (0 => '1', others => '0');
elsif(fire_req = '1') then
elsif (fire_req = '1') then
subpix_phase <= subpix_phase(30 downto 0) & subpix_phase(31);
end if;
if(fire_req = '1') then
if (fire_req = '1') then
fire_req_vec <= subpix_phase;
else
fire_req_vec <= (others => '0');
end if;
if(fire_req = '1' and start_image_flag = '1') then
if (fire_req = '1' and start_image_flag = '1') then
start_of_image_vec <= subpix_phase;
else
start_of_image_vec <= (others => '0');
end if;
if unsigned(subpixel_phase_num) > 1 then
has_subpix_phases <= '1';
else
has_subpix_phases <= '0';
end if;
end if;
end process pSUBPIXEL_GEN;
@ -744,35 +773,35 @@ begin
-- Time-of-Flight Compensation
-----------------------------------------------------------------------------
gTOF_COMP_GEN: if TOF_COMP_EN = true and PULSE_DELAY_EQUAL_EN = true generate
gTOF_COMP_GEN : if TOF_COMP_EN = true and PULSE_DELAY_EQUAL_EN = true generate
add_tof_comp_regs <= '1';
pTOF_COMP : process(clk)
begin
if(clk = '1' and clk'event) then
if (clk = '1' and clk'event) then
-- if the encoder speed is negative, do a 1's complement (no need to
-- waste resources with the 2's complement).
-- Note: you don't really care to know whether the encoder speed
-- matches the direction used for generating fire-request, because
-- fire-request are not generated in the wrong direction
if(enc_vel(enc_vel'left) = '1') then
if (enc_vel(enc_vel'left) = '1') then
enc_vel_i <= not enc_vel;
else
enc_vel_i <= enc_vel;
end if;
if(tof_saturation = '1') then
if (tof_saturation = '1') then
tof_lut_addr <= (others => '1');
else
tof_lut_addr <= norm_enc_vel(norm_enc_vel'left-19 downto (norm_enc_vel'left-19-tof_lut_addr'left));
tof_lut_addr <= norm_enc_vel(norm_enc_vel'left - 19 downto (norm_enc_vel'left - 19 - tof_lut_addr'left));
end if;
if(init or (not enable) or (not tof_comp_enable)) then
if (init or (not enable) or (not tof_comp_enable)) then
tof_sat_flag <= '0';
elsif(tof_saturation = '1') then
elsif (tof_saturation = '1') then
tof_sat_flag <= '1';
end if;
ch_delay_i <= std_logic_vector(unsigned(ch_delay)+unsigned(tof_lut_comp));
if(tof_comp_enable = '1') then
ch_delay_i <= std_logic_vector(unsigned(ch_delay) + unsigned(tof_lut_comp));
if (tof_comp_enable = '1') then
tof_lut_comp <= tof_lut_comp_i;
else
tof_lut_comp <= (others => '0');
@ -780,31 +809,31 @@ begin
end if;
end process pTOF_COMP;
norm_enc_vel <= std_logic_vector(unsigned(enc_vel_i)*unsigned(enc_speed_norm_coeff));
norm_enc_vel <= std_logic_vector(unsigned(enc_vel_i) * unsigned(enc_speed_norm_coeff));
tof_saturation <= '1' when unsigned(norm_enc_vel(norm_enc_vel'left downto norm_enc_vel'left-18)) /= 0 else '0';
tof_saturation <= '1' when unsigned(norm_enc_vel(norm_enc_vel'left downto norm_enc_vel'left - 18)) /= 0 else '0';
--iTOF_COMP_LUT : entity work.dpram_sclk
iTOF_COMP_LUT : dpram_sclk
generic map (
DATA_WIDTH => TOF_COMP_LUT_WIDTH,
ADDR_WIDTH => log2(TOF_COMP_LUT_DEPTH))
port map (
clk => clk,
addr_a => tof_lut_wr_addr,
we_a => tof_lut_wr_en,
data_a => tof_lut_wr_data,
q_a => tof_lut_wr_q,
addr_b => tof_lut_addr,
we_b => '0',
data_b => gnd_16,
q_b => tof_lut_comp_i);
generic map(
DATA_WIDTH => TOF_COMP_LUT_WIDTH,
ADDR_WIDTH => log2(TOF_COMP_LUT_DEPTH))
port map(
clk => clk,
addr_a => tof_lut_wr_addr,
we_a => tof_lut_wr_en,
data_a => tof_lut_wr_data,
q_a => tof_lut_wr_q,
addr_b => tof_lut_addr,
we_b => '0',
data_b => gnd_16,
q_b => tof_lut_comp_i);
gnd_16 <= (others => '0');
end generate gTOF_COMP_GEN;
gTOF_COMP_NOGEN: if TOF_COMP_EN = false or PULSE_DELAY_EQUAL_EN = false generate
gTOF_COMP_NOGEN : if TOF_COMP_EN = false or PULSE_DELAY_EQUAL_EN = false generate
add_tof_comp_regs <= '0';
@ -821,23 +850,23 @@ begin
-----------------------------------------------------------------------------
gDIAG_CNT: if DIAG_COUNTERS = true generate
gDIAG_CNT : if DIAG_COUNTERS = true generate
add_diag_reg <= '1';
pEdgeDetect_Cnt : process(clk)
begin
if(clk = '1' and clk'event) then
if (clk = '1' and clk'event) then
loc_pd_dd <= loc_pd;
if(init = '1' or enable = '0' or rst_diag_regs = '1') then
if (init = '1' or enable = '0' or rst_diag_regs = '1') then
pd_cnt <= (others => '0');
elsif(loc_pd = '1' and loc_pd_dd = '0') then
pd_cnt <= std_logic_vector(unsigned(pd_cnt)+1);
elsif (loc_pd = '1' and loc_pd_dd = '0') then
pd_cnt <= std_logic_vector(unsigned(pd_cnt) + 1);
end if;
if(init = '1' or enable = '0' or rst_diag_regs = '1') then
if (init = '1' or enable = '0' or rst_diag_regs = '1') then
fire_req_cnt <= (others => '0');
elsif(new_pixel = '1') then
fire_req_cnt <= std_logic_vector(unsigned(fire_req_cnt)+1);
elsif (new_pixel = '1') then
fire_req_cnt <= std_logic_vector(unsigned(fire_req_cnt) + 1);
end if;
end if;
end process pEdgeDetect_Cnt;
@ -848,7 +877,7 @@ begin
end generate gDIAG_CNT;
gNOT_DIAG_CNT: if DIAG_COUNTERS = false generate
gNOT_DIAG_CNT : if DIAG_COUNTERS = false generate
pd_cnt <= (others => '0');
fire_req_cnt <= (others => '0');
@ -868,15 +897,15 @@ begin
ch_ctrl_csr_write <= '1' when avs_write = '1' and avs_address(10 downto 5) = "000001" else '0';
tof_lut_wr_en <= '1' when avs_write = '1' and avs_address(10 downto 9) = "10" else '0';
avs_read_i <= '1' when avs_read = '1' and avs_address(10 downto 9) = "00" else '0';
ch_ctrl_read <= '1' when avs_read = '1' and avs_address(10 downto 9) = "01" else '0';
ch_ctrl_csr_read <= '1' when avs_read = '1' and avs_address(10 downto 5) = "000001" else '0';
avs_read_i <= '1' when avs_read = '1' and avs_address(10 downto 9) = "00" else '0';
ch_ctrl_read <= '1' when avs_read = '1' and avs_address(10 downto 9) = "01" else '0';
ch_ctrl_csr_read <= '1' when avs_read = '1' and avs_address(10 downto 5) = "000001" else '0';
avs_addr <= avs_address(4 downto 0);
avs_addr <= avs_address(4 downto 0);
ch_ctrl_address <= avs_address(ch_ctrl_address'range);
ch_ctrl_csr_addr <= avs_address(ch_ctrl_csr_addr'range);
tof_lut_wr_addr <= avs_address(tof_lut_wr_addr'range);
tof_lut_wr_addr <= avs_address(tof_lut_wr_addr'range);
ch_ctrl_writedata <= avs_writedata;
ch_ctrl_csr_writedata <= avs_writedata;
@ -885,8 +914,8 @@ begin
pINIT : process(clk)
begin
if(clk = '1' and clk'event) then
if(init = '1') then
if (clk = '1' and clk'event) then
if (init = '1') then
init_v <= (others => '1');
else
init_v <= '0' & init_v(init_v'high downto 1);
@ -899,75 +928,75 @@ begin
enc_speed_meas_w <= enc_speed_meas_w_i;
pulse_generator_csr_regs_i : entity work.pulse_generator_6_csr_regs
generic map (
ADDR_DECODE_WIDTH => 5
)
port map (
-- Clock and reset
clk => clk,
rst_n => reset_n,
generic map(
ADDR_DECODE_WIDTH => 5
)
port map(
-- Clock and reset
clk => clk,
rst_n => reset_n,
-- auto-generated
-- auto-generated
-- Internal signal ports
pulse_gen_control_w_enable => enable_i,
pulse_gen_control_w_bypass_channel_controller => bypass_ch_ctrl,
pulse_gen_control_w_bypass_delay_equalizer => bypass_delay_equal,
pulse_gen_control_w_sw_control_dp_dir => sw_ctrl_dp_dir,
pulse_gen_control_w_wh_apply_corr_en => wh_apply_corr_en,
pulse_gen_control_w_pp_apply_corr_en => open,
pulse_gen_control_w_tof_comp_enable => tof_comp_enable,
pulse_gen_control_w_enable_output => enable_out,
pulse_gen_control_w_trigger_abort_fire => abort_fire,
pulse_gen_control_w_reset_diag_regs => rst_diag_regs,
pd_offset_dir_0 => ch_offset_dir0,
pd_offset_dir_1 => ch_offset_dir1,
channel_delay => ch_delay,
channel_controller_control_w_sequencer_start_address => ch_ctrl_start_addr,
fractional_divider_control_enable => frac_div_en_i,
fractional_divider_control_udp_max_pos => upd_max_pos_i,
fractional_divider_control_udp_min_pos => upd_min_pos_i,
divider_ratio_int => div_ratio(33 downto 24),
divider_ratio_fraction => div_ratio(23 downto 0),
subpixel_phase_num => subpixel_phase_num,
enc_speed_meas_window => enc_speed_meas_w_i,
tof_compensation_w_enc_speed_norm => enc_speed_norm_coeff,
pixel_pitch_corr_stripe_num => wh_image_pixel_len,
pixel_pitch_pos_err_2_corr => wh_pos_err_2_corr,
pixel_pitch_skip_corr_thres => wh_skip_corr_thres,
pixel_pitch_loop_filter_corr_delta_error_coeff => wh_loop_filt_delta,
pixel_pitch_loop_filter_corr_tot_error_coeff => wh_loop_filt_tot,
pulse_gen_control_w_clr_pd_queue => clr_pd_queue,
channel_controller_control_w_start_seq_trigger => ch_ctrl_start_req_ii,
pulse_gen_control_r_pd_queue_error_flag => pd_queue_error,
pulse_gen_control_r_delay_equalizer_error_flag => de_queue_error,
pulse_gen_control_r_ch_mask_status => ch_mask_i,
pulse_gen_control_r_fire_enable_status => fire_enable,
pulse_gen_control_r_dual_phase_directionality_select_status => dp_dir_i,
pulse_gen_control_r_tof_sat_flag => tof_sat_flag,
channel_controller_control_r_busy => ch_ctrl_busy,
abs_position_max => abs_pos_max,
abs_position_min => abs_pos_min,
abs_position => abs_position,
pd_counter => pd_cnt,
fire_req_counter => fire_req_cnt,
enc_speed => enc_vel,
tof_compensation_r_tof_lut_comp => tof_lut_comp,
pixel_pitch_pos_err_curr => wh_pos_err_curr,
pixel_pitch_pos_err_max => wh_pos_err_max,
pixel_pitch_pos_err_min => wh_pos_err_min,
pixel_pitch_div_ratio_corr => div_ratio_corr(31 downto 0),
pixel_pitch_corr_cnt => wh_rotat_cnt,
-- Internal signal ports
pulse_gen_control_w_enable => enable_i,
pulse_gen_control_w_bypass_channel_controller => bypass_ch_ctrl,
pulse_gen_control_w_bypass_delay_equalizer => bypass_delay_equal,
pulse_gen_control_w_sw_control_dp_dir => sw_ctrl_dp_dir,
pulse_gen_control_w_wh_apply_corr_en => wh_apply_corr_en,
pulse_gen_control_w_pp_apply_corr_en => open,
pulse_gen_control_w_tof_comp_enable => tof_comp_enable,
pulse_gen_control_w_enable_output => enable_out,
pulse_gen_control_w_trigger_abort_fire => abort_fire,
pulse_gen_control_w_reset_diag_regs => rst_diag_regs,
pd_offset_dir_0 => ch_offset_dir0,
pd_offset_dir_1 => ch_offset_dir1,
channel_delay => ch_delay,
channel_controller_control_w_sequencer_start_address => ch_ctrl_start_addr,
fractional_divider_control_enable => frac_div_en_i,
fractional_divider_control_udp_max_pos => upd_max_pos_i,
fractional_divider_control_udp_min_pos => upd_min_pos_i,
divider_ratio_int => div_ratio(33 downto 24),
divider_ratio_fraction => div_ratio(23 downto 0),
subpixel_phase_num => subpixel_phase_num,
enc_speed_meas_window => enc_speed_meas_w_i,
tof_compensation_w_enc_speed_norm => enc_speed_norm_coeff,
pixel_pitch_corr_stripe_num => wh_image_pixel_len,
pixel_pitch_pos_err_2_corr => wh_pos_err_2_corr,
pixel_pitch_skip_corr_thres => wh_skip_corr_thres,
pixel_pitch_loop_filter_corr_delta_error_coeff => wh_loop_filt_delta,
pixel_pitch_loop_filter_corr_tot_error_coeff => wh_loop_filt_tot,
pulse_gen_control_w_clr_pd_queue => clr_pd_queue,
channel_controller_control_w_start_seq_trigger => ch_ctrl_start_req_ii,
pulse_gen_control_r_pd_queue_error_flag => pd_queue_error,
pulse_gen_control_r_delay_equalizer_error_flag => de_queue_error,
pulse_gen_control_r_ch_mask_status => ch_mask_i,
pulse_gen_control_r_fire_enable_status => fire_enable,
pulse_gen_control_r_dual_phase_directionality_select_status => dp_dir_i,
pulse_gen_control_r_tof_sat_flag => tof_sat_flag,
channel_controller_control_r_busy => ch_ctrl_busy,
abs_position_max => abs_pos_max,
abs_position_min => abs_pos_min,
abs_position => abs_position,
pd_counter => pd_cnt,
fire_req_counter => fire_req_cnt,
enc_speed => enc_vel,
tof_compensation_r_tof_lut_comp => tof_lut_comp,
pixel_pitch_pos_err_curr => wh_pos_err_curr,
pixel_pitch_pos_err_max => wh_pos_err_max,
pixel_pitch_pos_err_min => wh_pos_err_min,
pixel_pitch_div_ratio_corr => div_ratio_corr(31 downto 0),
pixel_pitch_corr_cnt => wh_rotat_cnt,
-- end auto-generated
-- end auto-generated
-- Slave bus port
avs_address => avs_addr(4 downto 0),
avs_write => avs_write_i,
avs_writedata => avs_writedata,
avs_read => avs_read_i,
avs_readdata => avs_readdata_i
);
-- Slave bus port
avs_address => avs_addr(4 downto 0),
avs_write => avs_write_i,
avs_writedata => avs_writedata,
avs_read => avs_read_i,
avs_readdata => avs_readdata_i
);
avs_readdata <= avs_readdata_i when avs_address(10 downto 5) = "000000" else
ch_ctrl_csr_readdata when avs_address(10 downto 5) = "000001" else