system.v

   1 `define BUS_ICACHE 1
   2 `define BUS_DCACHE 0
   3
   4 module System(input clk);
   5         wire [7:0] bus_req;
   6         wire [7:0] bus_ack;
   7         wire [31:0] bus_addr;
   8         wire [31:0] bus_rdata;
   9         wire [31:0] bus_wdata;
  10         wire bus_rd, bus_wr;
  11         wire bus_ready;
  12
  13         wire bus_req_icache;
  14         wire bus_req_dcache;
  15         assign bus_req = {6'b0, bus_req_icache, bus_req_dcache};
  16         wire bus_ack_icache = bus_ack[`BUS_ICACHE];
  17         wire bus_ack_dcache = bus_ack[`BUS_DCACHE];
  18
  19         wire [31:0] bus_addr_icache;
  20         wire [31:0] bus_wdata_icache;
  21         wire bus_rd_icache;
  22         wire bus_wr_icache;
  23
  24         wire [31:0] bus_addr_dcache;
  25         wire [31:0] bus_wdata_dcache;
  26         wire bus_rd_dcache;
  27         wire bus_wr_dcache;
  28
  29         wire [31:0] bus_rdata_blockram;
  30         wire bus_ready_blockram;
  31
  32         assign bus_addr = bus_addr_icache | bus_addr_dcache;
  33         assign bus_rdata = bus_rdata_blockram;
  34         assign bus_wdata = bus_wdata_icache | bus_wdata_dcache;
  35         assign bus_rd = bus_rd_icache | bus_rd_dcache;
  36         assign bus_wr = bus_wr_icache | bus_wr_dcache;
  37         assign bus_ready = bus_ready_blockram;
  38
  39         wire [31:0] icache_rd_addr;
  40         wire icache_rd_req;
  41         wire icache_rd_wait;
  42         wire [31:0] icache_rd_data;
  43
  44         wire [31:0] dcache_addr;
  45         wire dcache_rd_req, dcache_wr_req;
  46         wire dcache_rw_wait;
  47         wire [31:0] dcache_wr_data, dcache_rd_data;
  48
  49         wire [31:0] decode_out_op0, decode_out_op1, decode_out_op2, decode_out_spsr, decode_out_cpsr;
  50         wire decode_out_carry;
  51
  52         wire [3:0] regfile_read_0, regfile_read_1, regfile_read_2, regfile_read_3;
  53         wire [31:0] regfile_rdata_0, regfile_rdata_1, regfile_rdata_2, regfile_rdata_3, regfile_spsr;
  54         wire regfile_write;
  55         wire [3:0] regfile_write_reg;
  56         wire [31:0] regfile_write_data;
  57
  58         wire execute_out_write_reg;
  59         wire [3:0] execute_out_write_num;
  60         wire [31:0] execute_out_write_data;
  61         wire [31:0] execute_out_op0, execute_out_op1, execute_out_op2;
  62         wire [31:0] execute_out_cpsr, execute_out_spsr;
  63         wire execute_out_cpsrup;
  64
  65         wire jmp_out_execute, jmp_out_writeback;
  66         wire [31:0] jmppc_out_execute, jmppc_out_writeback;
  67         wire jmp = jmp_out_execute | jmp_out_writeback;
  68         wire [31:0] jmppc = jmppc_out_execute | jmppc_out_writeback;
  69
  70         wire memory_out_write_reg;
  71         wire [3:0] memory_out_write_num;
  72         wire [31:0] memory_out_write_data;
  73         wire [31:0] memory_out_cpsr, memory_out_spsr;
  74         wire memory_out_cpsrup;
  75
  76         wire [31:0] writeback_out_cpsr, writeback_out_spsr;
  77
  78         wire cp_ack_terminal;
  79         wire cp_busy_terminal;
  80         wire [31:0] cp_read_terminal;
  81
  82         wire cp_req;
  83         wire [31:0] cp_insn;
  84         wire cp_ack = cp_ack_terminal;
  85         wire cp_busy = cp_busy_terminal;
  86         wire cp_rnw;
  87         wire [31:0] cp_read = cp_read_terminal;
  88         wire [31:0] cp_write;
  89
  90         wire stall_cause_issue;
  91         wire stall_cause_execute;
  92         wire stall_cause_memory;
  93         wire bubble_out_fetch;
  94         wire bubble_out_issue;
  95         wire bubble_out_execute;
  96         wire bubble_out_memory;
  97         wire [31:0] insn_out_fetch;
  98         wire [31:0] insn_out_issue;
  99         wire [31:0] insn_out_execute;
 100         wire [31:0] insn_out_memory;
 101         wire [31:0] pc_out_fetch;
 102         wire [31:0] pc_out_issue;
 103         wire [31:0] pc_out_execute;
 104         wire [31:0] pc_out_memory;
 105
 106         wire execute_out_backflush;
 107         wire writeback_out_backflush;
 108
 109         BusArbiter busarbiter(.bus_req(bus_req), .bus_ack(bus_ack));
 110
 111         ICache icache(
 112                 .clk(clk),
 113                 /* XXX reset? */
 114                 .rd_addr(icache_rd_addr), .rd_req(icache_rd_req),
 115                 .rd_wait(icache_rd_wait), .rd_data(icache_rd_data),
 116                 .bus_req(bus_req_icache), .bus_ack(bus_ack_icache),
 117                 .bus_addr(bus_addr_icache), .bus_rdata(bus_rdata),
 118                 .bus_wdata(bus_wdata_icache), .bus_rd(bus_rd_icache),
 119                 .bus_wr(bus_wr_icache), .bus_ready(bus_ready));
 120
 121         DCache dcache(
 122                 .clk(clk),
 123                 .addr(dcache_addr), .rd_req(dcache_rd_req), .wr_req(dcache_wr_req),
 124                 .rw_wait(dcache_rw_wait), .wr_data(dcache_wr_data), .rd_data(dcache_rd_data),
 125                 .bus_req(bus_req_dcache), .bus_ack(bus_ack_dcache),
 126                 .bus_addr(bus_addr_dcache), .bus_rdata(bus_rdata),
 127                 .bus_wdata(bus_wdata_dcache), .bus_rd(bus_rd_dcache),
 128                 .bus_wr(bus_wr_dcache), .bus_ready(bus_ready));
 129
 130         BlockRAM blockram(
 131                 .clk(clk),
 132                 .bus_addr(bus_addr), .bus_rdata(bus_rdata_blockram),
 133                 .bus_wdata(bus_wdata), .bus_rd(bus_rd), .bus_wr(bus_wr),
 134                 .bus_ready(bus_ready_blockram));
 135
 136         Fetch fetch(
 137                 .clk(clk),
 138                 .Nrst(1'b1 /* XXX */),
 139                 .rd_addr(icache_rd_addr), .rd_req(icache_rd_req),
 140                 .rd_wait(icache_rd_wait), .rd_data(icache_rd_data),
 141                 .stall(stall_cause_issue), .jmp(jmp), .jmppc(jmppc),
 142                 .bubble(bubble_out_fetch), .insn(insn_out_fetch),
 143                 .pc(pc_out_fetch));
 144
 145         Issue issue(
 146                 .clk(clk),
 147                 .Nrst(1'b1 /* XXX */),
 148                 .stall(stall_cause_execute), .flush(execute_out_backflush | writeback_out_backflush),
 149                 .inbubble(bubble_out_fetch), .insn(insn_out_fetch),
 150                 .inpc(pc_out_fetch), .cpsr(writeback_out_cpsr),
 151                 .outstall(stall_cause_issue), .outbubble(bubble_out_issue),
 152                 .outpc(pc_out_issue), .outinsn(insn_out_issue));
 153
 154         RegFile regfile(
 155                 .clk(clk),
 156                 .read_0(regfile_read_0), .read_1(regfile_read_1), .read_2(regfile_read_2), .read_3(regfile_read_3),
 157                 .rdata_0(regfile_rdata_0), .rdata_1(regfile_rdata_1), .rdata_2(regfile_rdata_2), .rdata_3(regfile_rdata_3),
 158                 .spsr(regfile_spsr),
 159                 .write(regfile_write), .write_reg(regfile_write_reg), .write_data(regfile_write_data));
 160
 161         Decode decode(
 162                 .clk(clk),
 163                 .stall(stall_cause_execute),
 164                 .insn(insn_out_fetch), .inpc(pc_out_fetch), .incpsr(writeback_out_cpsr), .inspsr(writeback_out_spsr),
 165                 .op0(decode_out_op0), .op1(decode_out_op1), .op2(decode_out_op2),
 166                 .carry(decode_out_carry), .outcpsr(decode_out_cpsr), .outspsr(decode_out_spsr),
 167                 .read_0(regfile_read_0), .read_1(regfile_read_1), .read_2(regfile_read_2),
 168                 .rdata_0(regfile_rdata_0), .rdata_1(regfile_rdata_1), .rdata_2(regfile_rdata_2));
 169
 170         Execute execute(
 171                 .clk(clk), .Nrst(1'b0),
 172                 .stall(stall_cause_memory), .flush(writeback_out_backflush),
 173                 .inbubble(bubble_out_issue), .pc(pc_out_issue), .insn(insn_out_issue),
 174                 .cpsr(decode_out_cpsr), .spsr(decode_out_spsr), .op0(decode_out_op0), .op1(decode_out_op1),
 175                 .op2(decode_out_op2), .carry(decode_out_carry),
 176                 .outstall(stall_cause_execute), .outbubble(bubble_out_execute),
 177                 .write_reg(execute_out_write_reg), .write_num(execute_out_write_num),
 178                 .write_data(execute_out_write_data),
 179                 .jmp(jmp_out_execute), .jmppc(jmppc_out_execute),
 180                 .outpc(pc_out_execute), .outinsn(insn_out_execute),
 181                 .outop0(execute_out_op0), .outop1(execute_out_op1), .outop2(execute_out_op2),
 182                 .outcpsr(execute_out_cpsr), .outspsr(execute_out_spsr), .outcpsrup(execute_out_cpsrup));
 183         assign execute_out_backflush = jmp;
 184
 185         assign cp_insn = insn_out_execute;
 186         Memory memory(
 187                 .clk(clk), .Nrst(1'b0),
 188                 /* stall? */ .flush(writeback_out_backflush),
 189                 .busaddr(dcache_addr), .rd_req(dcache_rd_req), .wr_req(dcache_wr_req),
 190                 .rw_wait(dcache_rw_wait), .wr_data(dcache_wr_data), .rd_data(dcache_rd_data),
 191                 .st_read(regfile_read_3), .st_data(regfile_rdata_3),
 192                 .inbubble(bubble_out_execute), .pc(pc_out_execute), .insn(insn_out_execute),
 193                 .op0(execute_out_op0), .op1(execute_out_op1), .op2(execute_out_op2),
 194                 .spsr(execute_out_spsr), .cpsr(execute_out_cpsr), .cpsrup(execute_out_cpsrup),
 195                 .write_reg(execute_out_write_reg), .write_num(execute_out_write_num), .write_data(execute_out_write_data),
 196                 .outstall(stall_cause_memory), .outbubble(bubble_out_memory),
 197                 .outpc(pc_out_memory), .outinsn(insn_out_memory),
 198                 .out_write_reg(memory_out_write_reg), .out_write_num(memory_out_write_num),
 199                 .out_write_data(memory_out_write_data),
 200                 .cp_req(cp_req), .cp_ack(cp_ack), .cp_busy(cp_busy), .cp_rnw(cp_rnw), .cp_read(cp_read), .cp_write(cp_write),
 201                 .outcpsr(memory_out_cpsr), .outspsr(memory_out_spsr), .outcpsrup(memory_out_cpsrup) /* XXX data_size */);
 202
 203         Terminal terminal(
 204                 .clk(clk),
 205                 .cp_req(cp_req), .cp_insn(cp_insn), .cp_ack(cp_ack_terminal), .cp_busy(cp_busy_terminal), .cp_rnw(cp_rnw),
 206                 .cp_read(cp_read_terminal), .cp_write(cp_write));
 207
 208         Writeback writeback(
 209                 .clk(clk),
 210                 .inbubble(bubble_out_memory),
 211                 .write_reg(memory_out_write_reg), .write_num(memory_out_write_num), .write_data(memory_out_write_data),
 212                 .cpsr(memory_out_cpsr), .spsr(memory_out_spsr), .cpsrup(memory_out_cpsrup),
 213                 .regfile_write(regfile_write), .regfile_write_reg(regfile_write_reg), .regfile_write_data(regfile_write_data),
 214                 .outcpsr(writeback_out_cpsr), .outspsr(writeback_out_spsr),
 215                 .jmp(jmp_out_writeback), .jmppc(jmppc_out_writeback));
 216         assign writeback_out_backflush = jmp_out_writeback;
 217
 218         reg [31:0] clockno = 0;
 219         always @(posedge clk)
 220         begin
 221                 clockno <= clockno + 1;
 222                 $display("------------------------------------------------------------------------------");
 223                 $display("%3d: FETCH:            Bubble: %d, Instruction: %08x, PC: %08x", clockno, bubble_out_fetch, insn_out_fetch, pc_out_fetch);
 224                 $display("%3d: ISSUE:  Stall: %d, Bubble: %d, Instruction: %08x, PC: %08x", clockno, stall_cause_issue, bubble_out_issue, insn_out_issue, pc_out_issue);
 225                 $display("%3d: DECODE:                      op0 %08x, op1 %08x, op2 %08x, carry %d", clockno, decode_out_op0, decode_out_op1, decode_out_op2, decode_out_carry);
 226                 $display("%3d: EXEC:   Stall: %d, Bubble: %d, Instruction: %08x, PC: %08x, Reg: %d, [%08x -> %d], Jmp: %d [%08x]", clockno, stall_cause_execute, bubble_out_execute, insn_out_execute, pc_out_execute, execute_out_write_reg, execute_out_write_data, execute_out_write_num, jmp_out_execute, jmppc_out_execute);
 227                 $display("%3d: MEMORY: Stall: %d, Bubble: %d, Instruction: %08x, PC: %08x, Reg: %d, [%08x -> %d]", clockno, stall_cause_memory, bubble_out_memory, insn_out_memory, pc_out_memory, memory_out_write_reg, memory_out_write_data, memory_out_write_num);
 228                 $display("%3d: WRITEB:                      CPSR %08x, SPSR %08x, Reg: %d [%08x -> %d], Jmp: %d [%08x]", clockno, writeback_out_cpsr, writeback_out_spsr, regfile_write, regfile_write_data, regfile_write_reg, jmp_out_writeback, jmppc_out_writeback);
 229         end
 230 endmodule