| 1 | ----------------------------------------------------------------------------------
|
|---|
| 2 | -- Company: ETH Zurich, Institute for Particle Physics
|
|---|
| 3 | -- Engineer: Q. Weitzel, P. Vogler
|
|---|
| 4 | --
|
|---|
| 5 | -- Create Date: 08/06/2010
|
|---|
| 6 | -- Design Name:
|
|---|
| 7 | -- Module Name: FTU_control - Behavioral
|
|---|
| 8 | -- Project Name:
|
|---|
| 9 | -- Target Devices:
|
|---|
| 10 | -- Tool versions:
|
|---|
| 11 | -- Description: Control FSM of FACT FTU board
|
|---|
| 12 | --
|
|---|
| 13 | -- Dependencies:
|
|---|
| 14 | --
|
|---|
| 15 | -- Revision:
|
|---|
| 16 | -- Revision 0.01 - File Created
|
|---|
| 17 | -- Additional Comments:
|
|---|
| 18 | --
|
|---|
| 19 | ----------------------------------------------------------------------------------
|
|---|
| 20 |
|
|---|
| 21 | library IEEE;
|
|---|
| 22 | use IEEE.STD_LOGIC_1164.ALL;
|
|---|
| 23 | use IEEE.STD_LOGIC_ARITH.ALL;
|
|---|
| 24 | use IEEE.STD_LOGIC_UNSIGNED.ALL;
|
|---|
| 25 |
|
|---|
| 26 | library ftu_definitions;
|
|---|
| 27 | USE ftu_definitions.ftu_array_types.all;
|
|---|
| 28 | USE ftu_definitions.ftu_constants.all;
|
|---|
| 29 |
|
|---|
| 30 | ---- Uncomment the following library declaration if instantiating
|
|---|
| 31 | ---- any Xilinx primitives in this code.
|
|---|
| 32 | --library UNISIM;
|
|---|
| 33 | --use UNISIM.VComponents.all;
|
|---|
| 34 |
|
|---|
| 35 | entity FTU_control is
|
|---|
| 36 | port(
|
|---|
| 37 | clk_50MHz : IN std_logic;
|
|---|
| 38 | clk_ready : IN std_logic; -- from DCM
|
|---|
| 39 | config_started : IN std_logic; -- from DAC/SPI
|
|---|
| 40 | config_ready : IN std_logic; -- from DAC/SPI
|
|---|
| 41 | ram_doa : IN STD_LOGIC_VECTOR(7 downto 0);
|
|---|
| 42 | ram_dob : IN STD_LOGIC_VECTOR(15 downto 0);
|
|---|
| 43 | rate_array : IN rate_array_type; -- from counters
|
|---|
| 44 | overflow_array : IN STD_LOGIC_VECTOR(7 downto 0); -- from counters
|
|---|
| 45 | new_rates : IN std_logic; -- from counters
|
|---|
| 46 | new_DACs : IN std_logic; -- from RS485 module
|
|---|
| 47 | new_enables : IN std_logic; -- from RS485 module
|
|---|
| 48 | new_prescaling : IN std_logic; -- from RS485 module
|
|---|
| 49 | read_rates : IN std_logic; -- from RS485 module
|
|---|
| 50 | read_DACs : IN std_logic; -- from RS485 module
|
|---|
| 51 | read_enables : IN std_logic; -- from RS485 module
|
|---|
| 52 | read_prescaling : IN std_logic; -- from RS485 module
|
|---|
| 53 | dac_array_rs485_out : IN dac_array_type; -- from RS485 module
|
|---|
| 54 | enable_array_rs485_out : IN enable_array_type; -- from RS485 module
|
|---|
| 55 | prescaling_rs485_out : IN STD_LOGIC_VECTOR(7 downto 0); -- from RS485 module
|
|---|
| 56 | reset : OUT std_logic;
|
|---|
| 57 | config_start : OUT std_logic;
|
|---|
| 58 | ram_ena : OUT std_logic;
|
|---|
| 59 | ram_enb : OUT std_logic;
|
|---|
| 60 | ram_wea : OUT STD_LOGIC_VECTOR(0 downto 0);
|
|---|
| 61 | ram_web : OUT STD_LOGIC_VECTOR(0 downto 0);
|
|---|
| 62 | ram_ada : OUT STD_LOGIC_VECTOR(4 downto 0);
|
|---|
| 63 | ram_adb : OUT STD_LOGIC_VECTOR(3 downto 0);
|
|---|
| 64 | ram_dia : OUT STD_LOGIC_VECTOR(7 downto 0);
|
|---|
| 65 | ram_dib : OUT STD_LOGIC_VECTOR(15 downto 0);
|
|---|
| 66 | rate_array_rs485 : OUT rate_array_type := (0,0,0,0,0); -- to RS485 module
|
|---|
| 67 | overflow_array_rs485_in : OUT STD_LOGIC_VECTOR(7 downto 0) := "00000000"; -- to RS485 module
|
|---|
| 68 | rates_ready : OUT std_logic := '0'; -- to RS485 module
|
|---|
| 69 | DACs_ready : OUT std_logic := '0'; -- to RS485 module
|
|---|
| 70 | enables_ready : OUT std_logic := '0'; -- to RS485 module
|
|---|
| 71 | prescaling_ready : OUT std_logic := '0'; -- to RS485 module
|
|---|
| 72 | dac_array : OUT dac_array_type;
|
|---|
| 73 | enable_array : OUT enable_array_type;
|
|---|
| 74 | cntr_reset : OUT STD_LOGIC;
|
|---|
| 75 | prescaling : OUT STD_LOGIC_VECTOR(7 downto 0)
|
|---|
| 76 | );
|
|---|
| 77 | end FTU_control;
|
|---|
| 78 |
|
|---|
| 79 | architecture Behavioral of FTU_control is
|
|---|
| 80 |
|
|---|
| 81 | signal reset_sig : STD_LOGIC := '0'; --initialize reset to 0 at power up
|
|---|
| 82 |
|
|---|
| 83 | --DAC/SPI interface, default DACs come from RAM during INIT
|
|---|
| 84 | signal config_start_sig : STD_LOGIC := '0';
|
|---|
| 85 | signal dac_array_sig : dac_array_type := (0,0,0,0,0,0,0,0);
|
|---|
| 86 |
|
|---|
| 87 | --enable signals for pixels in trigger, default values come from RAM during INIT
|
|---|
| 88 | signal enable_array_sig : enable_array_type := ("0000000000000000", --patch A
|
|---|
| 89 | "0000000000000000", --patch B
|
|---|
| 90 | "0000000000000000", --patch C
|
|---|
| 91 | "0000000000000000");--patch D
|
|---|
| 92 |
|
|---|
| 93 | signal rate_array_sig : rate_array_type; -- initialized in FTU_top
|
|---|
| 94 | signal cntr_reset_sig : STD_LOGIC := '0';
|
|---|
| 95 | signal prescaling_sig : STD_LOGIC_VECTOR(7 downto 0) := "00011101"; -- 29
|
|---|
| 96 |
|
|---|
| 97 | signal ram_ena_sig : STD_LOGIC := '0'; -- RAM enable for port A
|
|---|
| 98 | signal ram_enb_sig : STD_LOGIC := '0'; -- RAM enable for port B
|
|---|
| 99 | signal ram_wea_sig : STD_LOGIC_VECTOR(0 downto 0) := "0"; -- RAM write enable for port A
|
|---|
| 100 | signal ram_web_sig : STD_LOGIC_VECTOR(0 downto 0) := "0"; -- RAM write enable for port B
|
|---|
| 101 | signal ram_ada_sig : STD_LOGIC_VECTOR(4 downto 0) := (others => '0'); --RAM port A address
|
|---|
| 102 | signal ram_adb_sig : STD_LOGIC_VECTOR(3 downto 0) := (others => '0'); --RAM port B address
|
|---|
| 103 | signal ram_dia_sig : STD_LOGIC_VECTOR(7 downto 0) := (others => '0'); --RAM data in A
|
|---|
| 104 | signal ram_dib_sig : STD_LOGIC_VECTOR(15 downto 0) := (others => '0'); --RAM data in B
|
|---|
| 105 |
|
|---|
| 106 | --counter to loop through RAM
|
|---|
| 107 | signal ram_ada_cntr : INTEGER range 0 to 2**RAM_ADDR_WIDTH_A := 0;
|
|---|
| 108 | signal ram_dac_cntr : INTEGER range 0 to (NO_OF_DAC - NO_OF_DAC_NOT_USED + 2) := 0;
|
|---|
| 109 | signal ram_enable_cntr : INTEGER range 0 to (NO_OF_ENABLE + 1) := 0;
|
|---|
| 110 | signal ram_counter_cntr : INTEGER range 0 to (NO_OF_COUNTER + 2) := 0; --includes overflow register
|
|---|
| 111 |
|
|---|
| 112 | signal wait_cntr : INTEGER range 0 to 2**RAM_ADDR_WIDTH_A := 0;
|
|---|
| 113 |
|
|---|
| 114 | signal new_rates_sig : STD_LOGIC := '0';
|
|---|
| 115 | signal new_rates_busy : STD_LOGIC := '0';
|
|---|
| 116 |
|
|---|
| 117 | signal new_DACs_in_RAM : STD_LOGIC := '0';
|
|---|
| 118 | signal new_enables_in_RAM : STD_LOGIC := '0';
|
|---|
| 119 | signal new_prescaling_in_RAM : STD_LOGIC := '0';
|
|---|
| 120 |
|
|---|
| 121 | type FTU_control_StateType is (IDLE, INIT, RUNNING,
|
|---|
| 122 | CONFIG_ENABLE, CONFIG_DAC, CONFIG_COUNTER,
|
|---|
| 123 | WRITE_RATES, WRITE_DAC, WRITE_ENABLE, WRITE_PRESCALING,
|
|---|
| 124 | READOUT_RATES, READOUT_DAC, READOUT_ENABLE, READOUT_PRESCALING);
|
|---|
| 125 | signal FTU_control_State : FTU_control_StateType;
|
|---|
| 126 |
|
|---|
| 127 | begin
|
|---|
| 128 |
|
|---|
| 129 | --FTU control finite state machine
|
|---|
| 130 |
|
|---|
| 131 | FTU_control_FSM: process (clk_50MHz)
|
|---|
| 132 |
|
|---|
| 133 | begin
|
|---|
| 134 |
|
|---|
| 135 | reset_sig <= '0';
|
|---|
| 136 |
|
|---|
| 137 | if Rising_edge(clk_50MHz) then
|
|---|
| 138 |
|
|---|
| 139 | case FTU_control_State is
|
|---|
| 140 |
|
|---|
| 141 | when IDLE => -- wait for DCMs to lock
|
|---|
| 142 | config_start_sig <= '0';
|
|---|
| 143 | ram_ena_sig <= '0';
|
|---|
| 144 | ram_wea_sig <= "0";
|
|---|
| 145 | if (clk_ready = '1') then
|
|---|
| 146 | FTU_control_State <= INIT;
|
|---|
| 147 | else
|
|---|
| 148 | FTU_control_State <= IDLE;
|
|---|
| 149 | end if;
|
|---|
| 150 |
|
|---|
| 151 | when INIT => -- load default config data to RAM, see also ftu_definitions.vhd for more info
|
|---|
| 152 | new_rates_busy <= '1';
|
|---|
| 153 | config_start_sig <= '0';
|
|---|
| 154 | ram_ena_sig <= '1';
|
|---|
| 155 | ram_wea_sig <= "1";
|
|---|
| 156 | ram_ada_cntr <= ram_ada_cntr + 1;
|
|---|
| 157 | ram_ada_sig <= conv_std_logic_vector(ram_ada_cntr, RAM_ADDR_WIDTH_A);
|
|---|
| 158 | if (ram_ada_cntr < NO_OF_ENABLE*RAM_ADDR_RATIO) then -- default enables
|
|---|
| 159 | if (ram_ada_cntr mod 2 = 0) then
|
|---|
| 160 | ram_dia_sig <= DEFAULT_ENABLE(ram_ada_cntr / 2)(7 downto 0);
|
|---|
| 161 | else
|
|---|
| 162 | ram_dia_sig <= DEFAULT_ENABLE(ram_ada_cntr / 2)(15 downto 8);
|
|---|
| 163 | end if;
|
|---|
| 164 | FTU_control_State <= INIT;
|
|---|
| 165 | elsif (ram_ada_cntr < (NO_OF_ENABLE*RAM_ADDR_RATIO + NO_OF_COUNTER*RAM_ADDR_RATIO)) then -- default counter values
|
|---|
| 166 | ram_dia_sig <= (others => '0');
|
|---|
| 167 | FTU_control_State <= INIT;
|
|---|
| 168 | elsif (ram_ada_cntr < (NO_OF_ENABLE*RAM_ADDR_RATIO + NO_OF_COUNTER*RAM_ADDR_RATIO + (NO_OF_DAC - NO_OF_DAC_NOT_USED)*RAM_ADDR_RATIO)) then -- default DACs
|
|---|
| 169 | if (ram_ada_cntr < (NO_OF_ENABLE*RAM_ADDR_RATIO + NO_OF_COUNTER*RAM_ADDR_RATIO + (NO_OF_DAC - NO_OF_DAC_NOT_USED - 1)*RAM_ADDR_RATIO)) then
|
|---|
| 170 | if (ram_ada_cntr mod 2 = 0) then
|
|---|
| 171 | ram_dia_sig <= conv_std_logic_vector(DEFAULT_DAC((ram_ada_cntr - (NO_OF_ENABLE*RAM_ADDR_RATIO + NO_OF_COUNTER*RAM_ADDR_RATIO)) / 2),16)(7 downto 0);
|
|---|
| 172 | else
|
|---|
| 173 | ram_dia_sig <= conv_std_logic_vector(DEFAULT_DAC((ram_ada_cntr - (NO_OF_ENABLE*RAM_ADDR_RATIO + NO_OF_COUNTER*RAM_ADDR_RATIO)) / 2),16)(15 downto 8);
|
|---|
| 174 | end if;
|
|---|
| 175 | else
|
|---|
| 176 | if (ram_ada_cntr mod 2 = 0) then
|
|---|
| 177 | ram_dia_sig <= conv_std_logic_vector(DEFAULT_DAC(((ram_ada_cntr - (NO_OF_ENABLE*RAM_ADDR_RATIO + NO_OF_COUNTER*RAM_ADDR_RATIO)) / 2) + NO_OF_DAC_NOT_USED),16)(7 downto 0);
|
|---|
| 178 | else
|
|---|
| 179 | ram_dia_sig <= conv_std_logic_vector(DEFAULT_DAC(((ram_ada_cntr - (NO_OF_ENABLE*RAM_ADDR_RATIO + NO_OF_COUNTER*RAM_ADDR_RATIO)) / 2) + NO_OF_DAC_NOT_USED),16)(15 downto 8);
|
|---|
| 180 | end if;
|
|---|
| 181 | end if;
|
|---|
| 182 | FTU_control_State <= INIT;
|
|---|
| 183 | elsif (ram_ada_cntr = (NO_OF_ENABLE*RAM_ADDR_RATIO + NO_OF_COUNTER*RAM_ADDR_RATIO + (NO_OF_DAC - NO_OF_DAC_NOT_USED)*RAM_ADDR_RATIO)) then -- default prescaling
|
|---|
| 184 | ram_dia_sig <= conv_std_logic_vector(DEFAULT_PRESCALING,8);
|
|---|
| 185 | FTU_control_State <= INIT;
|
|---|
| 186 | elsif (ram_ada_cntr = (NO_OF_ENABLE*RAM_ADDR_RATIO + NO_OF_COUNTER*RAM_ADDR_RATIO + (NO_OF_DAC - NO_OF_DAC_NOT_USED)*RAM_ADDR_RATIO) + 1) then -- default overflow register
|
|---|
| 187 | ram_dia_sig <= (others => '0');
|
|---|
| 188 | FTU_control_State <= INIT;
|
|---|
| 189 | elsif (ram_ada_cntr = (NO_OF_ENABLE*RAM_ADDR_RATIO + NO_OF_COUNTER*RAM_ADDR_RATIO + (NO_OF_DAC - NO_OF_DAC_NOT_USED)*RAM_ADDR_RATIO) + 2) then -- default checksum
|
|---|
| 190 | ram_dia_sig <= (others => '0');
|
|---|
| 191 | FTU_control_State <= INIT;
|
|---|
| 192 | elsif (ram_ada_cntr = (NO_OF_ENABLE*RAM_ADDR_RATIO + NO_OF_COUNTER*RAM_ADDR_RATIO + (NO_OF_DAC - NO_OF_DAC_NOT_USED)*RAM_ADDR_RATIO) + 3) then -- empty RAM cell
|
|---|
| 193 | ram_dia_sig <= (others => '0');
|
|---|
| 194 | FTU_control_State <= INIT;
|
|---|
| 195 | else
|
|---|
| 196 | ram_dia_sig <= (others => '0');
|
|---|
| 197 | ram_ada_cntr <= 0;
|
|---|
| 198 | ram_ada_sig <= (others => '0');
|
|---|
| 199 | ram_ena_sig <= '0';
|
|---|
| 200 | ram_wea_sig <= "0";
|
|---|
| 201 | new_DACs_in_RAM <= '1';
|
|---|
| 202 | new_enables_in_RAM <= '1';
|
|---|
| 203 | new_prescaling_in_RAM <= '1';
|
|---|
| 204 | cntr_reset_sig <= '1';
|
|---|
| 205 | new_rates_busy <= '0';
|
|---|
| 206 | FTU_control_State <= RUNNING;
|
|---|
| 207 | end if;
|
|---|
| 208 |
|
|---|
| 209 | when RUNNING => -- count triggers and react to commands from FTM
|
|---|
| 210 | cntr_reset_sig <= '0';
|
|---|
| 211 | config_start_sig <= '0';
|
|---|
| 212 | if (new_rates_sig = '1') then -- counters have finished a period
|
|---|
| 213 | FTU_control_State <= WRITE_RATES;
|
|---|
| 214 | else -- update FTU settings if necessary
|
|---|
| 215 | if (new_DACs_in_RAM = '1') then
|
|---|
| 216 | ram_enb_sig <= '1';
|
|---|
| 217 | ram_adb_sig <= conv_std_logic_vector((NO_OF_ENABLE + NO_OF_COUNTER), RAM_ADDR_WIDTH_B);
|
|---|
| 218 | FTU_control_State <= CONFIG_DAC;
|
|---|
| 219 | elsif (new_DACs_in_RAM = '0' and new_enables_in_RAM = '1') then
|
|---|
| 220 | ram_enb_sig <= '1';
|
|---|
| 221 | ram_adb_sig <= conv_std_logic_vector(0, RAM_ADDR_WIDTH_B);
|
|---|
| 222 | FTU_control_State <= CONFIG_ENABLE;
|
|---|
| 223 | elsif (new_DACs_in_RAM = '0' and new_enables_in_RAM = '0' and new_prescaling_in_RAM = '1') then
|
|---|
| 224 | ram_ena_sig <= '1';
|
|---|
| 225 | ram_ada_sig <= conv_std_logic_vector((NO_OF_ENABLE*RAM_ADDR_RATIO + NO_OF_COUNTER*RAM_ADDR_RATIO + (NO_OF_DAC - NO_OF_DAC_NOT_USED)*RAM_ADDR_RATIO), RAM_ADDR_WIDTH_A);
|
|---|
| 226 | FTU_control_State <= CONFIG_COUNTER;
|
|---|
| 227 | else -- nothing to be updated, check new commands from RS485
|
|---|
| 228 | if (new_DACs = '1') then
|
|---|
| 229 | FTU_control_State <= WRITE_DAC;
|
|---|
| 230 | elsif (new_DACs = '0' and new_enables = '1') then
|
|---|
| 231 | FTU_control_State <= WRITE_ENABLE;
|
|---|
| 232 | elsif (new_DACs = '0' and new_enables = '0' and new_prescaling = '1') then
|
|---|
| 233 | FTU_control_State <= WRITE_PRESCALING;
|
|---|
| 234 | elsif (new_DACs = '0' and new_enables = '0' and new_prescaling = '0' and
|
|---|
| 235 | read_rates = '1') then
|
|---|
| 236 | ram_enb_sig <= '1';
|
|---|
| 237 | ram_adb_sig <= conv_std_logic_vector(NO_OF_ENABLE, RAM_ADDR_WIDTH_B);
|
|---|
| 238 | FTU_control_State <= READOUT_RATES;
|
|---|
| 239 | elsif (new_DACs = '0' and new_enables = '0' and new_prescaling = '0' and
|
|---|
| 240 | read_rates = '0' and read_DACs = '1') then
|
|---|
| 241 | ram_enb_sig <= '1';
|
|---|
| 242 | ram_adb_sig <= conv_std_logic_vector(NO_OF_ENABLE + NO_OF_COUNTER, RAM_ADDR_WIDTH_B);
|
|---|
| 243 | FTU_control_State <= READOUT_DAC;
|
|---|
| 244 | elsif (new_DACs = '0' and new_enables = '0' and new_prescaling = '0' and
|
|---|
| 245 | read_rates = '0' and read_DACs = '0' and read_enables = '1') then
|
|---|
| 246 | ram_enb_sig <= '1';
|
|---|
| 247 | ram_adb_sig <= conv_std_logic_vector(0, RAM_ADDR_WIDTH_B);
|
|---|
| 248 | FTU_control_State <= READOUT_ENABLE;
|
|---|
| 249 | elsif (new_DACs = '0' and new_enables = '0' and new_prescaling = '0' and
|
|---|
| 250 | read_rates = '0' and read_DACs = '0' and read_enables = '0' and read_prescaling = '1') then
|
|---|
| 251 | ram_ena_sig <= '1';
|
|---|
| 252 | ram_ada_sig <= conv_std_logic_vector((NO_OF_ENABLE*RAM_ADDR_RATIO + NO_OF_COUNTER*RAM_ADDR_RATIO + (NO_OF_DAC - NO_OF_DAC_NOT_USED)*RAM_ADDR_RATIO), RAM_ADDR_WIDTH_A);
|
|---|
| 253 | FTU_control_State <= READOUT_PRESCALING;
|
|---|
| 254 | else
|
|---|
| 255 | FTU_control_State <= RUNNING; --no commands from RS485 -> stay running
|
|---|
| 256 | end if;
|
|---|
| 257 | end if;
|
|---|
| 258 | end if;
|
|---|
| 259 |
|
|---|
| 260 | when CONFIG_COUNTER =>
|
|---|
| 261 | wait_cntr <= wait_cntr + 1;
|
|---|
| 262 | new_rates_busy <= '1';
|
|---|
| 263 | if (wait_cntr = 0) then
|
|---|
| 264 | FTU_control_State <= CONFIG_COUNTER;
|
|---|
| 265 | elsif (wait_cntr = 1) then
|
|---|
| 266 | prescaling_sig <= ram_doa;
|
|---|
| 267 | FTU_control_State <= CONFIG_COUNTER;
|
|---|
| 268 | prescaling_ready <= '1';
|
|---|
| 269 | else
|
|---|
| 270 | cntr_reset_sig <= '1';
|
|---|
| 271 | ram_ada_sig <= (others => '0');
|
|---|
| 272 | wait_cntr <= 0;
|
|---|
| 273 | new_prescaling_in_RAM <= '0';
|
|---|
| 274 | ram_ena_sig <= '0';
|
|---|
| 275 | new_rates_busy <= '0';
|
|---|
| 276 | prescaling_ready <= '0';
|
|---|
| 277 | FTU_control_State <= RUNNING;
|
|---|
| 278 | end if;
|
|---|
| 279 |
|
|---|
| 280 | when CONFIG_ENABLE =>
|
|---|
| 281 | ram_enable_cntr <= ram_enable_cntr + 1;
|
|---|
| 282 | new_rates_busy <= '1';
|
|---|
| 283 | if (ram_enable_cntr = 0) then
|
|---|
| 284 | ram_adb_sig <= conv_std_logic_vector(ram_enable_cntr + 1, RAM_ADDR_WIDTH_B);
|
|---|
| 285 | FTU_control_State <= CONFIG_ENABLE;
|
|---|
| 286 | elsif (ram_enable_cntr > 0 and ram_enable_cntr < NO_OF_ENABLE + 1) then
|
|---|
| 287 | ram_adb_sig <= conv_std_logic_vector(ram_enable_cntr + 1, RAM_ADDR_WIDTH_B);
|
|---|
| 288 | enable_array_sig(ram_enable_cntr - 1) <= ram_dob;
|
|---|
| 289 | enables_ready <= '1';
|
|---|
| 290 | FTU_control_State <= CONFIG_ENABLE;
|
|---|
| 291 | else
|
|---|
| 292 | ram_adb_sig <= (others => '0');
|
|---|
| 293 | ram_enable_cntr <= 0;
|
|---|
| 294 | new_enables_in_RAM <= '0';
|
|---|
| 295 | ram_enb_sig <= '0';
|
|---|
| 296 | cntr_reset_sig <= '1';
|
|---|
| 297 | new_rates_busy <= '0';
|
|---|
| 298 | enables_ready <= '0';
|
|---|
| 299 | FTU_control_State <= RUNNING;
|
|---|
| 300 | end if;
|
|---|
| 301 |
|
|---|
| 302 | when CONFIG_DAC =>
|
|---|
| 303 | new_rates_busy <= '1';
|
|---|
| 304 | if (ram_dac_cntr <= (NO_OF_DAC - NO_OF_DAC_NOT_USED + 2)) then
|
|---|
| 305 | ram_dac_cntr <= ram_dac_cntr + 1;
|
|---|
| 306 | if (ram_dac_cntr = 0) then
|
|---|
| 307 | FTU_control_State <= CONFIG_DAC;
|
|---|
| 308 | ram_adb_sig <= conv_std_logic_vector((NO_OF_ENABLE + NO_OF_COUNTER + ram_dac_cntr + 1), RAM_ADDR_WIDTH_B);
|
|---|
| 309 | elsif (ram_dac_cntr > 0 and ram_dac_cntr < (NO_OF_DAC - NO_OF_DAC_NOT_USED)) then
|
|---|
| 310 | dac_array_sig(ram_dac_cntr - 1) <= conv_integer(unsigned(ram_dob(11 downto 0)));
|
|---|
| 311 | ram_adb_sig <= conv_std_logic_vector((NO_OF_ENABLE + NO_OF_COUNTER + ram_dac_cntr + 1), RAM_ADDR_WIDTH_B);
|
|---|
| 312 | FTU_control_State <= CONFIG_DAC;
|
|---|
| 313 | elsif (ram_dac_cntr > 0 and ram_dac_cntr < (NO_OF_DAC - NO_OF_DAC_NOT_USED + 1)) then
|
|---|
| 314 | dac_array_sig(ram_dac_cntr - 1 + NO_OF_DAC_NOT_USED) <= conv_integer(unsigned(ram_dob(11 downto 0)));
|
|---|
| 315 | ram_adb_sig <= (others => '0');
|
|---|
| 316 | FTU_control_State <= CONFIG_DAC;
|
|---|
| 317 | DACs_ready <= '1';
|
|---|
| 318 | else
|
|---|
| 319 | ram_adb_sig <= (others => '0');
|
|---|
| 320 | config_start_sig <= '1';
|
|---|
| 321 | DACs_ready <= '0';
|
|---|
| 322 | FTU_control_State <= CONFIG_DAC;
|
|---|
| 323 | end if;
|
|---|
| 324 | else
|
|---|
| 325 | if (config_ready = '1') then
|
|---|
| 326 | ram_dac_cntr <= 0;
|
|---|
| 327 | new_DACs_in_RAM <= '0';
|
|---|
| 328 | cntr_reset_sig <= '1';
|
|---|
| 329 | new_rates_busy <= '0';
|
|---|
| 330 | FTU_control_State <= RUNNING;
|
|---|
| 331 | elsif (config_ready = '0' and config_started = '1') then
|
|---|
| 332 | ram_enb_sig <= '0';
|
|---|
| 333 | config_start_sig <= '0';
|
|---|
| 334 | FTU_control_State <= CONFIG_DAC;
|
|---|
| 335 | else
|
|---|
| 336 | FTU_control_State <= CONFIG_DAC;
|
|---|
| 337 | end if;
|
|---|
| 338 | end if;
|
|---|
| 339 |
|
|---|
| 340 | when WRITE_RATES => -- write trigger/patch rates to RAM B and overflow register to RAM A
|
|---|
| 341 | new_rates_busy <= '1';
|
|---|
| 342 | ram_counter_cntr <= ram_counter_cntr + 1;
|
|---|
| 343 | if (ram_counter_cntr < NO_OF_COUNTER) then
|
|---|
| 344 | ram_enb_sig <= '1';
|
|---|
| 345 | ram_web_sig <= "1";
|
|---|
| 346 | ram_adb_sig <= conv_std_logic_vector((NO_OF_ENABLE + ram_counter_cntr), RAM_ADDR_WIDTH_B);
|
|---|
| 347 | ram_dib_sig <= conv_std_logic_vector(rate_array_sig(ram_counter_cntr), 16);
|
|---|
| 348 | FTU_control_State <= WRITE_RATES;
|
|---|
| 349 | elsif (ram_counter_cntr = NO_Of_COUNTER) then
|
|---|
| 350 | ram_dib_sig <= (others => '0');
|
|---|
| 351 | ram_adb_sig <= (others => '0');
|
|---|
| 352 | ram_enb_sig <= '0';
|
|---|
| 353 | ram_web_sig <= "0";
|
|---|
| 354 | ram_ena_sig <= '1';
|
|---|
| 355 | ram_wea_sig <= "1";
|
|---|
| 356 | ram_ada_sig <= conv_std_logic_vector(NO_OF_ENABLE*RAM_ADDR_RATIO + NO_OF_COUNTER*RAM_ADDR_RATIO + (NO_OF_DAC - NO_OF_DAC_NOT_USED)*RAM_ADDR_RATIO + 1, RAM_ADDR_WIDTH_A);
|
|---|
| 357 | ram_dia_sig <= overflow_array;
|
|---|
| 358 | FTU_control_State <= WRITE_RATES;
|
|---|
| 359 | else
|
|---|
| 360 | ram_ena_sig <= '0';
|
|---|
| 361 | ram_wea_sig <= "0";
|
|---|
| 362 | ram_counter_cntr <= 0;
|
|---|
| 363 | new_rates_busy <= '0';
|
|---|
| 364 | FTU_control_State <= RUNNING;
|
|---|
| 365 | end if;
|
|---|
| 366 |
|
|---|
| 367 | when WRITE_DAC => -- write new DAC values from RS485 to RAM
|
|---|
| 368 | ram_dac_cntr <= ram_dac_cntr + 1;
|
|---|
| 369 | if (ram_dac_cntr < (NO_OF_DAC - NO_OF_DAC_NOT_USED - 1)) then
|
|---|
| 370 | ram_enb_sig <= '1';
|
|---|
| 371 | ram_web_sig <= "1";
|
|---|
| 372 | ram_adb_sig <= conv_std_logic_vector((NO_OF_ENABLE + NO_OF_COUNTER + ram_dac_cntr), RAM_ADDR_WIDTH_B);
|
|---|
| 373 | ram_dib_sig <= conv_std_logic_vector(dac_array_rs485_out(ram_dac_cntr), 16);
|
|---|
| 374 | FTU_control_State <= WRITE_DAC;
|
|---|
| 375 | elsif (ram_dac_cntr = (NO_OF_DAC - NO_OF_DAC_NOT_USED - 1)) then
|
|---|
| 376 | ram_enb_sig <= '1';
|
|---|
| 377 | ram_web_sig <= "1";
|
|---|
| 378 | ram_adb_sig <= conv_std_logic_vector((NO_OF_ENABLE + NO_OF_COUNTER + ram_dac_cntr), RAM_ADDR_WIDTH_B);
|
|---|
| 379 | ram_dib_sig <= conv_std_logic_vector(dac_array_rs485_out(ram_dac_cntr + NO_OF_DAC_NOT_USED), 16);
|
|---|
| 380 | FTU_control_State <= WRITE_DAC;
|
|---|
| 381 | else
|
|---|
| 382 | ram_enb_sig <= '0';
|
|---|
| 383 | ram_web_sig <= "0";
|
|---|
| 384 | new_DACs_in_RAM <= '1';
|
|---|
| 385 | ram_dib_sig <= (others => '0');
|
|---|
| 386 | ram_adb_sig <= (others => '0');
|
|---|
| 387 | ram_dac_cntr <= 0;
|
|---|
| 388 | FTU_control_State <= RUNNING;
|
|---|
| 389 | end if;
|
|---|
| 390 |
|
|---|
| 391 | when WRITE_ENABLE => -- write new enable patterns from RS485 to RAM
|
|---|
| 392 | ram_enable_cntr <= ram_enable_cntr + 1;
|
|---|
| 393 | if (ram_enable_cntr < NO_OF_ENABLE) then
|
|---|
| 394 | ram_enb_sig <= '1';
|
|---|
| 395 | ram_web_sig <= "1";
|
|---|
| 396 | ram_adb_sig <= conv_std_logic_vector(ram_enable_cntr, RAM_ADDR_WIDTH_B);
|
|---|
| 397 | ram_dib_sig <= enable_array_rs485_out(ram_enable_cntr);
|
|---|
| 398 | else
|
|---|
| 399 | ram_enb_sig <= '0';
|
|---|
| 400 | ram_web_sig <= "0";
|
|---|
| 401 | new_enables_in_RAM <= '1';
|
|---|
| 402 | ram_dib_sig <= (others => '0');
|
|---|
| 403 | ram_adb_sig <= (others => '0');
|
|---|
| 404 | ram_enable_cntr <= 0;
|
|---|
| 405 | FTU_control_State <= RUNNING;
|
|---|
| 406 | end if;
|
|---|
| 407 |
|
|---|
| 408 | when WRITE_PRESCALING => -- write new prescaling from RS485 to RAM
|
|---|
| 409 | wait_cntr <= wait_cntr + 1;
|
|---|
| 410 | if (wait_cntr = 0) then
|
|---|
| 411 | ram_ena_sig <= '1';
|
|---|
| 412 | ram_wea_sig <= "1";
|
|---|
| 413 | ram_ada_sig <= conv_std_logic_vector((NO_OF_ENABLE*RAM_ADDR_RATIO + NO_OF_COUNTER*RAM_ADDR_RATIO + (NO_OF_DAC - NO_OF_DAC_NOT_USED)*RAM_ADDR_RATIO), RAM_ADDR_WIDTH_A);
|
|---|
| 414 | ram_dia_sig <= prescaling_rs485_out;
|
|---|
| 415 | else
|
|---|
| 416 | ram_ena_sig <= '0';
|
|---|
| 417 | ram_wea_sig <= "0";
|
|---|
| 418 | new_prescaling_in_RAM <= '1';
|
|---|
| 419 | ram_dia_sig <= (others => '0');
|
|---|
| 420 | ram_ada_sig <= (others => '0');
|
|---|
| 421 | wait_cntr <= 0;
|
|---|
| 422 | FTU_control_State <= RUNNING;
|
|---|
| 423 | end if;
|
|---|
| 424 |
|
|---|
| 425 | when READOUT_RATES => -- read most recent rate values from RAM and send them to RS485 module
|
|---|
| 426 | ram_counter_cntr <= ram_counter_cntr + 1;
|
|---|
| 427 | if (ram_counter_cntr = 0) then
|
|---|
| 428 | ram_enb_sig <= '1';
|
|---|
| 429 | ram_adb_sig <= conv_std_logic_vector((NO_OF_ENABLE + ram_counter_cntr + 1), RAM_ADDR_WIDTH_B);
|
|---|
| 430 | FTU_control_State <= READOUT_RATES;
|
|---|
| 431 | elsif (ram_counter_cntr < NO_OF_COUNTER) then
|
|---|
| 432 | ram_ena_sig <= '1';
|
|---|
| 433 | ram_ada_sig <= conv_std_logic_vector(((NO_OF_ENABLE + NO_OF_COUNTER + NO_OF_DAC - NO_OF_DAC_NOT_USED)*RAM_ADDR_RATIO + 1), RAM_ADDR_WIDTH_A);
|
|---|
| 434 | ram_enb_sig <= '1';
|
|---|
| 435 | ram_adb_sig <= conv_std_logic_vector((NO_OF_ENABLE + ram_counter_cntr + 1), RAM_ADDR_WIDTH_B);
|
|---|
| 436 | rate_array_rs485(ram_counter_cntr - 1) <= conv_integer(unsigned(ram_dob));
|
|---|
| 437 | FTU_control_State <= READOUT_RATES;
|
|---|
| 438 | elsif (ram_counter_cntr = NO_Of_COUNTER) then
|
|---|
| 439 | ram_enb_sig <= '0';
|
|---|
| 440 | ram_adb_sig <= (others => '0');
|
|---|
| 441 | rate_array_rs485(ram_counter_cntr - 1) <= conv_integer(unsigned(ram_dob));
|
|---|
| 442 | ram_ena_sig <= '1';
|
|---|
| 443 | ram_ada_sig <= conv_std_logic_vector(((NO_OF_ENABLE + NO_OF_COUNTER + NO_OF_DAC - NO_OF_DAC_NOT_USED)*RAM_ADDR_RATIO + 1), RAM_ADDR_WIDTH_A);
|
|---|
| 444 | FTU_control_State <= READOUT_RATES;
|
|---|
| 445 | elsif (ram_counter_cntr = NO_Of_COUNTER + 1) then
|
|---|
| 446 | ram_enb_sig <= '0';
|
|---|
| 447 | ram_adb_sig <= (others => '0');
|
|---|
| 448 | ram_ena_sig <= '0';
|
|---|
| 449 | ram_ada_sig <= (others => '0');
|
|---|
| 450 | overflow_array_rs485_in <= ram_doa;
|
|---|
| 451 | rates_ready <= '1';
|
|---|
| 452 | FTU_control_State <= READOUT_RATES;
|
|---|
| 453 | else
|
|---|
| 454 | ram_enb_sig <= '0';
|
|---|
| 455 | ram_adb_sig <= (others => '0');
|
|---|
| 456 | ram_ena_sig <= '0';
|
|---|
| 457 | ram_ada_sig <= (others => '0');
|
|---|
| 458 | ram_counter_cntr <= 0;
|
|---|
| 459 | rates_ready <= '0';
|
|---|
| 460 | FTU_control_State <= RUNNING;
|
|---|
| 461 | end if;
|
|---|
| 462 |
|
|---|
| 463 | when READOUT_DAC => -- read most recent DAC values from RAM and send them to RS485 module
|
|---|
| 464 | ram_dac_cntr <= ram_dac_cntr + 1;
|
|---|
| 465 | if (ram_dac_cntr = 0) then
|
|---|
| 466 | ram_enb_sig <= '1';
|
|---|
| 467 | ram_adb_sig <= conv_std_logic_vector((NO_OF_ENABLE + NO_OF_COUNTER + ram_dac_cntr + 1), RAM_ADDR_WIDTH_B);
|
|---|
| 468 | FTU_control_State <= READOUT_DAC;
|
|---|
| 469 | elsif (ram_dac_cntr < (NO_OF_DAC - NO_OF_DAC_NOT_USED)) then
|
|---|
| 470 | ram_enb_sig <= '1';
|
|---|
| 471 | ram_adb_sig <= conv_std_logic_vector((NO_OF_ENABLE + NO_OF_COUNTER + ram_dac_cntr + 1), RAM_ADDR_WIDTH_B);
|
|---|
| 472 | dac_array_sig(ram_dac_cntr - 1) <= conv_integer(unsigned(ram_dob(11 downto 0)));
|
|---|
| 473 | FTU_control_State <= READOUT_DAC;
|
|---|
| 474 | elsif (ram_dac_cntr = (NO_OF_DAC - NO_OF_DAC_NOT_USED)) then
|
|---|
| 475 | ram_enb_sig <= '0';
|
|---|
| 476 | ram_adb_sig <= (others => '0');
|
|---|
| 477 | dac_array_sig(ram_dac_cntr + NO_OF_DAC_NOT_USED - 1) <= conv_integer(unsigned(ram_dob(11 downto 0)));
|
|---|
| 478 | DACs_ready <= '1';
|
|---|
| 479 | FTU_control_State <= READOUT_DAC;
|
|---|
| 480 | else
|
|---|
| 481 | ram_enb_sig <= '0';
|
|---|
| 482 | ram_adb_sig <= (others => '0');
|
|---|
| 483 | DACs_ready <= '0';
|
|---|
| 484 | ram_dac_cntr <= 0;
|
|---|
| 485 | FTU_control_State <= RUNNING;
|
|---|
| 486 | end if;
|
|---|
| 487 |
|
|---|
| 488 | when READOUT_ENABLE => -- read most recent enable patterns from RAM and send them to RS485 module
|
|---|
| 489 | ram_enable_cntr <= ram_enable_cntr + 1;
|
|---|
| 490 | if (ram_enable_cntr = 0) then
|
|---|
| 491 | ram_enb_sig <= '1';
|
|---|
| 492 | ram_adb_sig <= conv_std_logic_vector((ram_enable_cntr + 1), RAM_ADDR_WIDTH_B);
|
|---|
| 493 | FTU_control_State <= READOUT_ENABLE;
|
|---|
| 494 | elsif (ram_enable_cntr < NO_OF_ENABLE) then
|
|---|
| 495 | ram_enb_sig <= '1';
|
|---|
| 496 | ram_adb_sig <= conv_std_logic_vector((ram_enable_cntr + 1), RAM_ADDR_WIDTH_B);
|
|---|
| 497 | enable_array_sig(ram_enable_cntr - 1) <= ram_dob;
|
|---|
| 498 | FTU_control_State <= READOUT_ENABLE;
|
|---|
| 499 | elsif (ram_enable_cntr = NO_OF_ENABLE) then
|
|---|
| 500 | ram_enb_sig <= '0';
|
|---|
| 501 | ram_adb_sig <= (others => '0');
|
|---|
| 502 | enable_array_sig(ram_enable_cntr - 1) <= ram_dob;
|
|---|
| 503 | enables_ready <= '1';
|
|---|
| 504 | FTU_control_State <= READOUT_ENABLE;
|
|---|
| 505 | else
|
|---|
| 506 | ram_enb_sig <= '0';
|
|---|
| 507 | ram_adb_sig <= (others => '0');
|
|---|
| 508 | enables_ready <= '0';
|
|---|
| 509 | ram_enable_cntr <= 0;
|
|---|
| 510 | FTU_control_State <= RUNNING;
|
|---|
| 511 | end if;
|
|---|
| 512 |
|
|---|
| 513 | when READOUT_PRESCALING => -- read most recent prescaling value from RAM and send it to RS485 module
|
|---|
| 514 | wait_cntr <= wait_cntr + 1;
|
|---|
| 515 | if (wait_cntr = 0) then
|
|---|
| 516 | ram_ena_sig <= '1';
|
|---|
| 517 | ram_ada_sig <= conv_std_logic_vector((NO_OF_ENABLE*RAM_ADDR_RATIO + NO_OF_COUNTER*RAM_ADDR_RATIO + (NO_OF_DAC - NO_OF_DAC_NOT_USED)*RAM_ADDR_RATIO) + 1, RAM_ADDR_WIDTH_A);
|
|---|
| 518 | FTU_control_State <= READOUT_PRESCALING;
|
|---|
| 519 | elsif (wait_cntr = 1) then
|
|---|
| 520 | ram_ena_sig <= '1';
|
|---|
| 521 | ram_ada_sig <= (others => '0');
|
|---|
| 522 | prescaling_sig <= ram_doa;
|
|---|
| 523 | FTU_control_State <= READOUT_PRESCALING;
|
|---|
| 524 | elsif (wait_cntr = 2) then
|
|---|
| 525 | ram_ena_sig <= '0';
|
|---|
| 526 | ram_ada_sig <= (others => '0');
|
|---|
| 527 | overflow_array_rs485_in <= ram_doa;
|
|---|
| 528 | prescaling_ready <= '1';
|
|---|
| 529 | FTU_control_State <= READOUT_PRESCALING;
|
|---|
| 530 | else
|
|---|
| 531 | ram_ena_sig <= '0';
|
|---|
| 532 | ram_ada_sig <= (others => '0');
|
|---|
| 533 | prescaling_ready <= '0';
|
|---|
| 534 | wait_cntr <= 0;
|
|---|
| 535 | FTU_control_State <= RUNNING;
|
|---|
| 536 | end if;
|
|---|
| 537 |
|
|---|
| 538 | end case;
|
|---|
| 539 | end if;
|
|---|
| 540 | end process FTU_control_FSM;
|
|---|
| 541 |
|
|---|
| 542 | detect_new_rates: process(new_rates, new_rates_busy)
|
|---|
| 543 | begin
|
|---|
| 544 | if(new_rates_busy = '1') then
|
|---|
| 545 | new_rates_sig <= '0';
|
|---|
| 546 | elsif rising_edge(new_rates) then
|
|---|
| 547 | new_rates_sig <= '1';
|
|---|
| 548 | end if;
|
|---|
| 549 | end process detect_new_rates;
|
|---|
| 550 |
|
|---|
| 551 | reset <= reset_sig;
|
|---|
| 552 |
|
|---|
| 553 | config_start <= config_start_sig;
|
|---|
| 554 | dac_array <= dac_array_sig;
|
|---|
| 555 |
|
|---|
| 556 | enable_array <= enable_array_sig;
|
|---|
| 557 | prescaling <= prescaling_sig;
|
|---|
| 558 |
|
|---|
| 559 | rate_array_sig <= rate_array;
|
|---|
| 560 | cntr_reset <= cntr_reset_sig;
|
|---|
| 561 |
|
|---|
| 562 | ram_ena <= ram_ena_sig;
|
|---|
| 563 | ram_enb <= ram_enb_sig;
|
|---|
| 564 | ram_wea <= ram_wea_sig;
|
|---|
| 565 | ram_web <= ram_web_sig;
|
|---|
| 566 | ram_ada <= ram_ada_sig;
|
|---|
| 567 | ram_adb <= ram_adb_sig;
|
|---|
| 568 | ram_dia <= ram_dia_sig;
|
|---|
| 569 | ram_dib <= ram_dib_sig;
|
|---|
| 570 |
|
|---|
| 571 | end Behavioral;
|
|---|