- stlink_t* sl = NULL;
- struct opts o;
- int err = -1;
-
- o.size = 0;
- if (get_opts(&o, ac - 1, av + 1) == -1)
- {
- printf("invalid command line\n");
- usage();
- goto on_error;
- }
-
- if (o.devname != NULL) /* stlinkv1 */
- {
- sl = stlink_v1_open(50, 1);
- if (sl == NULL) goto on_error;
- sl->verbose = 50;
- }
- else /* stlinkv2 */
- {
- sl = stlink_open_usb(50, 1);
- if (sl == NULL) goto on_error;
- sl->verbose = 50;
- }
-
- if (stlink_current_mode(sl) == STLINK_DEV_DFU_MODE)
- stlink_exit_dfu_mode(sl);
-
- if (stlink_current_mode(sl) != STLINK_DEV_DEBUG_MODE)
- stlink_enter_swd_mode(sl);
-
- if (o.reset)
- stlink_reset(sl);
-
-// Disable DMA - Set All DMA CCR Registers to zero. - AKS 1/7/2013
- if (sl->chip_id == STM32_CHIPID_F4)
- {
- memset(sl->q_buf,0,4);
- for (int i=0;i<8;i++) {
- stlink_write_mem32(sl,0x40026000+0x10+0x18*i,4);
- stlink_write_mem32(sl,0x40026400+0x10+0x18*i,4);
- stlink_write_mem32(sl,0x40026000+0x24+0x18*i,4);
- stlink_write_mem32(sl,0x40026400+0x24+0x18*i,4);
- }
- }
- if (o.cmd == DO_WRITE) /* write */
- {
- if ((o.addr >= sl->flash_base) &&
- (o.addr < sl->flash_base + sl->flash_size)) {
- err = stlink_fwrite_flash(sl, o.filename, o.addr);
- if (err == -1)
- {
- printf("stlink_fwrite_flash() == -1\n");
- goto on_error;
- }
- }
- else if ((o.addr >= sl->sram_base) &&
- (o.addr < sl->sram_base + sl->sram_size)) {
- err = stlink_fwrite_sram(sl, o.filename, o.addr);
- if (err == -1)
- {
- printf("stlink_sram_flash() == -1\n");
- goto on_error;
- }
- }
- } else if (o.cmd == DO_ERASE)
- {
- err = stlink_erase_flash_mass(sl);
- if (err == -1)
+ stlink_t* sl = NULL;
+ struct opts o;
+ char serial_buffer[13] = {0};
+ o.serial = serial_buffer;
+ int err = -1;
+
+ o.size = 0;
+ if (get_opts(&o, ac - 1, av + 1) == -1)
+ {
+ printf("invalid command line\n");
+ usage();
+ return -1;
+ }
+
+ if (o.devname != NULL) /* stlinkv1 */
+ sl = stlink_v1_open(o.log_level, 1);
+ else /* stlinkv2 */
+ sl = stlink_open_usb(o.log_level, 1, o.serial);
+
+ if (sl == NULL)
+ return -1;
+
+ sl->verbose = o.log_level;
+
+ connected_stlink = sl;
+ signal(SIGINT, &cleanup);
+ signal(SIGTERM, &cleanup);
+ signal(SIGSEGV, &cleanup);
+
+ if (stlink_current_mode(sl) == STLINK_DEV_DFU_MODE) {
+ if (stlink_exit_dfu_mode(sl)) {
+ printf("Failed to exit DFU mode\n");
+ goto on_error;
+ }
+ }
+
+ if (stlink_current_mode(sl) != STLINK_DEV_DEBUG_MODE) {
+ if (stlink_enter_swd_mode(sl)) {
+ printf("Failed to enter SWD mode\n");
+ goto on_error;
+ }
+ }
+
+ if (o.reset){
+ if (stlink_jtag_reset(sl, 2)) {
+ printf("Failed to reset JTAG\n");
+ goto on_error;
+ }
+
+ if (stlink_reset(sl)) {
+ printf("Failed to reset device\n");
+ goto on_error;
+ }
+ }
+
+ // Disable DMA - Set All DMA CCR Registers to zero. - AKS 1/7/2013
+ if (sl->chip_id == STM32_CHIPID_F4)