34 lines
645 B
C
34 lines
645 B
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
|
|
#include <stdint.h>
|
|
|
|
#define FLASH_BSY (1 << 0)
|
|
#define FLASH_PGERR (1 << 2)
|
|
#define FLASH_WRPRTERR (1 << 4)
|
|
|
|
void flash_write(volatile uint32_t *flash_sr,
|
|
uint32_t hwords_count,
|
|
uint16_t *buffer,
|
|
uint16_t *target_addr) __attribute__((naked));
|
|
|
|
void flash_write(volatile uint32_t *flash_sr,
|
|
uint32_t hwords_count,
|
|
uint16_t *buffer,
|
|
uint16_t *target_addr)
|
|
{
|
|
do {
|
|
*target_addr = *buffer++;
|
|
|
|
register uint32_t sr;
|
|
do {
|
|
sr = *flash_sr;
|
|
} while (sr & FLASH_BSY);
|
|
|
|
if (sr & (FLASH_PGERR | FLASH_WRPRTERR))
|
|
break;
|
|
|
|
target_addr++;
|
|
} while (--hwords_count);
|
|
asm("ebreak");
|
|
}
|