drv_wdt.c 3.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135
  1. /*
  2. * Copyright (c) 2006-2018, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2018-12-07 balanceTWK first version
  9. */
  10. #include <board.h>
  11. #include<rtthread.h>
  12. #include<rtdevice.h>
  13. #ifdef RT_USING_WDT
  14. //#define DRV_DEBUG
  15. #define LOG_TAG "drv.wdt"
  16. #include <drv_log.h>
  17. struct stm32_wdt_obj
  18. {
  19. IWDG_HandleTypeDef hiwdg;
  20. rt_uint16_t is_start;
  21. };
  22. static struct stm32_wdt_obj stm32_wdt;
  23. static struct rt_watchdog_ops ops;
  24. static rt_watchdog_t watchdog;
  25. static rt_err_t wdt_init(rt_watchdog_t *wdt)
  26. {
  27. return RT_EOK;
  28. }
  29. static rt_err_t wdt_control(rt_watchdog_t *wdt, int cmd, void *arg)
  30. {
  31. switch (cmd)
  32. {
  33. /* feed the watchdog */
  34. case RT_DEVICE_CTRL_WDT_KEEPALIVE:
  35. if(HAL_IWDG_Refresh(&stm32_wdt.hiwdg) != HAL_OK)
  36. {
  37. LOG_E("watch dog keepalive fail.");
  38. }
  39. break;
  40. /* set watchdog timeout */
  41. case RT_DEVICE_CTRL_WDT_SET_TIMEOUT:
  42. #if defined(LSI_VALUE)
  43. if(LSI_VALUE)
  44. {
  45. stm32_wdt.hiwdg.Init.Reload = (*((rt_uint32_t*)arg)) * LSI_VALUE / 256 ;
  46. }
  47. else
  48. {
  49. LOG_E("Please define the value of LSI_VALUE!");
  50. }
  51. if(stm32_wdt.hiwdg.Init.Reload > 0xFFF)
  52. {
  53. LOG_E("wdg set timeout parameter too large, please less than %ds",0xFFF * 256 / LSI_VALUE);
  54. return -RT_EINVAL;
  55. }
  56. #else
  57. #error "Please define the value of LSI_VALUE!"
  58. #endif
  59. if(stm32_wdt.is_start)
  60. {
  61. if (HAL_IWDG_Init(&stm32_wdt.hiwdg) != HAL_OK)
  62. {
  63. LOG_E("wdg set timeout failed.");
  64. return -RT_ERROR;
  65. }
  66. }
  67. break;
  68. case RT_DEVICE_CTRL_WDT_GET_TIMEOUT:
  69. #if defined(LSI_VALUE)
  70. if(LSI_VALUE)
  71. {
  72. /* 实际溢出 = (Reload+1)*256/LSI(IWDG 多计一个计数周期)。原式用 Reload
  73. * 且未四舍五入,GET 结果比实际少 1s(781→4,实际≈5s),与 SET 口径不一致。 */
  74. (*((rt_uint32_t*)arg)) = ((stm32_wdt.hiwdg.Init.Reload + 1) * 256 + LSI_VALUE / 2) / LSI_VALUE;
  75. }
  76. else
  77. {
  78. LOG_E("Please define the value of LSI_VALUE!");
  79. }
  80. #else
  81. #error "Please define the value of LSI_VALUE!"
  82. #endif
  83. break;
  84. case RT_DEVICE_CTRL_WDT_START:
  85. if (HAL_IWDG_Init(&stm32_wdt.hiwdg) != HAL_OK)
  86. {
  87. LOG_E("wdt start failed.");
  88. return -RT_ERROR;
  89. }
  90. stm32_wdt.is_start = 1;
  91. break;
  92. default:
  93. LOG_W("This command is not supported.");
  94. return -RT_ERROR;
  95. }
  96. return RT_EOK;
  97. }
  98. int rt_wdt_init(void)
  99. {
  100. #if defined(SOC_SERIES_STM32H7)
  101. stm32_wdt.hiwdg.Instance = IWDG1;
  102. #else
  103. stm32_wdt.hiwdg.Instance = IWDG;
  104. #endif
  105. stm32_wdt.hiwdg.Init.Prescaler = IWDG_PRESCALER_256;
  106. stm32_wdt.hiwdg.Init.Reload = 0x00000FFF;
  107. #if defined(SOC_SERIES_STM32F0) || defined(SOC_SERIES_STM32L4) || defined(SOC_SERIES_STM32F7) \
  108. || defined(SOC_SERIES_STM32H7)
  109. stm32_wdt.hiwdg.Init.Window = 0x00000FFF;
  110. #endif
  111. stm32_wdt.is_start = 0;
  112. ops.init = &wdt_init;
  113. ops.control = &wdt_control;
  114. watchdog.ops = &ops;
  115. /* register watchdog device */
  116. if (rt_hw_watchdog_register(&watchdog, "wdt", RT_DEVICE_FLAG_DEACTIVATE, RT_NULL) != RT_EOK)
  117. {
  118. LOG_E("wdt device register failed.");
  119. return -RT_ERROR;
  120. }
  121. LOG_D("wdt device register success.");
  122. return RT_EOK;
  123. }
  124. INIT_BOARD_EXPORT(rt_wdt_init);
  125. #endif /* RT_USING_WDT */