123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259 |
- #include <stdint.h>
- #include <stdbool.h>
- #include "nrf.h"
- #include "nrf_erratas.h"
- #include "system_nrf9160.h"
- #define __SYSTEM_CLOCK (64000000UL)
- #define TRACE_PIN_CNF_VALUE ( (GPIO_PIN_CNF_DIR_Output << GPIO_PIN_CNF_DIR_Pos) | \
- (GPIO_PIN_CNF_INPUT_Connect << GPIO_PIN_CNF_INPUT_Pos) | \
- (GPIO_PIN_CNF_PULL_Disabled << GPIO_PIN_CNF_PULL_Pos) | \
- (GPIO_PIN_CNF_DRIVE_H0H1 << GPIO_PIN_CNF_DRIVE_Pos) | \
- (GPIO_PIN_CNF_SENSE_Disabled << GPIO_PIN_CNF_SENSE_Pos) )
- #define TRACE_TRACECLK_PIN (21)
- #define TRACE_TRACEDATA0_PIN (22)
- #define TRACE_TRACEDATA1_PIN (23)
- #define TRACE_TRACEDATA2_PIN (24)
- #define TRACE_TRACEDATA3_PIN (25)
- #if defined ( __CC_ARM )
- uint32_t SystemCoreClock __attribute__((used)) = __SYSTEM_CLOCK;
- #elif defined ( __ICCARM__ )
- __root uint32_t SystemCoreClock = __SYSTEM_CLOCK;
- #elif defined ( __GNUC__ )
- uint32_t SystemCoreClock __attribute__((used)) = __SYSTEM_CLOCK;
- #endif
- #if !defined(NRF_TRUSTZONE_NONSECURE)
-
- static uint32_t uicr_erased_value;
- static uint32_t uicr_new_value;
- #endif
- #if !defined(NRF_TRUSTZONE_NONSECURE)
- static bool uicr_HFXOSRC_erased(void);
- static bool uicr_HFXOCNT_erased(void);
- #endif
- void SystemCoreClockUpdate(void)
- {
- SystemCoreClock = __SYSTEM_CLOCK;
- }
- void SystemInit(void)
- {
- #if !defined(NRF_TRUSTZONE_NONSECURE)
-
-
- #if defined (__ARM_FEATURE_CMSE) && (__ARM_FEATURE_CMSE == 3U)
- SAU->CTRL |= (1 << SAU_CTRL_ALLNS_Pos);
- #endif
-
-
- if (nrf91_errata_6()){
- NRF_POWER_S->EVENTS_SLEEPENTER = (POWER_EVENTS_SLEEPENTER_EVENTS_SLEEPENTER_NotGenerated << POWER_EVENTS_SLEEPENTER_EVENTS_SLEEPENTER_Pos);
- NRF_POWER_S->EVENTS_SLEEPEXIT = (POWER_EVENTS_SLEEPEXIT_EVENTS_SLEEPEXIT_NotGenerated << POWER_EVENTS_SLEEPEXIT_EVENTS_SLEEPEXIT_Pos);
- }
-
- if (nrf91_errata_14()){
- *((volatile uint32_t *)0x50004A38) = 0x01ul;
- NRF_REGULATORS_S->DCDCEN = REGULATORS_DCDCEN_DCDCEN_Enabled << REGULATORS_DCDCEN_DCDCEN_Pos;
- }
-
- if (nrf91_errata_15()){
- NRF_REGULATORS_S->DCDCEN = REGULATORS_DCDCEN_DCDCEN_Enabled << REGULATORS_DCDCEN_DCDCEN_Pos;
- }
-
- if (nrf91_errata_20()){
- *((volatile uint32_t *)0x5003AEE4) = 0xE;
- }
-
- if (nrf91_errata_31()){
- *((volatile uint32_t *)0x5000470Cul) = 0x0;
- *((volatile uint32_t *)0x50004710ul) = 0x1;
- }
-
- uint32_t index = 0;
- for (index = 0; index < 256ul && NRF_FICR_S->TRIMCNF[index].ADDR != 0xFFFFFFFFul; index++){
- #if defined ( __ICCARM__ )
- #pragma diag_suppress=Pa082
- #endif
- *(volatile uint32_t *)NRF_FICR_S->TRIMCNF[index].ADDR = NRF_FICR_S->TRIMCNF[index].DATA;
- #if defined ( __ICCARM__ )
- #pragma diag_default=Pa082
- #endif
- }
-
- if (uicr_HFXOSRC_erased() || uicr_HFXOCNT_erased()) {
-
- while (NRF_NVMC_S->READY != NVMC_READY_READY_Ready);
-
- NRF_NVMC_S->CONFIG = NVMC_CONFIG_WEN_Wen;
- while (NRF_NVMC_S->READY != NVMC_READY_READY_Ready);
- if (uicr_HFXOSRC_erased()){
-
- uicr_erased_value = NRF_UICR_S->HFXOSRC;
- uicr_new_value = (uicr_erased_value & ~UICR_HFXOSRC_HFXOSRC_Msk) | UICR_HFXOSRC_HFXOSRC_TCXO;
- NRF_UICR_S->HFXOSRC = uicr_new_value;
- while (NRF_NVMC_S->READY != NVMC_READY_READY_Ready);
- }
- if (uicr_HFXOCNT_erased()){
-
- uicr_erased_value = NRF_UICR_S->HFXOCNT;
- uicr_new_value = (uicr_erased_value & ~UICR_HFXOCNT_HFXOCNT_Msk) | 0x20;
- NRF_UICR_S->HFXOCNT = uicr_new_value;
- while (NRF_NVMC_S->READY != NVMC_READY_READY_Ready);
- }
-
- NRF_NVMC_S->CONFIG = NVMC_CONFIG_WEN_Ren;
- while (NRF_NVMC_S->READY != NVMC_READY_READY_Ready);
-
- NVIC_SystemReset();
- }
-
- #if defined (ENABLE_TRACE)
-
- NRF_TAD_S->ENABLE = TAD_ENABLE_ENABLE_Msk;
- NRF_TAD_S->CLOCKSTART = TAD_CLOCKSTART_START_Msk;
-
- NRF_SPU_S->GPIOPORT[0].PERM &= ~(1 << TRACE_TRACECLK_PIN);
- NRF_SPU_S->GPIOPORT[0].PERM &= ~(1 << TRACE_TRACEDATA0_PIN);
- NRF_SPU_S->GPIOPORT[0].PERM &= ~(1 << TRACE_TRACEDATA1_PIN);
- NRF_SPU_S->GPIOPORT[0].PERM &= ~(1 << TRACE_TRACEDATA2_PIN);
- NRF_SPU_S->GPIOPORT[0].PERM &= ~(1 << TRACE_TRACEDATA3_PIN);
-
- NRF_P0_S->PIN_CNF[TRACE_TRACECLK_PIN] = TRACE_PIN_CNF_VALUE;
- NRF_P0_S->PIN_CNF[TRACE_TRACEDATA0_PIN] = TRACE_PIN_CNF_VALUE;
- NRF_P0_S->PIN_CNF[TRACE_TRACEDATA1_PIN] = TRACE_PIN_CNF_VALUE;
- NRF_P0_S->PIN_CNF[TRACE_TRACEDATA2_PIN] = TRACE_PIN_CNF_VALUE;
- NRF_P0_S->PIN_CNF[TRACE_TRACEDATA3_PIN] = TRACE_PIN_CNF_VALUE;
-
- NRF_TAD_S->PSEL.TRACECLK = TRACE_TRACECLK_PIN;
- NRF_TAD_S->PSEL.TRACEDATA0 = TRACE_TRACEDATA0_PIN;
- NRF_TAD_S->PSEL.TRACEDATA1 = TRACE_TRACEDATA1_PIN;
- NRF_TAD_S->PSEL.TRACEDATA2 = TRACE_TRACEDATA2_PIN;
- NRF_TAD_S->PSEL.TRACEDATA3 = TRACE_TRACEDATA3_PIN;
-
- NRF_TAD_S->TRACEPORTSPEED = TAD_TRACEPORTSPEED_TRACEPORTSPEED_32MHz;
- *((uint32_t *)(0xE0053000ul)) = 0x00000001ul;
-
- *((uint32_t *)(0xE005AFB0ul)) = 0xC5ACCE55ul;
- *((uint32_t *)(0xE005A000ul)) &= 0xFFFFFF00ul;
- *((uint32_t *)(0xE005A004ul)) = 0x00000009ul;
- *((uint32_t *)(0xE005A000ul)) = 0x00000303ul;
- *((uint32_t *)(0xE005AFB0ul)) = 0x00000000ul;
- *((uint32_t *)(0xE005BFB0ul)) = 0xC5ACCE55ul;
- *((uint32_t *)(0xE005B000ul)) &= 0xFFFFFF00ul;
- *((uint32_t *)(0xE005B004ul)) = 0x00003000ul;
- *((uint32_t *)(0xE005B000ul)) = 0x00000308ul;
- *((uint32_t *)(0xE005BFB0ul)) = 0x00000000ul;
- *((uint32_t *)(0xE0058FB0ul)) = 0xC5ACCE55ul;
- *((uint32_t *)(0xE0058000ul)) = 0x00000000ul;
- *((uint32_t *)(0xE0058004ul)) = 0x00000000ul;
- *((uint32_t *)(0xE0058FB0ul)) = 0x00000000ul;
-
- #endif
-
- SCB->NSACR |= (3UL << 10);
- #endif
-
-
- #if (__FPU_USED == 1)
- SCB->CPACR |= (3UL << 20) | (3UL << 22);
- __DSB();
- __ISB();
- #endif
-
- SystemCoreClockUpdate();
- }
- #if !defined(NRF_TRUSTZONE_NONSECURE)
- bool uicr_HFXOCNT_erased()
- {
- if (NRF_UICR_S->HFXOCNT == 0xFFFFFFFFul) {
- return true;
- }
- return false;
- }
-
-
- bool uicr_HFXOSRC_erased()
- {
- if ((NRF_UICR_S->HFXOSRC & UICR_HFXOSRC_HFXOSRC_Msk) != UICR_HFXOSRC_HFXOSRC_TCXO) {
- return true;
- }
- return false;
- }
- #endif
|