blob: 69225a026797453b9757d9398a5b0425e04baebd (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
|
/* 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");
}
|