esm.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713
  1. /** @file esm.c
  2. * @brief Esm Driver Source File
  3. * @date 29.May.2013
  4. * @version 03.05.02
  5. *
  6. * This file contains:
  7. * - API Functions
  8. * .
  9. * which are relevant for the Esm driver.
  10. */
  11. /* (c) Texas Instruments 2009-2013, All rights reserved. */
  12. /* USER CODE BEGIN (0) */
  13. /* USER CODE END */
  14. /* Include Files */
  15. #include "esm.h"
  16. /* USER CODE BEGIN (1) */
  17. /* USER CODE END */
  18. /** @fn void esmInit(void)
  19. * @brief Initializes Esm Driver
  20. *
  21. * This function initializes the Esm driver.
  22. *
  23. */
  24. /* USER CODE BEGIN (2) */
  25. /* USER CODE END */
  26. void esmInit(void)
  27. {
  28. /* USER CODE BEGIN (3) */
  29. /* USER CODE END */
  30. /** - Disable error pin channels */
  31. esmREG->EPENACLR1 = 0xFFFFFFFFU;
  32. esmREG->EPENACLR4 = 0xFFFFFFFFU;
  33. /** - Disable interrupts */
  34. esmREG->INTENACLR1 = 0xFFFFFFFFU;
  35. esmREG->INTENACLR4 = 0xFFFFFFFFU;
  36. /** - Clear error status flags */
  37. esmREG->ESTATUS1[0U] = 0xFFFFFFFFU;
  38. esmREG->ESTATUS1[1U] = 0xFFFFFFFFU;
  39. esmREG->ESTATUS2EMU = 0xFFFFFFFFU;
  40. esmREG->ESTATUS1[2U] = 0xFFFFFFFFU;
  41. esmREG->ESTATUS4[0U] = 0xFFFFFFFFU;
  42. esmREG->ESTATUS4[1U] = 0xFFFFFFFFU;
  43. esmREG->ESTATUS5EMU = 0xFFFFFFFFU;
  44. esmREG->ESTATUS4[2U] = 0xFFFFFFFFU;
  45. /** - Setup LPC preload */
  46. esmREG->LTCPRELOAD = 16384U - 1U;
  47. /** - Reset error pin */
  48. if (esmREG->EPSTATUS == 0U)
  49. {
  50. esmREG->KEY = 0x00000005U;
  51. }
  52. else
  53. {
  54. esmREG->KEY = 0x00000000U;
  55. }
  56. /** - Clear interrupt level */
  57. esmREG->INTLVLCLR1 = 0xFFFFFFFFU;
  58. esmREG->INTLVLCLR4 = 0xFFFFFFFFU;
  59. /** - Set interrupt level */
  60. esmREG->INTLVLSET1 = (0U << 31U)
  61. | (0U << 30U)
  62. | (0U << 29U)
  63. | (0U << 28U)
  64. | (0U << 27U)
  65. | (0U << 26U)
  66. | (0U << 25U)
  67. | (0U << 24U)
  68. | (0U << 23U)
  69. | (0U << 22U)
  70. | (0U << 21U)
  71. | (0U << 20U)
  72. | (0U << 19U)
  73. | (0U << 18U)
  74. | (0U << 17U)
  75. | (0U << 16U)
  76. | (0U << 15U)
  77. | (0U << 14U)
  78. | (0U << 13U)
  79. | (0U << 12U)
  80. | (0U << 11U)
  81. | (0U << 10U)
  82. | (0U << 9U)
  83. | (0U << 8U)
  84. | (0U << 7U)
  85. | (0U << 6U)
  86. | (0U << 5U)
  87. | (0U << 4U)
  88. | (0U << 3U)
  89. | (0U << 2U)
  90. | (0U << 1U)
  91. | (0U);
  92. esmREG->INTLVLSET4 = (0U << 31U)
  93. | (0U << 30U)
  94. | (0U << 29U)
  95. | (0U << 28U)
  96. | (0U << 27U)
  97. | (0U << 26U)
  98. | (0U << 25U)
  99. | (0U << 24U)
  100. | (0U << 23U)
  101. | (0U << 22U)
  102. | (0U << 21U)
  103. | (0U << 20U)
  104. | (0U << 19U)
  105. | (0U << 18U)
  106. | (0U << 17U)
  107. | (0U << 16U)
  108. | (0U << 15U)
  109. | (0U << 14U)
  110. | (0U << 13U)
  111. | (0U << 12U)
  112. | (0U << 11U)
  113. | (0U << 10U)
  114. | (0U << 9U)
  115. | (0U << 8U)
  116. | (0U << 7U)
  117. | (0U << 6U)
  118. | (0U << 5U)
  119. | (0U << 4U)
  120. | (0U << 3U)
  121. | (0U << 2U)
  122. | (0U << 1U)
  123. | (0U);
  124. /** - Enable error pin channels */
  125. esmREG->EPENASET1 = (0U << 31U)
  126. | (0U << 30U)
  127. | (0U << 29U)
  128. | (0U << 28U)
  129. | (0U << 27U)
  130. | (0U << 26U)
  131. | (0U << 25U)
  132. | (0U << 24U)
  133. | (0U << 23U)
  134. | (0U << 22U)
  135. | (0U << 21U)
  136. | (0U << 20U)
  137. | (0U << 19U)
  138. | (0U << 18U)
  139. | (0U << 17U)
  140. | (0U << 16U)
  141. | (0U << 15U)
  142. | (0U << 14U)
  143. | (0U << 13U)
  144. | (0U << 12U)
  145. | (0U << 11U)
  146. | (0U << 10U)
  147. | (0U << 9U)
  148. | (0U << 8U)
  149. | (0U << 7U)
  150. | (0U << 6U)
  151. | (0U << 5U)
  152. | (0U << 4U)
  153. | (0U << 3U)
  154. | (0U << 2U)
  155. | (0U << 1U)
  156. | (0U);
  157. esmREG->EPENASET4 = (0U << 31U)
  158. | (0U << 30U)
  159. | (0U << 29U)
  160. | (0U << 28U)
  161. | (0U << 27U)
  162. | (0U << 26U)
  163. | (0U << 25U)
  164. | (0U << 24U)
  165. | (0U << 23U)
  166. | (0U << 22U)
  167. | (0U << 21U)
  168. | (0U << 20U)
  169. | (0U << 19U)
  170. | (0U << 18U)
  171. | (0U << 17U)
  172. | (0U << 16U)
  173. | (0U << 15U)
  174. | (0U << 14U)
  175. | (0U << 13U)
  176. | (0U << 12U)
  177. | (0U << 11U)
  178. | (0U << 10U)
  179. | (0U << 9U)
  180. | (0U << 8U)
  181. | (0U << 7U)
  182. | (0U << 6U)
  183. | (0U << 5U)
  184. | (0U << 4U)
  185. | (0U << 3U)
  186. | (0U << 2U)
  187. | (0U << 1U)
  188. | (0U);
  189. /** - Enable interrupts */
  190. esmREG->INTENASET1 = (0U << 31U)
  191. | (0U << 30U)
  192. | (0U << 29U)
  193. | (0U << 28U)
  194. | (0U << 27U)
  195. | (0U << 26U)
  196. | (0U << 25U)
  197. | (0U << 24U)
  198. | (0U << 23U)
  199. | (0U << 22U)
  200. | (0U << 21U)
  201. | (0U << 20U)
  202. | (0U << 19U)
  203. | (0U << 18U)
  204. | (0U << 17U)
  205. | (0U << 16U)
  206. | (0U << 15U)
  207. | (0U << 14U)
  208. | (0U << 13U)
  209. | (0U << 12U)
  210. | (0U << 11U)
  211. | (0U << 10U)
  212. | (0U << 9U)
  213. | (0U << 8U)
  214. | (0U << 7U)
  215. | (0U << 6U)
  216. | (0U << 5U)
  217. | (0U << 4U)
  218. | (0U << 3U)
  219. | (0U << 2U)
  220. | (0U << 1U)
  221. | (0U);
  222. esmREG->INTENASET4 = (0U << 31U)
  223. | (0U << 30U)
  224. | (0U << 29U)
  225. | (0U << 28U)
  226. | (0U << 27U)
  227. | (0U << 26U)
  228. | (0U << 25U)
  229. | (0U << 24U)
  230. | (0U << 23U)
  231. | (0U << 22U)
  232. | (0U << 21U)
  233. | (0U << 20U)
  234. | (0U << 19U)
  235. | (0U << 18U)
  236. | (0U << 17U)
  237. | (0U << 16U)
  238. | (0U << 15U)
  239. | (0U << 14U)
  240. | (0U << 13U)
  241. | (0U << 12U)
  242. | (0U << 11U)
  243. | (0U << 10U)
  244. | (0U << 9U)
  245. | (0U << 8U)
  246. | (0U << 7U)
  247. | (0U << 6U)
  248. | (0U << 5U)
  249. | (0U << 4U)
  250. | (0U << 3U)
  251. | (0U << 2U)
  252. | (0U << 1U)
  253. | (0U);
  254. /* USER CODE BEGIN (4) */
  255. /* USER CODE END */
  256. }
  257. /** @fn uint32 esmError(void)
  258. * @brief Return Error status
  259. *
  260. * @return The error status
  261. *
  262. * Returns the error status.
  263. */
  264. uint32 esmError(void)
  265. {
  266. uint32 status;
  267. /* USER CODE BEGIN (5) */
  268. /* USER CODE END */
  269. status = esmREG->EPSTATUS;
  270. /* USER CODE BEGIN (6) */
  271. /* USER CODE END */
  272. return status;
  273. }
  274. /** @fn void esmEnableError(uint64 channels)
  275. * @brief Enable Group 1 Channels Error Signals propagation
  276. *
  277. * @param[in] channels - Channel mask
  278. *
  279. * Enable Group 1 Channels Error Signals propagation to the error pin.
  280. */
  281. void esmEnableError(uint64 channels)
  282. {
  283. /* USER CODE BEGIN (7) */
  284. /* USER CODE END */
  285. esmREG->EPENASET4 = (uint32)((channels >> 32U) & 0xFFFFFFFFU);
  286. esmREG->EPENASET1 = (uint32)(channels & 0xFFFFFFFFU);
  287. /* USER CODE BEGIN (8) */
  288. /* USER CODE END */
  289. }
  290. /** @fn void esmDisableError(uint64 channels)
  291. * @brief Disable Group 1 Channels Error Signals propagation
  292. *
  293. * @param[in] channels - Channel mask
  294. *
  295. * Disable Group 1 Channels Error Signals propagation to the error pin.
  296. */
  297. void esmDisableError(uint64 channels)
  298. {
  299. /* USER CODE BEGIN (9) */
  300. /* USER CODE END */
  301. esmREG->EPENACLR4 = (uint32)((channels >> 32U) & 0xFFFFFFFFU);
  302. esmREG->EPENACLR1 = (uint32)(channels & 0xFFFFFFFFU);
  303. /* USER CODE BEGIN (10) */
  304. /* USER CODE END */
  305. }
  306. /** @fn void esmTriggerErrorPinReset(void)
  307. * @brief Trigger error pin reset and switch back to normal operation
  308. *
  309. * Trigger error pin reset and switch back to normal operation.
  310. */
  311. void esmTriggerErrorPinReset(void)
  312. {
  313. /* USER CODE BEGIN (11) */
  314. /* USER CODE END */
  315. esmREG->KEY = 5U;
  316. /* USER CODE BEGIN (12) */
  317. /* USER CODE END */
  318. }
  319. /** @fn void esmActivateNormalOperation(void)
  320. * @brief Activate normal operation
  321. *
  322. * Activates normal operation mode.
  323. */
  324. void esmActivateNormalOperation(void)
  325. {
  326. /* USER CODE BEGIN (13) */
  327. /* USER CODE END */
  328. esmREG->KEY = 0U;
  329. /* USER CODE BEGIN (14) */
  330. /* USER CODE END */
  331. }
  332. /** @fn void esmEnableInterrupt(uint64 channels)
  333. * @brief Enable Group 1 Channels Interrupts
  334. *
  335. * @param[in] channels - Channel mask
  336. *
  337. * Enable Group 1 Channels Interrupts.
  338. */
  339. void esmEnableInterrupt(uint64 channels)
  340. {
  341. /* USER CODE BEGIN (15) */
  342. /* USER CODE END */
  343. esmREG->INTENASET4 = (uint32)((channels >> 32U) & 0xFFFFFFFFU);
  344. esmREG->INTENASET1 = (uint32)(channels & 0xFFFFFFFFU);
  345. /* USER CODE BEGIN (16) */
  346. /* USER CODE END */
  347. }
  348. /** @fn void esmDisableInterrupt(uint64 channels)
  349. * @brief Disable Group 1 Channels Interrupts
  350. *
  351. * @param[in] channels - Channel mask
  352. *
  353. * Disable Group 1 Channels Interrupts.
  354. */
  355. void esmDisableInterrupt(uint64 channels)
  356. {
  357. /* USER CODE BEGIN (17) */
  358. /* USER CODE END */
  359. esmREG->INTENACLR4 = (uint32)((channels >> 32U) & 0xFFFFFFFFU);
  360. esmREG->INTENACLR1 = (uint32)(channels & 0xFFFFFFFFU);
  361. /* USER CODE BEGIN (18) */
  362. /* USER CODE END */
  363. }
  364. /** @fn void esmSetInterruptLevel(uint64 channels, uint64 flags)
  365. * @brief Set Group 1 Channels Interrupt Levels
  366. *
  367. * @param[in] channels - Channel mask
  368. * @param[in] flags - Level mask: - 0: Low priority interrupt
  369. * - 1: High priority interrupt
  370. *
  371. * Set Group 1 Channels Interrupts levels.
  372. */
  373. void esmSetInterruptLevel(uint64 channels, uint64 flags)
  374. {
  375. /* USER CODE BEGIN (19) */
  376. /* USER CODE END */
  377. esmREG->INTLVLCLR4 = (uint32)(((channels & (~flags)) >> 32U) & 0xFFFFFFFU);
  378. esmREG->INTLVLSET4 = (uint32)(((channels & flags) >> 32U) & 0xFFFFFFFFU);
  379. esmREG->INTLVLCLR1 = (uint32)((channels & (~flags)) & 0xFFFFFFFU);
  380. esmREG->INTLVLSET1 = (uint32)((channels & flags) & 0xFFFFFFFFU);
  381. /* USER CODE BEGIN (20) */
  382. /* USER CODE END */
  383. }
  384. /** @fn void esmClearStatus(uint32 group, uint64 channels)
  385. * @brief Clear Group error status
  386. *
  387. * @param[in] group - Error group
  388. * @param[in] channels - Channel mask
  389. *
  390. * Clear Group error status.
  391. */
  392. void esmClearStatus(uint32 group, uint64 channels)
  393. {
  394. /* USER CODE BEGIN (21) */
  395. /* USER CODE END */
  396. esmREG->ESTATUS4[group] = (uint32)((channels >> 32U) & 0xFFFFFFFFU);
  397. esmREG->ESTATUS1[group] = (uint32)(channels & 0xFFFFFFFFU);
  398. /* USER CODE BEGIN (22) */
  399. /* USER CODE END */
  400. }
  401. /** @fn void esmClearStatusBuffer(uint64 channels)
  402. * @brief Clear Group 2 error status buffer
  403. *
  404. * @param[in] channels - Channel mask
  405. *
  406. * Clear Group 2 error status buffer.
  407. */
  408. void esmClearStatusBuffer(uint64 channels)
  409. {
  410. /* USER CODE BEGIN (23) */
  411. /* USER CODE END */
  412. esmREG->ESTATUS5EMU = (uint32)((channels >> 32U) & 0xFFFFFFFFU);
  413. esmREG->ESTATUS2EMU = (uint32)(channels & 0xFFFFFFFFU);
  414. /* USER CODE BEGIN (24) */
  415. /* USER CODE END */
  416. }
  417. /** @fn void esmSetCounterPreloadValue(uint32 value)
  418. * @brief Set counter preload value
  419. *
  420. * @param[in] value - Counter preload value
  421. *
  422. * Set counter preload value.
  423. */
  424. void esmSetCounterPreloadValue(uint32 value)
  425. {
  426. /* USER CODE BEGIN (25) */
  427. /* USER CODE END */
  428. esmREG->LTCPRELOAD = value & 0xC000U;
  429. /* USER CODE BEGIN (26) */
  430. /* USER CODE END */
  431. }
  432. /** @fn uint64 esmGetStatus(uint32 group, uint64 channels)
  433. * @brief Return Error status
  434. *
  435. * @param[in] group - Error group
  436. * @param[in] channels - Error Channels
  437. *
  438. * @return The channels status of selected group
  439. *
  440. * Returns the channels status of selected group.
  441. */
  442. uint64 esmGetStatus(uint32 group, uint64 channels)
  443. {
  444. uint64 status;
  445. /* USER CODE BEGIN (27) */
  446. /* USER CODE END */
  447. /*SAFETYMCUSW 51 S MR:12.3 <REVIEWED> "Needs shifting for 64-bit value" */
  448. status = (((uint64)esmREG->ESTATUS4[group] << 32U) | (uint64)esmREG->ESTATUS1[group]) & channels;
  449. /* USER CODE BEGIN (28) */
  450. /* USER CODE END */
  451. return status;
  452. }
  453. /** @fn uint64 esmGetStatusBuffer(uint64 channels)
  454. * @brief Return Group 2 channel x Error status buffer
  455. *
  456. * @param[in] channels - Error Channels
  457. *
  458. * @return The channels status
  459. *
  460. * Returns the group 2 buffered status of selected channels.
  461. */
  462. uint64 esmGetStatusBuffer(uint64 channels)
  463. {
  464. uint64 status;
  465. /* USER CODE BEGIN (29) */
  466. /* USER CODE END */
  467. /*SAFETYMCUSW 51 S MR:12.3 <REVIEWED> "Needs shifting for 64-bit value" */
  468. status = (((uint64)esmREG->ESTATUS5EMU << 32U) | (uint64)esmREG->ESTATUS2EMU) & channels;
  469. /* USER CODE BEGIN (30) */
  470. /* USER CODE END */
  471. return status;
  472. }
  473. /** @fn esmSelfTestFlag_t esmEnterSelfTest(void)
  474. * @brief Return ESM Self test status
  475. *
  476. * @return ESM Self test status
  477. *
  478. * Returns the ESM Self test status.
  479. */
  480. esmSelfTestFlag_t esmEnterSelfTest(void)
  481. {
  482. esmSelfTestFlag_t status;
  483. /* USER CODE BEGIN (31) */
  484. /* USER CODE END */
  485. if(((esmREG->EPSTATUS & 0x1U) == 0x0U) && (esmREG->KEY == 0x0U))
  486. {
  487. status = esmSelfTest_NotStarted;
  488. }
  489. else
  490. {
  491. esmREG->KEY = 0xAU;
  492. status = esmSelfTest_Active;
  493. if((esmREG->EPSTATUS & 0x1U) != 0x0U)
  494. {
  495. status = esmSelfTest_Failed;
  496. }
  497. esmREG->KEY = 0x5U;
  498. }
  499. /* USER CODE BEGIN (32) */
  500. /* USER CODE END */
  501. return status;
  502. }
  503. /** @fn esmSelfTestFlag_t esmSelfTestStatus(void)
  504. * @brief Return ESM Self test status
  505. *
  506. * Returns the ESM Self test status.
  507. */
  508. esmSelfTestFlag_t esmSelfTestStatus(void)
  509. {
  510. esmSelfTestFlag_t status;
  511. /* USER CODE BEGIN (33) */
  512. /* USER CODE END */
  513. if((esmREG->EPSTATUS & 0x1U) == 0x0U)
  514. {
  515. if(esmREG->KEY == 0x5U)
  516. {
  517. status = esmSelfTest_Active;
  518. }
  519. else
  520. {
  521. status = esmSelfTest_Failed;
  522. }
  523. }
  524. else
  525. {
  526. status = esmSelfTest_Passed;
  527. }
  528. /* USER CODE BEGIN (34) */
  529. /* USER CODE END */
  530. return status;
  531. }
  532. /** @fn void esmGetConfigValue(esm_config_reg_t *config_reg, config_value_type_t type)
  533. * @brief Get the initial or current values of the configuration registers
  534. *
  535. * @param[in] *config_reg: pointer to the struct to which the initial or current
  536. * value of the configuration registers need to be stored
  537. * @param[in] type: whether initial or current value of the configuration registers need to be stored
  538. * - InitialValue: initial value of the configuration registers will be stored
  539. * in the struct pointed by config_reg
  540. * - CurrentValue: initial value of the configuration registers will be stored
  541. * in the struct pointed by config_reg
  542. *
  543. * This function will copy the initial or current value (depending on the parameter 'type')
  544. * of the configuration registers to the struct pointed by config_reg
  545. *
  546. */
  547. void esmGetConfigValue(esm_config_reg_t *config_reg, config_value_type_t type)
  548. {
  549. if (type == InitialValue)
  550. {
  551. config_reg->CONFIG_EPENASET1 = ESM_EPENASET1_CONFIGVALUE;
  552. config_reg->CONFIG_INTENASET1 = ESM_INTENASET1_CONFIGVALUE;
  553. config_reg->CONFIG_INTLVLSET1 = ESM_INTLVLSET1_CONFIGVALUE;
  554. config_reg->CONFIG_LTCPRELOAD = ESM_LTCPRELOAD_CONFIGVALUE;
  555. config_reg->CONFIG_KEY = ESM_KEY_CONFIGVALUE;
  556. config_reg->CONFIG_EPENASET4 = ESM_EPENASET4_CONFIGVALUE;
  557. config_reg->CONFIG_INTENASET4 = ESM_INTENASET4_CONFIGVALUE;
  558. config_reg->CONFIG_INTLVLSET4 = ESM_INTLVLSET4_CONFIGVALUE;
  559. }
  560. else
  561. {
  562. config_reg->CONFIG_EPENASET1 = esmREG->EPENASET1;
  563. config_reg->CONFIG_INTENASET1 = esmREG->INTENASET1;
  564. config_reg->CONFIG_INTLVLSET1 = esmREG->INTLVLSET1;
  565. config_reg->CONFIG_LTCPRELOAD = esmREG->LTCPRELOAD;
  566. config_reg->CONFIG_KEY = esmREG->KEY;
  567. config_reg->CONFIG_EPENASET4 = esmREG->EPENASET4;
  568. config_reg->CONFIG_INTENASET4 = esmREG->INTENASET4;
  569. config_reg->CONFIG_INTLVLSET4 = esmREG->INTLVLSET4;
  570. }
  571. }
  572. /* USER CODE BEGIN (35) */
  573. /* USER CODE END */
  574. /** @fn void esmHighInterrupt(void)
  575. * @brief High Level Interrupt for ESM
  576. */
  577. #pragma CODE_STATE(esmHighInterrupt, 32)
  578. #pragma INTERRUPT(esmHighInterrupt, FIQ)
  579. void esmHighInterrupt(void)
  580. {
  581. sint32 vec = esmREG->INTOFFH - 1U;
  582. /* USER CODE BEGIN (36) */
  583. /* USER CODE END */
  584. if (vec >= 96U)
  585. {
  586. esmREG->ESTATUS4[1U] = 1U << (vec-96U);
  587. esmGroup2Notification(vec-64U);
  588. }
  589. else if (vec >= 64U)
  590. {
  591. esmREG->ESTATUS4[0U] = 1U << (vec-64U);
  592. esmGroup1Notification(vec-32U);
  593. }
  594. else if (vec >= 32U)
  595. {
  596. esmREG->ESTATUS1[1U] = 1U << (vec-32U);
  597. esmGroup2Notification(vec-32U);
  598. }
  599. else if (vec >= 0U)
  600. {
  601. esmREG->ESTATUS1[0U] = 1U << vec;
  602. esmGroup1Notification(vec);
  603. }
  604. else
  605. {
  606. esmREG->ESTATUS4[1U] = 0xFFFFFFFFU;
  607. esmREG->ESTATUS4[0U] = 0xFFFFFFFFU;
  608. esmREG->ESTATUS1[1U] = 0xFFFFFFFFU;
  609. esmREG->ESTATUS1[0U] = 0xFFFFFFFFU;
  610. }
  611. /* USER CODE BEGIN (37) */
  612. /* USER CODE END */
  613. }
  614. /* USER CODE BEGIN (41) */
  615. /* USER CODE END */