mirror of
git://projects.qi-hardware.com/ben-wpan.git
synced 2024-11-23 06:41:35 +02:00
atusb/fw/flash.c: simplified logic of flash_write and corrected several small bugs
- flash.c (flash_write): we don't use eeprom_busy_wait, removed it - flash.c (flash_write): write the page only at one place - flash.c (flash_write): corrected the address of the page write - flash.c (flash_write): value being added to word wasn't shifted
This commit is contained in:
parent
553c981551
commit
2978afe92b
@ -40,27 +40,23 @@ void flash_write(const uint8_t *buf, uint16_t size)
|
|||||||
static uint8_t last;
|
static uint8_t last;
|
||||||
const uint8_t *p;
|
const uint8_t *p;
|
||||||
|
|
||||||
eeprom_busy_wait();
|
|
||||||
for (p = buf; p != buf+size; p++) {
|
for (p = buf; p != buf+size; p++) {
|
||||||
if (!(payload & (SPM_PAGESIZE-1))) {
|
if (!(payload & (SPM_PAGESIZE-1))) {
|
||||||
if (payload) {
|
|
||||||
boot_page_write(payload-SPM_PAGESIZE);
|
|
||||||
boot_spm_busy_wait();
|
|
||||||
}
|
|
||||||
boot_page_erase(payload);
|
boot_page_erase(payload);
|
||||||
boot_spm_busy_wait();
|
boot_spm_busy_wait();
|
||||||
}
|
}
|
||||||
|
|
||||||
if (payload & 1)
|
if (payload & 1)
|
||||||
boot_page_fill(payload, last | (*p << 0));
|
boot_page_fill(payload, last | (*p << 8));
|
||||||
else
|
else
|
||||||
last = *p;
|
last = *p;
|
||||||
payload++;
|
payload++;
|
||||||
}
|
|
||||||
|
|
||||||
if (!(payload & (SPM_PAGESIZE-1))) {
|
if (!(payload & (SPM_PAGESIZE-1))) {
|
||||||
boot_page_write(payload);
|
boot_page_write(payload-SPM_PAGESIZE);
|
||||||
boot_spm_busy_wait();
|
boot_spm_busy_wait();
|
||||||
}
|
}
|
||||||
|
}
|
||||||
|
|
||||||
boot_rww_enable();
|
boot_rww_enable();
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user