smp: replace commands smp_on/smp_off with "smp [on|off]"
[openocd.git] / src / target / smp.c
1 /***************************************************************************
2 * *
3 * Copyright (C) ST-Ericsson SA 2011 *
4 * Author: Michel Jaouen <michel.jaouen@stericsson.com> for ST-Ericsson. *
5 * This program is free software; you can redistribute it and/or modify *
6 * it under the terms of the GNU General Public License as published by *
7 * the Free Software Foundation; either version 2 of the License, or *
8 * (at your option) any later version. *
9 * *
10 * This program is distributed in the hope that it will be useful, *
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
13 * GNU General Public License for more details. *
14 * *
15 * You should have received a copy of the GNU General Public License *
16 * along with this program. If not, see <http://www.gnu.org/licenses/>. *
17 ***************************************************************************/
18
19 #ifdef HAVE_CONFIG_H
20 #include "config.h"
21 #endif
22
23 #include "server/server.h"
24
25 #include "target/target.h"
26
27 #include "server/gdb_server.h"
28 #include "smp.h"
29 #include "helper/binarybuffer.h"
30
31 /* implementation of new packet in gdb interface for smp feature */
32 /* */
33 /* j : smp status request */
34 /* J : smp set request */
35 /* */
36 /* jc :read core id displayed by gdb connection */
37 /* reply XXXXXXXX core id is int32_t , 8 hex digits */
38 /* */
39 /* Reply ENN error not supported (target not smp) */
40 /* */
41 /* JcXX set core id displayed at next gdb continue */
42 /* maximum 8 bytes described core id int32_t (8 hex digits) */
43 /* (core id -1 , reserved for returning to normal continue mode) */
44 /* Reply ENN error not supported(target not smp,core id out of range) */
45 /* Reply OK : for success */
46 /* */
47 /* handling of this packet within gdb can be done by the creation */
48 /* internal variable by mean of function allocate_computed_value */
49 /* set $_core 1 => Jc01 packet is sent */
50 /* print $_core => jc packet is sent and result is affected in $ */
51 /* Another way to test this packet is the usage of maintenance packet */
52 /* maint packet Jc01 */
53 /* maint packet jc */
54
55 /* packet j :smp status request */
56 int gdb_read_smp_packet(struct connection *connection,
57 char const *packet, int packet_size)
58 {
59 struct target *target = get_target_from_connection(connection);
60 int retval = ERROR_OK;
61 if (target->smp) {
62 if (strncmp(packet, "jc", 2) == 0) {
63 const uint32_t len = sizeof(target->gdb_service->core[0]);
64 char hex_buffer[len * 2 + 1];
65 uint8_t buffer[len];
66 buf_set_u32(buffer, 0, len * 8, target->gdb_service->core[0]);
67 size_t pkt_len = hexify(hex_buffer, buffer, sizeof(buffer),
68 sizeof(hex_buffer));
69
70 retval = gdb_put_packet(connection, hex_buffer, pkt_len);
71 }
72 } else
73 retval = gdb_put_packet(connection, "E01", 3);
74 return retval;
75 }
76
77 /* J : smp set request */
78 int gdb_write_smp_packet(struct connection *connection,
79 char const *packet, int packet_size)
80 {
81 struct target *target = get_target_from_connection(connection);
82 char *separator;
83 int coreid = 0;
84 int retval = ERROR_OK;
85
86 /* skip command character */
87 if (target->smp) {
88 if (strncmp(packet, "Jc", 2) == 0) {
89 packet += 2;
90 coreid = strtoul(packet, &separator, 16);
91 target->gdb_service->core[1] = coreid;
92 retval = gdb_put_packet(connection, "OK", 2);
93 }
94 } else
95 retval = gdb_put_packet(connection, "E01", 3);
96
97 return retval;
98 }
99
100 COMMAND_HANDLER(default_handle_smp_command)
101 {
102 struct target *target = get_current_target(CMD_CTX);
103 struct target_list *head;
104
105 if (CMD_ARGC > 1)
106 return ERROR_COMMAND_SYNTAX_ERROR;
107
108 if (!CMD_ARGC) {
109 command_print(CMD_CTX, "%s", target->smp ? "on" : "off");
110 return ERROR_OK;
111 }
112
113 if (!strcmp(CMD_ARGV[0], "on")) {
114 foreach_smp_target(head, target->head)
115 head->target->smp = 1;
116
117 return ERROR_OK;
118 }
119
120 if (!strcmp(CMD_ARGV[0], "off")) {
121 foreach_smp_target(head, target->head)
122 head->target->smp = 0;
123
124 /* fixes the target display to the debugger */
125 if (target->head)
126 target->gdb_service->target = target;
127
128 return ERROR_OK;
129 }
130
131 return ERROR_COMMAND_SYNTAX_ERROR;
132 }
133
134 COMMAND_HANDLER(deprecated_handle_smp_on_command)
135 {
136 const char *argv[] = {"on", NULL};
137
138 LOG_WARNING("\'smp_on\' is deprecated, please use \'smp on\' instead.");
139 CMD_ARGC = 1;
140 CMD_ARGV = argv;
141 return CALL_COMMAND_HANDLER(default_handle_smp_command);
142 }
143
144 COMMAND_HANDLER(deprecated_handle_smp_off_command)
145 {
146 const char *argv[] = {"off", NULL};
147
148 LOG_WARNING("\'smp_off\' is deprecated, please use \'smp off\' instead.");
149 CMD_ARGC = 1;
150 CMD_ARGV = argv;
151 return CALL_COMMAND_HANDLER(default_handle_smp_command);
152 }
153
154 const struct command_registration smp_command_handlers[] = {
155 {
156 .name = "smp",
157 .handler = default_handle_smp_command,
158 .mode = COMMAND_EXEC,
159 .help = "smp handling",
160 .usage = "[on|off]",
161 },
162 {
163 .name = "smp_on",
164 .handler = deprecated_handle_smp_on_command,
165 .mode = COMMAND_EXEC,
166 .help = "Restart smp handling",
167 .usage = "",
168 },
169 {
170 .name = "smp_off",
171 .handler = deprecated_handle_smp_off_command,
172 .mode = COMMAND_EXEC,
173 .help = "Stop smp handling",
174 .usage = "",
175 },
176 COMMAND_REGISTRATION_DONE
177 };