+ stlink_t *sl = NULL;
+ int port = 0;
+
+ const char * HelpStr = "\nUsage:\n"
+ "\tst-util [Arguments]\n"
+ "\tArguments (no more than 2):\n"
+ "\t\t<Port>: Port. Default: 4242.\n"
+ "\t\t{usb|sgauto|/dev/sgX}: Transport, "
+ "where X = {0, 1, 2, ...}. Default: USB.\n"
+ "\tExamples:\n"
+ "\t\tst-util 1234\n"
+ "\t\tst-util sgauto\n"
+ "\t\tst-util 1234 usb\n"
+ "\t\tst-util /dev/sgX 1234\n"
+ "\t\tst-util 1234 /dev/sgX\n";
+
+
+ // Parsing the arguments of command line ...
+
+ if (argc == 1 || argc > 3) {
+ fprintf(stderr, HelpStr, NULL);
+ return 1;
+ }
+
+ for(int a = 1; a < argc; a++) {
+
+ // Port
+ int p = atoi(argv[a]);
+ if (p < 0 || p > 0xFFFF) {
+ fprintf(stderr, "Invalid port\n");
+ fprintf(stderr, HelpStr, NULL);
+ return 1;
+ }
+ if (p > 0 && port == 0) {port = p; continue;}
+
+ // if (p == 0) ...
+
+ if (sl != NULL) {
+ fprintf(stderr, "Invalid argumets\n");
+ fprintf(stderr, HelpStr, NULL);
+ return 1;
+ }
+
+ // usb
+ if (!strcmp(argv[a], "usb")) {
+ sl = stlink_open_usb(10);
+ if(sl == NULL) return 1;
+ continue;
+ }
+
+ // /dev/sgX
+ if (!strncmp(argv[a], "/dev/sgX", 7)) {
+ if(!CONFIG_USE_LIBSG) {
+ fprintf(stderr, "libsg not use\n");
+ return 1;
+ }
+ sl = stlink_quirk_open(argv[a], 0);
+ if(sl == NULL) return 1;
+ continue;
+ }
+
+ // sg_auto
+ if (!strcmp(argv[a], "sgauto")) {
+ if(!CONFIG_USE_LIBSG) {
+ fprintf(stderr, "libsg not use\n");
+ return 1;
+ }
+
+ // Search ST-LINK (from /dev/sg0 to /dev/sg99)
+ for(int DevNum = 0; DevNum <= 99; DevNum++)
+ {
+ if(DevNum < 10) {
+ char DevName[] = "/dev/sgX";
+ DevName[7] = DevNum + '0';
+ if ( !access(DevName, F_OK) )
+ sl = stlink_quirk_open(DevName, 0);
+ }
+ else {
+ char DevName[] = "/dev/sgXY";
+ DevName[7] = DevNum/10 + '0';
+ DevName[8] = DevNum%10 + '0';
+ if ( !access(DevName, F_OK) )
+ sl = stlink_quirk_open(DevName, 0);
+ }
+ if (sl != NULL) break;
+ }
+
+ if(sl == NULL) return 1;
+ continue;
+ }
+
+ // Invalid argumets
+ fprintf(stderr, "Invalid argumets\n");
+ fprintf(stderr, HelpStr, NULL);
+ return 1;
+ }
+
+ // Default transport: USB
+ if (sl == NULL) sl = stlink_open_usb(10);
+ // Default port: 4242
+ if (port == 0) port = 4242;
+
+ // End parsing
+
+
+ if (sl == NULL) return 1;
+
+ if (stlink_current_mode(sl) == STLINK_DEV_DFU_MODE) {
+ stlink_exit_dfu_mode(sl);
+ }