#include <stdio.h>
#include <string.h>
#include <stdlib.h>
+#include "proxmark3.h"
#include "sleep.h"
-#include "proxusb.h"
#include "flash.h"
#include "elf.h"
#include "proxendian.h"
+#include "usb_cmd.h"
+#include "at91sam7s512.h"
+
+void SendCommand(UsbCommand* txcmd);
+void ReceiveCommand(UsbCommand* rxcmd);
+void CloseProxmark();
+int OpenProxmark(size_t i);
// 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',
// 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;
+ SendCommand(&c);
+ UsbCommand resp;
ReceiveCommand(&resp);
// Three outcomes:
*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"llx"\n", resp.cmd);
return -1;
break;
}
}
// Enter the bootloader to be able to start flashing
-static int enter_bootloader(void)
+static int enter_bootloader(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();
- sleep(1);
- while (!OpenProxmark(0)) {
+
+ fprintf(stderr,"Waiting for Proxmark to reappear on %s",serial_port_name);
+ do {
sleep(1);
fprintf(stderr, ".");
- }
+ } while (!OpenProxmark(0));
fprintf(stderr," Found.\n");
return 0;
return -1;
}
-static int wait_for_ack(void)
+static int wait_for_ack(UsbCommand *ack)
{
- HidCommand ack;
- ReceiveCommand(&ack);
- if (ack.cmd != CMD_ACK) {
- printf("Error: Unexpected reply 0x%04x (expected ACK)\n", ack.cmd);
+ ReceiveCommand(ack);
+ if (ack->cmd != CMD_ACK) {
+ printf("Error: Unexpected reply 0x%04"llx" (expected ACK)\n", ack->cmd);
return -1;
}
return 0;
}
// Go into flashing mode
-int flash_start_flashing(int enable_bl_writes)
+int flash_start_flashing(int enable_bl_writes,char *serial_port_name)
{
uint32_t state;
- if (enter_bootloader() < 0)
+ if (enter_bootloader(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);
- return wait_for_ack();
+ SendCommand(&c);
+ return wait_for_ack(&c);
} else {
fprintf(stderr, "Note: Your bootloader does not understand the new START_FLASH command\n");
fprintf(stderr, " It is recommended that you update your bootloader\n\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);
+ int ret = wait_for_ack(&c);
+ if (ret && c.arg[0]) {
+ uint32_t lock_bits = c.arg[0] >> 16;
+ bool lock_error = c.arg[0] & AT91C_MC_LOCKE;
+ bool prog_error = c.arg[0] & AT91C_MC_PROGE;
+ bool security_bit = c.arg[0] & AT91C_MC_SECURITY;
+ printf("%s", lock_error?" Lock Error\n":"");
+ printf("%s", prog_error?" Invalid Command or bad Keyword\n":"");
+ printf("%s", security_bit?" Security Bit is set!\n":"");
+ printf(" Lock Bits: 0x%04x\n", lock_bits);
+ }
+ return ret;
}
// Write a file's segments to Flash
// just reset the unit
int flash_stop_flashing(void) {
- HidCommand c = {CMD_HARDWARE_RESET};
- SendCommand_(&c);
- return 0;
+ UsbCommand c = {CMD_HARDWARE_RESET};
+ SendCommand(&c);
+ msleep(100);
+ return 0;
}
projects / proxmark3-svn / blobdiff