ALPAKA/TACOS
1
0
Fork 0
mirror of https://git.intern.spaceteamaachen.de/ALPAKA/TACOS.git synced 2025-08-06 09:37:34 +00:00
Code Issues Actions Packages Projects Releases Wiki Activity

feat(sync): added periodicDelay function to threads

Browse Source
This commit is contained in:
@CarlWachter
2024-06-16 10:44:24 +02:00
committed by carlwachter
parent e03f624c5b
commit 40727728d0
2 changed files with 34 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

26
src/thread.cpp
View File

@@ -13,7 +13,11 @@
#include <functional>
#include <cstring>
#include <cmsis_os2.h>
// Include FreeRTOS configuration for the system tick rate.
typedef uint32_t TickType_t;
#include <FreeRTOSConfig.h>
namespace sta
{
@@ -31,7 +35,8 @@ namespace sta
CAN_queue_{STA_RTOS_CAN_BUS_QUEUE_LENGTH},
canID_{0},
#endif // STA_CAN_BUS_ENABLE
terminate_{false}
terminate_{false},
previous_tick_{0}
{
STA_ASSERT(stack_size >= 0);
STA_ASSERT(cb_size >= 0);
@@ -110,6 +115,25 @@ namespace sta
osDelay(ticks);
#ifdef STA_TACOS_WATCHDOG_ENABLED
heartbeat();
#endif // STA_TACOS_WATCHDOG_ENABLED
}
void TacosThread::periodicDelay(uint32_t frequency){
if (previous_tick_ == 0)
{
previous_tick_ = osKernelGetTickCount();
}
previous_tick_ += configTICK_RATE_HZ/frequency;
#ifdef STA_TACOS_WATCHDOG_ENABLED
waiting();
#endif // STA_TACOS_WATCHDOG_ENABLED
osDelayUntil(previous_tick_);
#ifdef STA_TACOS_WATCHDOG_ENABLED
heartbeat();
#endif // STA_TACOS_WATCHDOG_ENABLED