1 /***************************************************************************
2 * Copyright (C) 2008 by Spencer Oliver *
3 * spen@spen-soft.co.uk *
5 * Copyright (C) 2008 by David T.L. Wong *
7 * Copyright (C) 2009 by David N. Claffey <dnclaffey@gmail.com> *
9 * This program is free software; you can redistribute it and/or modify *
10 * it under the terms of the GNU General Public License as published by *
11 * the Free Software Foundation; either version 2 of the License, or *
12 * (at your option) any later version. *
14 * This program is distributed in the hope that it will be useful, *
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
17 * GNU General Public License for more details. *
19 * You should have received a copy of the GNU General Public License *
20 * along with this program; if not, write to the *
21 * Free Software Foundation, Inc., *
22 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
23 ***************************************************************************/
28 #include "breakpoints.h"
31 #include "mips32_dmaacc.h"
32 #include "target_type.h"
35 static void mips_m4k_enable_breakpoints(struct target
*target
);
36 static void mips_m4k_enable_watchpoints(struct target
*target
);
37 static int mips_m4k_set_breakpoint(struct target
*target
,
38 struct breakpoint
*breakpoint
);
39 static int mips_m4k_unset_breakpoint(struct target
*target
,
40 struct breakpoint
*breakpoint
);
42 static int mips_m4k_examine_debug_reason(struct target
*target
)
44 uint32_t break_status
;
47 if ((target
->debug_reason
!= DBG_REASON_DBGRQ
)
48 && (target
->debug_reason
!= DBG_REASON_SINGLESTEP
))
50 /* get info about inst breakpoint support */
51 if ((retval
= target_read_u32(target
, EJTAG_IBS
, &break_status
)) != ERROR_OK
)
53 if (break_status
& 0x1f)
55 /* we have halted on a breakpoint */
56 if ((retval
= target_write_u32(target
, EJTAG_IBS
, 0)) != ERROR_OK
)
58 target
->debug_reason
= DBG_REASON_BREAKPOINT
;
61 /* get info about data breakpoint support */
62 if ((retval
= target_read_u32(target
, EJTAG_DBS
, &break_status
)) != ERROR_OK
)
64 if (break_status
& 0x1f)
66 /* we have halted on a breakpoint */
67 if ((retval
= target_write_u32(target
, EJTAG_DBS
, 0)) != ERROR_OK
)
69 target
->debug_reason
= DBG_REASON_WATCHPOINT
;
76 static int mips_m4k_debug_entry(struct target
*target
)
78 struct mips32_common
*mips32
= target_to_mips32(target
);
79 struct mips_ejtag
*ejtag_info
= &mips32
->ejtag_info
;
82 /* read debug register */
83 mips_ejtag_read_debug(ejtag_info
, &debug_reg
);
85 /* make sure break unit configured */
86 mips32_configure_break_unit(target
);
88 /* attempt to find halt reason */
89 mips_m4k_examine_debug_reason(target
);
91 /* clear single step if active */
92 if (debug_reg
& EJTAG_DEBUG_DSS
)
94 /* stopped due to single step - clear step bit */
95 mips_ejtag_config_step(ejtag_info
, 0);
98 mips32_save_context(target
);
100 /* default to mips32 isa, it will be changed below if required */
101 mips32
->isa_mode
= MIPS32_ISA_MIPS32
;
103 if (ejtag_info
->impcode
& EJTAG_IMP_MIPS16
) {
104 mips32
->isa_mode
= buf_get_u32(mips32
->core_cache
->reg_list
[MIPS32_PC
].value
, 0, 1);
107 LOG_DEBUG("entered debug state at PC 0x%" PRIx32
", target->state: %s",
108 buf_get_u32(mips32
->core_cache
->reg_list
[MIPS32_PC
].value
, 0, 32),
109 target_state_name(target
));
114 static int mips_m4k_poll(struct target
*target
)
117 struct mips32_common
*mips32
= target_to_mips32(target
);
118 struct mips_ejtag
*ejtag_info
= &mips32
->ejtag_info
;
119 uint32_t ejtag_ctrl
= ejtag_info
->ejtag_ctrl
;
121 /* read ejtag control reg */
122 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_CONTROL
);
123 mips_ejtag_drscan_32(ejtag_info
, &ejtag_ctrl
);
125 /* clear this bit before handling polling
126 * as after reset registers will read zero */
127 if (ejtag_ctrl
& EJTAG_CTRL_ROCC
)
129 /* we have detected a reset, clear flag
130 * otherwise ejtag will not work */
131 ejtag_ctrl
= ejtag_info
->ejtag_ctrl
& ~EJTAG_CTRL_ROCC
;
133 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_CONTROL
);
134 mips_ejtag_drscan_32(ejtag_info
, &ejtag_ctrl
);
135 LOG_DEBUG("Reset Detected");
138 /* check for processor halted */
139 if (ejtag_ctrl
& EJTAG_CTRL_BRKST
)
141 if ((target
->state
== TARGET_RUNNING
) || (target
->state
== TARGET_RESET
))
143 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_NORMALBOOT
);
145 target
->state
= TARGET_HALTED
;
147 if ((retval
= mips_m4k_debug_entry(target
)) != ERROR_OK
)
150 target_call_event_callbacks(target
, TARGET_EVENT_HALTED
);
152 else if (target
->state
== TARGET_DEBUG_RUNNING
)
154 target
->state
= TARGET_HALTED
;
156 if ((retval
= mips_m4k_debug_entry(target
)) != ERROR_OK
)
159 target_call_event_callbacks(target
, TARGET_EVENT_DEBUG_HALTED
);
164 target
->state
= TARGET_RUNNING
;
167 // LOG_DEBUG("ctrl = 0x%08X", ejtag_ctrl);
172 static int mips_m4k_halt(struct target
*target
)
174 struct mips32_common
*mips32
= target_to_mips32(target
);
175 struct mips_ejtag
*ejtag_info
= &mips32
->ejtag_info
;
177 LOG_DEBUG("target->state: %s",
178 target_state_name(target
));
180 if (target
->state
== TARGET_HALTED
)
182 LOG_DEBUG("target was already halted");
186 if (target
->state
== TARGET_UNKNOWN
)
188 LOG_WARNING("target was in unknown state when halt was requested");
191 if (target
->state
== TARGET_RESET
)
193 if ((jtag_get_reset_config() & RESET_SRST_PULLS_TRST
) && jtag_get_srst())
195 LOG_ERROR("can't request a halt while in reset if nSRST pulls nTRST");
196 return ERROR_TARGET_FAILURE
;
200 /* we came here in a reset_halt or reset_init sequence
201 * debug entry was already prepared in mips32_prepare_reset_halt()
203 target
->debug_reason
= DBG_REASON_DBGRQ
;
209 /* break processor */
210 mips_ejtag_enter_debug(ejtag_info
);
212 target
->debug_reason
= DBG_REASON_DBGRQ
;
217 static int mips_m4k_assert_reset(struct target
*target
)
219 struct mips_m4k_common
*mips_m4k
= target_to_m4k(target
);
220 struct mips_ejtag
*ejtag_info
= &mips_m4k
->mips32
.ejtag_info
;
223 LOG_DEBUG("target->state: %s",
224 target_state_name(target
));
226 enum reset_types jtag_reset_config
= jtag_get_reset_config();
228 if (!(jtag_reset_config
& RESET_HAS_SRST
))
231 if (target
->reset_halt
)
233 /* use hardware to catch reset */
234 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_EJTAGBOOT
);
238 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_NORMALBOOT
);
243 /* here we should issue a srst only, but we may have to assert trst as well */
244 if (jtag_reset_config
& RESET_SRST_PULLS_TRST
)
246 jtag_add_reset(1, 1);
250 jtag_add_reset(0, 1);
255 if (mips_m4k
->is_pic32mx
)
259 LOG_DEBUG("Using MTAP reset to reset processor...");
261 /* use microchip specific MTAP reset */
262 mips_ejtag_set_instr(ejtag_info
, MTAP_SW_MTAP
);
263 mips_ejtag_set_instr(ejtag_info
, MTAP_COMMAND
);
265 mchip_cmd
= MCHP_ASERT_RST
;
266 mips_ejtag_drscan_8(ejtag_info
, &mchip_cmd
);
267 mchip_cmd
= MCHP_DE_ASSERT_RST
;
268 mips_ejtag_drscan_8(ejtag_info
, &mchip_cmd
);
269 mips_ejtag_set_instr(ejtag_info
, MTAP_SW_ETAP
);
273 /* use ejtag reset - not supported by all cores */
274 uint32_t ejtag_ctrl
= ejtag_info
->ejtag_ctrl
| EJTAG_CTRL_PRRST
| EJTAG_CTRL_PERRST
;
275 LOG_DEBUG("Using EJTAG reset (PRRST) to reset processor...");
276 mips_ejtag_set_instr(ejtag_info
, EJTAG_INST_CONTROL
);
277 mips_ejtag_drscan_32(ejtag_info
, &ejtag_ctrl
);
281 target
->state
= TARGET_RESET
;
282 jtag_add_sleep(50000);
284 register_cache_invalidate(mips_m4k
->mips32
.core_cache
);
286 if (target
->reset_halt
)
289 if ((retval
= target_halt(target
)) != ERROR_OK
)
296 static int mips_m4k_deassert_reset(struct target
*target
)
298 LOG_DEBUG("target->state: %s",
299 target_state_name(target
));
301 /* deassert reset lines */
302 jtag_add_reset(0, 0);
307 static int mips_m4k_soft_reset_halt(struct target
*target
)
313 static int mips_m4k_single_step_core(struct target
*target
)
315 struct mips32_common
*mips32
= target_to_mips32(target
);
316 struct mips_ejtag
*ejtag_info
= &mips32
->ejtag_info
;
318 /* configure single step mode */
319 mips_ejtag_config_step(ejtag_info
, 1);
321 /* disable interrupts while stepping */
322 mips32_enable_interrupts(target
, 0);
324 /* exit debug mode */
325 mips_ejtag_exit_debug(ejtag_info
);
327 mips_m4k_debug_entry(target
);
332 static int mips_m4k_resume(struct target
*target
, int current
,
333 uint32_t address
, int handle_breakpoints
, int debug_execution
)
335 struct mips32_common
*mips32
= target_to_mips32(target
);
336 struct mips_ejtag
*ejtag_info
= &mips32
->ejtag_info
;
337 struct breakpoint
*breakpoint
= NULL
;
340 if (target
->state
!= TARGET_HALTED
)
342 LOG_WARNING("target not halted");
343 return ERROR_TARGET_NOT_HALTED
;
346 if (!debug_execution
)
348 target_free_all_working_areas(target
);
349 mips_m4k_enable_breakpoints(target
);
350 mips_m4k_enable_watchpoints(target
);
353 /* current = 1: continue on current pc, otherwise continue at <address> */
356 buf_set_u32(mips32
->core_cache
->reg_list
[MIPS32_PC
].value
, 0, 32, address
);
357 mips32
->core_cache
->reg_list
[MIPS32_PC
].dirty
= 1;
358 mips32
->core_cache
->reg_list
[MIPS32_PC
].valid
= 1;
361 if (ejtag_info
->impcode
& EJTAG_IMP_MIPS16
) {
362 buf_set_u32(mips32
->core_cache
->reg_list
[MIPS32_PC
].value
, 0, 1, mips32
->isa_mode
);
365 resume_pc
= buf_get_u32(mips32
->core_cache
->reg_list
[MIPS32_PC
].value
, 0, 32);
367 mips32_restore_context(target
);
369 /* the front-end may request us not to handle breakpoints */
370 if (handle_breakpoints
)
372 /* Single step past breakpoint at current address */
373 if ((breakpoint
= breakpoint_find(target
, resume_pc
)))
375 LOG_DEBUG("unset breakpoint at 0x%8.8" PRIx32
"", breakpoint
->address
);
376 mips_m4k_unset_breakpoint(target
, breakpoint
);
377 mips_m4k_single_step_core(target
);
378 mips_m4k_set_breakpoint(target
, breakpoint
);
382 /* enable interrupts if we are running */
383 mips32_enable_interrupts(target
, !debug_execution
);
385 /* exit debug mode */
386 mips_ejtag_exit_debug(ejtag_info
);
387 target
->debug_reason
= DBG_REASON_NOTHALTED
;
389 /* registers are now invalid */
390 register_cache_invalidate(mips32
->core_cache
);
392 if (!debug_execution
)
394 target
->state
= TARGET_RUNNING
;
395 target_call_event_callbacks(target
, TARGET_EVENT_RESUMED
);
396 LOG_DEBUG("target resumed at 0x%" PRIx32
"", resume_pc
);
400 target
->state
= TARGET_DEBUG_RUNNING
;
401 target_call_event_callbacks(target
, TARGET_EVENT_DEBUG_RESUMED
);
402 LOG_DEBUG("target debug resumed at 0x%" PRIx32
"", resume_pc
);
408 static int mips_m4k_step(struct target
*target
, int current
,
409 uint32_t address
, int handle_breakpoints
)
411 /* get pointers to arch-specific information */
412 struct mips32_common
*mips32
= target_to_mips32(target
);
413 struct mips_ejtag
*ejtag_info
= &mips32
->ejtag_info
;
414 struct breakpoint
*breakpoint
= NULL
;
416 if (target
->state
!= TARGET_HALTED
)
418 LOG_WARNING("target not halted");
419 return ERROR_TARGET_NOT_HALTED
;
422 /* current = 1: continue on current pc, otherwise continue at <address> */
425 buf_set_u32(mips32
->core_cache
->reg_list
[MIPS32_PC
].value
, 0, 32, address
);
426 mips32
->core_cache
->reg_list
[MIPS32_PC
].dirty
= 1;
427 mips32
->core_cache
->reg_list
[MIPS32_PC
].valid
= 1;
430 /* the front-end may request us not to handle breakpoints */
431 if (handle_breakpoints
) {
432 breakpoint
= breakpoint_find(target
,
433 buf_get_u32(mips32
->core_cache
->reg_list
[MIPS32_PC
].value
, 0, 32));
435 mips_m4k_unset_breakpoint(target
, breakpoint
);
438 /* restore context */
439 mips32_restore_context(target
);
441 /* configure single step mode */
442 mips_ejtag_config_step(ejtag_info
, 1);
444 target
->debug_reason
= DBG_REASON_SINGLESTEP
;
446 target_call_event_callbacks(target
, TARGET_EVENT_RESUMED
);
448 /* disable interrupts while stepping */
449 mips32_enable_interrupts(target
, 0);
451 /* exit debug mode */
452 mips_ejtag_exit_debug(ejtag_info
);
454 /* registers are now invalid */
455 register_cache_invalidate(mips32
->core_cache
);
458 mips_m4k_set_breakpoint(target
, breakpoint
);
460 LOG_DEBUG("target stepped ");
462 mips_m4k_debug_entry(target
);
463 target_call_event_callbacks(target
, TARGET_EVENT_HALTED
);
468 static void mips_m4k_enable_breakpoints(struct target
*target
)
470 struct breakpoint
*breakpoint
= target
->breakpoints
;
472 /* set any pending breakpoints */
475 if (breakpoint
->set
== 0)
476 mips_m4k_set_breakpoint(target
, breakpoint
);
477 breakpoint
= breakpoint
->next
;
481 static int mips_m4k_set_breakpoint(struct target
*target
,
482 struct breakpoint
*breakpoint
)
484 struct mips32_common
*mips32
= target_to_mips32(target
);
485 struct mips32_comparator
* comparator_list
= mips32
->inst_break_list
;
490 LOG_WARNING("breakpoint already set");
494 if (breakpoint
->type
== BKPT_HARD
)
498 while (comparator_list
[bp_num
].used
&& (bp_num
< mips32
->num_inst_bpoints
))
500 if (bp_num
>= mips32
->num_inst_bpoints
)
502 LOG_ERROR("Can not find free FP Comparator(bpid: %d)",
503 breakpoint
->unique_id
);
504 return ERROR_TARGET_RESOURCE_NOT_AVAILABLE
;
506 breakpoint
->set
= bp_num
+ 1;
507 comparator_list
[bp_num
].used
= 1;
508 comparator_list
[bp_num
].bp_value
= breakpoint
->address
;
509 target_write_u32(target
, comparator_list
[bp_num
].reg_address
, comparator_list
[bp_num
].bp_value
);
510 target_write_u32(target
, comparator_list
[bp_num
].reg_address
+ 0x08, 0x00000000);
511 target_write_u32(target
, comparator_list
[bp_num
].reg_address
+ 0x18, 1);
512 LOG_DEBUG("bpid: %d, bp_num %i bp_value 0x%" PRIx32
"",
513 breakpoint
->unique_id
,
514 bp_num
, comparator_list
[bp_num
].bp_value
);
516 else if (breakpoint
->type
== BKPT_SOFT
)
518 LOG_DEBUG("bpid: %d", breakpoint
->unique_id
);
519 if (breakpoint
->length
== 4)
521 uint32_t verify
= 0xffffffff;
523 if ((retval
= target_read_memory(target
, breakpoint
->address
, breakpoint
->length
, 1,
524 breakpoint
->orig_instr
)) != ERROR_OK
)
528 if ((retval
= target_write_u32(target
, breakpoint
->address
, MIPS32_SDBBP
)) != ERROR_OK
)
533 if ((retval
= target_read_u32(target
, breakpoint
->address
, &verify
)) != ERROR_OK
)
537 if (verify
!= MIPS32_SDBBP
)
539 LOG_ERROR("Unable to set 32bit breakpoint at address %08" PRIx32
" - check that memory is read/writable", breakpoint
->address
);
545 uint16_t verify
= 0xffff;
547 if ((retval
= target_read_memory(target
, breakpoint
->address
, breakpoint
->length
, 1,
548 breakpoint
->orig_instr
)) != ERROR_OK
)
552 if ((retval
= target_write_u16(target
, breakpoint
->address
, MIPS16_SDBBP
)) != ERROR_OK
)
557 if ((retval
= target_read_u16(target
, breakpoint
->address
, &verify
)) != ERROR_OK
)
561 if (verify
!= MIPS16_SDBBP
)
563 LOG_ERROR("Unable to set 16bit breakpoint at address %08" PRIx32
" - check that memory is read/writable", breakpoint
->address
);
568 breakpoint
->set
= 20; /* Any nice value but 0 */
574 static int mips_m4k_unset_breakpoint(struct target
*target
,
575 struct breakpoint
*breakpoint
)
577 /* get pointers to arch-specific information */
578 struct mips32_common
*mips32
= target_to_mips32(target
);
579 struct mips32_comparator
*comparator_list
= mips32
->inst_break_list
;
582 if (!breakpoint
->set
)
584 LOG_WARNING("breakpoint not set");
588 if (breakpoint
->type
== BKPT_HARD
)
590 int bp_num
= breakpoint
->set
- 1;
591 if ((bp_num
< 0) || (bp_num
>= mips32
->num_inst_bpoints
))
593 LOG_DEBUG("Invalid FP Comparator number in breakpoint (bpid: %d)",
594 breakpoint
->unique_id
);
597 LOG_DEBUG("bpid: %d - releasing hw: %d",
598 breakpoint
->unique_id
,
600 comparator_list
[bp_num
].used
= 0;
601 comparator_list
[bp_num
].bp_value
= 0;
602 target_write_u32(target
, comparator_list
[bp_num
].reg_address
+ 0x18, 0);
607 /* restore original instruction (kept in target endianness) */
608 LOG_DEBUG("bpid: %d", breakpoint
->unique_id
);
609 if (breakpoint
->length
== 4)
611 uint32_t current_instr
;
613 /* check that user program has not modified breakpoint instruction */
614 if ((retval
= target_read_memory(target
, breakpoint
->address
, 4, 1,
615 (uint8_t*)¤t_instr
)) != ERROR_OK
)
619 if (current_instr
== MIPS32_SDBBP
)
621 if ((retval
= target_write_memory(target
, breakpoint
->address
, 4, 1,
622 breakpoint
->orig_instr
)) != ERROR_OK
)
630 uint16_t current_instr
;
632 /* check that user program has not modified breakpoint instruction */
633 if ((retval
= target_read_memory(target
, breakpoint
->address
, 2, 1,
634 (uint8_t*)¤t_instr
)) != ERROR_OK
)
639 if (current_instr
== MIPS16_SDBBP
)
641 if ((retval
= target_write_memory(target
, breakpoint
->address
, 2, 1,
642 breakpoint
->orig_instr
)) != ERROR_OK
)
654 static int mips_m4k_add_breakpoint(struct target
*target
, struct breakpoint
*breakpoint
)
656 struct mips32_common
*mips32
= target_to_mips32(target
);
658 if (breakpoint
->type
== BKPT_HARD
)
660 if (mips32
->num_inst_bpoints_avail
< 1)
662 LOG_INFO("no hardware breakpoint available");
663 return ERROR_TARGET_RESOURCE_NOT_AVAILABLE
;
666 mips32
->num_inst_bpoints_avail
--;
669 return mips_m4k_set_breakpoint(target
, breakpoint
);
672 static int mips_m4k_remove_breakpoint(struct target
*target
,
673 struct breakpoint
*breakpoint
)
675 /* get pointers to arch-specific information */
676 struct mips32_common
*mips32
= target_to_mips32(target
);
678 if (target
->state
!= TARGET_HALTED
)
680 LOG_WARNING("target not halted");
681 return ERROR_TARGET_NOT_HALTED
;
686 mips_m4k_unset_breakpoint(target
, breakpoint
);
689 if (breakpoint
->type
== BKPT_HARD
)
690 mips32
->num_inst_bpoints_avail
++;
695 static int mips_m4k_set_watchpoint(struct target
*target
,
696 struct watchpoint
*watchpoint
)
698 struct mips32_common
*mips32
= target_to_mips32(target
);
699 struct mips32_comparator
*comparator_list
= mips32
->data_break_list
;
702 * watchpoint enabled, ignore all byte lanes in value register
703 * and exclude both load and store accesses from watchpoint
704 * condition evaluation
706 int enable
= EJTAG_DBCn_NOSB
| EJTAG_DBCn_NOLB
| EJTAG_DBCn_BE
|
707 (0xff << EJTAG_DBCn_BLM_SHIFT
);
711 LOG_WARNING("watchpoint already set");
715 while(comparator_list
[wp_num
].used
&& (wp_num
< mips32
->num_data_bpoints
))
717 if (wp_num
>= mips32
->num_data_bpoints
)
719 LOG_ERROR("Can not find free FP Comparator");
723 if (watchpoint
->length
!= 4)
725 LOG_ERROR("Only watchpoints of length 4 are supported");
726 return ERROR_TARGET_UNALIGNED_ACCESS
;
729 if (watchpoint
->address
% 4)
731 LOG_ERROR("Watchpoints address should be word aligned");
732 return ERROR_TARGET_UNALIGNED_ACCESS
;
735 switch (watchpoint
->rw
)
738 enable
&= ~EJTAG_DBCn_NOLB
;
741 enable
&= ~EJTAG_DBCn_NOSB
;
744 enable
&= ~(EJTAG_DBCn_NOLB
| EJTAG_DBCn_NOSB
);
747 LOG_ERROR("BUG: watchpoint->rw neither read, write nor access");
750 watchpoint
->set
= wp_num
+ 1;
751 comparator_list
[wp_num
].used
= 1;
752 comparator_list
[wp_num
].bp_value
= watchpoint
->address
;
753 target_write_u32(target
, comparator_list
[wp_num
].reg_address
, comparator_list
[wp_num
].bp_value
);
754 target_write_u32(target
, comparator_list
[wp_num
].reg_address
+ 0x08, 0x00000000);
755 target_write_u32(target
, comparator_list
[wp_num
].reg_address
+ 0x10, 0x00000000);
756 target_write_u32(target
, comparator_list
[wp_num
].reg_address
+ 0x18, enable
);
757 target_write_u32(target
, comparator_list
[wp_num
].reg_address
+ 0x20, 0);
758 LOG_DEBUG("wp_num %i bp_value 0x%" PRIx32
"", wp_num
, comparator_list
[wp_num
].bp_value
);
763 static int mips_m4k_unset_watchpoint(struct target
*target
,
764 struct watchpoint
*watchpoint
)
766 /* get pointers to arch-specific information */
767 struct mips32_common
*mips32
= target_to_mips32(target
);
768 struct mips32_comparator
*comparator_list
= mips32
->data_break_list
;
770 if (!watchpoint
->set
)
772 LOG_WARNING("watchpoint not set");
776 int wp_num
= watchpoint
->set
- 1;
777 if ((wp_num
< 0) || (wp_num
>= mips32
->num_data_bpoints
))
779 LOG_DEBUG("Invalid FP Comparator number in watchpoint");
782 comparator_list
[wp_num
].used
= 0;
783 comparator_list
[wp_num
].bp_value
= 0;
784 target_write_u32(target
, comparator_list
[wp_num
].reg_address
+ 0x18, 0);
790 static int mips_m4k_add_watchpoint(struct target
*target
, struct watchpoint
*watchpoint
)
792 struct mips32_common
*mips32
= target_to_mips32(target
);
794 if (mips32
->num_data_bpoints_avail
< 1)
796 LOG_INFO("no hardware watchpoints available");
797 return ERROR_TARGET_RESOURCE_NOT_AVAILABLE
;
800 mips32
->num_data_bpoints_avail
--;
802 mips_m4k_set_watchpoint(target
, watchpoint
);
806 static int mips_m4k_remove_watchpoint(struct target
*target
,
807 struct watchpoint
*watchpoint
)
809 /* get pointers to arch-specific information */
810 struct mips32_common
*mips32
= target_to_mips32(target
);
812 if (target
->state
!= TARGET_HALTED
)
814 LOG_WARNING("target not halted");
815 return ERROR_TARGET_NOT_HALTED
;
820 mips_m4k_unset_watchpoint(target
, watchpoint
);
823 mips32
->num_data_bpoints_avail
++;
828 static void mips_m4k_enable_watchpoints(struct target
*target
)
830 struct watchpoint
*watchpoint
= target
->watchpoints
;
832 /* set any pending watchpoints */
835 if (watchpoint
->set
== 0)
836 mips_m4k_set_watchpoint(target
, watchpoint
);
837 watchpoint
= watchpoint
->next
;
841 static int mips_m4k_read_memory(struct target
*target
, uint32_t address
,
842 uint32_t size
, uint32_t count
, uint8_t *buffer
)
844 struct mips32_common
*mips32
= target_to_mips32(target
);
845 struct mips_ejtag
*ejtag_info
= &mips32
->ejtag_info
;
847 LOG_DEBUG("address: 0x%8.8" PRIx32
", size: 0x%8.8" PRIx32
", count: 0x%8.8" PRIx32
"", address
, size
, count
);
849 if (target
->state
!= TARGET_HALTED
)
851 LOG_WARNING("target not halted");
852 return ERROR_TARGET_NOT_HALTED
;
855 /* sanitize arguments */
856 if (((size
!= 4) && (size
!= 2) && (size
!= 1)) || (count
== 0) || !(buffer
))
857 return ERROR_INVALID_ARGUMENTS
;
859 if (((size
== 4) && (address
& 0x3u
)) || ((size
== 2) && (address
& 0x1u
)))
860 return ERROR_TARGET_UNALIGNED_ACCESS
;
862 /* if noDMA off, use DMAACC mode for memory read */
864 if (ejtag_info
->impcode
& EJTAG_IMP_NODMA
)
865 retval
= mips32_pracc_read_mem(ejtag_info
, address
, size
, count
, (void *)buffer
);
867 retval
= mips32_dmaacc_read_mem(ejtag_info
, address
, size
, count
, (void *)buffer
);
868 if (ERROR_OK
!= retval
)
874 static int mips_m4k_write_memory(struct target
*target
, uint32_t address
,
875 uint32_t size
, uint32_t count
, uint8_t *buffer
)
877 struct mips32_common
*mips32
= target_to_mips32(target
);
878 struct mips_ejtag
*ejtag_info
= &mips32
->ejtag_info
;
880 LOG_DEBUG("address: 0x%8.8" PRIx32
", size: 0x%8.8" PRIx32
", count: 0x%8.8" PRIx32
"",
881 address
, size
, count
);
883 if (target
->state
!= TARGET_HALTED
)
885 LOG_WARNING("target not halted");
886 return ERROR_TARGET_NOT_HALTED
;
889 /* sanitize arguments */
890 if (((size
!= 4) && (size
!= 2) && (size
!= 1)) || (count
== 0) || !(buffer
))
891 return ERROR_INVALID_ARGUMENTS
;
893 if (((size
== 4) && (address
& 0x3u
)) || ((size
== 2) && (address
& 0x1u
)))
894 return ERROR_TARGET_UNALIGNED_ACCESS
;
896 /* if noDMA off, use DMAACC mode for memory write */
897 if (ejtag_info
->impcode
& EJTAG_IMP_NODMA
)
898 return mips32_pracc_write_mem(ejtag_info
, address
, size
, count
, (void *)buffer
);
900 return mips32_dmaacc_write_mem(ejtag_info
, address
, size
, count
, (void *)buffer
);
903 static int mips_m4k_init_target(struct command_context
*cmd_ctx
,
904 struct target
*target
)
906 mips32_build_reg_cache(target
);
911 static int mips_m4k_init_arch_info(struct target
*target
,
912 struct mips_m4k_common
*mips_m4k
, struct jtag_tap
*tap
)
914 struct mips32_common
*mips32
= &mips_m4k
->mips32
;
916 mips_m4k
->common_magic
= MIPSM4K_COMMON_MAGIC
;
918 /* initialize mips4k specific info */
919 mips32_init_arch_info(target
, mips32
, tap
);
920 mips32
->arch_info
= mips_m4k
;
925 static int mips_m4k_target_create(struct target
*target
, Jim_Interp
*interp
)
927 struct mips_m4k_common
*mips_m4k
= calloc(1, sizeof(struct mips_m4k_common
));
929 mips_m4k_init_arch_info(target
, mips_m4k
, target
->tap
);
934 static int mips_m4k_examine(struct target
*target
)
937 struct mips_m4k_common
*mips_m4k
= target_to_m4k(target
);
938 struct mips_ejtag
*ejtag_info
= &mips_m4k
->mips32
.ejtag_info
;
941 if (!target_was_examined(target
))
943 mips_ejtag_get_idcode(ejtag_info
, &idcode
);
944 ejtag_info
->idcode
= idcode
;
946 if (((idcode
>> 1) & 0x7FF) == 0x29)
948 /* we are using a pic32mx so select ejtag port
949 * as it is not selected by default */
950 mips_ejtag_set_instr(ejtag_info
, MTAP_SW_ETAP
);
951 LOG_DEBUG("PIC32MX Detected - using EJTAG Interface");
952 mips_m4k
->is_pic32mx
= true;
956 /* init rest of ejtag interface */
957 if ((retval
= mips_ejtag_init(ejtag_info
)) != ERROR_OK
)
960 if ((retval
= mips32_examine(target
)) != ERROR_OK
)
966 static int mips_m4k_bulk_write_memory(struct target
*target
, uint32_t address
,
967 uint32_t count
, uint8_t *buffer
)
969 struct mips32_common
*mips32
= target_to_mips32(target
);
970 struct mips_ejtag
*ejtag_info
= &mips32
->ejtag_info
;
974 LOG_DEBUG("address: 0x%8.8" PRIx32
", count: 0x%8.8" PRIx32
"", address
, count
);
976 if (target
->state
!= TARGET_HALTED
)
978 LOG_WARNING("target not halted");
979 return ERROR_TARGET_NOT_HALTED
;
982 /* check alignment */
984 return ERROR_TARGET_UNALIGNED_ACCESS
;
986 if (mips32
->fast_data_area
== NULL
)
988 /* Get memory for block write handler
989 * we preserve this area between calls and gain a speed increase
990 * of about 3kb/sec when writing flash
991 * this will be released/nulled by the system when the target is resumed or reset */
992 retval
= target_alloc_working_area(target
,
993 MIPS32_FASTDATA_HANDLER_SIZE
,
994 &mips32
->fast_data_area
);
995 if (retval
!= ERROR_OK
)
997 LOG_WARNING("No working area available, falling back to non-bulk write");
998 return mips_m4k_write_memory(target
, address
, 4, count
, buffer
);
1001 /* reset fastadata state so the algo get reloaded */
1002 ejtag_info
->fast_access_save
= -1;
1005 /* TAP data register is loaded LSB first (little endian) */
1006 if (target
->endianness
== TARGET_BIG_ENDIAN
)
1009 for(i
= 0; i
< (count
* 4); i
+= 4)
1011 t32
= be_to_h_u32((uint8_t *) &buffer
[i
]);
1012 h_u32_to_le(&buffer
[i
], t32
);
1016 retval
= mips32_pracc_fastdata_xfer(ejtag_info
, mips32
->fast_data_area
, write_t
, address
,
1017 count
, (uint32_t*) (void *)buffer
);
1018 if (retval
!= ERROR_OK
)
1020 /* FASTDATA access failed, try normal memory write */
1021 LOG_DEBUG("Fastdata access Failed, falling back to non-bulk write");
1022 retval
= mips_m4k_write_memory(target
, address
, 4, count
, buffer
);
1028 struct target_type mips_m4k_target
=
1032 .poll
= mips_m4k_poll
,
1033 .arch_state
= mips32_arch_state
,
1035 .target_request_data
= NULL
,
1037 .halt
= mips_m4k_halt
,
1038 .resume
= mips_m4k_resume
,
1039 .step
= mips_m4k_step
,
1041 .assert_reset
= mips_m4k_assert_reset
,
1042 .deassert_reset
= mips_m4k_deassert_reset
,
1043 .soft_reset_halt
= mips_m4k_soft_reset_halt
,
1045 .get_gdb_reg_list
= mips32_get_gdb_reg_list
,
1047 .read_memory
= mips_m4k_read_memory
,
1048 .write_memory
= mips_m4k_write_memory
,
1049 .bulk_write_memory
= mips_m4k_bulk_write_memory
,
1050 .checksum_memory
= mips32_checksum_memory
,
1051 .blank_check_memory
= mips32_blank_check_memory
,
1053 .run_algorithm
= mips32_run_algorithm
,
1055 .add_breakpoint
= mips_m4k_add_breakpoint
,
1056 .remove_breakpoint
= mips_m4k_remove_breakpoint
,
1057 .add_watchpoint
= mips_m4k_add_watchpoint
,
1058 .remove_watchpoint
= mips_m4k_remove_watchpoint
,
1060 .target_create
= mips_m4k_target_create
,
1061 .init_target
= mips_m4k_init_target
,
1062 .examine
= mips_m4k_examine
,