final_test_id.txt

`include "defines.vh"
module ID(
    input wire clk,
    input wire rst,
    // input wire flush,
    input wire [`StallBus-1:0] stall,
    
    output wire stallreq,

    input wire [`IF_TO_ID_WD-1:0] if_to_id_bus,

    input wire [31:0] inst_sram_rdata,

    input wire [`WB_TO_RF_WD-1:0] wb_to_rf_bus,

    output wire [`ID_TO_EX_WD-1:0] id_to_ex_bus,

    output wire [`BR_WD-1:0] br_bus,
    input wire [4:0] ex_rf_waddr,
    input wire [4:0] mem_rf_waddr,
    input wire [31:0] ex_rf_data,
    input wire [31:0] mem_rf_wdata,
    input wire mem_rf_we,
    input wire ex_rf_we,
    input wire[5:0] ex_opcode,
    input wire [65:0]mul_div_res_bus
);

    reg [`IF_TO_ID_WD-1:0] if_to_id_bus_r;
    wire [31:0] inst;
    wire [31:0] id_pc;
    wire ce;

    wire wb_rf_we;
    wire [4:0] wb_rf_waddr;
    wire [31:0] wb_rf_wdata;

    always @ (posedge clk) begin
        if (rst) begin
            if_to_id_bus_r <= `IF_TO_ID_WD'b0;        
        end
        // else if (flush) begin
        //     ic_to_id_bus <= `IC_TO_ID_WD'b0;
        // end
        else if (stall[1]==`Stop && stall[2]==`NoStop) begin
            if_to_id_bus_r <= `IF_TO_ID_WD'b0;
        end
        else if (stall[1]==`NoStop) begin
            if_to_id_bus_r <= if_to_id_bus;
        end
    end
    reg ifstall;
        always @ (posedge clk) begin
        if (stall[1]) begin
            ifstall <=1'b1;        
        end
        else begin
            ifstall <=1'b0;
        end
    end
    assign inst = ifstall ? inst : inst_sram_rdata;
    assign {
        ce,
        id_pc
    } = if_to_id_bus_r;
    assign {
        wb_rf_we,
        wb_rf_waddr,
        wb_rf_wdata
    } = wb_to_rf_bus;

    wire [5:0] opcode;
    wire [4:0] rs,rt,rd,sa;
    wire [5:0] func;
    wire [15:0] imm;
    wire [25:0] instr_index;
    wire [19:0] code;
    wire [4:0] base;
    wire [15:0] offset;
    wire [2:0] sel;

    wire [63:0] op_d, func_d;
    wire [31:0] rs_d, rt_d, rd_d, sa_d;

    wire [2:0] sel_alu_src1;
    wire [3:0] sel_alu_src2;
    wire [11:0] alu_op;

    wire data_ram_en;
    wire [3:0] data_ram_sel;
    
    wire rf_we;
    wire [4:0] rf_waddr;
    wire sel_rf_res;
    wire [2:0] sel_rf_dst;

    wire [31:0] rdata1, rdata2,rdata1_r,rdata2_r;
    wire [31:0] hi_o,lo_o;
    wire [31:0] hi_i, lo_i, hi_i_exr, lo_i_exr;
    wire hi_we_exr, lo_we_exr, hi_we, lo_we;
    
    assign {
           hi_we_exr,
           lo_we_exr,
           hi_i_exr,
           lo_i_exr
    } = mul_div_res_bus;
    
    assign hi_we = inst_mthi ? 1'b1 : hi_we_exr;
    assign lo_we = inst_mtlo ? 1'b1 : lo_we_exr;
    assign hi_i = inst_mthi ? rdata1 : hi_i_exr;
     assign lo_i = inst_mtlo ? rdata1 : lo_i_exr;

    regfile u_regfile(
    	.clk    (clk    ),
        .raddr1 (rs ),
        .rdata1 (rdata1_r ),
        .raddr2 (rt ),
        .rdata2 (rdata2_r ),
        .we     (wb_rf_we     ),
        .waddr  (wb_rf_waddr  ),
        .wdata  (wb_rf_wdata  ),
        .hi_i   (hi_i),
        .lo_i   (lo_i),
        .hi_we  (hi_we),
        .lo_we  (lo_we),
        .hi_o   (hi_o),
        .lo_o   (lo_o)
    );
    
    assign opcode = inst[31:26];
    assign rs = inst[25:21];
    assign rt = inst[20:16];
    assign rd = inst[15:11];
    assign sa = inst[10:6];
    assign func = inst[5:0];
    assign imm = inst[15:0];
    assign instr_index = inst[25:0];
    assign code = inst[25:6];
    assign base = inst[25:21];
    assign offset = inst[15:0];
    assign sel = inst[2:0];
    assign rdata1 = ((rs==ex_rf_waddr)&&(ex_rf_we)) ? ex_rf_data :
                      ((inst_mfhi & hi_we) ? hi_i : 
                      ((inst_mfhi & ~hi_we) ? hi_o : 
                         (((rs==mem_rf_waddr)&&(mem_rf_we)) ? mem_rf_wdata : 
                            (((rs==wb_rf_waddr)&&(wb_rf_we)) ? wb_rf_wdata : rdata1_r))));
    assign rdata2 = ((rt==ex_rf_waddr)&&(ex_rf_we)) ? ex_rf_data :
                      ((inst_mflo & lo_we) ?  lo_i : 
                        ((inst_mflo & ~lo_we) ? lo_o : 
                           (((rt==mem_rf_waddr)&&(mem_rf_we)) ? mem_rf_wdata : 
                            (((rt==wb_rf_waddr)&&(wb_rf_we)) ? wb_rf_wdata : rdata2_r))));
                            
                            
    
    wire inst_ori, inst_lui, inst_addiu, inst_beq, inst_subu, inst_jr, inst_jal, inst_addu, inst_bne, inst_sll, inst_or;
    wire inst_sw, inst_lw, inst_xor, inst_sltu, inst_slt, inst_slti, inst_sltiu, inst_j, inst_add, inst_addi, inst_sub;
    wire inst_and, inst_andi, inst_nor, inst_xori, inst_sllv ,inst_sra, inst_srav , inst_srl , inst_srlv ,inst_bgez;
    wire inst_bgtz, inst_blez, inst_bltz, inst_bltzal, inst_bgezal ,inst_jalr ,inst_div ,inst_mflo, inst_mfhi, inst_divu;
    wire inst_mult, inst_multu,inst_mthi,inst_mtlo, inst_lb, inst_lbu, inst_lh, inst_lhu, inst_sb, inst_sh, inst_lsa;
    
    wire op_add, op_sub, op_slt, op_sltu;
    wire op_and, op_nor, op_or, op_xor;
    wire op_sll, op_srl, op_sra, op_lui;
    wire op_mul, op_div, mul_div_signed;

    decoder_6_64 u0_decoder_6_64(
    	.in  (opcode  ),
        .out (op_d )
    );

    decoder_6_64 u1_decoder_6_64(
    	.in  (func  ),
        .out (func_d )
    );
    
    decoder_5_32 u0_decoder_5_32(
    	.in  (rs  ),
        .out (rs_d )
    );

    decoder_5_32 u1_decoder_5_32(
    	.in  (rt  ),
        .out (rt_d )
    );

    
    assign inst_ori     = op_d[6'b00_1101];
    assign inst_lui     = op_d[6'b00_1111];
    assign inst_addiu   = op_d[6'b00_1001];
    assign inst_beq     = op_d[6'b00_0100];
    assign inst_subu    = op_d[6'b00_0000] & func_d[6'b10_0011];
    assign inst_jr      = op_d[6'b00_0000] & func_d[6'b00_1000];
    assign inst_jal     = op_d[6'b00_0011];
    assign inst_addu    = op_d[6'b00_0000] & func_d[6'b10_0001];
    assign inst_bne     = op_d[6'b00_0101];
    assign inst_sll     = op_d[6'b00_0000] & func_d[6'b00_0000];
    assign inst_or      = op_d[6'b00_0000] & func_d[6'b10_0101];
    assign inst_sw      = op_d[6'b10_1011];
    assign inst_lw      = op_d[6'b10_0011];
    assign inst_xor     = op_d[6'b00_0000] & func_d[6'b10_0110];
    assign inst_sltu    = op_d[6'b00_0000] & func_d[6'b10_1011];
    assign inst_slt     = op_d[6'b00_0000] & func_d[6'b10_1010];
    assign inst_slti    = op_d[6'b00_1010];
    assign inst_sltiu   = op_d[6'b00_1011];
    assign inst_j       = op_d[6'b00_0010];
    assign inst_add     = op_d[6'b00_0000] & func_d[6'b10_0000];
    assign inst_addi    = op_d[6'b00_1000];
    assign inst_sub     = op_d[6'b00_0000] & func_d[6'b10_0010];
    assign inst_and     = op_d[6'b00_0000] & func_d[6'b10_0100];
    assign inst_andi    = op_d[6'b00_1100];
    assign inst_nor     = op_d[6'b00_0000] & func_d[6'b10_0111];
    assign inst_xori    = op_d[6'b00_1110];
    assign inst_sllv    = op_d[6'b00_0000] & func_d[6'b00_0100];
    assign inst_sra     = op_d[6'b00_0000] & func_d[6'b00_0011];
    assign inst_srav    = op_d[6'b00_0000] & func_d[6'b00_0111];
    assign inst_srl     = op_d[6'b00_0000] & func_d[6'b00_0010];
    assign inst_srlv    = op_d[6'b00_0000] & func_d[6'b00_0110];
    assign inst_bgez    = op_d[6'b00_0001] & (rt==5'b00_001);
    assign inst_bgtz    = op_d[6'b00_0111] & (rt==5'b00_000); 
    assign inst_blez    = op_d[6'b00_0110] & (rt==5'b00_000); 
    assign inst_bltz    = op_d[6'b00_0001] & (rt==5'b00_000);
    assign inst_bltzal  = op_d[6'b00_0001] & (rt==5'b10_000);
    assign inst_bgezal  = op_d[6'b00_0001] & (rt==5'b10_001);
    assign inst_jalr    = op_d[6'b00_0000] & func_d[6'b00_1001];
    assign inst_div     = op_d[6'b00_0000] & func_d[6'b01_1010];
    assign inst_mflo    = op_d[6'b00_0000] & func_d[6'b01_0010];
    assign inst_mfhi    = op_d[6'b00_0000] & func_d[6'b01_0000];
    assign inst_divu    = op_d[6'b00_0000] & func_d[6'b01_1011];
    assign inst_mult    = op_d[6'b00_0000] & func_d[6'b01_1000];
    assign inst_multu    = op_d[6'b00_0000] & func_d[6'b01_1001];
    assign inst_mthi     = op_d[6'b00_0000] & func_d[6'b01_0001];
    assign inst_mtlo     = op_d[6'b00_0000] & func_d[6'b01_0011];
    assign inst_lb       = op_d[6'b10_0000];
    assign inst_lbu      = op_d[6'b10_0100];
    assign inst_lh       = op_d[6'b10_0001];
    assign inst_lhu      = op_d[6'b10_0101];
    assign inst_sb       = op_d[6'b10_1000];
    assign inst_sh       = op_d[6'b10_1001];
    assign inst_lsa      = op_d[6'b01_1100] & func_d[6'b11_0111];
    
    
    
    
    
    
    
    // rs to reg1
    assign sel_alu_src1[0] = inst_ori | inst_addiu | inst_subu  | inst_addu   
                             | inst_or | inst_sw | inst_lw | inst_xor | inst_sltu | inst_slt 
                             | inst_slti | inst_sltiu | inst_add | inst_addi | inst_sub | inst_and 
                             | inst_andi | inst_nor | inst_xori | inst_sllv | inst_srav |inst_srlv
                             |inst_div |inst_divu | inst_lb | inst_lbu | inst_lh | inst_lhu 
                             | inst_sb | inst_sh ;

    // pc to reg1
    assign sel_alu_src1[1] = inst_jal |inst_bltzal |inst_bgezal| inst_jalr;//

    // sa_zero_extend to reg1
    assign sel_alu_src1[2] = inst_sll | inst_sra | inst_srl;

    
    // rt to reg2
    assign sel_alu_src2[0] = inst_subu | inst_addu | inst_sll | inst_or | inst_xor | inst_sltu
                             | inst_slt | inst_add | inst_sub | inst_and | inst_nor | inst_sllv
                             | inst_sra | inst_srav |inst_srl |inst_srlv| inst_div |inst_divu ;
    
    // imm_sign_extend to reg2
    assign sel_alu_src2[1] = inst_lui | inst_addiu | inst_sw | inst_lw | inst_slti | inst_sltiu 
                             | inst_addi | inst_lb | inst_lbu | inst_lh | inst_lhu | inst_sb | inst_sh;

    // 32'b8 to reg2
    assign sel_alu_src2[2] = inst_jal |inst_bltzal |inst_bgezal| inst_jalr;//

    // imm_zero_extend to reg2
    assign sel_alu_src2[3] = inst_ori | inst_andi | inst_xori;



    assign op_add = inst_addiu | inst_jal | inst_addu | inst_sw | inst_lw | inst_add |
                    inst_addi |inst_bltzal |inst_bgezal| inst_jalr | inst_lb | inst_lbu |
                    inst_lh | inst_lhu | inst_sb | inst_sh;
    assign op_sub = inst_subu | inst_sub;
    assign op_slt = inst_slt | inst_slti;
    assign op_sltu = inst_sltu | inst_sltiu;
    assign op_and = inst_and | inst_andi;
    assign op_nor = inst_nor;
    assign op_or = inst_ori | inst_or;
    assign op_xor = inst_xor | inst_xori;
    assign op_sll = inst_sll | inst_sllv;
    assign op_srl = inst_srl |inst_srlv;
    assign op_sra = inst_sra | inst_srav;
    assign op_lui = inst_lui;
    assign op_mul = inst_mult |inst_multu;
    assign op_div = inst_div |inst_divu;
    assign mul_div_signed= inst_div |inst_mult;

    assign alu_op = {op_add, op_sub, op_slt, op_sltu,
                     op_and, op_nor, op_or, op_xor,
                     op_sll, op_srl, op_sra, op_lui};



    // load and store enable
    assign data_ram_en = inst_sw | inst_lw | inst_lb | inst_lbu | inst_lh | inst_lhu 
                         | inst_sb | inst_sh;

    // write enable
    wire real_data_ram_wen;
    
    assign real_data_ram_wen = inst_sw | inst_sb | inst_sh;
    assign data_ram_sel[0] = inst_lw | inst_sw;  //w
    assign data_ram_sel[1] = inst_lh | inst_lhu | inst_sh;  //h
    assign data_ram_sel[2] = inst_lb | inst_lbu | inst_sb;  //b
    assign data_ram_sel[3] = inst_lb | inst_lh;  // load sign ext



    // regfile sotre enable
    assign rf_we = inst_ori | inst_lui | inst_addiu | inst_jal | inst_subu | inst_addu | inst_sll 
                   | inst_or | inst_lw | inst_xor | inst_sltu | inst_slt | inst_slti | inst_sltiu 
                   | inst_add | inst_addi | inst_sub | inst_and | inst_andi | inst_nor | inst_xori
                   | inst_sllv |inst_sra | inst_srav | inst_srl |inst_srlv |inst_bltzal |inst_bgezal
                   | inst_jalr |inst_mflo |inst_mfhi | inst_lb | inst_lbu | inst_lh | inst_lhu | inst_lsa;



    // store in [rd]
    assign sel_rf_dst[0] = inst_subu | inst_addu | inst_sll | inst_or | inst_xor | inst_sltu | inst_slt 
                           | inst_add | inst_sub | inst_and | inst_nor| inst_sllv |inst_sra | inst_srav| inst_srl
                           | inst_srlv| inst_jalr |inst_mflo |inst_mfhi | inst_lsa;
    // store in [rt] 
    assign sel_rf_dst[1] = inst_ori | inst_lui | inst_addiu | inst_lw | inst_slti | inst_sltiu | inst_addi 
                           | inst_andi | inst_xori | inst_lb | inst_lbu | inst_lh | inst_lhu;
    // store in [31]
    assign sel_rf_dst[2] = inst_jal |inst_bltzal |inst_bgezal;

    // sel for regfile address
    assign rf_waddr = {5{sel_rf_dst[0]}} & rd 
                    | {5{sel_rf_dst[1]}} & rt
                    | {5{sel_rf_dst[2]}} & 32'd31;

    // 0 from alu_res ; 1 from ld_res
    assign sel_rf_res = inst_lw | inst_lb | inst_lbu | inst_lh | inst_lhu; 

    assign id_to_ex_bus = {
        real_data_ram_wen,
        mul_div_signed,  //161
        op_mul,         //160
        op_div,         //159
        id_pc,          // 158:127
        inst,           // 126:95
        alu_op,         // 94:83
        sel_alu_src1,   // 82:80
        sel_alu_src2,   // 79:76
        data_ram_en,    // 75
        data_ram_sel,   // 74:71
        rf_we,          // 70
        rf_waddr,       // 69:65
        sel_rf_res,     // 64
        rdata1,         // 63:32
        rdata2          // 31:0
    };


    wire br_e;
    wire [31:0] br_addr;
    wire rs_eq_rt;
    wire rs_ge_z;
    wire rs_gt_z;
    wire rs_le_z;
    wire rs_lt_z;
    wire [31:0] pc_plus_4;
    wire caddr1_f;  //flag:address=pc_plus_4 + {{14{inst[15]}},inst[15:0],2'b0}
    wire caddr2_f;  //flag:address=rs
    wire [31:0]caddr1;
    wire [31:0]caddr3;// {pc_plus_4[31:28],inst[25:0],2'b0}
    assign caddr1 = pc_plus_4 + {{14{inst[15]}},inst[15:0],2'b0};  //
    assign caddr3 = {pc_plus_4[31:28],inst[25:0],2'b0};//
    assign caddr1_f = inst_beq | inst_bne |inst_bgez |inst_bgtz |inst_blez |inst_bltz |inst_bltzal |inst_bgezal;        //
    assign caddr2_f = inst_jr |inst_jalr;    //
    
    assign pc_plus_4 = id_pc + 32'h4;

    assign rs_eq_rt = (rdata1 == rdata2);
    assign rs_ge_z = ~rdata1 [31];
    assign rs_gt_z =  ~rdata1[31] & ~(rdata1 == 32'b0);
    assign rs_le_z =  rdata1[31] | (rdata1 == 32'b0);
    assign rs_lt_z =  rdata1[31];
    
    assign br_e = (inst_beq & rs_eq_rt) | inst_jr | inst_jal | (inst_bne & ~rs_eq_rt) | inst_j | (inst_bgez & rs_ge_z) |(inst_bgtz &  rs_gt_z)
                   |(inst_blez & rs_le_z) |(inst_bltz & rs_lt_z) |(inst_bltzal & rs_lt_z) |(inst_bgezal & rs_ge_z) |inst_jalr;  //
    assign br_addr = caddr1_f ? caddr1 : (caddr2_f ? rdata1 : caddr3);  //

    assign br_bus = {
        br_e,
        br_addr
    };
    
    wire is_load;
    assign is_load = (ex_opcode == 6'b10_0011); 
    wire load_stall;
    assign load_stall = ((ex_rf_waddr == rs)|(ex_rf_waddr == rt));
    assign stallreq = (is_load & load_stall);
    





endmodule