From b778b36f29b74d6d571df85f984ae684672ea162 Mon Sep 17 00:00:00 2001 From: Michel Jaouen Date: Tue, 19 Apr 2011 08:43:33 +0200 Subject: smp : infra for smp minimum support --- src/target/smp.c | 116 +++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 116 insertions(+) create mode 100644 src/target/smp.c (limited to 'src/target/smp.c') diff --git a/src/target/smp.c b/src/target/smp.c new file mode 100644 index 00000000..aabfa5b8 --- /dev/null +++ b/src/target/smp.c @@ -0,0 +1,116 @@ +/*************************************************************************** + * * + * Copyright (C) ST-Ericsson SA 2011 * + * Author: Michel Jaouen for ST-Ericsson. * + * This program is free software; you can redistribute it and/or modify * + * it under the terms of the GNU General Public License as published by * + * the Free Software Foundation; either version 2 of the License, or * + * (at your option) any later version. * + * * + * This program is distributed in the hope that it will be useful, * + * but WITHOUT ANY WARRANTY; without even the implied warranty of * + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * + * GNU General Public License for more details. * + * * + * You should have received a copy of the GNU General Public License * + * along with this program; if not, write to the * + * 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 + +#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 */ +/* J : smp set request */ +/* */ +/* jc :read core id displayed by gdb connection */ +/* reply XXXXXXXX core id is int32_t , 8 hex digits */ +/* */ +/* Reply ENN error not supported (target not smp) */ +/* */ +/* JcXX set core id displayed at next gdb continue */ +/* maximum 8 bytes described core id int32_t (8 hex digits) */ +/* (core id -1 , reserved for returning to normal continue mode) */ +/* Reply ENN error not supported(target not smp,core id out of range) */ +/* Reply OK : for success */ +/* */ +/* handling of this packet within gdb can be done by the creation */ +/* internal variable by mean of function allocate_computed_value */ +/* set $_core 1 => Jc01 packet is sent */ +/* print $_core => jc packet is sent and result is affected in $ */ +/* Another way to test this packet is the usage of maintenance packet */ +/* maint packet Jc01 */ +/* maint packet jc */ + +static const char DIGITS[16] = "0123456789abcdef"; + + +/* packet j :smp status request */ +int gdb_read_smp_packet(struct connection *connection, + struct target *target, char *packet, int packet_size) +{ + uint32_t len = sizeof(int32_t); + uint8_t *buffer; + char *hex_buffer; + int retval = ERROR_OK; + if (target->smp) + { + if (strstr(packet, "jc")) + { + hex_buffer = malloc(len * 2 + 1); + buffer = (uint8_t *)&target->gdb_service->core[0]; + uint32_t 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]; + } + + gdb_put_packet(connection, hex_buffer, len * 2); + + free(hex_buffer); + } + } + else + retval = gdb_put_packet(connection,"E01",3); + return retval; +} + +/* J : smp set request */ +int gdb_write_smp_packet(struct connection *connection, + struct target *target, char *packet, int packet_size) +{ + char *separator; + int coreid = 0; + int retval = ERROR_OK; + + /* skip command character */ + if (target->smp) + { + if (strstr(packet, "Jc")) + { + packet+=2; + coreid = strtoul(packet, &separator, 16); + target->gdb_service->core[1] = coreid; + gdb_put_packet(connection, "OK", 2); + } + } + else + { + retval = gdb_put_packet(connection,"E01",3); + } + return ERROR_OK; +} -- cgit v1.2.3