mspm0_power.cpp

#include "mspm0_power.hpp"
 
// 应用使用的 SRAM（SRAM_BANK0）的末尾，来自 SysConfig 的链接脚本；
// 启动文件也从它取初始栈指针。
// End of the SRAM the application uses (SRAM_BANK0), from the SysConfig linker
// script; the startup file takes its initial stack pointer from it too.
extern "C" uint32_t __StackTop;
 
using namespace LibXR;
 
MSPM0PowerManager::MSPM0PowerManager()
{
  if (DL_SYSCTL_getStatus() & DL_SYSCTL_STATUS_SHUTDOWN_IO_LOCK_TRUE)
  {
    DL_SYSCTL_releaseShutdownIO();
  }
}
 
void MSPM0PowerManager::Reset() { DL_SYSCTL_resetDevice(DL_SYSCTL_RESET_BOOT); }
 
void MSPM0PowerManager::Shutdown()
{
  DL_SYSCTL_setPowerPolicySHUTDOWN();
  // 有中断挂起时 WFI 立即返回；处理完中断再执行 WFI，直到进入 SHUTDOWN。
  // WFI returns at once while an interrupt is pending; after it is served, WFI runs
  // again until the device enters SHUTDOWN.
  while (true)
  {
    __WFI();
  }
}
 
void MSPM0PowerManager::JumpToBootloader()
{
  __disable_irq();
  const uint32_t size = reinterpret_cast<uint32_t>(&__StackTop) - 0x20200000U;
  __asm volatile(
      ".syntax unified\n"
      "ldr     r1, =0x20300000\n"
      "adds    r2, %[size], r1\n"
      "movs    r3, #0\n"
      "1:\n"
      "str     r3, [r1]\n"
      "adds    r1, r1, #4\n"
      "cmp     r1, r2\n"
      "blo     1b\n"
      "ldr     r1, =0x20200000\n"
      "adds    r2, %[size], r1\n"
      "2:\n"
      "str     r3, [r1]\n"
      "adds    r1, r1, #4\n"
      "cmp     r1, r2\n"
      "blo     2b\n"
      "str     %[lvl_val], [%[lvl_addr]]\n"
      "str     %[cmd_val], [%[cmd_addr]]\n"
      :
      : [size] "l"(size), [lvl_addr] "l"(&SYSCTL->SOCLOCK.RESETLEVEL),
        [lvl_val] "l"(DL_SYSCTL_RESET_BOOTLOADER_ENTRY),
        [cmd_addr] "l"(&SYSCTL->SOCLOCK.RESETCMD),
        [cmd_val] "l"(SYSCTL_RESETCMD_KEY_VALUE | SYSCTL_RESETCMD_GO_TRUE)
      : "r1", "r2", "r3", "memory");
  while (true)
  {
  }
}