1 /***************************************************************************
2 * Copyright (C) 2005 by Dominic Rath *
3 * Dominic.Rath@gmx.de *
5 * Copyright (C) ST-Ericsson SA 2011 *
6 * michel.jaouen@stericsson.com : smp minimum support *
8 * This program is free software; you can redistribute it and/or modify *
9 * it under the terms of the GNU General Public License as published by *
10 * the Free Software Foundation; either version 2 of the License, or *
11 * (at your option) any later version. *
13 * This program is distributed in the hope that it will be useful, *
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
16 * GNU General Public License for more details. *
18 * You should have received a copy of the GNU General Public License *
19 * along with this program. If not, see <http://www.gnu.org/licenses/>. *
20 ***************************************************************************/
27 #include <helper/log.h>
28 #include "breakpoints.h"
30 static const char * const breakpoint_type_strings[] = {
35 static const char * const watchpoint_rw_strings[] = {
41 /* monotonic counter/id-number for breakpoints and watch points */
42 static int bpwp_unique_id;
44 int breakpoint_add_internal(struct target *target,
45 target_addr_t address,
47 enum breakpoint_type type)
49 struct breakpoint *breakpoint = target->breakpoints;
50 struct breakpoint **breakpoint_p = &target->breakpoints;
58 if (breakpoint->address == address) {
59 /* FIXME don't assume "same address" means "same
60 * breakpoint" ... check all the parameters before
63 LOG_DEBUG("Duplicate Breakpoint address: " TARGET_ADDR_FMT " (BP %" PRIu32 ")",
64 address, breakpoint->unique_id);
67 breakpoint_p = &breakpoint->next;
68 breakpoint = breakpoint->next;
71 (*breakpoint_p) = malloc(sizeof(struct breakpoint));
72 (*breakpoint_p)->address = address;
73 (*breakpoint_p)->asid = 0;
74 (*breakpoint_p)->length = length;
75 (*breakpoint_p)->type = type;
76 (*breakpoint_p)->set = 0;
77 (*breakpoint_p)->orig_instr = malloc(length);
78 (*breakpoint_p)->next = NULL;
79 (*breakpoint_p)->unique_id = bpwp_unique_id++;
81 retval = target_add_breakpoint(target, *breakpoint_p);
85 case ERROR_TARGET_RESOURCE_NOT_AVAILABLE:
86 reason = "resource not available";
88 case ERROR_TARGET_NOT_HALTED:
89 reason = "target running";
92 reason = "unknown reason";
94 LOG_ERROR("can't add breakpoint: %s", reason);
95 free((*breakpoint_p)->orig_instr);
101 LOG_DEBUG("added %s breakpoint at " TARGET_ADDR_FMT " of length 0x%8.8x, (BPID: %" PRIu32 ")",
102 breakpoint_type_strings[(*breakpoint_p)->type],
103 (*breakpoint_p)->address, (*breakpoint_p)->length,
104 (*breakpoint_p)->unique_id);
109 int context_breakpoint_add_internal(struct target *target,
112 enum breakpoint_type type)
114 struct breakpoint *breakpoint = target->breakpoints;
115 struct breakpoint **breakpoint_p = &target->breakpoints;
122 if (breakpoint->asid == asid) {
123 /* FIXME don't assume "same address" means "same
124 * breakpoint" ... check all the parameters before
127 LOG_DEBUG("Duplicate Breakpoint asid: 0x%08" PRIx32 " (BP %" PRIu32 ")",
128 asid, breakpoint->unique_id);
131 breakpoint_p = &breakpoint->next;
132 breakpoint = breakpoint->next;
135 (*breakpoint_p) = malloc(sizeof(struct breakpoint));
136 (*breakpoint_p)->address = 0;
137 (*breakpoint_p)->asid = asid;
138 (*breakpoint_p)->length = length;
139 (*breakpoint_p)->type = type;
140 (*breakpoint_p)->set = 0;
141 (*breakpoint_p)->orig_instr = malloc(length);
142 (*breakpoint_p)->next = NULL;
143 (*breakpoint_p)->unique_id = bpwp_unique_id++;
144 retval = target_add_context_breakpoint(target, *breakpoint_p);
145 if (retval != ERROR_OK) {
146 LOG_ERROR("could not add breakpoint");
147 free((*breakpoint_p)->orig_instr);
149 *breakpoint_p = NULL;
153 LOG_DEBUG("added %s Context breakpoint at 0x%8.8" PRIx32 " of length 0x%8.8x, (BPID: %" PRIu32 ")",
154 breakpoint_type_strings[(*breakpoint_p)->type],
155 (*breakpoint_p)->asid, (*breakpoint_p)->length,
156 (*breakpoint_p)->unique_id);
161 int hybrid_breakpoint_add_internal(struct target *target,
162 target_addr_t address,
165 enum breakpoint_type type)
167 struct breakpoint *breakpoint = target->breakpoints;
168 struct breakpoint **breakpoint_p = &target->breakpoints;
174 if ((breakpoint->asid == asid) && (breakpoint->address == address)) {
175 /* FIXME don't assume "same address" means "same
176 * breakpoint" ... check all the parameters before
179 LOG_DEBUG("Duplicate Hybrid Breakpoint asid: 0x%08" PRIx32 " (BP %" PRIu32 ")",
180 asid, breakpoint->unique_id);
182 } else if ((breakpoint->address == address) && (breakpoint->asid == 0)) {
183 LOG_DEBUG("Duplicate Breakpoint IVA: " TARGET_ADDR_FMT " (BP %" PRIu32 ")",
184 address, breakpoint->unique_id);
188 breakpoint_p = &breakpoint->next;
189 breakpoint = breakpoint->next;
191 (*breakpoint_p) = malloc(sizeof(struct breakpoint));
192 (*breakpoint_p)->address = address;
193 (*breakpoint_p)->asid = asid;
194 (*breakpoint_p)->length = length;
195 (*breakpoint_p)->type = type;
196 (*breakpoint_p)->set = 0;
197 (*breakpoint_p)->orig_instr = malloc(length);
198 (*breakpoint_p)->next = NULL;
199 (*breakpoint_p)->unique_id = bpwp_unique_id++;
202 retval = target_add_hybrid_breakpoint(target, *breakpoint_p);
203 if (retval != ERROR_OK) {
204 LOG_ERROR("could not add breakpoint");
205 free((*breakpoint_p)->orig_instr);
207 *breakpoint_p = NULL;
211 "added %s Hybrid breakpoint at address " TARGET_ADDR_FMT " of length 0x%8.8x, (BPID: %" PRIu32 ")",
212 breakpoint_type_strings[(*breakpoint_p)->type],
213 (*breakpoint_p)->address,
214 (*breakpoint_p)->length,
215 (*breakpoint_p)->unique_id);
220 int breakpoint_add(struct target *target,
221 target_addr_t address,
223 enum breakpoint_type type)
225 int retval = ERROR_OK;
227 struct target_list *head;
230 if (type == BKPT_SOFT)
231 return breakpoint_add_internal(head->target, address, length, type);
233 while (head != (struct target_list *)NULL) {
235 retval = breakpoint_add_internal(curr, address, length, type);
236 if (retval != ERROR_OK)
242 return breakpoint_add_internal(target, address, length, type);
244 int context_breakpoint_add(struct target *target,
247 enum breakpoint_type type)
249 int retval = ERROR_OK;
251 struct target_list *head;
254 while (head != (struct target_list *)NULL) {
256 retval = context_breakpoint_add_internal(curr, asid, length, type);
257 if (retval != ERROR_OK)
263 return context_breakpoint_add_internal(target, asid, length, type);
265 int hybrid_breakpoint_add(struct target *target,
266 target_addr_t address,
269 enum breakpoint_type type)
271 int retval = ERROR_OK;
273 struct target_list *head;
276 while (head != (struct target_list *)NULL) {
278 retval = hybrid_breakpoint_add_internal(curr, address, asid, length, type);
279 if (retval != ERROR_OK)
285 return hybrid_breakpoint_add_internal(target, address, asid, length, type);
288 /* free up a breakpoint */
289 static void breakpoint_free(struct target *target, struct breakpoint *breakpoint_to_remove)
291 struct breakpoint *breakpoint = target->breakpoints;
292 struct breakpoint **breakpoint_p = &target->breakpoints;
296 if (breakpoint == breakpoint_to_remove)
298 breakpoint_p = &breakpoint->next;
299 breakpoint = breakpoint->next;
302 if (breakpoint == NULL)
305 retval = target_remove_breakpoint(target, breakpoint);
307 LOG_DEBUG("free BPID: %" PRIu32 " --> %d", breakpoint->unique_id, retval);
308 (*breakpoint_p) = breakpoint->next;
309 free(breakpoint->orig_instr);
313 int breakpoint_remove_internal(struct target *target, target_addr_t address)
315 struct breakpoint *breakpoint = target->breakpoints;
318 if ((breakpoint->address == address) ||
319 (breakpoint->address == 0 && breakpoint->asid == address))
321 breakpoint = breakpoint->next;
325 breakpoint_free(target, breakpoint);
329 LOG_ERROR("no breakpoint at address " TARGET_ADDR_FMT " found", address);
333 void breakpoint_remove(struct target *target, target_addr_t address)
337 struct target_list *head;
340 while (head != (struct target_list *)NULL) {
342 found += breakpoint_remove_internal(curr, address);
346 LOG_ERROR("no breakpoint at address " TARGET_ADDR_FMT " found", address);
348 breakpoint_remove_internal(target, address);
351 void breakpoint_clear_target_internal(struct target *target)
353 LOG_DEBUG("Delete all breakpoints for target: %s",
354 target_name(target));
355 while (target->breakpoints != NULL)
356 breakpoint_free(target, target->breakpoints);
359 void breakpoint_clear_target(struct target *target)
362 struct target_list *head;
365 while (head != (struct target_list *)NULL) {
367 breakpoint_clear_target_internal(curr);
371 breakpoint_clear_target_internal(target);
375 struct breakpoint *breakpoint_find(struct target *target, target_addr_t address)
377 struct breakpoint *breakpoint = target->breakpoints;
380 if (breakpoint->address == address)
382 breakpoint = breakpoint->next;
388 int watchpoint_add(struct target *target, target_addr_t address, uint32_t length,
389 enum watchpoint_rw rw, uint32_t value, uint32_t mask)
391 struct watchpoint *watchpoint = target->watchpoints;
392 struct watchpoint **watchpoint_p = &target->watchpoints;
397 if (watchpoint->address == address) {
398 if (watchpoint->length != length
399 || watchpoint->value != value
400 || watchpoint->mask != mask
401 || watchpoint->rw != rw) {
402 LOG_ERROR("address " TARGET_ADDR_FMT
403 " already has watchpoint %d",
404 address, watchpoint->unique_id);
408 /* ignore duplicate watchpoint */
411 watchpoint_p = &watchpoint->next;
412 watchpoint = watchpoint->next;
415 (*watchpoint_p) = calloc(1, sizeof(struct watchpoint));
416 (*watchpoint_p)->address = address;
417 (*watchpoint_p)->length = length;
418 (*watchpoint_p)->value = value;
419 (*watchpoint_p)->mask = mask;
420 (*watchpoint_p)->rw = rw;
421 (*watchpoint_p)->unique_id = bpwp_unique_id++;
423 retval = target_add_watchpoint(target, *watchpoint_p);
427 case ERROR_TARGET_RESOURCE_NOT_AVAILABLE:
428 reason = "resource not available";
430 case ERROR_TARGET_NOT_HALTED:
431 reason = "target running";
434 reason = "unrecognized error";
436 LOG_ERROR("can't add %s watchpoint at " TARGET_ADDR_FMT ", %s",
437 watchpoint_rw_strings[(*watchpoint_p)->rw],
440 *watchpoint_p = NULL;
444 LOG_DEBUG("added %s watchpoint at " TARGET_ADDR_FMT
445 " of length 0x%8.8" PRIx32 " (WPID: %d)",
446 watchpoint_rw_strings[(*watchpoint_p)->rw],
447 (*watchpoint_p)->address,
448 (*watchpoint_p)->length,
449 (*watchpoint_p)->unique_id);
454 static void watchpoint_free(struct target *target, struct watchpoint *watchpoint_to_remove)
456 struct watchpoint *watchpoint = target->watchpoints;
457 struct watchpoint **watchpoint_p = &target->watchpoints;
461 if (watchpoint == watchpoint_to_remove)
463 watchpoint_p = &watchpoint->next;
464 watchpoint = watchpoint->next;
467 if (watchpoint == NULL)
469 retval = target_remove_watchpoint(target, watchpoint);
470 LOG_DEBUG("free WPID: %d --> %d", watchpoint->unique_id, retval);
471 (*watchpoint_p) = watchpoint->next;
475 void watchpoint_remove(struct target *target, target_addr_t address)
477 struct watchpoint *watchpoint = target->watchpoints;
480 if (watchpoint->address == address)
482 watchpoint = watchpoint->next;
486 watchpoint_free(target, watchpoint);
488 LOG_ERROR("no watchpoint at address " TARGET_ADDR_FMT " found", address);
491 void watchpoint_clear_target(struct target *target)
493 LOG_DEBUG("Delete all watchpoints for target: %s",
494 target_name(target));
495 while (target->watchpoints != NULL)
496 watchpoint_free(target, target->watchpoints);
499 int watchpoint_hit(struct target *target, enum watchpoint_rw *rw,
500 target_addr_t *address)
503 struct watchpoint *hit_watchpoint;
505 retval = target_hit_watchpoint(target, &hit_watchpoint);
506 if (retval != ERROR_OK)
509 *rw = hit_watchpoint->rw;
510 *address = hit_watchpoint->address;
512 LOG_DEBUG("Found hit watchpoint at " TARGET_ADDR_FMT " (WPID: %d)",
513 hit_watchpoint->address,
514 hit_watchpoint->unique_id);