rp: Handle flash.
- Beware, after reset, only a valid flash payload get mapped to XIP! Only 0 is read from flash when flash image is not valid
This commit is contained in:
Uwe Bonnes
parent
2b0e255c40
commit
52bffa70cf
|
|
@ -168,6 +168,7 @@ extern unsigned cortexm_wait_timeout;
|
||||||
#define REG_SPECIAL 19
|
#define REG_SPECIAL 19
|
||||||
|
|
||||||
#define ARM_THUMB_BREAKPOINT 0xBE00
|
#define ARM_THUMB_BREAKPOINT 0xBE00
|
||||||
|
#define CORTEXM_XPSR_THUMB (1 << 24)
|
||||||
|
|
||||||
#define CORTEXM_TOPT_INHIBIT_SRST (1 << 2)
|
#define CORTEXM_TOPT_INHIBIT_SRST (1 << 2)
|
||||||
|
|
||||||
|
|
|
||||||
290
src/target/rp.c
290
src/target/rp.c
|
|
@ -42,8 +42,247 @@
|
||||||
#include "target_internal.h"
|
#include "target_internal.h"
|
||||||
#include "cortexm.h"
|
#include "cortexm.h"
|
||||||
|
|
||||||
|
#define RP_ID "Raspberry RP2040"
|
||||||
#define BOOTROM_MAGIC ('M' | ('u' << 8) | (0x01 << 16))
|
#define BOOTROM_MAGIC ('M' | ('u' << 8) | (0x01 << 16))
|
||||||
#define BOOTROM_MAGIC_ADDR 0x00000010
|
#define BOOTROM_MAGIC_ADDR 0x00000010
|
||||||
|
#define XIP_FLASH_START 0x10000000
|
||||||
|
#define SRAM_START 0x20000000
|
||||||
|
|
||||||
|
struct rp_priv_s {
|
||||||
|
uint16_t _debug_trampoline;
|
||||||
|
uint16_t _debug_trampoline_end;
|
||||||
|
uint16_t _connect_internal_flash;
|
||||||
|
uint16_t _flash_exit_xip;
|
||||||
|
uint16_t _flash_range_erase;
|
||||||
|
uint16_t flash_range_program;
|
||||||
|
uint16_t _flash_flush_cache;
|
||||||
|
uint16_t _flash_enter_cmd_xip;
|
||||||
|
bool is_prepared;
|
||||||
|
uint32_t regs[0x20];/* Register playground*/
|
||||||
|
};
|
||||||
|
|
||||||
|
static bool rp2040_fill_table(struct rp_priv_s *priv, uint16_t *table, int max)
|
||||||
|
{
|
||||||
|
uint16_t tag = *table++;
|
||||||
|
int check = 0;
|
||||||
|
while ((tag != 0) && max) {
|
||||||
|
uint16_t data = *table++;
|
||||||
|
check++;
|
||||||
|
max -= 2;
|
||||||
|
switch (tag) {
|
||||||
|
case ('D' | ('T' << 8)):
|
||||||
|
priv->_debug_trampoline = data;
|
||||||
|
break;
|
||||||
|
case ('D' | ('E' << 8)):
|
||||||
|
priv->_debug_trampoline_end = data;
|
||||||
|
break;
|
||||||
|
case ('I' | ('F' << 8)):
|
||||||
|
priv->_connect_internal_flash = data;
|
||||||
|
break;
|
||||||
|
case ('E' | ('X' << 8)):
|
||||||
|
priv->_flash_exit_xip = data;
|
||||||
|
break;
|
||||||
|
case ('R' | ('E' << 8)):
|
||||||
|
priv->_flash_range_erase = data;
|
||||||
|
break;
|
||||||
|
case ('R' | ('P' << 8)):
|
||||||
|
priv->flash_range_program = data;
|
||||||
|
break;
|
||||||
|
case ('F' | ('C' << 8)):
|
||||||
|
priv->_flash_flush_cache = data;
|
||||||
|
break;
|
||||||
|
case ('C' | ('X' << 8)):
|
||||||
|
priv->_flash_enter_cmd_xip = data;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
check--;
|
||||||
|
}
|
||||||
|
tag = *table++;
|
||||||
|
}
|
||||||
|
DEBUG_TARGET("connect %04x debug_trampoline %04x end %04x\n",
|
||||||
|
priv->_connect_internal_flash, priv->_debug_trampoline,
|
||||||
|
priv->_debug_trampoline_end);
|
||||||
|
return (check != 8);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* RP ROM functions for flash handling return void */
|
||||||
|
static bool rp_rom_call(target *t, uint32_t *regs, uint32_t cmd,
|
||||||
|
uint32_t timeout)
|
||||||
|
{
|
||||||
|
const char spinner[] = "|/-\\";
|
||||||
|
int spinindex = 0;
|
||||||
|
struct rp_priv_s *ps = (struct rp_priv_s*)t->target_storage;
|
||||||
|
regs[7] = cmd;
|
||||||
|
regs[REG_LR] = ps->_debug_trampoline_end;
|
||||||
|
regs[REG_PC] = ps->_debug_trampoline;
|
||||||
|
regs[REG_MSP] = 0x20042000;
|
||||||
|
regs[REG_XPSR] = CORTEXM_XPSR_THUMB;
|
||||||
|
uint32_t dbg_regs[t->regs_size / sizeof(uint32_t)];
|
||||||
|
target_regs_write(t, regs);
|
||||||
|
/* start the target and wait for it to halt again */
|
||||||
|
target_halt_resume(t, false);
|
||||||
|
DEBUG_INFO("Call cmd %04x\n", cmd);
|
||||||
|
platform_timeout to;
|
||||||
|
platform_timeout_set(&to, timeout);
|
||||||
|
do {
|
||||||
|
if (timeout > 400)
|
||||||
|
tc_printf(t, "\b%c", spinner[spinindex++ % 4]);
|
||||||
|
if (platform_timeout_is_expired(&to)) {
|
||||||
|
DEBUG_WARN("RP Run timout %d ms reached: ", timeout);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
} while (!target_halt_poll(t, NULL));
|
||||||
|
/* Debug */
|
||||||
|
target_regs_read(t, dbg_regs);
|
||||||
|
bool ret = ((dbg_regs[REG_PC] &~1) != (ps->_debug_trampoline_end & ~1));
|
||||||
|
if (ret) {
|
||||||
|
DEBUG_WARN("rp_rom_call cmd %04x failed, PC %08" PRIx32 "\n",
|
||||||
|
cmd, dbg_regs[REG_PC]);
|
||||||
|
}
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void rp_flash_prepare(target *t)
|
||||||
|
{
|
||||||
|
struct rp_priv_s *ps = (struct rp_priv_s*)t->target_storage;
|
||||||
|
if (!ps->is_prepared) {
|
||||||
|
/* connect*/
|
||||||
|
rp_rom_call(t, ps->regs, ps->_connect_internal_flash,100);
|
||||||
|
/* exit_xip */
|
||||||
|
rp_rom_call(t, ps->regs, ps->_flash_exit_xip, 100);
|
||||||
|
ps->is_prepared = true;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* FLASHCMD_SECTOR_ERASE 45/ 400 ms
|
||||||
|
* 32k block erase 120/ 1600 ms
|
||||||
|
* 64k block erase 150/ 2000 ms
|
||||||
|
* chip erase 5000/25000 ms
|
||||||
|
* page programm 0.4/ 3 ms
|
||||||
|
*/
|
||||||
|
static int rp_flash_erase(struct target_flash *f, target_addr addr,
|
||||||
|
size_t len)
|
||||||
|
{
|
||||||
|
if (addr & 0xfff) {
|
||||||
|
DEBUG_WARN("Unaligned erase\n");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
if (len & 0xfff) {
|
||||||
|
DEBUG_WARN("Unaligned len\n");
|
||||||
|
len = (len + 0xfff) & ~0xfff;
|
||||||
|
}
|
||||||
|
DEBUG_INFO("Erase addr %08" PRIx32 " len 0x%" PRIx32 "\n", addr, len);
|
||||||
|
target *t = f->t;
|
||||||
|
rp_flash_prepare(t);
|
||||||
|
struct rp_priv_s *ps = (struct rp_priv_s*)t->target_storage;
|
||||||
|
/* Register playground*/
|
||||||
|
/* erase */
|
||||||
|
#define MAX_FLASH (2 * 1024 * 1024)
|
||||||
|
#define FLASHCMD_SECTOR_ERASE 0x20
|
||||||
|
#define FLASHCMD_BLOCK32K_ERASE 0x52
|
||||||
|
#define FLASHCMD_BLOCK64K_ERASE 0xd8
|
||||||
|
#define FLASHCMD_CHIP_ERASE 0x72
|
||||||
|
addr -= XIP_FLASH_START;
|
||||||
|
if (len > MAX_FLASH)
|
||||||
|
len = MAX_FLASH;
|
||||||
|
while (len) {
|
||||||
|
ps->regs[0] = addr;
|
||||||
|
ps->regs[2] = -1;
|
||||||
|
if (len >= MAX_FLASH) { /* Bulk erase */
|
||||||
|
ps->regs[1] = MAX_FLASH;
|
||||||
|
ps->regs[3] = FLASHCMD_CHIP_ERASE;
|
||||||
|
DEBUG_WARN("BULK_ERASE\n");
|
||||||
|
rp_rom_call(t, ps->regs, ps->_flash_range_erase, 25100);
|
||||||
|
len = 0;
|
||||||
|
} else if (len >= (64 * 1024)) {
|
||||||
|
uint32_t chunk = len & ~((1 << 16) - 1);
|
||||||
|
ps->regs[1] = chunk;
|
||||||
|
ps->regs[3] = FLASHCMD_BLOCK64K_ERASE;
|
||||||
|
DEBUG_WARN("64k_ERASE\n");
|
||||||
|
rp_rom_call(t, ps->regs, ps->_flash_range_erase, 2100);
|
||||||
|
len -= chunk ;
|
||||||
|
addr += chunk;
|
||||||
|
} else if (len >= (32 * 1024)) {
|
||||||
|
uint32_t chunk = len & ~((1 << 15) - 1);
|
||||||
|
ps->regs[1] = chunk;
|
||||||
|
ps->regs[3] = FLASHCMD_BLOCK32K_ERASE;
|
||||||
|
DEBUG_WARN("32k_ERASE\n");
|
||||||
|
rp_rom_call(t, ps->regs, ps->_flash_range_erase, 1700);
|
||||||
|
len -= chunk;
|
||||||
|
addr += chunk;
|
||||||
|
} else {
|
||||||
|
ps->regs[1] = len;
|
||||||
|
ps->regs[2] = MAX_FLASH;
|
||||||
|
ps->regs[3] = FLASHCMD_SECTOR_ERASE;
|
||||||
|
DEBUG_WARN("Sector_ERASE\n");
|
||||||
|
rp_rom_call(t, ps->regs, ps->_flash_range_erase, 410);
|
||||||
|
len = 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
DEBUG_INFO("\nErase done!\n");
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
int rp_flash_write(struct target_flash *f,
|
||||||
|
target_addr dest, const void *src, size_t len)
|
||||||
|
{
|
||||||
|
DEBUG_INFO("RP Write %08" PRIx32 " len 0x%" PRIx32 "\n", dest, len);
|
||||||
|
if ((dest & 0xff) || (len & 0xff)) {
|
||||||
|
DEBUG_WARN("Unaligned erase\n");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
target *t = f->t;
|
||||||
|
rp_flash_prepare(t);
|
||||||
|
struct rp_priv_s *ps = (struct rp_priv_s*)t->target_storage;
|
||||||
|
/* Write payload to target ram */
|
||||||
|
dest -= XIP_FLASH_START;
|
||||||
|
#define MAX_WRITE_CHUNK 0x1000
|
||||||
|
while (len) {
|
||||||
|
uint32_t chunksize = (len <= MAX_WRITE_CHUNK) ? len : MAX_WRITE_CHUNK;
|
||||||
|
target_mem_write(t, SRAM_START, src, chunksize);
|
||||||
|
/* Programm range */
|
||||||
|
ps->regs[0] = dest;
|
||||||
|
ps->regs[1] = SRAM_START;
|
||||||
|
ps->regs[2] = chunksize;
|
||||||
|
rp_rom_call(t, ps->regs, ps->flash_range_program,
|
||||||
|
(3 * chunksize) >> 8); /* 3 ms per 256 byte page */
|
||||||
|
len -= chunksize;
|
||||||
|
src += chunksize;
|
||||||
|
dest += chunksize;
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static bool rp_cmd_erase_mass(target *t, int argc, const char *argv[])
|
||||||
|
{
|
||||||
|
(void) argc;
|
||||||
|
(void) argv;
|
||||||
|
struct target_flash f;
|
||||||
|
f.t = t;
|
||||||
|
return (rp_flash_erase(&f, XIP_FLASH_START, MAX_FLASH)) ? false: true;
|
||||||
|
}
|
||||||
|
|
||||||
|
const struct command_s rp_cmd_list[] = {
|
||||||
|
{"erase_mass", rp_cmd_erase_mass, "Erase entire flash memory"},
|
||||||
|
{NULL, NULL, NULL}
|
||||||
|
};
|
||||||
|
|
||||||
|
static void rp_add_flash(target *t, uint32_t addr, size_t length)
|
||||||
|
{
|
||||||
|
struct target_flash *f = calloc(1, sizeof(*f));
|
||||||
|
if (!f) { /* calloc failed: heap exhaustion */
|
||||||
|
DEBUG_WARN("calloc: failed in %s\n", __func__);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
f->start = addr;
|
||||||
|
f->length = length;
|
||||||
|
f->blocksize = 0x1000;
|
||||||
|
f->erase = rp_flash_erase;
|
||||||
|
f->write = rp_flash_write;
|
||||||
|
f->buf_size = 2048; /* Max buffer size used eotherwise */
|
||||||
|
target_add_flash(t, f);
|
||||||
|
}
|
||||||
|
|
||||||
bool rp_probe(target *t)
|
bool rp_probe(target *t)
|
||||||
{
|
{
|
||||||
|
|
@ -53,8 +292,54 @@ bool rp_probe(target *t)
|
||||||
DEBUG_WARN("Wrong Bootmagic %08" PRIx32 " found\n!", boot_magic);
|
DEBUG_WARN("Wrong Bootmagic %08" PRIx32 " found\n!", boot_magic);
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
t->driver = "Raspberry RP2040";
|
#if defined(ENABLE_DEBUG)
|
||||||
target_add_ram(t, 0x20000000, 0x40000);
|
if ((boot_magic >> 24) == 1)
|
||||||
|
DEBUG_WARN("Old Bootrom Version 1!\n");
|
||||||
|
#endif
|
||||||
|
#define RP_MAX_TABLE_SIZE 0x80
|
||||||
|
uint16_t *table = alloca(RP_MAX_TABLE_SIZE);
|
||||||
|
uint16_t table_offset = target_mem_read32( t, BOOTROM_MAGIC_ADDR + 4);
|
||||||
|
if (!table || target_mem_read(t, table, table_offset, RP_MAX_TABLE_SIZE))
|
||||||
|
return false;
|
||||||
|
struct rp_priv_s *priv_storage = calloc(1, sizeof(struct rp_priv_s));
|
||||||
|
if (!priv_storage) { /* calloc failed: heap exhaustion */
|
||||||
|
DEBUG_WARN("calloc: failed in %s\n", __func__);
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
if (rp2040_fill_table(priv_storage, table, RP_MAX_TABLE_SIZE)) {
|
||||||
|
free(priv_storage);
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
t->target_storage = (void*)priv_storage;
|
||||||
|
uint32_t bootsec[16];
|
||||||
|
target_mem_read( t, bootsec, XIP_FLASH_START, sizeof( bootsec));
|
||||||
|
int i;
|
||||||
|
for (i = 0; i < 16; i++)
|
||||||
|
if (bootsec[i])
|
||||||
|
break;
|
||||||
|
uint32_t size = 8 * 1024 *1024;
|
||||||
|
if (i == 16) {
|
||||||
|
DEBUG_WARN("Use default size\n");
|
||||||
|
} else {
|
||||||
|
/* Find out size of connected SPI Flash
|
||||||
|
*
|
||||||
|
* Flash needs valid content to be mapped
|
||||||
|
* Low flash is mirrored when flash size is exceeded
|
||||||
|
*/
|
||||||
|
while (size) {
|
||||||
|
uint32_t mirrorsec[16];
|
||||||
|
target_mem_read(t, mirrorsec, XIP_FLASH_START + size,
|
||||||
|
sizeof( bootsec));
|
||||||
|
if (memcmp(bootsec, mirrorsec, sizeof( bootsec)))
|
||||||
|
break;
|
||||||
|
size >>= 1;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
rp_add_flash(t, XIP_FLASH_START, size << 1);
|
||||||
|
t->driver = RP_ID;
|
||||||
|
target_add_ram(t, SRAM_START, 0x40000);
|
||||||
|
target_add_ram(t, 0x51000000, 0x1000);
|
||||||
|
target_add_commands(t, rp_cmd_list, RP_ID);
|
||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -83,5 +368,4 @@ void rp_rescue_probe(ADIv5_AP_t *ap)
|
||||||
t->priv = ap;
|
t->priv = ap;
|
||||||
t->priv_free = (void*)adiv5_ap_unref;
|
t->priv_free = (void*)adiv5_ap_unref;
|
||||||
t->driver = "Raspberry RP2040 Rescue(Attach to reset!)";
|
t->driver = "Raspberry RP2040 Rescue(Attach to reset!)";
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
|
||||||
|
|
@ -584,6 +584,7 @@ void tc_printf(target *t, const char *fmt, ...)
|
||||||
|
|
||||||
va_start(ap, fmt);
|
va_start(ap, fmt);
|
||||||
t->tc->printf(t->tc, fmt, ap);
|
t->tc->printf(t->tc, fmt, ap);
|
||||||
|
fflush(stdout);
|
||||||
va_end(ap);
|
va_end(ap);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue