From ee1f6c47e1eff920068f4bceaf604f9535a2e8a9 Mon Sep 17 00:00:00 2001 From: Wojciech Kosior Date: Tue, 1 Sep 2020 10:54:59 +0200 Subject: start anew --- design/intercon.v | 142 ++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 142 insertions(+) create mode 100644 design/intercon.v (limited to 'design/intercon.v') diff --git a/design/intercon.v b/design/intercon.v new file mode 100644 index 0000000..bf908af --- /dev/null +++ b/design/intercon.v @@ -0,0 +1,142 @@ +`default_nettype none + +module intercon + ( + input wire CLK, + input wire RST, + + input wire S0_ACK_O, + output wire S0_CLK_I, + output wire [17:0] S0_ADR_I, + output wire [15:0] S0_DAT_I, + input wire [15:0] S0_DAT_O, + output wire S0_RST_I, + output wire S0_STB_I, + output wire S0_WE_I, + input wire S0_STALL_O, + + input wire S1_ACK_O, + output wire S1_CLK_I, + output wire [17:0] S1_ADR_I, + output wire [15:0] S1_DAT_I, + input wire [15:0] S1_DAT_O, + output wire S1_RST_I, + output wire S1_STB_I, + output wire S1_WE_I, + input wire S1_STALL_O, + + input wire S2_ACK_O, + output wire S2_CLK_I, + output wire [17:0] S2_ADR_I, + output wire [15:0] S2_DAT_I, + input wire [15:0] S2_DAT_O, + output wire S2_RST_I, + output wire S2_STB_I, + output wire S2_WE_I, + input wire S2_STALL_O, + + input wire S3_ACK_O, + output wire S3_CLK_I, + output wire [17:0] S3_ADR_I, + output wire [15:0] S3_DAT_I, + input wire [15:0] S3_DAT_O, + output wire S3_RST_I, + output wire S3_STB_I, + output wire S3_WE_I, + input wire S3_STALL_O, + + output wire M_ACK_I, + output wire M_CLK_I, + input wire [19:0] M_ADR_O, + input wire [15:0] M_DAT_O, + output wire [15:0] M_DAT_I, + output wire M_RST_I, + input wire M_STB_O, + input wire M_CYC_O, + input wire M_WE_O, + output wire M_STALL_I + ); + + wire [0:3] acks; + wire [0:3] stalls; + wire [15:0] datas [0:3]; + assign acks = {S0_ACK_O, S1_ACK_O, S2_ACK_O, S3_ACK_O}; + assign stalls = {S0_STALL_O, S1_STALL_O, S2_STALL_O, S3_STALL_O}; + assign datas[0] = S0_DAT_O; + assign datas[1] = S1_DAT_O; + assign datas[2] = S2_DAT_O; + assign datas[3] = S3_DAT_O; + + reg [1:0] commands_awaiting; + reg [1:0] slave_last_accessed; + + wire operation_requested; + wire working; + wire [1:0] slave_accessed; + wire slave_switch; + wire [1:0] commands_awaiting_next_tick; + assign operation_requested = M_STB_O && M_CYC_O; + assign working = commands_awaiting || operation_requested; + assign slave_accessed = commands_awaiting ? slave_last_accessed : + M_ADR_O[19:18]; + assign M_ACK_I = acks[slave_accessed] && working; + assign M_DAT_I = datas[slave_accessed]; + assign slave_switch = slave_accessed != M_ADR_O[19:18]; + assign M_STALL_I = stalls[slave_accessed] || slave_switch || + (commands_awaiting == 3 && !M_ACK_I); + assign commands_awaiting_next_tick + = commands_awaiting - M_ACK_I + (operation_requested && !M_STALL_I); + +`ifdef SIMULATION + /* anything could be latched here, this is just to avoid undefined values */ + initial begin + slave_last_accessed <= 0; + commands_awaiting <= 2; /* It is supposed to be driven low by RST */ + end +`endif + + always @ (posedge CLK) begin + slave_last_accessed <= slave_accessed; + + if (RST) + commands_awaiting <= 0; + else + commands_awaiting <= commands_awaiting_next_tick; + end + + assign S0_CLK_I = CLK; + assign S1_CLK_I = CLK; + assign S2_CLK_I = CLK; + assign S3_CLK_I = CLK; + assign M_CLK_I = CLK; + + assign S0_RST_I = RST; + assign S1_RST_I = RST; + assign S2_RST_I = RST; + assign S3_RST_I = RST; + assign M_RST_I = RST; + + assign S0_ADR_I = M_ADR_O[17:0]; + assign S1_ADR_I = M_ADR_O[17:0]; + assign S2_ADR_I = M_ADR_O[17:0]; + assign S3_ADR_I = M_ADR_O[17:0]; + + assign S0_DAT_I = M_DAT_O; + assign S1_DAT_I = M_DAT_O; + assign S2_DAT_I = M_DAT_O; + assign S3_DAT_I = M_DAT_O; + + wire pass_strobe; + assign pass_strobe = operation_requested && !slave_switch && + (commands_awaiting != 3 || M_ACK_I); + + assign S0_STB_I = slave_accessed == 0 && pass_strobe; + assign S1_STB_I = slave_accessed == 1 && pass_strobe; + assign S2_STB_I = slave_accessed == 2 && pass_strobe; + assign S3_STB_I = slave_accessed == 3 && pass_strobe; + + assign S0_WE_I = M_WE_O; + assign S1_WE_I = M_WE_O; + assign S2_WE_I = M_WE_O; + assign S3_WE_I = M_WE_O; +endmodule // intercon -- cgit v1.2.3