projects / fw / openocd / blobdiff
? search:
summary | shortlog | log | commit | commitdiff | tree
raw | inline | side by side
breakpoint_t -> struct breakpoint
[fw/openocd] / src / target / breakpoints.c
diff --git a/src/target/breakpoints.c b/src/target/breakpoints.c
index 88986518543ca569bb2c7addfcfb32a2bfe71e16..a65ca824e5f9f6d61b52628e055dab25be001ec8 100644 (file)
--- a/src/target/breakpoints.c
+++ b/src/target/breakpoints.c
@@ -44,8 +44,8 @@ static int bpwp_unique_id;
 
 int breakpoint_add(target_t *target, uint32_t address, uint32_t length, enum breakpoint_type type)
 {
-       breakpoint_t *breakpoint = target->breakpoints;
-       breakpoint_t **breakpoint_p = &target->breakpoints;
+       struct breakpoint *breakpoint = target->breakpoints;
+       struct breakpoint **breakpoint_p = &target->breakpoints;
        int retval;
        int n;
 
@@ -62,7 +62,7 @@ int breakpoint_add(target_t *target, uint32_t address, uint32_t length, enum bre
                breakpoint = breakpoint->next;
        }
 
-       (*breakpoint_p) = malloc(sizeof(breakpoint_t));
+       (*breakpoint_p) = malloc(sizeof(struct breakpoint));
        (*breakpoint_p)->address = address;
        (*breakpoint_p)->length = length;
        (*breakpoint_p)->type = type;
@@ -107,10 +107,10 @@ int breakpoint_add(target_t *target, uint32_t address, uint32_t length, enum bre
 }
 
 /* free up a breakpoint */
-static void breakpoint_free(target_t *target, breakpoint_t *breakpoint_remove)
+static void breakpoint_free(target_t *target, struct breakpoint *breakpoint_remove)
 {
-       breakpoint_t *breakpoint = target->breakpoints;
-       breakpoint_t **breakpoint_p = &target->breakpoints;
+       struct breakpoint *breakpoint = target->breakpoints;
+       struct breakpoint **breakpoint_p = &target->breakpoints;
 
        while (breakpoint)
        {
@@ -133,8 +133,8 @@ static void breakpoint_free(target_t *target, breakpoint_t *breakpoint_remove)
 
 void breakpoint_remove(target_t *target, uint32_t address)
 {
-       breakpoint_t *breakpoint = target->breakpoints;
-       breakpoint_t **breakpoint_p = &target->breakpoints;
+       struct breakpoint *breakpoint = target->breakpoints;
+       struct breakpoint **breakpoint_p = &target->breakpoints;
 
        while (breakpoint)
        {
@@ -156,7 +156,7 @@ void breakpoint_remove(target_t *target, uint32_t address)
 
 void breakpoint_clear_target(target_t *target)
 {
-       breakpoint_t *breakpoint;
+       struct breakpoint *breakpoint;
        LOG_DEBUG("Delete all breakpoints for target: %s", target_get_name( target ));
        while ((breakpoint = target->breakpoints) != NULL)
        {
@@ -164,9 +164,9 @@ void breakpoint_clear_target(target_t *target)
        }
 }
 
-breakpoint_t* breakpoint_find(target_t *target, uint32_t address)
+struct breakpoint* breakpoint_find(target_t *target, uint32_t address)
 {
-       breakpoint_t *breakpoint = target->breakpoints;
+       struct breakpoint *breakpoint = target->breakpoints;
 
        while (breakpoint)
        {
@@ -178,54 +178,61 @@ breakpoint_t* breakpoint_find(target_t *target, uint32_t address)
        return NULL;
 }
 
-int watchpoint_add(target_t *target, uint32_t address, uint32_t length, enum watchpoint_rw rw, uint32_t value, uint32_t mask)
+int watchpoint_add(target_t *target, uint32_t address, uint32_t length,
+               enum watchpoint_rw rw, uint32_t value, uint32_t mask)
 {
-       watchpoint_t *watchpoint = target->watchpoints;
-       watchpoint_t **watchpoint_p = &target->watchpoints;
+       struct watchpoint *watchpoint = target->watchpoints;
+       struct watchpoint **watchpoint_p = &target->watchpoints;
        int retval;
+       char *reason;
 
        while (watchpoint)
        {
-               if (watchpoint->address == address)
+               if (watchpoint->address == address) {
+                       if (watchpoint->length != length
+                                       || watchpoint->value != value
+                                       || watchpoint->mask != mask
+                                       || watchpoint->rw != rw) {
+                               LOG_ERROR("address 0x%8.8" PRIx32
+                                               "already has watchpoint %d",
+                                               address, watchpoint->unique_id);
+                               return ERROR_FAIL;
+                       }
+
+                       /* ignore duplicate watchpoint */
                        return ERROR_OK;
+               }
                watchpoint_p = &watchpoint->next;
                watchpoint = watchpoint->next;
        }
 
-       (*watchpoint_p) = malloc(sizeof(watchpoint_t));
+       (*watchpoint_p) = calloc(1, sizeof(struct watchpoint));
        (*watchpoint_p)->address = address;
        (*watchpoint_p)->length = length;
        (*watchpoint_p)->value = value;
        (*watchpoint_p)->mask = mask;
        (*watchpoint_p)->rw = rw;
-       (*watchpoint_p)->set = 0;
-       (*watchpoint_p)->next = NULL;
        (*watchpoint_p)->unique_id = bpwp_unique_id++;
 
-       if ((retval = target_add_watchpoint(target, *watchpoint_p)) != ERROR_OK)
-       {
-               switch (retval)
-               {
-                       case ERROR_TARGET_RESOURCE_NOT_AVAILABLE:
-                               LOG_INFO("can't add %s watchpoint, resource not available (WPID: %d)",
-                                        watchpoint_rw_strings[(*watchpoint_p)->rw],
-                                        (*watchpoint_p)->unique_id );
-                               free (*watchpoint_p);
-                               *watchpoint_p = NULL;
-                               return retval;
-                               break;
-                       case ERROR_TARGET_NOT_HALTED:
-                               LOG_INFO("can't add watchpoint while target is running (WPID: %d)",
-                                                (*watchpoint_p)->unique_id );
-                               free (*watchpoint_p);
-                               *watchpoint_p = NULL;
-                               return retval;
-                               break;
-                       default:
-                               LOG_ERROR("unknown error");
-                               exit(-1);
-                               break;
-               }
+       retval = target_add_watchpoint(target, *watchpoint_p);
+       switch (retval) {
+       case ERROR_OK:
+               break;
+       case ERROR_TARGET_RESOURCE_NOT_AVAILABLE:
+               reason = "resource not available";
+               goto bye;
+       case ERROR_TARGET_NOT_HALTED:
+               reason = "target running";
+               goto bye;
+       default:
+               reason = "unrecognized error";
+bye:
+               LOG_ERROR("can't add %s watchpoint at 0x%8.8" PRIx32 ", %s",
+                        watchpoint_rw_strings[(*watchpoint_p)->rw],
+                        address, reason);
+               free (*watchpoint_p);
+               *watchpoint_p = NULL;
+               return retval;
        }
 
        LOG_DEBUG("added %s watchpoint at 0x%8.8" PRIx32 " of length 0x%8.8x (WPID: %d)",
@@ -237,10 +244,10 @@ int watchpoint_add(target_t *target, uint32_t address, uint32_t length, enum wat
        return ERROR_OK;
 }
 
-static void watchpoint_free(target_t *target, watchpoint_t *watchpoint_remove)
+static void watchpoint_free(target_t *target, struct watchpoint *watchpoint_remove)
 {
-       watchpoint_t *watchpoint = target->watchpoints;
-       watchpoint_t **watchpoint_p = &target->watchpoints;
+       struct watchpoint *watchpoint = target->watchpoints;
+       struct watchpoint **watchpoint_p = &target->watchpoints;
 
        while (watchpoint)
        {
@@ -260,8 +267,8 @@ static void watchpoint_free(target_t *target, watchpoint_t *watchpoint_remove)
 
 void watchpoint_remove(target_t *target, uint32_t address)
 {
-       watchpoint_t *watchpoint = target->watchpoints;
-       watchpoint_t **watchpoint_p = &target->watchpoints;
+       struct watchpoint *watchpoint = target->watchpoints;
+       struct watchpoint **watchpoint_p = &target->watchpoints;
 
        while (watchpoint)
        {
@@ -283,7 +290,7 @@ void watchpoint_remove(target_t *target, uint32_t address)
 
 void watchpoint_clear_target(target_t *target)
 {
-       watchpoint_t *watchpoint;
+       struct watchpoint *watchpoint;
        LOG_DEBUG("Delete all watchpoints for target: %s", target_get_name( target ));
        while ((watchpoint = target->watchpoints) != NULL)
        {
openocd with support for Altus Metrum targets