system_ac7840x.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564
  1. /* Copyright Statement:
  2. *
  3. * This software/firmware and related documentation ("AutoChips Software") are
  4. * protected under relevant copyright laws. The information contained herein is
  5. * confidential and proprietary to AutoChips Inc. and/or its licensors. Without
  6. * the prior written permission of AutoChips inc. and/or its licensors, any
  7. * reproduction, modification, use or disclosure of AutoChips Software, and
  8. * information contained herein, in whole or in part, shall be strictly
  9. * prohibited.
  10. *
  11. * AutoChips Inc. (C) 2021. All rights reserved.
  12. *
  13. * BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
  14. * THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("AUTOCHIPS SOFTWARE")
  15. * RECEIVED FROM AUTOCHIPS AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER
  16. * ON AN "AS-IS" BASIS ONLY. AUTOCHIPS EXPRESSLY DISCLAIMS ANY AND ALL
  17. * WARRANTIES, EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED
  18. * WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR
  19. * NONINFRINGEMENT. NEITHER DOES AUTOCHIPS PROVIDE ANY WARRANTY WHATSOEVER WITH
  20. * RESPECT TO THE SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY,
  21. * INCORPORATED IN, OR SUPPLIED WITH THE AUTOCHIPS SOFTWARE, AND RECEIVER AGREES
  22. * TO LOOK ONLY TO SUCH THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO.
  23. * RECEIVER EXPRESSLY ACKNOWLEDGES THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO
  24. * OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES CONTAINED IN AUTOCHIPS
  25. * SOFTWARE. AUTOCHIPS SHALL ALSO NOT BE RESPONSIBLE FOR ANY AUTOCHIPS SOFTWARE
  26. * RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
  27. * STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND AUTOCHIPS'S
  28. * ENTIRE AND CUMULATIVE LIABILITY WITH RESPECT TO THE AUTOCHIPS SOFTWARE
  29. * RELEASED HEREUNDER WILL BE, AT AUTOCHIPS'S OPTION, TO REVISE OR REPLACE THE
  30. * AUTOCHIPS SOFTWARE AT ISSUE, OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE
  31. * CHARGE PAID BY RECEIVER TO AUTOCHIPS FOR SUCH AUTOCHIPS SOFTWARE AT ISSUE.
  32. */
  33. /*!
  34. * @file system_ac7840x.c
  35. *
  36. * @brief This file provides system clock config integration functions.
  37. *
  38. */
  39. /* =========================================== Includes =========================================== */
  40. #include "device_register.h"
  41. #if SYSTEM_USE_CKGEN
  42. #include "ckgen_drv.h"
  43. #endif
  44. /* ============================================ Define ============================================ */
  45. /* =========================================== Typedef ============================================ */
  46. /* ========================================== Variables =========================================== */
  47. uint32_t SystemCoreClock = DEFAULT_SYSTEM_CLOCK; /* System/core clock */
  48. /* ==================================== Functions declaration ===================================== */
  49. /* Externals declaration */
  50. #if defined (__VTOR_PRESENT) && (__VTOR_PRESENT == 1U)
  51. extern uint32_t __Vectors;
  52. #endif
  53. /* ====================================== Functions define ======================================== */
  54. /*!
  55. * @brief Initialize SPLL then set system clock to the SPLL clock
  56. * (just support SPLL refer clock 4/8/12/16/30MHz, others need to modify).
  57. *
  58. * @param[in] refClk: 0: HSI clock, 1: HSE clock
  59. * @param[in] freq: SPLL out frequency (16 - 120)
  60. * @return status 0: success others: error
  61. */
  62. uint32_t SetSysClkToSPLL(uint8_t refClk, uint8_t freq)
  63. {
  64. uint32_t ret = 0U, status, outFreq = freq;
  65. uint32_t timeout = 100000U, posdiv, fbkdiv, prediv;
  66. if (outFreq > 120U)
  67. {
  68. outFreq = 120U;
  69. }
  70. if (outFreq < 16U)
  71. {
  72. outFreq = 16U;
  73. }
  74. if (refClk != 0U)
  75. {
  76. /* Set XOSC bypass mode */
  77. MODIFY_REG32(SPM->PWR_MGR_CFG1, SPM_PWR_MGR_CFG1_XOSC_HSEBYP_Msk, SPM_PWR_MGR_CFG1_XOSC_HSEBYP_Pos, 0U);
  78. /* XOSC enable */
  79. SET_BIT32(SPM->PWR_MGR_CFG1, SPM_PWR_MGR_CFG1_XOSC_HSEEN_Msk);
  80. do
  81. {
  82. status = READ_BIT32(SPM->PWR_MGR_CFG1, SPM_PWR_MGR_CFG1_XOSC_RDY_Msk);
  83. } while ((0U == status) && (--timeout != 0U));
  84. if (0U == timeout)
  85. {
  86. ret = 1U;
  87. }
  88. /* SPLL configuration outFreq = (srcFreq / (prediv + 1)) * fbkdiv / (posdiv * 2) */
  89. #if (CKGEN_HSE_FREQ == 30000000U) /* For HSE frequency 30MHz */
  90. if (outFreq == 120U)
  91. {
  92. posdiv = 5U;
  93. fbkdiv = 160U;
  94. }
  95. else if (outFreq == 96U)
  96. {
  97. posdiv = 5U;
  98. fbkdiv = 128U;
  99. }
  100. else if (outFreq == 80U)
  101. {
  102. posdiv = 6U;
  103. fbkdiv = 128U;
  104. }
  105. else /* Output frequency 48MHz */
  106. {
  107. posdiv = 10U;
  108. fbkdiv = 128U;
  109. outFreq = 48U;
  110. }
  111. prediv = 3U;
  112. #elif (CKGEN_HSE_FREQ == 16000000U) /* For HSE frequency 16MHz */
  113. if (outFreq > 64U)
  114. {
  115. posdiv = 4U;
  116. fbkdiv = outFreq;
  117. }
  118. else if (outFreq > 32U)
  119. {
  120. posdiv = 8U;
  121. fbkdiv = outFreq * 2U;
  122. }
  123. else
  124. {
  125. posdiv = 16U;
  126. fbkdiv = outFreq * 4U;
  127. }
  128. prediv = 1U;
  129. #elif (CKGEN_HSE_FREQ == 12000000U) /* For HSE frequency 12MHz */
  130. if (outFreq > 62U)
  131. {
  132. posdiv = 6U;
  133. fbkdiv = outFreq;
  134. }
  135. else if (outFreq > 31U)
  136. {
  137. posdiv = 12U;
  138. fbkdiv = outFreq * 2U;
  139. }
  140. else
  141. {
  142. posdiv = 24U;
  143. fbkdiv = outFreq * 4U;
  144. }
  145. prediv = 0U;
  146. #elif (CKGEN_HSE_FREQ == 4000000U) /* For HSE frequency 4MHz */
  147. if (outFreq > 64U)
  148. {
  149. posdiv = 4U;
  150. fbkdiv = outFreq * 2;
  151. }
  152. else if (outFreq > 32U)
  153. {
  154. posdiv = 8U;
  155. fbkdiv = outFreq * 4U;
  156. }
  157. else
  158. {
  159. posdiv = 16U;
  160. fbkdiv = outFreq * 8U;
  161. }
  162. prediv = 0U;
  163. #else /* For default HSE 8MHz */
  164. if (outFreq > 64U)
  165. {
  166. posdiv = 4U;
  167. fbkdiv = outFreq;
  168. }
  169. else if (outFreq > 32U)
  170. {
  171. posdiv = 8U;
  172. fbkdiv = outFreq * 2U;
  173. }
  174. else
  175. {
  176. posdiv = 16U;
  177. fbkdiv = outFreq * 4U;
  178. }
  179. prediv = 0U;
  180. #endif
  181. }
  182. else
  183. {
  184. /* HSI enable */
  185. SET_BIT32(SPM->PWR_MGR_CFG1, SPM_PWR_MGR_CFG1_HSI_EN_NORMAL_Msk);
  186. timeout = 1000U;
  187. do
  188. {
  189. status = READ_BIT32(SPM->PWR_MGR_CFG1, SPM_PWR_MGR_CFG1_HSI_RDY_Msk);
  190. } while ((0U == status) && (--timeout != 0U));
  191. if (0U == timeout)
  192. {
  193. ret = 2U;
  194. }
  195. /* For HSI 8MHz */
  196. if (outFreq > 64U)
  197. {
  198. posdiv = 4U;
  199. fbkdiv = outFreq;
  200. }
  201. else if (outFreq > 32U)
  202. {
  203. posdiv = 8U;
  204. fbkdiv = outFreq * 2U;
  205. }
  206. else
  207. {
  208. posdiv = 16U;
  209. fbkdiv = outFreq * 4U;
  210. }
  211. prediv = 0U;
  212. }
  213. if (0U == ret)
  214. {
  215. CLEAR_BIT32(CKGEN->CTRL, CKGEN_CTRL_LOCK_Msk);
  216. /* Configure SPLL */
  217. if (refClk != 0U)
  218. {
  219. SET_BIT32(CKGEN->CTRL, CKGEN_CTRL_PLL_REF_SEL_Msk);
  220. }
  221. else
  222. {
  223. CLEAR_BIT32(CKGEN->CTRL, CKGEN_CTRL_PLL_REF_SEL_Msk);
  224. }
  225. MODIFY_REG32(ANA->SPLL_CFG0, ANA_SPLL_CFG0_POSDIV_Msk, ANA_SPLL_CFG0_POSDIV_Pos, posdiv);
  226. MODIFY_REG32(ANA->SPLL_CFG0, ANA_SPLL_CFG0_FBKDIV_Msk, ANA_SPLL_CFG0_FBKDIV_Pos, fbkdiv);
  227. MODIFY_REG32(ANA->SPLL_CFG0, ANA_SPLL_CFG0_PREDIV_Msk, ANA_SPLL_CFG0_PREDIV_Pos, prediv);
  228. MODIFY_REG32(ANA->SPLL_CFG1, ANA_SPLL_CFG1_LD_DLY_SEL_Msk, ANA_SPLL_CFG1_LD_DLY_SEL_Pos, 3U);
  229. /* SPLL enable */
  230. SET_BIT32(SPM->PWR_MGR_CFG1, SPM_PWR_MGR_CFG1_SPLL_EN_Msk);
  231. timeout = 10000U;
  232. do
  233. {
  234. status = READ_BIT32(SPM->PWR_MGR_CFG1, SPM_PWR_MGR_CFG1_SPLL_RDY_Msk);
  235. } while ((0U == status) && (--timeout != 0U));
  236. if (0U == timeout)
  237. {
  238. ret = 3U;
  239. }
  240. }
  241. if (0U == ret)
  242. {
  243. /* Unlock and set flash clock frequency */
  244. WRITE_REG32(FLASH->KEYUNLK, FLASH_UNLOCK_KEY1);
  245. WRITE_REG32(FLASH->KEYUNLK, FLASH_UNLOCK_KEY2);
  246. MODIFY_REG32(FLASH->CNFG, FLASH_CNFG_CLKFREQ_Msk, FLASH_CNFG_CLKFREQ_Pos, outFreq);
  247. /* Switch system clock to spll */
  248. MODIFY_REG32(CKGEN->CTRL, CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Msk, CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Pos, 3U);
  249. /* Set divider, default sysdiv is 1 divider and busdiv is 2 divider */
  250. MODIFY_REG32(CKGEN->CTRL, CKGEN_CTRL_SYSCLK_DIV_Msk, CKGEN_CTRL_SYSCLK_DIV_Pos, 0U);
  251. MODIFY_REG32(CKGEN->CTRL, CKGEN_CTRL_BUS_CLK_DIV_RUN_Msk, CKGEN_CTRL_BUS_CLK_DIV_RUN_Pos, 1U);
  252. /* Check current system clock */
  253. if (3U != ((CKGEN->CTRL & CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Msk) >> CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Pos))
  254. {
  255. ret = 4U;
  256. }
  257. }
  258. return ret;
  259. }
  260. /*!
  261. * @brief Initialize VHSI then set system clock to the VHSI clock.
  262. *
  263. * @param[in] none
  264. * @return status 0: success others: error
  265. */
  266. uint32_t SetSysClkToVHSI(void)
  267. {
  268. uint32_t ret = 0U, status, timeout = 100U;
  269. /* VHSI enable */
  270. SET_BIT32(SPM->PWR_MGR_CFG1, SPM_PWR_MGR_CFG1_VHSI_EN_Msk);
  271. do
  272. {
  273. status = READ_BIT32(SPM->PWR_MGR_CFG1, SPM_PWR_MGR_CFG1_VHSI_RDY_Msk);
  274. } while ((0U == status) && (--timeout != 0U));
  275. if (0U == timeout)
  276. {
  277. ret = 1U;
  278. }
  279. if (0U == ret)
  280. {
  281. CLEAR_BIT32(CKGEN->CTRL, CKGEN_CTRL_LOCK_Msk);
  282. /* Unlock and set flash clock frequency */
  283. WRITE_REG32(FLASH->KEYUNLK, FLASH_UNLOCK_KEY1);
  284. WRITE_REG32(FLASH->KEYUNLK, FLASH_UNLOCK_KEY2);
  285. MODIFY_REG32(FLASH->CNFG, FLASH_CNFG_CLKFREQ_Msk, FLASH_CNFG_CLKFREQ_Pos, 48U);
  286. /* Switch system clock to vhsi */
  287. MODIFY_REG32(CKGEN->CTRL, CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Msk, CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Pos, 0U);
  288. /* Set divider, default sysdiv is 1 divider and busdiv is 2 divider */
  289. MODIFY_REG32(CKGEN->CTRL, CKGEN_CTRL_SYSCLK_DIV_Msk, CKGEN_CTRL_SYSCLK_DIV_Pos, 0U);
  290. MODIFY_REG32(CKGEN->CTRL, CKGEN_CTRL_BUS_CLK_DIV_RUN_Msk, CKGEN_CTRL_BUS_CLK_DIV_RUN_Pos, 1U);
  291. /* Check current system clock */
  292. if (0U != ((CKGEN->CTRL & CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Msk) >> CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Pos))
  293. {
  294. ret = 2U;
  295. }
  296. }
  297. return ret;
  298. }
  299. /*!
  300. * @brief Initialize HSE then set system clock to the HSE clock.
  301. *
  302. * @param[in] bypass: 0: disable, 1: enable
  303. * @return status 0: success others: error
  304. */
  305. uint32_t SetSysClkToHSE(uint8_t bypass)
  306. {
  307. uint32_t ret = 0U, status, timeout = 100000U;
  308. /* Set XOSC bypass mode */
  309. if (bypass != 0U)
  310. {
  311. SET_BIT32(SPM->PWR_MGR_CFG1, SPM_PWR_MGR_CFG1_XOSC_HSEBYP_Msk);
  312. }
  313. else
  314. {
  315. CLEAR_BIT32(SPM->PWR_MGR_CFG1, SPM_PWR_MGR_CFG1_XOSC_HSEBYP_Msk);
  316. }
  317. /* XOSC enable */
  318. SET_BIT32(SPM->PWR_MGR_CFG1, SPM_PWR_MGR_CFG1_XOSC_HSEEN_Msk);
  319. do
  320. {
  321. status = READ_BIT32(SPM->PWR_MGR_CFG1, SPM_PWR_MGR_CFG1_XOSC_RDY_Msk);
  322. } while ((0U == status) && (--timeout != 0U));
  323. if (0U == timeout)
  324. {
  325. ret = 1U;
  326. }
  327. if (0U == ret)
  328. {
  329. CLEAR_BIT32(CKGEN->CTRL, CKGEN_CTRL_LOCK_Msk);
  330. /* Unlock and set flash clock frequency */
  331. WRITE_REG32(FLASH->KEYUNLK, FLASH_UNLOCK_KEY1);
  332. WRITE_REG32(FLASH->KEYUNLK, FLASH_UNLOCK_KEY2);
  333. MODIFY_REG32(FLASH->CNFG, FLASH_CNFG_CLKFREQ_Msk, FLASH_CNFG_CLKFREQ_Pos, CKGEN_HSE_FREQ / 1000000U);
  334. /* Switch system clock to hse */
  335. MODIFY_REG32(CKGEN->CTRL, CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Msk, CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Pos, 1U);
  336. /* Set divider, default sysdiv is 1 divider and busdiv is 2 divider */
  337. MODIFY_REG32(CKGEN->CTRL, CKGEN_CTRL_SYSCLK_DIV_Msk, CKGEN_CTRL_SYSCLK_DIV_Pos, 0U);
  338. MODIFY_REG32(CKGEN->CTRL, CKGEN_CTRL_BUS_CLK_DIV_RUN_Msk, CKGEN_CTRL_BUS_CLK_DIV_RUN_Pos, 1U);
  339. /* Check current system clock */
  340. if (1U != ((CKGEN->CTRL & CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Msk) >> CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Pos))
  341. {
  342. ret = 2U;
  343. }
  344. }
  345. return ret;
  346. }
  347. /*!
  348. * @brief Initialize HSI then set system clock to the HSI clock.
  349. *
  350. * @param[in] none
  351. * @return status 0: success others: error
  352. */
  353. uint32_t SetSysClkToHSI(void)
  354. {
  355. uint32_t ret = 0U, status, timeout = 100U;
  356. /* HSI enable */
  357. SET_BIT32(SPM->PWR_MGR_CFG1, SPM_PWR_MGR_CFG1_HSI_EN_NORMAL_Msk);
  358. do
  359. {
  360. status = READ_BIT32(SPM->PWR_MGR_CFG1, SPM_PWR_MGR_CFG1_HSI_RDY_Msk);
  361. } while ((0U == status) && (--timeout != 0U));
  362. if (0U == timeout)
  363. {
  364. ret = 1U;
  365. }
  366. if (0U == ret)
  367. {
  368. CLEAR_BIT32(CKGEN->CTRL, CKGEN_CTRL_LOCK_Msk);
  369. /* Unlock and set flash clock frequency */
  370. WRITE_REG32(FLASH->KEYUNLK, FLASH_UNLOCK_KEY1);
  371. WRITE_REG32(FLASH->KEYUNLK, FLASH_UNLOCK_KEY2);
  372. MODIFY_REG32(FLASH->CNFG, FLASH_CNFG_CLKFREQ_Msk, FLASH_CNFG_CLKFREQ_Pos, 8U);
  373. /* Switch system clock to hsi */
  374. MODIFY_REG32(CKGEN->CTRL, CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Msk, CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Pos, 2U);
  375. /* Set divider, default sysdiv is 1 divider and busdiv is 2 divider */
  376. MODIFY_REG32(CKGEN->CTRL, CKGEN_CTRL_SYSCLK_DIV_Msk, CKGEN_CTRL_SYSCLK_DIV_Pos, 0U);
  377. MODIFY_REG32(CKGEN->CTRL, CKGEN_CTRL_BUS_CLK_DIV_RUN_Msk, CKGEN_CTRL_BUS_CLK_DIV_RUN_Pos, 1U);
  378. /* Check current system clock */
  379. if (2U != ((CKGEN->CTRL & CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Msk) >> CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Pos))
  380. {
  381. ret = 2U;
  382. }
  383. }
  384. return ret;
  385. }
  386. /*!
  387. * @brief Get MCU CPUID.
  388. *
  389. * @param[in] none
  390. * @return MCU CPUID
  391. */
  392. uint32_t GetCPUID(void)
  393. {
  394. return SCB->CPUID;
  395. }
  396. /*!
  397. * @brief Get UUID from device.
  398. *
  399. * @param[out] uuidBuffer: UUID buffer
  400. * @return none
  401. */
  402. void GetUUID(uint32_t *uuidBuffer)
  403. {
  404. #define UUID_BASE_ADDRESS 0x00201800U
  405. uint32_t i;
  406. if (uuidBuffer != NULL)
  407. {
  408. for (i = 0U; i < 4U; i++)
  409. {
  410. uuidBuffer[i] = (*(__IO uint32_t *)(UUID_BASE_ADDRESS + i * 4U));
  411. }
  412. }
  413. }
  414. /*!
  415. * @brief Setup the microcontroller system. Initialize the System.
  416. *
  417. * @param[in] none
  418. * @return none
  419. */
  420. void SystemInit(void)
  421. {
  422. /* Sram L&U ECC read enable */
  423. #if (SRAM_ECC_READ_ENABLE)
  424. MCM->MLMDR0 |= MCM_MLMDR0_LREEN_Msk | MCM_MLMDR0_UREEN_Msk;
  425. /* Sram ECC 2bit error reset disable */
  426. #if !(SRAM_ECC_ERR_RST_ENABLE)
  427. CKGEN->RCM_EN &= ~CKGEN_RCM_EN_ECC2_ERR_RST_EN_Msk;
  428. #endif
  429. #endif
  430. /* Set CP10 and CP11 Full Access */
  431. #if (__FPU_PRESENT == 1U) && (__FPU_USED == 1U)
  432. SCB->CPACR |= ((3U << (10U * 2U)) | (3U << (11U * 2U)));
  433. #endif
  434. /* Disable watchdog */
  435. #if (WDG_DISABLE)
  436. #define WDG_UNLOCK_VALUE1 0xE064D987U
  437. #define WDG_UNLOCK_VALUE2 0x868A8478U
  438. WDG->CNT = (uint32_t)WDG_UNLOCK_VALUE1;
  439. WDG->CNT = (uint32_t)WDG_UNLOCK_VALUE2;
  440. WDG->CS0 &= ~WDG_CS0_EN_Msk;
  441. #endif
  442. /* Relocate vector table */
  443. #if defined (__VTOR_PRESENT) && (__VTOR_PRESENT == 1U)
  444. SCB->VTOR = (uint32_t) &__Vectors;
  445. #endif
  446. }
  447. /*!
  448. * @brief Update system clock frequence.
  449. *
  450. * @param[in] none
  451. * @return none
  452. */
  453. void SystemCoreClockUpdate(void)
  454. {
  455. #if SYSTEM_USE_CKGEN
  456. (void)CKGEN_DRV_GetFreq(CORE_CLK, &SystemCoreClock);
  457. #else
  458. uint32_t runMode, clkSrc, sysDiv, prediv, fbkdiv, postdiv, srcFreq;
  459. runMode = SPM->STATUS & SPM_STATUS_CURR_POWER_MODE_Msk;
  460. if (1U == runMode) /* VLPR mode */
  461. {
  462. sysDiv = (CKGEN->CTRL & CKGEN_CTRL_SYSCLK_DIV_VLPR_Msk) >> CKGEN_CTRL_SYSCLK_DIV_VLPR_Pos;
  463. srcFreq = CKGEN_HSI_FREQ;
  464. }
  465. else /* RUN mode */
  466. {
  467. sysDiv = (CKGEN->CTRL & CKGEN_CTRL_SYSCLK_DIV_Msk) >> CKGEN_CTRL_SYSCLK_DIV_Pos;
  468. clkSrc = (CKGEN->CTRL & CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Msk) >> CKGEN_CTRL_SYSCLK_SRC_SEL_RUN_Pos;
  469. switch (clkSrc)
  470. {
  471. case 1U: /* HSE clock, user define */
  472. srcFreq = CKGEN_HSE_FREQ;
  473. break;
  474. case 2U: /* HSI clock */
  475. srcFreq = CKGEN_HSI_FREQ;
  476. break;
  477. case 3U: /* SPLL clock */
  478. prediv = (ANA->SPLL_CFG0 & ANA_SPLL_CFG0_PREDIV_Msk) >> ANA_SPLL_CFG0_PREDIV_Pos;
  479. fbkdiv = (ANA->SPLL_CFG0 & ANA_SPLL_CFG0_FBKDIV_Msk) >> ANA_SPLL_CFG0_FBKDIV_Pos;
  480. postdiv = (ANA->SPLL_CFG0 & ANA_SPLL_CFG0_POSDIV_Msk) >> ANA_SPLL_CFG0_POSDIV_Pos;
  481. /* Get reference clock */
  482. if (0U == ((CKGEN->CTRL & CKGEN_CTRL_PLL_REF_SEL_Msk) >> CKGEN_CTRL_PLL_REF_SEL_Pos))
  483. {
  484. srcFreq = CKGEN_HSI_FREQ;
  485. }
  486. else
  487. {
  488. srcFreq = CKGEN_HSE_FREQ;
  489. }
  490. /* Calculate SPLL frequency */
  491. if (postdiv != 0U)
  492. {
  493. srcFreq = (srcFreq / (prediv + 1U)) * fbkdiv / (postdiv * 2U);
  494. }
  495. break;
  496. default: /* VHSI clock */
  497. srcFreq = CKGEN_VHSI_FREQ;
  498. break;
  499. }
  500. }
  501. SystemCoreClock = srcFreq / (sysDiv + 1U);
  502. #endif
  503. }
  504. /*!
  505. * @brief Enable NMI, after set pinmux.
  506. *
  507. * @param[in] enable: enable state
  508. * @return none
  509. */
  510. void EnableNMI(uint8_t enable)
  511. {
  512. if (enable != 0U)
  513. {
  514. SET_BIT32(MCM->MNCR, MCM_MNCR_NMI_EN_Msk);
  515. }
  516. else
  517. {
  518. CLEAR_BIT32(MCM->MNCR, MCM_MNCR_NMI_EN_Msk);
  519. }
  520. }
  521. /* ============================================= EOF ============================================== */