// ============================================================================
|
// ============================================================================
|
// (C) 2012 Robert Finch
|
// (C) 2012 Robert Finch
|
// All Rights Reserved.
|
// All Rights Reserved.
|
// robfinch<remove>@opencores.org
|
// robfinch<remove>@opencores.org
|
//
|
//
|
// Raptor64sc.v
|
// Raptor64sc.v
|
// - 64 bit CPU
|
// - 64 bit CPU
|
//
|
//
|
// This source file is free software: you can redistribute it and/or modify
|
// This source file is free software: you can redistribute it and/or modify
|
// it under the terms of the GNU Lesser General Public License as published
|
// it under the terms of the GNU Lesser General Public License as published
|
// by the Free Software Foundation, either version 3 of the License, or
|
// by the Free Software Foundation, either version 3 of the License, or
|
// (at your option) any later version.
|
// (at your option) any later version.
|
//
|
//
|
// This source file is distributed in the hope that it will be useful,
|
// This source file is distributed in the hope that it will be useful,
|
// but WITHOUT ANY WARRANTY; without even the implied warranty of
|
// but WITHOUT ANY WARRANTY; without even the implied warranty of
|
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
// GNU General Public License for more details.
|
// GNU General Public License for more details.
|
//
|
//
|
// You should have received a copy of the GNU General Public License
|
// You should have received a copy of the GNU General Public License
|
// along with this program. If not, see <http://www.gnu.org/licenses/>.
|
// along with this program. If not, see <http://www.gnu.org/licenses/>.
|
//
|
//
|
// ============================================================================
|
// ============================================================================
|
//
|
//
|
`define ADDRESS_RESERVATION 1
|
`define ADDRESS_RESERVATION 1
|
`define RAS_PREDICTION 1
|
`define RAS_PREDICTION 1
|
//`define FLOATING_POINT 1
|
//`define FLOATING_POINT 1
|
//`define BTB 1
|
//`define BTB 1
|
//`define TLB 1
|
//`define TLB 1
|
//`define BRANCH_PREDICTION_SIMPLE 1
|
//`define BRANCH_PREDICTION_SIMPLE 1
|
|
|
`define RESET_VECTOR 64'hFFFF_FFFF_FFFF_FFF0
|
`define RESET_VECTOR 64'hFFFF_FFFF_FFFF_FFF0
|
`define NMI_VECTOR 64'hFFFF_FFFF_FFFF_FFE0
|
`define NMI_VECTOR 64'hFFFF_FFFF_FFFF_FFE0
|
`define IRQ_VECTOR 64'hFFFF_FFFF_FFFF_FFD0
|
`define IRQ_VECTOR 64'hFFFF_FFFF_FFFF_FFD0
|
`define TRAP_VECTOR 64'h0000_0000_0000_0000
|
`define TRAP_VECTOR 64'h0000_0000_0000_0000
|
|
|
`define TLBMissPage 52'hFFFF_FFFF_FFFF_F
|
|
`define ITLB_MissHandler 64'hFFFF_FFFF_FFFF_FFC0
|
`define ITLB_MissHandler 64'hFFFF_FFFF_FFFF_FFC0
|
`define DTLB_MissHandler 64'hFFFF_FFFF_FFFF_FFB0
|
`define DTLB_MissHandler 64'hFFFF_FFFF_FFFF_FFB0
|
`define BERR_VECTOR 64'hFFFF_FFFF_FFFF_FFA0
|
|
|
|
`define GEN_TRAP_OFFSET 13'h0200
|
|
`define DBZ_TRAP_OFFSET 13'h0050
|
|
`define OFL_TRAP_OFFSET 13'h0070
|
|
`define PRIV_OFFSET 13'h0080
|
|
|
|
`define EX_NON 9'd000
|
`define EX_NON 9'd000
|
`define EX_TRAP 9'd32 // Trap exception
|
`define EX_TRAP 9'd32 // Trap exception
|
`define EX_IRQ 9'd449 // interrupt
|
`define EX_IRQ 9'd449 // interrupt
|
`define EX_DBZ 9'd488 // divide by zero
|
`define EX_DBZ 9'd488 // divide by zero
|
`define EX_OFL 9'd489 // overflow
|
`define EX_OFL 9'd489 // overflow
|
`define EX_PRIV 9'd496 // priviledge violation
|
`define EX_PRIV 9'd496 // priviledge violation
|
`define EX_TLBD 9'd506 // TLB exception - data
|
`define EX_TLBD 9'd506 // TLB exception - data
|
`define EX_TLBI 9'd507 // TLB exception - ifetch
|
`define EX_TLBI 9'd507 // TLB exception - ifetch
|
`define EX_DBERR 9'd508 // Bus Error - load or store or I/O
|
`define EX_DBERR 9'd508 // Bus Error - load or store or I/O
|
`define EX_IBERR 9'd509 // Bus Error - instruction fetch
|
`define EX_IBERR 9'd509 // Bus Error - instruction fetch
|
`define EX_NMI 9'd510 // non-maskable interrupt
|
`define EX_NMI 9'd510 // non-maskable interrupt
|
`define EX_RST 9'd511 // Reset
|
`define EX_RST 9'd511 // Reset
|
|
|
`define EXCEPT_Int 5'd00
|
`include "Raptor64_opcodes.v"
|
`define EXCEPT_Mod 5'd01 // TLB modification
|
|
`define EXCEPT_TLBL 5'd02 // TLB exception - load or ifetch
|
|
`define EXCEPT_TLBS 5'd03 // TLB exception - store
|
|
`define EXCEPT_AdEL 5'd04 // Address error - load or ifetch
|
|
`define EXCEPT_AdES 5'd05 // Address error - store
|
|
`define EXCEPT_IBE 5'd06 // Bus Error - instruction fetch
|
|
`define EXCEPT_DBE 5'd07 // Bus Error - load or store
|
|
`define EXCEPT_Sys 5'd08
|
|
`define EXCEPT_Bp 5'd09
|
|
`define EXCEPT_RI 5'd10 // reserved instruction
|
|
`define EXCEPT_CpU 5'd11 // Coprocessor unusable
|
|
`define EXCEPT_Ov 5'd12 // Integer Overflow
|
|
`define EXCEPT_Tr 5'd13 // Trap exception
|
|
// 14-22 Reserved
|
|
`define EXCEPT_WATCH 5'd23
|
|
`define EXCEPT_MCheck 5'd24 // Machine check
|
|
// 25-31 Reserved
|
|
|
|
|
|
`define MISC 7'd0
|
|
`define BRK 7'd0
|
|
`define IRQ 7'd1
|
|
`define ICACHE_ON 7'd10
|
|
`define ICACHE_OFF 7'd11
|
|
`define DCACHE_ON 7'd12
|
|
`define DCACHE_OFF 7'd13
|
|
`define FIP 7'd20
|
|
`define SYSJMP 7'd22
|
|
`define SYSCALL 7'd23
|
|
`define IRET 7'd32
|
|
`define ERET 7'd33
|
|
`define WAIT 7'd40
|
|
`define TLBP 7'd49
|
|
`define TLBR 7'd50
|
|
`define TLBWI 7'd51
|
|
`define TLBWR 7'd52
|
|
`define CLI 7'd64
|
|
`define SEI 7'd65
|
|
`define GRAN 7'd80
|
|
`define GRAFD 7'd82
|
|
`define R 7'd1
|
|
`define COM 7'd4
|
|
`define NOT 7'd5
|
|
`define NEG 7'd6
|
|
`define ABS 7'd7
|
|
`define SGN 7'd8
|
|
`define MOV 7'd9
|
|
`define SWAP 7'd13
|
|
`define CTLZ 7'd16
|
|
`define CTLO 7'd17
|
|
`define CTPOP 7'd18
|
|
`define SEXT8 7'd19
|
|
`define SEXT16 7'd20
|
|
`define SEXT32 7'd21
|
|
`define SQRT 7'd24
|
|
`define REDOR 7'd30
|
|
`define REDAND 7'd31
|
|
`define MFSPR 7'd40
|
|
`define MTSPR 7'd41
|
|
`define SR 6'd00
|
|
`define TLBIndex 6'd01
|
|
`define TLBRandom 6'd02
|
|
`define PageTableAddr 6'd04
|
|
`define BadVAddr 6'd08
|
|
`define TLBPhysPage0 6'd10
|
|
`define TLBPhysPage1 6'd11
|
|
`define TLBVirtPage 6'd12
|
|
`define TLBPageMask 6'd13
|
|
`define TLBASID 6'd14
|
|
`define ASID 6'd15
|
|
`define Wired 6'd16
|
|
`define EP0 6'd17
|
|
`define EP1 6'd18
|
|
`define EP2 6'd19
|
|
`define EP3 6'd20
|
|
`define AXC 6'd21
|
|
`define Tick 6'd22
|
|
`define EPC 6'd23
|
|
`define CauseCode 6'd24
|
|
`define TBA 6'd25
|
|
`define NON_ICACHE_SEG 6'd26
|
|
`define FPCR 6'd32
|
|
`define IPC 6'd33
|
|
`define RAND 6'd34
|
|
`define SRANDZ 6'd35
|
|
`define SRANDW 6'd36
|
|
`define INSNKEY 6'd37
|
|
`define OMG 7'd50
|
|
`define CMG 7'd51
|
|
`define OMGI 7'd52
|
|
`define CMGI 7'd53
|
|
`define EXEC 7'd58
|
|
`define MYST 7'd59
|
|
`define RR 7'd2
|
|
`define ADD 7'd2
|
|
`define ADDU 7'd3
|
|
`define SUB 7'd4
|
|
`define SUBU 7'd5
|
|
`define CMP 7'd6
|
|
`define CMPU 7'd7
|
|
`define AND 7'd8
|
|
`define OR 7'd9
|
|
`define XOR 7'd10
|
|
`define ANDC 7'd11
|
|
`define NAND 7'd12
|
|
`define NOR 7'd13
|
|
`define XNOR 7'd14
|
|
`define ORC 7'd15
|
|
`define MIN 7'd20
|
|
`define MAX 7'd21
|
|
`define MULU 7'd24
|
|
`define MULS 7'd25
|
|
`define DIVU 7'd26
|
|
`define DIVS 7'd27
|
|
`define MOD 7'd28
|
|
`define MOVZ 7'd30
|
|
`define MOVNZ 7'd31
|
|
|
|
`define SHL 7'd40
|
|
`define SHRU 7'd41
|
|
`define ROL 7'd42
|
|
`define ROR 7'd43
|
|
`define SHR 7'd44
|
|
`define ROLAM 7'd45
|
|
|
|
`define NOP 7'd60
|
|
|
|
`define SLT 7'd96
|
|
`define SLE 7'd97
|
|
`define SGT 7'd98
|
|
`define SGE 7'd99
|
|
`define SLTU 7'd100
|
|
`define SLEU 7'd101
|
|
`define SGTU 7'd102
|
|
`define SGEU 7'd103
|
|
`define SEQ 7'd104
|
|
`define SNE 7'd105
|
|
|
|
`define BCD_ADD 7'd110
|
|
`define BCD_SUB 7'd111
|
|
|
|
`define SHFTI 7'd3
|
|
`define SHLI 5'd0
|
|
`define SHRUI 5'd1
|
|
`define ROLI 5'd2
|
|
`define SHRI 5'd3
|
|
`define RORI 5'd4
|
|
`define ROLAMI 5'd5
|
|
`define BFINS 5'd8
|
|
`define BFSET 5'd9
|
|
`define BFCLR 5'd10
|
|
`define BFCHG 5'd11
|
|
`define ADDI 7'd4
|
|
`define ADDUI 7'd5
|
|
`define SUBI 7'd6
|
|
`define SUBUI 7'd7
|
|
`define CMPI 7'd8
|
|
`define CMPUI 7'd9
|
|
`define ANDI 7'd10
|
|
`define ORI 7'd11
|
|
`define XORI 7'd12
|
|
|
|
`define MULUI 7'd13
|
|
`define MULSI 7'd14
|
|
`define DIVUI 7'd15
|
|
`define DIVSI 7'd16
|
|
|
|
`define TRAPcc 7'd17
|
|
`define TEQ 5'd0
|
|
`define TNE 5'd1
|
|
`define TLT 5'd2
|
|
`define TGE 5'd3
|
|
`define TLE 5'd4
|
|
`define TGT 5'd5
|
|
`define TLTU 5'd6
|
|
`define TGEU 5'd7
|
|
`define TLEU 5'd8
|
|
`define TGTU 5'd9
|
|
`define TRAP 5'd10
|
|
`define TRN 5'd11
|
|
`define TRAPcci 7'd18
|
|
`define TEQI 5'd0
|
|
`define TNEI 5'd1
|
|
`define TLTI 5'd2
|
|
`define TGEI 5'd3
|
|
`define TLEI 5'd4
|
|
`define TGTI 5'd5
|
|
`define TLTUI 5'd6
|
|
`define TGEUI 5'd7
|
|
`define TLEUI 5'd8
|
|
`define TGTUI 5'd9
|
|
`define TRAI 5'd10
|
|
`define TRNI 5'd11
|
|
// SETLO=20 to 23
|
|
`define SETLO 7'b00101xx
|
|
`define CALL 7'd24
|
|
`define JMP 7'd25
|
|
`define JAL 7'd26
|
|
`define RET 7'd27
|
|
// SETLO=28 to 31
|
|
`define SETHI 7'b00111xx
|
|
`define LB 7'd32
|
|
`define LC 7'd33
|
|
`define LH 7'd34
|
|
`define LW 7'd35
|
|
`define LP 7'd36
|
|
`define LBU 7'd37
|
|
`define LCU 7'd38
|
|
`define LHU 7'd39
|
|
`define LSH 7'd40
|
|
`define LSW 7'd41
|
|
`define LF 7'd42
|
|
`define LFD 7'd43
|
|
`define LFP 7'd44
|
|
`define LFDP 7'd45
|
|
`define LWR 7'd46
|
|
`define LDONE 7'd47
|
|
|
|
`define SB 7'd48
|
|
`define SC 7'd49
|
|
`define SH 7'd50
|
|
`define SW 7'd51
|
|
`define SP 7'd52
|
|
`define MEMNDX 7'd53
|
|
`define LBX 6'd0
|
|
`define LCX 6'd1
|
|
`define LHX 6'd2
|
|
`define LWX 6'd3
|
|
`define LPX 6'd4
|
|
`define LBUX 6'd5
|
|
`define LCUX 6'd6
|
|
`define LHUX 6'd7
|
|
`define LSHX 6'd8
|
|
`define LSWX 6'd9
|
|
`define LFX 6'd10
|
|
`define LFDX 6'd11
|
|
`define LFPX 6'd12
|
|
`define LFDPX 6'd13
|
|
`define LWRX 6'd14
|
|
|
|
`define SBX 6'd16
|
|
`define SCX 6'd17
|
|
`define SHX 6'd18
|
|
`define SWX 6'd19
|
|
`define SPX 6'd20
|
|
`define SSHX 6'd24
|
|
`define SSWX 6'd25
|
|
`define SFX 6'd26
|
|
`define SFDX 6'd27
|
|
`define SFPX 6'd28
|
|
`define SFDPX 6'd29
|
|
`define SWCX 6'd30
|
|
|
|
`define INBX 6'd32
|
|
`define INCX 6'd33
|
|
`define INHX 6'd34
|
|
`define INWX 6'd35
|
|
`define INBUX 6'd36
|
|
`define INCUX 6'd37
|
|
`define INHUX 6'd38
|
|
`define OUTBX 6'd40
|
|
`define OUTCX 6'd41
|
|
`define OUTHX 6'd42
|
|
`define OUTWX 6'd43
|
|
`define CACHEX 6'd44
|
|
`define LEAX 6'd45
|
|
`define LMX 6'd46
|
|
`define SMX 6'd47
|
|
|
|
`define SSH 7'd56
|
|
`define SSW 7'd57
|
|
`define SF 7'd58
|
|
`define SFD 7'd59
|
|
`define SFP 7'd60
|
|
`define SFDP 7'd61
|
|
`define SWC 7'd62
|
|
|
|
`define INB 7'd64
|
|
`define INCH 7'd65
|
|
`define INH 7'd66
|
|
`define INW 7'd67
|
|
`define INBU 7'd68
|
|
`define INCU 7'd69
|
|
`define INHU 7'd70
|
|
`define OUTB 7'd72
|
|
`define OUTC 7'd73
|
|
`define OUTH 7'd74
|
|
`define OUTW 7'd75
|
|
`define CACHE 7'd76
|
|
`define INVIL 5'd0
|
|
`define INVIALL 5'd1
|
|
`define LEA 7'd77
|
|
`define LM 7'd78
|
|
`define SM 7'd79
|
|
|
|
`define BLTI 7'd80
|
|
`define BGEI 7'd81
|
|
`define BLEI 7'd82
|
|
`define BGTI 7'd83
|
|
`define BLTUI 7'd84
|
|
`define BGEUI 7'd85
|
|
`define BLEUI 7'd86
|
|
`define BGTUI 7'd87
|
|
`define BEQI 7'd88
|
|
`define BNEI 7'd89
|
|
|
|
`define BTRI 7'd94
|
|
`define BLTRI 5'd0
|
|
`define BGERI 5'd1
|
|
`define BLERI 5'd2
|
|
`define BGTRI 5'd3
|
|
`define BLTURI 5'd4
|
|
`define BGEURI 5'd5
|
|
`define BLEURI 5'd6
|
|
`define BGTURI 5'd7
|
|
`define BEQRI 5'd8
|
|
`define BNERI 5'd9
|
|
`define BRARI 5'd10
|
|
`define BRNRI 5'd11
|
|
`define BANDRI 5'd12
|
|
`define BORRI 5'd13
|
|
`define BTRR 7'd95
|
|
`define BLT 5'd0
|
|
`define BGE 5'd1
|
|
`define BLE 5'd2
|
|
`define BGT 5'd3
|
|
`define BLTU 5'd4
|
|
`define BGEU 5'd5
|
|
`define BLEU 5'd6
|
|
`define BGTU 5'd7
|
|
`define BEQ 5'd8
|
|
`define BNE 5'd9
|
|
`define BRA 5'd10
|
|
`define BRN 5'd11
|
|
`define BAND 5'd12
|
|
`define BOR 5'd13
|
|
`define BNR 5'd14
|
|
`define LOOP 5'd15
|
|
`define BLTR 5'd16
|
|
`define BGER 5'd17
|
|
`define BLER 5'd18
|
|
`define BGTR 5'd19
|
|
`define BLTUR 5'd20
|
|
`define BGEUR 5'd21
|
|
`define BLEUR 5'd22
|
|
`define BGTUR 5'd23
|
|
`define BEQR 5'd24
|
|
`define BNER 5'd25
|
|
`define BRAR 5'd26
|
|
`define BRNR 5'd27
|
|
|
|
|
|
`define SLTI 7'd96
|
|
`define SLEI 7'd97
|
|
`define SGTI 7'd98
|
|
`define SGEI 7'd99
|
|
`define SLTUI 7'd100
|
|
`define SLEUI 7'd101
|
|
`define SGTUI 7'd102
|
|
`define SGEUI 7'd103
|
|
`define SEQI 7'd104
|
|
`define SNEI 7'd105
|
|
|
|
`define FP 7'd108
|
|
`define FDADD 6'd0
|
|
`define FDSUB 6'd1
|
|
`define FDMUL 6'd2
|
|
`define FDDIV 6'd3
|
|
`define FDCUN 6'd4
|
|
`define FDI2F 6'd5
|
|
`define FDF2I 6'd6
|
|
`define FDF2D 6'd7
|
|
`define FDD2F 6'd8
|
|
`define FDCLT 6'b001100
|
|
`define FDCEQ 6'b010100
|
|
`define FDCLE 6'b011100
|
|
`define FDCGT 6'b100100
|
|
`define FDCNE 6'b101100
|
|
`define FDCGE 6'b110100
|
|
`define FPLOO 7'd109
|
|
`define FPZL 7'd110
|
|
`define NOPI 7'd111
|
|
|
|
`define IMM 3'd7
|
|
|
|
`define NOP_INSN 42'b1101111_000_00000000_00000000_00000000_00000000
|
|
|
|
module Raptor64sc(rst_i, clk_i, nmi_i, irq_i, bte_o, cti_o, bl_o,
|
module Raptor64sc(rst_i, clk_i, nmi_i, irq_i, bte_o, cti_o, bl_o,
|
cyc_o, stb_o, ack_i, err_i, we_o, sel_o, rsv_o, adr_o, dat_i, dat_o, sys_adv, sys_adr
|
cyc_o, stb_o, ack_i, err_i, we_o, sel_o, rsv_o, adr_o, dat_i, dat_o, sys_adv, sys_adr
|
);
|
);
|
parameter IDLE = 5'd1;
|
parameter IDLE = 5'd1;
|
parameter ICACT = 5'd2;
|
parameter ICACT = 5'd2;
|
parameter ICACT0 = 5'd3;
|
parameter ICACT0 = 5'd3;
|
parameter ICACT1 = 5'd4;
|
parameter ICACT1 = 5'd4;
|
parameter ICACT2 = 5'd5;
|
parameter ICACT2 = 5'd5;
|
parameter ICACT3 = 5'd6;
|
parameter ICACT3 = 5'd6;
|
parameter ICACT4 = 5'd7;
|
parameter ICACT4 = 5'd7;
|
parameter ICACT5 = 5'd8;
|
parameter ICACT5 = 5'd8;
|
parameter ICACT6 = 5'd9;
|
parameter ICACT6 = 5'd9;
|
parameter ICACT7 = 5'd10;
|
parameter ICACT7 = 5'd10;
|
parameter ICDLY = 5'd11;
|
parameter ICDLY = 5'd11;
|
parameter DCIDLE = 5'd20;
|
parameter DCIDLE = 5'd20;
|
parameter DCACT = 5'd21;
|
parameter DCACT = 5'd21;
|
parameter DCACT0 = 5'd22;
|
parameter DCACT0 = 5'd22;
|
parameter DCACT1 = 5'd23;
|
parameter DCACT1 = 5'd23;
|
parameter DCACT2 = 5'd24;
|
parameter DCACT2 = 5'd24;
|
parameter DCACT3 = 5'd25;
|
parameter DCACT3 = 5'd25;
|
parameter DCACT4 = 5'd26;
|
parameter DCACT4 = 5'd26;
|
parameter DCACT5 = 5'd27;
|
parameter DCACT5 = 5'd27;
|
parameter DCACT6 = 5'd28;
|
parameter DCACT6 = 5'd28;
|
parameter DCACT7 = 5'd29;
|
parameter DCACT7 = 5'd29;
|
parameter DCDLY = 5'd30;
|
parameter DCDLY = 5'd30;
|
|
|
input rst_i;
|
input rst_i;
|
input clk_i;
|
input clk_i;
|
input nmi_i;
|
input nmi_i;
|
input irq_i;
|
input irq_i;
|
|
|
output [1:0] bte_o;
|
output [1:0] bte_o;
|
reg [1:0] bte_o;
|
reg [1:0] bte_o;
|
output [2:0] cti_o;
|
output [2:0] cti_o;
|
reg [2:0] cti_o;
|
reg [2:0] cti_o;
|
output [4:0] bl_o;
|
output [4:0] bl_o;
|
reg [4:0] bl_o;
|
reg [4:0] bl_o;
|
output cyc_o;
|
output cyc_o;
|
reg cyc_o;
|
reg cyc_o;
|
output stb_o;
|
output stb_o;
|
reg stb_o;
|
reg stb_o;
|
input ack_i;
|
input ack_i;
|
input err_i;
|
input err_i;
|
output we_o;
|
output we_o;
|
reg we_o;
|
reg we_o;
|
output [7:0] sel_o;
|
output [7:0] sel_o;
|
reg [7:0] sel_o;
|
reg [7:0] sel_o;
|
output rsv_o;
|
output rsv_o;
|
reg rsv_o;
|
reg rsv_o;
|
output [63:0] adr_o;
|
output [63:0] adr_o;
|
reg [63:0] adr_o;
|
reg [63:0] adr_o;
|
input [63:0] dat_i;
|
input [63:0] dat_i;
|
output [63:0] dat_o;
|
output [63:0] dat_o;
|
reg [63:0] dat_o;
|
reg [63:0] dat_o;
|
|
|
input sys_adv;
|
input sys_adv;
|
input [63:5] sys_adr;
|
input [63:5] sys_adr;
|
|
|
reg [5:0] fltctr;
|
reg [5:0] fltctr;
|
wire fltdone = fltctr==6'd0;
|
wire fltdone = fltctr==6'd0;
|
reg resetA;
|
reg resetA;
|
reg im,bu_im; // interrupt mask
|
reg im,bu_im; // interrupt mask
|
reg im1; // temporary interrupt mask for LM/SM
|
reg im1; // temporary interrupt mask for LM/SM
|
reg [1:0] vtno; // vector table number
|
reg [1:0] vtno; // vector table number
|
reg [1:0] rm; // fp rounding mode
|
reg [1:0] rm; // fp rounding mode
|
reg FXE; // fp exception enable
|
reg FXE; // fp exception enable
|
wire KernelMode;
|
wire KernelMode;
|
wire [31:0] sr = {bu_im,15'd0,im,1'b0,KernelMode,FXE,vtno,10'b0};
|
wire [31:0] sr = {bu_im,15'd0,im,1'b0,KernelMode,FXE,vtno,10'b0};
|
reg [41:0] dIR;
|
reg [41:0] dIR,xIR,m1IR,m2IR,wIR;
|
reg [41:0] ndIR;
|
reg [41:0] ndIR;
|
wire [6:0] dOpcode = dIR[41:35];
|
wire [6:0] dOpcode = dIR[41:35];
|
reg [41:0] xIR;
|
|
reg [63:0] pc;
|
reg [63:0] pc;
|
reg [63:0] ErrorEPC,EPC,IPC;
|
reg [63:0] ErrorEPC,EPC,IPC;
|
reg [63:0] dpc,m1pc,m2pc,wpc;
|
reg [63:0] dpc,m1pc,m2pc,wpc;
|
reg dpcv,xpcv,m1pcv,m2pcv,wpcv; // PC valid indicators
|
reg dpcv,xpcv,m1pcv,m2pcv,wpcv; // PC valid indicators
|
reg [63:0] xpc;
|
reg [63:0] xpc;
|
reg [63:0] tlbra; // return address for a TLB exception
|
reg [63:0] tlbra; // return address for a TLB exception
|
reg [8:0] dRa,dRb,dRc;
|
reg [8:0] dRa,dRb,dRc;
|
reg [8:0] wRt,mRt,m1Rt,m2Rt,tRt,dRt;
|
reg [8:0] wRt,mRt,m1Rt,m2Rt,tRt,dRt;
|
reg [8:0] xRt;
|
reg [8:0] xRt;
|
reg [63:0] dImm;
|
reg [63:0] dImm;
|
reg [63:0] ea;
|
reg [63:0] ea;
|
reg [63:0] iadr_o;
|
reg [63:0] iadr_o;
|
reg [31:0] idat;
|
reg [31:0] idat;
|
reg [4:0] cstate;
|
reg [4:0] cstate;
|
reg dbranch_taken,xbranch_taken;
|
reg dbranch_taken,xbranch_taken;
|
reg [63:0] mutex_gate;
|
reg [63:0] mutex_gate;
|
reg [63:0] TBA;
|
reg [63:0] TBA;
|
reg [1:0] dhwxtype,xhwxtype,m1hwxtype,m2hwxtype,whwxtype;
|
reg [1:0] dhwxtype,xhwxtype,m1hwxtype,m2hwxtype,whwxtype;
|
reg [3:0] AXC,dAXC,xAXC;
|
reg [3:0] AXC,dAXC,xAXC;
|
reg dtinit;
|
reg dtinit;
|
reg dcache_on;
|
reg dcache_on;
|
reg [63:32] nonICacheSeg;
|
reg [63:32] nonICacheSeg;
|
|
|
reg [1:0] FPC_rm;
|
reg [1:0] FPC_rm;
|
reg FPC_SL; // result is negative (and non-zero)
|
reg FPC_SL; // result is negative (and non-zero)
|
reg FPC_SE; // result is zero
|
reg FPC_SE; // result is zero
|
reg FPC_SG; // result is positive (and non-zero)
|
reg FPC_SG; // result is positive (and non-zero)
|
reg FPC_SI; // result is infinite or NaN
|
reg FPC_SI; // result is infinite or NaN
|
reg FPC_overx;
|
reg FPC_overx;
|
reg fp_iop;
|
reg fp_iop;
|
reg fp_ovr;
|
reg fp_ovr;
|
reg fp_uf;
|
reg fp_uf;
|
wire [31:0] FPC = {FPC_rm,1'b0,
|
wire [31:0] FPC = {FPC_rm,1'b0,
|
9'd0,
|
9'd0,
|
FPC_SL,
|
FPC_SL,
|
FPC_SG,
|
FPC_SG,
|
FPC_SE,
|
FPC_SE,
|
FPC_SI,
|
FPC_SI,
|
16'd0
|
16'd0
|
};
|
};
|
wire [63:0] cdat;
|
wire [63:0] cdat;
|
reg [63:0] wr_addr;
|
reg [63:0] wr_addr;
|
reg [41:0] insn;
|
reg [41:0] insn;
|
wire [63:0] rfoa,rfob,rfoc;
|
wire [63:0] rfoa,rfob,rfoc;
|
reg clk_en;
|
reg clk_en;
|
reg cpu_clk_en;
|
reg cpu_clk_en;
|
reg StatusERL; // 1= in error processing
|
reg StatusERL; // 1= in error processing
|
reg StatusEXL; // 1= in exception processing
|
reg StatusEXL; // 1= in exception processing
|
reg StatusHWI; // 1= in interrupt processing
|
reg StatusHWI; // 1= in interrupt processing
|
reg StatusUM; // 1= user mode
|
reg StatusUM; // 1= user mode
|
reg [7:0] CauseCode;
|
reg [7:0] CauseCode;
|
reg [7:0] ASID; // address space identifier (process ID)
|
reg [7:0] ASID; // address space identifier (process ID)
|
integer n;
|
integer n;
|
reg [63:13] BadVAddr;
|
reg [63:13] BadVAddr;
|
reg [63:13] PageTableAddr;
|
reg [63:13] PageTableAddr;
|
reg [63:0] errorAddress;
|
reg [63:0] errorAddress;
|
|
|
|
wire [6:0] iFunc = insn[6:0];
|
|
wire [6:0] dFunc = dIR[6:0];
|
|
wire [5:0] dFunc6 = dIR[5:0];
|
|
wire [6:0] xFunc = xIR[6:0];
|
|
wire [5:0] xFunc6 = xIR[5:0];
|
|
wire [4:0] xFunc5 = xIR[4:0];
|
|
wire [6:0] iOpcode = insn[41:35];
|
|
wire [6:0] xOpcode = xIR[41:35];
|
|
reg [6:0] m1Opcode,m2Opcode,wOpcode;
|
|
reg [6:0] m1Func,m2Func,wFunc;
|
|
reg [63:0] m1Data,m2Data,wData,tData;
|
|
reg [63:0] m2Addr;
|
|
reg [63:0] tick;
|
|
reg [63:0] tba;
|
|
reg [63:0] exception_address,ipc;
|
|
reg [63:0] a,b,c,imm,m1b;
|
|
reg prev_ihit;
|
|
reg rsf;
|
|
reg [63:5] resv_address;
|
|
reg dirqf,rirqf,m1irqf,m2irqf,wirqf,tirqf;
|
|
reg xirqf;
|
|
reg [8:0] dextype,m1extype,m2extype,wextype,textype,exception_type;
|
|
reg [8:0] xextype;
|
|
reg wLdPC,m2LdPC;
|
|
wire advanceX_edge;
|
|
reg takb;
|
|
wire advanceX,advanceM1,advanceW;
|
|
reg m1IsLoad,m2IsLoad;
|
|
reg m1IsIO;
|
|
reg m1IsStore,m2IsStore,wIsStore;
|
|
|
function [63:0] fnIncPC;
|
function [63:0] fnIncPC;
|
input [63:0] fpc;
|
input [63:0] fpc;
|
begin
|
begin
|
case(fpc[3:2])
|
case(fpc[3:2])
|
2'd0: fnIncPC = {fpc[63:4],4'b0100};
|
2'd0: fnIncPC = {fpc[63:4],4'b0100};
|
2'd1: fnIncPC = {fpc[63:4],4'b1000};
|
2'd1: fnIncPC = {fpc[63:4],4'b1000};
|
2'd2: fnIncPC = {fpc[63:4]+60'd1,4'b0000};
|
2'd2: fnIncPC = {fpc[63:4]+60'd1,4'b0000};
|
2'd3: fnIncPC = {fpc[63:4]+60'd1,4'b0000};
|
2'd3: fnIncPC = {fpc[63:4]+60'd1,4'b0000};
|
endcase
|
endcase
|
end
|
end
|
endfunction
|
endfunction
|
|
|
assign KernelMode = StatusEXL|StatusHWI;
|
assign KernelMode = StatusEXL|StatusHWI;
|
|
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
// TLB
|
// TLB
|
// The TLB contains 64 entries, that are 8 way set associative.
|
// The TLB contains 64 entries, that are 8 way set associative.
|
// The TLB is dual ported and shared between the instruction and data streams.
|
// The TLB is dual ported and shared between the instruction and data streams.
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
|
|
wire unmappedArea = pc[63:52]==12'hFFD || pc[63:52]==12'hFFE || pc[63:52]==12'hFFF;
|
|
wire unmappedDataArea = ea[63:52]==12'hFFD || ea[63:52]==12'hFFE || ea[63:52]==12'hFFF;
|
|
wire [63:0] ppc;
|
wire [63:0] ppc;
|
wire [63:0] pea;
|
wire [63:0] pea;
|
|
wire [63:0] tlbo;
|
`ifdef TLB
|
`ifdef TLB
|
reg [24:13] TLBPageMask;
|
wire [63:0] TLBVirtPage;
|
reg [63:13] TLBVirtPage;
|
wire wTlbp = advanceW && wOpcode==`MISC && wFunc==`TLBP;
|
reg [63:13] TLBPhysPage0;
|
wire wTlbrd = advanceW && wOpcode==`MISC && wFunc==`TLBR;
|
reg [63:13] TLBPhysPage1;
|
wire wTlbwr = advanceW && wOpcode==`MISC && wFunc==`TLBWR;
|
reg [7:0] TLBASID;
|
wire wTlbwi = advanceW && wOpcode==`MISC && wFunc==`TLBWI;
|
reg TLBG;
|
wire wMtspr = advanceW && wOpcode==`R && wFunc==`MTSPR;
|
reg TLBD;
|
wire xTlbrd = advanceX && xOpcode==`MISC && xFunc==`TLBR;
|
reg TLBValid;
|
wire xTlbwr = advanceX && xOpcode==`MISC && xFunc==`TLBWR;
|
reg [63:0] Index;
|
wire xTlbwi = advanceX && xOpcode==`MISC && xFunc==`TLBWI;
|
reg [2:0] Random;
|
wire ITLBMiss,DTLBMiss;
|
reg [2:0] Wired;
|
|
reg [15:0] IMatch,DMatch;
|
|
|
|
reg [3:0] m;
|
|
reg [5:0] i;
|
|
reg [24:13] ITLBPageMask [63:0];
|
|
reg [63:13] ITLBVirtPage [63:0];
|
|
reg [63:13] ITLBPhysPage0 [63:0];
|
|
reg [63:13] ITLBPhysPage1 [63:0];
|
|
reg [63:0] ITLBG;
|
|
reg [63:0] ITLBD;
|
|
reg [7:0] ITLBASID [63:0];
|
|
reg [15:0] ITLBValid;
|
|
initial begin
|
|
for (n = 0; n < 64; n = n + 1)
|
|
begin
|
|
ITLBPageMask[n] = 0;
|
|
ITLBVirtPage[n] = 0;
|
|
ITLBPhysPage0[n] = 0;
|
|
ITLBPhysPage1[n] = 0;
|
|
ITLBG[n] = 0;
|
|
ITLBASID[n] = 0;
|
|
ITLBValid[n] = 0;
|
|
end
|
|
end
|
|
always @*
|
|
for (n = 0; n < 8; n = n + 1)
|
|
IMatch[n] = ((pc[63:13]|ITLBPageMask[{n[2:0],pc[15:13]}])==(ITLBVirtPage[{n[2:0],pc[15:13]}]|ITLBPageMask[{n[2:0],pc[15:13]}])) &&
|
|
((ITLBASID[{n,pc[15:13]}]==ASID) || ITLBG[{n,pc[15:13]}]) &&
|
|
ITLBValid[{n,pc[15:13]}];
|
|
always @(IMatch)
|
|
if (IMatch[0]) m <= 4'd0;
|
|
else if (IMatch[1]) m <= 4'd1;
|
|
else if (IMatch[2]) m <= 4'd2;
|
|
else if (IMatch[3]) m <= 4'd3;
|
|
else if (IMatch[4]) m <= 4'd4;
|
|
else if (IMatch[5]) m <= 4'd5;
|
|
else if (IMatch[6]) m <= 4'd6;
|
|
else if (IMatch[7]) m <= 4'd7;
|
|
else m <= 4'd15;
|
|
|
|
wire ioddpage = |({ITLBPageMask[{m[2:0],pc[15:13]}]+19'd1,13'd0}&pc);
|
|
wire [63:13] IPFN = ioddpage ? ITLBPhysPage1[{m[2:0],pc[15:13]}] : ITLBPhysPage0[{m[2:0],pc[15:13]}];
|
|
|
|
wire ITLBMiss = !unmappedArea & m[3];
|
|
|
|
assign ppc[63:13] = unmappedArea ? pc[63:13] : m[3] ? `TLBMissPage: IPFN;
|
|
assign ppc[12:0] = pc[12:0];
|
|
|
|
reg [3:0] q;
|
|
always @(ea)
|
|
for (n = 0; n < 7; n = n + 1)
|
|
DMatch[n] = ((ea[63:13]|ITLBPageMask[{n,ea[15:13]}])==(ITLBVirtPage[{n,ea[15:13]}]|ITLBPageMask[{n,ea[15:13]}])) &&
|
|
((ITLBASID[{n,ea[15:13]}]==ASID) || ITLBG[{n,ea[15:13]}]) &&
|
|
ITLBValid[{n,ea[15:13]}];
|
|
always @(DMatch)
|
|
if (DMatch[0]) q <= 4'd0;
|
|
else if (DMatch[1]) q <= 4'd1;
|
|
else if (DMatch[2]) q <= 4'd2;
|
|
else if (DMatch[3]) q <= 4'd3;
|
|
else if (DMatch[4]) q <= 4'd4;
|
|
else if (DMatch[5]) q <= 4'd5;
|
|
else if (DMatch[6]) q <= 4'd6;
|
|
else if (DMatch[7]) q <= 4'd7;
|
|
else q <= 4'd15;
|
|
|
|
wire doddpage = |({ITLBPageMask[{q[2:0],ea[15:13]}]+19'd1,13'd0}&ea);
|
|
wire [63:13] DPFN = doddpage ? ITLBPhysPage1[{q[2:0],ea[15:13]}] : ITLBPhysPage0[{q[2:0],ea[15:13]}];
|
|
|
|
wire DTLBMiss = !unmappedDataArea & q[3];
|
Raptor64_TLB u22
|
|
(
|
|
.rst(rst_i),
|
|
.clk(clk),
|
|
.pc(pc),
|
|
.ea(ea),
|
|
.ppc(ppc),
|
|
.pea(pea),
|
|
.m1IsStore(advanceM1 && m1IsStore),
|
|
.ASID(ASID),
|
|
.wTlbp(wTlbp),
|
|
.wTlbrd(wTlbrd),
|
|
.wTlbwr(wTlbwr),
|
|
.wTlbwi(wTlbwi),
|
|
.xTlbrd(xTlbrd),
|
|
.xTlbwr(xTlbwr),
|
|
.xTlbwi(xTlbwi),
|
|
.wr(wMtspr),
|
|
.wregno(wIR[12:7]),
|
|
.dati(wData),
|
|
.xregno(xIR[12:7]),
|
|
.dato(tlbo),
|
|
.ITLBMiss(ITLBMiss),
|
|
.DTLBMiss(DTLBMiss),
|
|
.HTLBVirtPage(TLBVirtPage)
|
|
);
|
|
|
assign pea[63:13] = unmappedDataArea ? ea[63:13] : q[3] ? `TLBMissPage: DPFN;
|
|
assign pea[12:0] = ea[12:0];
|
|
`else
|
`else
|
assign ppc = pc;
|
assign ppc = pc;
|
assign pea = ea;
|
assign pea = ea;
|
`endif
|
`endif
|
wire m1UnmappedDataArea = pea[63:13]>=12'hFFD;
|
|
|
|
wire dram_bus = !pea[63];
|
wire dram_bus = !pea[63];
|
wire m2_dram_bus = !m2Addr[63];
|
wire m2_dram_bus = !m2Addr[63];
|
|
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
// Clock control
|
// Clock control
|
// - reset or NMI reenables the clock
|
// - reset or NMI reenables the clock
|
// - this circuit must be under the clk_i domain
|
// - this circuit must be under the clk_i domain
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
//
|
//
|
BUFGCE u20 (.CE(cpu_clk_en), .I(clk_i), .O(clk) );
|
BUFGCE u20 (.CE(cpu_clk_en), .I(clk_i), .O(clk) );
|
|
|
always @(posedge clk_i)
|
always @(posedge clk_i)
|
if (rst_i) begin
|
if (rst_i) begin
|
cpu_clk_en <= 1'b1;
|
cpu_clk_en <= 1'b1;
|
end
|
end
|
else begin
|
else begin
|
if (nmi_i)
|
if (nmi_i)
|
cpu_clk_en <= 1'b1;
|
cpu_clk_en <= 1'b1;
|
else
|
else
|
cpu_clk_en <= clk_en;
|
cpu_clk_en <= clk_en;
|
end
|
end
|
|
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
// Random number register:
|
// Random number register:
|
//
|
//
|
// Uses George Marsaglia's multiply method.
|
// Uses George Marsaglia's multiply method.
|
// Current method is to concatonate two 32 bit generators. This isn't a very
|
// Current method is to concatonate two 32 bit generators. This isn't a very
|
// good way to do it.
|
// good way to do it.
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
reg [31:0] m_z1,m_z2;
|
reg [31:0] m_z1,m_z2;
|
reg [31:0] m_w1,m_w2;
|
reg [31:0] m_w1,m_w2;
|
reg [31:0] next_m_z1,next_m_z2;
|
reg [31:0] next_m_z1,next_m_z2;
|
reg [31:0] next_m_w1,next_m_w2;
|
reg [31:0] next_m_w1,next_m_w2;
|
|
|
always @(m_z1 or m_w1)
|
always @(m_z1 or m_w1)
|
begin
|
begin
|
next_m_z1 <= (18'h36969 * m_z1[15:0]) + m_z1[31:16];
|
next_m_z1 <= (18'h36969 * m_z1[15:0]) + m_z1[31:16];
|
next_m_w1 <= (18'h18000 * m_w1[15:0]) + m_w1[31:16];
|
next_m_w1 <= (18'h18000 * m_w1[15:0]) + m_w1[31:16];
|
end
|
end
|
|
|
always @(m_z2 or m_w2)
|
always @(m_z2 or m_w2)
|
begin
|
begin
|
next_m_z2 <= (18'h36969 * m_z2[15:0]) + m_z2[31:16];
|
next_m_z2 <= (18'h36969 * m_z2[15:0]) + m_z2[31:16];
|
next_m_w2 <= (18'h18000 * m_w2[15:0]) + m_w2[31:16];
|
next_m_w2 <= (18'h18000 * m_w2[15:0]) + m_w2[31:16];
|
end
|
end
|
|
|
wire [31:0] rand1 = {m_z1[15:0],16'd0} + m_w1;
|
wire [31:0] rand1 = {m_z1[15:0],16'd0} + m_w1;
|
wire [31:0] rand2 = {m_z2[15:0],16'd0} + m_w2;
|
wire [31:0] rand2 = {m_z2[15:0],16'd0} + m_w2;
|
wire [63:0] rand = {rand2,rand1};
|
wire [63:0] rand = {rand2,rand1};
|
|
|
wire [10:0] bias = 11'h3FF; // bias amount (eg 127)
|
wire [10:0] bias = 11'h3FF; // bias amount (eg 127)
|
wire [10:0] xl = rand[62:53];
|
wire [10:0] xl = rand[62:53];
|
wire sgn = 1'b0; // floating point: always generate a positive number
|
wire sgn = 1'b0; // floating point: always generate a positive number
|
wire [10:0] exp = xl > bias-1 ? bias-1 : xl; // 2^-1 otherwise number could be over 1
|
wire [10:0] exp = xl > bias-1 ? bias-1 : xl; // 2^-1 otherwise number could be over 1
|
wire [52:0] man = rand[52:0]; // a leading '1' will be assumed
|
wire [52:0] man = rand[52:0]; // a leading '1' will be assumed
|
wire [63:0] randfd = {sgn,exp,man};
|
wire [63:0] randfd = {sgn,exp,man};
|
reg [63:0] rando;
|
reg [63:0] rando;
|
|
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
// Instruction Cache / Instruction buffer
|
// Instruction Cache / Instruction buffer
|
// 8kB
|
// 8kB
|
//
|
//
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
//reg lfdir;
|
//reg lfdir;
|
wire lfdir = (((dOpcode==`LM || dOpcode==`SM) && dIR[31:0]!=32'd0) && ndIR[31:0]!=32'd0) ||
|
wire lfdir = (((dOpcode==`LM || dOpcode==`SM) && dIR[31:0]!=32'd0) && ndIR[31:0]!=32'd0) ||
|
((dOpcode==`LP || dOpcode==`SP || dOpcode==`LFP || dOpcode==`SFP || dOpcode==`LFDP || dOpcode==`SFDP) && dIR[25]!=1'b1);
|
((dOpcode==`LP || dOpcode==`SP || dOpcode==`LFP || dOpcode==`SFP || dOpcode==`LFDP || dOpcode==`SFDP) && dIR[25]!=1'b1);
|
wire ldnop = (((dOpcode==`LM || dOpcode==`SM) && (dIR[31:0]==32'd0 || ndIR[31:0]==32'd0)) ||
|
wire ldnop = (((dOpcode==`LM || dOpcode==`SM) && (dIR[31:0]==32'd0 || ndIR[31:0]==32'd0)) ||
|
((dOpcode==`LP || dOpcode==`SP || dOpcode==`LFP || dOpcode==`SFP || dOpcode==`LFDP || dOpcode==`SFDP) && dIR[25]==1'b1));
|
((dOpcode==`LP || dOpcode==`SP || dOpcode==`LFP || dOpcode==`SFP || dOpcode==`LFDP || dOpcode==`SFDP) && dIR[25]==1'b1));
|
reg icaccess;
|
reg icaccess;
|
reg ICacheOn;
|
reg ICacheOn;
|
wire ibufrdy;
|
wire ibufrdy;
|
reg [63:0] tmpbuf;
|
reg [63:0] tmpbuf;
|
wire [127:0] insnbundle;
|
wire [127:0] insnbundle;
|
reg [127:0] insnbuf0,insnbuf1;
|
reg [127:0] insnbuf0,insnbuf1;
|
reg [63:4] ibuftag0,ibuftag1;
|
reg [63:4] ibuftag0,ibuftag1;
|
wire isICached = ppc[63:32]!=nonICacheSeg;
|
wire isICached = ppc[63:32]!=nonICacheSeg;
|
//wire isEncrypted = ppc[63:32]==encryptedArea;
|
//wire isEncrypted = ppc[63:32]==encryptedArea;
|
wire ICacheAct = ICacheOn & isICached;
|
wire ICacheAct = ICacheOn & isICached;
|
reg [41:0] insn1;
|
reg [41:0] insn1;
|
reg [41:0] insnkey;
|
reg [41:0] insnkey;
|
|
|
// SYSCALL 509
|
// SYSCALL 509
|
wire [127:0] bevect = 128'b00_00000000_00000000_00000000_11111110_10010111__00_00000000_00000000_00000000_11111110_10010111__00_00000000_00000000_00000000_11111110_10010111;
|
wire [127:0] bevect = 128'b00_00000000_00000000_00000000_11111110_10010111__00_00000000_00000000_00000000_11111110_10010111__00_00000000_00000000_00000000_11111110_10010111;
|
|
|
Raptor64_icache_ram u1
|
Raptor64_icache_ram u1
|
(
|
(
|
.clka(clk), // input clka
|
.clka(clk), // input clka
|
.wea(icaccess & (ack_i|err_i)), // input [0 : 0] wea
|
.wea(icaccess & (ack_i|err_i)), // input [0 : 0] wea
|
.addra(adr_o[12:3]), // input [9 : 0] addra
|
.addra(adr_o[12:3]), // input [9 : 0] addra
|
.dina(err_i ? (adr_o[3] ? bevect[127:64] : bevect[63:0]) : dat_i), // input [63 : 0] dina
|
.dina(err_i ? (adr_o[3] ? bevect[127:64] : bevect[63:0]) : dat_i), // input [63 : 0] dina
|
.clkb(~clk), // input clkb
|
.clkb(~clk), // input clkb
|
.addrb(pc[12:4]), // input [8 : 0] addrb
|
.addrb(pc[12:4]), // input [8 : 0] addrb
|
.doutb(insnbundle) // output [127 : 0] doutb
|
.doutb(insnbundle) // output [127 : 0] doutb
|
);
|
);
|
|
|
always @(ppc or insnbundle or ICacheAct or insnbuf0 or insnbuf1 or ndIR or lfdir or ldnop)
|
always @(ppc or insnbundle or ICacheAct or insnbuf0 or insnbuf1 or ndIR or lfdir or ldnop)
|
begin
|
begin
|
casex({ldnop,lfdir,ICacheAct,ibuftag1==ppc[63:4],pc[3:2]})
|
casex({ldnop,lfdir,ICacheAct,ibuftag1==ppc[63:4],pc[3:2]})
|
6'b1xxxxx: insn1 <= 42'h37800000000;
|
6'b1xxxxx: insn1 <= 42'h37800000000;
|
6'b01xxxx: insn1 <= ndIR;
|
6'b01xxxx: insn1 <= ndIR;
|
6'b001x00: insn1 <= insnbundle[ 41: 0];
|
6'b001x00: insn1 <= insnbundle[ 41: 0];
|
6'b001x01: insn1 <= insnbundle[ 83:42];
|
6'b001x01: insn1 <= insnbundle[ 83:42];
|
6'b001x10: insn1 <= insnbundle[125:84];
|
6'b001x10: insn1 <= insnbundle[125:84];
|
6'b001x11: insn1 <= 42'h37800000000; // NOP instruction
|
6'b001x11: insn1 <= 42'h37800000000; // NOP instruction
|
6'b000000: insn1 <= insnbuf0[ 41: 0];
|
6'b000000: insn1 <= insnbuf0[ 41: 0];
|
6'b000001: insn1 <= insnbuf0[ 83:42];
|
6'b000001: insn1 <= insnbuf0[ 83:42];
|
6'b000010: insn1 <= insnbuf0[125:84];
|
6'b000010: insn1 <= insnbuf0[125:84];
|
6'b000011: insn1 <= 42'h37800000000;
|
6'b000011: insn1 <= 42'h37800000000;
|
6'b000100: insn1 <= insnbuf1[ 41: 0];
|
6'b000100: insn1 <= insnbuf1[ 41: 0];
|
6'b000101: insn1 <= insnbuf1[ 83:42];
|
6'b000101: insn1 <= insnbuf1[ 83:42];
|
6'b000110: insn1 <= insnbuf1[125:84];
|
6'b000110: insn1 <= insnbuf1[125:84];
|
6'b000111: insn1 <= 42'h37800000000;
|
6'b000111: insn1 <= 42'h37800000000;
|
endcase
|
endcase
|
end
|
end
|
|
|
// Decrypt the instruction set.
|
// Decrypt the instruction set.
|
always @(insn1,insnkey)
|
always @(insn1,insnkey)
|
insn <= insn1 ^ insnkey;
|
insn <= insn1 ^ insnkey;
|
|
|
reg [63:13] tmem [127:0];
|
reg [63:13] tmem [127:0];
|
reg [127:0] tvalid;
|
reg [127:0] tvalid;
|
|
|
initial begin
|
initial begin
|
for (n=0; n < 128; n = n + 1)
|
for (n=0; n < 128; n = n + 1)
|
tmem[n] = 0;
|
tmem[n] = 0;
|
for (n=0; n < 128; n = n + 1)
|
for (n=0; n < 128; n = n + 1)
|
tvalid[n] = 0;
|
tvalid[n] = 0;
|
end
|
end
|
|
|
wire [64:13] tgout;
|
wire [64:13] tgout;
|
assign tgout = {tvalid[pc[12:6]],tmem[pc[12:6]]};
|
assign tgout = {tvalid[pc[12:6]],tmem[pc[12:6]]};
|
assign ihit = (tgout=={1'b1,ppc[63:13]});
|
assign ihit = (tgout=={1'b1,ppc[63:13]});
|
assign ibufrdy = ibuftag0==ppc[63:4] || ibuftag1==ppc[63:4];
|
assign ibufrdy = ibuftag0==ppc[63:4] || ibuftag1==ppc[63:4];
|
|
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
// Data Cache
|
// Data Cache
|
// No-allocate on write
|
// No-allocate on write
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
reg dcaccess;
|
reg dcaccess;
|
wire dhit;
|
wire dhit;
|
wire [64:15] dtgout;
|
wire [64:15] dtgout;
|
reg wrhit;
|
reg wrhit;
|
reg [7:0] dsel_o;
|
reg [7:0] dsel_o;
|
reg [63:0] dadr_o;
|
reg [63:0] dadr_o;
|
reg [31:0] ddat;
|
reg [31:0] ddat;
|
reg wr_dcache;
|
reg wr_dcache;
|
|
|
// cache RAM 32Kb
|
// cache RAM 32Kb
|
Raptor64_dcache_ram u10
|
Raptor64_dcache_ram u10
|
(
|
(
|
.clka(clk), // input clka
|
.clka(clk), // input clka
|
.ena(1'b1),
|
.ena(1'b1),
|
.wea(dcaccess ? {8{ack_i}} : wrhit ? sel_o : 8'h00), // input [7 : 0] wea
|
.wea(dcaccess ? {8{ack_i}} : wrhit ? sel_o : 8'h00), // input [7 : 0] wea
|
.addra(adr_o[14:3]), // input [11 : 0] addra
|
.addra(adr_o[14:3]), // input [11 : 0] addra
|
.dina(dcaccess ? dat_i : dat_o), // input [63 : 0] dina
|
.dina(dcaccess ? dat_i : dat_o), // input [63 : 0] dina
|
|
|
.clkb(~clk), // input clkb
|
.clkb(~clk), // input clkb
|
.addrb(pea[14:3]), // input [11 : 0] addrb
|
.addrb(pea[14:3]), // input [11 : 0] addrb
|
.doutb(cdat) // output [63 : 0] doutb
|
.doutb(cdat) // output [63 : 0] doutb
|
);
|
);
|
|
|
|
|
Raptor64_dcache_tagram u11
|
Raptor64_dcache_tagram u11
|
(
|
(
|
.clka(clk), // input clka
|
.clka(clk), // input clka
|
.ena(dtinit | (adr_o[5:3]==3'b111)), // input ena
|
.ena(dtinit | (adr_o[5:3]==3'b111)), // input ena
|
.wea(dtinit | (dcaccess & ack_i)), // input [0 : 0] wea
|
.wea(dtinit | (dcaccess & ack_i)), // input [0 : 0] wea
|
.addra({1'b0,adr_o[14:6]}), // input [9 : 0] addra
|
.addra({1'b0,adr_o[14:6]}), // input [9 : 0] addra
|
.dina(dtinit ? {1'b0,adr_o[63:15]} : {1'b1,adr_o[63:15]}), // input [48 : 0] dina
|
.dina(dtinit ? {1'b0,adr_o[63:15]} : {1'b1,adr_o[63:15]}), // input [48 : 0] dina
|
|
|
.clkb(~clk), // input clkb
|
.clkb(~clk), // input clkb
|
.addrb({1'b0,pea[14:6]}), // input [9 : 0] addrb
|
.addrb({1'b0,pea[14:6]}), // input [9 : 0] addrb
|
.doutb(dtgout) // output [48 : 0] doutb
|
.doutb(dtgout) // output [48 : 0] doutb
|
);
|
);
|
|
|
assign dhit = (dtgout=={1'b1,pea[63:15]});
|
assign dhit = (dtgout=={1'b1,pea[63:15]});
|
|
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
|
|
reg [64:0] xData;
|
reg [64:0] xData;
|
wire xisCacheElement = (xData[63:52] != 12'hFFD && xData[63:52]!=12'hFFF) && dcache_on;
|
wire xisCacheElement = (xData[63:52] != 12'hFFD && xData[63:52]!=12'hFFF) && dcache_on;
|
reg m1IsCacheElement;
|
reg m1IsCacheElement;
|
|
|
reg nopI;
|
reg nopI;
|
wire [6:0] iFunc = insn[6:0];
|
|
wire [6:0] dFunc = dIR[6:0];
|
|
wire [5:0] dFunc6 = dIR[5:0];
|
|
wire [6:0] xFunc = xIR[6:0];
|
|
wire [5:0] xFunc6 = xIR[5:0];
|
|
wire [4:0] xFunc5 = xIR[4:0];
|
|
wire [6:0] iOpcode = insn[41:35];
|
|
wire [6:0] xOpcode = xIR[41:35];
|
|
reg [6:0] m1Opcode,m2Opcode,wOpcode;
|
|
reg [6:0] m1Func,m2Func;
|
|
reg [63:0] m1Data,m2Data,wData,tData;
|
|
reg [63:0] m2Addr;
|
|
reg [63:0] tick;
|
|
reg [63:0] tba;
|
|
reg [63:0] exception_address,ipc;
|
|
reg [63:0] a,b,c,imm,m1b;
|
|
reg prev_ihit;
|
|
reg rsf;
|
|
reg [63:5] resv_address;
|
|
reg dirqf,rirqf,m1irqf,m2irqf,wirqf,tirqf;
|
|
reg xirqf;
|
|
reg [8:0] dextype,m1extype,m2extype,wextype,textype,exception_type;
|
|
reg [8:0] xextype;
|
|
reg wLdPC,m2LdPC;
|
|
wire advanceX_edge;
|
|
reg takb;
|
|
|
|
|
|
|
|
wire [127:0] mult_out;
|
wire [127:0] mult_out;
|
wire [63:0] sqrt_out;
|
wire [63:0] sqrt_out;
|
wire [63:0] div_q;
|
wire [63:0] div_q;
|
wire [63:0] div_r;
|
wire [63:0] div_r;
|
wire sqrt_done,mult_done,div_done;
|
wire sqrt_done,mult_done,div_done;
|
wire isSqrt = xOpcode==`R && xFunc==`SQRT;
|
wire isSqrt = xOpcode==`R && xFunc==`SQRT;
|
wire [7:0] bcdaddo,bcdsubo;
|
wire [7:0] bcdaddo,bcdsubo;
|
|
|
BCDAdd u40(.ci(1'b0),.a(a[7:0]),.b(b[7:0]),.o(bcdaddo),.c());
|
BCDAdd u40(.ci(1'b0),.a(a[7:0]),.b(b[7:0]),.o(bcdaddo),.c());
|
BCDSub u41(.ci(1'b0),.a(a[7:0]),.b(b[7:0]),.o(bcdsubo),.c());
|
BCDSub u41(.ci(1'b0),.a(a[7:0]),.b(b[7:0]),.o(bcdsubo),.c());
|
|
|
isqrt #(64) u14
|
isqrt #(64) u14
|
(
|
(
|
.rst(rst_i),
|
.rst(rst_i),
|
.clk(clk),
|
.clk(clk),
|
.ce(1'b1),
|
.ce(1'b1),
|
.ld(isSqrt),
|
.ld(isSqrt),
|
.a(a),
|
.a(a),
|
.o(sqrt_out),
|
.o(sqrt_out),
|
.done(sqrt_done)
|
.done(sqrt_done)
|
);
|
);
|
|
|
wire isMulu = xOpcode==`RR && xFunc==`MULU;
|
wire isMulu = xOpcode==`RR && xFunc==`MULU;
|
wire isMuls = (xOpcode==`RR && xFunc==`MULS) || xOpcode==`MULSI;
|
wire isMuls = (xOpcode==`RR && xFunc==`MULS) || xOpcode==`MULSI;
|
wire isMuli = xOpcode==`MULSI || xOpcode==`MULUI;
|
wire isMuli = xOpcode==`MULSI || xOpcode==`MULUI;
|
wire isMult = xOpcode==`MULSI || xOpcode==`MULUI || (xOpcode==`RR && (xFunc==`MULS || xFunc==`MULU));
|
wire isMult = xOpcode==`MULSI || xOpcode==`MULUI || (xOpcode==`RR && (xFunc==`MULS || xFunc==`MULU));
|
wire isDivu = xOpcode==`RR && xFunc==`DIVU;
|
wire isDivu = xOpcode==`RR && xFunc==`DIVU;
|
wire isDivs = (xOpcode==`RR && xFunc==`DIVS) || xOpcode==`DIVSI;
|
wire isDivs = (xOpcode==`RR && xFunc==`DIVS) || xOpcode==`DIVSI;
|
wire isDivi = xOpcode==`DIVSI || xOpcode==`DIVUI;
|
wire isDivi = xOpcode==`DIVSI || xOpcode==`DIVUI;
|
wire isDiv = xOpcode==`DIVSI || xOpcode==`DIVUI || (xOpcode==`RR && (xFunc==`DIVS || xFunc==`DIVU));
|
wire isDiv = xOpcode==`DIVSI || xOpcode==`DIVUI || (xOpcode==`RR && (xFunc==`DIVS || xFunc==`DIVU));
|
|
|
wire disRRShift = dOpcode==`RR && (
|
wire disRRShift = dOpcode==`RR && (
|
dFunc==`SHL || dFunc==`ROL || dFunc==`SHR ||
|
dFunc==`SHL || dFunc==`ROL || dFunc==`SHR ||
|
dFunc==`SHRU || dFunc==`ROR || dFunc==`ROLAM
|
dFunc==`SHRU || dFunc==`ROR || dFunc==`ROLAM
|
);
|
);
|
wire disRightShift = dOpcode==`RR && (
|
wire disRightShift = dOpcode==`RR && (
|
dFunc==`SHR || dFunc==`SHRU || dFunc==`ROR
|
dFunc==`SHR || dFunc==`SHRU || dFunc==`ROR
|
);
|
);
|
|
|
Raptor64Mult u18
|
Raptor64Mult u18
|
(
|
(
|
.rst(rst_i),
|
.rst(rst_i),
|
.clk(clk),
|
.clk(clk),
|
.ld(isMult),
|
.ld(isMult),
|
.sgn(isMuls),
|
.sgn(isMuls),
|
.isMuli(isMuli),
|
.isMuli(isMuli),
|
.a(a),
|
.a(a),
|
.b(b),
|
.b(b),
|
.imm(imm),
|
.imm(imm),
|
.o(mult_out),
|
.o(mult_out),
|
.done(mult_done)
|
.done(mult_done)
|
);
|
);
|
|
|
Raptor64Div u19
|
Raptor64Div u19
|
(
|
(
|
.rst(rst_i),
|
.rst(rst_i),
|
.clk(clk),
|
.clk(clk),
|
.ld(isDiv),
|
.ld(isDiv),
|
.sgn(isDivs),
|
.sgn(isDivs),
|
.isDivi(isDivi),
|
.isDivi(isDivi),
|
.a(a),
|
.a(a),
|
.b(b),
|
.b(b),
|
.imm(imm),
|
.imm(imm),
|
.qo(div_q),
|
.qo(div_q),
|
.ro(div_r),
|
.ro(div_r),
|
.dvByZr(),
|
.dvByZr(),
|
.done(div_done)
|
.done(div_done)
|
);
|
);
|
|
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
// Floating point
|
// Floating point
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
|
|
wire [63:0] fpZLOut;
|
wire [63:0] fpZLOut;
|
wire [63:0] fpLooOut;
|
wire [63:0] fpLooOut;
|
wire fpLooDone;
|
wire fpLooDone;
|
|
|
/*
|
/*
|
fpZLUnit #(64) u30
|
fpZLUnit #(64) u30
|
(
|
(
|
.op(xFunc[5:0]),
|
.op(xFunc[5:0]),
|
.a(a),
|
.a(a),
|
.b(b), // for fcmp
|
.b(b), // for fcmp
|
.o(fpZLOut),
|
.o(fpZLOut),
|
.nanx()
|
.nanx()
|
);
|
);
|
|
|
fpLOOUnit #(64) u31
|
fpLOOUnit #(64) u31
|
(
|
(
|
.clk(clk),
|
.clk(clk),
|
.ce(1'b1),
|
.ce(1'b1),
|
.rm(rm),
|
.rm(rm),
|
.op(xFunc[5:0]),
|
.op(xFunc[5:0]),
|
.a(a),
|
.a(a),
|
.o(fpLooOut),
|
.o(fpLooOut),
|
.done(fpLooDone)
|
.done(fpLooDone)
|
);
|
);
|
|
|
*/
|
*/
|
wire dcmp_result;
|
wire dcmp_result;
|
wire [63:0] daddsub_result;
|
wire [63:0] daddsub_result;
|
wire [63:0] ddiv_result;
|
wire [63:0] ddiv_result;
|
wire [63:0] dmul_result;
|
wire [63:0] dmul_result;
|
wire [63:0] i2f_result;
|
wire [63:0] i2f_result;
|
wire [63:0] f2i_result;
|
wire [63:0] f2i_result;
|
wire [63:0] f2d_result;
|
wire [63:0] f2d_result;
|
wire [63:0] d2f_result;
|
wire [63:0] d2f_result;
|
|
|
wire f2i_iop,fpmul_iop,fpdiv_iop,fpaddsub_iop,fpcmp_iop;
|
wire f2i_iop,fpmul_iop,fpdiv_iop,fpaddsub_iop,fpcmp_iop;
|
wire f2i_ovr,fpmul_ovr,fpdiv_ovr,fpaddsub_ovr;
|
wire f2i_ovr,fpmul_ovr,fpdiv_ovr,fpaddsub_ovr;
|
wire fpmul_uf,fpaddsub_uf,fpdiv_uf;
|
wire fpmul_uf,fpaddsub_uf,fpdiv_uf;
|
|
|
|
|
`ifdef FLOATING_POINT
|
`ifdef FLOATING_POINT
|
|
|
Raptor64_fpCmp u60
|
Raptor64_fpCmp u60
|
(
|
(
|
.a(a), // input [63 : 0] a
|
.a(a), // input [63 : 0] a
|
.b(b), // input [63 : 0] b
|
.b(b), // input [63 : 0] b
|
.operation(xFunc6), // input [5 : 0] operation
|
.operation(xFunc6), // input [5 : 0] operation
|
.clk(clk), // input clk
|
.clk(clk), // input clk
|
.result(dcmp_result), // ouput [0 : 0] result
|
.result(dcmp_result), // ouput [0 : 0] result
|
.invalid_op(fpcmp_iop)
|
.invalid_op(fpcmp_iop)
|
); // ouput invalid_op
|
); // ouput invalid_op
|
|
|
Raptor64_fpAddsub u61
|
Raptor64_fpAddsub u61
|
(
|
(
|
.a(a), // input [63 : 0] a
|
.a(a), // input [63 : 0] a
|
.b(b), // input [63 : 0] b
|
.b(b), // input [63 : 0] b
|
.operation(xFunc6), // input [5 : 0] operation
|
.operation(xFunc6), // input [5 : 0] operation
|
.clk(clk), // input clk
|
.clk(clk), // input clk
|
.result(daddsub_result), // ouput [63 : 0] result
|
.result(daddsub_result), // ouput [63 : 0] result
|
.underflow(fpaddsub_uf), // ouput underflow
|
.underflow(fpaddsub_uf), // ouput underflow
|
.overflow(fpaddsub_ovr), // ouput overflow
|
.overflow(fpaddsub_ovr), // ouput overflow
|
.invalid_op(fpaddsub_iop)
|
.invalid_op(fpaddsub_iop)
|
); // ouput invalid_op
|
); // ouput invalid_op
|
|
|
Raptor64_fpDiv u62
|
Raptor64_fpDiv u62
|
(
|
(
|
.a(a), // input [63 : 0] a
|
.a(a), // input [63 : 0] a
|
.b(b), // input [63 : 0] b
|
.b(b), // input [63 : 0] b
|
.clk(clk), // input clk
|
.clk(clk), // input clk
|
.result(ddiv_result), // ouput [63 : 0] result
|
.result(ddiv_result), // ouput [63 : 0] result
|
.underflow(fpdiv_uf), // ouput underflow
|
.underflow(fpdiv_uf), // ouput underflow
|
.overflow(fpdiv_ovr), // ouput overflow
|
.overflow(fpdiv_ovr), // ouput overflow
|
.invalid_op(fpdiv_iop), // ouput invalid_op
|
.invalid_op(fpdiv_iop), // ouput invalid_op
|
.divide_by_zero()
|
.divide_by_zero()
|
); // ouput divide_by_zero
|
); // ouput divide_by_zero
|
|
|
Raptor64_fpMul u63
|
Raptor64_fpMul u63
|
(
|
(
|
.a(a), // input [63 : 0] a
|
.a(a), // input [63 : 0] a
|
.b(b), // input [63 : 0] b
|
.b(b), // input [63 : 0] b
|
.clk(clk), // input clk
|
.clk(clk), // input clk
|
.result(dmul_result), // ouput [63 : 0] result
|
.result(dmul_result), // ouput [63 : 0] result
|
.underflow(fpmul_uf), // ouput underflow
|
.underflow(fpmul_uf), // ouput underflow
|
.overflow(fpmul_ovr), // ouput overflow
|
.overflow(fpmul_ovr), // ouput overflow
|
.invalid_op(fpmul_iop)
|
.invalid_op(fpmul_iop)
|
); // ouput invalid_op
|
); // ouput invalid_op
|
|
|
Raptor64_fpItoF u64
|
Raptor64_fpItoF u64
|
(
|
(
|
.a(a), // input [63 : 0] a
|
.a(a), // input [63 : 0] a
|
.clk(clk), // input clk
|
.clk(clk), // input clk
|
.result(i2f_result)
|
.result(i2f_result)
|
); // ouput [63 : 0] result
|
); // ouput [63 : 0] result
|
|
|
Raptor64_fpFtoI u65
|
Raptor64_fpFtoI u65
|
(
|
(
|
.a(a), // input [63 : 0] a
|
.a(a), // input [63 : 0] a
|
.clk(clk), // input clk
|
.clk(clk), // input clk
|
.result(f2i_result), // ouput [63 : 0] result
|
.result(f2i_result), // ouput [63 : 0] result
|
.overflow(f2i_ovr), // ouput overflow
|
.overflow(f2i_ovr), // ouput overflow
|
.invalid_op(f2i_iop)
|
.invalid_op(f2i_iop)
|
); // ouput invalid_op
|
); // ouput invalid_op
|
|
|
`endif
|
`endif
|
|
|
always @(posedge clk)
|
always @(posedge clk)
|
if (rst_i) begin
|
if (rst_i) begin
|
fltctr <= 6'd0;
|
fltctr <= 6'd0;
|
end
|
end
|
else begin
|
else begin
|
if (fltdone) begin
|
if (fltdone) begin
|
FPC_overx <= fp_ovr;
|
FPC_overx <= fp_ovr;
|
end
|
end
|
if (advanceX) begin
|
if (advanceX) begin
|
if (xOpcode==`FP) begin
|
if (xOpcode==`FP) begin
|
if (xFunc[5:0]==6'b000000) // FDADD
|
if (xFunc[5:0]==6'b000000) // FDADD
|
fltctr <= 6'd12;
|
fltctr <= 6'd12;
|
else if (xFunc[5:0]==6'b000001) // FDSUB
|
else if (xFunc[5:0]==6'b000001) // FDSUB
|
fltctr <= 6'd12;
|
fltctr <= 6'd12;
|
else if (xFunc[5:0]==6'b000010) // FDMUL
|
else if (xFunc[5:0]==6'b000010) // FDMUL
|
fltctr <= 6'd12;
|
fltctr <= 6'd12;
|
else if (xFunc[5:0]==6'b000011) // FDDIV
|
else if (xFunc[5:0]==6'b000011) // FDDIV
|
fltctr <= 6'd12;
|
fltctr <= 6'd12;
|
else if (xFunc[5:0]==6'b000100) // unordered
|
else if (xFunc[5:0]==6'b000100) // unordered
|
fltctr <= 6'd2;
|
fltctr <= 6'd2;
|
else if (xFunc[5:0]==6'b001100) // less than
|
else if (xFunc[5:0]==6'b001100) // less than
|
fltctr <= 6'd2;
|
fltctr <= 6'd2;
|
else if (xFunc[5:0]==6'b010100) // equal
|
else if (xFunc[5:0]==6'b010100) // equal
|
fltctr <= 6'd2;
|
fltctr <= 6'd2;
|
else if (xFunc[5:0]==6'b011100) // less than or equal
|
else if (xFunc[5:0]==6'b011100) // less than or equal
|
fltctr <= 6'd2;
|
fltctr <= 6'd2;
|
else if (xFunc[5:0]==6'b100100) // greater than
|
else if (xFunc[5:0]==6'b100100) // greater than
|
fltctr <= 6'd2;
|
fltctr <= 6'd2;
|
else if (xFunc[5:0]==6'b101100) // not equal
|
else if (xFunc[5:0]==6'b101100) // not equal
|
fltctr <= 6'd2;
|
fltctr <= 6'd2;
|
else if (xFunc[5:0]==6'b110100) // greater than or equal
|
else if (xFunc[5:0]==6'b110100) // greater than or equal
|
fltctr <= 6'd2;
|
fltctr <= 6'd2;
|
else if (xFunc[5:0]==6'b000101) // ItoFD
|
else if (xFunc[5:0]==6'b000101) // ItoFD
|
fltctr <= 6'd7;
|
fltctr <= 6'd7;
|
else if (xFunc[5:0]==6'b000110) // FFtoI
|
else if (xFunc[5:0]==6'b000110) // FFtoI
|
fltctr <= 6'd6;
|
fltctr <= 6'd6;
|
else if (xFunc[5:0]==6'b000111) // FtoD
|
else if (xFunc[5:0]==6'b000111) // FtoD
|
fltctr <= 6'd2;
|
fltctr <= 6'd2;
|
else if (xFunc[5:0]==6'b001000) // DtoF
|
else if (xFunc[5:0]==6'b001000) // DtoF
|
fltctr <= 6'd2;
|
fltctr <= 6'd2;
|
else
|
else
|
fltctr <= 6'd0;
|
fltctr <= 6'd0;
|
end
|
end
|
end
|
end
|
else begin
|
else begin
|
if (fltctr > 6'd0)
|
if (fltctr > 6'd0)
|
fltctr <= fltctr - 6'd1;
|
fltctr <= fltctr - 6'd1;
|
end
|
end
|
end
|
end
|
|
|
function [2:0] popcnt6;
|
function [2:0] popcnt6;
|
input [5:0] a;
|
input [5:0] a;
|
begin
|
begin
|
case(a)
|
case(a)
|
6'b000000: popcnt6 = 3'd0;
|
6'b000000: popcnt6 = 3'd0;
|
6'b000001: popcnt6 = 3'd1;
|
6'b000001: popcnt6 = 3'd1;
|
6'b000010: popcnt6 = 3'd1;
|
6'b000010: popcnt6 = 3'd1;
|
6'b000011: popcnt6 = 3'd2;
|
6'b000011: popcnt6 = 3'd2;
|
6'b000100: popcnt6 = 3'd1;
|
6'b000100: popcnt6 = 3'd1;
|
6'b000101: popcnt6 = 3'd2;
|
6'b000101: popcnt6 = 3'd2;
|
6'b000110: popcnt6 = 3'd2;
|
6'b000110: popcnt6 = 3'd2;
|
6'b000111: popcnt6 = 3'd3;
|
6'b000111: popcnt6 = 3'd3;
|
6'b001000: popcnt6 = 3'd1;
|
6'b001000: popcnt6 = 3'd1;
|
6'b001001: popcnt6 = 3'd2;
|
6'b001001: popcnt6 = 3'd2;
|
6'b001010: popcnt6 = 3'd2;
|
6'b001010: popcnt6 = 3'd2;
|
6'b001011: popcnt6 = 3'd3;
|
6'b001011: popcnt6 = 3'd3;
|
6'b001100: popcnt6 = 3'd2;
|
6'b001100: popcnt6 = 3'd2;
|
6'b001101: popcnt6 = 3'd3;
|
6'b001101: popcnt6 = 3'd3;
|
6'b001110: popcnt6 = 3'd3;
|
6'b001110: popcnt6 = 3'd3;
|
6'b001111: popcnt6 = 3'd4;
|
6'b001111: popcnt6 = 3'd4;
|
6'b010000: popcnt6 = 3'd1;
|
6'b010000: popcnt6 = 3'd1;
|
6'b010001: popcnt6 = 3'd2;
|
6'b010001: popcnt6 = 3'd2;
|
6'b010010: popcnt6 = 3'd2;
|
6'b010010: popcnt6 = 3'd2;
|
6'b010011: popcnt6 = 3'd3;
|
6'b010011: popcnt6 = 3'd3;
|
6'b010100: popcnt6 = 3'd2;
|
6'b010100: popcnt6 = 3'd2;
|
6'b010101: popcnt6 = 3'd3;
|
6'b010101: popcnt6 = 3'd3;
|
6'b010110: popcnt6 = 3'd3;
|
6'b010110: popcnt6 = 3'd3;
|
6'b010111: popcnt6 = 3'd4;
|
6'b010111: popcnt6 = 3'd4;
|
6'b011000: popcnt6 = 3'd2;
|
6'b011000: popcnt6 = 3'd2;
|
6'b011001: popcnt6 = 3'd3;
|
6'b011001: popcnt6 = 3'd3;
|
6'b011010: popcnt6 = 3'd3;
|
6'b011010: popcnt6 = 3'd3;
|
6'b011011: popcnt6 = 3'd4;
|
6'b011011: popcnt6 = 3'd4;
|
6'b011100: popcnt6 = 3'd3;
|
6'b011100: popcnt6 = 3'd3;
|
6'b011101: popcnt6 = 3'd4;
|
6'b011101: popcnt6 = 3'd4;
|
6'b011110: popcnt6 = 3'd4;
|
6'b011110: popcnt6 = 3'd4;
|
6'b011111: popcnt6 = 3'd5;
|
6'b011111: popcnt6 = 3'd5;
|
6'b100000: popcnt6 = 3'd1;
|
6'b100000: popcnt6 = 3'd1;
|
6'b100001: popcnt6 = 3'd2;
|
6'b100001: popcnt6 = 3'd2;
|
6'b100010: popcnt6 = 3'd2;
|
6'b100010: popcnt6 = 3'd2;
|
6'b100011: popcnt6 = 3'd3;
|
6'b100011: popcnt6 = 3'd3;
|
6'b100100: popcnt6 = 3'd2;
|
6'b100100: popcnt6 = 3'd2;
|
6'b100101: popcnt6 = 3'd3;
|
6'b100101: popcnt6 = 3'd3;
|
6'b100110: popcnt6 = 3'd3;
|
6'b100110: popcnt6 = 3'd3;
|
6'b100111: popcnt6 = 3'd4;
|
6'b100111: popcnt6 = 3'd4;
|
6'b101000: popcnt6 = 3'd2;
|
6'b101000: popcnt6 = 3'd2;
|
6'b101001: popcnt6 = 3'd3;
|
6'b101001: popcnt6 = 3'd3;
|
6'b101010: popcnt6 = 3'd3;
|
6'b101010: popcnt6 = 3'd3;
|
6'b101011: popcnt6 = 3'd4;
|
6'b101011: popcnt6 = 3'd4;
|
6'b101100: popcnt6 = 3'd3;
|
6'b101100: popcnt6 = 3'd3;
|
6'b101101: popcnt6 = 3'd4;
|
6'b101101: popcnt6 = 3'd4;
|
6'b101110: popcnt6 = 3'd4;
|
6'b101110: popcnt6 = 3'd4;
|
6'b101111: popcnt6 = 3'd5;
|
6'b101111: popcnt6 = 3'd5;
|
6'b110000: popcnt6 = 3'd2;
|
6'b110000: popcnt6 = 3'd2;
|
6'b110001: popcnt6 = 3'd3;
|
6'b110001: popcnt6 = 3'd3;
|
6'b110010: popcnt6 = 3'd3;
|
6'b110010: popcnt6 = 3'd3;
|
6'b110011: popcnt6 = 3'd4;
|
6'b110011: popcnt6 = 3'd4;
|
6'b110100: popcnt6 = 3'd3;
|
6'b110100: popcnt6 = 3'd3;
|
6'b110101: popcnt6 = 3'd4;
|
6'b110101: popcnt6 = 3'd4;
|
6'b110110: popcnt6 = 3'd4;
|
6'b110110: popcnt6 = 3'd4;
|
6'b110111: popcnt6 = 3'd5;
|
6'b110111: popcnt6 = 3'd5;
|
6'b111000: popcnt6 = 3'd3;
|
6'b111000: popcnt6 = 3'd3;
|
6'b111001: popcnt6 = 3'd4;
|
6'b111001: popcnt6 = 3'd4;
|
6'b111010: popcnt6 = 3'd4;
|
6'b111010: popcnt6 = 3'd4;
|
6'b111011: popcnt6 = 3'd5;
|
6'b111011: popcnt6 = 3'd5;
|
6'b111100: popcnt6 = 3'd4;
|
6'b111100: popcnt6 = 3'd4;
|
6'b111101: popcnt6 = 3'd5;
|
6'b111101: popcnt6 = 3'd5;
|
6'b111110: popcnt6 = 3'd5;
|
6'b111110: popcnt6 = 3'd5;
|
6'b111111: popcnt6 = 3'd6;
|
6'b111111: popcnt6 = 3'd6;
|
endcase
|
endcase
|
end
|
end
|
endfunction
|
endfunction
|
|
|
function [5:0] popcnt36;
|
function [5:0] popcnt36;
|
input [35:0] a;
|
input [35:0] a;
|
begin
|
begin
|
popcnt36 = popcnt6(a[5:0]) +
|
popcnt36 = popcnt6(a[5:0]) +
|
popcnt6(a[11:6]) +
|
popcnt6(a[11:6]) +
|
popcnt6(a[17:12]) +
|
popcnt6(a[17:12]) +
|
popcnt6(a[23:18]) +
|
popcnt6(a[23:18]) +
|
popcnt6(a[29:24]) +
|
popcnt6(a[29:24]) +
|
popcnt6(a[35:30]);
|
popcnt6(a[35:30]);
|
end
|
end
|
endfunction
|
endfunction
|
|
|
wire [63:0] jmp_tgt = dOpcode[6:4]==`IMM ? {dIR[26:0],insn[34:0],2'b00} : {pc[63:37],insn[34:0],2'b00};
|
wire [63:0] jmp_tgt = dOpcode[6:4]==`IMM ? {dIR[26:0],insn[34:0],2'b00} : {pc[63:37],insn[34:0],2'b00};
|
|
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
// Stack for return address predictor
|
// Stack for return address predictor
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
`ifdef RAS_PREDICTION
|
`ifdef RAS_PREDICTION
|
reg [63:0] ras [63:0]; // return address stack, return predictions
|
reg [63:0] ras [63:0]; // return address stack, return predictions
|
reg [5:0] ras_sp; // stack pointer
|
reg [5:0] ras_sp; // stack pointer
|
`endif
|
`endif
|
`ifdef BTB
|
`ifdef BTB
|
reg [63:0] btb [63:0]; // branch target buffer
|
reg [63:0] btb [63:0]; // branch target buffer
|
`endif
|
`endif
|
|
|
`ifdef BRANCH_PREDICTION_SIMPLE
|
`ifdef BRANCH_PREDICTION_SIMPLE
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
// Simple predictor:
|
// Simple predictor:
|
// - backwards branches are predicted taken, others predicted not taken.
|
// - backwards branches are predicted taken, others predicted not taken.
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
reg predict_taken;
|
reg predict_taken;
|
|
|
always @(iOpcode or insn)
|
always @(iOpcode or insn)
|
case(iOpcode)
|
case(iOpcode)
|
`BTRR:
|
`BTRR:
|
case(insn[4:0])
|
case(insn[4:0])
|
`BEQ,`BNE,`BLT,`BLE,`BGT,`BGE,`BLTU,`BLEU,`BGTU,`BGEU,`BAND,`BOR,`BNR:
|
`BEQ,`BNE,`BLT,`BLE,`BGT,`BGE,`BLTU,`BLEU,`BGTU,`BGEU,`BAND,`BOR,`BNR:
|
predict_taken = insn[24];
|
predict_taken = insn[24];
|
default: predict_taken = 1'd0;
|
default: predict_taken = 1'd0;
|
endcase
|
endcase
|
`BEQI,`BNEI,`BLTI,`BLEI,`BGTI,`BGEI,`BLTUI,`BLEUI,`BGTUI,`BGEUI:
|
`BEQI,`BNEI,`BLTI,`BLEI,`BGTI,`BGEI,`BLTUI,`BLEUI,`BGTUI,`BGEUI:
|
predict_taken = insn[29];
|
predict_taken = insn[29];
|
default:
|
default:
|
predict_taken = 1'd0;
|
predict_taken = 1'd0;
|
endcase
|
endcase
|
`else
|
`else
|
|
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
// Branch history table.
|
// Branch history table.
|
// The history table is updated by the EX stage and read in
|
// The history table is updated by the EX stage and read in
|
// both the EX and IF stages.
|
// both the EX and IF stages.
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
reg [2:0] gbl_branch_hist;
|
wire predict_taken;
|
reg [1:0] branch_history_table [255:0];
|
|
wire [7:0] bht_wa = {xpc[5:0],gbl_branch_hist[2:1]}; // write address
|
|
wire [7:0] bht_ra1 = {xpc[5:0],gbl_branch_hist[2:1]}; // read address (EX stage)
|
|
wire [7:0] bht_ra2 = {pc[5:0],gbl_branch_hist[2:1]}; // read address (IF stage)
|
|
wire [1:0] bht_xbits = branch_history_table[bht_ra1];
|
|
wire [1:0] bht_ibits = branch_history_table[bht_ra2];
|
|
wire predict_taken = bht_ibits==2'd0 || bht_ibits==2'd1;
|
|
|
|
wire isxBranchI = (xOpcode==`BEQI || xOpcode==`BNEI ||
|
|
xOpcode==`BLTI || xOpcode==`BLEI || xOpcode==`BGTI || xOpcode==`BGEI ||
|
|
xOpcode==`BLTUI || xOpcode==`BLEUI || xOpcode==`BGTUI || xOpcode==`BGEUI)
|
|
;
|
|
wire isxBranch = isxBranchI || xOpcode==`TRAPcc || xOpcode==`TRAPcci || xOpcode==`BTRI || xOpcode==`BTRR;
|
|
|
|
reg [1:0] xbits_new;
|
|
|
|
always @(takb or bht_xbits)
|
Raptor64_BranchHistory u6
|
if (takb) begin
|
(
|
if (bht_xbits != 2'd1)
|
.rst(rst_i),
|
xbits_new <= bht_xbits + 2'd1;
|
.clk(clk),
|
else
|
.advanceX(advanceX),
|
xbits_new <= bht_xbits;
|
.xIR(xIR),
|
end
|
.pc(pc),
|
else begin
|
.xpc(xpc),
|
if (bht_xbits != 2'd2)
|
.takb(takb),
|
xbits_new <= bht_xbits - 2'd1;
|
.predict_taken(predict_taken)
|
else
|
);
|
xbits_new <= bht_xbits;
|
|
end
|
|
|
|
// For simulation only, initialize the history table to zeros.
|
|
// In the real world we don't care.
|
|
initial begin
|
|
for (n = 0; n < 256; n = n + 1)
|
|
branch_history_table[n] = 0;
|
|
end
|
|
`endif
|
`endif
|
|
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
// Evaluate branch conditions.
|
// Evaluate branch conditions.
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
wire signed [63:0] as = a;
|
wire signed [63:0] as = a;
|
wire signed [63:0] bs = b;
|
wire signed [63:0] bs = b;
|
wire signed [63:0] imms = imm;
|
wire signed [63:0] imms = imm;
|
wire aeqz = a==64'd0;
|
wire aeqz = a==64'd0;
|
wire beqz = b==64'd0;
|
wire beqz = b==64'd0;
|
wire immeqz = imm==64'd0;
|
wire immeqz = imm==64'd0;
|
|
|
wire eqb0 = a[ 7: 0]==b[ 7: 0];
|
wire eqb0 = a[ 7: 0]==b[ 7: 0];
|
wire eqb1 = a[15: 8]==b[15: 8];
|
wire eqb1 = a[15: 8]==b[15: 8];
|
wire eqb2 = a[23:16]==b[23:16];
|
wire eqb2 = a[23:16]==b[23:16];
|
wire eqb3 = a[31:24]==b[31:24];
|
wire eqb3 = a[31:24]==b[31:24];
|
wire eqb4 = a[39:32]==b[39:32];
|
wire eqb4 = a[39:32]==b[39:32];
|
wire eqb5 = a[47:40]==b[47:40];
|
wire eqb5 = a[47:40]==b[47:40];
|
wire eqb6 = a[55:48]==b[55:48];
|
wire eqb6 = a[55:48]==b[55:48];
|
wire eqb7 = a[63:56]==b[63:56];
|
wire eqb7 = a[63:56]==b[63:56];
|
|
|
wire eqc0 = eqb0 & eqb1;
|
wire eqc0 = eqb0 & eqb1;
|
wire eqc1 = eqb2 & eqb3;
|
wire eqc1 = eqb2 & eqb3;
|
wire eqc2 = eqb4 & eqb5;
|
wire eqc2 = eqb4 & eqb5;
|
wire eqc3 = eqb6 & eqb7;
|
wire eqc3 = eqb6 & eqb7;
|
|
|
wire eqh0 = eqc0 & eqc1;
|
wire eqh0 = eqc0 & eqc1;
|
wire eqh1 = eqc2 & eqc3;
|
wire eqh1 = eqc2 & eqc3;
|
|
|
wire eqw = eqh0 & eqh1;
|
wire eqw = eqh0 & eqh1;
|
wire eq = eqw;
|
wire eq = eqw;
|
|
|
wire eqi = a==imm;
|
wire eqi = a==imm;
|
wire lt = $signed(a) < $signed(b);
|
wire lt = $signed(a) < $signed(b);
|
wire lti = as < imms;
|
wire lti = as < imms;
|
wire ltu = a < b;
|
wire ltu = a < b;
|
wire ltui = a < imm;
|
wire ltui = a < imm;
|
|
|
always @(xOpcode or xFunc or a or eq or eqi or lt or lti or ltu or ltui or aeqz or beqz or rsf or xIR)
|
always @(xOpcode or xFunc or a or eq or eqi or lt or lti or ltu or ltui or aeqz or beqz or rsf or xIR)
|
case (xOpcode)
|
case (xOpcode)
|
`BTRR:
|
`BTRR:
|
case(xFunc5)
|
case(xFunc5)
|
`BRA: takb = 1'b1;
|
`BRA: takb = 1'b1;
|
`BRN: takb = 1'b0;
|
`BRN: takb = 1'b0;
|
`BEQ: takb = eq;
|
`BEQ: takb = eq;
|
`BNE: takb = !eq;
|
`BNE: takb = !eq;
|
`BLT: takb = lt;
|
`BLT: takb = lt;
|
`BLE: takb = lt|eq;
|
`BLE: takb = lt|eq;
|
`BGT: takb = !(lt|eq);
|
`BGT: takb = !(lt|eq);
|
`BGE: takb = !lt;
|
`BGE: takb = !lt;
|
`BLTU: takb = ltu;
|
`BLTU: takb = ltu;
|
`BLEU: takb = ltu|eq;
|
`BLEU: takb = ltu|eq;
|
`BGTU: takb = !(ltu|eq);
|
`BGTU: takb = !(ltu|eq);
|
`BGEU: takb = !ltu;
|
`BGEU: takb = !ltu;
|
`BOR: takb = !aeqz || !beqz;
|
`BOR: takb = !aeqz || !beqz;
|
`BAND: takb = !aeqz && !beqz;
|
`BAND: takb = !aeqz && !beqz;
|
`BNR: takb = !rsf;
|
`BNR: takb = !rsf;
|
`LOOP: takb = !beqz;
|
`LOOP: takb = !beqz;
|
`BEQR: takb = eq;
|
`BEQR: takb = eq;
|
`BNER: takb = !eq;
|
`BNER: takb = !eq;
|
`BLTR: takb = lt;
|
`BLTR: takb = lt;
|
`BLER: takb = lt|eq;
|
`BLER: takb = lt|eq;
|
`BGTR: takb = !(lt|eq);
|
`BGTR: takb = !(lt|eq);
|
`BGER: takb = !lt;
|
`BGER: takb = !lt;
|
`BLTUR: takb = ltu;
|
`BLTUR: takb = ltu;
|
`BLEUR: takb = ltu|eq;
|
`BLEUR: takb = ltu|eq;
|
`BGTUR: takb = !(ltu|eq);
|
`BGTUR: takb = !(ltu|eq);
|
`BGEUR: takb = !ltu;
|
`BGEUR: takb = !ltu;
|
default: takb = 1'b0;
|
default: takb = 1'b0;
|
endcase
|
endcase
|
`BEQI: takb = eqi;
|
`BEQI: takb = eqi;
|
`BNEI: takb = !eqi;
|
`BNEI: takb = !eqi;
|
`BLTI: takb = lti;
|
`BLTI: takb = lti;
|
`BLEI: takb = lti|eqi;
|
`BLEI: takb = lti|eqi;
|
`BGTI: takb = !(lti|eqi);
|
`BGTI: takb = !(lti|eqi);
|
`BGEI: takb = !lti;
|
`BGEI: takb = !lti;
|
`BLTUI: takb = ltui;
|
`BLTUI: takb = ltui;
|
`BLEUI: takb = ltui|eqi;
|
`BLEUI: takb = ltui|eqi;
|
`BGTUI: takb = !(ltui|eqi);
|
`BGTUI: takb = !(ltui|eqi);
|
`BGEUI: takb = !ltui;
|
`BGEUI: takb = !ltui;
|
`BTRI:
|
`BTRI:
|
case(xIR[24:18])
|
case(xIR[24:20])
|
`BRA: takb = 1'b1;
|
`BRA: takb = 1'b1;
|
`BRN: takb = 1'b0;
|
`BRN: takb = 1'b0;
|
`BEQ: takb = eqi;
|
`BEQ: takb = eqi;
|
`BNE: takb = !eqi;
|
`BNE: takb = !eqi;
|
`BLT: takb = lti;
|
`BLT: takb = lti;
|
`BLE: takb = lti|eqi;
|
`BLE: takb = lti|eqi;
|
`BGT: takb = !(lti|eqi);
|
`BGT: takb = !(lti|eqi);
|
`BGE: takb = !lti;
|
`BGE: takb = !lti;
|
`BLTU: takb = ltui;
|
`BLTU: takb = ltui;
|
`BLEU: takb = ltui|eqi;
|
`BLEU: takb = ltui|eqi;
|
`BGTU: takb = !(ltui|eqi);
|
`BGTU: takb = !(ltui|eqi);
|
`BGEU: takb = !ltui;
|
`BGEU: takb = !ltui;
|
default: takb = 1'b0;
|
default: takb = 1'b0;
|
endcase
|
endcase
|
`TRAPcc:
|
`TRAPcc:
|
case(xFunc5)
|
case(xFunc5)
|
`TEQ: takb = eq;
|
`TEQ: takb = eq;
|
`TNE: takb = !eq;
|
`TNE: takb = !eq;
|
`TLT: takb = lt;
|
`TLT: takb = lt;
|
`TLE: takb = lt|eq;
|
`TLE: takb = lt|eq;
|
`TGT: takb = !(lt|eq);
|
`TGT: takb = !(lt|eq);
|
`TGE: takb = !lt;
|
`TGE: takb = !lt;
|
`TLTU: takb = ltu;
|
`TLTU: takb = ltu;
|
`TLEU: takb = ltu|eq;
|
`TLEU: takb = ltu|eq;
|
`TGTU: takb = !(ltu|eq);
|
`TGTU: takb = !(ltu|eq);
|
`TGEU: takb = !ltu;
|
`TGEU: takb = !ltu;
|
default: takb = 1'b0;
|
default: takb = 1'b0;
|
endcase
|
endcase
|
`TRAPcci:
|
`TRAPcci:
|
case(xIR[29:25])
|
case(xIR[29:25])
|
`TEQI: takb = eqi;
|
`TEQI: takb = eqi;
|
`TNEI: takb = !eqi;
|
`TNEI: takb = !eqi;
|
`TLTI: takb = lti;
|
`TLTI: takb = lti;
|
`TLEI: takb = lti|eqi;
|
`TLEI: takb = lti|eqi;
|
`TGTI: takb = !(lti|eqi);
|
`TGTI: takb = !(lti|eqi);
|
`TGEI: takb = !lti;
|
`TGEI: takb = !lti;
|
`TLTUI: takb = ltui;
|
`TLTUI: takb = ltui;
|
`TLEUI: takb = ltui|eqi;
|
`TLEUI: takb = ltui|eqi;
|
`TGTUI: takb = !(ltui|eqi);
|
`TGTUI: takb = !(ltui|eqi);
|
`TGEUI: takb = !ltui;
|
`TGEUI: takb = !ltui;
|
default: takb = 1'b0;
|
default: takb = 1'b0;
|
endcase
|
endcase
|
default:
|
default:
|
takb = 1'b0;
|
takb = 1'b0;
|
endcase
|
endcase
|
|
|
|
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
// Datapath (ALU) operations.
|
// Datapath (ALU) operations.
|
//-----------------------------------------------------------------------------
|
//-----------------------------------------------------------------------------
|
wire [6:0] cntlzo,cntloo;
|
wire [6:0] cntlzo,cntloo;
|
cntlz64 u12 (.clk(clk), .i(a), .o(cntlzo) );
|
cntlz64 u12 (.clk(clk), .i(a), .o(cntlzo) );
|
cntlo64 u13 (.clk(clk), .i(a), .o(cntloo) );
|
cntlo64 u13 (.clk(clk), .i(a), .o(cntloo) );
|
|
|
reg [1:0] shftop;
|
reg [1:0] shftop;
|
wire [63:0] shfto;
|
wire [63:0] shfto;
|
reg [63:0] masko;
|
reg [63:0] masko;
|
//wire shl = (xOpcode==`RR && xFunc==`SHL) || (xOpcode==`SHFTI && xFunc==`SHLI);
|
reg [63:0] bfextd;
|
//wire shr = (xOpcode==`RR && xFunc==`SHR) || (xOpcode==`SHFTI && xFunc==`SHRI);
|
|
//wire shru = (xOpcode==`RR && xFunc==`SHRU) || (xOpcode==`SHFTI && xFunc==`SHRUI);
|
|
//wire rol = (xOpcode==`RR && xFunc==`ROL) || (xOpcode==`SHFTI && xFunc==`ROLI);
|
|
//wire ror = (xOpcode==`RR && xFunc==`ROR) || (xOpcode==`SHFTI && xFunc==`RORI);
|
|
//wire rolam = (xOpcode==`RR && xFunc==`ROLAM) || (xOpcode==`SHFTI && xFunc==`ROLAMI);
|
|
//
|
|
//always @(shl,shr,shru,rol,ror,rolam)
|
|
// if (shl) shftop = 2'b00;
|
|
// else if (rol | ror | rolam) shftop = 2'b01;
|
|
// else if (shru) shftop = 2'b10;
|
|
// else if (shr) shftop = 2'b11;
|
|
// else shftop = 2'b01;
|
|
|
|
wire [127:0] shlxo = {64'd0,a} << b[5:0];
|
wire [127:0] shlxo = {64'd0,a} << b[5:0];
|
wire [127:0] shruxo = {a,64'd0} >> b[5:0];
|
wire [127:0] shruxo = {a,64'd0} >> b[5:0];
|
wire [63:0] shlo = shlxo[63:0];
|
wire [63:0] shlo = shlxo[63:0];
|
wire [63:0] shruo = shruxo[127:64];
|
wire [63:0] shruo = shruxo[127:64];
|
wire [63:0] rolo = {shlo[127:64]|shlo[63:0]};
|
wire [63:0] rolo = {shlxo[127:64]|shlxo[63:0]};
|
wire [63:0] roro = {shruo[127:64]|shruo[63:0]};
|
wire [63:0] roro = {shruxo[127:64]|shruxo[63:0]};
|
wire [63:0] shro = ~(~a >> b[5:0]);
|
wire [63:0] shro = ~(~a >> b[5:0]);
|
// generate mask
|
// generate mask
|
wire [5:0] mb = xIR[12:7];
|
wire [5:0] mb = xIR[12:7];
|
wire [5:0] me = xIR[18:13];
|
wire [5:0] me = xIR[18:13];
|
integer nn;
|
integer nn;
|
always @(mb or me or nn)
|
always @(mb or me or nn)
|
for (nn = 0; nn < 64; nn = nn + 1)
|
for (nn = 0; nn < 64; nn = nn + 1)
|
masko[nn] <= (nn >= mb) ^ (nn <= me) ^ (me >= mb);
|
masko[nn] <= (nn >= mb) ^ (nn <= me) ^ (me >= mb);
|
/*
|
|
shiftAndMask #(64) u15
|
|
(
|
|
.op(shftop),
|
|
.oz(1'b0), // zero the output
|
|
.a(a),
|
|
.b(b[5:0]),
|
|
.mb(xIR[12:7]),
|
|
.me(xIR[18:13]),
|
|
.o(shfto),
|
|
.mo(masko)
|
|
);
|
|
|
|
*/
|
|
always @(xOpcode or xFunc or a or b or imm or as or bs or imms or xpc or
|
always @(xOpcode or xFunc or a or b or imm or as or bs or imms or xpc or
|
sqrt_out or cntlzo or cntloo or tick or ipc or tba or AXC or
|
sqrt_out or cntlzo or cntloo or tick or ipc or tba or AXC or
|
lt or eq or ltu or mult_out or lti or eqi or ltui or xIR or div_q or div_r or
|
lt or eq or ltu or mult_out or lti or eqi or ltui or xIR or div_q or div_r or
|
shfto or masko or bcdaddo or bcdsubo or fpLooOut or fpZLOut
|
shfto or masko or bcdaddo or bcdsubo or fpLooOut or fpZLOut or
|
`ifdef TLB
|
`ifdef TLB
|
or Wired or Index or Random or TLBPhysPage0 or TLBPhysPage1 or TLBVirtPage or TLBASID or
|
PageTableAddr or BadVAddr or ASID or tlbo or
|
PageTableAddr or BadVAddr or ASID or TLBPageMask
|
|
`endif
|
`endif
|
or ASID or EPC or mutex_gate or IPC or CauseCode or TBA or xAXC or nonICacheSeg or rm or
|
ASID or EPC or mutex_gate or IPC or CauseCode or TBA or xAXC or nonICacheSeg or rm or
|
rando
|
rando
|
)
|
)
|
casex(xOpcode)
|
casex(xOpcode)
|
`R:
|
`R:
|
casex(xFunc)
|
casex(xFunc)
|
`COM: xData = ~a;
|
`COM: xData = ~a;
|
`NOT: xData = ~|a;
|
`NOT: xData = ~|a;
|
`NEG: xData = -a;
|
`NEG: xData = -a;
|
`ABS: xData = a[63] ? -a : a;
|
`ABS: xData = a[63] ? -a : a;
|
`SGN: xData = a[63] ? 65'h1FFFFFFFF_FFFFFFFF : aeqz ? 65'd0 : 65'd1;
|
`SGN: xData = a[63] ? 65'h1FFFFFFFF_FFFFFFFF : aeqz ? 65'd0 : 65'd1;
|
`MOV: xData = a;
|
`MOV: xData = a;
|
`SQRT: xData = sqrt_out;
|
`SQRT: xData = sqrt_out;
|
`SWAP: xData = {a[31:0],a[63:32]};
|
`SWAP: xData = {a[31:0],a[63:32]};
|
|
|
`REDOR: xData = |a;
|
`REDOR: xData = |a;
|
`REDAND: xData = &a;
|
`REDAND: xData = &a;
|
|
|
`CTLZ: xData = cntlzo;
|
`CTLZ: xData = cntlzo;
|
`CTLO: xData = cntloo;
|
`CTLO: xData = cntloo;
|
`CTPOP: xData = {4'd0,popcnt6(a[5:0])} +
|
`CTPOP: xData = {4'd0,popcnt6(a[5:0])} +
|
{4'd0,popcnt6(a[11:6])} +
|
{4'd0,popcnt6(a[11:6])} +
|
{4'd0,popcnt6(a[17:12])} +
|
{4'd0,popcnt6(a[17:12])} +
|
{4'd0,popcnt6(a[23:18])} +
|
{4'd0,popcnt6(a[23:18])} +
|
{4'd0,popcnt6(a[29:24])} +
|
{4'd0,popcnt6(a[29:24])} +
|
{4'd0,popcnt6(a[35:30])} +
|
{4'd0,popcnt6(a[35:30])} +
|
{4'd0,popcnt6(a[41:36])} +
|
{4'd0,popcnt6(a[41:36])} +
|
{4'd0,popcnt6(a[47:42])} +
|
{4'd0,popcnt6(a[47:42])} +
|
{4'd0,popcnt6(a[53:48])} +
|
{4'd0,popcnt6(a[53:48])} +
|
{4'd0,popcnt6(a[59:54])} +
|
{4'd0,popcnt6(a[59:54])} +
|
{4'd0,popcnt6(a[63:60])}
|
{4'd0,popcnt6(a[63:60])}
|
;
|
;
|
`SEXT8: xData = {{56{a[7]}},a[7:0]};
|
`SEXT8: xData = {{56{a[7]}},a[7:0]};
|
`SEXT16: xData = {{48{a[15]}},a[15:0]};
|
`SEXT16: xData = {{48{a[15]}},a[15:0]};
|
`SEXT32: xData = {{32{a[31]}},a[31:0]};
|
`SEXT32: xData = {{32{a[31]}},a[31:0]};
|
|
|
|
`MTSPR: xData = a;
|
`MFSPR:
|
`MFSPR:
|
case(xIR[12:7])
|
case(xIR[12:7])
|
`ifdef TLB
|
`ifdef TLB
|
`Wired: xData = Wired;
|
`TLBWired: xData = tlbo;
|
`TLBIndex: xData = Index;
|
`TLBIndex: xData = tlbo;
|
`TLBRandom: xData = Random;
|
`TLBRandom: xData = tlbo;
|
`TLBPhysPage0: xData = {TLBPhysPage0,13'd0};
|
`TLBPhysPage0: xData = tlbo;
|
`TLBPhysPage1: xData = {TLBPhysPage1,13'd0};
|
`TLBPhysPage1: xData = tlbo;
|
`TLBVirtPage: xData = {TLBVirtPage,13'd0};
|
`TLBVirtPage: xData = tlbo;
|
`TLBPageMask: xData = {TLBPageMask,13'd0};
|
`TLBPageMask: xData = tlbo;
|
`TLBASID: begin
|
`TLBASID: begin
|
xData = 65'd0;
|
xData = 65'd0;
|
xData[0] = TLBValid;
|
xData[0] = tlbo[0];
|
xData[1] = TLBD;
|
xData[1] = tlbo[1];
|
xData[2] = TLBG;
|
xData[2] = tlbo[2];
|
xData[15:8] = TLBASID;
|
xData[15:8] = tlbo[15:8];
|
end
|
end
|
`PageTableAddr: xData = {PageTableAddr,13'd0};
|
`PageTableAddr: xData = {PageTableAddr,13'd0};
|
`BadVAddr: xData = {BadVAddr,13'd0};
|
`BadVAddr: xData = {BadVAddr,13'd0};
|
`endif
|
`endif
|
`ASID: xData = ASID;
|
`ASID: xData = ASID;
|
`Tick: xData = tick;
|
`Tick: xData = tick;
|
`EPC: xData = EPC;
|
`EPC: xData = EPC;
|
`IPC: xData = IPC;
|
`IPC: xData = IPC;
|
`CauseCode: xData = CauseCode;
|
`CauseCode: xData = CauseCode;
|
`TBA: xData = TBA;
|
`TBA: xData = TBA;
|
`AXC: xData = xAXC;
|
`AXC: xData = xAXC;
|
`NON_ICACHE_SEG: xData = nonICacheSeg;
|
`NON_ICACHE_SEG: xData = nonICacheSeg;
|
`FPCR: xData = FPC;
|
`FPCR: xData = FPC;
|
`RAND: xData = rando;
|
`RAND: xData = rando;
|
`SRANDZ: xData = {m_z2,m_z1};
|
`SRAND1: xData = {m_z2,m_z1};
|
`SRANDW: xData = {m_w2,m_w1};
|
`SRAND2: xData = {m_w2,m_w1};
|
`INSNKEY: xData = insnkey;
|
`INSNKEY: xData = insnkey;
|
default: xData = 65'd0;
|
default: xData = 65'd0;
|
endcase
|
endcase
|
`OMG: xData = mutex_gate[a[5:0]];
|
`OMG: xData = mutex_gate[a[5:0]];
|
`CMG: xData = mutex_gate[a[5:0]];
|
`CMG: xData = mutex_gate[a[5:0]];
|
`OMGI: begin
|
`OMGI: begin
|
xData = mutex_gate[xIR[12:7]];
|
xData = mutex_gate[xIR[12:7]];
|
$display("mutex_gate[%d]=%d",xIR[12:7],mutex_gate[xIR[12:7]]);
|
$display("mutex_gate[%d]=%d",xIR[12:7],mutex_gate[xIR[12:7]]);
|
end
|
end
|
`CMGI: xData = mutex_gate[xIR[12:7]];
|
`CMGI: xData = mutex_gate[xIR[12:7]];
|
default: xData = 65'd0;
|
default: xData = 65'd0;
|
endcase
|
endcase
|
`RR:
|
`RR:
|
case(xFunc)
|
case(xFunc)
|
`ADD: xData = a + b;
|
`ADD: xData = a + b;
|
`ADDU: xData = a + b;
|
`ADDU: xData = a + b;
|
`SUB: xData = a - b;
|
`SUB: xData = a - b;
|
`SUBU: xData = a - b;
|
`SUBU: xData = a - b;
|
`CMP: xData = lt ? 64'hFFFFFFFFFFFFF : eq ? 64'd0 : 64'd1;
|
`CMP: xData = lt ? 64'hFFFFFFFFFFFFF : eq ? 64'd0 : 64'd1;
|
`CMPU: xData = ltu ? 64'hFFFFFFFFFFFFF : eq ? 64'd0 : 64'd1;
|
`CMPU: xData = ltu ? 64'hFFFFFFFFFFFFF : eq ? 64'd0 : 64'd1;
|
`SEQ: xData = eq;
|
`SEQ: xData = eq;
|
`SNE: xData = !eq;
|
`SNE: xData = !eq;
|
`SLT: xData = lt;
|
`SLT: xData = lt;
|
`SLE: xData = lt|eq;
|
`SLE: xData = lt|eq;
|
`SGT: xData = !(lt|eq);
|
`SGT: xData = !(lt|eq);
|
`SGE: xData = !lt;
|
`SGE: xData = !lt;
|
`SLTU: xData = ltu;
|
`SLTU: xData = ltu;
|
`SLEU: xData = ltu|eq;
|
`SLEU: xData = ltu|eq;
|
`SGTU: xData = !(ltu|eq);
|
`SGTU: xData = !(ltu|eq);
|
`SGEU: xData = !ltu;
|
`SGEU: xData = !ltu;
|
`AND: xData = a & b;
|
`AND: xData = a & b;
|
`OR: xData = a | b;
|
`OR: xData = a | b;
|
`XOR: xData = a ^ b;
|
`XOR: xData = a ^ b;
|
`ANDC: xData = a & ~b;
|
`ANDC: xData = a & ~b;
|
`NAND: xData = ~(a & b);
|
`NAND: xData = ~(a & b);
|
`NOR: xData = ~(a | b);
|
`NOR: xData = ~(a | b);
|
`XNOR: xData = ~(a ^ b);
|
`XNOR: xData = ~(a ^ b);
|
`ORC: xData = a | ~b;
|
`ORC: xData = a | ~b;
|
`MIN: xData = lt ? a : b;
|
`MIN: xData = lt ? a : b;
|
`MAX: xData = lt ? b : a;
|
`MAX: xData = lt ? b : a;
|
`MOVZ: xData = b;
|
`MOVZ: xData = b;
|
`MOVNZ: xData = b;
|
`MOVNZ: xData = b;
|
`MULS: xData = mult_out[63:0];
|
`MULS: xData = mult_out[63:0];
|
`MULU: xData = mult_out[63:0];
|
`MULU: xData = mult_out[63:0];
|
`DIVS: xData = div_q;
|
`DIVS: xData = div_q;
|
`DIVU: xData = div_q;
|
`DIVU: xData = div_q;
|
`MOD: xData = div_r;
|
`MOD: xData = div_r;
|
`SHL: xData = shlo;
|
`SHL: xData = shlo;
|
`SHRU: xData = shruo;
|
`SHRU: xData = shruo;
|
`ROL: xData = rolo;
|
`ROL: xData = rolo;
|
`ROR: xData = roro;
|
`ROR: xData = roro;
|
`SHR: xData = shro;
|
`SHR: xData = shro;
|
`ROLAM: xData = rolo & masko;
|
`ROLAM: xData = rolo & masko;
|
`BCD_ADD: xData = bcdaddo;
|
`BCD_ADD: xData = bcdaddo;
|
`BCD_SUB: xData = bcdsubo;
|
`BCD_SUB: xData = bcdsubo;
|
default: xData = 65'd0;
|
default: xData = 65'd0;
|
endcase
|
endcase
|
`SHFTI:
|
`SHFTI:
|
case(xFunc5)
|
case(xFunc5)
|
`SHLI: xData = shlo;
|
`SHLI: xData = shlo;
|
`SHRUI: xData = shruo;
|
`SHRUI: xData = shruo;
|
`ROLI: xData = rolo;
|
`ROLI: xData = rolo;
|
`RORI: xData = roro;
|
`RORI: xData = roro;
|
`SHRI: xData = shro;
|
`SHRI: xData = shro;
|
`ROLAMI: xData = rolo & masko;
|
`ROLAMI: xData = rolo & masko;
|
`BFINS: begin for (n = 0; n < 64; n = n + 1) xData[n] = masko[n] ? rolo[n] : b[n]; xData[64] = 1'b0; end
|
`BFINS: begin for (n = 0; n < 64; n = n + 1) xData[n] = masko[n] ? rolo[n] : b[n]; xData[64] = 1'b0; end
|
`BFSET: begin for (n = 0; n < 64; n = n + 1) xData[n] = masko[n] ? 1'b1 : b[n]; xData[64] = 1'b0; end
|
`BFSET: begin for (n = 0; n < 64; n = n + 1) xData[n] = masko[n] ? 1'b1 : b[n]; xData[64] = 1'b0; end
|
`BFCLR: begin for (n = 0; n < 64; n = n + 1) xData[n] = masko[n] ? 1'b0 : b[n]; xData[64] = 1'b0; end
|
`BFCLR: begin for (n = 0; n < 64; n = n + 1) xData[n] = masko[n] ? 1'b0 : b[n]; xData[64] = 1'b0; end
|
`BFCHG: begin for (n = 0; n < 64; n = n + 1) xData[n] = masko[n] ? ~b[n] : b[n]; xData[64] = 1'b0; end
|
`BFCHG: begin for (n = 0; n < 64; n = n + 1) xData[n] = masko[n] ? ~b[n] : b[n]; xData[64] = 1'b0; end
|
|
`BFEXT: begin for (n = 0; n < 64; n = n + 1) bfextd[n] = masko[n] ? b[n] : 1'b0; xData = bfextd >> mb; end
|
default: xData = 65'd0;
|
default: xData = 65'd0;
|
endcase
|
endcase
|
`BTRR:
|
`BTRR:
|
case(xFunc5)
|
case(xFunc5)
|
`LOOP: xData = b - 64'd1;
|
`LOOP: xData = b - 64'd1;
|
default: xData = 64'd0;
|
default: xData = 64'd0;
|
endcase
|
endcase
|
`SETLO: xData = {{32{xIR[31]}},xIR[31:0]};
|
`SETLO: xData = {{32{xIR[31]}},xIR[31:0]};
|
`SETHI: xData = {xIR[31:0],a[31:0]};
|
`SETHI: xData = {xIR[31:0],a[31:0]};
|
`ADDI: xData = a + imm;
|
`ADDI: xData = a + imm;
|
`ADDUI: xData = a + imm;
|
`ADDUI: xData = a + imm;
|
`SUBI: xData = a - imm;
|
`SUBI: xData = a - imm;
|
`SUBUI: xData = a - imm;
|
`SUBUI: xData = a - imm;
|
`CMPI: xData = lti ? 64'hFFFFFFFFFFFFF : eqi ? 64'd0 : 64'd1;
|
`CMPI: xData = lti ? 64'hFFFFFFFFFFFFF : eqi ? 64'd0 : 64'd1;
|
`CMPUI: xData = ltui ? 64'hFFFFFFFFFFFFF : eqi ? 64'd0 : 64'd1;
|
`CMPUI: xData = ltui ? 64'hFFFFFFFFFFFFF : eqi ? 64'd0 : 64'd1;
|
`MULSI: xData = mult_out[63:0];
|
`MULSI: xData = mult_out[63:0];
|
`MULUI: xData = mult_out[63:0];
|
`MULUI: xData = mult_out[63:0];
|
`DIVSI: xData = div_q;
|
`DIVSI: xData = div_q;
|
`DIVUI: xData = div_q;
|
`DIVUI: xData = div_q;
|
`ANDI: xData = a & imm;
|
`ANDI: xData = a & imm;
|
`ORI: xData = a | imm;
|
`ORI: xData = a | imm;
|
`XORI: xData = a ^ imm;
|
`XORI: xData = a ^ imm;
|
`SEQI: xData = eqi;
|
`SEQI: xData = eqi;
|
`SNEI: xData = !eqi;
|
`SNEI: xData = !eqi;
|
`SLTI: xData = lti;
|
`SLTI: xData = lti;
|
`SLEI: xData = lti|eqi;
|
`SLEI: xData = lti|eqi;
|
`SGTI: xData = !(lti|eqi);
|
`SGTI: xData = !(lti|eqi);
|
`SGEI: xData = !lti;
|
`SGEI: xData = !lti;
|
`SLTUI: xData = ltui;
|
`SLTUI: xData = ltui;
|
`SLEUI: xData = ltui|eqi;
|
`SLEUI: xData = ltui|eqi;
|
`SGTUI: xData = !(ltui|eqi);
|
`SGTUI: xData = !(ltui|eqi);
|
`SGEUI: xData = !ltui;
|
`SGEUI: xData = !ltui;
|
`INB,`INCH,`INH,`INW,`INCU,`INHU,`INBU:
|
`INB,`INCH,`INH,`INW,`INCU,`INHU,`INBU:
|
xData = a + imm;
|
xData = a + imm;
|
`OUTB,`OUTC,`OUTH,`OUTW:
|
`OUTB,`OUTC,`OUTH,`OUTW:
|
xData = a + imm;
|
xData = a + imm;
|
`LW,`LH,`LC,`LB,`LHU,`LCU,`LBU,`LWR,`LF,`LFD,`LP,`LFP,`LFDP,`LEA:
|
`LW,`LH,`LC,`LB,`LHU,`LCU,`LBU,`LWR,`LF,`LFD,`LP,`LFP,`LFDP,`LEA:
|
xData = a + imm;
|
xData = a + imm;
|
`SW,`SH,`SC,`SB,`SWC,`SF,`SFD,`SP,`SFP,`SFDP:
|
`SW,`SH,`SC,`SB,`SWC,`SF,`SFD,`SP,`SFP,`SFDP:
|
xData = a + imm;
|
xData = a + imm;
|
`MEMNDX:
|
`MEMNDX:
|
xData = a + b + imm;
|
xData = a + b + imm;
|
`SM: xData = a + {popcnt36(xIR[31:0]),3'b000};
|
`SM: xData = a + {popcnt36(xIR[31:0]),3'b000}-64'd8;
|
`LM: xData = a + {popcnt36(xIR[31:0]),3'b000};
|
`LM: xData = a + {popcnt36(xIR[31:0]),3'b000}-64'd8;
|
`TRAPcc: xData = fnIncPC(xpc);
|
`TRAPcc: xData = fnIncPC(xpc);
|
`TRAPcci: xData = fnIncPC(xpc);
|
`TRAPcci: xData = fnIncPC(xpc);
|
`CALL: xData = fnIncPC(xpc);
|
`CALL: xData = fnIncPC(xpc);
|
`JAL: xData = xpc + {xIR[29:25],2'b00};
|
`JAL: xData = xpc + {xIR[29:25],2'b00};
|
`RET: xData = a + imm;
|
`RET: xData = a + imm;
|
`FPLOO: xData = fpLooOut;
|
`FPLOO: xData = fpLooOut;
|
`FPZL: xData = fpZLOut;
|
`FPZL: xData = fpZLOut;
|
`ifdef FLOATING_POINT
|
`ifdef FLOATING_POINT
|
`FP:
|
`FP:
|
case(xFunc6)
|
case(xFunc6)
|
`FDADD: xData = daddsub_result;
|
`FDADD: xData = daddsub_result;
|
`FDSUB: xData = daddsub_result;
|
`FDSUB: xData = daddsub_result;
|
`FDMUL: xData = dmul_result;
|
`FDMUL: xData = dmul_result;
|
`FDDIV: xData = ddiv_result;
|
`FDDIV: xData = ddiv_result;
|
`FDI2F: xData = i2f_result;
|
`FDI2F: xData = i2f_result;
|
`FDF2I: xData = f2i_result;
|
`FDF2I: xData = f2i_result;
|
`FDCUN: xData = dcmp_result;
|
`FDCUN: xData = dcmp_result;
|
`FDCEQ: xData = dcmp_result;
|
`FDCEQ: xData = dcmp_result;
|
`FDCNE: xData = dcmp_result;
|
`FDCNE: xData = dcmp_result;
|
`FDCLT: xData = dcmp_result;
|
`FDCLT: xData = dcmp_result;
|
`FDCLE: xData = dcmp_result;
|
`FDCLE: xData = dcmp_result;
|
`FDCGT: xData = dcmp_result;
|
`FDCGT: xData = dcmp_result;
|
`FDCGE: xData = dcmp_result;
|
`FDCGE: xData = dcmp_result;
|
endcase
|
endcase
|
`endif
|
`endif
|
default: xData = 65'd0;
|
default: xData = 65'd0;
|
endcase
|
endcase
|
|
|
wire v_ri,v_rr;
|
wire v_ri,v_rr;
|
overflow u2 (.op(xOpcode==`SUBI), .a(a[63]), .b(imm[63]), .s(xData[63]), .v(v_ri));
|
overflow u2 (.op(xOpcode==`SUBI), .a(a[63]), .b(imm[63]), .s(xData[63]), .v(v_ri));
|
overflow u3 (.op(xOpcode==`RR && xFunc==`SUB), .a(a[63]), .b(b[63]), .s(xData[63]), .v(v_rr));
|
overflow u3 (.op(xOpcode==`RR && xFunc==`SUB), .a(a[63]), .b(b[63]), .s(xData[63]), .v(v_rr));
|
|
|
wire dbz_error = ((xOpcode==`DIVSI||xOpcode==`DIVUI) && imm==64'd0) || (xOpcode==`RR && (xFunc==`DIVS || xFunc==`DIVU) && b==64'd0);
|
wire dbz_error = ((xOpcode==`DIVSI||xOpcode==`DIVUI) && imm==64'd0) || (xOpcode==`RR && (xFunc==`DIVS || xFunc==`DIVU) && b==64'd0);
|
wire ovr_error = ((xOpcode==`ADDI || xOpcode==`SUBI) && v_ri) || ((xOpcode==`RR && (xFunc==`SUB || xFunc==`ADD)) && v_rr);
|
wire ovr_error = ((xOpcode==`ADDI || xOpcode==`SUBI) && v_ri) || ((xOpcode==`RR && (xFunc==`SUB || xFunc==`ADD)) && v_rr);
|
wire priv_violation = !KernelMode && (xOpcode==`MISC &&
|
wire priv_violation = !KernelMode && (xOpcode==`MISC &&
|
(xFunc==`IRET || xFunc==`ERET || xFunc==`CLI || xFunc==`SEI ||
|
(xFunc==`IRET || xFunc==`ERET || xFunc==`CLI || xFunc==`SEI ||
|
xFunc==`TLBP || xFunc==`TLBR || xFunc==`TLBWR || xFunc==`TLBWI
|
xFunc==`TLBP || xFunc==`TLBR || xFunc==`TLBWR || xFunc==`TLBWI
|
));
|
));
|
wire xIsSqrt = xOpcode==`R && xFunc==`SQRT;
|
wire xIsSqrt = xOpcode==`R && xFunc==`SQRT;
|
wire xIsMult = (xOpcode==`RR && (xFunc==`MULU || xFunc==`MULS)) ||
|
wire xIsMult = (xOpcode==`RR && (xFunc==`MULU || xFunc==`MULS)) ||
|
xOpcode==`MULSI || xOpcode==`MULUI;
|
xOpcode==`MULSI || xOpcode==`MULUI;
|
wire xIsDiv = (xOpcode==`RR && (xFunc==`DIVU || xFunc==`DIVS)) ||
|
wire xIsDiv = (xOpcode==`RR && (xFunc==`DIVU || xFunc==`DIVS)) ||
|
xOpcode==`DIVSI || xOpcode==`DIVUI;
|
xOpcode==`DIVSI || xOpcode==`DIVUI;
|
wire xIsCnt = xOpcode==`R && (xFunc==`CTLZ || xFunc==`CTLO || xFunc==`CTPOP);
|
wire xIsCnt = xOpcode==`R && (xFunc==`CTLZ || xFunc==`CTLO || xFunc==`CTPOP);
|
reg m1IsCnt,m2IsCnt;
|
reg m1IsCnt,m2IsCnt;
|
|
|
wire xIsLoad =
|
wire xIsLoad =
|
xOpcode==`LW || xOpcode==`LH || xOpcode==`LB || xOpcode==`LWR ||
|
xOpcode==`LW || xOpcode==`LH || xOpcode==`LB || xOpcode==`LWR ||
|
xOpcode==`LHU || xOpcode==`LBU ||
|
xOpcode==`LHU || xOpcode==`LBU ||
|
xOpcode==`LC || xOpcode==`LCU || xOpcode==`LM ||
|
xOpcode==`LC || xOpcode==`LCU || xOpcode==`LM ||
|
xOpcode==`LF || xOpcode==`LFD || xOpcode==`LP || xOpcode==`LFP || xOpcode==`LFDP ||
|
xOpcode==`LF || xOpcode==`LFD || xOpcode==`LP || xOpcode==`LFP || xOpcode==`LFDP ||
|
xOpcode==`LSH || xOpcode==`LSW ||
|
xOpcode==`LSH || xOpcode==`LSW ||
|
(xOpcode==`MEMNDX && (
|
(xOpcode==`MEMNDX && (
|
xFunc6==`LWX || xFunc6==`LHX || xFunc6==`LBX || xFunc6==`LWRX ||
|
xFunc6==`LWX || xFunc6==`LHX || xFunc6==`LBX || xFunc6==`LWRX ||
|
xFunc6==`LHUX || xFunc6==`LBUX ||
|
xFunc6==`LHUX || xFunc6==`LBUX ||
|
xFunc6==`LCX || xFunc6==`LCUX ||
|
xFunc6==`LCX || xFunc6==`LCUX ||
|
xFunc6==`LFX || xFunc6==`LFDX || xFunc6==`LPX ||
|
xFunc6==`LFX || xFunc6==`LFDX || xFunc6==`LPX ||
|
xFunc6==`LSHX || xFunc6==`LSWX
|
xFunc6==`LSHX || xFunc6==`LSWX
|
)) ||
|
)) ||
|
(xOpcode==`MISC && (xFunc==`SYSJMP || xFunc==`SYSCALL))
|
(xOpcode==`MISC && (xFunc==`SYSJMP || xFunc==`SYSCALL))
|
;
|
;
|
|
|
wire xIsStore =
|
wire xIsStore =
|
xOpcode==`SW || xOpcode==`SH || xOpcode==`SB || xOpcode==`SC || xOpcode==`SWC || xOpcode==`SM ||
|
xOpcode==`SW || xOpcode==`SH || xOpcode==`SB || xOpcode==`SC || xOpcode==`SWC || xOpcode==`SM ||
|
xOpcode==`SF || xOpcode==`SFD || xOpcode==`SP || xOpcode==`SFP || xOpcode==`SFDP ||
|
xOpcode==`SF || xOpcode==`SFD || xOpcode==`SP || xOpcode==`SFP || xOpcode==`SFDP ||
|
xOpcode==`SSH || xOpcode==`SSW ||
|
xOpcode==`SSH || xOpcode==`SSW ||
|
(xOpcode==`MEMNDX && (
|
(xOpcode==`MEMNDX && (
|
xFunc6==`SWX || xFunc6==`SHX || xFunc6==`SBX || xFunc6==`SCX || xFunc6==`SWCX ||
|
xFunc6==`SWX || xFunc6==`SHX || xFunc6==`SBX || xFunc6==`SCX || xFunc6==`SWCX ||
|
xFunc6==`SFX || xFunc6==`SFDX || xFunc6==`SPX ||
|
xFunc6==`SFX || xFunc6==`SFDX || xFunc6==`SPX ||
|
xFunc6==`SSHX || xFunc6==`SSWX
|
xFunc6==`SSHX || xFunc6==`SSWX
|
))
|
))
|
;
|
;
|
wire xIsSWC = xOpcode==`SWC;
|
wire xIsSWC = xOpcode==`SWC;
|
wire xIsIn =
|
wire xIsIn =
|
xOpcode==`INW || xOpcode==`INH || xOpcode==`INCH || xOpcode==`INB ||
|
xOpcode==`INW || xOpcode==`INH || xOpcode==`INCH || xOpcode==`INB ||
|
xOpcode==`INHU || xOpcode==`INCU || xOpcode==`INBU
|
xOpcode==`INHU || xOpcode==`INCU || xOpcode==`INBU
|
;
|
;
|
//wire mIsSWC = mOpcode==`SWC;
|
//wire mIsSWC = mOpcode==`SWC;
|
|
|
wire m1IsIn =
|
wire m1IsIn =
|
m1Opcode==`INW || m1Opcode==`INH || m1Opcode==`INCH || m1Opcode==`INB ||
|
m1Opcode==`INW || m1Opcode==`INH || m1Opcode==`INCH || m1Opcode==`INB ||
|
m1Opcode==`INHU || m1Opcode==`INCU || m1Opcode==`INBU
|
m1Opcode==`INHU || m1Opcode==`INCU || m1Opcode==`INBU
|
;
|
;
|
wire m2IsInW = m2Opcode==`INW;
|
wire m2IsInW = m2Opcode==`INW;
|
wire xIsIO =
|
wire xIsIO =
|
xIsIn ||
|
xIsIn ||
|
xOpcode==`OUTW || xOpcode==`OUTH || xOpcode==`OUTC || xOpcode==`OUTB
|
xOpcode==`OUTW || xOpcode==`OUTH || xOpcode==`OUTC || xOpcode==`OUTB
|
;
|
;
|
|
|
reg m1IsLoad,m2IsLoad;
|
|
reg m1IsIO;
|
|
reg m1IsStore,m2IsStore,wIsStore;
|
|
|
|
|
|
wire xIsFPLoo = xOpcode==`FPLOO;
|
wire xIsFPLoo = xOpcode==`FPLOO;
|
wire xIsFP = xOpcode==`FP;
|
wire xIsFP = xOpcode==`FP;
|
wire xneedBus = xIsIO;
|
wire xneedBus = xIsIO;
|
wire m1needBus = (m1IsLoad & !m1IsCacheElement) || m1IsStore || m1IsIO;
|
wire m1needBus = (m1IsLoad & !m1IsCacheElement) || m1IsStore || m1IsIO;
|
wire m2needBus = (m2IsLoad | m2IsStore);
|
wire m2needBus = (m2IsLoad | m2IsStore);
|
|
|
// Stall on SWC allows rsf flag to be loaded for the next instruction
|
// Stall on SWC allows rsf flag to be loaded for the next instruction
|
// Currently stalls on load of R0, but doesn't need to.
|
// Currently stalls on load of R0, but doesn't need to.
|
wire StallR = (((xIsLoad||xIsIn||xIsCnt) && ((xRt==dRa)||(xRt==dRb)||(xRt==dRt))) || xIsSWC) ||
|
wire StallR = (((xIsLoad||xIsIn||xIsCnt) && ((xRt==dRa)||(xRt==dRb)||(xRt==dRt))) || xIsSWC) ||
|
(((m1IsLoad||m1IsIn||m1IsCnt) && ((m1Rt==dRa)||(m1Rt==dRb)||(m1Rt==dRt)))) ||
|
(((m1IsLoad||m1IsIn||m1IsCnt) && ((m1Rt==dRa)||(m1Rt==dRb)||(m1Rt==dRt)))) ||
|
(((m2IsLoad||m2IsCnt) && ((m2Rt==dRa)||(m2Rt==dRb)||(m2Rt==dRt))))
|
(((m2IsLoad||m2IsCnt) && ((m2Rt==dRa)||(m2Rt==dRb)||(m2Rt==dRt))))
|
;
|
;
|
wire StallX = xneedBus & (m1needBus|m2needBus|icaccess|dcaccess);
|
wire StallX = xneedBus & (m1needBus|m2needBus|icaccess|dcaccess);
|
wire StallM1 = (m1needBus & (m2needBus|icaccess|dcaccess)) ||
|
wire StallM1 = (m1needBus & (m2needBus|icaccess|dcaccess)) ||
|
( m1IsLoad & m1IsCacheElement & (m2IsStore|wIsStore)) // wait for a preceding store to complete
|
( m1IsLoad & m1IsCacheElement & (m2IsStore|wIsStore)) // wait for a preceding store to complete
|
;
|
;
|
wire StallM2 = icaccess|dcaccess;
|
wire StallM2 = icaccess|dcaccess;
|
|
|
wire advanceT = !resetA;
|
wire advanceT = !resetA;
|
wire advanceW = advanceT;
|
assign advanceW = advanceT;
|
wire advanceM2 = advanceW &&
|
wire advanceM2 = advanceW &&
|
((m2IsLoad || m2IsStore) ? (ack_i|err_i) : 1'b1) &&
|
((m2IsLoad || m2IsStore) ? (ack_i|err_i) : 1'b1) &&
|
!StallM2
|
!StallM2
|
;
|
;
|
wire advanceM1 = advanceM2 &
|
assign advanceM1 = advanceM2 &
|
(m1IsIO ? (ack_i|err_i) : 1'b1) &
|
(m1IsIO ? (ack_i|err_i) : 1'b1) &
|
((m1IsLoad & m1IsCacheElement) ? dhit : 1'b1) &
|
((m1IsLoad & m1IsCacheElement) ? dhit : 1'b1) &
|
!StallM1
|
!StallM1
|
;
|
;
|
wire advanceX = advanceM1 & (
|
assign advanceX = advanceM1 & (
|
xIsSqrt ? sqrt_done :
|
xIsSqrt ? sqrt_done :
|
xIsMult ? mult_done :
|
xIsMult ? mult_done :
|
xIsDiv ? div_done :
|
xIsDiv ? div_done :
|
xIsFPLoo ? fpLooDone :
|
xIsFPLoo ? fpLooDone :
|
xIsFP ? fltdone :
|
xIsFP ? fltdone :
|
1'b1) &
|
1'b1) &
|
!StallX;
|
!StallX;
|
wire advanceR = advanceX & !StallR;
|
wire advanceR = advanceX & !StallR;
|
wire advanceI = advanceR & (ICacheOn ? ihit : ibufrdy);
|
wire advanceI = advanceR & (ICacheOn ? ihit : ibufrdy);
|
|
|
wire triggerDCacheLoad = (m1IsLoad & m1IsCacheElement & !dhit) && // there is a miss
|
wire triggerDCacheLoad = (m1IsLoad & m1IsCacheElement & !dhit) && // there is a miss
|
!(icaccess | dcaccess) && // caches are not active
|
!(icaccess | dcaccess) && // caches are not active
|
m2Opcode==`NOPI // and the pipeline is free of memory-ops
|
m2Opcode==`NOPI // and the pipeline is free of memory-ops
|
;
|
;
|
// Since IMM is "sticky" we have to check for it.
|
// Since IMM is "sticky" we have to check for it.
|
wire triggerICacheLoad1 = ICacheAct && !ihit && !triggerDCacheLoad && // There is a miss
|
wire triggerICacheLoad1 = ICacheAct && !ihit && !triggerDCacheLoad && // There is a miss
|
!(icaccess | dcaccess) && // caches are not active
|
!(icaccess | dcaccess) && // caches are not active
|
(dOpcode==`NOPI || dOpcode[6:4]==`IMM) && // and the pipeline is flushed
|
(dOpcode==`NOPI || dOpcode[6:4]==`IMM) && // and the pipeline is flushed
|
(xOpcode==`NOPI || xOpcode[6:4]==`IMM) &&
|
(xOpcode==`NOPI || xOpcode[6:4]==`IMM) &&
|
m1Opcode==`NOPI &&
|
m1Opcode==`NOPI &&
|
m2Opcode==`NOPI
|
m2Opcode==`NOPI
|
;
|
;
|
wire triggerICacheLoad2 = (!ICacheAct && !ibufrdy) && !triggerDCacheLoad && // There is a miss
|
wire triggerICacheLoad2 = (!ICacheAct && !ibufrdy) && !triggerDCacheLoad && // There is a miss
|
!(icaccess | dcaccess) // caches are not active
|
!(icaccess | dcaccess) // caches are not active
|
;
|
;
|
wire triggerICacheLoad = triggerICacheLoad1 | triggerICacheLoad2;
|
wire triggerICacheLoad = triggerICacheLoad1 | triggerICacheLoad2;
|
|
|
wire EXexception_pending = ovr_error || dbz_error || priv_violation || xOpcode==`TRAPcci || xOpcode==`TRAPcc;
|
wire EXexception_pending = ovr_error || dbz_error || priv_violation || xOpcode==`TRAPcci || xOpcode==`TRAPcc;
|
`ifdef TLB
|
`ifdef TLB
|
wire M1exception_pending = advanceM1 & (m1IsLoad|m1IsStore) & DTLBMiss;
|
wire M1exception_pending = advanceM1 & (m1IsLoad|m1IsStore) & DTLBMiss;
|
`else
|
`else
|
wire M1exception_pending = 1'b0;
|
wire M1exception_pending = 1'b0;
|
`endif
|
`endif
|
wire exception_pending = EXexception_pending | M1exception_pending;
|
wire exception_pending = EXexception_pending | M1exception_pending;
|
|
|
reg prev_nmi,nmi_edge;
|
reg prev_nmi,nmi_edge;
|
|
|
always @(dOpcode or dIR)
|
always @(dOpcode or dIR)
|
begin
|
begin
|
ndIR <= dIR;
|
ndIR <= dIR;
|
if (dOpcode==`SP || dOpcode==`LP || dOpcode==`SFP || dOpcode==`LFP || dOpcode==`SFDP || dOpcode==`LFDP) begin
|
if (dOpcode==`SP || dOpcode==`LP || dOpcode==`SFP || dOpcode==`LFP || dOpcode==`SFDP || dOpcode==`LFDP) begin
|
ndIR[25] <= 1'b1;
|
ndIR[25] <= 1'b1;
|
ndIR[3] <= 1'b1;
|
ndIR[3] <= 1'b1;
|
end
|
end
|
else if ((dOpcode==`LM || dOpcode==`SM) && dIR[31:0]!=32'd0) begin
|
else if ((dOpcode==`LM || dOpcode==`SM) && dIR[31:0]!=32'd0) begin
|
$display("LM/SM %h",dIR[31:0]);
|
$display("LM/SM %h",dIR[31:0]);
|
if (dIR[0])
|
if (dIR[0])
|
ndIR[0] <= 1'b0;
|
ndIR[0] <= 1'b0;
|
else if (dIR[1])
|
else if (dIR[1])
|
ndIR[1] <= 1'b0;
|
ndIR[1] <= 1'b0;
|
else if (dIR[2])
|
else if (dIR[2])
|
ndIR[2] <= 1'b0;
|
ndIR[2] <= 1'b0;
|
else if (dIR[3])
|
else if (dIR[3])
|
ndIR[3] <= 1'b0;
|
ndIR[3] <= 1'b0;
|
else if (dIR[4])
|
else if (dIR[4])
|
ndIR[4] <= 1'b0;
|
ndIR[4] <= 1'b0;
|
else if (dIR[5])
|
else if (dIR[5])
|
ndIR[5] <= 1'b0;
|
ndIR[5] <= 1'b0;
|
else if (dIR[6])
|
else if (dIR[6])
|
ndIR[6] <= 1'b0;
|
ndIR[6] <= 1'b0;
|
else if (dIR[7])
|
else if (dIR[7])
|
ndIR[7] <= 1'b0;
|
ndIR[7] <= 1'b0;
|
else if (dIR[8])
|
else if (dIR[8])
|
ndIR[8] <= 1'b0;
|
ndIR[8] <= 1'b0;
|
else if (dIR[9])
|
else if (dIR[9])
|
ndIR[9] <= 1'b0;
|
ndIR[9] <= 1'b0;
|
else if (dIR[10])
|
else if (dIR[10])
|
ndIR[10] <= 1'b0;
|
ndIR[10] <= 1'b0;
|
else if (dIR[11])
|
else if (dIR[11])
|
ndIR[11] <= 1'b0;
|
ndIR[11] <= 1'b0;
|
else if (dIR[12])
|
else if (dIR[12])
|
ndIR[12] <= 1'b0;
|
ndIR[12] <= 1'b0;
|
else if (dIR[13])
|
else if (dIR[13])
|
ndIR[13] <= 1'b0;
|
ndIR[13] <= 1'b0;
|
else if (dIR[14])
|
else if (dIR[14])
|
ndIR[14] <= 1'b0;
|
ndIR[14] <= 1'b0;
|
else if (dIR[15])
|
else if (dIR[15])
|
ndIR[15] <= 1'b0;
|
ndIR[15] <= 1'b0;
|
else if (dIR[16])
|
else if (dIR[16])
|
ndIR[16] <= 1'b0;
|
ndIR[16] <= 1'b0;
|
else if (dIR[17])
|
else if (dIR[17])
|
ndIR[17] <= 1'b0;
|
ndIR[17] <= 1'b0;
|
else if (dIR[18])
|
else if (dIR[18])
|
ndIR[18] <= 1'b0;
|
ndIR[18] <= 1'b0;
|
else if (dIR[19])
|
else if (dIR[19])
|
ndIR[19] <= 1'b0;
|
ndIR[19] <= 1'b0;
|
else if (dIR[20])
|
else if (dIR[20])
|
ndIR[20] <= 1'b0;
|
ndIR[20] <= 1'b0;
|
else if (dIR[21])
|
else if (dIR[21])
|
ndIR[21] <= 1'b0;
|
ndIR[21] <= 1'b0;
|
else if (dIR[22])
|
else if (dIR[22])
|
ndIR[22] <= 1'b0;
|
ndIR[22] <= 1'b0;
|
else if (dIR[23])
|
else if (dIR[23])
|
ndIR[23] <= 1'b0;
|
ndIR[23] <= 1'b0;
|
else if (dIR[24])
|
else if (dIR[24])
|
ndIR[24] <= 1'b0;
|
ndIR[24] <= 1'b0;
|
else if (dIR[25])
|
else if (dIR[25])
|
ndIR[25] <= 1'b0;
|
ndIR[25] <= 1'b0;
|
else if (dIR[26])
|
else if (dIR[26])
|
ndIR[26] <= 1'b0;
|
ndIR[26] <= 1'b0;
|
else if (dIR[27])
|
else if (dIR[27])
|
ndIR[27] <= 1'b0;
|
ndIR[27] <= 1'b0;
|
else if (dIR[28])
|
else if (dIR[28])
|
ndIR[28] <= 1'b0;
|
ndIR[28] <= 1'b0;
|
else if (dIR[29])
|
else if (dIR[29])
|
ndIR[29] <= 1'b0;
|
ndIR[29] <= 1'b0;
|
else if (dIR[30])
|
else if (dIR[30])
|
ndIR[30] <= 1'b0;
|
ndIR[30] <= 1'b0;
|
else
|
else
|
ndIR[31] <= 1'b0;
|
ndIR[31] <= 1'b0;
|
end
|
end
|
end
|
end
|
|
|
|
reg m1clkoff,m2clkoff,m3clkoff,m4clkoff,wclkoff;
|
|
reg dFip,xFip,m1Fip,m2Fip,m3Fip,m4Fip,wFip;
|
|
reg cyc1;
|
|
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
// Register file.
|
// Register file.
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
|
|
syncRam512x64_1rw3r u5
|
wire [63:0] nxt_a, nxt_b, nxt_c;
|
|
|
|
Raptor64_regfile u5
|
(
|
(
|
.wrst(1'b0),
|
.clk(clk),
|
.wclk(clk),
|
.advanceR(advanceR),
|
.wce(advanceW),
|
.advanceW(advanceW),
|
.we(1'b1),
|
.dRa(dRa),
|
.wadr(wRt),
|
.dRb(dRb),
|
.i(wData),
|
.dRc(dRc),
|
.wo(),
|
.dpc(dpc),
|
|
.xRt(xRt),
|
.rrsta(1'b0),
|
.m1Rt(m1Rt),
|
.rclka(~clk),
|
.m2Rt(m2Rt),
|
.rcea(advanceR),
|
.wRt(wRt),
|
.radra(dRa),
|
.tRt(tRt),
|
.roa(rfoa),
|
.xData(xData[63:0]),
|
|
.m1Data(m1Data),
|
.rrstb(1'b0),
|
.m2Data(m2Data),
|
.rclkb(~clk),
|
.wData(wData),
|
.rceb(advanceR),
|
.tData(tData),
|
.radrb(dRb),
|
.nxt_a(nxt_a),
|
.rob(rfob),
|
.nxt_b(nxt_b),
|
|
.nxt_c(nxt_c)
|
.rrstc(1'b0),
|
|
.rclkc(~clk),
|
|
.rcec(advanceR),
|
|
.radrc(dRc),
|
|
.roc(rfoc)
|
|
);
|
);
|
|
|
|
|
reg m1clkoff,m2clkoff,m3clkoff,m4clkoff,wclkoff;
|
|
reg dFip,xFip,m1Fip,m2Fip,m3Fip,m4Fip,wFip;
|
|
reg cyc1;
|
|
|
|
reg [63:0] nxt_a;
|
|
always @(dRa or xData or m1Data or m2Data or wData or tData or rfoa)
|
|
casex(dRa)
|
|
9'bxxxx00000: nxt_a <= 64'd0;
|
|
xRt: nxt_a <= xData;
|
|
m1Rt: nxt_a <= m1Data;
|
|
m2Rt: nxt_a <= m2Data;
|
|
wRt: nxt_a <= wData;
|
|
tRt: nxt_a <= tData;
|
|
default: nxt_a <= rfoa;
|
|
endcase
|
|
|
|
reg [63:0] nxt_b;
|
|
always @(dRb or xData or m1Data or m2Data or wData or tData or rfob)
|
|
casex(dRb)
|
|
9'bxxxx00000: nxt_b <= 64'd0;
|
|
xRt: nxt_b <= xData;
|
|
m1Rt: nxt_b <= m1Data;
|
|
m2Rt: nxt_b <= m2Data;
|
|
wRt: nxt_b <= wData;
|
|
tRt: nxt_b <= tData;
|
|
default: nxt_b <= rfob;
|
|
endcase
|
|
|
|
reg [63:0] nxt_c;
|
|
always @(dRc or xData or m1Data or m2Data or wData or tData or rfoc)
|
|
casex(dRc)
|
|
9'bxxxx00000: nxt_c <= 64'd0;
|
|
xRt: nxt_c <= xData;
|
|
m1Rt: nxt_c <= m1Data;
|
|
m2Rt: nxt_c <= m2Data;
|
|
wRt: nxt_c <= wData;
|
|
tRt: nxt_c <= tData;
|
|
default: nxt_c <= rfoc;
|
|
endcase
|
|
|
|
always @(posedge clk)
|
always @(posedge clk)
|
if (rst_i) begin
|
if (rst_i) begin
|
bte_o <= 2'b00;
|
bte_o <= 2'b00;
|
cti_o <= 3'b000;
|
cti_o <= 3'b000;
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
we_o <= 1'b0;
|
we_o <= 1'b0;
|
sel_o <= 8'h00;
|
sel_o <= 8'h00;
|
adr_o <= 64'd0;
|
adr_o <= 64'd0;
|
dat_o <= 64'd0;
|
dat_o <= 64'd0;
|
|
|
nonICacheSeg <= 32'hFFFF_FFFD;
|
nonICacheSeg <= 32'hFFFF_FFFD;
|
TBA <= 64'd0;
|
TBA <= 64'd0;
|
pc <= `RESET_VECTOR;
|
pc <= `RESET_VECTOR;
|
m1Opcode <= `NOPI;
|
m1Opcode <= `NOPI;
|
m2Opcode <= `NOPI;
|
m2Opcode <= `NOPI;
|
wOpcode <= `NOPI;
|
wOpcode <= `NOPI;
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
dRt <= 9'd0;
|
dRt <= 9'd0;
|
tRt <= 9'd0;
|
tRt <= 9'd0;
|
wRt <= 9'd0;
|
wRt <= 9'd0;
|
m1Rt <= 9'd0;
|
m1Rt <= 9'd0;
|
m2Rt <= 9'd0;
|
m2Rt <= 9'd0;
|
tData <= 64'd0;
|
tData <= 64'd0;
|
wData <= 64'd0;
|
wData <= 64'd0;
|
m1Data <= 64'd0;
|
m1Data <= 64'd0;
|
m2Data <= 64'd0;
|
m2Data <= 64'd0;
|
m2LdPC <= 1'b0;
|
m2LdPC <= 1'b0;
|
wLdPC <= 1'b0;
|
wLdPC <= 1'b0;
|
m1IsLoad <= 1'b0;
|
m1IsLoad <= 1'b0;
|
m2IsLoad <= 1'b0;
|
m2IsLoad <= 1'b0;
|
m1IsStore <= 1'b0;
|
m1IsStore <= 1'b0;
|
m2IsStore <= 1'b0;
|
m2IsStore <= 1'b0;
|
wIsStore <= 1'b0;
|
wIsStore <= 1'b0;
|
m1IsIO <= 1'b0;
|
m1IsIO <= 1'b0;
|
icaccess <= 1'b0;
|
icaccess <= 1'b0;
|
dcaccess <= 1'b0;
|
dcaccess <= 1'b0;
|
nopI <= 1'b0;
|
nopI <= 1'b0;
|
prev_ihit <= 1'b0;
|
prev_ihit <= 1'b0;
|
dhwxtype <= 2'b00;
|
dhwxtype <= 2'b00;
|
xhwxtype <= 2'b00;
|
xhwxtype <= 2'b00;
|
m1hwxtype <= 2'b00;
|
m1hwxtype <= 2'b00;
|
m2hwxtype <= 2'b00;
|
m2hwxtype <= 2'b00;
|
whwxtype <= 2'b00;
|
whwxtype <= 2'b00;
|
wFip <= 1'b0;
|
wFip <= 1'b0;
|
m2Fip <= 1'b0;
|
m2Fip <= 1'b0;
|
m1Fip <= 1'b0;
|
m1Fip <= 1'b0;
|
xFip <= 1'b0;
|
xFip <= 1'b0;
|
dFip <= 1'b0;
|
dFip <= 1'b0;
|
dirqf <= 1'b0;
|
dirqf <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
m1pcv <= 1'b0;
|
m1pcv <= 1'b0;
|
m2pcv <= 1'b0;
|
m2pcv <= 1'b0;
|
wpcv <= 1'b0;
|
wpcv <= 1'b0;
|
tick <= 32'd0;
|
tick <= 32'd0;
|
cstate <= IDLE;
|
cstate <= IDLE;
|
dImm <= 64'd0;
|
dImm <= 64'd0;
|
AXC <= 4'd0;
|
AXC <= 4'd0;
|
dAXC <= 4'd0;
|
dAXC <= 4'd0;
|
xirqf <= 1'b0;
|
xirqf <= 1'b0;
|
xextype <= 8'h00;
|
xextype <= 8'h00;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xpc <= 64'd0;
|
xpc <= 64'd0;
|
a <= 64'd0;
|
a <= 64'd0;
|
b <= 64'd0;
|
b <= 64'd0;
|
imm <= 64'd0;
|
imm <= 64'd0;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
clk_en <= 1'b1;
|
clk_en <= 1'b1;
|
`ifdef TLB
|
|
Random <= 4'hF;
|
|
Wired <= 4'd0;
|
|
`endif
|
|
StatusEXL <= 1'b1;
|
StatusEXL <= 1'b1;
|
StatusHWI <= 1'b0;
|
StatusHWI <= 1'b0;
|
resetA <= 1'b1;
|
resetA <= 1'b1;
|
mutex_gate <= 64'h0;
|
mutex_gate <= 64'h0;
|
`ifndef BRANCH_PREDICTION_SIMPLE
|
|
gbl_branch_hist <= 3'b000;
|
|
`endif
|
|
dcache_on <= 1'b0;
|
dcache_on <= 1'b0;
|
ICacheOn <= 1'b0;
|
ICacheOn <= 1'b0;
|
ibuftag0 <= 64'h0;
|
ibuftag0 <= 64'h0;
|
ibuftag1 <= 64'h0;
|
ibuftag1 <= 64'h0;
|
m1IsCacheElement <= 1'b0;
|
m1IsCacheElement <= 1'b0;
|
dtinit <= 1'b1;
|
dtinit <= 1'b1;
|
`ifdef RAS_PREDICTION
|
`ifdef RAS_PREDICTION
|
ras_sp <= 6'd63;
|
ras_sp <= 6'd63;
|
`endif
|
`endif
|
im <= 1'b1;
|
im <= 1'b1;
|
im1 <= 1'b1;
|
im1 <= 1'b1;
|
// These must be non-zero in order to produce random numbers
|
// These must be non-zero in order to produce random numbers
|
// We set them here in case the user doesn't bother to set them.
|
// We set them here in case the user doesn't bother to set them.
|
m_z1 <= 32'h01234567;
|
m_z1 <= 32'h01234567;
|
m_z2 <= 32'h89ABCDEF;
|
m_z2 <= 32'h89ABCDEF;
|
m_w1 <= 32'h88888888;
|
m_w1 <= 32'h88888888;
|
m_w2 <= 32'h77777777;
|
m_w2 <= 32'h77777777;
|
insnkey <= 42'd0;
|
insnkey <= 42'd0;
|
end
|
end
|
else begin
|
else begin
|
|
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
// Initialize program counters
|
// Initialize program counters
|
// Initialize data tags to zero.
|
// Initialize data tags to zero.
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
if (resetA) begin
|
if (resetA) begin
|
pc <= `RESET_VECTOR;
|
pc <= `RESET_VECTOR;
|
adr_o[14:6] <= adr_o[14:6]+9'd1;
|
adr_o[14:6] <= adr_o[14:6]+9'd1;
|
if (adr_o[14:6]==9'h1FF) begin
|
if (adr_o[14:6]==9'h1FF) begin
|
dtinit <= 1'b0;
|
dtinit <= 1'b0;
|
resetA <= 1'b0;
|
resetA <= 1'b0;
|
end
|
end
|
end
|
end
|
|
|
`ifdef TLB
|
|
if (Random==Wired)
|
|
Random <= 3'd7;
|
|
else
|
|
Random <= Random - 3'd1;
|
|
`endif
|
|
|
|
tick <= tick + 64'd1;
|
tick <= tick + 64'd1;
|
|
|
prev_nmi <= nmi_i;
|
prev_nmi <= nmi_i;
|
if (!prev_nmi & nmi_i)
|
if (!prev_nmi & nmi_i)
|
nmi_edge <= 1'b1;
|
nmi_edge <= 1'b1;
|
|
|
|
|
`ifdef ADDRESS_RESERVATION
|
`ifdef ADDRESS_RESERVATION
|
// A store by any device in the system to a reserved address blcok
|
// A store by any device in the system to a reserved address blcok
|
// clears the reservation.
|
// clears the reservation.
|
|
|
if (sys_adv && sys_adr[63:5]==resv_address)
|
if (sys_adv && sys_adr[63:5]==resv_address)
|
resv_address <= 59'd0;
|
resv_address <= 59'd0;
|
`endif
|
`endif
|
|
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
// TRAILER:
|
// TRAILER:
|
// - placeholder to allow the use of synchronous register
|
// - placeholder to allow the use of synchronous register
|
// memory
|
// memory
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
if (advanceT) begin
|
if (advanceT) begin
|
tRt <= 9'd0;
|
tRt <= 9'd0;
|
tData <= 64'd0;
|
tData <= 64'd0;
|
end
|
end
|
|
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
// WRITEBACK:
|
// WRITEBACK:
|
// - update the register file with results
|
// - update the register file with results
|
// - record exception address and type
|
// - record exception address and type
|
// - jump to exception handler routine (below)
|
// - jump to exception handler routine (below)
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
if (advanceW) begin
|
if (advanceW) begin
|
textype <= wextype;
|
textype <= wextype;
|
wextype <= `EX_NON;
|
wextype <= `EX_NON;
|
if (wextype==`EX_IRQ)
|
if (wextype==`EX_IRQ)
|
$display("wextype=IRQ");
|
$display("wextype=IRQ");
|
tRt <= wRt;
|
tRt <= wRt;
|
tData <= wData;
|
tData <= wData;
|
if (wRt!=5'd0)
|
if (wRt!=5'd0)
|
$display("Writing regfile[%d:%d] with %h", wRt[8:5],wRt[4:0], wData);
|
$display("Writing regfile[%d:%d] with %h", wRt[8:5],wRt[4:0], wData);
|
case(wOpcode)
|
case(wOpcode)
|
`LSH:
|
`LSH:
|
case (wRt)
|
case (wRt)
|
`SR: begin
|
`SR: begin
|
bu_im <= wData[31];
|
bu_im <= wData[31];
|
im <= wData[15];
|
im <= wData[15];
|
FXE <= wData[12];
|
FXE <= wData[12];
|
end
|
end
|
default: ;
|
default: ;
|
endcase
|
endcase
|
endcase
|
endcase
|
wRt <= 9'd0;
|
wRt <= 9'd0;
|
wData <= 64'd0;
|
wData <= 64'd0;
|
wOpcode <= `NOPI;
|
wOpcode <= `NOPI;
|
wIsStore <= 1'b0;
|
wIsStore <= 1'b0;
|
wLdPC <= 1'b0;
|
wLdPC <= 1'b0;
|
if (|whwxtype) begin
|
if (|whwxtype) begin
|
dhwxtype <= 2'b00;
|
dhwxtype <= 2'b00;
|
xhwxtype <= 2'b00;
|
xhwxtype <= 2'b00;
|
m1hwxtype <= 2'b00;
|
m1hwxtype <= 2'b00;
|
m2hwxtype <= 2'b00;
|
m2hwxtype <= 2'b00;
|
whwxtype <= 2'b00;
|
whwxtype <= 2'b00;
|
end
|
end
|
clk_en <= 1'b1;
|
clk_en <= 1'b1;
|
if (wclkoff)
|
if (wclkoff)
|
clk_en <= 1'b0;
|
clk_en <= 1'b0;
|
wclkoff <= 1'b0;
|
wclkoff <= 1'b0;
|
m1clkoff <= 1'b0;
|
m1clkoff <= 1'b0;
|
m2clkoff <= 1'b0;
|
m2clkoff <= 1'b0;
|
if (wFip) begin
|
if (wFip) begin
|
wFip <= 1'b0;
|
wFip <= 1'b0;
|
m2Fip <= 1'b0;
|
m2Fip <= 1'b0;
|
m1Fip <= 1'b0;
|
m1Fip <= 1'b0;
|
xFip <= 1'b0;
|
xFip <= 1'b0;
|
dFip <= 1'b0;
|
dFip <= 1'b0;
|
end
|
end
|
end
|
end
|
|
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
// MEMORY:
|
// MEMORY:
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
if (advanceM2) begin
|
if (advanceM2) begin
|
wIsStore <= m2IsStore;
|
wIsStore <= m2IsStore;
|
|
wIR <= m2IR;
|
wOpcode <= m2Opcode;
|
wOpcode <= m2Opcode;
|
|
wFunc <= m2Func;
|
wData <= m2Data;
|
wData <= m2Data;
|
whwxtype <= m2hwxtype;
|
whwxtype <= m2hwxtype;
|
wextype <= (m2IsLoad|m2IsStore)&err_i ? `EX_DBERR : m2extype;
|
wextype <= (m2IsLoad|m2IsStore)&err_i ? `EX_DBERR : m2extype;
|
if (m2extype==`EX_IRQ)
|
if (m2extype==`EX_IRQ)
|
$display("m2extype=IRQ");
|
$display("m2extype=IRQ");
|
wRt <= m2Rt;
|
wRt <= m2Rt;
|
wpc <= m2pc;
|
wpc <= m2pc;
|
wpcv <= m2pcv;
|
wpcv <= m2pcv;
|
wclkoff <= m2clkoff;
|
wclkoff <= m2clkoff;
|
wFip <= m2Fip;
|
wFip <= m2Fip;
|
wLdPC <= m2LdPC;
|
wLdPC <= m2LdPC;
|
|
|
m2Rt <= 9'd0;
|
m2Rt <= 9'd0;
|
m2Opcode <= `NOPI;
|
m2Opcode <= `NOPI;
|
m2IsLoad <= 1'b0;
|
m2IsLoad <= 1'b0;
|
m2IsStore <= 1'b0;
|
m2IsStore <= 1'b0;
|
m2IsCnt <= 1'b0;
|
m2IsCnt <= 1'b0;
|
m2Func <= 7'd0;
|
m2Func <= 7'd0;
|
m2Addr <= 64'd0;
|
m2Addr <= 64'd0;
|
m2Data <= 64'd0;
|
m2Data <= 64'd0;
|
m2clkoff <= 1'b0;
|
m2clkoff <= 1'b0;
|
m2pc <= 64'd0;
|
m2pc <= 64'd0;
|
m2extype <= `EX_NON;
|
m2extype <= `EX_NON;
|
m2LdPC <= 1'b0;
|
m2LdPC <= 1'b0;
|
if ((m2IsLoad|m2IsStore)&err_i)
|
if ((m2IsLoad|m2IsStore)&err_i)
|
errorAddress <= adr_o;
|
errorAddress <= adr_o;
|
if (m2extype==`EX_NON) begin
|
if (m2extype==`EX_NON) begin
|
case(m2Opcode)
|
case(m2Opcode)
|
`MISC:
|
`MISC:
|
if (m2Func==`SYSJMP || m2Func==`SYSCALL)
|
if (m2Func==`SYSJMP || m2Func==`SYSCALL)
|
begin
|
begin
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
sel_o <= 8'h00;
|
sel_o <= 8'h00;
|
wData <= {dat_i[63:2],2'b00};
|
wData <= {dat_i[63:2],2'b00};
|
end
|
end
|
`SH,`SC,`SB,`SW,`SWC,`SM,`SF,`SFD,`SSH,`SSW,`SP,`SFP,`SFDP:
|
`SH,`SC,`SB,`SW,`SWC,`SM,`SF,`SFD,`SSH,`SSW,`SP,`SFP,`SFDP:
|
begin
|
begin
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
we_o <= 1'b0;
|
we_o <= 1'b0;
|
sel_o <= 4'h0;
|
sel_o <= 4'h0;
|
end
|
end
|
`LH,`LF,`LSH,`LFP:
|
`LH,`LF,`LSH,`LFP:
|
begin
|
begin
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
sel_o <= 8'h00;
|
sel_o <= 8'h00;
|
wData <= sel_o[7] ? {{32{dat_i[63]}},dat_i[63:32]}:{{32{dat_i[31]}},dat_i[31: 0]};
|
wData <= sel_o[7] ? {{32{dat_i[63]}},dat_i[63:32]}:{{32{dat_i[31]}},dat_i[31: 0]};
|
end
|
end
|
`LW,`LWR,`LM,`LFD,`LSW,`LP,`LFDP:
|
`LW,`LWR,`LM,`LFD,`LSW,`LP,`LFDP:
|
begin
|
begin
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
sel_o <= 8'h00;
|
sel_o <= 8'h00;
|
wData <= dat_i;
|
wData <= dat_i;
|
end
|
end
|
`LHU:
|
`LHU:
|
begin
|
begin
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
sel_o <= 8'h00;
|
sel_o <= 8'h00;
|
wData <= sel_o[7] ? dat_i[63:32] : dat_i[31: 0];
|
wData <= sel_o[7] ? dat_i[63:32] : dat_i[31: 0];
|
end
|
end
|
`LC:
|
`LC:
|
begin
|
begin
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
sel_o <= 8'h00;
|
sel_o <= 8'h00;
|
case(sel_o)
|
case(sel_o)
|
8'b00000011: wData <= {{48{dat_i[15]}},dat_i[15: 0]};
|
8'b00000011: wData <= {{48{dat_i[15]}},dat_i[15: 0]};
|
8'b00001100: wData <= {{48{dat_i[31]}},dat_i[31:16]};
|
8'b00001100: wData <= {{48{dat_i[31]}},dat_i[31:16]};
|
8'b00110000: wData <= {{48{dat_i[47]}},dat_i[47:32]};
|
8'b00110000: wData <= {{48{dat_i[47]}},dat_i[47:32]};
|
8'b11000000: wData <= {{48{dat_i[63]}},dat_i[63:48]};
|
8'b11000000: wData <= {{48{dat_i[63]}},dat_i[63:48]};
|
default: wData <= 64'hDEADDEADDEADDEAD;
|
default: wData <= 64'hDEADDEADDEADDEAD;
|
endcase
|
endcase
|
end
|
end
|
`LCU:
|
`LCU:
|
begin
|
begin
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
sel_o <= 8'h00;
|
sel_o <= 8'h00;
|
case(sel_o)
|
case(sel_o)
|
8'b00000011: wData <= dat_i[15: 0];
|
8'b00000011: wData <= dat_i[15: 0];
|
8'b00001100: wData <= dat_i[31:16];
|
8'b00001100: wData <= dat_i[31:16];
|
8'b00110000: wData <= dat_i[47:32];
|
8'b00110000: wData <= dat_i[47:32];
|
8'b11000000: wData <= dat_i[63:48];
|
8'b11000000: wData <= dat_i[63:48];
|
default: wData <= 64'hDEADDEADDEADDEAD;
|
default: wData <= 64'hDEADDEADDEADDEAD;
|
endcase
|
endcase
|
end
|
end
|
`LB:
|
`LB:
|
begin
|
begin
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
sel_o <= 8'h00;
|
sel_o <= 8'h00;
|
case(sel_o)
|
case(sel_o)
|
8'b00000001: wData <= {{56{dat_i[ 7]}},dat_i[ 7: 0]};
|
8'b00000001: wData <= {{56{dat_i[ 7]}},dat_i[ 7: 0]};
|
8'b00000010: wData <= {{56{dat_i[15]}},dat_i[15: 8]};
|
8'b00000010: wData <= {{56{dat_i[15]}},dat_i[15: 8]};
|
8'b00000100: wData <= {{56{dat_i[23]}},dat_i[23:16]};
|
8'b00000100: wData <= {{56{dat_i[23]}},dat_i[23:16]};
|
8'b00001000: wData <= {{56{dat_i[31]}},dat_i[31:24]};
|
8'b00001000: wData <= {{56{dat_i[31]}},dat_i[31:24]};
|
8'b00010000: wData <= {{56{dat_i[39]}},dat_i[39:32]};
|
8'b00010000: wData <= {{56{dat_i[39]}},dat_i[39:32]};
|
8'b00100000: wData <= {{56{dat_i[47]}},dat_i[47:40]};
|
8'b00100000: wData <= {{56{dat_i[47]}},dat_i[47:40]};
|
8'b01000000: wData <= {{56{dat_i[55]}},dat_i[55:48]};
|
8'b01000000: wData <= {{56{dat_i[55]}},dat_i[55:48]};
|
8'b10000000: wData <= {{56{dat_i[63]}},dat_i[63:56]};
|
8'b10000000: wData <= {{56{dat_i[63]}},dat_i[63:56]};
|
default: wData <= 64'hDEADDEADDEADDEAD;
|
default: wData <= 64'hDEADDEADDEADDEAD;
|
endcase
|
endcase
|
end
|
end
|
`LBU:
|
`LBU:
|
begin
|
begin
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
sel_o <= 8'h00;
|
sel_o <= 8'h00;
|
case(sel_o)
|
case(sel_o)
|
8'b00000001: wData <= dat_i[ 7: 0];
|
8'b00000001: wData <= dat_i[ 7: 0];
|
8'b00000010: wData <= dat_i[15: 8];
|
8'b00000010: wData <= dat_i[15: 8];
|
8'b00000100: wData <= dat_i[23:16];
|
8'b00000100: wData <= dat_i[23:16];
|
8'b00001000: wData <= dat_i[31:24];
|
8'b00001000: wData <= dat_i[31:24];
|
8'b00010000: wData <= dat_i[39:32];
|
8'b00010000: wData <= dat_i[39:32];
|
8'b00100000: wData <= dat_i[47:40];
|
8'b00100000: wData <= dat_i[47:40];
|
8'b01000000: wData <= dat_i[55:48];
|
8'b01000000: wData <= dat_i[55:48];
|
8'b10000000: wData <= dat_i[63:56];
|
8'b10000000: wData <= dat_i[63:56];
|
default: wData <= 64'hDEADDEADDEADDEAD;
|
default: wData <= 64'hDEADDEADDEADDEAD;
|
endcase
|
endcase
|
end
|
end
|
default: ;
|
default: ;
|
endcase
|
endcase
|
end
|
end
|
end
|
end
|
|
|
wrhit <= 1'b0;
|
wrhit <= 1'b0;
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
// MEMORY:
|
// MEMORY:
|
// - I/O instructions are finished
|
// - I/O instructions are finished
|
// - store instructions are started
|
// - store instructions are started
|
// - missed loads are started
|
// - missed loads are started
|
// On a data cache hit for a load, the load is essentially
|
// On a data cache hit for a load, the load is essentially
|
// finished in this stage. We switch the opcode to 'NOPI'
|
// finished in this stage. We switch the opcode to 'NOPI'
|
// to cause the pipeline to advance as if a NOPs were
|
// to cause the pipeline to advance as if a NOPs were
|
// present.
|
// present.
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
if (advanceM1) begin
|
if (advanceM1) begin
|
|
m2IR <= m1IR;
|
m2Opcode <= m1Opcode;
|
m2Opcode <= m1Opcode;
|
m2Func <= m1Func;
|
m2Func <= m1Func;
|
m2IsLoad <= m1IsLoad;
|
m2IsLoad <= m1IsLoad;
|
m2IsStore <= m1IsStore;
|
m2IsStore <= m1IsStore;
|
m2IsCnt <= m1IsCnt;
|
m2IsCnt <= m1IsCnt;
|
m2Func <= m1Func;
|
m2Func <= m1Func;
|
m2Addr <= pea;
|
m2Addr <= pea;
|
m2Data <= m1Data;
|
m2Data <= m1Data;
|
m2hwxtype <= m1hwxtype;
|
m2hwxtype <= m1hwxtype;
|
m2extype <= m1IsIO & err_i ? `EX_DBERR : m1extype;
|
m2extype <= m1IsIO & err_i ? `EX_DBERR : m1extype;
|
if (m1extype==`EX_IRQ)
|
if (m1extype==`EX_IRQ)
|
$display("m1extype=IRQ");
|
$display("m1extype=IRQ");
|
m2Rt <= m1Rt;
|
m2Rt <= m1Rt;
|
m2pc <= m1pc;
|
m2pc <= m1pc;
|
m2pcv <= m1pcv;
|
m2pcv <= m1pcv;
|
m2clkoff <= m1clkoff;
|
m2clkoff <= m1clkoff;
|
m2Fip <= m1Fip;
|
m2Fip <= m1Fip;
|
|
|
m1Rt <= 9'd0;
|
m1Rt <= 9'd0;
|
m1IsLoad <= 1'b0;
|
m1IsLoad <= 1'b0;
|
m1IsStore <= 1'b0;
|
m1IsStore <= 1'b0;
|
m1IsCnt <= 1'b0;
|
m1IsCnt <= 1'b0;
|
m1IsIO <= 1'b0;
|
m1IsIO <= 1'b0;
|
m1Opcode <= `NOPI;
|
m1Opcode <= `NOPI;
|
m1Func <= 7'd0;
|
m1Func <= 7'd0;
|
m1Data <= 64'd0;
|
m1Data <= 64'd0;
|
m1clkoff <= 1'b0;
|
m1clkoff <= 1'b0;
|
m1pc <= 64'd0;
|
m1pc <= 64'd0;
|
m1IsCacheElement <= 1'b0;
|
m1IsCacheElement <= 1'b0;
|
m1extype <= `EX_NON;
|
m1extype <= `EX_NON;
|
|
|
if (m1IsIO&err_i)
|
if (m1IsIO&err_i)
|
errorAddress <= adr_o;
|
errorAddress <= adr_o;
|
|
|
if (m1extype == `EX_NON) begin
|
if (m1extype == `EX_NON) begin
|
case(m1Opcode)
|
case(m1Opcode)
|
`MISC:
|
`MISC:
|
case(m1Func)
|
case(m1Func)
|
`SYSJMP,`SYSCALL:
|
`SYSJMP,`SYSCALL:
|
begin
|
begin
|
m2LdPC <= 1'b1;
|
m2LdPC <= 1'b1;
|
if (!m1IsCacheElement) begin
|
if (!m1IsCacheElement) begin
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
sel_o <= 8'hFF;
|
sel_o <= 8'hFF;
|
adr_o <= {pea[63:3],3'b000};
|
adr_o <= {pea[63:3],3'b000};
|
m2Addr <= {pea[63:3],3'b000};
|
m2Addr <= {pea[63:3],3'b000};
|
end
|
end
|
else if (dhit) begin
|
else if (dhit) begin
|
m2IsLoad <= 1'b0;
|
m2IsLoad <= 1'b0;
|
m2Opcode <= `NOPI;
|
m2Opcode <= `NOPI;
|
m2Data <= {cdat[63:2],2'b00};
|
m2Data <= {cdat[63:2],2'b00};
|
end
|
end
|
end
|
end
|
`ifdef TLB
|
|
`TLBP:
|
|
begin
|
|
Index[63] <= ~|DMatch;
|
|
end
|
|
`TLBR:
|
|
begin
|
|
TLBPageMask <= ITLBPageMask[i];
|
|
TLBVirtPage <= ITLBVirtPage[i];
|
|
TLBPhysPage0 <= ITLBPhysPage0[i];
|
|
TLBPhysPage1 <= ITLBPhysPage1[i];
|
|
TLBASID <= ITLBASID[i];
|
|
TLBG <= ITLBG[i];
|
|
TLBD <= ITLBD[i];
|
|
TLBValid <= ITLBValid[i];
|
|
end
|
|
`TLBWI,`TLBWR:
|
|
begin
|
|
ITLBValid[i] <= TLBValid;
|
|
ITLBVirtPage[i] <= TLBVirtPage;
|
|
ITLBPhysPage0[i] <= TLBPhysPage0;
|
|
ITLBPhysPage1[i] <= TLBPhysPage1;
|
|
ITLBPageMask[i] <= TLBPageMask;
|
|
ITLBASID[i] <= TLBASID;
|
|
ITLBD[i] <= TLBD;
|
|
ITLBG[i] <= TLBG;
|
|
end
|
|
`endif
|
|
endcase
|
endcase
|
`INW:
|
`INW:
|
begin
|
begin
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
sel_o <= 8'h00;
|
sel_o <= 8'h00;
|
m2Data <= dat_i;
|
m2Data <= dat_i;
|
end
|
end
|
`INH:
|
`INH:
|
begin
|
begin
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
sel_o <= 8'h00;
|
sel_o <= 8'h00;
|
m2Data <= sel_o[7] ? {{32{dat_i[63]}},dat_i[63:32]}:{{32{dat_i[31]}},dat_i[31: 0]};
|
m2Data <= sel_o[7] ? {{32{dat_i[63]}},dat_i[63:32]}:{{32{dat_i[31]}},dat_i[31: 0]};
|
end
|
end
|
`INHU:
|
`INHU:
|
begin
|
begin
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
sel_o <= 8'h00;
|
sel_o <= 8'h00;
|
m2Data <= sel_o[7] ? dat_i[63:32] : dat_i[31: 0];
|
m2Data <= sel_o[7] ? dat_i[63:32] : dat_i[31: 0];
|
end
|
end
|
`INCH:
|
`INCH:
|
begin
|
begin
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
sel_o <= 8'h00;
|
sel_o <= 8'h00;
|
case(sel_o)
|
case(sel_o)
|
8'b00000011: m2Data <= {{48{dat_i[15]}},dat_i[15: 0]};
|
8'b00000011: m2Data <= {{48{dat_i[15]}},dat_i[15: 0]};
|
8'b00001100: m2Data <= {{48{dat_i[31]}},dat_i[31:16]};
|
8'b00001100: m2Data <= {{48{dat_i[31]}},dat_i[31:16]};
|
8'b00110000: m2Data <= {{48{dat_i[47]}},dat_i[47:32]};
|
8'b00110000: m2Data <= {{48{dat_i[47]}},dat_i[47:32]};
|
8'b11000000: m2Data <= {{48{dat_i[63]}},dat_i[63:48]};
|
8'b11000000: m2Data <= {{48{dat_i[63]}},dat_i[63:48]};
|
default: m2Data <= 64'hDEADDEADDEADDEAD;
|
default: m2Data <= 64'hDEADDEADDEADDEAD;
|
endcase
|
endcase
|
end
|
end
|
`INCU:
|
`INCU:
|
begin
|
begin
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
sel_o <= 8'h00;
|
sel_o <= 8'h00;
|
case(sel_o)
|
case(sel_o)
|
8'b00000011: m2Data <= dat_i[15: 0];
|
8'b00000011: m2Data <= dat_i[15: 0];
|
8'b00001100: m2Data <= dat_i[31:16];
|
8'b00001100: m2Data <= dat_i[31:16];
|
8'b00110000: m2Data <= dat_i[47:32];
|
8'b00110000: m2Data <= dat_i[47:32];
|
8'b11000000: m2Data <= dat_i[63:48];
|
8'b11000000: m2Data <= dat_i[63:48];
|
default: m2Data <= 64'hDEADDEADDEADDEAD;
|
default: m2Data <= 64'hDEADDEADDEADDEAD;
|
endcase
|
endcase
|
end
|
end
|
`INB:
|
`INB:
|
begin
|
begin
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
sel_o <= 8'h00;
|
sel_o <= 8'h00;
|
case(sel_o)
|
case(sel_o)
|
8'b00000001: m2Data <= {{56{dat_i[ 7]}},dat_i[ 7: 0]};
|
8'b00000001: m2Data <= {{56{dat_i[ 7]}},dat_i[ 7: 0]};
|
8'b00000010: m2Data <= {{56{dat_i[15]}},dat_i[15: 8]};
|
8'b00000010: m2Data <= {{56{dat_i[15]}},dat_i[15: 8]};
|
8'b00000100: m2Data <= {{56{dat_i[23]}},dat_i[23:16]};
|
8'b00000100: m2Data <= {{56{dat_i[23]}},dat_i[23:16]};
|
8'b00001000: m2Data <= {{56{dat_i[31]}},dat_i[31:24]};
|
8'b00001000: m2Data <= {{56{dat_i[31]}},dat_i[31:24]};
|
8'b00010000: m2Data <= {{56{dat_i[39]}},dat_i[39:32]};
|
8'b00010000: m2Data <= {{56{dat_i[39]}},dat_i[39:32]};
|
8'b00100000: m2Data <= {{56{dat_i[47]}},dat_i[47:40]};
|
8'b00100000: m2Data <= {{56{dat_i[47]}},dat_i[47:40]};
|
8'b01000000: m2Data <= {{56{dat_i[55]}},dat_i[55:48]};
|
8'b01000000: m2Data <= {{56{dat_i[55]}},dat_i[55:48]};
|
8'b10000000: m2Data <= {{56{dat_i[63]}},dat_i[63:56]};
|
8'b10000000: m2Data <= {{56{dat_i[63]}},dat_i[63:56]};
|
default: m2Data <= 64'hDEADDEADDEADDEAD;
|
default: m2Data <= 64'hDEADDEADDEADDEAD;
|
endcase
|
endcase
|
end
|
end
|
`INBU:
|
`INBU:
|
begin
|
begin
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
sel_o <= 8'h00;
|
sel_o <= 8'h00;
|
case(sel_o)
|
case(sel_o)
|
8'b00000001: m2Data <= dat_i[ 7: 0];
|
8'b00000001: m2Data <= dat_i[ 7: 0];
|
8'b00000010: m2Data <= dat_i[15: 8];
|
8'b00000010: m2Data <= dat_i[15: 8];
|
8'b00000100: m2Data <= dat_i[23:16];
|
8'b00000100: m2Data <= dat_i[23:16];
|
8'b00001000: m2Data <= dat_i[31:24];
|
8'b00001000: m2Data <= dat_i[31:24];
|
8'b00010000: m2Data <= dat_i[39:32];
|
8'b00010000: m2Data <= dat_i[39:32];
|
8'b00100000: m2Data <= dat_i[47:40];
|
8'b00100000: m2Data <= dat_i[47:40];
|
8'b01000000: m2Data <= dat_i[55:48];
|
8'b01000000: m2Data <= dat_i[55:48];
|
8'b10000000: m2Data <= dat_i[63:56];
|
8'b10000000: m2Data <= dat_i[63:56];
|
default: m2Data <= 64'hDEADDEADDEADDEAD;
|
default: m2Data <= 64'hDEADDEADDEADDEAD;
|
endcase
|
endcase
|
end
|
end
|
`OUTW,`OUTH,`OUTC,`OUTB:
|
`OUTW,`OUTH,`OUTC,`OUTB:
|
begin
|
begin
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
we_o <= 1'b0;
|
we_o <= 1'b0;
|
sel_o <= 8'h00;
|
sel_o <= 8'h00;
|
end
|
end
|
`CACHE:
|
`CACHE:
|
case(xIR[29:25])
|
case(xIR[29:25])
|
`INVIL: tvalid[ea[12:6]] <= 1'b0;
|
`INVIL: tvalid[ea[12:6]] <= 1'b0;
|
default: ;
|
default: ;
|
endcase
|
endcase
|
|
|
|
|
`LW,`LM,`LFD,`LSW,`LP,`LFDP:
|
`LW,`LM,`LFD,`LSW,`LP,`LFDP:
|
if (!m1IsCacheElement) begin
|
if (!m1IsCacheElement) begin
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
sel_o <= 8'hFF;
|
sel_o <= 8'hFF;
|
adr_o <= {pea[63:3],3'b000};
|
adr_o <= {pea[63:3],3'b000};
|
m2Addr <= {pea[63:3],3'b000};
|
m2Addr <= {pea[63:3],3'b000};
|
end
|
end
|
else if (dhit) begin
|
else if (dhit) begin
|
m2IsLoad <= 1'b0;
|
m2IsLoad <= 1'b0;
|
m2Opcode <= `NOPI;
|
m2Opcode <= `NOPI;
|
m2Data <= cdat;
|
m2Data <= cdat;
|
end
|
end
|
`ifdef ADDRESS_RESERVATION
|
`ifdef ADDRESS_RESERVATION
|
`LWR:
|
`LWR:
|
if (!m1IsCacheElement) begin
|
if (!m1IsCacheElement) begin
|
rsv_o <= 1'b1;
|
rsv_o <= 1'b1;
|
resv_address <= pea[63:5];
|
resv_address <= pea[63:5];
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
sel_o <= 8'hFF;
|
sel_o <= 8'hFF;
|
adr_o <= {pea[63:3],3'b000};
|
adr_o <= {pea[63:3],3'b000};
|
m2Addr <= {pea[63:3],3'b000};
|
m2Addr <= {pea[63:3],3'b000};
|
end
|
end
|
else if (dhit) begin
|
else if (dhit) begin
|
m2IsLoad <= 1'b0;
|
m2IsLoad <= 1'b0;
|
m2Opcode <= `NOPI;
|
m2Opcode <= `NOPI;
|
m2Data <= cdat;
|
m2Data <= cdat;
|
rsv_o <= 1'b1;
|
rsv_o <= 1'b1;
|
resv_address <= pea[63:5];
|
resv_address <= pea[63:5];
|
end
|
end
|
`endif
|
`endif
|
`LH,`LF,`LFP:
|
`LH,`LF,`LFP:
|
if (!m1IsCacheElement) begin
|
if (!m1IsCacheElement) begin
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
sel_o <= pea[2] ? 8'b11110000 : 8'b00001111;
|
sel_o <= pea[2] ? 8'b11110000 : 8'b00001111;
|
adr_o <= {pea[63:2],2'b00};
|
adr_o <= {pea[63:2],2'b00};
|
m2Addr <= {pea[63:2],2'b00};
|
m2Addr <= {pea[63:2],2'b00};
|
end
|
end
|
else if (dhit) begin
|
else if (dhit) begin
|
m2IsLoad <= 1'b0;
|
m2IsLoad <= 1'b0;
|
m2Opcode <= `NOPI;
|
m2Opcode <= `NOPI;
|
if (pea[1])
|
if (pea[1])
|
m2Data <= {{32{cdat[31]}},cdat[31:0]};
|
m2Data <= {{32{cdat[31]}},cdat[31:0]};
|
else
|
else
|
m2Data <= {{32{cdat[63]}},cdat[63:32]};
|
m2Data <= {{32{cdat[63]}},cdat[63:32]};
|
end
|
end
|
|
|
`LHU,`LSH:
|
`LHU,`LSH:
|
if (!m1IsCacheElement) begin
|
if (!m1IsCacheElement) begin
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
sel_o <= pea[2] ? 8'b11110000 : 8'b00001111;
|
sel_o <= pea[2] ? 8'b11110000 : 8'b00001111;
|
adr_o <= {pea[63:2],2'b00};
|
adr_o <= {pea[63:2],2'b00};
|
m2Addr <= {pea[63:2],2'b00};
|
m2Addr <= {pea[63:2],2'b00};
|
end
|
end
|
else if (dhit) begin
|
else if (dhit) begin
|
m2IsLoad <= 1'b0;
|
m2IsLoad <= 1'b0;
|
m2Opcode <= `NOPI;
|
m2Opcode <= `NOPI;
|
if (pea[1])
|
if (pea[1])
|
m2Data <= {32'd0,cdat};
|
m2Data <= {32'd0,cdat};
|
else
|
else
|
m2Data <= {32'd0,cdat[63:32]};
|
m2Data <= {32'd0,cdat[63:32]};
|
end
|
end
|
|
|
`LC:
|
`LC:
|
if (!m1IsCacheElement) begin
|
if (!m1IsCacheElement) begin
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
case(pea[2:1])
|
case(pea[2:1])
|
2'b00: sel_o <= 8'b00000011;
|
2'b00: sel_o <= 8'b00000011;
|
2'b01: sel_o <= 8'b00001100;
|
2'b01: sel_o <= 8'b00001100;
|
2'b10: sel_o <= 8'b00110000;
|
2'b10: sel_o <= 8'b00110000;
|
2'b11: sel_o <= 8'b11000000;
|
2'b11: sel_o <= 8'b11000000;
|
endcase
|
endcase
|
adr_o <= {pea[63:1],1'b0};
|
adr_o <= {pea[63:1],1'b0};
|
m2Addr <= {pea[63:1],1'b0};
|
m2Addr <= {pea[63:1],1'b0};
|
end
|
end
|
else if (dhit) begin
|
else if (dhit) begin
|
$display("dhit=1, cdat=%h",cdat);
|
$display("dhit=1, cdat=%h",cdat);
|
m2IsLoad <= 1'b0;
|
m2IsLoad <= 1'b0;
|
m2Opcode <= `NOPI;
|
m2Opcode <= `NOPI;
|
case(pea[2:1])
|
case(pea[2:1])
|
2'd0: m2Data <= {{48{cdat[15]}},cdat[15:0]};
|
2'd0: m2Data <= {{48{cdat[15]}},cdat[15:0]};
|
2'd1: m2Data <= {{48{cdat[31]}},cdat[31:16]};
|
2'd1: m2Data <= {{48{cdat[31]}},cdat[31:16]};
|
2'd2: m2Data <= {{48{cdat[47]}},cdat[47:32]};
|
2'd2: m2Data <= {{48{cdat[47]}},cdat[47:32]};
|
2'd3: m2Data <= {{48{cdat[63]}},cdat[63:48]};
|
2'd3: m2Data <= {{48{cdat[63]}},cdat[63:48]};
|
endcase
|
endcase
|
end
|
end
|
|
|
`LCU:
|
`LCU:
|
if (!m1IsCacheElement) begin
|
if (!m1IsCacheElement) begin
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
case(pea[2:1])
|
case(pea[2:1])
|
2'b00: sel_o <= 8'b00000011;
|
2'b00: sel_o <= 8'b00000011;
|
2'b01: sel_o <= 8'b00001100;
|
2'b01: sel_o <= 8'b00001100;
|
2'b10: sel_o <= 8'b00110000;
|
2'b10: sel_o <= 8'b00110000;
|
2'b11: sel_o <= 8'b11000000;
|
2'b11: sel_o <= 8'b11000000;
|
endcase
|
endcase
|
adr_o <= {pea[63:1],1'b0};
|
adr_o <= {pea[63:1],1'b0};
|
m2Addr <= {pea[63:1],1'b0};
|
m2Addr <= {pea[63:1],1'b0};
|
end
|
end
|
else if (dhit) begin
|
else if (dhit) begin
|
m2IsLoad <= 1'b0;
|
m2IsLoad <= 1'b0;
|
m2Opcode <= `NOPI;
|
m2Opcode <= `NOPI;
|
case(pea[2:1])
|
case(pea[2:1])
|
2'd0: m2Data <= {48'd0,cdat[15: 0]};
|
2'd0: m2Data <= {48'd0,cdat[15: 0]};
|
2'd1: m2Data <= {48'd0,cdat[31:16]};
|
2'd1: m2Data <= {48'd0,cdat[31:16]};
|
2'd2: m2Data <= {48'd0,cdat[47:32]};
|
2'd2: m2Data <= {48'd0,cdat[47:32]};
|
2'd3: m2Data <= {48'd0,cdat[63:48]};
|
2'd3: m2Data <= {48'd0,cdat[63:48]};
|
endcase
|
endcase
|
end
|
end
|
|
|
`LB:
|
`LB:
|
if (!m1IsCacheElement) begin
|
if (!m1IsCacheElement) begin
|
$display("Load byte:");
|
$display("Load byte:");
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
case(pea[2:0])
|
case(pea[2:0])
|
3'b000: sel_o <= 8'b00000001;
|
3'b000: sel_o <= 8'b00000001;
|
3'b001: sel_o <= 8'b00000010;
|
3'b001: sel_o <= 8'b00000010;
|
3'b010: sel_o <= 8'b00000100;
|
3'b010: sel_o <= 8'b00000100;
|
3'b011: sel_o <= 8'b00001000;
|
3'b011: sel_o <= 8'b00001000;
|
3'b100: sel_o <= 8'b00010000;
|
3'b100: sel_o <= 8'b00010000;
|
3'b101: sel_o <= 8'b00100000;
|
3'b101: sel_o <= 8'b00100000;
|
3'b110: sel_o <= 8'b01000000;
|
3'b110: sel_o <= 8'b01000000;
|
3'b111: sel_o <= 8'b10000000;
|
3'b111: sel_o <= 8'b10000000;
|
endcase
|
endcase
|
adr_o <= pea;
|
adr_o <= pea;
|
m2Addr <= pea;
|
m2Addr <= pea;
|
end
|
end
|
else if (dhit) begin
|
else if (dhit) begin
|
m2IsLoad <= 1'b0;
|
m2IsLoad <= 1'b0;
|
m2Opcode <= `NOPI;
|
m2Opcode <= `NOPI;
|
case(pea[2:0])
|
case(pea[2:0])
|
3'b000: m2Data <= {{56{cdat[ 7]}},cdat[ 7: 0]};
|
3'b000: m2Data <= {{56{cdat[ 7]}},cdat[ 7: 0]};
|
3'b001: m2Data <= {{56{cdat[15]}},cdat[15: 8]};
|
3'b001: m2Data <= {{56{cdat[15]}},cdat[15: 8]};
|
3'b010: m2Data <= {{56{cdat[23]}},cdat[23:16]};
|
3'b010: m2Data <= {{56{cdat[23]}},cdat[23:16]};
|
3'b011: m2Data <= {{56{cdat[31]}},cdat[31:24]};
|
3'b011: m2Data <= {{56{cdat[31]}},cdat[31:24]};
|
3'b100: m2Data <= {{56{cdat[39]}},cdat[39:32]};
|
3'b100: m2Data <= {{56{cdat[39]}},cdat[39:32]};
|
3'b101: m2Data <= {{56{cdat[47]}},cdat[47:40]};
|
3'b101: m2Data <= {{56{cdat[47]}},cdat[47:40]};
|
3'b110: m2Data <= {{56{cdat[55]}},cdat[55:48]};
|
3'b110: m2Data <= {{56{cdat[55]}},cdat[55:48]};
|
3'b111: m2Data <= {{56{cdat[63]}},cdat[63:56]};
|
3'b111: m2Data <= {{56{cdat[63]}},cdat[63:56]};
|
endcase
|
endcase
|
end
|
end
|
|
|
`LBU:
|
`LBU:
|
if (!m1IsCacheElement) begin
|
if (!m1IsCacheElement) begin
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
case(pea[2:0])
|
case(pea[2:0])
|
3'b000: sel_o <= 8'b00000001;
|
3'b000: sel_o <= 8'b00000001;
|
3'b001: sel_o <= 8'b00000010;
|
3'b001: sel_o <= 8'b00000010;
|
3'b010: sel_o <= 8'b00000100;
|
3'b010: sel_o <= 8'b00000100;
|
3'b011: sel_o <= 8'b00001000;
|
3'b011: sel_o <= 8'b00001000;
|
3'b100: sel_o <= 8'b00010000;
|
3'b100: sel_o <= 8'b00010000;
|
3'b101: sel_o <= 8'b00100000;
|
3'b101: sel_o <= 8'b00100000;
|
3'b110: sel_o <= 8'b01000000;
|
3'b110: sel_o <= 8'b01000000;
|
3'b111: sel_o <= 8'b10000000;
|
3'b111: sel_o <= 8'b10000000;
|
endcase
|
endcase
|
adr_o <= pea;
|
adr_o <= pea;
|
m2Addr <= pea;
|
m2Addr <= pea;
|
end
|
end
|
else if (dhit) begin
|
else if (dhit) begin
|
m2IsLoad <= 1'b0;
|
m2IsLoad <= 1'b0;
|
m2Opcode <= `NOPI;
|
m2Opcode <= `NOPI;
|
case(pea[2:0])
|
case(pea[2:0])
|
3'b000: m2Data <= {56'd0,cdat[ 7: 0]};
|
3'b000: m2Data <= {56'd0,cdat[ 7: 0]};
|
3'b001: m2Data <= {56'd0,cdat[15: 8]};
|
3'b001: m2Data <= {56'd0,cdat[15: 8]};
|
3'b010: m2Data <= {56'd0,cdat[23:16]};
|
3'b010: m2Data <= {56'd0,cdat[23:16]};
|
3'b011: m2Data <= {56'd0,cdat[31:23]};
|
3'b011: m2Data <= {56'd0,cdat[31:23]};
|
3'b100: m2Data <= {56'd0,cdat[39:32]};
|
3'b100: m2Data <= {56'd0,cdat[39:32]};
|
3'b101: m2Data <= {56'd0,cdat[47:40]};
|
3'b101: m2Data <= {56'd0,cdat[47:40]};
|
3'b110: m2Data <= {56'd0,cdat[55:48]};
|
3'b110: m2Data <= {56'd0,cdat[55:48]};
|
3'b111: m2Data <= {56'd0,cdat[63:56]};
|
3'b111: m2Data <= {56'd0,cdat[63:56]};
|
endcase
|
endcase
|
end
|
end
|
|
|
`SW,`SM,`SFD,`SSW,`SP,`SFDP:
|
`SW,`SM,`SFD,`SSW,`SP,`SFDP:
|
begin
|
begin
|
$display("SW/SM");
|
$display("SW/SM");
|
m2Addr <= {pea[63:3],3'b000};
|
m2Addr <= {pea[63:3],3'b000};
|
wrhit <= dhit;
|
wrhit <= dhit;
|
`ifdef TLB
|
|
if (!m1UnmappedDataArea & !q[3])
|
|
ITLBD[{q[2:0],pea[15:13]}] <= 1'b1;
|
|
`endif
|
|
`ifdef ADDRESS_RESERVATION
|
`ifdef ADDRESS_RESERVATION
|
if (resv_address==pea[63:5])
|
if (resv_address==pea[63:5])
|
resv_address <= 59'd0;
|
resv_address <= 59'd0;
|
`endif
|
`endif
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
we_o <= 1'b1;
|
we_o <= 1'b1;
|
sel_o <= 8'hFF;
|
sel_o <= 8'hFF;
|
adr_o <= {pea[63:3],3'b000};
|
adr_o <= {pea[63:3],3'b000};
|
dat_o <= m1Data;
|
dat_o <= m1Data;
|
end
|
end
|
|
|
`SH,`SF,`SSH,`SFP:
|
`SH,`SF,`SSH,`SFP:
|
begin
|
begin
|
wrhit <= dhit;
|
wrhit <= dhit;
|
m2Addr <= {pea[63:2],2'b00};
|
m2Addr <= {pea[63:2],2'b00};
|
`ifdef TLB
|
|
if (!m1UnmappedDataArea & !q[3])
|
|
ITLBD[{q[2:0],pea[15:13]}] <= 1'b1;
|
|
`endif
|
|
`ifdef ADDRESS_RESERVATION
|
`ifdef ADDRESS_RESERVATION
|
if (resv_address==pea[63:5])
|
if (resv_address==pea[63:5])
|
resv_address <= 59'd0;
|
resv_address <= 59'd0;
|
`endif
|
`endif
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
we_o <= 1'b1;
|
we_o <= 1'b1;
|
sel_o <= pea[2] ? 8'b11110000 : 8'b00001111;
|
sel_o <= pea[2] ? 8'b11110000 : 8'b00001111;
|
adr_o <= {pea[63:2],2'b00};
|
adr_o <= {pea[63:2],2'b00};
|
dat_o <= {2{m1Data[31:0]}};
|
dat_o <= {2{m1Data[31:0]}};
|
end
|
end
|
|
|
`SC:
|
`SC:
|
begin
|
begin
|
$display("Storing char to %h, ea=%h",pea,ea);
|
$display("Storing char to %h, ea=%h",pea,ea);
|
wrhit <= dhit;
|
wrhit <= dhit;
|
m2Addr <= {pea[63:2],2'b00};
|
m2Addr <= {pea[63:2],2'b00};
|
`ifdef TLB
|
|
if (!m1UnmappedDataArea & !q[3])
|
|
ITLBD[{q[2:0],pea[15:13]}] <= 1'b1;
|
|
`endif
|
|
`ifdef ADDRESS_RESERVATION
|
`ifdef ADDRESS_RESERVATION
|
if (resv_address==pea[63:5])
|
if (resv_address==pea[63:5])
|
resv_address <= 59'd0;
|
resv_address <= 59'd0;
|
`endif
|
`endif
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
we_o <= 1'b1;
|
we_o <= 1'b1;
|
case(pea[2:1])
|
case(pea[2:1])
|
2'b00: sel_o <= 8'b00000011;
|
2'b00: sel_o <= 8'b00000011;
|
2'b01: sel_o <= 8'b00001100;
|
2'b01: sel_o <= 8'b00001100;
|
2'b10: sel_o <= 8'b00110000;
|
2'b10: sel_o <= 8'b00110000;
|
2'b11: sel_o <= 8'b11000000;
|
2'b11: sel_o <= 8'b11000000;
|
endcase
|
endcase
|
adr_o <= {pea[63:1],1'b0};
|
adr_o <= {pea[63:1],1'b0};
|
dat_o <= {4{m1Data[15:0]}};
|
dat_o <= {4{m1Data[15:0]}};
|
end
|
end
|
|
|
`SB:
|
`SB:
|
begin
|
begin
|
wrhit <= dhit;
|
wrhit <= dhit;
|
m2Addr <= {pea[63:2],2'b00};
|
m2Addr <= {pea[63:2],2'b00};
|
`ifdef ADDRESS_RESERVATION
|
`ifdef ADDRESS_RESERVATION
|
if (resv_address==pea[63:5])
|
if (resv_address==pea[63:5])
|
resv_address <= 59'd0;
|
resv_address <= 59'd0;
|
`endif
|
`endif
|
`ifdef TLB
|
|
if (!m1UnmappedDataArea & !q[3])
|
|
ITLBD[{q[2:0],pea[15:13]}] <= 1'b1;
|
|
`endif
|
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
we_o <= 1'b1;
|
we_o <= 1'b1;
|
case(pea[2:0])
|
case(pea[2:0])
|
3'b000: sel_o <= 8'b00000001;
|
3'b000: sel_o <= 8'b00000001;
|
3'b001: sel_o <= 8'b00000010;
|
3'b001: sel_o <= 8'b00000010;
|
3'b010: sel_o <= 8'b00000100;
|
3'b010: sel_o <= 8'b00000100;
|
3'b011: sel_o <= 8'b00001000;
|
3'b011: sel_o <= 8'b00001000;
|
3'b100: sel_o <= 8'b00010000;
|
3'b100: sel_o <= 8'b00010000;
|
3'b101: sel_o <= 8'b00100000;
|
3'b101: sel_o <= 8'b00100000;
|
3'b110: sel_o <= 8'b01000000;
|
3'b110: sel_o <= 8'b01000000;
|
3'b111: sel_o <= 8'b10000000;
|
3'b111: sel_o <= 8'b10000000;
|
endcase
|
endcase
|
adr_o <= {pea[63:2],2'b00};
|
adr_o <= {pea[63:2],2'b00};
|
dat_o <= {8{m1Data[7:0]}};
|
dat_o <= {8{m1Data[7:0]}};
|
end
|
end
|
|
|
`ifdef ADDRESS_RESERVATION
|
`ifdef ADDRESS_RESERVATION
|
`SWC:
|
`SWC:
|
begin
|
begin
|
rsf <= 1'b0;
|
rsf <= 1'b0;
|
if (resv_address==pea[63:5]) begin
|
if (resv_address==pea[63:5]) begin
|
`ifdef TLB
|
|
if (!m1UnmappedDataArea & !q[3])
|
|
ITLBD[{q[2:0],pea[15:13]}] <= 1'b1;
|
|
`endif
|
|
wrhit <= dhit;
|
wrhit <= dhit;
|
m2Addr <= {pea[63:3],3'b00};
|
m2Addr <= {pea[63:3],3'b00};
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
we_o <= 1'b1;
|
we_o <= 1'b1;
|
sel_o <= 8'hFF;
|
sel_o <= 8'hFF;
|
adr_o <= {pea[63:3],3'b000};
|
adr_o <= {pea[63:3],3'b000};
|
dat_o <= m1Data;
|
dat_o <= m1Data;
|
resv_address <= 59'd0;
|
resv_address <= 59'd0;
|
rsf <= 1'b1;
|
rsf <= 1'b1;
|
end
|
end
|
else
|
else
|
m2Opcode <= `NOPI;
|
m2Opcode <= `NOPI;
|
end
|
end
|
`endif
|
`endif
|
endcase
|
endcase
|
end
|
end
|
end
|
end
|
|
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
// EXECUTE:
|
// EXECUTE:
|
// - perform datapath operation
|
// - perform datapath operation
|
// - perform virtual to physical address translation.
|
// - perform virtual to physical address translation.
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
if (advanceX) begin
|
if (advanceX) begin
|
|
m1IR <= xIR;
|
m1hwxtype <= xhwxtype;
|
m1hwxtype <= xhwxtype;
|
m1Fip <= xFip;
|
m1Fip <= xFip;
|
m1extype <= xextype;
|
m1extype <= xextype;
|
if (xextype==`EX_IRQ)
|
if (xextype==`EX_IRQ)
|
$display("xextype=IRQ");
|
$display("xextype=IRQ");
|
m1IsLoad <= xIsLoad;
|
m1IsLoad <= xIsLoad;
|
m1IsStore <= xIsStore;
|
m1IsStore <= xIsStore;
|
m1IsCnt <= xIsCnt;
|
m1IsCnt <= xIsCnt;
|
m1IsIO <= xIsIO;
|
m1IsIO <= xIsIO;
|
m1Opcode <= xOpcode;
|
m1Opcode <= xOpcode;
|
m1Func <= xFunc;
|
m1Func <= xFunc;
|
m1Rt <= xRt;
|
m1Rt <= xRt;
|
m1Data <= xData;
|
m1Data <= xData;
|
m1IsCacheElement <= xisCacheElement;
|
m1IsCacheElement <= xisCacheElement;
|
if (xOpcode==`MOVZ && !aeqz) begin
|
if (xOpcode==`MOVZ && !aeqz) begin
|
m1Rt <= 9'd0;
|
m1Rt <= 9'd0;
|
m1Data <= 64'd0;
|
m1Data <= 64'd0;
|
end
|
end
|
if (xOpcode==`MOVNZ && aeqz) begin
|
if (xOpcode==`MOVNZ && aeqz) begin
|
m1Rt <= 9'd0;
|
m1Rt <= 9'd0;
|
m1Data <= 64'd0;
|
m1Data <= 64'd0;
|
end
|
end
|
m1pc <= xpc;
|
m1pc <= xpc;
|
m1pcv <= xpcv;
|
m1pcv <= xpcv;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
a <= 64'd0;
|
a <= 64'd0;
|
b <= 64'd0;
|
b <= 64'd0;
|
imm <= 64'd0;
|
imm <= 64'd0;
|
xextype <= `EX_NON;
|
xextype <= `EX_NON;
|
if (xOpcode[6:4]!=`IMM) begin
|
if (xOpcode[6:4]!=`IMM) begin
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
end
|
end
|
// xpc <= 64'd0;
|
// xpc <= 64'd0;
|
case(xOpcode)
|
case(xOpcode)
|
`MISC:
|
`MISC:
|
case(xFunc)
|
case(xFunc)
|
`SEI: im <= 1'b1;
|
`SEI: im <= 1'b1;
|
`CLI: im <= 1'b0;
|
`CLI: im <= 1'b0;
|
`WAIT: m1clkoff <= 1'b1;
|
`WAIT: m1clkoff <= 1'b1;
|
`ICACHE_ON: ICacheOn <= 1'b1;
|
`ICACHE_ON: ICacheOn <= 1'b1;
|
`ICACHE_OFF: ICacheOn <= 1'b0;
|
`ICACHE_OFF: ICacheOn <= 1'b0;
|
`DCACHE_ON: dcache_on <= 1'b1;
|
`DCACHE_ON: dcache_on <= 1'b1;
|
`DCACHE_OFF: dcache_on <= 1'b0;
|
`DCACHE_OFF: dcache_on <= 1'b0;
|
`GRAN: begin
|
`GRAN: begin
|
rando <= rand;
|
rando <= rand;
|
m_z1 <= next_m_z1;
|
m_z1 <= next_m_z1;
|
m_z2 <= next_m_z2;
|
m_z2 <= next_m_z2;
|
m_w1 <= next_m_w1;
|
m_w1 <= next_m_w1;
|
m_w2 <= next_m_w2;
|
m_w2 <= next_m_w2;
|
end
|
end
|
`GRAFD: begin
|
`GRAFD: begin
|
rando <= randfd;
|
rando <= randfd;
|
m_z1 <= next_m_z1;
|
m_z1 <= next_m_z1;
|
m_z2 <= next_m_z2;
|
m_z2 <= next_m_z2;
|
m_w1 <= next_m_w1;
|
m_w1 <= next_m_w1;
|
m_w2 <= next_m_w2;
|
m_w2 <= next_m_w2;
|
end
|
end
|
`SYSJMP,`SYSCALL:
|
`SYSJMP,`SYSCALL:
|
begin
|
begin
|
ea <= {TBA[63:12],xIR[15:7],3'b000};
|
ea <= {TBA[63:12],xIR[15:7],3'b000};
|
end
|
end
|
`ifdef TLB
|
`ifdef TLB
|
`TLBP: ea <= TLBVirtPage;
|
`TLBP: ea <= TLBVirtPage;
|
`TLBR,`TLBWI:
|
|
begin
|
|
i <= {Index[2:0],TLBVirtPage[15:13]};
|
|
end
|
|
`TLBWR:
|
|
begin
|
|
i <= {Random,TLBVirtPage[15:13]};
|
|
end
|
|
`endif
|
`endif
|
default: ;
|
default: ;
|
endcase
|
endcase
|
`R:
|
`R:
|
case(xFunc)
|
case(xFunc)
|
`MTSPR:
|
`MTSPR:
|
case(xIR[12:7])
|
case(xIR[12:7])
|
`ifdef TLB
|
`ifdef TLB
|
`Wired: Wired <= a[2:0];
|
|
`TLBIndex: Index <= a[2:0];
|
|
`TLBVirtPage: TLBVirtPage <= a[63:13];
|
|
`TLBPhysPage0: TLBPhysPage0 <= a[63:13];
|
|
`TLBPhysPage1: TLBPhysPage1 <= a[63:13];
|
|
`TLBPageMask: TLBPageMask <= a[24:13];
|
|
`TLBASID: begin
|
|
TLBValid <= a[0];
|
|
TLBD <= a[1];
|
|
TLBG <= a[2];
|
|
TLBASID <= a[15:8];
|
|
end
|
|
`PageTableAddr: PageTableAddr <= a[63:13];
|
`PageTableAddr: PageTableAddr <= a[63:13];
|
`BadVAddr: BadVAddr <= a[63:13];
|
`BadVAddr: BadVAddr <= a[63:13];
|
`endif
|
`endif
|
`ASID: ASID <= a[7:0];
|
`ASID: ASID <= a[7:0];
|
`EPC: EPC <= a;
|
`EPC: EPC <= a;
|
`TBA: TBA <= {a[63:12],12'h000};
|
`TBA: TBA <= {a[63:12],12'h000};
|
`AXC: AXC <= a[3:0];
|
`AXC: AXC <= a[3:0];
|
`NON_ICACHE_SEG: nonICacheSeg <= a[63:32];
|
`NON_ICACHE_SEG: nonICacheSeg <= a[63:32];
|
`FPCR: rm <= a[31:30];
|
`FPCR: rm <= a[31:30];
|
`IPC: IPC <= a;
|
`IPC: IPC <= a;
|
`SRANDZ: begin
|
`SRAND1: begin
|
m_z1 <= a[31:0];
|
m_z1 <= a[31:0];
|
m_z2 <= a[63:32];
|
m_z2 <= a[63:32];
|
end
|
end
|
`SRANDW: begin
|
`SRAND2: begin
|
m_w1 <= a[31:0];
|
m_w1 <= a[31:0];
|
m_w2 <= a[63:32];
|
m_w2 <= a[63:32];
|
end
|
end
|
`INSNKEY: insnkey <= a[41:0];
|
`INSNKEY: insnkey <= a[41:0];
|
default: ;
|
default: ;
|
endcase
|
endcase
|
`OMG: mutex_gate[a[5:0]] <= 1'b1;
|
`OMG: mutex_gate[a[5:0]] <= 1'b1;
|
`CMG: mutex_gate[a[5:0]] <= 1'b0;
|
`CMG: mutex_gate[a[5:0]] <= 1'b0;
|
`OMGI: mutex_gate[xIR[12:7]] <= 1'b1;
|
`OMGI: mutex_gate[xIR[12:7]] <= 1'b1;
|
`CMGI: mutex_gate[xIR[12:7]] <= 1'b0;
|
`CMGI: mutex_gate[xIR[12:7]] <= 1'b0;
|
default: ;
|
default: ;
|
endcase
|
endcase
|
`CALL: m1Data <= fnIncPC(xpc);
|
`CALL: m1Data <= fnIncPC(xpc);
|
`INW:
|
`INW:
|
begin
|
begin
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
sel_o <= 8'hFF;
|
sel_o <= 8'hFF;
|
adr_o <= {xData[63:3],3'b000};
|
adr_o <= {xData[63:3],3'b000};
|
end
|
end
|
`INH,`INHU:
|
`INH,`INHU:
|
begin
|
begin
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
sel_o <= xData[2] ? 8'b11110000 : 8'b00001111;
|
sel_o <= xData[2] ? 8'b11110000 : 8'b00001111;
|
adr_o <= {xData[63:2],2'b00};
|
adr_o <= {xData[63:2],2'b00};
|
end
|
end
|
`INCH,`INCU:
|
`INCH,`INCU:
|
begin
|
begin
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
case(xData[2:1])
|
case(xData[2:1])
|
2'b00: sel_o <= 8'b00000011;
|
2'b00: sel_o <= 8'b00000011;
|
2'b01: sel_o <= 8'b00001100;
|
2'b01: sel_o <= 8'b00001100;
|
2'b10: sel_o <= 8'b00110000;
|
2'b10: sel_o <= 8'b00110000;
|
2'b11: sel_o <= 8'b11000000;
|
2'b11: sel_o <= 8'b11000000;
|
endcase
|
endcase
|
adr_o <= {xData[63:1],1'b0};
|
adr_o <= {xData[63:1],1'b0};
|
end
|
end
|
`INB,`INBU:
|
`INB,`INBU:
|
begin
|
begin
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
case(xData[2:0])
|
case(xData[2:0])
|
3'b000: sel_o <= 8'b00000001;
|
3'b000: sel_o <= 8'b00000001;
|
3'b001: sel_o <= 8'b00000010;
|
3'b001: sel_o <= 8'b00000010;
|
3'b010: sel_o <= 8'b00000100;
|
3'b010: sel_o <= 8'b00000100;
|
3'b011: sel_o <= 8'b00001000;
|
3'b011: sel_o <= 8'b00001000;
|
3'b100: sel_o <= 8'b00010000;
|
3'b100: sel_o <= 8'b00010000;
|
3'b101: sel_o <= 8'b00100000;
|
3'b101: sel_o <= 8'b00100000;
|
3'b110: sel_o <= 8'b01000000;
|
3'b110: sel_o <= 8'b01000000;
|
3'b111: sel_o <= 8'b10000000;
|
3'b111: sel_o <= 8'b10000000;
|
endcase
|
endcase
|
adr_o <= xData;
|
adr_o <= xData;
|
end
|
end
|
`OUTW:
|
`OUTW:
|
begin
|
begin
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
we_o <= 1'b1;
|
we_o <= 1'b1;
|
sel_o <= 8'hFF;
|
sel_o <= 8'hFF;
|
adr_o <= {xData[63:3],3'b000};
|
adr_o <= {xData[63:3],3'b000};
|
dat_o <= b;
|
dat_o <= b;
|
end
|
end
|
`OUTH:
|
`OUTH:
|
begin
|
begin
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
we_o <= 1'b1;
|
we_o <= 1'b1;
|
sel_o <= xData[2] ? 8'b11110000 : 8'b00001111;
|
sel_o <= xData[2] ? 8'b11110000 : 8'b00001111;
|
adr_o <= {xData[63:2],2'b00};
|
adr_o <= {xData[63:2],2'b00};
|
dat_o <= {2{b[31:0]}};
|
dat_o <= {2{b[31:0]}};
|
end
|
end
|
`OUTC:
|
`OUTC:
|
begin
|
begin
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
we_o <= 1'b1;
|
we_o <= 1'b1;
|
case(xData[2:1])
|
case(xData[2:1])
|
2'b00: sel_o <= 8'b00000011;
|
2'b00: sel_o <= 8'b00000011;
|
2'b01: sel_o <= 8'b00001100;
|
2'b01: sel_o <= 8'b00001100;
|
2'b10: sel_o <= 8'b00110000;
|
2'b10: sel_o <= 8'b00110000;
|
2'b11: sel_o <= 8'b11000000;
|
2'b11: sel_o <= 8'b11000000;
|
endcase
|
endcase
|
adr_o <= {xData[63:1],1'b0};
|
adr_o <= {xData[63:1],1'b0};
|
dat_o <= {4{b[15:0]}};
|
dat_o <= {4{b[15:0]}};
|
end
|
end
|
`OUTB:
|
`OUTB:
|
begin
|
begin
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
we_o <= 1'b1;
|
we_o <= 1'b1;
|
case(xData[2:0])
|
case(xData[2:0])
|
3'b000: sel_o <= 8'b00000001;
|
3'b000: sel_o <= 8'b00000001;
|
3'b001: sel_o <= 8'b00000010;
|
3'b001: sel_o <= 8'b00000010;
|
3'b010: sel_o <= 8'b00000100;
|
3'b010: sel_o <= 8'b00000100;
|
3'b011: sel_o <= 8'b00001000;
|
3'b011: sel_o <= 8'b00001000;
|
3'b100: sel_o <= 8'b00010000;
|
3'b100: sel_o <= 8'b00010000;
|
3'b101: sel_o <= 8'b00100000;
|
3'b101: sel_o <= 8'b00100000;
|
3'b110: sel_o <= 8'b01000000;
|
3'b110: sel_o <= 8'b01000000;
|
3'b111: sel_o <= 8'b10000000;
|
3'b111: sel_o <= 8'b10000000;
|
endcase
|
endcase
|
adr_o <= xData;
|
adr_o <= xData;
|
dat_o <= {8{b[7:0]}};
|
dat_o <= {8{b[7:0]}};
|
end
|
end
|
`LEA: m1Data <= xData;
|
`LEA: m1Data <= xData;
|
`LB,`LBU,`LC,`LCU,`LH,`LHU,`LW,`LWR,`LF,`LFD,`LM,`LSH,`LSW,`LP,`LFP,`LFDP,
|
`LB,`LBU,`LC,`LCU,`LH,`LHU,`LW,`LWR,`LF,`LFD,`LM,`LSH,`LSW,`LP,`LFP,`LFDP,
|
`SW,`SH,`SC,`SB,`SWC,`SF,`SFD,`SM,`SSH,`SSW,`SP,`SFP,`SFDP:
|
`SW,`SH,`SC,`SB,`SWC,`SF,`SFD,`SM,`SSH,`SSW,`SP,`SFP,`SFDP:
|
begin
|
begin
|
m1Data <= b;
|
m1Data <= b;
|
ea <= xData;
|
ea <= xData;
|
end
|
end
|
`SSH: begin
|
`SSH: begin
|
case(xRt)
|
case(xRt)
|
`SR: m1Data <= {2{sr}};
|
`SR: m1Data <= {2{sr}};
|
default: m1Data <= 64'd0;
|
default: m1Data <= 64'd0;
|
endcase
|
endcase
|
ea <= xData;
|
ea <= xData;
|
end
|
end
|
`CACHE:
|
`CACHE:
|
begin
|
begin
|
m1Data <= b;
|
m1Data <= b;
|
ea <= xData;
|
ea <= xData;
|
case(xIR[29:25])
|
case(xIR[29:25])
|
`INVIALL: tvalid <= 128'd0;
|
`INVIALL: tvalid <= 128'd0;
|
default: ;
|
default: ;
|
endcase
|
endcase
|
end
|
end
|
`MEMNDX:
|
`MEMNDX:
|
begin
|
begin
|
m1Opcode <= 7'd32+xFunc6;
|
m1Opcode <= 7'd32+xFunc6;
|
case(xFunc6)
|
case(xFunc6)
|
`LEAX:
|
`LEAX:
|
begin
|
begin
|
m1Data <= xData;
|
m1Data <= xData;
|
end
|
end
|
default:
|
default:
|
begin
|
begin
|
m1Data <= c;
|
m1Data <= c;
|
ea <= xData;
|
ea <= xData;
|
end
|
end
|
endcase
|
endcase
|
end
|
end
|
`DIVSI,`DIVUI:
|
`DIVSI,`DIVUI:
|
if (b==64'd0) begin
|
if (b==64'd0) begin
|
xextype <= `EX_DBZ;
|
xextype <= `EX_DBZ;
|
end
|
end
|
default: ;
|
default: ;
|
endcase
|
endcase
|
`ifdef FLOATING_POINT
|
`ifdef FLOATING_POINT
|
if (xOpcode==`FP) begin
|
if (xOpcode==`FP) begin
|
case (xFunc6)
|
case (xFunc6)
|
`FDADD,`FDSUB:
|
`FDADD,`FDSUB:
|
begin
|
begin
|
fp_uf <= fpaddsub_uf;
|
fp_uf <= fpaddsub_uf;
|
fp_ovr <= fpaddsub_ovr;
|
fp_ovr <= fpaddsub_ovr;
|
fp_iop <= fpaddsub_iop;
|
fp_iop <= fpaddsub_iop;
|
FPC_SL <= xData[63] && xData[62:0]!=63'd0;
|
FPC_SL <= xData[63] && xData[62:0]!=63'd0;
|
FPC_SG <= !xData[63] && xData[62:0]!=63'd0;
|
FPC_SG <= !xData[63] && xData[62:0]!=63'd0;
|
FPC_SE <= xData[62:0]==63'd0;
|
FPC_SE <= xData[62:0]==63'd0;
|
end
|
end
|
`FPMUL:
|
`FPMUL:
|
begin
|
begin
|
fp_uf <= fpmul_uf;
|
fp_uf <= fpmul_uf;
|
fp_ovr <= fpmul_ovr;
|
fp_ovr <= fpmul_ovr;
|
fp_iop <= fpmul_iop;
|
fp_iop <= fpmul_iop;
|
FPC_SL <= xData[63] && xData[62:0]!=63'd0;
|
FPC_SL <= xData[63] && xData[62:0]!=63'd0;
|
FPC_SG <= !xData[63] && xData[62:0]!=63'd0;
|
FPC_SG <= !xData[63] && xData[62:0]!=63'd0;
|
FPC_SE <= xData[62:0]==63'd0;
|
FPC_SE <= xData[62:0]==63'd0;
|
end
|
end
|
`FPDIV:
|
`FPDIV:
|
begin
|
begin
|
fp_uf <= fpdiv_uf;
|
fp_uf <= fpdiv_uf;
|
fp_ovr <= fpdiv_ovr;
|
fp_ovr <= fpdiv_ovr;
|
fp_iop <= fpdiv_iop;
|
fp_iop <= fpdiv_iop;
|
FPC_SL <= xData[63] && xData[62:0]!=63'd0;
|
FPC_SL <= xData[63] && xData[62:0]!=63'd0;
|
FPC_SG <= !xData[63] && xData[62:0]!=63'd0;
|
FPC_SG <= !xData[63] && xData[62:0]!=63'd0;
|
FPC_SE <= xData[62:0]==63'd0;
|
FPC_SE <= xData[62:0]==63'd0;
|
end
|
end
|
`FDF2I:
|
`FDF2I:
|
begin
|
begin
|
fp_ovr <= f2i_ovr;
|
fp_ovr <= f2i_ovr;
|
fp_iop <= f2i_iop;
|
fp_iop <= f2i_iop;
|
end
|
end
|
`FDCLT,`FDCLE,`FDCEQ,`FDCNE,`FDCGT,`FDCGE,`FDCUN:
|
`FDCLT,`FDCLE,`FDCEQ,`FDCNE,`FDCGT,`FDCGE,`FDCUN:
|
begin
|
begin
|
fp_iop <= fpcmp_iop;
|
fp_iop <= fpcmp_iop;
|
end
|
end
|
default: ;
|
default: ;
|
endcase
|
endcase
|
end
|
end
|
`endif
|
`endif
|
`ifndef BRANCH_PREDICTION_SIMPLE
|
|
// Update the branch history
|
|
if (isxBranch) begin
|
|
gbl_branch_hist <= {gbl_branch_hist,takb};
|
|
branch_history_table[bht_wa] <= xbits_new;
|
|
end
|
|
`endif
|
|
end
|
end
|
|
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
// RFETCH:
|
// RFETCH:
|
// Register fetch stage
|
// Register fetch stage
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
if (advanceR) begin
|
if (advanceR) begin
|
xAXC <= dAXC;
|
xAXC <= dAXC;
|
xhwxtype <= dhwxtype;
|
xhwxtype <= dhwxtype;
|
xFip <= dFip;
|
xFip <= dFip;
|
xextype <= dextype;
|
xextype <= dextype;
|
if (dextype==`EX_IRQ)
|
if (dextype==`EX_IRQ)
|
$display("dextype=IRQ");
|
$display("dextype=IRQ");
|
if (dOpcode==`R && dFunc==`MYST)
|
if (dOpcode==`R && dFunc==`MYST)
|
xIR <= nxt_c;
|
xIR <= nxt_c;
|
else
|
else
|
xIR <= dIR;
|
xIR <= dIR;
|
xpc <= dpc;
|
xpc <= dpc;
|
xpcv <= dpcv;
|
xpcv <= dpcv;
|
xbranch_taken <= dbranch_taken;
|
xbranch_taken <= dbranch_taken;
|
dbranch_taken <= 1'b0;
|
dbranch_taken <= 1'b0;
|
dextype <= `EX_NON;
|
dextype <= `EX_NON;
|
if (dOpcode[6:4]!=`IMM && dOpcode!=`LM && dOpcode!=`SM && dOpcode!=`SP && dOpcode!=`LP &&
|
if (dOpcode[6:4]!=`IMM && dOpcode!=`LM && dOpcode!=`SM && dOpcode!=`SP && dOpcode!=`LP &&
|
dOpcode!=`SFP && dOpcode!=`LFP && dOpcode!=`SFDP && dOpcode!=`LFDP) // IMM is "sticky"
|
dOpcode!=`SFP && dOpcode!=`LFP && dOpcode!=`SFDP && dOpcode!=`LFDP) // IMM is "sticky"
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
dRa <= 9'd0;
|
dRa <= 9'd0;
|
dRb <= 9'd0;
|
dRb <= 9'd0;
|
|
|
a <= nxt_a;
|
a <= nxt_a;
|
b <= nxt_b;
|
b <= nxt_b;
|
if (dOpcode==`SHFTI)
|
if (dOpcode==`SHFTI)
|
b <= {58'd0,dIR[24:19]};
|
b <= {58'd0,dIR[24:19]};
|
c <= nxt_c;
|
c <= nxt_c;
|
|
|
// Set the target register
|
// Set the target register
|
casex(dOpcode)
|
casex(dOpcode)
|
`R:
|
`R:
|
case(dFunc)
|
case(dFunc)
|
`MTSPR,`CMG,`CMGI,`EXEC:
|
`MTSPR,`CMG,`CMGI,`EXEC:
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
`MYST: xRt <= {dAXC,dIR[19:15]};
|
`MYST: xRt <= {dAXC,dIR[19:15]};
|
default: xRt <= {dAXC,dIR[29:25]};
|
default: xRt <= {dAXC,dIR[29:25]};
|
endcase
|
endcase
|
`SETLO: xRt <= {dAXC,dIR[36:32]};
|
`SETLO: xRt <= {dAXC,dIR[36:32]};
|
`SETHI: xRt <= {dAXC,dIR[36:32]};
|
`SETHI: xRt <= {dAXC,dIR[36:32]};
|
`RR,`FP: xRt <= {dAXC,dIR[24:20]};
|
`RR,`FP: xRt <= {dAXC,dIR[24:20]};
|
`BTRI: xRt <= 9'd0;
|
`BTRI: xRt <= 9'd0;
|
`BTRR:
|
`BTRR:
|
case(dIR[4:0])
|
case(dIR[4:0])
|
`LOOP: xRt <= {dAXC,dIR[29:25]};
|
`LOOP: xRt <= {dAXC,dIR[29:25]};
|
default: xRt <= 9'd0;
|
default: xRt <= 9'd0;
|
endcase
|
endcase
|
`TRAPcc: xRt <= 9'd0;
|
`TRAPcc: xRt <= 9'd0;
|
`TRAPcci: xRt <= 9'd0;
|
`TRAPcci: xRt <= 9'd0;
|
`JMP: xRt <= 9'd00;
|
`JMP: xRt <= 9'd00;
|
`CALL: xRt <= {dAXC,5'd31};
|
`CALL: xRt <= {dAXC,5'd31};
|
`RET: xRt <= {dAXC,5'd30};
|
`RET: xRt <= {dAXC,5'd30};
|
`MEMNDX:
|
`MEMNDX:
|
case(dFunc[5:0])
|
case(dFunc[5:0])
|
`SWX,`SHX,`SCX,`SBX,`SFX,`SFDX,`SPX,`SFPX,`SFDPX,`SSHX,`SSWX,
|
`SWX,`SHX,`SCX,`SBX,`SFX,`SFDX,`SPX,`SFPX,`SFDPX,`SSHX,`SSWX,
|
`OUTWX,`OUTHX,`OUTCX,`OUTBX:
|
`OUTWX,`OUTHX,`OUTCX,`OUTBX:
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
default: xRt <= {dAXC,dIR[24:20]};
|
default: xRt <= {dAXC,dIR[24:20]};
|
endcase
|
endcase
|
`LSH,`LSW,
|
`LSH,`LSW,
|
`SW,`SH,`SC,`SB,`SF,`SFD,`SSH,`SSW,`SP,`SFP,`SFDP, // but not SWC!
|
`SW,`SH,`SC,`SB,`SF,`SFD,`SSH,`SSW,`SP,`SFP,`SFDP, // but not SWC!
|
`OUTW,`OUTH,`OUTC,`OUTB:
|
`OUTW,`OUTH,`OUTC,`OUTB:
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
`NOPI: xRt <= 9'd0;
|
`NOPI: xRt <= 9'd0;
|
`BEQI,`BNEI,`BLTI,`BLEI,`BGTI,`BGEI,`BLTUI,`BLEUI,`BGTUI,`BGEUI:
|
`BEQI,`BNEI,`BLTI,`BLEI,`BGTI,`BGEI,`BLTUI,`BLEUI,`BGTUI,`BGEUI:
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
`SM: xRt <= 9'd0;
|
`SM: xRt <= 9'd0;
|
`LM:
|
`LM:
|
casex(dIR[30:0])
|
casex(dIR[30:0])
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx1: xRt <= {dAXC,5'd1};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx1: xRt <= {dAXC,5'd1};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxxxxx10: xRt <= {dAXC,5'd2};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxxxxx10: xRt <= {dAXC,5'd2};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxxxx100: xRt <= {dAXC,5'd3};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxxxx100: xRt <= {dAXC,5'd3};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxxx1000: xRt <= {dAXC,5'd4};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxxx1000: xRt <= {dAXC,5'd4};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxx10000: xRt <= {dAXC,5'd5};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxx10000: xRt <= {dAXC,5'd5};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxx100000: xRt <= {dAXC,5'd6};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxx100000: xRt <= {dAXC,5'd6};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxx1000000: xRt <= {dAXC,5'd7};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxx1000000: xRt <= {dAXC,5'd7};
|
31'bxxxxxxxxxxxxxxxxxxxxxxx10000000: xRt <= {dAXC,5'd8};
|
31'bxxxxxxxxxxxxxxxxxxxxxxx10000000: xRt <= {dAXC,5'd8};
|
31'bxxxxxxxxxxxxxxxxxxxxxx100000000: xRt <= {dAXC,5'd9};
|
31'bxxxxxxxxxxxxxxxxxxxxxx100000000: xRt <= {dAXC,5'd9};
|
31'bxxxxxxxxxxxxxxxxxxxxx1000000000: xRt <= {dAXC,5'd10};
|
31'bxxxxxxxxxxxxxxxxxxxxx1000000000: xRt <= {dAXC,5'd10};
|
31'bxxxxxxxxxxxxxxxxxxxx10000000000: xRt <= {dAXC,5'd11};
|
31'bxxxxxxxxxxxxxxxxxxxx10000000000: xRt <= {dAXC,5'd11};
|
31'bxxxxxxxxxxxxxxxxxxx100000000000: xRt <= {dAXC,5'd12};
|
31'bxxxxxxxxxxxxxxxxxxx100000000000: xRt <= {dAXC,5'd12};
|
31'bxxxxxxxxxxxxxxxxxx1000000000000: xRt <= {dAXC,5'd13};
|
31'bxxxxxxxxxxxxxxxxxx1000000000000: xRt <= {dAXC,5'd13};
|
31'bxxxxxxxxxxxxxxxxx10000000000000: xRt <= {dAXC,5'd14};
|
31'bxxxxxxxxxxxxxxxxx10000000000000: xRt <= {dAXC,5'd14};
|
31'bxxxxxxxxxxxxxxxx100000000000000: xRt <= {dAXC,5'd15};
|
31'bxxxxxxxxxxxxxxxx100000000000000: xRt <= {dAXC,5'd15};
|
31'bxxxxxxxxxxxxxxx1000000000000000: xRt <= {dAXC,5'd16};
|
31'bxxxxxxxxxxxxxxx1000000000000000: xRt <= {dAXC,5'd16};
|
31'bxxxxxxxxxxxxxx10000000000000000: xRt <= {dAXC,5'd17};
|
31'bxxxxxxxxxxxxxx10000000000000000: xRt <= {dAXC,5'd17};
|
31'bxxxxxxxxxxxxx100000000000000000: xRt <= {dAXC,5'd18};
|
31'bxxxxxxxxxxxxx100000000000000000: xRt <= {dAXC,5'd18};
|
31'bxxxxxxxxxxxx1000000000000000000: xRt <= {dAXC,5'd19};
|
31'bxxxxxxxxxxxx1000000000000000000: xRt <= {dAXC,5'd19};
|
31'bxxxxxxxxxxx10000000000000000000: xRt <= {dAXC,5'd20};
|
31'bxxxxxxxxxxx10000000000000000000: xRt <= {dAXC,5'd20};
|
31'bxxxxxxxxxx100000000000000000000: xRt <= {dAXC,5'd21};
|
31'bxxxxxxxxxx100000000000000000000: xRt <= {dAXC,5'd21};
|
31'bxxxxxxxxx1000000000000000000000: xRt <= {dAXC,5'd22};
|
31'bxxxxxxxxx1000000000000000000000: xRt <= {dAXC,5'd22};
|
31'bxxxxxxxx10000000000000000000000: xRt <= {dAXC,5'd23};
|
31'bxxxxxxxx10000000000000000000000: xRt <= {dAXC,5'd23};
|
31'bxxxxxxx100000000000000000000000: xRt <= {dAXC,5'd24};
|
31'bxxxxxxx100000000000000000000000: xRt <= {dAXC,5'd24};
|
31'bxxxxxx1000000000000000000000000: xRt <= {dAXC,5'd25};
|
31'bxxxxxx1000000000000000000000000: xRt <= {dAXC,5'd25};
|
31'bxxxxx10000000000000000000000000: xRt <= {dAXC,5'd26};
|
31'bxxxxx10000000000000000000000000: xRt <= {dAXC,5'd26};
|
31'bxxxx100000000000000000000000000: xRt <= {dAXC,5'd27};
|
31'bxxxx100000000000000000000000000: xRt <= {dAXC,5'd27};
|
31'bxxx1000000000000000000000000000: xRt <= {dAXC,5'd28};
|
31'bxxx1000000000000000000000000000: xRt <= {dAXC,5'd28};
|
31'bxx10000000000000000000000000000: xRt <= {dAXC,5'd29};
|
31'bxx10000000000000000000000000000: xRt <= {dAXC,5'd29};
|
31'bx100000000000000000000000000000: xRt <= {dAXC,5'd30};
|
31'bx100000000000000000000000000000: xRt <= {dAXC,5'd30};
|
31'b1000000000000000000000000000000: xRt <= {dAXC,5'd31};
|
31'b1000000000000000000000000000000: xRt <= {dAXC,5'd31};
|
default: xRt <= 9'h000;
|
default: xRt <= 9'h000;
|
endcase
|
endcase
|
|
|
default: xRt <= {dAXC,dIR[29:25]};
|
default: xRt <= {dAXC,dIR[29:25]};
|
endcase
|
endcase
|
if (dOpcode[6:4]==`IMM)
|
if (dOpcode[6:4]==`IMM)
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
|
|
// Set immediate value
|
// Set immediate value
|
if (xOpcode[6:4]==`IMM) begin
|
if (xOpcode[6:4]==`IMM) begin
|
imm <= {xIR[38:0],dIR[24:0]};
|
imm <= {xIR[38:0],dIR[24:0]};
|
end
|
end
|
else
|
else
|
case(dOpcode)
|
case(dOpcode)
|
`BTRI: imm <= {{44{dIR[19]}},dIR[19:0]};
|
`BTRI: imm <= {{44{dIR[19]}},dIR[19:0]};
|
`BEQI,`BNEI,`BLTI,`BLEI,`BGTI,`BGEI,`BLTUI,`BLEUI,`BGTUI,`BGEUI:
|
`BEQI,`BNEI,`BLTI,`BLEI,`BGTI,`BGEI,`BLTUI,`BLEUI,`BGTUI,`BGEUI:
|
imm <= {{46{dIR[17]}},dIR[17:0]};
|
imm <= {{46{dIR[17]}},dIR[17:0]};
|
`ORI: imm <= {39'h0000000000,dIR[24:0]};
|
`ORI: imm <= {39'h0000000000,dIR[24:0]};
|
`XORI: imm <= {39'h0000000000,dIR[24:0]};
|
`XORI: imm <= {39'h0000000000,dIR[24:0]};
|
`RET: imm <= {39'h00000000,dIR[24:3],3'b000};
|
`RET: imm <= {39'h00000000,dIR[24:3],3'b000};
|
`MEMNDX: imm <= {{50{dIR[19]}},dIR[19:6]};
|
`MEMNDX: imm <= {{50{dIR[19]}},dIR[19:6]};
|
default: imm <= {{39{dIR[24]}},dIR[24:0]};
|
default: imm <= {{39{dIR[24]}},dIR[24:0]};
|
endcase
|
endcase
|
|
|
if ((((dOpcode==`SM || dOpcode==`LM) && dIR[31:0]!=32'd0)) ||
|
if ((((dOpcode==`SM || dOpcode==`LM) && dIR[31:0]!=32'd0)) ||
|
((dOpcode==`SP || dOpcode==`LP || dOpcode==`SFP || dOpcode==`LFP || dOpcode==`SFDP || dOpcode==`LFDP) && !dIR[25]))
|
((dOpcode==`SP || dOpcode==`LP || dOpcode==`SFP || dOpcode==`LFP || dOpcode==`SFDP || dOpcode==`LFDP) && !dIR[25]))
|
dIR <= ndIR;
|
dIR <= ndIR;
|
end
|
end
|
|
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
// IFETCH:
|
// IFETCH:
|
// - check for external hardware interrupt
|
// - check for external hardware interrupt
|
// - fetch instruction
|
// - fetch instruction
|
// - increment PC
|
// - increment PC
|
// - set special register defaults for some instructions
|
// - set special register defaults for some instructions
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
if (advanceI) begin
|
if (advanceI) begin
|
dAXC <= AXC;
|
dAXC <= AXC;
|
dextype <= `EX_NON;
|
dextype <= `EX_NON;
|
if (nmi_edge & !StatusHWI & !im1) begin
|
if (nmi_edge & !StatusHWI & !im1) begin
|
$display("*****************");
|
$display("*****************");
|
$display("NMI edge detected");
|
$display("NMI edge detected");
|
$display("*****************");
|
$display("*****************");
|
StatusHWI <= 1'b1;
|
StatusHWI <= 1'b1;
|
nmi_edge <= 1'b0;
|
nmi_edge <= 1'b0;
|
dhwxtype <= 2'b01;
|
dhwxtype <= 2'b01;
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
dextype <= `EX_NMI;
|
dextype <= `EX_NMI;
|
end
|
end
|
else if (irq_i & !im & !StatusHWI & !im1) begin
|
else if (irq_i & !im & !StatusHWI & !im1) begin
|
$display("*****************");
|
$display("*****************");
|
$display("IRQ detected");
|
$display("IRQ detected");
|
$display("*****************");
|
$display("*****************");
|
bu_im <= 1'b0;
|
bu_im <= 1'b0;
|
im <= 1'b1;
|
im <= 1'b1;
|
StatusHWI <= 1'b1;
|
StatusHWI <= 1'b1;
|
dhwxtype <= 2'b10;
|
dhwxtype <= 2'b10;
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
dextype <= `EX_IRQ;
|
dextype <= `EX_IRQ;
|
end
|
end
|
// Are we filling the pipeline with NOP's as a result of a previous
|
// Are we filling the pipeline with NOP's as a result of a previous
|
// hardware interrupt ?
|
// hardware interrupt ?
|
else if (|dhwxtype|dFip) begin
|
else if (|dhwxtype|dFip) begin
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
end
|
end
|
`ifdef TLB
|
`ifdef TLB
|
else if (ITLBMiss)
|
else if (ITLBMiss)
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
`endif
|
`endif
|
else begin
|
else begin
|
if (((iOpcode==`SM || iOpcode==`LM) && insn[31:0]!=32'd0) ||
|
if (((iOpcode==`SM || iOpcode==`LM) && insn[31:0]!=32'd0) ||
|
((iOpcode==`LP || iOpcode==`SP || iOpcode==`SFP || iOpcode==`LFP || iOpcode==`SFDP || iOpcode==`LFDP) && !insn[25]))
|
((iOpcode==`LP || iOpcode==`SP || iOpcode==`SFP || iOpcode==`LFP || iOpcode==`SFDP || iOpcode==`LFDP) && !insn[25]))
|
im1 <= 1'b1;
|
im1 <= 1'b1;
|
else
|
else
|
im1 <= 1'b0;
|
im1 <= 1'b0;
|
if ((iOpcode==`SP || iOpcode==`LP || iOpcode==`SFP || iOpcode==`LFP || iOpcode==`SFDP || iOpcode==`LFDP) && insn[25]==1'b1) begin
|
if ((iOpcode==`SP || iOpcode==`LP || iOpcode==`SFP || iOpcode==`LFP || iOpcode==`SFDP || iOpcode==`LFDP) && insn[25]==1'b1) begin
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
pc <= fnIncPC(pc);
|
pc <= fnIncPC(pc);
|
end
|
end
|
else if ((iOpcode==`SM || iOpcode==`LM) && insn[31:0]==32'd0) begin
|
else if ((iOpcode==`SM || iOpcode==`LM) && insn[31:0]==32'd0) begin
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
pc <= fnIncPC(pc);
|
pc <= fnIncPC(pc);
|
end
|
end
|
else
|
else
|
dIR <= insn;
|
dIR <= insn;
|
`include "insn_dumpsc.v"
|
`include "insn_dumpsc.v"
|
end
|
end
|
nopI <= 1'b0;
|
nopI <= 1'b0;
|
if (dOpcode[6:4]!=`IMM) begin
|
if (dOpcode[6:4]!=`IMM) begin
|
dpc <= pc;
|
dpc <= pc;
|
dpcv <= 1'b1;
|
dpcv <= 1'b1;
|
end
|
end
|
dRb <= {AXC,insn[29:25]};
|
dRb <= {AXC,insn[29:25]};
|
dRc <= {AXC,insn[24:20]};
|
dRc <= {AXC,insn[24:20]};
|
casex(iOpcode)
|
casex(iOpcode)
|
`RET: begin
|
`RET: begin
|
dRa <= {AXC,5'd30};
|
dRa <= {AXC,5'd30};
|
dRb <= {AXC,5'd31};
|
dRb <= {AXC,5'd31};
|
end
|
end
|
`SETLO: dRa <= {AXC,insn[36:32]};
|
`SETLO: dRa <= {AXC,insn[36:32]};
|
`SETHI: dRa <= {AXC,insn[36:32]};
|
`SETHI: dRa <= {AXC,insn[36:32]};
|
`SM,`LM:
|
`SM,`LM:
|
begin
|
begin
|
dRa <= {AXC,1'b1,insn[34:31]};
|
dRa <= {AXC,1'b1,insn[34:31]};
|
casex(insn[30:0])
|
casex(insn[30:0])
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx1: dRb <= {AXC,5'd1};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx1: dRb <= {AXC,5'd1};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxxxxx10: dRb <= {AXC,5'd2};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxxxxx10: dRb <= {AXC,5'd2};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxxxx100: dRb <= {AXC,5'd3};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxxxx100: dRb <= {AXC,5'd3};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxxx1000: dRb <= {AXC,5'd4};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxxx1000: dRb <= {AXC,5'd4};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxx10000: dRb <= {AXC,5'd5};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxxx10000: dRb <= {AXC,5'd5};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxx100000: dRb <= {AXC,5'd6};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxxx100000: dRb <= {AXC,5'd6};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxx1000000: dRb <= {AXC,5'd7};
|
31'bxxxxxxxxxxxxxxxxxxxxxxxx1000000: dRb <= {AXC,5'd7};
|
31'bxxxxxxxxxxxxxxxxxxxxxxx10000000: dRb <= {AXC,5'd8};
|
31'bxxxxxxxxxxxxxxxxxxxxxxx10000000: dRb <= {AXC,5'd8};
|
31'bxxxxxxxxxxxxxxxxxxxxxx100000000: dRb <= {AXC,5'd9};
|
31'bxxxxxxxxxxxxxxxxxxxxxx100000000: dRb <= {AXC,5'd9};
|
31'bxxxxxxxxxxxxxxxxxxxxx1000000000: dRb <= {AXC,5'd10};
|
31'bxxxxxxxxxxxxxxxxxxxxx1000000000: dRb <= {AXC,5'd10};
|
31'bxxxxxxxxxxxxxxxxxxxx10000000000: dRb <= {AXC,5'd11};
|
31'bxxxxxxxxxxxxxxxxxxxx10000000000: dRb <= {AXC,5'd11};
|
31'bxxxxxxxxxxxxxxxxxxx100000000000: dRb <= {AXC,5'd12};
|
31'bxxxxxxxxxxxxxxxxxxx100000000000: dRb <= {AXC,5'd12};
|
31'bxxxxxxxxxxxxxxxxxx1000000000000: dRb <= {AXC,5'd13};
|
31'bxxxxxxxxxxxxxxxxxx1000000000000: dRb <= {AXC,5'd13};
|
31'bxxxxxxxxxxxxxxxxx10000000000000: dRb <= {AXC,5'd14};
|
31'bxxxxxxxxxxxxxxxxx10000000000000: dRb <= {AXC,5'd14};
|
31'bxxxxxxxxxxxxxxxx100000000000000: dRb <= {AXC,5'd15};
|
31'bxxxxxxxxxxxxxxxx100000000000000: dRb <= {AXC,5'd15};
|
31'bxxxxxxxxxxxxxxx1000000000000000: dRb <= {AXC,5'd16};
|
31'bxxxxxxxxxxxxxxx1000000000000000: dRb <= {AXC,5'd16};
|
31'bxxxxxxxxxxxxxx10000000000000000: dRb <= {AXC,5'd17};
|
31'bxxxxxxxxxxxxxx10000000000000000: dRb <= {AXC,5'd17};
|
31'bxxxxxxxxxxxxx100000000000000000: dRb <= {AXC,5'd18};
|
31'bxxxxxxxxxxxxx100000000000000000: dRb <= {AXC,5'd18};
|
31'bxxxxxxxxxxxx1000000000000000000: dRb <= {AXC,5'd19};
|
31'bxxxxxxxxxxxx1000000000000000000: dRb <= {AXC,5'd19};
|
31'bxxxxxxxxxxx10000000000000000000: dRb <= {AXC,5'd20};
|
31'bxxxxxxxxxxx10000000000000000000: dRb <= {AXC,5'd20};
|
31'bxxxxxxxxxx100000000000000000000: dRb <= {AXC,5'd21};
|
31'bxxxxxxxxxx100000000000000000000: dRb <= {AXC,5'd21};
|
31'bxxxxxxxxx1000000000000000000000: dRb <= {AXC,5'd22};
|
31'bxxxxxxxxx1000000000000000000000: dRb <= {AXC,5'd22};
|
31'bxxxxxxxx10000000000000000000000: dRb <= {AXC,5'd23};
|
31'bxxxxxxxx10000000000000000000000: dRb <= {AXC,5'd23};
|
31'bxxxxxxx100000000000000000000000: dRb <= {AXC,5'd24};
|
31'bxxxxxxx100000000000000000000000: dRb <= {AXC,5'd24};
|
31'bxxxxxx1000000000000000000000000: dRb <= {AXC,5'd25};
|
31'bxxxxxx1000000000000000000000000: dRb <= {AXC,5'd25};
|
31'bxxxxx10000000000000000000000000: dRb <= {AXC,5'd26};
|
31'bxxxxx10000000000000000000000000: dRb <= {AXC,5'd26};
|
31'bxxxx100000000000000000000000000: dRb <= {AXC,5'd27};
|
31'bxxxx100000000000000000000000000: dRb <= {AXC,5'd27};
|
31'bxxx1000000000000000000000000000: dRb <= {AXC,5'd28};
|
31'bxxx1000000000000000000000000000: dRb <= {AXC,5'd28};
|
31'bxx10000000000000000000000000000: dRb <= {AXC,5'd29};
|
31'bxx10000000000000000000000000000: dRb <= {AXC,5'd29};
|
31'bx100000000000000000000000000000: dRb <= {AXC,5'd30};
|
31'bx100000000000000000000000000000: dRb <= {AXC,5'd30};
|
31'b1000000000000000000000000000000: dRb <= {AXC,5'd31};
|
31'b1000000000000000000000000000000: dRb <= {AXC,5'd31};
|
default: dRb <= {AXC,5'd0};
|
default: dRb <= {AXC,5'd0};
|
endcase
|
endcase
|
end
|
end
|
default: dRa <= {AXC,insn[34:30]};
|
default: dRa <= {AXC,insn[34:30]};
|
endcase
|
endcase
|
`ifdef TLB
|
`ifdef TLB
|
if (ITLBMiss) begin
|
if (ITLBMiss) begin
|
$display("TLB miss on instruction fetch.");
|
$display("TLB miss on instruction fetch.");
|
CauseCode <= `EX_TLBI;
|
CauseCode <= `EX_TLBI;
|
StatusEXL <= 1'b1;
|
StatusEXL <= 1'b1;
|
BadVAddr <= pc[63:13];
|
BadVAddr <= pc[63:13];
|
pc <= `ITLB_MissHandler;
|
pc <= `ITLB_MissHandler;
|
EPC <= pc;
|
EPC <= pc;
|
end
|
end
|
else
|
else
|
`endif
|
`endif
|
begin
|
begin
|
dbranch_taken <= 1'b0;
|
dbranch_taken <= 1'b0;
|
if ((iOpcode==`SP || iOpcode==`LP || iOpcode==`SFP || iOpcode==`LFP || iOpcode==`SFDP || iOpcode==`LFDP) && !insn[25])
|
if ((iOpcode==`SP || iOpcode==`LP || iOpcode==`SFP || iOpcode==`LFP || iOpcode==`SFDP || iOpcode==`LFDP) && !insn[25])
|
;
|
;
|
else if ((iOpcode==`LM || iOpcode==`SM) && insn[31:0]!=32'd0)
|
else if ((iOpcode==`LM || iOpcode==`SM) && insn[31:0]!=32'd0)
|
;
|
;
|
else begin
|
else begin
|
if (pc!=64'd3)
|
if (pc!=64'hC)
|
pc <= fnIncPC(pc);
|
pc <= fnIncPC(pc);
|
end
|
end
|
case(iOpcode)
|
case(iOpcode)
|
`MISC:
|
`MISC:
|
case(iFunc)
|
case(iFunc)
|
`FIP: dFip <= 1'b1;
|
`FIP: dFip <= 1'b1;
|
default: ;
|
default: ;
|
endcase
|
endcase
|
// We predict the return address by storing it in a return address stack
|
// We predict the return address by storing it in a return address stack
|
// during a call instruction, then popping it off the stack in a return
|
// during a call instruction, then popping it off the stack in a return
|
// instruction. The prediction will not always be correct, if it's wrong
|
// instruction. The prediction will not always be correct, if it's wrong
|
// it's corrected by the EX stage branching to the right address.
|
// it's corrected by the EX stage branching to the right address.
|
`CALL:
|
`CALL:
|
begin
|
begin
|
`ifdef RAS_PREDICTION
|
`ifdef RAS_PREDICTION
|
ras[ras_sp] <= fnIncPC(pc);
|
ras[ras_sp] <= fnIncPC(pc);
|
ras_sp <= ras_sp - 6'd1;
|
ras_sp <= ras_sp - 6'd1;
|
`endif
|
`endif
|
dbranch_taken <= 1'b1;
|
dbranch_taken <= 1'b1;
|
pc <= jmp_tgt;
|
pc <= jmp_tgt;
|
end
|
end
|
`RET:
|
`RET:
|
begin
|
begin
|
`ifdef RAS_PREDICTION
|
`ifdef RAS_PREDICTION
|
// $display("predicted return address=%h.%h",{ras[ras_sp + 6'd1][63:4],4'b0000},ras[ras_sp + 6'd1][3:2]);
|
// $display("predicted return address=%h.%h",{ras[ras_sp + 6'd1][63:4],4'b0000},ras[ras_sp + 6'd1][3:2]);
|
pc <= ras[ras_sp + 6'd1];
|
pc <= ras[ras_sp + 6'd1];
|
ras_sp <= ras_sp + 6'd1;
|
ras_sp <= ras_sp + 6'd1;
|
`endif
|
`endif
|
end
|
end
|
`JMP:
|
`JMP:
|
begin
|
begin
|
dbranch_taken <= 1'b1;
|
dbranch_taken <= 1'b1;
|
pc <= jmp_tgt;
|
pc <= jmp_tgt;
|
end
|
end
|
`BTRR:
|
`BTRR:
|
case(insn[4:0])
|
case(insn[4:0])
|
`BEQ,`BNE,`BLT,`BLE,`BGT,`BGE,`BLTU,`BLEU,`BGTU,`BGEU,`BAND,`BOR,`BRA,`BNR,`BRN,`LOOP:
|
`BEQ,`BNE,`BLT,`BLE,`BGT,`BGE,`BLTU,`BLEU,`BGTU,`BGEU,`BAND,`BOR,`BRA,`BNR,`BRN,`LOOP:
|
if (predict_taken) begin
|
if (predict_taken) begin
|
// $display("Taking predicted branch: %h",{pc[63:4] + {{42{insn[24]}},insn[24:7]},insn[6:5],2'b00});
|
// $display("Taking predicted branch: %h",{pc[63:4] + {{42{insn[24]}},insn[24:7]},insn[6:5],2'b00});
|
dbranch_taken <= 1'b1;
|
dbranch_taken <= 1'b1;
|
pc <= {pc[63:4] + {{42{insn[24]}},insn[24:7]},insn[6:5],2'b00};
|
pc <= {pc[63:4] + {{42{insn[24]}},insn[24:7]},insn[6:5],2'b00};
|
end
|
end
|
default: ;
|
default: ;
|
endcase
|
endcase
|
`ifdef BTB
|
`ifdef BTB
|
`BTRI:
|
`BTRI:
|
if (predict_taken) begin
|
if (predict_taken) begin
|
dbranch_taken <= 1'b1;
|
dbranch_taken <= 1'b1;
|
pc <= btb[pc[7:2]];
|
pc <= btb[pc[7:2]];
|
end
|
end
|
`endif
|
`endif
|
`BEQI,`BNEI,`BLTI,`BLEI,`BGTI,`BGEI,`BLTUI,`BLEUI,`BGTUI,`BGEUI:
|
`BEQI,`BNEI,`BLTI,`BLEI,`BGTI,`BGEI,`BLTUI,`BLEUI,`BGTUI,`BGEUI:
|
begin
|
begin
|
if (predict_taken) begin
|
if (predict_taken) begin
|
dbranch_taken <= 1'b1;
|
dbranch_taken <= 1'b1;
|
pc <= {pc[63:4] + {{50{insn[29]}},insn[29:20]},insn[19:18],2'b00};
|
pc <= {pc[63:4] + {{50{insn[29]}},insn[29:20]},insn[19:18],2'b00};
|
end
|
end
|
end
|
end
|
default: ;
|
default: ;
|
endcase
|
endcase
|
end
|
end
|
end
|
end
|
|
|
//`include "RPSTAGE.v"
|
//`include "RPSTAGE.v"
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
// EXECUTE (EX')- part two:
|
// EXECUTE (EX')- part two:
|
// - override the default program counter increment for
|
// - override the default program counter increment for
|
// control flow instructions
|
// control flow instructions
|
// - NOP out the instructions following a branch in the
|
// - NOP out the instructions following a branch in the
|
// pipeline
|
// pipeline
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
if (advanceX) begin
|
if (advanceX) begin
|
case(xOpcode)
|
case(xOpcode)
|
`MISC:
|
`MISC:
|
case(xFunc)
|
case(xFunc)
|
`IRET:
|
`IRET:
|
if (StatusHWI) begin
|
if (StatusHWI) begin
|
StatusHWI <= 1'b0;
|
StatusHWI <= 1'b0;
|
im <= 1'b0;
|
im <= 1'b0;
|
pc <= IPC;
|
pc <= IPC;
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
`ERET:
|
`ERET:
|
if (StatusEXL) begin
|
if (StatusEXL) begin
|
StatusEXL <= 1'b0;
|
StatusEXL <= 1'b0;
|
pc <= EPC;
|
pc <= EPC;
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
`SYSJMP:
|
`SYSJMP:
|
begin
|
begin
|
StatusEXL <= 1'b1;
|
StatusEXL <= 1'b1;
|
pc <= 64'd3;
|
pc <= 64'hC;
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
`SYSCALL:
|
`SYSCALL:
|
begin
|
begin
|
StatusEXL <= 1'b1;
|
StatusEXL <= 1'b1;
|
EPC <= fnIncPC(xpc);
|
EPC <= fnIncPC(xpc);
|
pc <= 64'd3;
|
pc <= 64'hC;
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
default: ;
|
default: ;
|
endcase
|
endcase
|
`R:
|
`R:
|
case(xFunc)
|
case(xFunc)
|
`EXEC:
|
`EXEC:
|
begin
|
begin
|
pc <= fnIncPC(xpc);
|
pc <= fnIncPC(xpc);
|
dRa <= b[34:30];
|
dRa <= b[34:30];
|
dRb <= b[29:25];
|
dRb <= b[29:25];
|
dRc <= b[24:20];
|
dRc <= b[24:20];
|
dIR <= b;
|
dIR <= b;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
default: ;
|
default: ;
|
endcase
|
endcase
|
`BTRR:
|
`BTRR:
|
case(xFunc5)
|
case(xFunc5)
|
// BEQ r1,r2,label
|
// BEQ r1,r2,label
|
`BEQ,`BNE,`BLT,`BLE,`BGT,`BGE,`BLTU,`BLEU,`BGTU,`BGEU,`BAND,`BOR,`BNR,`LOOP,`BRA,`BRN:
|
`BEQ,`BNE,`BLT,`BLE,`BGT,`BGE,`BLTU,`BLEU,`BGTU,`BGEU,`BAND,`BOR,`BNR,`LOOP,`BRA,`BRN:
|
if (!takb & xbranch_taken) begin
|
if (!takb & xbranch_taken) begin
|
$display("Taking mispredicted branch %h",fnIncPC(xpc));
|
$display("Taking mispredicted branch %h",fnIncPC(xpc));
|
pc <= fnIncPC(xpc);
|
pc <= fnIncPC(xpc);
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
else if (takb & !xbranch_taken) begin
|
else if (takb & !xbranch_taken) begin
|
$display("Taking branch %h.%h",{xpc[63:4] + {{42{xIR[24]}},xIR[24:7]},4'b0000},xIR[6:5]);
|
$display("Taking branch %h.%h",{xpc[63:4] + {{42{xIR[24]}},xIR[24:7]},4'b0000},xIR[6:5]);
|
pc[63:4] <= xpc[63:4] + {{42{xIR[24]}},xIR[24:7]};
|
pc[63:4] <= xpc[63:4] + {{42{xIR[24]}},xIR[24:7]};
|
pc[3:2] <= xIR[6:5];
|
pc[3:2] <= xIR[6:5];
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
// BEQ r1,r2,r10
|
// BEQ r1,r2,r10
|
`BEQR,`BNER,`BLTR,`BLER,`BGTR,`BGER,`BLTUR,`BLEUR,`BGTUR,`BGEUR://,`BANDR,`BORR,`BNRR:
|
`BEQR,`BNER,`BLTR,`BLER,`BGTR,`BGER,`BLTUR,`BLEUR,`BGTUR,`BGEUR://,`BANDR,`BORR,`BNRR:
|
if (takb) begin
|
if (takb) begin
|
pc[63:2] <= c[63:2];
|
pc[63:2] <= c[63:2];
|
pc[1:0] <= 2'b00;
|
pc[1:0] <= 2'b00;
|
`ifdef BTB
|
`ifdef BTB
|
btb[xpc[7:2]] <= c;
|
btb[xpc[7:2]] <= c;
|
`endif
|
`endif
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
default: ;
|
default: ;
|
endcase
|
endcase
|
// JMP and CALL change the program counter immediately in the IF stage.
|
// JMP and CALL change the program counter immediately in the IF stage.
|
// There's no work to do here. The pipeline does not need to be cleared.
|
// There's no work to do here. The pipeline does not need to be cleared.
|
`JMP: ;
|
`JMP: ;
|
`CALL: ;
|
`CALL: ;
|
`JAL:
|
`JAL:
|
begin
|
begin
|
pc[63:2] <= a[63:2] + imm[63:2];
|
pc[63:2] <= a[63:2] + imm[63:2];
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
|
|
// Check the pc of the instruction after the RET instruction (the dpc), to
|
// Check the pc of the instruction after the RET instruction (the dpc), to
|
// see if it's equal to the RET target. If it's the same as the target then
|
// see if it's equal to the RET target. If it's the same as the target then
|
// we predicted the RET return correctly, so there's nothing to do. Otherwise
|
// we predicted the RET return correctly, so there's nothing to do. Otherwise
|
// we need to branch to the RET location.
|
// we need to branch to the RET location.
|
`RET:
|
`RET:
|
`ifdef RAS_PREDICTION
|
`ifdef RAS_PREDICTION
|
if (dpc[63:2]!=b[63:2]) begin
|
if (dpc[63:2]!=b[63:2]) begin
|
`else
|
`else
|
begin
|
begin
|
`endif
|
`endif
|
// $display("returning to: %h.%h", {b[63:4],4'b0},b[3:2]);
|
// $display("returning to: %h.%h", {b[63:4],4'b0},b[3:2]);
|
pc[63:2] <= b[63:2];
|
pc[63:2] <= b[63:2];
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
// else
|
// else
|
// $display("RET address %h predicted correctly.", {b[63:4],4'b0},b[3:2]);
|
// $display("RET address %h predicted correctly.", {b[63:4],4'b0},b[3:2]);
|
// BEQ r1,#3,r10
|
// BEQ r1,#3,r10
|
`BTRI:
|
`BTRI:
|
`ifdef BTB
|
`ifdef BTB
|
if (takb) begin
|
if (takb) begin
|
if ((xbranch_taken && b!=btb[xpc[7:2]]) || // took branch, but not to right target
|
if ((xbranch_taken && b!=btb[xpc[7:2]]) || // took branch, but not to right target
|
!xbranch_taken) begin // didn't take branch, and were supposed to
|
!xbranch_taken) begin // didn't take branch, and were supposed to
|
pc[63:2] <= b[63:2];
|
pc[63:2] <= b[63:2];
|
pc[1:0] <= 2'b00;
|
pc[1:0] <= 2'b00;
|
btb[xpc[7:2]] <= b;
|
btb[xpc[7:2]] <= b;
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
end
|
end
|
else if (xbranch_taken) begin // took the branch, and weren't supposed to
|
else if (xbranch_taken) begin // took the branch, and weren't supposed to
|
pc <= fnIncPC(xpc);
|
pc <= fnIncPC(xpc);
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
`else
|
`else
|
if (takb) begin
|
if (takb) begin
|
pc[63:2] <= b[63:2];
|
pc[63:2] <= b[63:2];
|
pc[1:0] <= 2'b00;
|
pc[1:0] <= 2'b00;
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
`endif
|
`endif
|
// BEQI r1,#3,label
|
// BEQI r1,#3,label
|
`BEQI,`BNEI,`BLTI,`BLEI,`BGTI,`BGEI,`BLTUI,`BLEUI,`BGTUI,`BGEUI:
|
`BEQI,`BNEI,`BLTI,`BLEI,`BGTI,`BGEI,`BLTUI,`BLEUI,`BGTUI,`BGEUI:
|
if (takb) begin
|
if (takb) begin
|
if (!xbranch_taken) begin
|
if (!xbranch_taken) begin
|
pc[63:4] <= xpc[63:4] + {{50{xIR[29]}},xIR[29:20]};
|
pc[63:4] <= xpc[63:4] + {{50{xIR[29]}},xIR[29:20]};
|
pc[3:2] <= xIR[19:18];
|
pc[3:2] <= xIR[19:18];
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
end
|
end
|
else begin
|
else begin
|
if (xbranch_taken) begin
|
if (xbranch_taken) begin
|
$display("Taking mispredicted branch %h",fnIncPC(xpc));
|
$display("Taking mispredicted branch %h",fnIncPC(xpc));
|
pc <= fnIncPC(xpc);
|
pc <= fnIncPC(xpc);
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
end
|
end
|
`TRAPcc,`TRAPcci:
|
`TRAPcc,`TRAPcci:
|
if (takb) begin
|
if (takb) begin
|
StatusEXL <= 1'b1;
|
StatusEXL <= 1'b1;
|
CauseCode <= `EX_TRAP;
|
CauseCode <= `EX_TRAP;
|
xextype <= `EX_TRAP;
|
xextype <= `EX_TRAP;
|
pc <= 64'd3;
|
pc <= 64'hC;
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
default: ;
|
default: ;
|
endcase
|
endcase
|
|
|
if (dbz_error) begin
|
if (dbz_error) begin
|
$display("Divide by zero error");
|
$display("Divide by zero error");
|
CauseCode <= `EX_DBZ;
|
CauseCode <= `EX_DBZ;
|
xextype <= `EX_DBZ;
|
xextype <= `EX_DBZ;
|
StatusEXL <= 1'b1;
|
StatusEXL <= 1'b1;
|
pc <= 64'd3;
|
pc <= 64'hC;
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
else if (ovr_error) begin
|
else if (ovr_error) begin
|
$display("Overflow error");
|
$display("Overflow error");
|
CauseCode <= `EX_OFL;
|
CauseCode <= `EX_OFL;
|
xextype <= `EX_OFL;
|
xextype <= `EX_OFL;
|
StatusEXL <= 1'b1;
|
StatusEXL <= 1'b1;
|
pc <= 64'd3;
|
pc <= 64'hC;
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
else if (priv_violation) begin
|
else if (priv_violation) begin
|
$display("Priviledge violation");
|
$display("Priviledge violation");
|
CauseCode <= `EX_PRIV;
|
CauseCode <= `EX_PRIV;
|
xextype <= `EX_PRIV;
|
xextype <= `EX_PRIV;
|
StatusEXL <= 1'b1;
|
StatusEXL <= 1'b1;
|
pc <= 64'd3;
|
pc <= 64'hC;
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
end
|
end
|
|
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
// MEMORY1 (M1') - part two:
|
// MEMORY1 (M1') - part two:
|
// Check for a TLB miss.
|
// Check for a TLB miss.
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
`ifdef TLB
|
`ifdef TLB
|
if (advanceM1) begin
|
if (advanceM1) begin
|
if (m1IsLoad|m1IsStore) begin
|
if (m1IsLoad|m1IsStore) begin
|
if (DTLBMiss) begin
|
if (DTLBMiss) begin
|
$display("DTLB miss on address: %h",ea);
|
$display("DTLB miss on address: %h",ea);
|
m1extype <= `EX_TLBD;
|
m1extype <= `EX_TLBD;
|
CauseCode <= `EX_TLBD;
|
CauseCode <= `EX_TLBD;
|
StatusEXL <= 1'b1;
|
StatusEXL <= 1'b1;
|
BadVAddr <= ea[63:13];
|
BadVAddr <= ea[63:13];
|
EPC <= m1pc;
|
EPC <= m1pc;
|
pc <= `DTLB_MissHandler;
|
pc <= `DTLB_MissHandler;
|
m1Opcode <= `NOPI;
|
m1Opcode <= `NOPI;
|
m1Rt <= 9'd0;
|
m1Rt <= 9'd0;
|
xIR <= `NOP_INSN;
|
xIR <= `NOP_INSN;
|
xRt <= 9'd0;
|
xRt <= 9'd0;
|
dIR <= `NOP_INSN;
|
dIR <= `NOP_INSN;
|
m1pcv <= 1'b0;
|
m1pcv <= 1'b0;
|
xpcv <= 1'b0;
|
xpcv <= 1'b0;
|
dpcv <= 1'b0;
|
dpcv <= 1'b0;
|
end
|
end
|
end
|
end
|
end
|
end
|
`endif
|
`endif
|
|
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
// MEMORY2 (M2')
|
// MEMORY2 (M2')
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
if (advanceM2) begin
|
if (advanceM2) begin
|
end
|
end
|
|
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
// WRITEBACK (WB') - part two:
|
// WRITEBACK (WB') - part two:
|
// - vector to exception handler address
|
// - vector to exception handler address
|
// In the case of a hardware interrupt (NMI/IRQ) we know
|
// In the case of a hardware interrupt (NMI/IRQ) we know
|
// the pipeline following the interrupt is filled with
|
// the pipeline following the interrupt is filled with
|
// NOP instructions. This means there is no need to
|
// NOP instructions. This means there is no need to
|
// invalidate the pipeline.
|
// invalidate the pipeline.
|
// Also, we have to wait until the WB stage before
|
// Also, we have to wait until the WB stage before
|
// vectoring so that the pc setting doesn't get trashed
|
// vectoring so that the pc setting doesn't get trashed
|
// by a branch or other exception.
|
// by a branch or other exception.
|
// Tricky because we have to find the first valid
|
// Tricky because we have to find the first valid
|
// PC to record in the IPC register. The interrupt might
|
// PC to record in the IPC register. The interrupt might
|
// have occurred in a branch shadow, in which case the
|
// have occurred in a branch shadow, in which case the
|
// current PC isn't valid.
|
// current PC isn't valid.
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
if (advanceW) begin
|
if (advanceW) begin
|
case(wextype)
|
case(wextype)
|
`EX_NON: ;
|
`EX_NON: ;
|
`EX_RST:
|
`EX_RST:
|
begin
|
begin
|
pc <= `RESET_VECTOR;
|
pc <= `RESET_VECTOR;
|
end
|
end
|
`EX_NMI,`EX_IRQ,`EX_DBERR:
|
`EX_NMI,`EX_IRQ,`EX_DBERR:
|
begin
|
begin
|
$display("Stuffing SYSJMP");
|
$display("Stuffing SYSJMP");
|
xIR <= {`MISC,19'd0,wextype,`SYSJMP};
|
xIR <= {`MISC,19'd0,wextype,`SYSJMP};
|
pc <= 64'd3;
|
pc <= 64'hC;
|
case(1'b1)
|
case(1'b1)
|
wpcv: IPC <= wpc;
|
wpcv: IPC <= wpc;
|
m2pcv: IPC <= m2pc;
|
m2pcv: IPC <= m2pc;
|
m1pcv: IPC <= m1pc;
|
m1pcv: IPC <= m1pc;
|
xpcv: IPC <= xpc;
|
xpcv: IPC <= xpc;
|
dpcv: IPC <= dpc;
|
dpcv: IPC <= dpc;
|
default: IPC <= pc;
|
default: IPC <= pc;
|
endcase
|
endcase
|
end
|
end
|
`EX_OFL,`EX_DBZ,`EX_PRIV,`EX_TRAP:
|
`EX_OFL,`EX_DBZ,`EX_PRIV,`EX_TRAP:
|
begin
|
begin
|
xIR <= {`MISC,19'd0,wextype,`SYSJMP};
|
xIR <= {`MISC,19'd0,wextype,`SYSJMP};
|
pc <= 64'd3;
|
pc <= 64'hC;
|
EPC <= fnIncPC(wpc);
|
EPC <= fnIncPC(wpc);
|
end
|
end
|
default:
|
default:
|
begin
|
begin
|
xIR <= {`MISC,19'd0,wextype,`SYSJMP};
|
xIR <= {`MISC,19'd0,wextype,`SYSJMP};
|
pc <= 64'd3;
|
pc <= 64'hC;
|
EPC <= fnIncPC(wpc);
|
EPC <= fnIncPC(wpc);
|
end
|
end
|
endcase
|
endcase
|
if (wLdPC) begin
|
if (wLdPC) begin
|
$display("Loading PC");
|
$display("Loading PC");
|
pc <= wData;
|
pc <= wData;
|
end
|
end
|
end
|
end
|
|
|
|
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
// Trailer (TR')
|
// Trailer (TR')
|
// - no exceptions
|
// - no exceptions
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
if (advanceT) begin
|
if (advanceT) begin
|
end
|
end
|
|
|
|
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
// Cache loader
|
// Cache loader
|
//---------------------------------------------------------
|
//---------------------------------------------------------
|
if (rst_i) begin
|
if (rst_i) begin
|
cstate <= IDLE;
|
cstate <= IDLE;
|
end
|
end
|
else begin
|
else begin
|
case(cstate)
|
case(cstate)
|
IDLE:
|
IDLE:
|
if (triggerDCacheLoad) begin
|
if (triggerDCacheLoad) begin
|
dcaccess <= 1'b1;
|
dcaccess <= 1'b1;
|
bte_o <= 2'b00; // linear burst
|
bte_o <= 2'b00; // linear burst
|
cti_o <= 3'b010; // burst access
|
cti_o <= 3'b010; // burst access
|
bl_o <= 5'd7;
|
bl_o <= 5'd7;
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
adr_o <= {pea[63:6],6'h00};
|
adr_o <= {pea[63:6],6'h00};
|
cstate <= DCACT;
|
cstate <= DCACT;
|
end
|
end
|
else if (triggerICacheLoad) begin
|
else if (triggerICacheLoad) begin
|
icaccess <= 1'b1;
|
icaccess <= 1'b1;
|
bte_o <= 2'b00; // linear burst
|
bte_o <= 2'b00; // linear burst
|
cti_o <= 3'b010; // burst access
|
cti_o <= 3'b010; // burst access
|
cyc_o <= 1'b1;
|
cyc_o <= 1'b1;
|
stb_o <= 1'b1;
|
stb_o <= 1'b1;
|
if (ICacheAct) begin
|
if (ICacheAct) begin
|
bl_o <= 5'd7;
|
bl_o <= 5'd7;
|
adr_o <= {ppc[63:6],6'h00};
|
adr_o <= {ppc[63:6],6'h00};
|
cstate <= ICACT1;
|
cstate <= ICACT1;
|
end
|
end
|
else begin
|
else begin
|
bl_o <= 5'd1;
|
bl_o <= 5'd1;
|
adr_o <= {ppc[63:4],4'b0000};
|
adr_o <= {ppc[63:4],4'b0000};
|
cstate <= ICACT2;
|
cstate <= ICACT2;
|
end
|
end
|
end
|
end
|
// WISHBONE burst accesses
|
// WISHBONE burst accesses
|
//
|
//
|
ICACT1:
|
ICACT1:
|
if (ack_i|err_i) begin
|
if (ack_i|err_i) begin
|
adr_o[5:3] <= adr_o[5:3] + 3'd1;
|
adr_o[5:3] <= adr_o[5:3] + 3'd1;
|
if (adr_o[5:3]==3'd6)
|
if (adr_o[5:3]==3'd6)
|
cti_o <= 3'b111; // Last cycle ahead
|
cti_o <= 3'b111; // Last cycle ahead
|
else if (adr_o[5:3]==3'd7) begin
|
else if (adr_o[5:3]==3'd7) begin
|
cti_o <= 3'b000; // back to non-burst mode
|
cti_o <= 3'b000; // back to non-burst mode
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
tmem[adr_o[12:6]] <= {1'b1,adr_o[63:13]}; // This will cause ihit to go high
|
tmem[adr_o[12:6]] <= {1'b1,adr_o[63:13]}; // This will cause ihit to go high
|
tvalid[adr_o[12:6]] <= 1'b1;
|
tvalid[adr_o[12:6]] <= 1'b1;
|
icaccess <= 1'b0;
|
icaccess <= 1'b0;
|
cstate <= IDLE;
|
cstate <= IDLE;
|
end
|
end
|
end
|
end
|
//SYSCALL 509: 00_00000000_00000000_00000000_11111110_10010111
|
//SYSCALL 509: 00_00000000_00000000_00000000_11111110_10010111
|
ICACT2:
|
ICACT2:
|
if (ack_i|err_i) begin
|
if (ack_i|err_i) begin
|
adr_o <= adr_o + 64'd8;
|
adr_o <= adr_o + 64'd8;
|
if (adr_o[3]==1'b0) begin
|
if (adr_o[3]==1'b0) begin
|
cti_o <= 3'b111; // Last cycle ahead
|
cti_o <= 3'b111; // Last cycle ahead
|
tmpbuf <= err_i ? bevect[63:0] : dat_i;
|
tmpbuf <= err_i ? bevect[63:0] : dat_i;
|
end
|
end
|
else begin
|
else begin
|
if (tick[0]) begin
|
if (tick[0]) begin
|
insnbuf0 <= {err_i ? bevect[127:64] : dat_i,tmpbuf};
|
insnbuf0 <= {err_i ? bevect[127:64] : dat_i,tmpbuf};
|
ibuftag0 <= adr_o[63:4];
|
ibuftag0 <= adr_o[63:4];
|
end
|
end
|
else begin
|
else begin
|
insnbuf1 <= {err_i ? bevect[127:64] : dat_i,tmpbuf};
|
insnbuf1 <= {err_i ? bevect[127:64] : dat_i,tmpbuf};
|
ibuftag1 <= adr_o[63:4];
|
ibuftag1 <= adr_o[63:4];
|
end
|
end
|
cti_o <= 3'b000; // back to non-burst mode
|
cti_o <= 3'b000; // back to non-burst mode
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
icaccess <= 1'b0;
|
icaccess <= 1'b0;
|
cstate <= IDLE;
|
cstate <= IDLE;
|
end
|
end
|
end
|
end
|
|
|
DCACT:
|
DCACT:
|
if (ack_i|err_i) begin
|
if (ack_i|err_i) begin
|
adr_o[5:3] <= adr_o[5:3] + 3'd1;
|
adr_o[5:3] <= adr_o[5:3] + 3'd1;
|
if (adr_o[5:3]==3'h6)
|
if (adr_o[5:3]==3'h6)
|
cti_o <= 3'b111; // Last cycle ahead
|
cti_o <= 3'b111; // Last cycle ahead
|
if (adr_o[5:3]==3'h7) begin
|
if (adr_o[5:3]==3'h7) begin
|
cti_o <= 3'b000; // back to non-burst mode
|
cti_o <= 3'b000; // back to non-burst mode
|
cyc_o <= 1'b0;
|
cyc_o <= 1'b0;
|
stb_o <= 1'b0;
|
stb_o <= 1'b0;
|
dcaccess <= 1'b0;
|
dcaccess <= 1'b0;
|
cstate <= IDLE;
|
cstate <= IDLE;
|
end
|
end
|
end
|
end
|
|
|
endcase
|
endcase
|
end
|
end
|
|
|
end
|
end
|
|
|
endmodule
|
endmodule
|
|
|