You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
92 lines
2.2 KiB
C
92 lines
2.2 KiB
C
#include <stdio.h>
|
|
#include <signal.h>
|
|
#include <sys/time.h>
|
|
#include <time.h>
|
|
#include <stdarg.h>
|
|
#include <string.h>
|
|
|
|
#include "../multi_timer.h"
|
|
|
|
#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, ...)
|
|
{
|
|
char content[1024] = {0};
|
|
time_t time_write;
|
|
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 signalHandler(int signo)
|
|
{
|
|
switch(signo)
|
|
{
|
|
case SIGALRM:
|
|
timer_ticks();
|
|
//printf_timestamp("Caught the SIGALRM signal every 1ms !\n");
|
|
break;
|
|
}
|
|
}
|
|
|
|
struct Timer timer1;
|
|
struct Timer timer2;
|
|
|
|
void timer1_callback(void *arg)
|
|
{
|
|
printf_timestamp("timer1 timeout! arg: %p\r\n", arg);
|
|
}
|
|
|
|
void timer2_callback(void *arg)
|
|
{
|
|
printf_timestamp("timer2 timeout! arg: %p\r\n", arg);
|
|
}
|
|
|
|
int main(void)
|
|
{
|
|
printf_timestamp("%s start ...\r\n", __func__);
|
|
|
|
signal(SIGALRM, signalHandler);
|
|
|
|
struct itimerval new_value, old_value;
|
|
new_value.it_value.tv_sec = 0; // should be 0x00 !!!
|
|
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, 2000, &timer2); // start timer right now
|
|
timer_start(&timer2);
|
|
|
|
while(1) {
|
|
timer_loop();
|
|
}
|
|
|
|
return 0;
|
|
}
|