summaryrefslogtreecommitdiff
path: root/Host/libnxt-0.3/flash_write/flash.c
diff options
context:
space:
mode:
Diffstat (limited to 'Host/libnxt-0.3/flash_write/flash.c')
-rw-r--r--Host/libnxt-0.3/flash_write/flash.c46
1 files changed, 46 insertions, 0 deletions
diff --git a/Host/libnxt-0.3/flash_write/flash.c b/Host/libnxt-0.3/flash_write/flash.c
new file mode 100644
index 0000000..824a088
--- /dev/null
+++ b/Host/libnxt-0.3/flash_write/flash.c
@@ -0,0 +1,46 @@
+/**
+ * NXT bootstrap interface; NXT onboard flashing driver.
+ *
+ * Copyright 2006 David Anderson <david.anderson@calixo.net>
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License as
+ * published by the Free Software Foundation; either version 2 of the
+ * License, or (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
+ * USA
+ */
+
+#define VINTPTR(addr) ((volatile unsigned int *)(addr))
+#define VINT(addr) (*(VINTPTR(addr)))
+
+#define USER_PAGE VINTPTR(0x00202100)
+#define USER_PAGE_NUM VINT(0x00202300)
+
+#define FLASH_BASE VINTPTR(0x00100000)
+#define FLASH_CMD_REG VINT(0xFFFFFF64)
+#define FLASH_STATUS_REG VINT(0xFFFFFF68)
+#define OFFSET_PAGE_NUM ((USER_PAGE_NUM & 0x000003FF) << 8)
+#define FLASH_CMD_WRITE (0x5A000001 + OFFSET_PAGE_NUM)
+
+void do_flash_write(void)
+{
+ unsigned long i;
+
+ while (!(FLASH_STATUS_REG & 0x1));
+
+ for (i = 0; i < 64; i++)
+ FLASH_BASE[(USER_PAGE_NUM*64)+i] = USER_PAGE[i];
+
+ FLASH_CMD_REG = FLASH_CMD_WRITE;
+
+ while (!(FLASH_STATUS_REG & 0x1));
+}