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. */
exit(1);
}
+#endif
int main(int argc, char** argv) {
+ uint32_t voltage;
stlink_t *sl = NULL;
}
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);
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
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
}
}
- #ifdef DEBUG
+ #if DEBUG
printf("failure: add watchpoints addr %x wf %u len %u\n", addr, wf, len);
#endif
return -1;
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
}
}
- #ifdef DEBUG
+ #if DEBUG
printf("failure: delete watchpoint addr %x\n", addr);
#endif
else brk->type &= ~type;
if(brk->type == 0) {
- #ifdef DEBUG
+ #if DEBUG
printf("clearing hw break %d\n", id);
#endif
} 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",
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
//Update FLASH_PAGE
stlink_calculate_pagesize(sl, page);
- #ifdef DEBUG
+ #if DEBUG
printf("flash_do: page %08x\n", page);
#endif
return 1;
}
- #ifdef DEBUG
+ #if DEBUG
printf("recv: %s\n", packet);
#endif
char* queryName = calloc(queryNameLength + 1, 1);
strncpy(queryName, &packet[1], queryNameLength);
- #ifdef DEBUG
+ #if DEBUG
printf("query: %s;%s\n", queryName, params);
#endif
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
if (!strncmp(params,"726573756d65",12)) {// resume
-#ifdef DEBUG
+#if DEBUG
printf("Rcmd: resume\n");
#endif
stlink_run(sl);
stlink_force_debug(sl);
-#ifdef DEBUG
+#if DEBUG
printf("Rcmd: halt\n");
#endif
} else if (!strncmp(params,"6a7461675f7265736574",20)) { //jtag_reset
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
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
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
if(dec_index % 2 != 0)
dec_index++;
- #ifdef DEBUG
+ #if DEBUG
printf("binary packet %d -> %d\n", data_length, dec_index);
#endif
}
if(reply) {
- #ifdef DEBUG
+ #if DEBUG
printf("send: %s\n", reply);
#endif