//Allways update the FLASH_PAGE before each use, by calling stlink_calculate_pagesize
#define FLASH_PAGE (sl->flash_pgsz)
+stlink_t *connected_stlink = NULL;
+
static const char hex[] = "0123456789abcdef";
static const char* current_memory_map = NULL;
-/* Persistent mode flag.
- * In persistent mode, server starts listening again
- * on GDB disconnect. */
-int persistent = 0;
-
typedef struct _st_state_t {
// things from command line, bleh
int stlink_version;
char devicename[100];
int logging_level;
int listen_port;
+ int persistent;
} st_state_t;
-int serve(stlink_t *sl, int port);
+int serve(stlink_t *sl, st_state_t *st);
char* make_memory_map(stlink_t *sl);
+static void cleanup(int signal __attribute__((unused))) {
+ if (connected_stlink) {
+ /* Switch back to mass storage mode before closing. */
+ stlink_run(connected_stlink);
+ stlink_exit_debug_mode(connected_stlink);
+ stlink_close(connected_stlink);
+ }
+
+ exit(1);
+}
int parse_options(int argc, char** argv, st_state_t *st) {
static struct option long_options[] = {
st->listen_port = q;
break;
case 'm':
- persistent = 1;
+ st->persistent = 1;
break;
}
}
break;
}
+ connected_stlink = sl;
+ signal(SIGINT, &cleanup);
+
printf("Chip ID is %08x, Core ID is %08x.\n", sl->chip_id, sl->core_id);
sl->verbose=0;
#endif
do {
- serve(sl, state.listen_port);
- } while (persistent);
+ serve(sl, &state);
+ } while (state.persistent);
#ifdef __MINGW32__
winsock_error:
return error;
}
-int serve(stlink_t *sl, int port) {
+int serve(stlink_t *sl, st_state_t *st) {
int sock = socket(AF_INET, SOCK_STREAM, 0);
if(sock < 0) {
perror("socket");
struct sockaddr_in serv_addr;
memset(&serv_addr,0,sizeof(struct sockaddr_in));
serv_addr.sin_family = AF_INET;
- serv_addr.sin_addr.s_addr = inet_addr("127.0.0.1");
- serv_addr.sin_port = htons(port);
+ serv_addr.sin_addr.s_addr = INADDR_ANY;
+ serv_addr.sin_port = htons(st->listen_port);
if(bind(sock, (struct sockaddr *) &serv_addr, sizeof(serv_addr)) < 0) {
perror("bind");
init_code_breakpoints(sl);
init_data_watchpoints(sl);
- printf("Listening at *:%d...\n", port);
+ printf("Listening at *:%d...\n", st->listen_port);
int client = accept(sock, NULL, NULL);
//signal (SIGINT, SIG_DFL);
* Also, set to persistent mode
* to allow GDB disconnect.
*/
- persistent = 1;
+ st->persistent = 1;
reply = strdup("OK");