Add RTOS memory read/write functions.

[fw/openocd] / src / server / gdb_server.c

diff --git a/src/server/gdb_server.c b/src/server/gdb_server.c
index d0586d1706e89ded317c5845ab2e180efe1a3528..9ac982f6ca20b07fd79f4bf654ba71e3a6cc4e3e 100644 (file)
--- a/src/server/gdb_server.c
+++ b/src/server/gdb_server.c
@@ -1494,7 +1494,11 @@ static int gdb_read_memory_packet(struct connection *connection,
 
        LOG_DEBUG("addr: 0x%16.16" PRIx64 ", len: 0x%8.8" PRIx32 "", addr, len);
 
-       retval = target_read_buffer(target, addr, len, buffer);
+       retval = ERROR_NOT_IMPLEMENTED;
+       if (target->rtos)
+               retval = rtos_read_buffer(target, addr, len, buffer);
+       if (retval == ERROR_NOT_IMPLEMENTED)
+               retval = target_read_buffer(target, addr, len, buffer);
 
        if ((retval != ERROR_OK) && !gdb_report_data_abort) {
                /* TODO : Here we have to lie and send back all zero's lest stack traces won't work.
@@ -1565,7 +1569,11 @@ static int gdb_write_memory_packet(struct connection *connection,
        if (unhexify(buffer, separator, len) != len)
                LOG_ERROR("unable to decode memory packet");
 
-       retval = target_write_buffer(target, addr, len, buffer);
+       retval = ERROR_NOT_IMPLEMENTED;
+       if (target->rtos)
+               retval = rtos_write_buffer(target, addr, len, buffer);
+       if (retval == ERROR_NOT_IMPLEMENTED)
+               retval = target_write_buffer(target, addr, len, buffer);
 
        if (retval == ERROR_OK)
                gdb_put_packet(connection, "OK", 2);
@@ -1634,7 +1642,12 @@ static int gdb_write_memory_binary_packet(struct connection *connection,
        if (len) {
                LOG_DEBUG("addr: 0x%" PRIx64 ", len: 0x%8.8" PRIx32 "", addr, len);
 
-               retval = target_write_buffer(target, addr, len, (uint8_t *)separator);
+               retval = ERROR_NOT_IMPLEMENTED;
+               if (target->rtos)
+                       retval = rtos_write_buffer(target, addr, len, (uint8_t *)separator);
+               if (retval == ERROR_NOT_IMPLEMENTED)
+                       retval = target_write_buffer(target, addr, len, (uint8_t *)separator);
+
                if (retval != ERROR_OK)
                        gdb_connection->mem_write_error = true;
        }