mips: optimize read code for speed

[fw/openocd] / src / target / smp.c

diff --git a/src/target/smp.c b/src/target/smp.c
index eed3d8ca9780c438f26d94a5acb6c2612d575d08..ccbc2be434916998ac5692df499a74b132ba4af1 100644 (file)
--- a/src/target/smp.c
+++ b/src/target/smp.c
@@ -17,19 +17,18 @@
  *   Free Software Foundation, Inc.,                                       *
  *   59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.             *
  ***************************************************************************/
+
 #ifdef HAVE_CONFIG_H
 #include "config.h"
 #endif
 
 #include "server/server.h"
-#include <helper/types.h>
 
 #include "target/target.h"
 
 #include "server/gdb_server.h"
 #include "smp.h"
 
-
 /*  implementation of new packet in gdb interface for smp feature          */
 /*                                                                         */
 /*   j : smp  status request                                               */
@@ -53,9 +52,8 @@
 /*  Another way to test this packet is the usage of maintenance packet     */
 /*  maint packet Jc01                                                      */
 /*  maint packet jc                                                        */
-                                                
-static const char DIGITS[16] = "0123456789abcdef";
 
+static const char DIGITS[16] = "0123456789abcdef";
 
 /* packet j :smp status request */
 int gdb_read_smp_packet(struct connection *connection,
@@ -66,15 +64,12 @@ int gdb_read_smp_packet(struct connection *connection,
        uint8_t *buffer;
        char *hex_buffer;
        int retval = ERROR_OK;
-       if (target->smp)
-       {
-               if (strstr(packet, "jc"))
-               {
+       if (target->smp) {
+               if (strncmp(packet, "jc", 2) == 0) {
                        hex_buffer = malloc(len * 2 + 1);
                        buffer = (uint8_t *)&target->gdb_service->core[0];
                        uint32_t i;
-                       for (i = 0; i < 4; i++)
-                       {
+                       for (i = 0; i < 4; i++) {
                                uint8_t t = buffer[i];
                                hex_buffer[2 * i] = DIGITS[(t >> 4) & 0xf];
                                hex_buffer[2 * i + 1] = DIGITS[t & 0xf];
@@ -84,9 +79,8 @@ int gdb_read_smp_packet(struct connection *connection,
 
                        free(hex_buffer);
                }
-       }
-       else
-               retval = gdb_put_packet(connection,"E01",3);
+       } else
+               retval = gdb_put_packet(connection, "E01", 3);
        return retval;
 }
 
@@ -100,20 +94,15 @@ int gdb_write_smp_packet(struct connection *connection,
        int retval = ERROR_OK;
 
        /* skip command character */
-       if (target->smp)
-       {
-               if (strstr(packet, "Jc"))
-               {
-                       packet+=2;
+       if (target->smp) {
+               if (strncmp(packet, "Jc", 2) == 0) {
+                       packet += 2;
                        coreid = strtoul(packet, &separator, 16);
                        target->gdb_service->core[1] = coreid;
                        retval = gdb_put_packet(connection, "OK", 2);
                }
-       }
-       else
-       {
-               retval = gdb_put_packet(connection,"E01",3);
-       }
+       } else
+               retval = gdb_put_packet(connection, "E01", 3);
 
        return retval;
 }