--- /dev/null
+#include <proxmark3.h>\r
+\r
+static void ConfigClocks(void)\r
+{\r
+ // we are using a 16 MHz crystal as the basis for everything\r
+ // slow clock runs at 32Khz typical regardless of crystal\r
+\r
+ // enable system clock and USB clock\r
+ PMC_SYS_CLK_ENABLE = PMC_SYS_CLK_PROCESSOR_CLK | PMC_SYS_CLK_UDP_CLK;\r
+\r
+ // enable the clock to the following peripherals\r
+ PMC_PERIPHERAL_CLK_ENABLE =\r
+ (1<<PERIPH_PIOA) |\r
+ (1<<PERIPH_ADC) |\r
+ (1<<PERIPH_SPI) |\r
+ (1<<PERIPH_SSC) |\r
+ (1<<PERIPH_PWMC) |\r
+ (1<<PERIPH_UDP);\r
+\r
+ // worst case scenario, with 16Mhz xtal startup delay is 14.5ms\r
+ // with a slow clock running at it worst case (max) frequency of 42khz\r
+ // max startup delay = (14.5ms*42k)/8 = 76 = 0x4C round up to 0x50\r
+\r
+ // enable main oscillator and set startup delay\r
+ PMC_MAIN_OSCILLATOR = PMC_MAIN_OSCILLATOR_ENABLE |\r
+ PMC_MAIN_OSCILLATOR_STARTUP_DELAY(0x50);\r
+\r
+ // wait for main oscillator to stabilize\r
+ while ( !(PMC_INTERRUPT_STATUS & PMC_MAIN_OSCILLATOR_STABILIZED) )\r
+ ;\r
+\r
+ // minimum PLL clock frequency is 80 MHz in range 00 (96 here so okay)\r
+ // frequency is crystal * multiplier / divisor = 16Mhz * 12 / 2 = 96Mhz\r
+ PMC_PLL = PMC_PLL_DIVISOR(2) | PMC_PLL_COUNT_BEFORE_LOCK(0x50) |\r
+ PMC_PLL_FREQUENCY_RANGE(0) | PMC_PLL_MULTIPLIER(12) |\r
+ PMC_PLL_USB_DIVISOR(1);\r
+\r
+ // wait for PLL to lock\r
+ while ( !(PMC_INTERRUPT_STATUS & PMC_MAIN_OSCILLATOR_PLL_LOCK) )\r
+ ;\r
+\r
+ // we want a master clock (MCK) to be PLL clock / 2 = 96Mhz / 2 = 48Mhz\r
+ // as per datasheet, this register must be programmed in two operations\r
+ // when changing to PLL, program the prescaler first then the source\r
+ PMC_MASTER_CLK = PMC_CLK_PRESCALE_DIV_2;\r
+\r
+ // wait for main clock ready signal\r
+ while ( !(PMC_INTERRUPT_STATUS & PMC_MAIN_OSCILLATOR_MCK_READY) )\r
+ ;\r
+\r
+ // set the source to PLL\r
+ PMC_MASTER_CLK = PMC_CLK_SELECTION_PLL_CLOCK | PMC_CLK_PRESCALE_DIV_2;\r
+\r
+ // wait for main clock ready signal\r
+ while ( !(PMC_INTERRUPT_STATUS & PMC_MAIN_OSCILLATOR_MCK_READY) )\r
+ ;\r
+}\r
+\r
+static void Fatal(void)\r
+{\r
+ for(;;);\r
+}\r
+\r
+void UsbPacketReceived(BYTE *packet, int len)\r
+{\r
+ int i;\r
+ UsbCommand *c = (UsbCommand *)packet;\r
+ volatile DWORD *p;\r
+\r
+ if(len != sizeof(*c)) {\r
+ Fatal();\r
+ }\r
+\r
+ switch(c->cmd) {\r
+ case CMD_DEVICE_INFO:\r
+ break;\r
+\r
+ case CMD_SETUP_WRITE:\r
+ p = (volatile DWORD *)0;\r
+ for(i = 0; i < 12; i++) {\r
+ p[i+c->ext1] = c->d.asDwords[i];\r
+ }\r
+ break;\r
+\r
+ case CMD_FINISH_WRITE:\r
+ p = (volatile DWORD *)0;\r
+ for(i = 0; i < 4; i++) {\r
+ p[i+60] = c->d.asDwords[i];\r
+ }\r
+\r
+ MC_FLASH_COMMAND = MC_FLASH_COMMAND_KEY |\r
+ MC_FLASH_COMMAND_PAGEN(c->ext1/FLASH_PAGE_SIZE_BYTES) |\r
+ FCMD_WRITE_PAGE;\r
+ while(!(MC_FLASH_STATUS & MC_FLASH_STATUS_READY))\r
+ ;\r
+ break;\r
+\r
+ case CMD_HARDWARE_RESET:\r
+ break;\r
+\r
+ default:\r
+ Fatal();\r
+ break;\r
+ }\r
+\r
+ c->cmd = CMD_ACK;\r
+ UsbSendPacket(packet, len);\r
+}\r
+\r
+void BootROM(void)\r
+{\r
+ //------------\r
+ // First set up all the I/O pins; GPIOs configured directly, other ones\r
+ // just need to be assigned to the appropriate peripheral.\r
+\r
+ // Kill all the pullups, especially the one on USB D+; leave them for\r
+ // the unused pins, though.\r
+ PIO_NO_PULL_UP_ENABLE = (1 << GPIO_USB_PU) |\r
+ (1 << GPIO_LED_A) |\r
+ (1 << GPIO_LED_B) |\r
+ (1 << GPIO_LED_C) |\r
+ (1 << GPIO_LED_D) |\r
+ (1 << GPIO_FPGA_DIN) |\r
+ (1 << GPIO_FPGA_DOUT) |\r
+ (1 << GPIO_FPGA_CCLK) |\r
+ (1 << GPIO_FPGA_NINIT) |\r
+ (1 << GPIO_FPGA_NPROGRAM) |\r
+ (1 << GPIO_FPGA_DONE) |\r
+ (1 << GPIO_MUXSEL_HIPKD) |\r
+ (1 << GPIO_MUXSEL_HIRAW) |\r
+ (1 << GPIO_MUXSEL_LOPKD) |\r
+ (1 << GPIO_MUXSEL_LORAW) |\r
+ (1 << GPIO_RELAY) |\r
+ (1 << GPIO_NVDD_ON);\r
+ // (and add GPIO_FPGA_ON)\r
+ // These pins are outputs\r
+ PIO_OUTPUT_ENABLE = (1 << GPIO_LED_A) |\r
+ (1 << GPIO_LED_B) |\r
+ (1 << GPIO_LED_C) |\r
+ (1 << GPIO_LED_D) |\r
+ (1 << GPIO_RELAY) |\r
+ (1 << GPIO_NVDD_ON);\r
+ // PIO controls the following pins\r
+ PIO_ENABLE = (1 << GPIO_USB_PU) |\r
+ (1 << GPIO_LED_A) |\r
+ (1 << GPIO_LED_B) |\r
+ (1 << GPIO_LED_C) |\r
+ (1 << GPIO_LED_D);\r
+\r
+ USB_D_PLUS_PULLUP_OFF();\r
+ LED_D_OFF();\r
+ LED_C_ON();\r
+ LED_B_OFF();\r
+ LED_A_OFF();\r
+\r
+ // if 512K FLASH part - TODO make some defines :)\r
+ if ((DBGU_CIDR | 0xf00) == 0xa00) {\r
+ MC_FLASH_MODE0 = MC_FLASH_MODE_FLASH_WAIT_STATES(1) |\r
+ MC_FLASH_MODE_MASTER_CLK_IN_MHZ(0x48);\r
+ MC_FLASH_MODE1 = MC_FLASH_MODE_FLASH_WAIT_STATES(1) |\r
+ MC_FLASH_MODE_MASTER_CLK_IN_MHZ(0x48);\r
+ } else {\r
+ MC_FLASH_MODE0 = MC_FLASH_MODE_FLASH_WAIT_STATES(0) |\r
+ MC_FLASH_MODE_MASTER_CLK_IN_MHZ(48);\r
+ }\r
+\r
+ // Initialize all system clocks\r
+ ConfigClocks();\r
+\r
+ LED_A_ON();\r
+\r
+ if(BUTTON_PRESS()) {\r
+ UsbStart();\r
+ }\r
+\r
+ for(;;) {\r
+ WDT_HIT();\r
+\r
+ UsbPoll(TRUE);\r
+\r
+ if(!BUTTON_PRESS()) {\r
+ USB_D_PLUS_PULLUP_OFF();\r
+ LED_B_ON();\r
+\r
+ // jump to RAM address 0x10000 (LSBit set for thumb mode)\r
+ asm("ldr r3, = 0x10001\n");\r
+ asm("bx r3\n");\r
+ }\r
+ }\r
+}\r