On 6 August 2018 at 11:01, Steffen Görtz <cont...@steffen-goertz.de> wrote: > The nRF51 contains three regions of non-volatile memory (NVM): > - CODE (R/W): contains code > - FICR (R): Factory information like code size, chip id etc. > - UICR (R/W): Changeable configuration data. Lock bits, Code > protection configuration, Bootloader address, Nordic SoftRadio > configuration, Firmware configuration. > > Read and write access to the memories is managed by the > Non-volatile memory controller. > > Memory schema: > [ CPU ] -+- [ NVM, either FICR, UICR or CODE ] > | | > \- [ NVMC ] > --- > hw/nvram/Makefile.objs | 1 + > hw/nvram/nrf51_nvm.c | 390 +++++++++++++++++++++++++++++++++++ > include/hw/nvram/nrf51_nvm.h | 56 +++++ > 3 files changed, 447 insertions(+) > create mode 100644 hw/nvram/nrf51_nvm.c > create mode 100644 include/hw/nvram/nrf51_nvm.h > > diff --git a/hw/nvram/Makefile.objs b/hw/nvram/Makefile.objs > index a912d25391..3f978e6212 100644 > --- a/hw/nvram/Makefile.objs > +++ b/hw/nvram/Makefile.objs > @@ -5,3 +5,4 @@ common-obj-y += fw_cfg.o > common-obj-y += chrp_nvram.o > common-obj-$(CONFIG_MAC_NVRAM) += mac_nvram.o > obj-$(CONFIG_PSERIES) += spapr_nvram.o > +obj-$(CONFIG_NRF51_SOC) += nrf51_nvm.o > diff --git a/hw/nvram/nrf51_nvm.c b/hw/nvram/nrf51_nvm.c > new file mode 100644 > index 0000000000..603dbd7ca2 > --- /dev/null > +++ b/hw/nvram/nrf51_nvm.c > @@ -0,0 +1,390 @@ > +/* > + * Nordic Semiconductor nRF51 non-volatile memory > + * > + * It provides an interface to erase regions in flash memory. > + * Furthermore it provides the user and factory information registers. > + * > + * Reference Manual: http://infocenter.nordicsemi.com/pdf/nRF51_RM_v3.0.pdf > + * > + * See nRF51 reference manual and product sheet sections: > + * + Non-Volatile Memory Controller (NVMC) > + * + Factory Information Configuration Registers (FICR) > + * + User Information Configuration Registers (UICR) > + * > + * Copyright 2018 Steffen Görtz <cont...@steffen-goertz.de> > + * > + * This code is licensed under the GPL version 2 or later. See > + * the COPYING file in the top-level directory. > + */ > + > +#include "qemu/osdep.h" > +#include "qapi/error.h" > +#include "qemu/log.h" > +#include "exec/address-spaces.h" > +#include "hw/nvram/nrf51_nvm.h" > + > +#define NRF51_NVMC_SIZE 0x1000 > + > +#define NRF51_NVMC_READY 0x400 > +#define NRF51_NVMC_READY_READY 0x01 > +#define NRF51_NVMC_CONFIG 0x504 > +#define NRF51_NVMC_CONFIG_MASK 0x03 > +#define NRF51_NVMC_CONFIG_WEN 0x01 > +#define NRF51_NVMC_CONFIG_EEN 0x02 > +#define NRF51_NVMC_ERASEPCR1 0x508 > +#define NRF51_NVMC_ERASEPCR0 0x510 > +#define NRF51_NVMC_ERASEALL 0x50C > +#define NRF51_NVMC_ERASEUICR 0x514 > +#define NRF51_NVMC_ERASE 0x01 > + > +#define NRF51_FICR_SIZE 0x100 > + > +#define NRF51_UICR_SIZE 0x100 > + > + > +/* FICR Registers Assignments > +CODEPAGESIZE 0x010 > +CODESIZE 0x014
This is confusing because these lines look like code because they don't have the leading " * ". Please keep multiline comments to the standard format that CODING_STYLE (now) suggests. > +CLENR0 0x028 > +PPFC 0x02C > +NUMRAMBLOCK 0x034 > +SIZERAMBLOCKS 0x038 > +SIZERAMBLOCK[0] 0x038 > +SIZERAMBLOCK[1] 0x03C > +SIZERAMBLOCK[2] 0x040 > +SIZERAMBLOCK[3] 0x044 > +CONFIGID 0x05C > +DEVICEID[0] 0x060 > +DEVICEID[1] 0x064 > +ER[0] 0x080 > +ER[1] 0x084 > +ER[2] 0x088 > +ER[3] 0x08C > +IR[0] 0x090 > +IR[1] 0x094 > +IR[2] 0x098 > +IR[3] 0x09C > +DEVICEADDRTYPE 0x0A0 > +DEVICEADDR[0] 0x0A4 > +DEVICEADDR[1] 0x0A8 > +OVERRIDEEN 0x0AC > +NRF_1MBIT[0] 0x0B0 > +NRF_1MBIT[1] 0x0B4 > +NRF_1MBIT[2] 0x0B8 > +NRF_1MBIT[3] 0x0BC > +NRF_1MBIT[4] 0x0C0 > +BLE_1MBIT[0] 0x0EC > +BLE_1MBIT[1] 0x0F0 > +BLE_1MBIT[2] 0x0F4 > +BLE_1MBIT[3] 0x0F8 > +BLE_1MBIT[4] 0x0FC > +*/ > +static const uint32_t ficr_content[64] = { > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0x00000400, > + 0x00000100, 0xFFFFFFFF, 0xFFFFFFFF, 0x00000002, 0x00002000, > + 0x00002000, 0x00002000, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0x00000003, > + 0x12345678, 0x9ABCDEF1, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF > +}; > + > +static uint64_t ficr_read(void *opaque, hwaddr offset, unsigned int size) > +{ > + return ficr_content[offset >> 2]; We can't get here with a bogus offset because of the use of sizeof() when registering the memory region. I think that an assert() that offset is in range before doing the array dereference would be helpful though, as a defensive guard against the MR size being changed in future: it turns the consequences of that bug from "read out of bounds" to "assertion failure". Similarly with uicr. > +} > +static const uint32_t uicr_fixture[NRF51_UICR_FIXTURE_SIZE] = { > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, > + 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF, 0xFFFFFFFF > +}; Would this ever be anything other than "all 0xff" ? If not, might be more obvious just to use memset() to init/reset the data. > + > +static uint64_t uicr_read(void *opaque, hwaddr offset, unsigned int size) > +{ > + Nrf51NVMState *s = NRF51_NVM(opaque); > + > + offset >>= 2; > + > + return s->uicr_content[offset]; > +} > + > +static void uicr_write(void *opaque, hwaddr offset, uint64_t value, > + unsigned int size) > +{ > + Nrf51NVMState *s = NRF51_NVM(opaque); > + > + offset >>= 2; > + > + if (offset >= ARRAY_SIZE(s->uicr_content)) { > + qemu_log_mask(LOG_GUEST_ERROR, > + "%s: bad read offset 0x%" HWADDR_PRIx "\n", __func__, > offset); > + return; > + } > + > + s->uicr_content[offset] = value; > +} > + > +static const MemoryRegionOps uicr_ops = { > + .read = uicr_read, > + .write = uicr_write, > + .impl.min_access_size = 4, > + .impl.max_access_size = 4, > + .impl.unaligned = false, > +}; > + > + > +static uint64_t io_read(void *opaque, hwaddr offset, unsigned int size) > +{ > + Nrf51NVMState *s = NRF51_NVM(opaque); > + uint64_t r = 0; > + > + switch (offset) { > + case NRF51_NVMC_READY: > + r = NRF51_NVMC_READY_READY; > + break; > + case NRF51_NVMC_CONFIG: > + r = s->config; > + break; > + default: > + qemu_log_mask(LOG_GUEST_ERROR, > + "%s: bad read offset 0x%" HWADDR_PRIx "\n", __func__, > offset); Missing "break;" here (and at the end of the switches in the other functions in this file). The compiler won't complain (and the behaviour is correct) but Coverity likely will produce a warning later. > + } > + > + return r; > +} > + > +static void io_write(void *opaque, hwaddr offset, uint64_t value, > + unsigned int size) > +{ > + Nrf51NVMState *s = NRF51_NVM(opaque); > + > + switch (offset) { > + case NRF51_NVMC_CONFIG: > + s->config = value & NRF51_NVMC_CONFIG_MASK; > + break; > + case NRF51_NVMC_ERASEPCR0: > + case NRF51_NVMC_ERASEPCR1: > + value &= ~(s->page_size - 1); > + if (value < (s->code_size * s->page_size)) { > + address_space_write(&s->as, value, MEMTXATTRS_UNSPECIFIED, > + s->empty_page, s->page_size); > + } > + break; > + case NRF51_NVMC_ERASEALL: > + if (value == NRF51_NVMC_ERASE) { > + for (uint32_t i = 0; i < s->code_size; i++) { > + address_space_write(&s->as, i * s->page_size, > + MEMTXATTRS_UNSPECIFIED, s->empty_page, s->page_size); > + } > + memset(s->uicr_content, 0xFF, sizeof(s->uicr_content)); > + } > + break; > + case NRF51_NVMC_ERASEUICR: > + if (value == NRF51_NVMC_ERASE) { > + memset(s->uicr_content, 0xFF, sizeof(s->uicr_content)); > + } > + break; > + > + default: > + qemu_log_mask(LOG_GUEST_ERROR, > + "%s: bad write offset 0x%" HWADDR_PRIx "\n", __func__, > offset); > + } > +} > + > +static const MemoryRegionOps io_ops = { > + .read = io_read, > + .write = io_write, > + .endianness = DEVICE_LITTLE_ENDIAN, > +}; > + > +static void nrf51_nvm_init(Object *obj) > +{ > + Nrf51NVMState *s = NRF51_NVM(obj); > + SysBusDevice *sbd = SYS_BUS_DEVICE(obj); > + > + memory_region_init_io(&s->mmio, obj, &io_ops, s, "nrf51_soc.nvmc", > + NRF51_NVMC_SIZE); > + sysbus_init_mmio(sbd, &s->mmio); > + > + memory_region_init_io(&s->ficr, NULL, &ficr_ops, s, "nrf51_soc.ficr", > + sizeof(ficr_content)); > + memory_region_set_readonly(&s->ficr, true); memory_region_set_readonly() is only intended for use with RAM regions, which this is not. Usually if you want an IO region that has "ignores writes" behaviour you just give it a write function that does nothing. > + sysbus_init_mmio(sbd, &s->ficr); > + > + memcpy(s->uicr_content, uicr_fixture, sizeof(s->uicr_content)); The guest can change uicr_content[], so this memcpy() is a part of reset and should be in the reset function, so that it gets set back to its correct value on a reset. > + memory_region_init_io(&s->uicr, NULL, &uicr_ops, s, "nrf51_soc.uicr", > + sizeof(s->uicr_content)); > + sysbus_init_mmio(sbd, &s->uicr); > +} > + > +static void nrf51_nvm_realize(DeviceState *dev, Error **errp) > +{ > + Nrf51NVMState *s = NRF51_NVM(dev); > + > + if (!s->mr) { > + error_setg(errp, "memory property was not set"); > + return; > + } > + > + if (s->page_size < NRF51_UICR_SIZE) { > + error_setg(errp, "page size too small"); > + return; > + } > + > + s->empty_page = g_malloc(s->page_size); > + > + address_space_init(&s->as, s->mr, "system-memory"); > +} > + > +static void nrf51_nvm_unrealize(DeviceState *dev, Error **errp) > +{ > + Nrf51NVMState *s = NRF51_NVM(dev); > + > + g_free(s->empty_page); > + s->empty_page = NULL; > +} This device can't be hot-unplugged, so an unrealize function is unreachable and not required. > + > +static void nrf51_nvm_reset(DeviceState *dev) > +{ > + Nrf51NVMState *s = NRF51_NVM(dev); > + > + memset(s->empty_page, 0xFF, s->page_size); > +} > + > + > +static Property nrf51_nvm_properties[] = { > + DEFINE_PROP_UINT16("page_size", Nrf51NVMState, page_size, 0x400), Do the different NRF51 variants really have different NAND page sizes ? > + DEFINE_PROP_UINT32("code_size", Nrf51NVMState, code_size, 0x100), > + DEFINE_PROP_LINK("memory", Nrf51NVMState, mr, TYPE_MEMORY_REGION, > + MemoryRegion *), > + DEFINE_PROP_END_OF_LIST(), > +}; thanks -- PMM