Add Tercel PHY reset synchronization

[microwatt.git] / wishbone_arbiter.vhdl

diff --git a/wishbone_arbiter.vhdl b/wishbone_arbiter.vhdl
index c7d249a635a9047a2057e68043c0cbbc72e97098..cb632bffafab762ec3395b4649a5eea7fb830961 100644 (file)
--- a/wishbone_arbiter.vhdl
+++ b/wishbone_arbiter.vhdl
@@ -4,54 +4,67 @@ use ieee.std_logic_1164.all;
 library work;
 use work.wishbone_types.all;
 
+-- TODO: Use an array of master/slaves with parametric size
 entity wishbone_arbiter is
-       port (
-               clk     : in std_ulogic;
-               rst     : in std_ulogic;
-
-               wb1_in  : in wishbone_master_out;
-               wb1_out : out wishbone_slave_out;
+    generic(
+       NUM_MASTERS : positive := 3
+       );
+    port (clk     : in std_ulogic;
+         rst     : in std_ulogic;
 
-               wb2_in  : in wishbone_master_out;
-               wb2_out : out wishbone_slave_out;
+         wb_masters_in  : in wishbone_master_out_vector(0 to NUM_MASTERS-1);
+         wb_masters_out : out wishbone_slave_out_vector(0 to NUM_MASTERS-1);
 
-               wb_out  : out wishbone_master_out;
-               wb_in   : in wishbone_slave_out
-       );
+         wb_slave_out  : out wishbone_master_out;
+         wb_slave_in   : in wishbone_slave_out
+         );
 end wishbone_arbiter;
 
 architecture behave of wishbone_arbiter is
-       type wishbone_arbiter_state_t is (IDLE, WB1_BUSY, WB2_BUSY);
-       signal state : wishbone_arbiter_state_t := IDLE;
+    subtype wb_arb_master_t is integer range 0 to NUM_MASTERS-1;
+    signal candidate, selected : wb_arb_master_t;
+    signal busy : std_ulogic;
 begin
-       wb1_out <= wb_in when state = WB1_BUSY else wishbone_slave_out_init;
-       wb2_out <= wb_in when state = WB2_BUSY else wishbone_slave_out_init;
-
-       wb_out <= wb1_in when state = WB1_BUSY else wb2_in when state = WB2_BUSY else wishbone_master_out_init;
-
-       wishbone_arbiter_process: process(clk)
-       begin
-               if rising_edge(clk) then
-                       if rst = '1' then
-                               state <= IDLE;
-                       else
-                               case state is
-                               when IDLE =>
-                                       if wb1_in.cyc = '1' then
-                                               state <= WB1_BUSY;
-                                       elsif wb2_in.cyc = '1' then
-                                               state <= WB2_BUSY;
-                                       end if;
-                               when WB1_BUSY =>
-                                       if wb1_in.cyc = '0' then
-                                               state <= IDLE;
-                                       end if;
-                               when WB2_BUSY =>
-                                       if wb2_in.cyc = '0' then
-                                               state <= IDLE;
-                                       end if;
-                               end case;
-                       end if;
-               end if;
-       end process;
+
+    busy <= wb_masters_in(selected).cyc;
+
+    wishbone_muxes: process(selected, candidate, busy, wb_slave_in, wb_masters_in)
+       variable early_sel : wb_arb_master_t;
+    begin
+       early_sel := selected;
+       if busy = '0' then
+           early_sel := candidate;
+       end if;
+       wb_slave_out <= wb_masters_in(early_sel);
+       for i in 0 to NUM_MASTERS-1 loop
+           wb_masters_out(i).dat <= wb_slave_in.dat;
+           wb_masters_out(i).ack <= wb_slave_in.ack when early_sel = i else '0';
+           wb_masters_out(i).stall <= wb_slave_in.stall when early_sel = i else '1';
+       end loop;
+    end process;
+
+    -- Candidate selection is dumb, priority order... we could
+    -- instead consider some form of fairness but it's not really
+    -- an issue at the moment.
+    --
+    wishbone_candidate: process(all)
+    begin
+       candidate <= selected;
+       for i in NUM_MASTERS-1 downto 0  loop
+           if wb_masters_in(i).cyc = '1' then
+               candidate <= i;
+           end if;
+       end loop;
+    end process;
+
+    wishbone_arbiter_process: process(clk)
+    begin
+       if rising_edge(clk) then
+           if rst = '1' then
+               selected <= 0;
+           elsif busy = '0' then
+               selected <= candidate;
+           end if;
+       end if;
+    end process;
 end behave;