nes-proj/cpu/avr/dev/flash.c

51 lines
1.1 KiB
C
Raw Normal View History

#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;
}
/*---------------------------------------------------------------------------*/