Blame view

RIOT/cpu/nrf5x_common/periph/flashpage.c 1.13 KB
a752c7ab   elopes   add first test an...
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
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
  /*
   * Copyright (C) 2016 Freie Universitรคt Berlin
   *
   * This file is subject to the terms and conditions of the GNU Lesser
   * General Public License v2.1. See the file LICENSE in the top level
   * directory for more details.
   */
  
  /**
   * @ingroup     cpu_nrf5x_common
   * @ingroup     drivers_periph_flashpage
   * @{
   *
   * @file
   * @brief       Low-level flash page driver implementation
   *
   * @author      Hauke Petersen <hauke.petersen@fu-berlin.de>
   *
   * @}
   */
  
  #include "cpu.h"
  #include "assert.h"
  #include "periph/flashpage.h"
  
  void flashpage_write(int page, void *data)
  {
      assert(page < FLASHPAGE_NUMOF);
  
      uint32_t *page_addr = (uint32_t *)flashpage_addr(page);
      uint32_t *data_addr = (uint32_t *)data;
  
      /* erase given page */
      NRF_NVMC->CONFIG = NVMC_CONFIG_WEN_Een;
      NRF_NVMC->ERASEPAGE = (uint32_t)page_addr;
      while (NRF_NVMC->READY == 0) {}
  
      /* write data to page */
      if (data != NULL) {
          NRF_NVMC->CONFIG = NVMC_CONFIG_WEN_Wen;
          for (unsigned i = 0; i < (FLASHPAGE_SIZE / 4); i++) {
              *page_addr++ = data_addr[i];
          }
      }
  
      /* finish up */
      NRF_NVMC->CONFIG = NVMC_CONFIG_WEN_Ren;
  }