add a wishbone arbiter for 2 masters

3 files changed, 442 insertions, 0 deletions

diff --git a/tests/master_arbiter/operations0.memv b/tests/master_arbiter/operations0.memv
new file mode 100644
index 0000000..bc122b2
--- /dev/null
+++ b/tests/master_arbiter/operations0.memv
@@ -0,0 +1,55 @@
+`include "macroasm.vh" // look into macroasm.vh for more info
+
+// Those are the operations performed by
+// master 0 (the one prioritized by arbiter)
+`WRITE(00000, abcd)
+`WAIT
+`READ (00000, abcd)
+`WRITE(00001, 1234)
+`READ (00000, abcd)
+`DESELECT
+`DESELECT
+`READ (00001, 1234)
+`WRITE(01010, a2a2)
+`WRITE(00001, 4321)
+`READ (01010, a2a2)
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+// Only values written until this point will also be checked by master 1
+`DESELECT
+`DESELECT
+`DESELECT
+`WAIT
+`DESELECT
+// Let's force some interleaved single operations by both masters
+`WRITE(0001c, 8a9b)
+`DESELECT
+`WRITE(0003e, acbd)
+`DESELECT
+`READ (0003e, acbd)
+`DESELECT
+`READ (0001c, 8a9b)
+`DESELECT
+`WRITE(00050, cedf)
+`DESELECT
+`WRITE(00072, e0f1)
+`DESELECT
+`READ (00072, e0f1)
+`DESELECT
+`READ (00050, cedf)
+`DESELECT
+`WAIT
+`READ (00001, 4321)
+// The other master should write the values we check below during its first few
+// blocks of operations. Although we have no means of synchronizing masters, we
+// assume, that when 1 of them does a `DESELECT, other one can take over the
+// bus. Because we do have `DESELECTs above, we can expect at least the first
+// sets of other master's operations to have completed once we get here.
+`READ (30000, 03e8)
+`READ (30005, 0403)
+`READ (30120, 0120)
+`READ (b0005, 22ef)
+`READ (3001a, 0a1b)
diff --git a/tests/master_arbiter/operations1.memv b/tests/master_arbiter/operations1.memv
new file mode 100644
index 0000000..1900676
--- /dev/null
+++ b/tests/master_arbiter/operations1.memv
@@ -0,0 +1,190 @@
+`include "macroasm.vh" // look into macroasm.vh for more info
+
+// Those are the operations performed by master 1
+// (the one with worse priority in arbiter)
+`WRITE(30000, 03e8)
+`WAIT
+`READ (30000, 03e8)
+`WRITE(30005, 0403)
+`WAIT
+`WAIT
+`WAIT
+`WRITE(30120, 0120)
+`READ (30005, 0403)
+`READ (30120, 0120)
+`DESELECT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WRITE(b0005, 22ef)
+// Let's make the operations block significantly long.
+// If arbiter works properly, it should not allow master 0
+// to complete its operations in the meantime
+// (master 1's CYC_O is still high during `WAITs)
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`WAIT
+`READ (b0005, 22ef)
+`WRITE(3001a, 0a1b)
+// Only values written until this point will also be checked by master 0
+`DESELECT
+`READ (3001a, 0a1b)
+// Let's force some interleaved single operations by both masters
+`WRITE(3001c, 0a1b)
+`DESELECT
+`WRITE(3003e, 2c3d)
+`DESELECT
+`READ (3003e, 2c3d)
+`DESELECT
+`READ (3001c, 0a1b)
+`DESELECT
+`WRITE(30050, 4e5f)
+`DESELECT
+`WRITE(30072, 6071)
+`DESELECT
+`READ (30072, 6071)
+`DESELECT
+`READ (30050, 4e5f)
+`DESELECT
+// See comment at the end of master 0's operations - we do it analogoulys here
+`READ (00000, abcd)
+`READ (01010, a2a2)
+`READ (00001, 4321)
diff --git a/tests/master_arbiter/test.v b/tests/master_arbiter/test.v
new file mode 100644
index 0000000..bcf90b8
--- /dev/null
+++ b/tests/master_arbiter/test.v
@@ -0,0 +1,197 @@
+`default_nettype none
+
+`include "messages.vh"
+
+`ifndef MASTER0_OPERATIONS_COUNT
+ `error_MASTER0_OPERATIONS_COUNT_must_be_defined
+; /* Cause syntax error */
+`endif
+
+`ifndef MASTER1_OPERATIONS_COUNT
+ `error_MASTER1_OPERATIONS_COUNT_must_be_defined
+; /* Cause syntax error */
+`endif
+
+`ifndef SIMULATION
+ `error_SIMULATION_not_defined
+; /* Cause syntax error */
+`endif
+
+module master_arbiter_test();
+   wire        M0_ACK_I;
+   wire [19:0] M0_ADR_O;
+   wire [15:0] M0_DAT_I;
+   wire [15:0] M0_DAT_O;
+   wire        M0_STB_O;
+   wire        M0_CYC_O;
+   wire        M0_WE_O;
+   wire        M0_STALL_I;
+
+   wire        M1_ACK_I;
+   wire [19:0] M1_ADR_O;
+   wire [15:0] M1_DAT_I;
+   wire [15:0] M1_DAT_O;
+   wire        M1_STB_O;
+   wire        M1_CYC_O;
+   wire        M1_WE_O;
+   wire        M1_STALL_I;
+
+   wire        S_ACK_O;
+   wire [19:0] S_ADR_I;
+   wire [15:0] S_DAT_I;
+   wire [15:0] S_DAT_O;
+   wire        S_STB_I;
+   wire        S_WE_I;
+   wire        S_STALL_O;
+
+   wire        M_COMBINED_ACK_I;
+   wire        M_COMBINED_CLK_I;
+   wire [19:0] M_COMBINED_ADR_O;
+   wire [15:0] M_COMBINED_DAT_I;
+   wire [15:0] M_COMBINED_DAT_O;
+   wire        M_COMBINED_RST_I;
+   wire        M_COMBINED_STB_O;
+   wire        M_COMBINED_CYC_O;
+   wire        M_COMBINED_WE_O;
+   wire        M_COMBINED_STALL_I;
+
+   reg 	       CLK;
+   reg 	       RST;
+
+   /* Non-wishbone */
+   wire        M0_finished;
+   wire        M1_finished;
+
+   master_model
+     #(
+       .MASTER_NR(0),
+       .WORD_SIZE(2),
+       .ADR_BITS(20),
+       .OPERATIONS_FILE("operations0.mem"),
+       .OPERATIONS_COUNT(`MASTER0_OPERATIONS_COUNT)
+       ) master0
+       (
+	.ACK_I(M0_ACK_I),
+ 	.CLK_I(CLK),
+	.ADR_O(M0_ADR_O),
+	.DAT_I(M0_DAT_I),
+	.DAT_O(M0_DAT_O),
+ 	.RST_I(RST),
+	.STB_O(M0_STB_O),
+	.CYC_O(M0_CYC_O),
+	.WE_O(M0_WE_O),
+ 	.STALL_I(M0_STALL_I),
+
+	.finished(M0_finished)
+	);
+
+   master_model
+     #(
+       .MASTER_NR(1),
+       .WORD_SIZE(2),
+       .ADR_BITS(20),
+       .OPERATIONS_FILE("operations1.mem"),
+       .OPERATIONS_COUNT(`MASTER1_OPERATIONS_COUNT)
+       ) master1
+       (
+	.ACK_I(M1_ACK_I),
+ 	.CLK_I(CLK),
+	.ADR_O(M1_ADR_O),
+	.DAT_I(M1_DAT_I),
+	.DAT_O(M1_DAT_O),
+ 	.RST_I(RST),
+	.STB_O(M1_STB_O),
+	.CYC_O(M1_CYC_O),
+	.WE_O(M1_WE_O),
+ 	.STALL_I(M1_STALL_I),
+
+	.finished(M1_finished)
+	);
+
+   memory_slave_model
+     #(
+       .SLAVE_NR(0),
+       .WORD_SIZE(2),
+       .ADR_BITS(20)
+       ) slave
+       (
+	.ACK_O(S_ACK_O),
+      	.CLK_I(CLK),
+	.ADR_I(S_ADR_I),
+	.DAT_I(S_DAT_I),
+	.DAT_O(S_DAT_O),
+      	.RST_I(RST),
+      	.STB_I(S_STB_I),
+      	.WE_I(S_WE_I),
+	.STALL_O(S_STALL_O)
+	);
+
+   master_arbiter arbiter
+     (
+      .CLK(CLK),
+      .RST(RST),
+
+      .M0_ACK_I(M0_ACK_I),
+      .M0_ADR_O(M0_ADR_O),
+      .M0_DAT_I(M0_DAT_I),
+      .M0_DAT_O(M0_DAT_O),
+      .M0_STB_O(M0_STB_O),
+      .M0_CYC_O(M0_CYC_O),
+      .M0_WE_O(M0_WE_O),
+      .M0_STALL_I(M0_STALL_I),
+
+      .M1_ACK_I(M1_ACK_I),
+      .M1_ADR_O(M1_ADR_O),
+      .M1_DAT_I(M1_DAT_I),
+      .M1_DAT_O(M1_DAT_O),
+      .M1_STB_O(M1_STB_O),
+      .M1_CYC_O(M1_CYC_O),
+      .M1_WE_O(M1_WE_O),
+      .M1_STALL_I(M1_STALL_I),
+
+      .M_COMBINED_ACK_I(M_COMBINED_ACK_I),
+      .M_COMBINED_ADR_O(M_COMBINED_ADR_O),
+      .M_COMBINED_DAT_I(M_COMBINED_DAT_I),
+      .M_COMBINED_DAT_O(M_COMBINED_DAT_O),
+      .M_COMBINED_STB_O(M_COMBINED_STB_O),
+      .M_COMBINED_CYC_O(M_COMBINED_CYC_O),
+      .M_COMBINED_WE_O(M_COMBINED_WE_O),
+      .M_COMBINED_STALL_I(M_COMBINED_STALL_I)
+   );
+
+   assign M_COMBINED_ACK_I = S_ACK_O;
+   assign M_COMBINED_DAT_I = S_DAT_O;
+   assign M_COMBINED_STALL_I = S_STALL_O;
+
+   assign S_ADR_I = M_COMBINED_ADR_O[19:0];
+   assign S_DAT_I = M_COMBINED_DAT_O;
+   assign S_STB_I = M_COMBINED_STB_O && M_COMBINED_CYC_O;
+   assign S_WE_I = M_COMBINED_WE_O;
+
+   integer     i;
+
+   initial begin
+      CLK <= 0;
+      RST <= 1;
+
+      for (i = 0; i < 1000; i++) begin
+	 #1;
+
+	 CLK <= ~CLK;
+
+	 if (CLK)
+	   RST <= 0;
+
+	 if (M0_finished && M1_finished)
+	   $finish;
+      end
+
+      if (!M0_finished)
+	$display("error: master 0 hasn't finished its operations in 500 ticks");
+
+      if (!M1_finished)
+	$display("error: master 1 hasn't finished its operations in 500 ticks");
+
+      $finish;
+   end
+endmodule // master_arbiter_test