| Line 34... |
Line 34... |
//
|
//
|
// *Author(s):
|
// *Author(s):
|
// - Olivier Girard, olgirard@gmail.com
|
// - Olivier Girard, olgirard@gmail.com
|
//
|
//
|
//----------------------------------------------------------------------------
|
//----------------------------------------------------------------------------
|
// $Rev: 117 $
|
// $Rev: 175 $
|
// $LastChangedBy: olivier.girard $
|
// $LastChangedBy: olivier.girard $
|
// $LastChangedDate: 2011-06-23 21:30:51 +0200 (Thu, 23 Jun 2011) $
|
// $LastChangedDate: 2013-01-30 22:21:42 +0100 (Wed, 30 Jan 2013) $
|
//----------------------------------------------------------------------------
|
//----------------------------------------------------------------------------
|
`ifdef OMSP_NO_INCLUDE
|
`ifdef OMSP_NO_INCLUDE
|
`else
|
`else
|
`include "openMSP430_defines.v"
|
`include "openMSP430_defines.v"
|
`endif
|
`endif
|
| Line 56... |
Line 56... |
brk_reg_rd, // Hardware break/watch-point register read select
|
brk_reg_rd, // Hardware break/watch-point register read select
|
brk_reg_wr, // Hardware break/watch-point register write select
|
brk_reg_wr, // Hardware break/watch-point register write select
|
dbg_clk, // Debug unit clock
|
dbg_clk, // Debug unit clock
|
dbg_din, // Debug register data input
|
dbg_din, // Debug register data input
|
dbg_rst, // Debug unit reset
|
dbg_rst, // Debug unit reset
|
|
decode_noirq, // Frontend decode instruction
|
eu_mab, // Execution-Unit Memory address bus
|
eu_mab, // Execution-Unit Memory address bus
|
eu_mb_en, // Execution-Unit Memory bus enable
|
eu_mb_en, // Execution-Unit Memory bus enable
|
eu_mb_wr, // Execution-Unit Memory bus write transfer
|
eu_mb_wr, // Execution-Unit Memory bus write transfer
|
eu_mdb_in, // Memory data bus input
|
|
eu_mdb_out, // Memory data bus output
|
|
exec_done, // Execution completed
|
|
fe_mb_en, // Frontend Memory bus enable
|
|
pc // Program counter
|
pc // Program counter
|
);
|
);
|
|
|
// OUTPUTs
|
// OUTPUTs
|
//=========
|
//=========
|
| Line 79... |
Line 76... |
input [3:0] brk_reg_rd; // Hardware break/watch-point register read select
|
input [3:0] brk_reg_rd; // Hardware break/watch-point register read select
|
input [3:0] brk_reg_wr; // Hardware break/watch-point register write select
|
input [3:0] brk_reg_wr; // Hardware break/watch-point register write select
|
input dbg_clk; // Debug unit clock
|
input dbg_clk; // Debug unit clock
|
input [15:0] dbg_din; // Debug register data input
|
input [15:0] dbg_din; // Debug register data input
|
input dbg_rst; // Debug unit reset
|
input dbg_rst; // Debug unit reset
|
|
input decode_noirq; // Frontend decode instruction
|
input [15:0] eu_mab; // Execution-Unit Memory address bus
|
input [15:0] eu_mab; // Execution-Unit Memory address bus
|
input eu_mb_en; // Execution-Unit Memory bus enable
|
input eu_mb_en; // Execution-Unit Memory bus enable
|
input [1:0] eu_mb_wr; // Execution-Unit Memory bus write transfer
|
input [1:0] eu_mb_wr; // Execution-Unit Memory bus write transfer
|
input [15:0] eu_mdb_in; // Memory data bus input
|
|
input [15:0] eu_mdb_out; // Memory data bus output
|
|
input exec_done; // Execution completed
|
|
input fe_mb_en; // Frontend Memory bus enable
|
|
input [15:0] pc; // Program counter
|
input [15:0] pc; // Program counter
|
|
|
|
|
//=============================================================================
|
//=============================================================================
|
// 1) WIRE & PARAMETER DECLARATION
|
// 1) WIRE & PARAMETER DECLARATION
|
| Line 217... |
Line 211... |
wire equ_d_addr0 = eu_mb_en & (eu_mab==brk_addr0) & ~brk_ctl[`BRK_RANGE];
|
wire equ_d_addr0 = eu_mb_en & (eu_mab==brk_addr0) & ~brk_ctl[`BRK_RANGE];
|
wire equ_d_addr1 = eu_mb_en & (eu_mab==brk_addr1) & ~brk_ctl[`BRK_RANGE];
|
wire equ_d_addr1 = eu_mb_en & (eu_mab==brk_addr1) & ~brk_ctl[`BRK_RANGE];
|
wire equ_d_range = eu_mb_en & ((eu_mab>=brk_addr0) & (eu_mab<=brk_addr1)) &
|
wire equ_d_range = eu_mb_en & ((eu_mab>=brk_addr0) & (eu_mab<=brk_addr1)) &
|
brk_ctl[`BRK_RANGE] & `HWBRK_RANGE;
|
brk_ctl[`BRK_RANGE] & `HWBRK_RANGE;
|
|
|
reg fe_mb_en_buf;
|
|
always @ (posedge dbg_clk or posedge dbg_rst)
|
|
if (dbg_rst) fe_mb_en_buf <= 1'b0;
|
|
else fe_mb_en_buf <= fe_mb_en;
|
|
|
|
wire equ_i_addr0 = fe_mb_en_buf & (pc==brk_addr0) & ~brk_ctl[`BRK_RANGE];
|
wire equ_i_addr0 = decode_noirq & (pc==brk_addr0) & ~brk_ctl[`BRK_RANGE];
|
wire equ_i_addr1 = fe_mb_en_buf & (pc==brk_addr1) & ~brk_ctl[`BRK_RANGE];
|
wire equ_i_addr1 = decode_noirq & (pc==brk_addr1) & ~brk_ctl[`BRK_RANGE];
|
wire equ_i_range = fe_mb_en_buf & ((pc>=brk_addr0) & (pc<=brk_addr1)) &
|
wire equ_i_range = decode_noirq & ((pc>=brk_addr0) & (pc<=brk_addr1)) &
|
brk_ctl[`BRK_RANGE] & `HWBRK_RANGE;
|
brk_ctl[`BRK_RANGE] & `HWBRK_RANGE;
|
|
|
|
|
// Detect accesses
|
// Detect accesses
|
//---------------------------
|
//---------------------------
|
| Line 242... |
Line 232... |
wire d_addr0_wr = equ_d_addr0 & ~brk_ctl[`BRK_I_EN] & |eu_mb_wr;
|
wire d_addr0_wr = equ_d_addr0 & ~brk_ctl[`BRK_I_EN] & |eu_mb_wr;
|
wire d_addr1_wr = equ_d_addr1 & ~brk_ctl[`BRK_I_EN] & |eu_mb_wr;
|
wire d_addr1_wr = equ_d_addr1 & ~brk_ctl[`BRK_I_EN] & |eu_mb_wr;
|
wire d_range_wr = equ_d_range & ~brk_ctl[`BRK_I_EN] & |eu_mb_wr;
|
wire d_range_wr = equ_d_range & ~brk_ctl[`BRK_I_EN] & |eu_mb_wr;
|
|
|
// Detect DATA read access
|
// Detect DATA read access
|
// Whenever an "ADD r9. &0x200" instruction is executed, &0x200 will be read
|
wire d_addr0_rd = equ_d_addr0 & ~brk_ctl[`BRK_I_EN] & ~|eu_mb_wr;
|
// before being written back. In that case, the read flag should not be set.
|
wire d_addr1_rd = equ_d_addr1 & ~brk_ctl[`BRK_I_EN] & ~|eu_mb_wr;
|
// In general, We should here make sure no write access occures during the
|
wire d_range_rd = equ_d_range & ~brk_ctl[`BRK_I_EN] & ~|eu_mb_wr;
|
// same instruction cycle before setting the read flag.
|
|
reg [2:0] d_rd_trig;
|
|
always @ (posedge dbg_clk or posedge dbg_rst)
|
|
if (dbg_rst) d_rd_trig <= 3'h0;
|
|
else if (exec_done) d_rd_trig <= 3'h0;
|
|
else d_rd_trig <= {equ_d_range & ~brk_ctl[`BRK_I_EN] & ~|eu_mb_wr,
|
|
equ_d_addr1 & ~brk_ctl[`BRK_I_EN] & ~|eu_mb_wr,
|
|
equ_d_addr0 & ~brk_ctl[`BRK_I_EN] & ~|eu_mb_wr};
|
|
|
|
wire d_addr0_rd = d_rd_trig[0] & exec_done & ~d_addr0_wr;
|
|
wire d_addr1_rd = d_rd_trig[1] & exec_done & ~d_addr1_wr;
|
|
wire d_range_rd = d_rd_trig[2] & exec_done & ~d_range_wr;
|
|
|
|
|
|
// Set flags
|
// Set flags
|
assign addr0_rd_set = brk_ctl[`BRK_MODE_RD] & (d_addr0_rd | i_addr0_rd);
|
assign addr0_rd_set = brk_ctl[`BRK_MODE_RD] & (d_addr0_rd | i_addr0_rd);
|
assign addr0_wr_set = brk_ctl[`BRK_MODE_WR] & d_addr0_wr;
|
assign addr0_wr_set = brk_ctl[`BRK_MODE_WR] & d_addr0_wr;
|
assign addr1_rd_set = brk_ctl[`BRK_MODE_RD] & (d_addr1_rd | i_addr1_rd);
|
assign addr1_rd_set = brk_ctl[`BRK_MODE_RD] & (d_addr1_rd | i_addr1_rd);
|
