-library ieee;\r
-use ieee.std_logic_1164.all;\r
-use ieee.numeric_std.all;\r
-\r
-library work;\r
-use work.trb_net_std.all;\r
-use work.trb_net_components.all;\r
-use work.trb3_components.all;\r
-use work.version.all;\r
-\r
-library machxo2;\r
-use machxo2.all;\r
-\r
-\r
-entity panda_dirc_wasa is\r
- generic(\r
- PADIWA_FLAVOUR : integer := 2\r
- );\r
- port(\r
- CON : out std_logic_vector(16 downto 1);\r
- INP : in std_logic_vector(16 downto 1);\r
- PWM : out std_logic_vector(16 downto 1);\r
- SPARE_LINE : out std_logic_vector(3 downto 0);\r
- SPARE_LVDS : out std_logic;\r
- LED_GREEN : out std_logic;\r
- LED_ORANGE : out std_logic;\r
- LED_RED : out std_logic;\r
- LED_YELLOW : out std_logic;\r
- SPI_CLK : in std_logic;\r
- SPI_CS : in std_logic;\r
- SPI_IN : in std_logic;\r
- SPI_OUT : out std_logic;\r
- TEMP_LINE : inout std_logic;\r
- TEST_LINE : out std_logic_vector(15 downto 0)\r
- );\r
-end entity;\r
-\r
-architecture panda_dirc_wasa_arch of panda_dirc_wasa is\r
-\r
-component OSCH\r
--- synthesis translate_off\r
- generic (NOM_FREQ: string := "133.00");\r
--- synthesis translate_on\r
- port (\r
- STDBY :IN std_logic;\r
- OSC :OUT std_logic;\r
- SEDSTDBY :OUT std_logic\r
- );\r
-end component;\r
-\r
-component oddr16 is\r
- port (\r
- clk: in std_logic; \r
- clkout: out std_logic; \r
- reset: in std_logic; \r
- sclk: out std_logic; \r
- dataout: in std_logic_vector(31 downto 0); \r
- dout: out std_logic_vector(15 downto 0));\r
-end component;\r
-\r
-component spi_slave\r
- port(\r
- CLK : in std_logic;\r
- SPI_CLK : in std_logic;\r
- SPI_CS : in std_logic;\r
- SPI_IN : in std_logic;\r
- SPI_OUT : out std_logic;\r
- \r
- DATA_OUT : out std_logic_vector(15 downto 0);\r
- REG00_IN : in std_logic_vector(15 downto 0);\r
- REG10_IN : in std_logic_vector(15 downto 0);\r
- REG20_IN : in std_logic_vector(15 downto 0);\r
- REG40_IN : in std_logic_vector(15 downto 0);\r
- \r
- OPERATION_OUT : out std_logic_vector(3 downto 0);\r
- CHANNEL_OUT : out std_logic_vector(7 downto 0);\r
- WRITE_OUT : out std_logic_vector(15 downto 0);\r
-\r
- DEBUG_OUT : out std_logic_vector(15 downto 0)\r
- );\r
-end component;\r
-\r
-\r
-component pwm_generator\r
- port(\r
- CLK : in std_logic;\r
- DATA_IN : in std_logic_vector(15 downto 0);\r
- DATA_OUT : out std_logic_vector(15 downto 0);\r
- WRITE_IN : in std_logic;\r
- ADDR_IN : in std_logic_vector(3 downto 0);\r
- PWM : out std_logic_vector(31 downto 0)\r
- );\r
-end component;\r
-\r
-component flashram\r
- port (\r
- DataInA: in std_logic_vector(7 downto 0); \r
- DataInB: in std_logic_vector(7 downto 0); \r
- AddressA: in std_logic_vector(3 downto 0); \r
- AddressB: in std_logic_vector(3 downto 0); \r
- ClockA: in std_logic; \r
- ClockB: in std_logic; \r
- ClockEnA: in std_logic; \r
- ClockEnB: in std_logic; \r
- WrA: in std_logic; \r
- WrB: in std_logic; \r
- ResetA: in std_logic; \r
- ResetB: in std_logic; \r
- QA: out std_logic_vector(7 downto 0); \r
- QB: out std_logic_vector(7 downto 0)\r
- );\r
-end component;\r
-\r
-component pll\r
- port (\r
- CLKI: in std_logic; \r
- CLKOP: out std_logic; \r
- CLKOS: out std_logic; \r
- LOCK: out std_logic);\r
-end component;\r
-\r
-\r
-component UFM_WB\r
- port(\r
- clk_i : in std_logic;\r
- rst_n : in std_logic;\r
- cmd : in std_logic_vector(2 downto 0);\r
- ufm_page : in std_logic_vector(10 downto 0);\r
- GO : in std_logic;\r
- BUSY : out std_logic;\r
- ERR : out std_logic;\r
- mem_clk : out std_logic;\r
- mem_we : out std_logic;\r
- mem_ce : out std_logic;\r
- mem_addr : out std_logic_vector(3 downto 0);\r
- mem_wr_data : out std_logic_vector(7 downto 0);\r
- mem_rd_data : in std_logic_vector(7 downto 0)\r
- );\r
-end component;\r
-\r
-component PUR port(PUR : in std_logic); end component;\r
-component GSR port(GSR : in std_logic); end component;\r
- \r
-\r
-\r
-attribute NOM_FREQ : string;\r
-attribute NOM_FREQ of clk_source : label is "133.00";\r
-signal clk_i : std_logic;\r
-\r
-signal reset_i : std_logic := '1';\r
-signal reset_cnt : unsigned(3 downto 0) := x"0";\r
-signal id_data_i : std_logic_vector(15 downto 0);\r
-signal id_addr_i : std_logic_vector(2 downto 0);\r
-signal id_write_i: std_logic;\r
-signal ram_write_i : std_logic;\r
-signal ram_data_i: std_logic_vector(7 downto 0);\r
-signal ram_data_o: std_logic_vector(7 downto 0);\r
-signal ram_addr_i: std_logic_vector(3 downto 0);\r
-signal temperature_i : std_logic_vector(11 downto 0);\r
-\r
-type idram_t is array(0 to 7) of std_logic_vector(15 downto 0);\r
-signal idram : idram_t;\r
-type ram_t is array(0 to 15) of std_logic_vector(15 downto 0);\r
-signal ram : ram_t;\r
-\r
-signal pwm_i : std_logic_vector(31 downto 0);\r
-signal INP_i : std_logic_vector(15 downto 0);\r
-signal spi_reg00_i : std_logic_vector(15 downto 0);\r
-signal spi_reg10_i : std_logic_vector(15 downto 0);\r
-signal spi_reg20_i : std_logic_vector(15 downto 0);\r
-signal spi_reg40_i : std_logic_vector(15 downto 0);\r
-signal spi_data_i : std_logic_vector(15 downto 0);\r
-signal spi_operation_i : std_logic_vector(3 downto 0);\r
-signal spi_channel_i : std_logic_vector(7 downto 0);\r
-signal spi_write_i : std_logic_vector(15 downto 0);\r
-signal buf_SPI_OUT : std_logic;\r
-signal spi_debug_i : std_logic_vector(15 downto 0);\r
-\r
-signal pll_lock : std_logic;\r
-signal clk_26 : std_logic;\r
-signal clk_osc : std_logic;\r
-\r
-signal flashram_addr_i : std_logic_vector(3 downto 0);\r
-signal flashram_cen_i : std_logic;\r
-signal flashram_reset : std_logic;\r
-signal flashram_write_i: std_logic;\r
-signal flashram_data_i : std_logic_vector(7 downto 0);\r
-signal flashram_data_o : std_logic_vector(7 downto 0);\r
-\r
-signal flash_command : std_logic_vector(2 downto 0);\r
-signal flash_page : std_logic_vector(10 downto 0);\r
-signal flash_go : std_logic;\r
-signal flash_busy : std_logic;\r
-signal flash_err : std_logic;\r
-\r
-signal inp_select : integer range 0 to 31 := 0;\r
-signal inp_invert : std_logic_vector(15 downto 0);\r
-signal input_enable : std_logic_vector(15 downto 0);\r
-signal inp_status : std_logic_vector(15 downto 0);\r
-signal led_status : std_logic_vector(4 downto 0);\r
-\r
-signal timer : unsigned(18 downto 0) := (others => '0');\r
-signal last_inp : std_logic_vector(3 downto 0) := (others => '0');\r
-signal leds : std_logic_vector(3 downto 0) := (others => '0');\r
-signal last_leds: std_logic_vector(3 downto 0) := (others => '0');\r
-signal onewire_monitor : std_logic;\r
-signal onewire_reset : std_logic;\r
-signal inp_or : std_logic;\r
-signal inp_long_or : std_logic;\r
-signal inp_long_reg : std_logic;\r
-signal last_inp_long_reg : std_logic;\r
-\r
-signal inp_stretch : std_logic_vector(15 downto 0);\r
-signal inp_stretched : std_logic_vector(15 downto 0);\r
-signal inp_hold : std_logic_vector(15 downto 0);\r
-signal inp_gated : std_logic_vector(15 downto 0);\r
-signal inp_hold_reg: std_logic_vector(15 downto 0);\r
-signal last_inp_hold_reg: std_logic_vector(15 downto 0);\r
-signal flash_go_tmp : std_logic_vector(5 downto 0);\r
-signal flash_reset_n : std_logic;\r
-\r
-signal pwm_data_i : std_logic_vector(15 downto 0);\r
-signal pwm_data_o : std_logic_vector(15 downto 0);\r
-signal pwm_write_i : std_logic;\r
-signal pwm_addr_i : std_logic_vector(3 downto 0);\r
-type fsm_state is (IDLE, PWM_WRITE_GET_1, PWM_WRITE_GET_2, PWM_WRITE, PWM_WAIT);\r
-signal fsm_copydat : fsm_state;\r
-\r
-signal pwm_fsm_data_i : std_logic_vector(15 downto 0);\r
-signal pwm_fsm_addr : std_logic_vector(3 downto 0);\r
-signal pwm_fsm_write : std_logic;\r
-signal fsm_job : std_logic_vector(1 downto 0);\r
-signal ram_fsm_data_i : std_logic_vector(7 downto 0);\r
-signal ram_fsm_addr_i : std_logic_vector(3 downto 0);\r
-signal ram_fsm_write_i: std_logic;\r
-\r
-begin\r
-\r
-\r
-THE_PLL : pll\r
- port map(\r
- CLKI => clk_osc,\r
- CLKOP => clk_26, --33\r
- CLKOS => clk_i, --133\r
- LOCK => pll_lock --no lock available!\r
- );\r
-\r
----------------------------------------------------------------------------\r
--- Clock\r
----------------------------------------------------------------------------\r
-clk_source: OSCH\r
--- synthesis translate_off\r
- generic map ( NOM_FREQ => "133.00" )\r
--- synthesis translate_on\r
- port map (\r
- STDBY => '0',\r
- OSC => clk_osc,\r
- SEDSTDBY => open\r
- );\r
-\r
----------------------------------------------------------------------------\r
--- Input re-ordering\r
----------------------------------------------------------------------------\r
-gen_outputs_1 : if PADIWA_FLAVOUR = 2 generate\r
- INP_i <= INP;\r
- PWM <= pwm_i(15 downto 0);\r
-end generate;\r
-\r
-\r
-gen_outputs_2 : if PADIWA_FLAVOUR = 1 generate\r
- INP_i <= INP(16) & INP(8) & INP(15) & INP(7) & INP(14) & INP(6) & INP(13) & INP(5) & \r
- INP(12) & INP(4) & INP(11) & INP(3) & INP(10) & INP(2) & INP(9) & INP(1);\r
- PWM <= pwm_i(15) & pwm_i(7) & pwm_i(14) & pwm_i(6) & pwm_i(13) & pwm_i(5) & pwm_i(12) & pwm_i(4) & \r
- pwm_i(11) & pwm_i(3) & pwm_i(10) & pwm_i(2) & pwm_i(9) & pwm_i(1) & pwm_i(8) & pwm_i(0);\r
-end generate;\r
-\r
- \r
- \r
- \r
----------------------------------------------------------------------------\r
--- SPI Interface\r
---------------------------------------------------------------------------- \r
-THE_SPI_SLAVE : spi_slave\r
- port map(\r
- CLK => clk_i,\r
- SPI_CLK => SPI_CLK,\r
- SPI_CS => SPI_CS,\r
- SPI_IN => SPI_IN,\r
- SPI_OUT => buf_SPI_OUT,\r
- DATA_OUT => spi_data_i,\r
- REG00_IN => spi_reg00_i,\r
- REG10_IN => spi_reg10_i,\r
- REG20_IN => spi_reg20_i,\r
- REG40_IN => spi_reg40_i,\r
- OPERATION_OUT => spi_operation_i,\r
- CHANNEL_OUT => spi_channel_i,\r
- WRITE_OUT => spi_write_i,\r
- DEBUG_OUT => spi_debug_i\r
- );\r
-\r
-SPI_OUT <= buf_SPI_OUT; \r
-\r
-spi_reg00_i <= pwm_data_o;\r
-spi_reg10_i <= idram(to_integer(unsigned(spi_channel_i(2 downto 0))));\r
-spi_reg40_i <= flash_busy & flash_err & "000000" & ram_data_o;\r
-\r
----------------------------------------------------------------------------\r
--- RAM Interface\r
---------------------------------------------------------------------------- \r
-\r
-\r
-PROC_CTRL_FLASH : process begin\r
- wait until rising_edge(clk_i);\r
- if(spi_write_i(5) = '1' and spi_channel_i(7 downto 4) = x"0") then\r
- flash_command <= spi_data_i(14 downto 12);\r
- flash_page <= spi_data_i(10 downto 0);\r
- flash_go_tmp(0)<= '1';\r
- else\r
- flash_go_tmp(5 downto 0) <= flash_go_tmp(4 downto 0) & '0';\r
- end if;\r
- if flash_reset_n = '0' then\r
- flash_go_tmp <= (others => '0');\r
- end if;\r
-end process;\r
-\r
- flash_go <= or_all(flash_go_tmp);\r
-\r
-THE_FLASH_RAM : flashram\r
- port map(\r
- DataInA => ram_data_i,\r
- DataInB => flashram_data_i,\r
- AddressA => ram_addr_i,\r
- AddressB => flashram_addr_i,\r
- ClockA => clk_i, \r
- ClockB => clk_26,\r
- ClockEnA => '1',\r
- ClockEnB => flashram_cen_i,\r
- WrA => ram_write_i, \r
- WrB => flashram_write_i, \r
- ResetA => '0',\r
- ResetB => flashram_reset,\r
- QA => ram_data_o,\r
- QB => flashram_data_o\r
- );\r
-\r
----------------------------------------------------------------------------\r
--- Flash Controller\r
---------------------------------------------------------------------------- \r
-\r
-THE_FLASH : UFM_WB\r
- port map(\r
- clk_i => clk_26,\r
- rst_n => flash_reset_n,\r
- cmd => flash_command,\r
- ufm_page => flash_page,\r
- GO => flash_go,\r
- BUSY => flash_busy,\r
- ERR => flash_err,\r
- mem_clk => open,\r
- mem_we => flashram_write_i,\r
- mem_ce => flashram_cen_i,\r
- mem_addr => flashram_addr_i,\r
- mem_wr_data => flashram_data_i,\r
- mem_rd_data => flashram_data_o\r
- );\r
-\r
-PROC_DATA_COPY : process \r
- variable count : integer range 0 to 31 := 0;\r
- variable tmp : std_logic_vector(7 downto 0);\r
-begin\r
- wait until rising_edge(clk_i);\r
- pwm_fsm_write <= '0';\r
- ram_fsm_write_i <= '0';\r
- case fsm_copydat is\r
- when IDLE => \r
- count := 0;\r
- if spi_write_i(5) = '1' and spi_channel_i(7 downto 4) = x"1" then\r
- fsm_copydat <= PWM_WRITE_GET_1;\r
- ram_fsm_addr_i <= std_logic_vector(to_unsigned(count,4));\r
- fsm_job <= spi_channel_i(1 downto 0);\r
- count := count + 1;\r
- end if;\r
- when PWM_WRITE_GET_1 =>\r
- ram_fsm_addr_i <= std_logic_vector(to_unsigned(count,4));\r
- count := count + 1;\r
- fsm_copydat <= PWM_WRITE_GET_2;\r
- when PWM_WRITE_GET_2 =>\r
- fsm_copydat <= PWM_WRITE;\r
- tmp := ram_data_o;\r
- when PWM_WRITE =>\r
- pwm_fsm_data_i <= tmp & ram_data_o;\r
- pwm_fsm_write <= '1';\r
- pwm_fsm_addr <= fsm_job(0) & std_logic_vector(to_unsigned(count/2-1,3));\r
- \r
- if(count < 15) then\r
- fsm_copydat <= PWM_WRITE_GET_1;\r
- else\r
- fsm_copydat <= PWM_WAIT;\r
- end if;\r
- \r
- ram_fsm_addr_i <= std_logic_vector(to_unsigned(count,4));\r
- count := count + 1;\r
- \r
- when PWM_WAIT =>\r
- fsm_copydat <= IDLE;\r
- end case;\r
- if onewire_reset = '1' then\r
- fsm_copydat <= IDLE;\r
- end if;\r
-end process;\r
-\r
----------------------------------------------------------------------------\r
--- PWM\r
---------------------------------------------------------------------------- \r
-\r
-THE_PWM_GEN : pwm_generator\r
- port map(\r
- CLK => clk_i,\r
- DATA_IN => pwm_data_i,\r
- DATA_OUT => pwm_data_o,\r
- WRITE_IN => pwm_write_i,\r
- ADDR_IN => pwm_addr_i,\r
- PWM => pwm_i\r
- );\r
-\r
-\r
-\r
-PROC_PWM_DATA_MUX : process(fsm_copydat, spi_data_i, spi_write_i, spi_channel_i,\r
- pwm_fsm_addr, pwm_fsm_data_i, pwm_fsm_write,\r
- ram_fsm_addr_i, ram_fsm_data_i, ram_fsm_write_i)\r
-begin\r
- if(fsm_copydat = IDLE) then\r
- pwm_data_i <= spi_data_i;\r
- pwm_write_i <= spi_write_i(0);\r
- pwm_addr_i <= spi_channel_i(3 downto 0);\r
- ram_write_i <= spi_write_i(4);\r
- ram_data_i <= spi_data_i(7 downto 0);\r
- ram_addr_i <= spi_channel_i(3 downto 0);\r
- else\r
- pwm_data_i <= pwm_fsm_data_i;\r
- pwm_write_i <= pwm_fsm_write;\r
- pwm_addr_i <= pwm_fsm_addr;\r
- ram_write_i <= ram_fsm_write_i;\r
- ram_data_i <= ram_fsm_data_i;\r
- ram_addr_i <= ram_fsm_addr_i;\r
- end if;\r
-end process;\r
-\r
-\r
-\r
----------------------------------------------------------------------------\r
--- Temperature Sensor\r
---------------------------------------------------------------------------- \r
- \r
-THE_ONEWIRE : trb_net_onewire\r
- generic map(\r
- USE_TEMPERATURE_READOUT => 1,\r
- PARASITIC_MODE => c_NO,\r
- CLK_PERIOD => 40\r
- )\r
- port map(\r
- CLK => clk_26,\r
- RESET => onewire_reset,\r
- READOUT_ENABLE_IN => '1',\r
- ONEWIRE => TEMP_LINE,\r
- MONITOR_OUT => onewire_monitor,\r
- --connection to id ram, according to memory map in TrbNetRegIO\r
- DATA_OUT => id_data_i,\r
- ADDR_OUT => id_addr_i,\r
- WRITE_OUT=> id_write_i,\r
- TEMP_OUT => temperature_i,\r
- ID_OUT => open,\r
- STAT => open\r
- );\r
-\r
-PROC_IDMEM : process begin\r
- wait until rising_edge(clk_i);\r
- if id_write_i = '1' then\r
- idram(to_integer(unsigned(id_addr_i))) <= id_data_i;\r
- else\r
- idram(4) <= "0000" & temperature_i;\r
- end if;\r
- \r
- if spi_write_i(1) = '1' then\r
- onewire_reset <= spi_data_i(0);\r
- end if;\r
-end process;\r
-\r
-flash_reset_n <= not onewire_reset;\r
-\r
----------------------------------------------------------------------------\r
--- I/O Register 0x20\r
---------------------------------------------------------------------------- \r
-THE_IO_REG_READ : process begin\r
- wait until rising_edge(clk_i);\r
- if spi_channel_i(4) = '0' then\r
- case spi_channel_i(3 downto 0) is\r
- when x"0" => spi_reg20_i <= input_enable;\r
- when x"1" => spi_reg20_i <= inp_status;\r
- when x"2" => spi_reg20_i <= x"00" & "000" & led_status(4) & leds;\r
- when x"3" => spi_reg20_i <= x"00" & "000" & std_logic_vector(to_unsigned(inp_select,5));\r
- when x"4" => spi_reg20_i <= inp_invert;\r
- when x"5" => spi_reg20_i <= inp_stretch;\r
- when others => null;\r
- end case;\r
- else\r
- case spi_channel_i(3 downto 0) is\r
- when x"0" => spi_reg20_i <= std_logic_vector(to_unsigned(VERSION_NUMBER_TIME,16));\r
- when x"1" => spi_reg20_i <= std_logic_vector(to_unsigned(VERSION_NUMBER_TIME/2**16,16));\r
- when x"2" => spi_reg20_i <= x"000" & std_logic_vector(to_unsigned(PADIWA_FLAVOUR,4));\r
- when others => null;\r
- end case;\r
- end if;\r
-end process;\r
-\r
-THE_IO_REG_WRITE : process begin\r
- wait until rising_edge(clk_i);\r
- if spi_write_i(2) = '1' then\r
- case spi_channel_i(3 downto 0) is\r
- when x"0" => input_enable <= spi_data_i;\r
- when x"1" => null;\r
- when x"2" => led_status <= spi_data_i(4 downto 0);\r
- when x"3" => inp_select <= to_integer(unsigned(spi_data_i(4 downto 0)));\r
- when x"4" => inp_invert <= spi_data_i;\r
- when x"5" => inp_stretch <= spi_data_i;\r
- when others => null;\r
- end case;\r
- end if;\r
-end process;\r
-\r
-inp_status <= INP_i when rising_edge(clk_i);\r
-last_inp <= inp_status(3 downto 0) when rising_edge(clk_i);\r
-\r
-\r
----------------------------------------------------------------------------\r
--- LED blinking when activity on inputs\r
----------------------------------------------------------------------------\r
-PROC_TIMER : process begin\r
- wait until rising_edge(clk_i);\r
- timer <= timer + 1;\r
- leds <= (last_inp xor inp_status(3 downto 0)) or leds or last_leds;\r
- if timer = 0 then\r
- leds <= not inp_status(3 downto 0);\r
- last_leds <= x"0";\r
- end if;\r
-end process;\r
-\r
-\r
----------------------------------------------------------------------------\r
--- Rest of the I/O\r
----------------------------------------------------------------------------\r
-\r
-inp_gated <= (INP_i xor inp_invert) and not input_enable;\r
-CON <= inp_gated or (inp_stretched and inp_stretch);\r
-\r
-\r
-\r
-SPARE_LINE(0) <= '0'; --clk_26;\r
-SPARE_LINE(1) <= '0'; --clk_i;\r
-SPARE_LINE(2) <= '0'; --timer(18);\r
-SPARE_LINE(3) <= '0';\r
-\r
-\r
-inp_hold <= (inp_gated or inp_hold) and not inp_hold_reg;\r
-inp_hold_reg <= inp_hold when rising_edge(clk_i);\r
-last_inp_hold_reg <= inp_hold_reg when rising_edge(clk_i);\r
-inp_stretched <= inp_hold_reg or last_inp_hold_reg or inp_hold;\r
-\r
-\r
-\r
-\r
-\r
-SPARE_OUTPUT : process(INP_i, inp_select, inp_or, inp_long_or, inp_long_reg, last_inp_long_reg)\r
- begin\r
- if inp_select < 16 then\r
- SPARE_LVDS <= INP_i(inp_select);\r
- elsif inp_select < 24 then\r
- SPARE_LVDS <= inp_or;\r
- else\r
- SPARE_LVDS <= inp_long_reg or last_inp_long_reg or inp_long_or ;\r
- end if;\r
- end process;\r
-\r
-inp_or <= or_all((INP_i xor inp_invert) and not input_enable);\r
-inp_long_or <= (inp_or or inp_long_or) and not inp_long_reg;\r
-inp_long_reg <= inp_long_or when rising_edge(clk_i);\r
-last_inp_long_reg <= inp_long_reg when rising_edge(clk_i);\r
-\r
--- ll_inp_long_reg <= last_inp_long_reg when rising_edge(clk_i);\r
-\r
-\r
--- TEST_LINE(0) <= '0';\r
--- TEST_LINE(15 downto 1) <= (others => '0');\r
-\r
--- TEST_LINE(0) <= '0';\r
--- TEST_LINE(1) <= spi_write_i(5);\r
--- TEST_LINE(2) <= pwm_write_i;\r
--- TEST_LINE(3) <= ram_write_i;\r
--- TEST_LINE(7 downto 4) <= pwm_addr_i;\r
--- TEST_LINE(11 downto 8) <= ram_addr_i;\r
--- TEST_LINE(12) <= spi_write_i(4);\r
--- TEST_LINE(13) <= ;\r
--- TEST_LINE(14) <= '1' when fsm_copydat = PWM_WRITE_GET_1 or fsm_copydat = PWM_WRITE_GET_2 else '0';\r
--- TEST_LINE(15) <= '1' when fsm_copydat = PWM_WRITE_GET_2 or fsm_copydat = PWM_WRITE else '0';\r
-\r
-\r
-TEST_LINE <= (others => '0');\r
-\r
-\r
-LED_GREEN <= not leds(0) when led_status(4) = '0' else not led_status(0);\r
-LED_ORANGE <= not leds(1) when led_status(4) = '0' else not led_status(1);\r
-LED_RED <= not leds(2) when led_status(4) = '0' else not led_status(2);\r
-LED_YELLOW <= not leds(3) when led_status(4) = '0' else not led_status(3);\r
-\r
-end architecture;\r
-\r
-\r
-\r
-\r
--- PWM_ODDR : oddr16\r
--- port map(\r
--- clk => clk_i,\r
--- clkout => open,\r
--- reset => '0',\r
--- sclk => open,\r
--- dataout => pwm_i,\r
--- dout => PWM\r
--- );\r
-\r
--- PROC_RESET : process begin\r
--- wait until rising_edge(clk_osc);\r
--- reset_i <= not pll_lock;\r
--- -- if reset_cnt /= x"F" then\r
--- -- reset_cnt <= reset_cnt + 1;\r
--- -- reset_i <= '1';\r
--- -- end if;\r
--- end process;\r
-\r
-\r
--- process(inp_gated,clk_i); \r
--- begin\r
--- if inp_gated(i) then\r
--- inp_hold(i) <= inp_gated(i);\r
--- elsif rising_edge(clk_i) then\r
--- inp_hold(i) <= inp_hold(i) and not inp_hold_reg(i);\r
--- end if;\r
--- end process;\r
--- \r
+library ieee;
+use ieee.std_logic_1164.all;
+use ieee.numeric_std.all;
+
+library work;
+use work.trb_net_std.all;
+use work.trb_net_components.all;
+use work.trb3_components.all;
+use work.version.all;
+
+library machxo2;
+use machxo2.all;
+
+
+entity panda_dirc_wasa is
+ generic(
+ PADIWA_FLAVOUR : integer := 1
+ );
+ port(
+ CON : out std_logic_vector(16 downto 1);
+ INP : in std_logic_vector(16 downto 1);
+ PWM : out std_logic_vector(16 downto 1);
+ SPARE_LINE : out std_logic_vector(3 downto 0);
+ SPARE_LVDS : out std_logic;
+ LED_GREEN : out std_logic;
+ LED_ORANGE : out std_logic;
+ LED_RED : out std_logic;
+ LED_YELLOW : out std_logic;
+ SPI_CLK : in std_logic;
+ SPI_CS : in std_logic;
+ SPI_IN : in std_logic;
+ SPI_OUT : out std_logic;
+ TEMP_LINE : inout std_logic;
+ TEST_LINE : out std_logic_vector(15 downto 0)
+ );
+end entity;
+
+architecture panda_dirc_wasa_arch of panda_dirc_wasa is
+
+component OSCH
+-- synthesis translate_off
+ generic (NOM_FREQ: string := "133.00");
+-- synthesis translate_on
+ port (
+ STDBY :IN std_logic;
+ OSC :OUT std_logic;
+ SEDSTDBY :OUT std_logic
+ );
+end component;
+
+component oddr16 is
+ port (
+ clk: in std_logic;
+ clkout: out std_logic;
+ reset: in std_logic;
+ sclk: out std_logic;
+ dataout: in std_logic_vector(31 downto 0);
+ dout: out std_logic_vector(15 downto 0));
+end component;
+
+component spi_slave
+ port(
+ CLK : in std_logic;
+ SPI_CLK : in std_logic;
+ SPI_CS : in std_logic;
+ SPI_IN : in std_logic;
+ SPI_OUT : out std_logic;
+
+ DATA_OUT : out std_logic_vector(15 downto 0);
+ REG00_IN : in std_logic_vector(15 downto 0);
+ REG10_IN : in std_logic_vector(15 downto 0);
+ REG20_IN : in std_logic_vector(15 downto 0);
+ REG40_IN : in std_logic_vector(15 downto 0);
+
+ OPERATION_OUT : out std_logic_vector(3 downto 0);
+ CHANNEL_OUT : out std_logic_vector(7 downto 0);
+ WRITE_OUT : out std_logic_vector(15 downto 0);
+
+ DEBUG_OUT : out std_logic_vector(15 downto 0)
+ );
+end component;
+
+
+component pwm_generator
+ port(
+ CLK : in std_logic;
+ DATA_IN : in std_logic_vector(15 downto 0);
+ DATA_OUT : out std_logic_vector(15 downto 0);
+ WRITE_IN : in std_logic;
+ ADDR_IN : in std_logic_vector(3 downto 0);
+ PWM : out std_logic_vector(31 downto 0)
+ );
+end component;
+
+component flashram
+ port (
+ DataInA: in std_logic_vector(7 downto 0);
+ DataInB: in std_logic_vector(7 downto 0);
+ AddressA: in std_logic_vector(3 downto 0);
+ AddressB: in std_logic_vector(3 downto 0);
+ ClockA: in std_logic;
+ ClockB: in std_logic;
+ ClockEnA: in std_logic;
+ ClockEnB: in std_logic;
+ WrA: in std_logic;
+ WrB: in std_logic;
+ ResetA: in std_logic;
+ ResetB: in std_logic;
+ QA: out std_logic_vector(7 downto 0);
+ QB: out std_logic_vector(7 downto 0)
+ );
+end component;
+
+component pll
+ port (
+ CLKI: in std_logic;
+ CLKOP: out std_logic;
+ CLKOS: out std_logic;
+ LOCK: out std_logic);
+end component;
+
+
+component UFM_WB
+ port(
+ clk_i : in std_logic;
+ rst_n : in std_logic;
+ cmd : in std_logic_vector(2 downto 0);
+ ufm_page : in std_logic_vector(10 downto 0);
+ GO : in std_logic;
+ BUSY : out std_logic;
+ ERR : out std_logic;
+ mem_clk : out std_logic;
+ mem_we : out std_logic;
+ mem_ce : out std_logic;
+ mem_addr : out std_logic_vector(3 downto 0);
+ mem_wr_data : out std_logic_vector(7 downto 0);
+ mem_rd_data : in std_logic_vector(7 downto 0)
+ );
+end component;
+
+component PUR port(PUR : in std_logic); end component;
+component GSR port(GSR : in std_logic); end component;
+
+
+
+attribute NOM_FREQ : string;
+attribute NOM_FREQ of clk_source : label is "133.00";
+signal clk_i : std_logic;
+
+signal reset_i : std_logic := '1';
+signal reset_cnt : unsigned(3 downto 0) := x"0";
+signal id_data_i : std_logic_vector(15 downto 0);
+signal id_addr_i : std_logic_vector(2 downto 0);
+signal id_write_i: std_logic;
+signal ram_write_i : std_logic;
+signal ram_data_i: std_logic_vector(7 downto 0);
+signal ram_data_o: std_logic_vector(7 downto 0);
+signal ram_addr_i: std_logic_vector(3 downto 0);
+signal temperature_i : std_logic_vector(11 downto 0);
+
+type idram_t is array(0 to 7) of std_logic_vector(15 downto 0);
+signal idram : idram_t;
+type ram_t is array(0 to 15) of std_logic_vector(15 downto 0);
+signal ram : ram_t;
+
+signal pwm_i : std_logic_vector(32 downto 1);
+signal INP_i : std_logic_vector(15 downto 0);
+signal spi_reg00_i : std_logic_vector(15 downto 0);
+signal spi_reg10_i : std_logic_vector(15 downto 0);
+signal spi_reg20_i : std_logic_vector(15 downto 0);
+signal spi_reg40_i : std_logic_vector(15 downto 0);
+signal spi_data_i : std_logic_vector(15 downto 0);
+signal spi_operation_i : std_logic_vector(3 downto 0);
+signal spi_channel_i : std_logic_vector(7 downto 0);
+signal spi_write_i : std_logic_vector(15 downto 0);
+signal buf_SPI_OUT : std_logic;
+signal spi_debug_i : std_logic_vector(15 downto 0);
+
+signal pll_lock : std_logic;
+signal clk_26 : std_logic;
+signal clk_osc : std_logic;
+
+signal flashram_addr_i : std_logic_vector(3 downto 0);
+signal flashram_cen_i : std_logic;
+signal flashram_reset : std_logic;
+signal flashram_write_i: std_logic;
+signal flashram_data_i : std_logic_vector(7 downto 0);
+signal flashram_data_o : std_logic_vector(7 downto 0);
+
+signal flash_command : std_logic_vector(2 downto 0);
+signal flash_page : std_logic_vector(10 downto 0);
+signal flash_go : std_logic;
+signal flash_busy : std_logic;
+signal flash_err : std_logic;
+
+signal inp_select : integer range 0 to 31 := 0;
+signal inp_invert : std_logic_vector(15 downto 0);
+signal input_enable : std_logic_vector(15 downto 0);
+signal inp_status : std_logic_vector(15 downto 0);
+signal led_status : std_logic_vector(4 downto 0);
+
+signal timer : unsigned(18 downto 0) := (others => '0');
+signal last_inp : std_logic_vector(3 downto 0) := (others => '0');
+signal leds : std_logic_vector(3 downto 0) := (others => '0');
+signal last_leds: std_logic_vector(3 downto 0) := (others => '0');
+signal onewire_monitor : std_logic;
+signal onewire_reset : std_logic;
+signal inp_or : std_logic;
+signal inp_long_or : std_logic;
+signal inp_long_reg : std_logic;
+signal last_inp_long_reg : std_logic;
+
+signal inp_stretch : std_logic_vector(15 downto 0);
+signal inp_stretched : std_logic_vector(15 downto 0);
+signal inp_hold : std_logic_vector(15 downto 0);
+signal inp_gated : std_logic_vector(15 downto 0);
+signal inp_hold_reg: std_logic_vector(15 downto 0);
+signal last_inp_hold_reg: std_logic_vector(15 downto 0);
+signal flash_go_tmp : std_logic_vector(5 downto 0);
+signal flash_reset_n : std_logic;
+
+signal pwm_data_i : std_logic_vector(15 downto 0);
+signal pwm_data_o : std_logic_vector(15 downto 0);
+signal pwm_write_i : std_logic;
+signal pwm_addr_i : std_logic_vector(3 downto 0);
+type fsm_state is (IDLE, PWM_WRITE_GET_1, PWM_WRITE_GET_2, PWM_WRITE, PWM_WAIT);
+signal fsm_copydat : fsm_state;
+
+signal pwm_fsm_data_i : std_logic_vector(15 downto 0);
+signal pwm_fsm_addr : std_logic_vector(3 downto 0);
+signal pwm_fsm_write : std_logic;
+signal fsm_job : std_logic_vector(1 downto 0);
+signal ram_fsm_data_i : std_logic_vector(7 downto 0);
+signal ram_fsm_addr_i : std_logic_vector(3 downto 0);
+signal ram_fsm_write_i: std_logic;
+
+begin
+
+
+THE_PLL : pll
+ port map(
+ CLKI => clk_osc,
+ CLKOP => clk_26, --33
+ CLKOS => clk_i, --133
+ LOCK => pll_lock --no lock available!
+ );
+
+---------------------------------------------------------------------------
+-- Clock
+---------------------------------------------------------------------------
+clk_source: OSCH
+-- synthesis translate_off
+ generic map ( NOM_FREQ => "133.00" )
+-- synthesis translate_on
+ port map (
+ STDBY => '0',
+ OSC => clk_osc,
+ SEDSTDBY => open
+ );
+
+---------------------------------------------------------------------------
+-- Input re-ordering
+---------------------------------------------------------------------------
+
+gen_outputs_1 : if PADIWA_FLAVOUR = 1 generate
+ INP_i <= INP(16) & INP(8) & INP(15) & INP(7) & INP(14) & INP(6) & INP(13) & INP(5) &
+ INP(12) & INP(4) & INP(11) & INP(3) & INP(10) & INP(2) & INP(9) & INP(1);
+ PWM <= pwm_i(16) & pwm_i(8) & pwm_i(15) & pwm_i(7) & pwm_i(14) & pwm_i(6) & pwm_i(13) & pwm_i(5) &
+ pwm_i(12) & pwm_i(4) & pwm_i(11) & pwm_i(3) & pwm_i(10) & pwm_i(2) & pwm_i(9) & pwm_i(1);
+end generate;
+
+
+gen_outputs_2 : if PADIWA_FLAVOUR = 2 generate
+ INP_i <= INP;
+ PWM <= pwm_i(16 downto 1);
+end generate;
+
+
+gen_outputs_3 : if PADIWA_FLAVOUR = 3 generate
+ INP_i <= INP(9) & INP(1) & INP(10) & INP(2) & INP(11) & INP(3) & INP(12) & INP(4) &
+ INP(13) & INP(5) & INP(14) & INP(6) & INP(15) & INP(7) & INP(16) & INP(8);
+ PWM <= pwm_i(9) & pwm_i(1) & pwm_i(10) & pwm_i(2) & pwm_i(11) & pwm_i(3) & pwm_i(12) & pwm_i(4) &
+ pwm_i(13) & pwm_i(5) & pwm_i(14) & pwm_i(6) & pwm_i(15) & pwm_i(7) & pwm_i(16) & pwm_i(8);
+end generate;
+
+
+---------------------------------------------------------------------------
+-- SPI Interface
+---------------------------------------------------------------------------
+THE_SPI_SLAVE : spi_slave
+ port map(
+ CLK => clk_i,
+ SPI_CLK => SPI_CLK,
+ SPI_CS => SPI_CS,
+ SPI_IN => SPI_IN,
+ SPI_OUT => buf_SPI_OUT,
+ DATA_OUT => spi_data_i,
+ REG00_IN => spi_reg00_i,
+ REG10_IN => spi_reg10_i,
+ REG20_IN => spi_reg20_i,
+ REG40_IN => spi_reg40_i,
+ OPERATION_OUT => spi_operation_i,
+ CHANNEL_OUT => spi_channel_i,
+ WRITE_OUT => spi_write_i,
+ DEBUG_OUT => spi_debug_i
+ );
+
+SPI_OUT <= buf_SPI_OUT;
+
+spi_reg00_i <= pwm_data_o;
+spi_reg10_i <= idram(to_integer(unsigned(spi_channel_i(2 downto 0))));
+spi_reg40_i <= flash_busy & flash_err & "000000" & ram_data_o;
+
+---------------------------------------------------------------------------
+-- RAM Interface
+---------------------------------------------------------------------------
+
+
+PROC_CTRL_FLASH : process begin
+ wait until rising_edge(clk_i);
+ if(spi_write_i(5) = '1' and spi_channel_i(7 downto 4) = x"0") then
+ flash_command <= spi_data_i(14 downto 12);
+ flash_page <= spi_data_i(10 downto 0);
+ flash_go_tmp(0)<= '1';
+ else
+ flash_go_tmp(5 downto 0) <= flash_go_tmp(4 downto 0) & '0';
+ end if;
+ if flash_reset_n = '0' then
+ flash_go_tmp <= (others => '0');
+ end if;
+end process;
+
+ flash_go <= or_all(flash_go_tmp);
+
+THE_FLASH_RAM : flashram
+ port map(
+ DataInA => ram_data_i,
+ DataInB => flashram_data_i,
+ AddressA => ram_addr_i,
+ AddressB => flashram_addr_i,
+ ClockA => clk_i,
+ ClockB => clk_26,
+ ClockEnA => '1',
+ ClockEnB => flashram_cen_i,
+ WrA => ram_write_i,
+ WrB => flashram_write_i,
+ ResetA => '0',
+ ResetB => flashram_reset,
+ QA => ram_data_o,
+ QB => flashram_data_o
+ );
+
+---------------------------------------------------------------------------
+-- Flash Controller
+---------------------------------------------------------------------------
+
+THE_FLASH : UFM_WB
+ port map(
+ clk_i => clk_26,
+ rst_n => flash_reset_n,
+ cmd => flash_command,
+ ufm_page => flash_page,
+ GO => flash_go,
+ BUSY => flash_busy,
+ ERR => flash_err,
+ mem_clk => open,
+ mem_we => flashram_write_i,
+ mem_ce => flashram_cen_i,
+ mem_addr => flashram_addr_i,
+ mem_wr_data => flashram_data_i,
+ mem_rd_data => flashram_data_o
+ );
+
+PROC_DATA_COPY : process
+ variable count : integer range 0 to 31 := 0;
+ variable tmp : std_logic_vector(7 downto 0);
+begin
+ wait until rising_edge(clk_i);
+ pwm_fsm_write <= '0';
+ ram_fsm_write_i <= '0';
+ case fsm_copydat is
+ when IDLE =>
+ count := 0;
+ if spi_write_i(5) = '1' and spi_channel_i(7 downto 4) = x"1" then
+ fsm_copydat <= PWM_WRITE_GET_1;
+ ram_fsm_addr_i <= std_logic_vector(to_unsigned(count,4));
+ fsm_job <= spi_channel_i(1 downto 0);
+ count := count + 1;
+ end if;
+ when PWM_WRITE_GET_1 =>
+ ram_fsm_addr_i <= std_logic_vector(to_unsigned(count,4));
+ count := count + 1;
+ fsm_copydat <= PWM_WRITE_GET_2;
+ when PWM_WRITE_GET_2 =>
+ fsm_copydat <= PWM_WRITE;
+ tmp := ram_data_o;
+ when PWM_WRITE =>
+ pwm_fsm_data_i <= tmp & ram_data_o;
+ pwm_fsm_write <= '1';
+ pwm_fsm_addr <= fsm_job(0) & std_logic_vector(to_unsigned(count/2-1,3));
+
+ if(count < 15) then
+ fsm_copydat <= PWM_WRITE_GET_1;
+ else
+ fsm_copydat <= PWM_WAIT;
+ end if;
+
+ ram_fsm_addr_i <= std_logic_vector(to_unsigned(count,4));
+ count := count + 1;
+
+ when PWM_WAIT =>
+ fsm_copydat <= IDLE;
+ end case;
+ if onewire_reset = '1' then
+ fsm_copydat <= IDLE;
+ end if;
+end process;
+
+---------------------------------------------------------------------------
+-- PWM
+---------------------------------------------------------------------------
+
+THE_PWM_GEN : pwm_generator
+ port map(
+ CLK => clk_i,
+ DATA_IN => pwm_data_i,
+ DATA_OUT => pwm_data_o,
+ WRITE_IN => pwm_write_i,
+ ADDR_IN => pwm_addr_i,
+ PWM => pwm_i
+ );
+
+
+
+PROC_PWM_DATA_MUX : process(fsm_copydat, spi_data_i, spi_write_i, spi_channel_i,
+ pwm_fsm_addr, pwm_fsm_data_i, pwm_fsm_write,
+ ram_fsm_addr_i, ram_fsm_data_i, ram_fsm_write_i)
+begin
+ if(fsm_copydat = IDLE) then
+ pwm_data_i <= spi_data_i;
+ pwm_write_i <= spi_write_i(0);
+ pwm_addr_i <= spi_channel_i(3 downto 0);
+ ram_write_i <= spi_write_i(4);
+ ram_data_i <= spi_data_i(7 downto 0);
+ ram_addr_i <= spi_channel_i(3 downto 0);
+ else
+ pwm_data_i <= pwm_fsm_data_i;
+ pwm_write_i <= pwm_fsm_write;
+ pwm_addr_i <= pwm_fsm_addr;
+ ram_write_i <= ram_fsm_write_i;
+ ram_data_i <= ram_fsm_data_i;
+ ram_addr_i <= ram_fsm_addr_i;
+ end if;
+end process;
+
+
+
+---------------------------------------------------------------------------
+-- Temperature Sensor
+---------------------------------------------------------------------------
+
+THE_ONEWIRE : trb_net_onewire
+ generic map(
+ USE_TEMPERATURE_READOUT => 1,
+ PARASITIC_MODE => c_NO,
+ CLK_PERIOD => 40
+ )
+ port map(
+ CLK => clk_26,
+ RESET => onewire_reset,
+ READOUT_ENABLE_IN => '1',
+ ONEWIRE => TEMP_LINE,
+ MONITOR_OUT => onewire_monitor,
+ --connection to id ram, according to memory map in TrbNetRegIO
+ DATA_OUT => id_data_i,
+ ADDR_OUT => id_addr_i,
+ WRITE_OUT=> id_write_i,
+ TEMP_OUT => temperature_i,
+ ID_OUT => open,
+ STAT => open
+ );
+
+PROC_IDMEM : process begin
+ wait until rising_edge(clk_i);
+ if id_write_i = '1' then
+ idram(to_integer(unsigned(id_addr_i))) <= id_data_i;
+ else
+ idram(4) <= "0000" & temperature_i;
+ end if;
+
+ if spi_write_i(1) = '1' then
+ onewire_reset <= spi_data_i(0);
+ end if;
+end process;
+
+flash_reset_n <= not onewire_reset;
+
+---------------------------------------------------------------------------
+-- I/O Register 0x20
+---------------------------------------------------------------------------
+THE_IO_REG_READ : process begin
+ wait until rising_edge(clk_i);
+ if spi_channel_i(4) = '0' then
+ case spi_channel_i(3 downto 0) is
+ when x"0" => spi_reg20_i <= input_enable;
+ when x"1" => spi_reg20_i <= inp_status;
+ when x"2" => spi_reg20_i <= x"00" & "000" & led_status(4) & leds;
+ when x"3" => spi_reg20_i <= x"00" & "000" & std_logic_vector(to_unsigned(inp_select,5));
+ when x"4" => spi_reg20_i <= inp_invert;
+ when x"5" => spi_reg20_i <= inp_stretch;
+ when others => null;
+ end case;
+ else
+ case spi_channel_i(3 downto 0) is
+ when x"0" => spi_reg20_i <= std_logic_vector(to_unsigned(VERSION_NUMBER_TIME,16));
+ when x"1" => spi_reg20_i <= std_logic_vector(to_unsigned(VERSION_NUMBER_TIME/2**16,16));
+ when x"2" => spi_reg20_i <= x"000" & std_logic_vector(to_unsigned(PADIWA_FLAVOUR,4));
+ when others => null;
+ end case;
+ end if;
+end process;
+
+THE_IO_REG_WRITE : process begin
+ wait until rising_edge(clk_i);
+ if spi_write_i(2) = '1' then
+ case spi_channel_i(3 downto 0) is
+ when x"0" => input_enable <= spi_data_i;
+ when x"1" => null;
+ when x"2" => led_status <= spi_data_i(4 downto 0);
+ when x"3" => inp_select <= to_integer(unsigned(spi_data_i(4 downto 0)));
+ when x"4" => inp_invert <= spi_data_i;
+ when x"5" => inp_stretch <= spi_data_i;
+ when others => null;
+ end case;
+ end if;
+end process;
+
+inp_status <= INP_i when rising_edge(clk_i);
+last_inp <= inp_status(3 downto 0) when rising_edge(clk_i);
+
+
+---------------------------------------------------------------------------
+-- LED blinking when activity on inputs
+---------------------------------------------------------------------------
+PROC_TIMER : process begin
+ wait until rising_edge(clk_i);
+ timer <= timer + 1;
+ leds <= (last_inp xor inp_status(3 downto 0)) or leds or last_leds;
+ if timer = 0 then
+ leds <= not inp_status(3 downto 0);
+ last_leds <= x"0";
+ end if;
+end process;
+
+
+---------------------------------------------------------------------------
+-- Rest of the I/O
+---------------------------------------------------------------------------
+
+inp_gated <= (INP_i xor inp_invert) and not input_enable;
+CON <= inp_gated or (inp_stretched and inp_stretch);
+
+
+
+SPARE_LINE(0) <= '0'; --clk_26;
+SPARE_LINE(1) <= '0'; --clk_i;
+SPARE_LINE(2) <= '0'; --timer(18);
+SPARE_LINE(3) <= '0';
+
+
+inp_hold <= (inp_gated or inp_hold) and not inp_hold_reg;
+inp_hold_reg <= inp_hold when rising_edge(clk_i);
+last_inp_hold_reg <= inp_hold_reg when rising_edge(clk_i);
+inp_stretched <= inp_hold_reg or last_inp_hold_reg or inp_hold;
+
+
+
+
+
+SPARE_OUTPUT : process(INP_i, inp_select, inp_or, inp_long_or, inp_long_reg, last_inp_long_reg)
+ begin
+ if inp_select < 16 then
+ SPARE_LVDS <= INP_i(inp_select);
+ elsif inp_select < 24 then
+ SPARE_LVDS <= inp_or;
+ else
+ SPARE_LVDS <= inp_long_reg or last_inp_long_reg or inp_long_or ;
+ end if;
+ end process;
+
+inp_or <= or_all((INP_i xor inp_invert) and not input_enable);
+inp_long_or <= (inp_or or inp_long_or) and not inp_long_reg;
+inp_long_reg <= inp_long_or when rising_edge(clk_i);
+last_inp_long_reg <= inp_long_reg when rising_edge(clk_i);
+
+-- ll_inp_long_reg <= last_inp_long_reg when rising_edge(clk_i);
+
+
+-- TEST_LINE(0) <= '0';
+-- TEST_LINE(15 downto 1) <= (others => '0');
+
+-- TEST_LINE(0) <= '0';
+-- TEST_LINE(1) <= spi_write_i(5);
+-- TEST_LINE(2) <= pwm_write_i;
+-- TEST_LINE(3) <= ram_write_i;
+-- TEST_LINE(7 downto 4) <= pwm_addr_i;
+-- TEST_LINE(11 downto 8) <= ram_addr_i;
+-- TEST_LINE(12) <= spi_write_i(4);
+-- TEST_LINE(13) <= ;
+-- TEST_LINE(14) <= '1' when fsm_copydat = PWM_WRITE_GET_1 or fsm_copydat = PWM_WRITE_GET_2 else '0';
+-- TEST_LINE(15) <= '1' when fsm_copydat = PWM_WRITE_GET_2 or fsm_copydat = PWM_WRITE else '0';
+
+
+TEST_LINE <= (others => '0');
+
+
+LED_GREEN <= not leds(0) when led_status(4) = '0' else not led_status(0);
+LED_ORANGE <= not leds(1) when led_status(4) = '0' else not led_status(1);
+LED_RED <= not leds(2) when led_status(4) = '0' else not led_status(2);
+LED_YELLOW <= not leds(3) when led_status(4) = '0' else not led_status(3);
+
+end architecture;
+
+
+
+
+-- PWM_ODDR : oddr16
+-- port map(
+-- clk => clk_i,
+-- clkout => open,
+-- reset => '0',
+-- sclk => open,
+-- dataout => pwm_i,
+-- dout => PWM
+-- );
+
+-- PROC_RESET : process begin
+-- wait until rising_edge(clk_osc);
+-- reset_i <= not pll_lock;
+-- -- if reset_cnt /= x"F" then
+-- -- reset_cnt <= reset_cnt + 1;
+-- -- reset_i <= '1';
+-- -- end if;
+-- end process;
+
+
+-- process(inp_gated,clk_i);
+-- begin
+-- if inp_gated(i) then
+-- inp_hold(i) <= inp_gated(i);
+-- elsif rising_edge(clk_i) then
+-- inp_hold(i) <= inp_hold(i) and not inp_hold_reg(i);
+-- end if;
+-- end process;
+--