DFU: add dfu_runtime.c for runtime-to-dfu switching

1 files changed, 20 insertions, 0 deletions

diff --git a/usb/device/dfu/dfu_runtime.c b/usb/device/dfu/dfu_runtime.c
new file mode 100644
index 0000000..5ad1038
--- /dev/null
+++ b/usb/device/dfu/dfu_runtime.c
@@ -0,0 +1,20 @@
+
+#include <board.h>
+#include <core_cm3.h>
+
+#include <usb/device/core/USBD.h>
+#include <usb/device/dfu/dfu.h>
+
+
+void DFURT_SwitchToDFU(void)
+{
+	unsigned int *dfu_except_tbl = (unsigned int *)AT91C_IFLASH0;
+	void (*toDFU)(void) = (void *)dfu_except_tbl[1];
+
+	*(unsigned int *)USB_DFU_MAGIC_ADDR = USB_DFU_MAGIC;
+
+	USBD_Disconnect();
+	__disable_irq();
+
+	toDFU();
+}