From 34d0f64529a77c0375af8c9429b5571e7cedcb0b Mon Sep 17 00:00:00 2001 From: Mike Date: Fri, 25 Apr 2014 22:34:58 +0100 Subject: [PATCH] Nordic nRF51 series support --- flashstub/nrf51.s | 40 +++++++ src/Makefile | 1 + src/cortexm.c | 1 + src/include/target.h | 1 + src/nrf51.c | 244 +++++++++++++++++++++++++++++++++++++++++++ 5 files changed, 287 insertions(+) create mode 100644 flashstub/nrf51.s create mode 100644 src/nrf51.c diff --git a/flashstub/nrf51.s b/flashstub/nrf51.s new file mode 100644 index 0000000..e23b613 --- /dev/null +++ b/flashstub/nrf51.s @@ -0,0 +1,40 @@ +.global _start + +_start: + ldr r0, _ready + ldr r1, _addr + mov r2, pc + add r2, #(_data - . - 2) + ldr r3, _size +_next: + cmp r3, #0 + beq _done + @ Write data to flash + ldr r4, [r2] + str r4, [r1] + +_wait: @ Wait for READY bit + ldr r4, [r0] + mov r6, #1 + tst r4, r6 + beq _wait + + sub r3, #4 + add r1, #4 + add r2, #4 + b _next +_done: + bkpt + +@.align 4 +.org 0x24 +_ready: + .word 0x4001E400 +_addr: + .word 0 +_size: + .word 12 +_data: + .word 0xAAAAAAAA + .word 0xBBBBBBBB + .word 0xCCCCCCCC diff --git a/src/Makefile b/src/Makefile index d8d8b00..85b0337 100644 --- a/src/Makefile +++ b/src/Makefile @@ -28,6 +28,7 @@ SRC = \ lpc11xx.c \ lpc43xx.c \ main.c \ + nrf51.c \ platform.c \ sam3x.c \ stm32f1.c \ diff --git a/src/cortexm.c b/src/cortexm.c index 819dacd..8a9beb8 100644 --- a/src/cortexm.c +++ b/src/cortexm.c @@ -383,6 +383,7 @@ cortexm_probe(struct target_s *target) PROBE(lpc11xx_probe); PROBE(lpc43xx_probe); PROBE(sam3x_probe); + PROBE(nrf51_probe); PROBE(lmi_probe); #undef PROBE diff --git a/src/include/target.h b/src/include/target.h index 574a0eb..03230a5 100644 --- a/src/include/target.h +++ b/src/include/target.h @@ -212,6 +212,7 @@ bool lmi_probe(struct target_s *target); bool lpc11xx_probe(struct target_s *target); bool lpc43xx_probe(struct target_s *target); bool sam3x_probe(struct target_s *target); +bool nrf51_probe(struct target_s *target); #endif diff --git a/src/nrf51.c b/src/nrf51.c new file mode 100644 index 0000000..7a9d136 --- /dev/null +++ b/src/nrf51.c @@ -0,0 +1,244 @@ +/* + * This file is part of the Black Magic Debug project. + * + * Copyright (C) 2014 Mike Walters + * + * This program is free software: you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation, either version 3 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program. If not, see . + */ + +/* This file implements nRF51 target specific functions for detecting + * the device, providing the XML memory map and Flash memory programming. + */ + +#include +#include + +#include "general.h" +#include "adiv5.h" +#include "target.h" +#include "command.h" +#include "gdb_packet.h" + +static int nrf51_flash_erase(struct target_s *target, uint32_t addr, int len); +static int nrf51_flash_write(struct target_s *target, uint32_t dest, + const uint8_t *src, int len); + +static bool nrf51_cmd_erase_all(target *t); + +const struct command_s nrf51_cmd_list[] = { + {"erase_mass", (cmd_handler)nrf51_cmd_erase_all, "Erase entire flash memory"}, + {NULL, NULL, NULL} +}; + +static const char nrf51_xml_memory_map[] = "" +/* ""*/ + "" + " " + " 0x400" + " " + " " + ""; + +/* Non-Volatile Memory Controller (NVMC) Registers */ +#define NRF51_NVMC 0x4001E000 +#define NRF51_NVMC_READY (NRF51_NVMC + 0x400) +#define NRF51_NVMC_CONFIG (NRF51_NVMC + 0x504) +#define NRF51_NVMC_ERASEPAGE (NRF51_NVMC + 0x508) +#define NRF51_NVMC_ERASEALL (NRF51_NVMC + 0x50C) +#define NRF51_NVMC_ERASEUICR (NRF51_NVMC + 0x514) + +#define NRF51_NVMC_CONFIG_REN 0x0 // Read only access +#define NRF51_NVMC_CONFIG_WEN 0x1 // Write enable +#define NRF51_NVMC_CONFIG_EEN 0x2 // Erase enable + +/* Factory Information Configuration Registers (FICR) */ +#define NRF51_FICR 0x10000000 +#define NRF51_FICR_CODEPAGESIZE (NRF51_FICR + 0x010) +#define NRF51_FICR_CODESIZE (NRF51_FICR + 0x014) +#define NRF51_FICR_CONFIGID (NRF51_FICR + 0x05C) + +#define NRF51_PAGE_SIZE 1024 + +uint16_t nrf51_flash_write_stub[] = { +// _start: + 0x4808, // ldr r0, [pc, #32] ; (24 <_ready>) + 0x4909, // ldr r1, [pc, #36] ; (28 <_addr>) + 0x467a, // mov r2, pc + 0x3228, // adds r2, #40 ; 0x28 + 0x4b08, // ldr r3, [pc, #32] ; (2c <_size>) + +// next: + 0x2b00, // cmp r3, #0 + 0xd009, // beq.n 22 <_done> + 0x6814, // ldr r4, [r2, #0] + 0x600c, // str r4, [r1, #0] + +// wait: + 0x6804, // ldr r4, [r0, #0] + 0x2601, // movs r6, #1 + 0x4234, // tst r4, r6 + 0xd0fb, // beq.n 12 <_wait> + + 0x3b04, // subs r3, #4 + 0x3104, // adds r1, #4 + 0x3204, // adds r2, #4 + 0xe7f3, // b.n a <_next> + +// done: + 0xbe00, // bkpt 0x0000 + +// ready: + 0xe400, 0x4001 // .word 0x4001e400 +// addr: +// 0x0000, 0x0000 +// size: +// 0x0000, 0x0000 +// data: +// ... + +}; + +bool nrf51_probe(struct target_s *target) +{ + ADIv5_AP_t *ap = adiv5_target_ap(target); + + target->idcode = adiv5_ap_mem_read(ap, NRF51_FICR_CONFIGID) & 0xFFFF; + + switch (target->idcode) { + case 0x001D: + case 0x002A: + case 0x0044: + case 0x003C: + case 0x0020: + case 0x002F: + case 0x0040: + case 0x0047: + case 0x004D: + case 0x0026: + case 0x004C: + target->driver = "Nordic nRF51"; + target->xml_mem_map = nrf51_xml_memory_map; + target->flash_erase = nrf51_flash_erase; + target->flash_write = nrf51_flash_write; + target_add_commands(target, nrf51_cmd_list, "nRF51"); + return true; + } + + return false; +} + +static int nrf51_flash_erase(struct target_s *target, uint32_t addr, int len) +{ + + ADIv5_AP_t *ap = adiv5_target_ap(target); + + addr &= ~(NRF51_PAGE_SIZE - 1); + len &= ~(NRF51_PAGE_SIZE - 1); + + /* Enable erase */ + adiv5_ap_mem_write(ap, NRF51_NVMC_CONFIG, NRF51_NVMC_CONFIG_EEN); + + /* Poll for NVMC_READY */ + while(adiv5_ap_mem_read(ap, NRF51_NVMC_READY) == 0) + if(target_check_error(target)) + return -1; + + while (len) { + /* Write address of first word in page to erase it */ + adiv5_ap_mem_write(ap, NRF51_NVMC_ERASEPAGE, addr); + + /* Poll for NVMC_READY */ + while(adiv5_ap_mem_read(ap, NRF51_NVMC_READY) == 0) + if(target_check_error(target)) + return -1; + + addr += NRF51_PAGE_SIZE; + len -= NRF51_PAGE_SIZE; + } + + /* Return to read-only */ + adiv5_ap_mem_write(ap, NRF51_NVMC_CONFIG, NRF51_NVMC_CONFIG_REN); + + /* Poll for NVMC_READY */ + while(adiv5_ap_mem_read(ap, NRF51_NVMC_READY) == 0) + if(target_check_error(target)) + return -1; + + return 0; +} + +static int nrf51_flash_write(struct target_s *target, uint32_t dest, + const uint8_t *src, int len) +{ + ADIv5_AP_t *ap = adiv5_target_ap(target); + uint32_t offset = dest % 4; + uint32_t words = (offset + len + 3) / 4; + uint32_t data[2 + words]; + + /* Construct data buffer used by stub */ + data[0] = dest - offset; + data[1] = words * 4; /* length must always be a multiple of 4 */ + data[2] = 0xFFFFFFFF; /* pad partial words with all 1s to avoid */ + data[words + 1] = 0xFFFFFFFF; /* damaging overlapping areas */ + memcpy((uint8_t *)&data[2] + offset, src, len); + + /* Enable write */ + adiv5_ap_mem_write(ap, NRF51_NVMC_CONFIG, NRF51_NVMC_CONFIG_WEN); + + /* Poll for NVMC_READY */ + while(adiv5_ap_mem_read(ap, NRF51_NVMC_READY) == 0) + if(target_check_error(target)) + return -1; + + /* Write stub and data to target ram and set PC */ + target_mem_write_words(target, 0x20000000, (void*)nrf51_flash_write_stub, 0x28); + target_mem_write_words(target, 0x20000028, data, len + 8); + target_pc_write(target, 0x20000000); + if(target_check_error(target)) + return -1; + + /* Execute the stub */ + target_halt_resume(target, 0); + while(!target_halt_wait(target)); + + /* Return to read-only */ + adiv5_ap_mem_write(ap, NRF51_NVMC_CONFIG, NRF51_NVMC_CONFIG_REN); + + return 0; +} + +static bool nrf51_cmd_erase_all(target *t) +{ + ADIv5_AP_t *ap = adiv5_target_ap(t); + + /* Enable erase */ + adiv5_ap_mem_write(ap, NRF51_NVMC_CONFIG, NRF51_NVMC_CONFIG_EEN); + + /* Poll for NVMC_READY */ + while(adiv5_ap_mem_read(ap, NRF51_NVMC_READY) == 0) + if(target_check_error(t)) + return false; + + /* Erase all */ + adiv5_ap_mem_write(ap, NRF51_NVMC_ERASEALL, 1); + + /* Poll for NVMC_READY */ + while(adiv5_ap_mem_read(ap, NRF51_NVMC_READY) == 0) + if(target_check_error(t)) + return false; + + return true; +} \ No newline at end of file