From 146922e21147baef802aba5cd3eb5ae0f75b545e Mon Sep 17 00:00:00 2001 From: Zach Eveland Date: Fri, 21 Oct 2011 17:51:04 -0400 Subject: added and modified Program() routine --- bootloaders/nuevo_diskloader/src/DiskLoader.cpp | 26 +++++++++++++++++++++++++ 1 file changed, 26 insertions(+) (limited to 'bootloaders/nuevo_diskloader/src') diff --git a/bootloaders/nuevo_diskloader/src/DiskLoader.cpp b/bootloaders/nuevo_diskloader/src/DiskLoader.cpp index 83ffc1b..efd386f 100644 --- a/bootloaders/nuevo_diskloader/src/DiskLoader.cpp +++ b/bootloaders/nuevo_diskloader/src/DiskLoader.cpp @@ -19,6 +19,32 @@ void entrypoint(void) ::); } +u8 _flashbuf[128]; + +void Program(u8 ep, u16 page, u8 count) +{ + u8 write = page < 30*1024; // Don't write over firmware please + if (write) + boot_page_erase(page); + + USB_Recv(ep,_flashbuf,count); // Read while page is erasing + + if (!write) + return; + + boot_spm_busy_wait(); // Wait until the memory is erased. + + count >>= 1; + u16* p = (u16*)page; + u16* b = (u16*)_flashbuf; + for (u8 i = 0; i < count; i++) + boot_page_fill(p++, b[i]); + + boot_page_write(page); + boot_spm_busy_wait(); + boot_rww_enable (); +} + int main(void) __attribute__ ((naked)); int main() { -- cgit v1.2.3-18-g5258