X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=gdbserver%2Fgdb-server.c;h=a6de1b20d2db8f68fc6f2891e2b5e1f338ce809e;hb=5851dee3cd95d7b0276caa22b9d2992c8b1147fa;hp=f9c06f9831b17fee476e36b12e42472ad63ce4fe;hpb=04c142c69b0075a2004896d7046fe78fd015a02c;p=fw%2Fstlink

diff --git a/gdbserver/gdb-server.c b/gdbserver/gdb-server.c
index f9c06f9..a6de1b2 100644
--- a/gdbserver/gdb-server.c
+++ b/gdbserver/gdb-server.c
@@ -50,12 +50,14 @@ typedef struct _st_state_t {
     int logging_level;
 	int listen_port;
     int persistent;
+    int reset;
 } st_state_t;
 
 
 int serve(stlink_t *sl, st_state_t *st);
 char* make_memory_map(stlink_t *sl);
 
+#ifndef __MINGW32__
 static void cleanup(int signal __attribute__((unused))) {
     if (connected_stlink) {
         /* Switch back to mass storage mode before closing. */
@@ -66,6 +68,7 @@ static void cleanup(int signal __attribute__((unused))) {
 
     exit(1);
 }
+#endif
 
 
 
@@ -78,6 +81,7 @@ int parse_options(int argc, char** argv, st_state_t *st) {
         {"stlinkv1", no_argument, NULL, '1'},
 		{"listen_port", required_argument, NULL, 'p'},
 		{"multi", optional_argument, NULL, 'm'},
+		{"no-reset", optional_argument, NULL, 'n'},
         {0, 0, 0, 0},
     };
 	const char * help_str = "%s - usage:\n\n"
@@ -95,13 +99,15 @@ int parse_options(int argc, char** argv, st_state_t *st) {
     "  -m, --multi\n"
     "\t\t\tSet gdb server to extended mode.\n"
     "\t\t\tst-util will continue listening for connections after disconnect.\n"
+    "  -n, --no-reset\n"
+    "\t\t\tDo not reset board on connection.\n"
 	;
 
 
     int option_index = 0;
     int c;
     int q;
-    while ((c = getopt_long(argc, argv, "hv::d:s:1p:m", long_options, &option_index)) != -1) {
+    while ((c = getopt_long(argc, argv, "hv::d:s:1p:mn", long_options, &option_index)) != -1) {
         switch (c) {
         case 0:
             printf("XXXXX Shouldn't really normally come here, only if there's no corresponding option\n");
@@ -151,6 +157,9 @@ int parse_options(int argc, char** argv, st_state_t *st) {
 		case 'm':
 			st->persistent = 1;
 			break;
+		case 'n':
+			st->reset = 0;
+			break;
         }
     }
 
@@ -165,6 +174,7 @@ int parse_options(int argc, char** argv, st_state_t *st) {
 
 
 int main(int argc, char** argv) {
+	uint32_t voltage;
 
 	stlink_t *sl = NULL;
 
@@ -174,24 +184,36 @@ int main(int argc, char** argv) {
 	state.stlink_version = 2;
 	state.logging_level = DEFAULT_LOGGING_LEVEL;
 	state.listen_port = DEFAULT_GDB_LISTEN_PORT;
+	state.reset = 1;    /* By default, reset board */
 	parse_options(argc, argv, &state);
 	switch (state.stlink_version) {
 	case 2:
-		sl = stlink_open_usb(state.logging_level);
+		sl = stlink_open_usb(state.logging_level, 0);
 		if(sl == NULL) return 1;
 		break;
 	case 1:
-		sl = stlink_v1_open(state.logging_level);
+		sl = stlink_v1_open(state.logging_level, 0);
 		if(sl == NULL) return 1;
 		break;
     }
 
     connected_stlink = sl;
+#ifndef __MINGW32__
     signal(SIGINT, &cleanup);
     signal(SIGTERM, &cleanup);
+#endif
+
+    if (state.reset) {
+		stlink_reset(sl);
+    }
 
 	printf("Chip ID is %08x, Core ID is  %08x.\n", sl->chip_id, sl->core_id);
 
+	voltage = stlink_target_voltage(sl);
+	if (voltage != -1) {
+		printf("Target voltage is %d mV.\n", voltage);
+	}
+
 	sl->verbose=0;
 
 	current_memory_map = make_memory_map(sl);
@@ -205,6 +227,9 @@ int main(int argc, char** argv) {
 
 	do {
 		serve(sl, &state);
+
+		/* Continue */
+		stlink_run(sl);
 	} while (state.persistent);
 
 #ifdef __MINGW32__
@@ -213,7 +238,6 @@ winsock_error:
 #endif
 
 	/* Switch back to mass storage mode before closing. */
-	stlink_run(sl);
 	stlink_exit_debug_mode(sl);
 	stlink_close(sl);
 
@@ -370,7 +394,7 @@ struct code_hw_watchpoint {
 struct code_hw_watchpoint data_watches[DATA_WATCH_NUM];
 
 static void init_data_watchpoints(stlink_t *sl) {
-	#ifdef DEBUG
+	#if DEBUG
 	printf("init watchpoints\n");
 	#endif
 
@@ -405,7 +429,7 @@ static int add_data_watchpoint(stlink_t *sl, enum watchfun wf, stm32_addr_t addr
 		for(i = 0; i < DATA_WATCH_NUM; i++) {
 			// is this an empty slot ?
 			if(data_watches[i].fun == WATCHDISABLED) {
-				#ifdef DEBUG
+				#if DEBUG
 				printf("insert watchpoint %d addr %x wf %u mask %u len %d\n", i, addr, wf, mask, len);
 				#endif
 
@@ -429,7 +453,7 @@ static int add_data_watchpoint(stlink_t *sl, enum watchfun wf, stm32_addr_t addr
 		}
 	}
 
-	#ifdef DEBUG
+	#if DEBUG
 	printf("failure: add watchpoints addr %x wf %u len %u\n", addr, wf, len);
 	#endif
 	return -1;
@@ -441,7 +465,7 @@ static int delete_data_watchpoint(stlink_t *sl, stm32_addr_t addr)
 
 	for(i = 0 ; i < DATA_WATCH_NUM; i++) {
 		if((data_watches[i].addr == addr) && (data_watches[i].fun != WATCHDISABLED)) {
-			#ifdef DEBUG
+			#if DEBUG
 			printf("delete watchpoint %d addr %x\n", i, addr);
 			#endif
 
@@ -452,7 +476,7 @@ static int delete_data_watchpoint(stlink_t *sl, stm32_addr_t addr)
 		}
 	}
 
-	#ifdef DEBUG
+	#if DEBUG
 	printf("failure: delete watchpoint addr %x\n", addr);
 	#endif
 
@@ -513,7 +537,7 @@ static int update_code_breakpoint(stlink_t *sl, stm32_addr_t addr, int set) {
 	else	brk->type &= ~type;
 
 	if(brk->type == 0) {
-		#ifdef DEBUG
+		#if DEBUG
 		printf("clearing hw break %d\n", id);
 		#endif
 
@@ -521,7 +545,7 @@ static int update_code_breakpoint(stlink_t *sl, stm32_addr_t addr, int set) {
 	} else {
 	        uint32_t mask = (brk->addr) | 1 | (brk->type << 30);
 
-		#ifdef DEBUG
+		#if DEBUG
 		printf("setting hw break %d at %08x (%d)\n",
 			id, brk->addr, brk->type);
 		printf("reg %08x \n",
@@ -617,7 +641,7 @@ static int flash_go(stlink_t *sl) {
 	stlink_reset(sl);
 
 	for(struct flash_block* fb = flash_root; fb; fb = fb->next) {
-		#ifdef DEBUG
+		#if DEBUG
 		printf("flash_do: block %08x -> %04x\n", fb->addr, fb->length);
 		#endif
 
@@ -627,7 +651,7 @@ static int flash_go(stlink_t *sl) {
 			//Update FLASH_PAGE
 			stlink_calculate_pagesize(sl, page);
 
-			#ifdef DEBUG
+			#if DEBUG
 			printf("flash_do: page %08x\n", page);
 			#endif
 
@@ -679,11 +703,6 @@ int serve(stlink_t *sl, st_state_t *st) {
 		return 1;
 	}
 
-	stlink_force_debug(sl);
-	stlink_reset(sl);
-	init_code_breakpoints(sl);
-	init_data_watchpoints(sl);
-
 	printf("Listening at *:%d...\n", st->listen_port);
 
 	int client = accept(sock, NULL, NULL);
@@ -695,6 +714,13 @@ int serve(stlink_t *sl, st_state_t *st) {
 
 	close(sock);
 
+	stlink_force_debug(sl);
+	if (st->reset) {
+		stlink_reset(sl);
+    }
+	init_code_breakpoints(sl);
+	init_data_watchpoints(sl);
+
 	printf("GDB connected.\n");
 
 	/*
@@ -712,7 +738,7 @@ int serve(stlink_t *sl, st_state_t *st) {
 			return 1;
 		}
 
-		#ifdef DEBUG
+		#if DEBUG
 		printf("recv: %s\n", packet);
 		#endif
 
@@ -737,7 +763,7 @@ int serve(stlink_t *sl, st_state_t *st) {
 			char* queryName = calloc(queryNameLength + 1, 1);
 			strncpy(queryName, &packet[1], queryNameLength);
 
-			#ifdef DEBUG
+			#if DEBUG
 			printf("query: %s;%s\n", queryName, params);
 			#endif
 
@@ -762,7 +788,7 @@ int serve(stlink_t *sl, st_state_t *st) {
 				unsigned addr = strtoul(__s_addr, NULL, 16),
 				       length = strtoul(s_length, NULL, 16);
 
-				#ifdef DEBUG
+				#if DEBUG
 				printf("Xfer: type:%s;op:%s;annex:%s;addr:%d;length:%d\n",
 					type, op, annex, addr, length);
 				#endif
@@ -799,7 +825,7 @@ int serve(stlink_t *sl, st_state_t *st) {
 
 
 				if (!strncmp(params,"726573756d65",12)) {// resume
-#ifdef DEBUG
+#if DEBUG
 					printf("Rcmd: resume\n");
 #endif
 					stlink_run(sl);
@@ -810,7 +836,7 @@ int serve(stlink_t *sl, st_state_t *st) {
 
 					stlink_force_debug(sl);
 
-#ifdef DEBUG
+#if DEBUG
 					printf("Rcmd: halt\n");
 #endif
                 } else if (!strncmp(params,"6a7461675f7265736574",20)) { //jtag_reset
@@ -820,7 +846,7 @@ int serve(stlink_t *sl, st_state_t *st) {
 					stlink_jtag_reset(sl, 0);
 					stlink_force_debug(sl);
 
-#ifdef DEBUG
+#if DEBUG
 					printf("Rcmd: jtag_reset\n");
 #endif
                 } else if (!strncmp(params,"7265736574",10)) { //reset
@@ -831,11 +857,11 @@ int serve(stlink_t *sl, st_state_t *st) {
 					init_code_breakpoints(sl);
 					init_data_watchpoints(sl);
 
-#ifdef DEBUG
+#if DEBUG
 					printf("Rcmd: reset\n");
 #endif
 				} else {
-#ifdef DEBUG
+#if DEBUG
 					printf("Rcmd: %s\n", params);
 #endif
 
@@ -867,7 +893,7 @@ int serve(stlink_t *sl, st_state_t *st) {
 				unsigned addr = strtoul(__s_addr, NULL, 16),
 				       length = strtoul(s_length, NULL, 16);
 
-				#ifdef DEBUG
+				#if DEBUG
 				printf("FlashErase: addr:%08x,len:%04x\n",
 					addr, length);
 				#endif
@@ -905,7 +931,7 @@ int serve(stlink_t *sl, st_state_t *st) {
 				if(dec_index % 2 != 0)
 					dec_index++;
 
-				#ifdef DEBUG
+				#if DEBUG
 				printf("binary packet %d -> %d\n", data_length, dec_index);
 				#endif
 
@@ -1247,7 +1273,7 @@ int serve(stlink_t *sl, st_state_t *st) {
 		}
 
 		if(reply) {
-			#ifdef DEBUG
+			#if DEBUG
 			printf("send: %s\n", reply);
 			#endif