}
-/* Search for a STLINK device, either any or teh one with the given PID
- * Return the protocoll version
- */
-static int is_stlink_device(libusb_device * dev, uint16_t pid) {
- struct libusb_device_descriptor desc;
- int version;
-
- if (libusb_get_device_descriptor(dev, &desc))
- return 0;
-
- if (desc.idVendor != USB_ST_VID)
- return 0;
-
- if ((desc.idProduct != USB_STLINK_32L_PID) &&
- (desc.idProduct != USB_STLINK_PID ))
- return 0;
-
- if(pid && (pid != desc.idProduct))
- return 0;
- if (desc.idProduct == USB_STLINK_PID )
- version = 1;
- else
- version = 2;
-
- return version;
-}
-
static int fill_command
(stlink_t * sl, enum SCSI_Generic_Direction dir, uint32_t len) {
struct stlink_libusb * const slu = sl->backend_data;
struct stlink_libusb* slu = NULL;
int error = -1;
libusb_device** devs = NULL;
- libusb_device* dev;
- ssize_t i;
- ssize_t count;
int config;
- char *iSerial = NULL;
sl = malloc(sizeof (stlink_t));
slu = malloc(sizeof (struct stlink_libusb));
slu->usb_handle = libusb_open_device_with_vid_pid(slu->libusb_ctx, USB_ST_VID, USB_STLINK_32L_PID);
if (slu->usb_handle == NULL) {
// TODO - free usb context too...
- free(slu);
WLOG("Couldn't find any ST-Link/V2 devices");
- return NULL;
+ goto on_error;
}
if (libusb_kernel_driver_active(slu->usb_handle, 0) == 1) {
}
stlink_version(sl);
-
- /* per device family initialization */
- stlink_core_id(sl);
- if (sl->core_id == STM32L_CORE_ID) {
-
- /* flash memory settings */
- sl->flash_base = STM32_FLASH_BASE;
- sl->flash_size = STM32_FLASH_SIZE;
- sl->flash_pgsz = STM32L_FLASH_PGSZ;
-
- /* system memory */
- sl->sys_base = STM32_SYSTEM_BASE;
- sl->sys_size = STM32_SYSTEM_SIZE;
-
- /* sram memory settings */
- sl->sram_base = STM32_SRAM_BASE;
- sl->sram_size = STM32L_SRAM_SIZE;
-
- } else if (sl->core_id == STM32VL_CORE_ID) {
-
- /* flash memory settings */
- sl->flash_base = STM32_FLASH_BASE;
- sl->flash_size = STM32_FLASH_SIZE;
- sl->flash_pgsz = STM32_FLASH_PGSZ;
-
- /* system memory */
- sl->sys_base = STM32_SYSTEM_BASE;
- sl->sys_size = STM32_SYSTEM_SIZE;
-
- /* sram memory settings */
- sl->sram_base = STM32_SRAM_BASE;
- sl->sram_size = STM32_SRAM_SIZE;
-
- } else {
-
- fprintf(stderr, "unknown coreid: %x\n", sl->core_id);
- goto on_libusb_error;
-
- }
+ stlink_load_device_params(sl);
error = 0;
return sl;
on_error:
+ if( slu->libusb_ctx)
+ libusb_exit(slu->libusb_ctx);
if (sl != NULL) free(sl);
if (slu != NULL) free(slu);
return 0;