Compare commits
3 Commits
developmen
...
master
| Author | SHA1 | Date |
|---|---|---|
|
|
8552905e23 | 2 years ago |
|
|
ccb71779ca | 2 years ago |
|
|
1d387e9f4c | 2 years ago |
@ -1,82 +0,0 @@
|
|||||||
#include "MultiTimer.h"
|
|
||||||
#include <stdio.h>
|
|
||||||
|
|
||||||
/* Timer handle list head. */
|
|
||||||
static MultiTimer* timerList = NULL;
|
|
||||||
|
|
||||||
/* Timer tick */
|
|
||||||
static PlatformTicksFunction_t platformTicksFunction = NULL;
|
|
||||||
|
|
||||||
int MultiTimerInstall(PlatformTicksFunction_t ticksFunc)
|
|
||||||
{
|
|
||||||
platformTicksFunction = ticksFunc;
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
int MultiTimerStart(MultiTimer* timer, uint64_t timing, MultiTimerCallback_t callback, void* userData)
|
|
||||||
{
|
|
||||||
if (!timer || !callback ) {
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
MultiTimer** nextTimer = &timerList;
|
|
||||||
/* Remove the existing target timer. */
|
|
||||||
for (; *nextTimer; nextTimer = &(*nextTimer)->next) {
|
|
||||||
if (timer == *nextTimer) {
|
|
||||||
*nextTimer = timer->next; /* remove from list */
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Init timer. */
|
|
||||||
timer->deadline = platformTicksFunction() + timing;
|
|
||||||
timer->callback = callback;
|
|
||||||
timer->userData = userData;
|
|
||||||
|
|
||||||
/* Insert timer. */
|
|
||||||
for (nextTimer = &timerList;; nextTimer = &(*nextTimer)->next) {
|
|
||||||
if (!*nextTimer) {
|
|
||||||
timer->next = NULL;
|
|
||||||
*nextTimer = timer;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if (timer->deadline < (*nextTimer)->deadline) {
|
|
||||||
timer->next = *nextTimer;
|
|
||||||
*nextTimer = timer;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
int MultiTimerStop(MultiTimer* timer)
|
|
||||||
{
|
|
||||||
MultiTimer** nextTimer = &timerList;
|
|
||||||
/* Find and remove timer. */
|
|
||||||
for (; *nextTimer; nextTimer = &(*nextTimer)->next) {
|
|
||||||
MultiTimer* entry = *nextTimer;
|
|
||||||
if (entry == timer) {
|
|
||||||
*nextTimer = timer->next;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
int MultiTimerYield(void)
|
|
||||||
{
|
|
||||||
MultiTimer* entry = timerList;
|
|
||||||
for (; entry; entry = entry->next) {
|
|
||||||
/* Sorted list, just process with the front part. */
|
|
||||||
if (platformTicksFunction() < entry->deadline) {
|
|
||||||
return (int)(entry->deadline - platformTicksFunction());
|
|
||||||
}
|
|
||||||
/* remove expired timer from list */
|
|
||||||
timerList = entry->next;
|
|
||||||
|
|
||||||
/* call callback */
|
|
||||||
if (entry->callback) {
|
|
||||||
entry->callback(entry, entry->userData);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
@ -1,83 +0,0 @@
|
|||||||
/*
|
|
||||||
* Copyright (c) 2021 0x1abin
|
|
||||||
*
|
|
||||||
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
||||||
* of this software and associated documentation files (the "Software"), to
|
|
||||||
* deal in the Software without restriction, including without limitation the
|
|
||||||
* rights to use, copy, modify, merge, publish, distribute, sublicense, and/or
|
|
||||||
* sell copies of the Software, and to permit persons to whom the Software is
|
|
||||||
* furnished to do so, subject to the following conditions:
|
|
||||||
*
|
|
||||||
* The above copyright notice and this permission notice shall be included in
|
|
||||||
* all copies or substantial portions of the Software.
|
|
||||||
*
|
|
||||||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
||||||
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
||||||
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
|
||||||
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
||||||
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
|
|
||||||
* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS
|
|
||||||
* IN THE SOFTWARE.
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef _MULTI_TIMER_H_
|
|
||||||
#define _MULTI_TIMER_H_
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
|
|
||||||
#ifdef __cplusplus
|
|
||||||
extern "C" {
|
|
||||||
#endif
|
|
||||||
|
|
||||||
typedef uint64_t (*PlatformTicksFunction_t)(void);
|
|
||||||
|
|
||||||
typedef struct MultiTimerHandle MultiTimer;
|
|
||||||
|
|
||||||
typedef void (*MultiTimerCallback_t)(MultiTimer* timer, void* userData);
|
|
||||||
|
|
||||||
struct MultiTimerHandle {
|
|
||||||
MultiTimer* next;
|
|
||||||
uint64_t deadline;
|
|
||||||
MultiTimerCallback_t callback;
|
|
||||||
void* userData;
|
|
||||||
};
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief Platform ticks function.
|
|
||||||
*
|
|
||||||
* @param ticksFunc ticks function.
|
|
||||||
* @return int 0 on success, -1 on error.
|
|
||||||
*/
|
|
||||||
int MultiTimerInstall(PlatformTicksFunction_t ticksFunc);
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief Start the timer work, add the handle into work list.
|
|
||||||
*
|
|
||||||
* @param timer target handle strcut.
|
|
||||||
* @param timing Set the start time.
|
|
||||||
* @param callback deadline callback.
|
|
||||||
* @param userData user data.
|
|
||||||
* @return int 0: success, -1: fail.
|
|
||||||
*/
|
|
||||||
int MultiTimerStart(MultiTimer* timer, uint64_t timing, MultiTimerCallback_t callback, void* userData);
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief Stop the timer work, remove the handle off work list.
|
|
||||||
*
|
|
||||||
* @param timer target handle strcut.
|
|
||||||
* @return int 0: success, -1: fail.
|
|
||||||
*/
|
|
||||||
int MultiTimerStop(MultiTimer* timer);
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief Check the timer expried and call callback.
|
|
||||||
*
|
|
||||||
* @return int The next timer expires.
|
|
||||||
*/
|
|
||||||
int MultiTimerYield(void);
|
|
||||||
|
|
||||||
#ifdef __cplusplus
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#endif
|
|
||||||
@ -0,0 +1,34 @@
|
|||||||
|
#include "multi_timer.h"
|
||||||
|
|
||||||
|
struct Timer timer1;
|
||||||
|
struct Timer timer2;
|
||||||
|
|
||||||
|
void timer1_callback(void *arg)
|
||||||
|
{
|
||||||
|
printf("timer1 timeout! arg: %p\r\n", arg);
|
||||||
|
}
|
||||||
|
|
||||||
|
void timer2_callback(void *arg)
|
||||||
|
{
|
||||||
|
printf("timer2 timeout! arg: %p\r\n", arg);
|
||||||
|
}
|
||||||
|
|
||||||
|
int main(void)
|
||||||
|
{
|
||||||
|
timer_init(&timer1, timer1_callback, 1000, 1000, NULL); //1s loop
|
||||||
|
timer_start(&timer1);
|
||||||
|
|
||||||
|
timer_init(&timer2, timer2_callback, 50, 0, NULL); //50ms delay
|
||||||
|
timer_start(&timer2);
|
||||||
|
|
||||||
|
while(1) {
|
||||||
|
timer_loop();
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
void HAL_SYSTICK_Callback(void)
|
||||||
|
{
|
||||||
|
timer_ticks(); //1ms ticks
|
||||||
|
}
|
||||||
@ -1,45 +1,92 @@
|
|||||||
#include <stdio.h>
|
#include <stdio.h>
|
||||||
|
#include <signal.h>
|
||||||
#include <sys/time.h>
|
#include <sys/time.h>
|
||||||
#include <time.h>
|
#include <time.h>
|
||||||
#include "../MultiTimer.h"
|
#include <stdarg.h>
|
||||||
|
#include <string.h>
|
||||||
|
|
||||||
MultiTimer timer1;
|
#include "../multi_timer.h"
|
||||||
MultiTimer timer2;
|
|
||||||
MultiTimer timer3;
|
|
||||||
|
|
||||||
uint64_t PlatformTicksGetFunc(void)
|
#define LOG_TIMESTAMP_FORMAT "[%Y-%m-%d %H:%M:%S]"
|
||||||
|
#define LOG_TIMESTAMP_LEN 21
|
||||||
|
#define MS_TIMESTAMP_LEN 5
|
||||||
|
|
||||||
|
int32_t printf_timestamp(const char *msg, ...)
|
||||||
{
|
{
|
||||||
struct timespec current_time;
|
char content[1024] = {0};
|
||||||
clock_gettime(CLOCK_MONOTONIC, ¤t_time);
|
time_t time_write;
|
||||||
return (uint64_t)((current_time.tv_sec * 1000) + (current_time.tv_nsec / 1000000));
|
struct tm tm_Log;
|
||||||
|
struct timeval t;
|
||||||
|
uint32_t len = 0;
|
||||||
|
va_list vl_list;
|
||||||
|
|
||||||
|
time_write = time(NULL);
|
||||||
|
localtime_r(&time_write, &tm_Log);
|
||||||
|
strftime((char *)&content[len], sizeof(content) - len - 1, LOG_TIMESTAMP_FORMAT, &tm_Log);
|
||||||
|
len = strlen(&content[len]);
|
||||||
|
|
||||||
|
/* .msec] */
|
||||||
|
gettimeofday(&t, NULL);
|
||||||
|
len--; // min a ']' char
|
||||||
|
snprintf((char*)&content[len], sizeof(content) - len, ".%03d]", (int)(t.tv_usec / 1000));
|
||||||
|
len += MS_TIMESTAMP_LEN;
|
||||||
|
|
||||||
|
va_start(vl_list, msg);
|
||||||
|
vsnprintf((char *)&content[len], sizeof(content) - len - 1, (const char *)msg, vl_list);
|
||||||
|
va_end(vl_list);
|
||||||
|
|
||||||
|
printf("%s", content);
|
||||||
|
|
||||||
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
void exampleTimer1Callback(MultiTimer* timer, void *userData)
|
void signalHandler(int signo)
|
||||||
|
{
|
||||||
|
switch(signo)
|
||||||
{
|
{
|
||||||
printf("[%012ld] Timer:%p callback-> %s.\r\n", PlatformTicksGetFunc(), timer, (char*)userData);
|
case SIGALRM:
|
||||||
MultiTimerStart(timer, 1000, exampleTimer1Callback, userData);
|
timer_ticks();
|
||||||
|
//printf_timestamp("Caught the SIGALRM signal every 1ms !\n");
|
||||||
|
break;
|
||||||
}
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
struct Timer timer1;
|
||||||
|
struct Timer timer2;
|
||||||
|
|
||||||
void exampleTimer2Callback(MultiTimer* timer, void *userData)
|
void timer1_callback(void *arg)
|
||||||
{
|
{
|
||||||
printf("[%012ld] Timer:%p callback-> %s.\r\n", PlatformTicksGetFunc(), timer, (char*)userData);
|
printf_timestamp("timer1 timeout! arg: %p\r\n", arg);
|
||||||
}
|
}
|
||||||
|
|
||||||
void exampleTimer3Callback(MultiTimer* timer, void *userData)
|
void timer2_callback(void *arg)
|
||||||
{
|
{
|
||||||
printf("[%012ld] Timer:%p callback-> %s.\r\n", PlatformTicksGetFunc(), timer, (char*)userData);
|
printf_timestamp("timer2 timeout! arg: %p\r\n", arg);
|
||||||
MultiTimerStart(timer, 4567, exampleTimer3Callback, userData);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
int main(int argc, char *argv[])
|
int main(void)
|
||||||
{
|
{
|
||||||
MultiTimerInstall(PlatformTicksGetFunc);
|
printf_timestamp("%s start ...\r\n", __func__);
|
||||||
|
|
||||||
|
signal(SIGALRM, signalHandler);
|
||||||
|
|
||||||
MultiTimerStart(&timer1, 1000, exampleTimer1Callback, "1000ms CYCLE timer");
|
struct itimerval new_value, old_value;
|
||||||
MultiTimerStart(&timer2, 5000, exampleTimer2Callback, "5000ms ONCE timer");
|
new_value.it_value.tv_sec = 0; // should be 0x00 !!!
|
||||||
MultiTimerStart(&timer3, 3456, exampleTimer3Callback, "3456ms delay start, 4567ms CYCLE timer");
|
new_value.it_value.tv_usec = 1; // non-zero is OK !!!
|
||||||
|
new_value.it_interval.tv_sec = 0;
|
||||||
|
new_value.it_interval.tv_usec = 1000 * CFG_TIMER_1_TICK_N_MS; // 1ms
|
||||||
|
setitimer(ITIMER_REAL, &new_value, &old_value);
|
||||||
|
|
||||||
|
timer_init(&timer1, timer1_callback, 4000, 1000, &timer1); // start timer after 4s
|
||||||
|
timer_start(&timer1);
|
||||||
|
|
||||||
|
timer_init(&timer2, timer2_callback, 0, 5000, &timer2); // start timer right now
|
||||||
|
timer_start(&timer2);
|
||||||
|
|
||||||
while(1) {
|
while(1) {
|
||||||
MultiTimerYield();
|
/* Maybe some sleep time is needed to avoid running CPU all the time. */
|
||||||
|
timer_loop();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
}
|
}
|
||||||
@ -0,0 +1,118 @@
|
|||||||
|
/*
|
||||||
|
* Copyright (c) 2016 Zibin Zheng <znbin@qq.com>
|
||||||
|
* All rights reserved
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <stdio.h>
|
||||||
|
#include "multi_timer.h"
|
||||||
|
|
||||||
|
//timer handle list head.
|
||||||
|
static struct Timer* head_handle = NULL;
|
||||||
|
|
||||||
|
//Timer ticks
|
||||||
|
//static uint32_t _timer_ticks = (1 << 32)- 1000; // only for test tick clock overflow
|
||||||
|
static uint32_t _timer_ticks = 0;
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Initializes the timer struct handle.
|
||||||
|
* @param handle: the timer handle struct.
|
||||||
|
* @param timeout_cb: timeout callback.
|
||||||
|
* @param timeout: delay to start the timer.
|
||||||
|
* @param repeat: repeat interval time.
|
||||||
|
* @param arg: the input argument for timeout_cb fucntion.
|
||||||
|
* @retval None
|
||||||
|
*/
|
||||||
|
void timer_init(struct Timer* handle, void (*timeout_cb)(void *arg), \
|
||||||
|
uint32_t timeout, uint32_t repeat, void *arg)
|
||||||
|
{
|
||||||
|
// memset(handle, 0, sizeof(struct Timer));
|
||||||
|
handle->timeout_cb = timeout_cb;
|
||||||
|
handle->timeout = timeout;
|
||||||
|
handle->repeat = repeat;
|
||||||
|
handle->cur_ticks = _timer_ticks;
|
||||||
|
handle->cur_expired_time = handle->timeout;
|
||||||
|
handle->arg = arg;
|
||||||
|
//printf("cur_ticks: %u, cur_expired_time: %u, _timer_ticks: %u, timeout: %u\r\n",
|
||||||
|
// handle->cur_ticks, handle->cur_expired_time, _timer_ticks, timeout);
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Start the timer work, add the handle into work list.
|
||||||
|
* @param handle: target handle struct.
|
||||||
|
* @retval 0: succeed. -1: already exist.
|
||||||
|
*/
|
||||||
|
int timer_start(struct Timer* handle)
|
||||||
|
{
|
||||||
|
struct Timer* target = head_handle;
|
||||||
|
|
||||||
|
while(target) {
|
||||||
|
if(target == handle) {
|
||||||
|
return -1; //already exist.
|
||||||
|
}
|
||||||
|
target = target->next;
|
||||||
|
}
|
||||||
|
handle->next = head_handle;
|
||||||
|
head_handle = handle;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Stop the timer work, remove the handle off work list.
|
||||||
|
* @param handle: target handle struct.
|
||||||
|
* @retval 0: succeed. -1: timer not exist.
|
||||||
|
*/
|
||||||
|
int timer_stop(struct Timer* handle)
|
||||||
|
{
|
||||||
|
struct Timer** curr;
|
||||||
|
|
||||||
|
for(curr = &head_handle; *curr;) {
|
||||||
|
struct Timer* entry = *curr;
|
||||||
|
if(entry == handle) {
|
||||||
|
*curr = entry->next;
|
||||||
|
//free(entry);
|
||||||
|
return 0; // found specified timer
|
||||||
|
} else {
|
||||||
|
curr = &entry->next;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief main loop.
|
||||||
|
* @param None.
|
||||||
|
* @retval None
|
||||||
|
*/
|
||||||
|
void timer_loop(void)
|
||||||
|
{
|
||||||
|
struct Timer* target;
|
||||||
|
|
||||||
|
for(target = head_handle; target; target = target->next) {
|
||||||
|
/*
|
||||||
|
More detail on tick-clock overflow, please see https://blog.csdn.net/szullc/article/details/115332326
|
||||||
|
*/
|
||||||
|
if(_timer_ticks - target->cur_ticks >= target->cur_expired_time) {
|
||||||
|
//printf("cur_ticks: %u, cur_expired_time: %u, _timer_ticks: %u\r\n",
|
||||||
|
// target->cur_ticks, target->cur_expired_time, _timer_ticks);
|
||||||
|
if(target->repeat == 0) {
|
||||||
|
timer_stop(target);
|
||||||
|
} else {
|
||||||
|
target->cur_ticks = _timer_ticks;
|
||||||
|
target->cur_expired_time = target->repeat;
|
||||||
|
}
|
||||||
|
target->timeout_cb(target->arg);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief background ticks, timer repeat invoking interval nms.
|
||||||
|
* @param None.
|
||||||
|
* @retval None
|
||||||
|
*/
|
||||||
|
void timer_ticks(void)
|
||||||
|
{
|
||||||
|
_timer_ticks += CFG_TIMER_1_TICK_N_MS;
|
||||||
|
}
|
||||||
@ -0,0 +1,76 @@
|
|||||||
|
/*
|
||||||
|
* Copyright (c) 2016 Zibin Zheng <znbin@qq.com>
|
||||||
|
* All rights reserved
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _MULTI_TIMER_H_
|
||||||
|
#define _MULTI_TIMER_H_
|
||||||
|
|
||||||
|
#include <stdint.h>
|
||||||
|
#include <stddef.h>
|
||||||
|
|
||||||
|
/*
|
||||||
|
It means 1 tick for 1ms.
|
||||||
|
Your can configurate for your tick time such as 5ms/10ms and so on.
|
||||||
|
*/
|
||||||
|
#define CFG_TIMER_1_TICK_N_MS 1
|
||||||
|
|
||||||
|
typedef struct Timer {
|
||||||
|
uint32_t cur_ticks; /* Record current timer start tick */
|
||||||
|
uint32_t cur_expired_time; /* Record current timer expired time */
|
||||||
|
uint32_t timeout; /* Delay (xx ms) time to start timer */
|
||||||
|
uint32_t repeat; /* Timer interval expired time (xx ms) */
|
||||||
|
void * arg; /* Input argument for timeout_cb function */
|
||||||
|
void (*timeout_cb)(void *arg); /* Timer expired callback function */
|
||||||
|
struct Timer* next; /* Pointer to next timer */
|
||||||
|
} Timer;
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
extern "C" {
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Initializes the timer struct handle.
|
||||||
|
* @param handle: the timer handle struct.
|
||||||
|
* @param timeout_cb: timeout callback.
|
||||||
|
* @param timeout: delay to start the timer.
|
||||||
|
* @param repeat: repeat interval time.
|
||||||
|
* @param arg: the input argument for timeout_cb fucntion.
|
||||||
|
* @retval None
|
||||||
|
*/
|
||||||
|
void timer_init(struct Timer* handle, void(*timeout_cb)(void *arg), \
|
||||||
|
uint32_t timeout, uint32_t repeat, void *arg);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Start the timer work, add the handle into work list.
|
||||||
|
* @param handle: target handle struct.
|
||||||
|
* @retval 0: succeed. -1: already exist.
|
||||||
|
*/
|
||||||
|
int timer_start(struct Timer* handle);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Stop the timer work, remove the handle off work list.
|
||||||
|
* @param handle: target handle struct.
|
||||||
|
* @retval 0: succeed. -1: timer not exist.
|
||||||
|
*/
|
||||||
|
int timer_stop(struct Timer* handle);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief background ticks, timer repeat invoking interval nms.
|
||||||
|
* @param None.
|
||||||
|
* @retval None
|
||||||
|
*/
|
||||||
|
void timer_ticks(void);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief main loop.
|
||||||
|
* @param None.
|
||||||
|
* @retval None
|
||||||
|
*/
|
||||||
|
void timer_loop(void);
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#endif
|
||||||
Loading…
Reference in New Issue