51 lines
1.1 KiB
C
51 lines
1.1 KiB
C
|
|
||
|
|
#include "dev/flash.h"
|
||
|
|
|
||
|
|
#include <avr/boot.h>
|
||
|
|
#include <inttypes.h>
|
||
|
|
#include <avr/interrupt.h>
|
||
|
|
#include <avr/pgmspace.h>
|
||
|
|
|
||
|
|
/*---------------------------------------------------------------------------*/
|
||
|
|
/*
|
||
|
|
* The following code was taken from the avr-libc manual:
|
||
|
|
*/
|
||
|
|
void
|
||
|
|
flash_write_page(uint32_t page, uint8_t *buf)
|
||
|
|
{
|
||
|
|
uint16_t i;
|
||
|
|
uint8_t sreg;
|
||
|
|
|
||
|
|
/* Disable interrupts. */
|
||
|
|
|
||
|
|
sreg = SREG;
|
||
|
|
cli();
|
||
|
|
|
||
|
|
eeprom_busy_wait();
|
||
|
|
|
||
|
|
boot_page_erase(page);
|
||
|
|
boot_spm_busy_wait(); /* Wait until the memory is erased. */
|
||
|
|
|
||
|
|
for(i = 0; i < SPM_PAGESIZE; i += 2) {
|
||
|
|
/* Set up little-endian word. */
|
||
|
|
|
||
|
|
uint16_t w = *buf++;
|
||
|
|
w += (*buf++) << 8;
|
||
|
|
|
||
|
|
boot_page_fill(page + i, w);
|
||
|
|
}
|
||
|
|
|
||
|
|
boot_page_write(page); /* Store buffer in flash page. */
|
||
|
|
boot_spm_busy_wait(); /* Wait until the memory is written. */
|
||
|
|
|
||
|
|
/* Reenable RWW-section again. We need this if we want to jump back
|
||
|
|
* to the application after bootloading. */
|
||
|
|
|
||
|
|
boot_rww_enable();
|
||
|
|
|
||
|
|
/* Re-enable interrupts (if they were ever enabled). */
|
||
|
|
|
||
|
|
SREG = sreg;
|
||
|
|
}
|
||
|
|
/*---------------------------------------------------------------------------*/
|