#include <stdio.h>
#include <string.h>
#include <stdlib.h>
-#include "sleep.h"
-#include "proxusb.h"
+#include <inttypes.h>
+#include <unistd.h>
+
+#include "proxmark3.h"
+#include "util.h"
+#include "util_posix.h"
#include "flash.h"
#include "elf.h"
#include "proxendian.h"
+#include "usb_cmd.h"
+#include "comms.h"
// FIXME: what the fuckity fuck
unsigned int current_command = CMD_UNKNOWN;
#define BOOTLOADER_SIZE 0x2000
#define BOOTLOADER_END (FLASH_START + BOOTLOADER_SIZE)
-#define BLOCK_SIZE 0x100
+#define BLOCK_SIZE 0x200
static const uint8_t elf_ident[] = {
0x7f, 'E', 'L', 'F',
EV_CURRENT
};
+void CloseProxmark(receiver_arg* conn, char* serial_port_name) {
+ pthread_mutex_lock(&conn->recv_lock);
+
+ // Block the port from being used by anything
+ serial_port* my_port = GetSerialPort();
+ SetSerialPort(NULL);
+
+ // Then close the port.
+ uart_close(my_port);
+ pthread_mutex_unlock(&conn->recv_lock);
+
+ // Fix for linux, it seems that it is extremely slow to release the serial port file descriptor /dev/*
+ unlink(serial_port_name);
+}
+
+bool OpenProxmark(char* serial_port_name) {
+ serial_port *new_port = uart_open(serial_port_name);
+ if (new_port == INVALID_SERIAL_PORT || new_port == CLAIMED_SERIAL_PORT) {
+ //poll once a second
+ return false;
+ }
+
+ SetSerialPort(new_port);
+ return true;
+}
+
// Turn PHDRs into flasher segments, checking for PHDR sanity and merging adjacent
// unaligned segments if needed
static int build_segs_from_phdrs(flash_file_t *ctx, FILE *fd, Elf32_Phdr *phdrs, int num_phdrs)
// Get the state of the proxmark, backwards compatible
static int get_proxmark_state(uint32_t *state)
{
- HidCommand c;
+ UsbCommand c;
c.cmd = CMD_DEVICE_INFO;
- SendCommand_(&c);
-
- HidCommand resp;
- ReceiveCommand(&resp);
+ SendCommand(&c);
+ UsbCommand resp;
+ while (!WaitForResponse(CMD_ANY, &resp)) {
+ // Keep waiting for a response
+ msleep(100);
+ }
// Three outcomes:
// 1. The old bootrom code will ignore CMD_DEVICE_INFO, but respond with an ACK
*state = resp.arg[0];
break;
default:
- fprintf(stderr, "Error: Couldn't get proxmark state, bad response type: 0x%04x\n", resp.cmd);
+ fprintf(stderr, "Error: Couldn't get proxmark state, bad response type: 0x%04" PRIx64 "\n", resp.cmd);
return -1;
break;
}
}
// Enter the bootloader to be able to start flashing
-static int enter_bootloader(void)
+static int enter_bootloader(receiver_arg* conn, char *serial_port_name)
{
uint32_t state;
if (state & DEVICE_INFO_FLAG_CURRENT_MODE_OS) {
fprintf(stderr,"Entering bootloader...\n");
- HidCommand c;
+ UsbCommand c;
memset(&c, 0, sizeof (c));
if ((state & DEVICE_INFO_FLAG_BOOTROM_PRESENT)
// New style handover: Send CMD_START_FLASH, which will reset the board
// and enter the bootrom on the next boot.
c.cmd = CMD_START_FLASH;
- SendCommand_(&c);
+ SendCommand(&c);
fprintf(stderr,"(Press and release the button only to abort)\n");
} else {
// Old style handover: Ask the user to press the button, then reset the board
c.cmd = CMD_HARDWARE_RESET;
- SendCommand_(&c);
+ SendCommand(&c);
fprintf(stderr,"Press and hold down button NOW if your bootloader requires it.\n");
}
- fprintf(stderr,"Waiting for Proxmark to reappear on USB...");
+
+ msleep(100);
+ CloseProxmark(conn, serial_port_name);
- CloseProxmark();
- sleep(1);
- while (!OpenProxmark(0)) {
+ fprintf(stderr,"Waiting for Proxmark to reappear on %s",serial_port_name);
+ do {
sleep(1);
fprintf(stderr, ".");
- }
+ } while (!OpenProxmark(serial_port_name));
+
fprintf(stderr," Found.\n");
-
return 0;
}
return -1;
}
-static int wait_for_ack(void)
+static int wait_for_ack()
{
- HidCommand ack;
- ReceiveCommand(&ack);
- if (ack.cmd != CMD_ACK) {
- printf("Error: Unexpected reply 0x%04x (expected ACK)\n", ack.cmd);
+ UsbCommand resp;
+ while (!WaitForResponse(CMD_ANY, &resp)) {
+ msleep(100);
+ }
+ if (resp.cmd != CMD_ACK) {
+ printf("Error: Unexpected reply 0x%04" PRIx64 " (expected ACK)\n", resp.cmd);
return -1;
}
return 0;
}
// Go into flashing mode
-int flash_start_flashing(int enable_bl_writes)
+int flash_start_flashing(receiver_arg* conn, int enable_bl_writes,char *serial_port_name)
{
uint32_t state;
- if (enter_bootloader() < 0)
+ if (enter_bootloader(conn, serial_port_name) < 0)
return -1;
if (get_proxmark_state(&state) < 0)
if (state & DEVICE_INFO_FLAG_UNDERSTANDS_START_FLASH) {
// This command is stupid. Why the heck does it care which area we're
// flashing, as long as it's not the bootloader area? The mind boggles.
- HidCommand c = {CMD_START_FLASH};
+ UsbCommand c = {CMD_START_FLASH};
if (enable_bl_writes) {
c.arg[0] = FLASH_START;
c.arg[1] = FLASH_END;
c.arg[2] = 0;
}
- SendCommand_(&c);
+ SendCommand(&c);
return wait_for_ack();
} else {
fprintf(stderr, "Note: Your bootloader does not understand the new START_FLASH command\n");
memset(block_buf, 0xFF, BLOCK_SIZE);
memcpy(block_buf, data, length);
-
- HidCommand c = {CMD_SETUP_WRITE};
- for (int i = 0; i < 240; i += 48) {
- memcpy(c.d.asBytes, block_buf + i, 48);
- c.arg[0] = i / 4;
- SendCommand_(&c);
- if (wait_for_ack() < 0)
- return -1;
- }
-
+ UsbCommand c;
c.cmd = CMD_FINISH_WRITE;
c.arg[0] = address;
- memcpy(c.d.asBytes, block_buf+240, 16);
- SendCommand_(&c);
- return wait_for_ack();
+ memcpy(c.d.asBytes, block_buf, length);
+ SendCommand(&c);
+ return wait_for_ack();
}
// Write a file's segments to Flash
}
// just reset the unit
-int flash_stop_flashing(void) {
- HidCommand c = {CMD_HARDWARE_RESET};
- SendCommand_(&c);
+int flash_stop_flashing() {
+ UsbCommand c = {CMD_HARDWARE_RESET};
+ SendCommand(&c);
+ msleep(100);
return 0;
}