optimized

[proxmark3-svn] / client / flasher.c

diff --git a/client/flasher.c b/client/flasher.c
index 418718dd0cf44767d400b8f2f24fbb60347c5676..d494810aa5b64ca9a476c047dc19727dcb5c2ba2 100644 (file)
--- a/client/flasher.c
+++ b/client/flasher.c
@@ -1,58 +1,152 @@
+//-----------------------------------------------------------------------------
+// This code is licensed to you under the terms of the GNU GPL, version 2 or,
+// at your option, any later version. See the LICENSE.txt file for the text of
+// the license.
+//-----------------------------------------------------------------------------
+// Flasher frontend tool
+//-----------------------------------------------------------------------------
+
 #include <stdio.h>
 #include <stdlib.h>
+#include <string.h>
 #include "sleep.h"
-#include "proxusb.h"
+#include "proxmark3.h"
 #include "flash.h"
+#include "uart.h"
+#include "usb_cmd.h"
 
-unsigned int current_command = CMD_UNKNOWN;
+static serial_port sp;
+static char* serial_port_name;
 
-extern struct partition partitions[];
+void cmd_debug(UsbCommand* UC) {
+  //  Debug
+  printf("UsbCommand length[len=%zd]\n",sizeof(UsbCommand));
+  printf("  cmd[len=%zd]: %016"llx"\n",sizeof(UC->cmd),UC->cmd);
+  printf(" arg0[len=%zd]: %016"llx"\n",sizeof(UC->arg[0]),UC->arg[0]);
+  printf(" arg1[len=%zd]: %016"llx"\n",sizeof(UC->arg[1]),UC->arg[1]);
+  printf(" arg2[len=%zd]: %016"llx"\n",sizeof(UC->arg[2]),UC->arg[2]);
+  printf(" data[len=%zd]: ",sizeof(UC->d.asBytes));
+  for (size_t i=0; i<16; i++) {
+    printf("%02x",UC->d.asBytes[i]);
+  }
+  printf("...\n");
+}
 
-static void usage(char **argv)
-{
-  fprintf(stderr, "Usage:   %s areas image [image [image]]\n", argv[0]);
-  fprintf(stderr, "         areas is a comma-separated list of areas to flash, with no spaces\n");
-  fprintf(stderr, "               Known areas are:");
+void SendCommand(UsbCommand* txcmd) {
+//  printf("send: ");
+//  cmd_debug(txcmd);
+  if (!uart_send(sp,(byte_t*)txcmd,sizeof(UsbCommand))) {
+    printf("Sending bytes to proxmark failed\n");
+    exit(1);
+  }
+}
 
-  for (int i = 0; partitions[i].name != NULL; ++i) {
-    fprintf(stderr, " %s", partitions[i].name);
+void ReceiveCommand(UsbCommand* rxcmd) {
+  byte_t* prxcmd = (byte_t*)rxcmd;
+  byte_t* prx = prxcmd;
+  size_t rxlen;
+  while (true) {
+    rxlen = sizeof(UsbCommand) - (prx-prxcmd);
+    if (uart_receive(sp,prx,&rxlen)) {
+//      printf("received [%zd] bytes\n",rxlen);
+      prx += rxlen;
+      if ((prx-prxcmd) >= sizeof(UsbCommand)) {
+//        printf("received: ");
+//        cmd_debug(rxcmd);
+        return;
+      }
+    }
   }
+}
 
-  fprintf(stderr, "\n");
-  fprintf(stderr, "         image is the path to the corresponding image\n\n");
-  fprintf(stderr, "Example: %s os,fpga path/to/osimage.elf path/to/fpgaimage.elf\n", argv[0]);
+void CloseProxmark() {
+  // Clean up the port
+  uart_close(sp);
+}
+
+int OpenProxmark(size_t i) {
+  sp = uart_open(serial_port_name);
+  if (sp == INVALID_SERIAL_PORT) {
+    //poll once a second
+    msleep(100);
+    return 0;
+  }
+  return 1;
 }
 
+static void usage(char *argv0)
+{
+       fprintf(stderr, "Usage:   %s <port> [-b] image.elf [image.elf...]\n\n", argv0);
+       fprintf(stderr, "\t-b\tEnable flashing of bootloader area (DANGEROUS)\n\n");
+       fprintf(stderr, "Example: %s path/to/osimage.elf path/to/fpgaimage.elf\n", argv0);
+}
+
+#define MAX_FILES 4
+
 int main(int argc, char **argv)
 {
-  if (argc < 2) {
-    usage(argv);
-    exit(-1);
-  }
+       int can_write_bl = 0;
+       int num_files = 0;
+       int res;
+       flash_file_t files[MAX_FILES];
 
-  /* Count area arguments */
-  int areas = 0, offset=-1, length=0;
-  while (find_next_area(argv[1], &offset, &length)) areas++;
+       memset(files, 0, sizeof(files));
 
-  if (areas != argc - 2) {
-    usage(argv);
-    exit(-1);
-  }
+       if (argc < 3) {
+               usage(argv[0]);
+               return -1;
+       }
+
+       for (int i = 2; i < argc; i++) {
+               if (argv[i][0] == '-') {
+                       if (!strcmp(argv[i], "-b")) {
+                               can_write_bl = 1;
+                       } else {
+                               usage(argv[0]);
+                               return -1;
+                       }
+               } else {
+                       res = flash_load(&files[num_files], argv[i], can_write_bl);
+                       if (res < 0) {
+                               fprintf(stderr, "Error while loading %s\n", argv[i]);
+                               return -1;
+                       }
+                       fprintf(stderr, "\n");
+                       num_files++;
+               }
+       }
+
+  serial_port_name = argv[1];
+       fprintf(stderr, "Waiting for Proxmark to appear on USB...");
+       while (!OpenProxmark(0)) {
+               fprintf(stderr, ".");
+       }
+       fprintf(stderr, " Found.\n");
+
+       res = flash_start_flashing(can_write_bl);
+       if (res < 0)
+               return -1;
 
-  usb_init();
+       fprintf(stderr, "\nFlashing...\n");
 
-  fprintf(stderr,"Waiting for Proxmark to appear on USB... ");
-  while (!OpenProxmark(0)) { sleep(1); }
-  fprintf(stderr,"Found.\n");
+       for (int i = 0; i < num_files; i++) {
+               res = flash_write(&files[i]);
+               if (res < 0)
+                       return -1;
+               flash_free(&files[i]);
+               fprintf(stderr, "\n");
+       }
 
-  do_flash(argv);
+       fprintf(stderr, "Resetting hardware...\n");
 
-  UsbCommand c = {CMD_HARDWARE_RESET};
-  SendCommand(&c);
+       res = flash_stop_flashing();
+       if (res < 0)
+               return -1;
 
-  CloseProxmark();
+       CloseProxmark();
 
-  fprintf(stderr,"Have a nice day!\n");
+       fprintf(stderr, "All done.\n\n");
+       fprintf(stderr, "Have a nice day!\n");
 
-  return 0;
+       return 0;
 }