sys64738
/
blackmagic
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

kinetis: Run clang-format on the code

This commit is contained in:
dragonmux 2022-06-29 00:10:36 -04:00 committed by Piotr Esden-Tempski
parent 72e4f4d2b2
commit 18a49ac853
1 changed files with 186 additions and 197 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

95
src/target/kinetis.c
View File

@ -37,6 +37,7 @@
#include "general.h" #include "general.h"
#include "target.h" #include "target.h"
#include "target_internal.h" #include "target_internal.h"
#include "adiv5.h"
#define SIM_SDID 0x40048024 #define SIM_SDID 0x40048024
#define SIM_FCFG1 0x4004804C #define SIM_FCFG1 0x4004804C
@ -73,18 +74,16 @@
/* 8 byte phrases need to be written to the k64 flash */ /* 8 byte phrases need to be written to the k64 flash */
#define K64_WRITE_LEN 8 #define K64_WRITE_LEN 8
static bool kinetis_cmd_unsafe(target *t, int argc, char *argv[]); static bool kinetis_cmd_unsafe(target *t, int argc, char **argv);
const struct command_s kinetis_cmd_list[] = { const struct command_s kinetis_cmd_list[] = {
{"unsafe", (cmd_handler)kinetis_cmd_unsafe, "Allow programming security byte (enable|disable)"}, {"unsafe", (cmd_handler)kinetis_cmd_unsafe, "Allow programming security byte (enable|disable)"},
{NULL, NULL, NULL} {NULL, NULL, NULL}};
};
static bool kinetis_cmd_unsafe(target *t, int argc, char *argv[]) static bool kinetis_cmd_unsafe(target *t, int argc, char **argv)
{ {
if (argc == 1) { if (argc == 1) {
tc_printf(t, "Allow programming security byte: %s\n", tc_printf(t, "Allow programming security byte: %s\n", t->unsafe_enabled ? "enabled" : "disabled");
t->unsafe_enabled ? "enabled" : "disabled");
} else { } else {
parse_enable_or_disable(argv[1], &t->unsafe_enabled); parse_enable_or_disable(argv[1], &t->unsafe_enabled);
} }
@ -92,8 +91,7 @@ static bool kinetis_cmd_unsafe(target *t, int argc, char *argv[])
} }
static int kl_gen_flash_erase(struct target_flash *f, target_addr addr, size_t len); static int kl_gen_flash_erase(struct target_flash *f, target_addr addr, size_t len);
static int kl_gen_flash_write(struct target_flash *f, static int kl_gen_flash_write(struct target_flash *f, target_addr dest, const void *src, size_t len);
target_addr dest, const void *src, size_t len);
static int kl_gen_flash_done(struct target_flash *f); static int kl_gen_flash_done(struct target_flash *f);
struct kinetis_flash { struct kinetis_flash {
@ -101,8 +99,8 @@ struct kinetis_flash {
uint8_t write_len; uint8_t write_len;
}; };
static void kl_gen_add_flash(target *t, uint32_t addr, size_t length, static void kl_gen_add_flash(
size_t erasesize, size_t write_len) target *const t, const uint32_t addr, const size_t length, const size_t erasesize, const size_t write_len)
{ {
struct kinetis_flash *kf = calloc(1, sizeof(*kf)); struct kinetis_flash *kf = calloc(1, sizeof(*kf));
struct target_flash *f; struct target_flash *f;
@ -135,7 +133,7 @@ static void kl_s32k14_setup(
kl_gen_add_flash(t, 0x10000000, flexmem_size, 0x1000, K64_WRITE_LEN); /* FlexNVM, 4 KB Sectors */ kl_gen_add_flash(t, 0x10000000, flexmem_size, 0x1000, K64_WRITE_LEN); /* FlexNVM, 4 KB Sectors */
} }
bool kinetis_probe(target *t) bool kinetis_probe(target *const t)
{ {
uint32_t sdid = target_mem_read32(t, SIM_SDID); uint32_t sdid = target_mem_read32(t, SIM_SDID);
uint32_t fcfg1 = target_mem_read32(t, SIM_FCFG1); uint32_t fcfg1 = target_mem_read32(t, SIM_FCFG1);
@ -143,20 +141,20 @@ bool kinetis_probe(target *t)
switch (sdid >> 20) { switch (sdid >> 20) {
case 0x161: case 0x161:
/* sram memory size */ /* sram memory size */
switch((sdid >> 16) & 0x0f) { switch ((sdid >> 16) & 0x0f) {
case 0x03:/* 4 KB */ case 0x03: /* 4 KB */
target_add_ram(t, 0x1ffffc00, 0x0400); target_add_ram(t, 0x1ffffc00, 0x0400);
target_add_ram(t, 0x20000000, 0x0C00); target_add_ram(t, 0x20000000, 0x0C00);
break; break;
case 0x04:/* 8 KB */ case 0x04: /* 8 KB */
target_add_ram(t, 0x1ffff800, 0x0800); target_add_ram(t, 0x1ffff800, 0x0800);
target_add_ram(t, 0x20000000, 0x1800); target_add_ram(t, 0x20000000, 0x1800);
break; break;
case 0x05:/* 16 KB */ case 0x05: /* 16 KB */
target_add_ram(t, 0x1ffff000, 0x1000); target_add_ram(t, 0x1ffff000, 0x1000);
target_add_ram(t, 0x20000000, 0x3000); target_add_ram(t, 0x20000000, 0x3000);
break; break;
case 0x06:/* 32 KB */ case 0x06: /* 32 KB */
target_add_ram(t, 0x1fffe000, 0x2000); target_add_ram(t, 0x1fffe000, 0x2000);
target_add_ram(t, 0x20000000, 0x6000); target_add_ram(t, 0x20000000, 0x6000);
break; break;
@ -166,7 +164,7 @@ bool kinetis_probe(target *t)
} }
/* flash memory size */ /* flash memory size */
switch((fcfg1 >> 24) & 0x0f) { switch ((fcfg1 >> 24) & 0x0f) {
case 0x03: /* 32 KB */ case 0x03: /* 32 KB */
t->driver = "KL16Z32Vxxx"; t->driver = "KL16Z32Vxxx";
kl_gen_add_flash(t, 0x00000000, 0x08000, 0x400, KL_WRITE_LEN); kl_gen_add_flash(t, 0x00000000, 0x08000, 0x400, KL_WRITE_LEN);
@ -206,7 +204,7 @@ bool kinetis_probe(target *t)
kl_gen_add_flash(t, 0x00000000, 0x40000, 0x400, KL_WRITE_LEN); kl_gen_add_flash(t, 0x00000000, 0x40000, 0x400, KL_WRITE_LEN);
break; break;
case 0x271: case 0x271:
switch((sdid >> 16) & 0x0f) { switch ((sdid >> 16) & 0x0f) {
case 4: case 4:
t->driver = "KL27x32"; t->driver = "KL27x32";
target_add_ram(t, 0x1ffff800, 0x0800); target_add_ram(t, 0x1ffff800, 0x0800);
@ -224,7 +222,7 @@ bool kinetis_probe(target *t)
} }
break; break;
case 0x021: /* KL02 family */ case 0x021: /* KL02 family */
switch((sdid >> 16) & 0x0f) { switch ((sdid >> 16) & 0x0f) {
case 3: case 3:
t->driver = "KL02x32"; t->driver = "KL02x32";
target_add_ram(t, 0x1FFFFC00, 0x400); target_add_ram(t, 0x1FFFFC00, 0x400);
@ -272,7 +270,7 @@ bool kinetis_probe(target *t)
kl_gen_add_flash(t, 0x80000, 0x80000, 0x1000, K64_WRITE_LEN); kl_gen_add_flash(t, 0x80000, 0x80000, 0x1000, K64_WRITE_LEN);
break; break;
case 0x000: /* Older K-series */ case 0x000: /* Older K-series */
switch(sdid & 0xff0) { switch (sdid & 0xff0) {
case 0x000: /* K10 Family, DIEID=0x0 */ case 0x000: /* K10 Family, DIEID=0x0 */
case 0x080: /* K10 Family, DIEID=0x1 */ case 0x080: /* K10 Family, DIEID=0x1 */
case 0x100: /* K10 Family, DIEID=0x2 */ case 0x100: /* K10 Family, DIEID=0x2 */
@ -280,7 +278,7 @@ bool kinetis_probe(target *t)
case 0x220: /* K11 Family, DIEID=0x4 */ case 0x220: /* K11 Family, DIEID=0x4 */
return false; return false;
case 0x200: /* K12 Family, DIEID=0x4 */ case 0x200: /* K12 Family, DIEID=0x4 */
switch((fcfg1 >> 24) & 0x0f) { switch ((fcfg1 >> 24) & 0x0f) {
/* K12 Sub-Family Reference Manual, K12P80M50SF4RM, Rev. 4, February 2013 */ /* K12 Sub-Family Reference Manual, K12P80M50SF4RM, Rev. 4, February 2013 */
case 0x7: case 0x7:
t->driver = "MK12DX128Vxx5"; t->driver = "MK12DX128Vxx5";
@ -375,13 +373,12 @@ bool kinetis_probe(target *t)
return true; return true;
} }
static bool static bool kl_gen_command(target *t, uint8_t cmd, uint32_t addr, const uint32_t *data, int n_items)
kl_gen_command(target *t, uint8_t cmd, uint32_t addr, const uint32_t *data, int n_items)
{ {
uint8_t fstat; uint8_t fstat;
/* clear errors unconditionally, so we can start a new operation */ /* clear errors unconditionally, so we can start a new operation */
target_mem_write8(t,FTFA_FSTAT,(FTFA_FSTAT_ACCERR | FTFA_FSTAT_FPVIOL)); target_mem_write8(t, FTFA_FSTAT, (FTFA_FSTAT_ACCERR | FTFA_FSTAT_FPVIOL));
/* Wait for CCIF to be high */ /* Wait for CCIF to be high */
do { do {
@ -412,7 +409,7 @@ kl_gen_command(target *t, uint8_t cmd, uint32_t addr, const uint32_t *data, int
return true; return true;
} }
static int kl_gen_flash_erase(struct target_flash *f, target_addr addr, size_t len) static int kl_gen_flash_erase(struct target_flash *const f, target_addr addr, size_t len)
{ {
while (len) { while (len) {
if (kl_gen_command(f->t, FTFA_CMD_ERASE_SECTOR, addr, NULL, 0)) { if (kl_gen_command(f->t, FTFA_CMD_ERASE_SECTOR, addr, NULL, 0)) {
@ -432,17 +429,13 @@ static int kl_gen_flash_erase(struct target_flash *f, target_addr addr, size_t l
#define FLASH_SECURITY_BYTE_ADDRESS 0x40C #define FLASH_SECURITY_BYTE_ADDRESS 0x40C
#define FLASH_SECURITY_BYTE_UNSECURED 0xFE #define FLASH_SECURITY_BYTE_UNSECURED 0xFE
static int kl_gen_flash_write(struct target_flash *f, static int kl_gen_flash_write(struct target_flash *f, target_addr dest, const void *src, size_t len)
target_addr dest, const void *src, size_t len)
{ {
struct kinetis_flash *kf = (struct kinetis_flash *)f; struct kinetis_flash *const kf = (struct kinetis_flash *)f;
/* Ensure we don't write something horrible over the security byte */ /* Ensure we don't write something horrible over the security byte */
if (!f->t->unsafe_enabled && if (!f->t->unsafe_enabled && dest <= FLASH_SECURITY_BYTE_ADDRESS && dest + len > FLASH_SECURITY_BYTE_ADDRESS) {
dest <= FLASH_SECURITY_BYTE_ADDRESS && ((uint8_t *)src)[FLASH_SECURITY_BYTE_ADDRESS - dest] = FLASH_SECURITY_BYTE_UNSECURED;
dest + len > FLASH_SECURITY_BYTE_ADDRESS) {
((uint8_t*)src)[FLASH_SECURITY_BYTE_ADDRESS - dest] =
FLASH_SECURITY_BYTE_UNSECURED;
} }
/* Determine write command based on the alignment. */ /* Determine write command based on the alignment. */
@ -466,9 +459,9 @@ static int kl_gen_flash_write(struct target_flash *f,
return 0; return 0;
} }
static int kl_gen_flash_done(struct target_flash *f) static int kl_gen_flash_done(struct target_flash *const f)
{ {
struct kinetis_flash *kf = (struct kinetis_flash *)f; struct kinetis_flash *const kf = (struct kinetis_flash *)f;
if (f->t->unsafe_enabled) if (f->t->unsafe_enabled)
return 0; return 0;
@ -481,17 +474,15 @@ static int kl_gen_flash_done(struct target_flash *f)
*/ */
if (kf->write_len == K64_WRITE_LEN) { if (kf->write_len == K64_WRITE_LEN) {
uint32_t vals[2]; uint32_t vals[2];
vals[0] = target_mem_read32(f->t, FLASH_SECURITY_BYTE_ADDRESS-4); vals[0] = target_mem_read32(f->t, FLASH_SECURITY_BYTE_ADDRESS - 4);
vals[1] = target_mem_read32(f->t, FLASH_SECURITY_BYTE_ADDRESS); vals[1] = target_mem_read32(f->t, FLASH_SECURITY_BYTE_ADDRESS);
vals[1] = (vals[1] & 0xffffff00) | FLASH_SECURITY_BYTE_UNSECURED; vals[1] = (vals[1] & 0xffffff00) | FLASH_SECURITY_BYTE_UNSECURED;
kl_gen_command(f->t, FTFE_CMD_PROGRAM_PHRASE, kl_gen_command(f->t, FTFE_CMD_PROGRAM_PHRASE, FLASH_SECURITY_BYTE_ADDRESS - 4, vals, 2);
FLASH_SECURITY_BYTE_ADDRESS - 4, vals, 2);
} else { } else {
uint32_t vals[1]; uint32_t vals[1];
vals[0] = target_mem_read32(f->t, FLASH_SECURITY_BYTE_ADDRESS); vals[0] = target_mem_read32(f->t, FLASH_SECURITY_BYTE_ADDRESS);
vals[0] = (vals[0] & 0xffffff00) | FLASH_SECURITY_BYTE_UNSECURED; vals[0] = (vals[0] & 0xffffff00) | FLASH_SECURITY_BYTE_UNSECURED;
kl_gen_command(f->t, FTFA_CMD_PROGRAM_LONGWORD, kl_gen_command(f->t, FTFA_CMD_PROGRAM_LONGWORD, FLASH_SECURITY_BYTE_ADDRESS, vals, 1);
FLASH_SECURITY_BYTE_ADDRESS, vals, 1);
} }
return 0; return 0;
@ -504,7 +495,6 @@ static int kl_gen_flash_done(struct target_flash *f)
* a backdoor AP is provided which may allow a mass erase to recover the * a backdoor AP is provided which may allow a mass erase to recover the
* device. This provides a fake target to allow a monitor command interface * device. This provides a fake target to allow a monitor command interface
*/ */
#include "adiv5.h"
#define KINETIS_MDM_IDR_K22F 0x1c0000 #define KINETIS_MDM_IDR_K22F 0x1c0000
#define KINETIS_MDM_IDR_KZ03 0x1c0020 #define KINETIS_MDM_IDR_KZ03 0x1c0020
@ -514,19 +504,18 @@ static bool kinetis_mdm_cmd_ke04_mode(target *t, int argc, const char **argv);
const struct command_s kinetis_mdm_cmd_list[] = { const struct command_s kinetis_mdm_cmd_list[] = {
{"erase_mass", (cmd_handler)kinetis_mdm_cmd_erase_mass, "Erase entire flash memory"}, {"erase_mass", (cmd_handler)kinetis_mdm_cmd_erase_mass, "Erase entire flash memory"},
{"ke04_mode", (cmd_handler)kinetis_mdm_cmd_ke04_mode, "Allow erase for KE04"}, {"ke04_mode", (cmd_handler)kinetis_mdm_cmd_ke04_mode, "Allow erase for KE04"}, {NULL, NULL, NULL}};
{NULL, NULL, NULL}
};
enum target_halt_reason mdm_halt_poll(target *t, target_addr *watch) enum target_halt_reason mdm_halt_poll(target *t, const target_addr *const watch)
{ {
(void)t; (void)watch; (void)t;
(void)watch;
return TARGET_HALT_REQUEST; return TARGET_HALT_REQUEST;
} }
void kinetis_mdm_probe(ADIv5_AP_t *ap) void kinetis_mdm_probe(ADIv5_AP_t *ap)
{ {
switch(ap->idr) { switch (ap->idr) {
case KINETIS_MDM_IDR_KZ03: /* Also valid for KE04, no way to check! */ case KINETIS_MDM_IDR_KZ03: /* Also valid for KE04, no way to check! */
case KINETIS_MDM_IDR_K22F: case KINETIS_MDM_IDR_K22F:
break; break;
@ -541,7 +530,7 @@ void kinetis_mdm_probe(ADIv5_AP_t *ap)
adiv5_ap_ref(ap); adiv5_ap_ref(ap);
t->priv = ap; t->priv = ap;
t->priv_free = (void*)adiv5_ap_unref; t->priv_free = (void *)adiv5_ap_unref;
t->driver = "Kinetis Recovery (MDM-AP)"; t->driver = "Kinetis Recovery (MDM-AP)";
t->regs_size = 4; t->regs_size = 4;
@ -569,6 +558,7 @@ static bool kinetis_mdm_cmd_ke04_mode(target *t, int argc, const char **argv)
tc_printf(t, "Mass erase for KE04 now allowed\n"); tc_printf(t, "Mass erase for KE04 now allowed\n");
return true; return true;
} }
static bool kinetis_mdm_cmd_erase_mass(target *t, int argc, const char **argv) static bool kinetis_mdm_cmd_erase_mass(target *t, int argc, const char **argv)
{ {
(void)argc; (void)argc;
@ -576,13 +566,12 @@ static bool kinetis_mdm_cmd_erase_mass(target *t, int argc, const char **argv)
ADIv5_AP_t *ap = t->priv; ADIv5_AP_t *ap = t->priv;
/* Keep the MCU in reset as stated in KL25PxxM48SF0RM */ /* Keep the MCU in reset as stated in KL25PxxM48SF0RM */
if(t->ke04_mode) if (t->ke04_mode)
adiv5_ap_write(ap, MDM_CONTROL, MDM_CONTROL_SYS_RESET); adiv5_ap_write(ap, MDM_CONTROL, MDM_CONTROL_SYS_RESET);
uint32_t status, control; uint32_t status = adiv5_ap_read(ap, MDM_STATUS);
status = adiv5_ap_read(ap, MDM_STATUS); uint32_t control = adiv5_ap_read(ap, MDM_CONTROL);
control = adiv5_ap_read(ap, MDM_CONTROL); tc_printf(t, "Requesting mass erase (status = 0x%" PRIx32 ")\n", status);
tc_printf(t, "Requesting mass erase (status = 0x%"PRIx32")\n", status);
/* This flag does not exist on KE04 */ /* This flag does not exist on KE04 */
if (!(status & MDM_STATUS_MASS_ERASE_ENABLED) && !t->ke04_mode) { if (!(status & MDM_STATUS_MASS_ERASE_ENABLED) && !t->ke04_mode) {