Implement data0 inside of DM instead of core, so it gets correct reset. Add dummy tselect CSR.
This commit is contained in:
		
							parent
							
								
									ce5152a4f4
								
							
						
					
					
						commit
						5aca6be572
					
				| 
						 | 
				
			
			@ -66,9 +66,9 @@ module hazard3_dm #(
 | 
			
		|||
	input  wire [N_HARTS-1:0]        hart_running,
 | 
			
		||||
 | 
			
		||||
	// Hart access to data0 CSR (assumed to be core-internal but per-hart)
 | 
			
		||||
	input  wire [N_HARTS*XLEN-1:0]   hart_data0_rdata,
 | 
			
		||||
	output wire [N_HARTS*XLEN-1:0]   hart_data0_wdata,
 | 
			
		||||
	output wire [N_HARTS-1:0]        hart_data0_wen,
 | 
			
		||||
	output wire [N_HARTS*XLEN-1:0]   hart_data0_rdata,
 | 
			
		||||
	input  wire [N_HARTS*XLEN-1:0]   hart_data0_wdata,
 | 
			
		||||
	input  wire [N_HARTS-1:0]        hart_data0_wen,
 | 
			
		||||
 | 
			
		||||
	// Hart instruction injection
 | 
			
		||||
	output wire [N_HARTS*XLEN-1:0]   hart_instr_data,
 | 
			
		||||
| 
						 | 
				
			
			@ -237,8 +237,33 @@ assign hart_req_resume = dmcontrol_resumereq_sticky;
 | 
			
		|||
 | 
			
		||||
wire abstractcs_busy;
 | 
			
		||||
 | 
			
		||||
assign hart_data0_wdata = {N_HARTS{dmi_pwdata}};
 | 
			
		||||
assign hart_data0_wen = {{N_HARTS-1{1'b0}}, dmi_write && dmi_paddr == ADDR_DATA0 && !abstractcs_busy} << hartsel;
 | 
			
		||||
// The same data0 register is aliased as a CSR on all harts connected to this
 | 
			
		||||
// DM. Cores may read data0 as a CSR when in debug mode, and may write it when:
 | 
			
		||||
//
 | 
			
		||||
// - That core is in debug mode, and...
 | 
			
		||||
// - We are currently executing an abstract command on that core
 | 
			
		||||
//
 | 
			
		||||
// The DM can also read/write data0 at all times.
 | 
			
		||||
 | 
			
		||||
reg [XLEN-1:0] abstract_data0;
 | 
			
		||||
 | 
			
		||||
assign hart_data0_rdata = {N_HARTS{abstract_data0}};
 | 
			
		||||
 | 
			
		||||
always @ (posedge clk or negedge rst_n) begin: update_hart_data0
 | 
			
		||||
	integer i;
 | 
			
		||||
	if (!rst_n) begin
 | 
			
		||||
		abstract_data0 <= {XLEN{1'b0}};
 | 
			
		||||
	end else if (!dmactive) begin
 | 
			
		||||
		abstract_data0 <= {XLEN{1'b0}};
 | 
			
		||||
	end else if (dmi_write && dmi_paddr == ADDR_DATA0) begin
 | 
			
		||||
		abstract_data0 <= dmi_pwdata;
 | 
			
		||||
	end else begin
 | 
			
		||||
		for (i = 0; i < N_HARTS; i = i + 1) begin
 | 
			
		||||
			if (hartsel == i && hart_data0_wen[i] && hart_halted[i] && abstractcs_busy)
 | 
			
		||||
				abstract_data0 <= hart_data0_wdata[i * XLEN +: XLEN];
 | 
			
		||||
		end
 | 
			
		||||
	end
 | 
			
		||||
end
 | 
			
		||||
 | 
			
		||||
reg [XLEN-1:0] progbuf0;
 | 
			
		||||
reg [XLEN-1:0] progbuf1;
 | 
			
		||||
| 
						 | 
				
			
			@ -464,7 +489,7 @@ assign hart_instr_data = {N_HARTS{
 | 
			
		|||
 | 
			
		||||
always @ (*) begin
 | 
			
		||||
	case (dmi_paddr)
 | 
			
		||||
	ADDR_DATA0:        dmi_prdata = hart_data0_rdata[hartsel * XLEN +: XLEN];
 | 
			
		||||
	ADDR_DATA0:        dmi_prdata = abstract_data0;
 | 
			
		||||
	ADDR_DMCONTROL:    dmi_prdata = {
 | 
			
		||||
		dmcontrol_haltreq[hartsel],
 | 
			
		||||
		1'b0,                             // resumereq is a W1 field
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -60,9 +60,9 @@ module hazard3_core #(
 | 
			
		|||
	output wire              dbg_halted,
 | 
			
		||||
	output wire              dbg_running,
 | 
			
		||||
	// Debugger access to data0 CSR
 | 
			
		||||
	output wire [W_DATA-1:0] dbg_data0_rdata,
 | 
			
		||||
	input  wire [W_DATA-1:0] dbg_data0_wdata,
 | 
			
		||||
	input  wire              dbg_data0_wen,
 | 
			
		||||
	input  wire [W_DATA-1:0] dbg_data0_rdata,
 | 
			
		||||
	output wire [W_DATA-1:0] dbg_data0_wdata,
 | 
			
		||||
	output wire              dbg_data0_wen,
 | 
			
		||||
	// Debugger instruction injection
 | 
			
		||||
	input  wire [W_DATA-1:0] dbg_instr_data,
 | 
			
		||||
	input  wire              dbg_instr_data_vld,
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -50,9 +50,9 @@ module hazard3_cpu_1port #(
 | 
			
		|||
	output wire              dbg_halted,
 | 
			
		||||
	output wire              dbg_running,
 | 
			
		||||
	// Debugger access to data0 CSR
 | 
			
		||||
	output wire [W_DATA-1:0] dbg_data0_rdata,
 | 
			
		||||
	input  wire [W_DATA-1:0] dbg_data0_wdata,
 | 
			
		||||
	input  wire              dbg_data0_wen,
 | 
			
		||||
	input  wire [W_DATA-1:0] dbg_data0_rdata,
 | 
			
		||||
	output wire [W_DATA-1:0] dbg_data0_wdata,
 | 
			
		||||
	output wire              dbg_data0_wen,
 | 
			
		||||
	// Debugger instruction injection
 | 
			
		||||
	input  wire [W_DATA-1:0] dbg_instr_data,
 | 
			
		||||
	input  wire              dbg_instr_data_vld,
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -63,9 +63,9 @@ module hazard3_cpu_2port #(
 | 
			
		|||
	output wire              dbg_halted,
 | 
			
		||||
	output wire              dbg_running,
 | 
			
		||||
	// Debugger access to data0 CSR
 | 
			
		||||
	output wire [W_DATA-1:0] dbg_data0_rdata,
 | 
			
		||||
	input  wire [W_DATA-1:0] dbg_data0_wdata,
 | 
			
		||||
	input  wire              dbg_data0_wen,
 | 
			
		||||
	input  wire [W_DATA-1:0] dbg_data0_rdata,
 | 
			
		||||
	output wire [W_DATA-1:0] dbg_data0_wdata,
 | 
			
		||||
	output wire              dbg_data0_wen,
 | 
			
		||||
	// Debugger instruction injection
 | 
			
		||||
	input  wire [W_DATA-1:0] dbg_instr_data,
 | 
			
		||||
	input  wire              dbg_instr_data_vld,
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -43,9 +43,9 @@ module hazard3_csr #(
 | 
			
		|||
	output wire               dbg_instr_caught_exception,
 | 
			
		||||
	output wire               dbg_instr_caught_ebreak,
 | 
			
		||||
 | 
			
		||||
	output wire [W_DATA-1:0]  dbg_data0_rdata,
 | 
			
		||||
	input  wire [W_DATA-1:0]  dbg_data0_wdata,
 | 
			
		||||
	input  wire               dbg_data0_wen,
 | 
			
		||||
	input  wire [W_DATA-1:0]  dbg_data0_rdata,
 | 
			
		||||
	output wire [W_DATA-1:0]  dbg_data0_wdata,
 | 
			
		||||
	output wire               dbg_data0_wen,
 | 
			
		||||
 | 
			
		||||
	// Read port is combinatorial.
 | 
			
		||||
	// Write port is synchronous, and write effects will be observed on the next clock cycle.
 | 
			
		||||
| 
						 | 
				
			
			@ -239,6 +239,11 @@ localparam MEIE0          = 12'hbe0; // External interrupt enable register 0
 | 
			
		|||
localparam MEIP0          = 12'hfe0; // External interrupt pending register 0
 | 
			
		||||
localparam MLEI           = 12'hfe4; // Lowest external interrupt number
 | 
			
		||||
 | 
			
		||||
// ----------------------------------------------------------------------------
 | 
			
		||||
// Trigger Module
 | 
			
		||||
 | 
			
		||||
localparam TSELECT       = 12'h7a0;
 | 
			
		||||
 | 
			
		||||
// ----------------------------------------------------------------------------
 | 
			
		||||
// D-mode CSRs
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -548,21 +553,8 @@ always @ (posedge clk or negedge rst_n) begin
 | 
			
		|||
	end
 | 
			
		||||
end
 | 
			
		||||
 | 
			
		||||
reg [XLEN-1:0] data0;
 | 
			
		||||
 | 
			
		||||
always @ (posedge clk or negedge rst_n) begin
 | 
			
		||||
	if (!rst_n) begin
 | 
			
		||||
		data0 <= X0;
 | 
			
		||||
	end else if (DEBUG_SUPPORT) begin
 | 
			
		||||
		if (dbg_data0_wen)
 | 
			
		||||
			data0 <= dbg_data0_wdata;
 | 
			
		||||
		else if (debug_mode && wen && addr == DATA0)
 | 
			
		||||
			data0 <= update(data0);
 | 
			
		||||
	end
 | 
			
		||||
end
 | 
			
		||||
 | 
			
		||||
assign dbg_data0_rdata = data0;
 | 
			
		||||
 | 
			
		||||
assign dbg_data0_wdata = wdata;
 | 
			
		||||
assign dbg_data0_wen = wen && addr == DATA0;
 | 
			
		||||
 | 
			
		||||
// ----------------------------------------------------------------------------
 | 
			
		||||
// Read port + detect addressing of unmapped CSRs
 | 
			
		||||
| 
						 | 
				
			
			@ -811,6 +803,14 @@ always @ (*) begin
 | 
			
		|||
		rdata = minstreth;
 | 
			
		||||
	end
 | 
			
		||||
 | 
			
		||||
	// ------------------------------------------------------------------------
 | 
			
		||||
	// Trigger Module CSRs
 | 
			
		||||
 | 
			
		||||
	TSELECT: if (DEBUG_SUPPORT) begin
 | 
			
		||||
		decode_match = 1'b1;
 | 
			
		||||
		// lol
 | 
			
		||||
	end
 | 
			
		||||
 | 
			
		||||
	// ------------------------------------------------------------------------
 | 
			
		||||
	// Debug CSRs
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -840,7 +840,7 @@ always @ (*) begin
 | 
			
		|||
 | 
			
		||||
	DATA0: if (DEBUG_SUPPORT && debug_mode) begin
 | 
			
		||||
		decode_match = 1'b1;
 | 
			
		||||
		rdata = data0;
 | 
			
		||||
		rdata = dbg_data0_rdata;
 | 
			
		||||
	end
 | 
			
		||||
 | 
			
		||||
    // ------------------------------------------------------------------------
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
		Loading…
	
		Reference in New Issue