core_pm.c 2.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122
  1. #include "user.h"
  2. typedef struct
  3. {
  4. uint32_t HWFlagBit;
  5. uint32_t DrvFlagBit;
  6. }PM_CtrlStruct;
  7. static PM_CtrlStruct prvPM;
  8. void PM_Init(void)
  9. {
  10. GPIO->WAKE_TYPE_EN = (1 << 12) | (1 << 11);
  11. // GPIO->WAKE_P0_EN = 0xffffffff;
  12. // GPIO->WAKE_P1_EN = 0xffffffff;
  13. // GPIO->WAKE_P2_EN = 0xffffffff;
  14. GPIO->WAKE_P0_EN = 0;
  15. GPIO->WAKE_P1_EN = 0;
  16. GPIO->WAKE_P2_EN = 0;
  17. SENSOR->SEN_EXTS_START = 0x55;
  18. int i;
  19. for(i = 0; i < 19; i++)
  20. {
  21. SENSOR->SEN_EN[i] = 0x80000055;
  22. }
  23. SYSCTRL->MSR_CR1 |= BIT(27);
  24. }
  25. void PM_SetHardwareRunFlag(uint32_t PmHWSn, uint32_t OnOff)
  26. {
  27. if (OnOff)
  28. {
  29. prvPM.HWFlagBit |= (1 << PmHWSn);
  30. }
  31. else
  32. {
  33. prvPM.HWFlagBit &= ~(1 << PmHWSn);
  34. }
  35. }
  36. void PM_SetDriverRunFlag(uint32_t PmDrvSn, uint32_t OnOff)
  37. {
  38. if (OnOff)
  39. {
  40. prvPM.DrvFlagBit |= (1 << PmDrvSn);
  41. }
  42. else
  43. {
  44. prvPM.DrvFlagBit &= ~(1 << PmDrvSn);
  45. }
  46. }
  47. void PM_Print(void)
  48. {
  49. DBG("%x,%x", prvPM.HWFlagBit, prvPM.DrvFlagBit);
  50. }
  51. int32_t PM_Sleep(void)
  52. {
  53. uint64_t StartTick;
  54. volatile uint32_t Temp, Temp2, Temp3;
  55. if (prvPM.HWFlagBit || prvPM.DrvFlagBit) return -ERROR_DEVICE_BUSY;
  56. __disable_irq();
  57. SYSCTRL->ANA_CTRL |= BIT(7)|BIT(5)|BIT(4);
  58. SYSCTRL->LDO25_CR |= BIT(4);
  59. Temp2 = ADC0->ADC_CR1;
  60. Temp3 = DAC->DAC_CR1;
  61. ADC0->ADC_CR1 |= BIT(8);
  62. ADC0->ADC_CR1 &= ~BIT(6);
  63. DAC->DAC_CR1 |= BIT(4);
  64. StartTick = RTC_GetUTC();
  65. Temp = TRNG->RNG_ANA;
  66. TRNG->RNG_ANA = Temp | TRNG_RNG_AMA_PD_ALL_Mask;
  67. // SYSCTRL->PHER_CTRL |= BIT(20);
  68. __WFI();
  69. // SYSCTRL->LDO25_CR &= ~BIT(5);
  70. // SYSCTRL->PHER_CTRL &= ~BIT(20);
  71. TRNG->RNG_ANA = Temp;
  72. ADC0->ADC_CR1 = Temp2;
  73. DAC->DAC_CR1 = Temp3;
  74. SYSCTRL->LDO25_CR &= ~BIT(4);
  75. SYSCTRL->ANA_CTRL &= ~(BIT(7)|BIT(5)|BIT(4));
  76. WDT_Feed();
  77. SysTickAddSleepTime((RTC_GetUTC() - StartTick) * CORE_TICK_1S);
  78. Timer_WakeupRun();
  79. __enable_irq();
  80. return ERROR_NONE;
  81. }
  82. void PM_Set12MSource(uint8_t XTAL, uint32_t DelayCnt)
  83. {
  84. volatile uint32_t delay = DelayCnt;
  85. if (XTAL == ((SYSCTRL->FREQ_SEL & BIT(12)) >> 12))
  86. {
  87. __disable_irq();
  88. if (XTAL)
  89. {
  90. SYSCTRL->FREQ_SEL &= ~BIT(12);
  91. }
  92. else
  93. {
  94. SYSCTRL->FREQ_SEL |= BIT(12);
  95. }
  96. while(--delay) {;}
  97. __enable_irq();
  98. }
  99. }
  100. void PM_Set32KSource(uint8_t XTAL)
  101. {
  102. if (XTAL == ((BPU->SEN_ANA0 & BIT(10)) >> 10)) return ;
  103. if (XTAL)
  104. {
  105. BPU->SEN_ANA0 |= BIT(10);
  106. }
  107. else
  108. {
  109. BPU->SEN_ANA0 &= ~BIT(10);
  110. }
  111. }