csu3_am335x/EVSE/Projects/DO360/Apps/Common.c

/*
 * Common.c
 *
 *  Created on: 2021年8月7日
 *      Author: Wendell
 */

#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <stdarg.h>
#include <time.h>
#include <sys/timeb.h>

int StoreSysLogMsg(const char *fmt, ...)
{
    char Buf[4096+256];
    char buffer[4096];
    va_list args;
    struct timeb  SeqEndTime;
    struct tm *tm;

    va_start(args, fmt);
    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
    va_end(args);

    memset(Buf,0,sizeof(Buf));
    ftime(&SeqEndTime);
    SeqEndTime.time = time(NULL);
    tm=localtime(&SeqEndTime.time);

    sprintf(Buf,"echo \'%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\' >> /Storage/SystemLog/[%04d.%02d]SystemLog",
        tm->tm_year+1900,tm->tm_mon+1,tm->tm_mday,tm->tm_hour,tm->tm_min,tm->tm_sec,SeqEndTime.millitm,
        buffer,
        tm->tm_year+1900,tm->tm_mon+1);
    system(Buf);

    return rc;
}

int StorePsuLogMsg(const char *fmt, ...)
{
    char Buf[4096+256];
    char buffer[4096];
    va_list args;
    struct timeb  SeqEndTime;
    struct tm *tm;

    va_start(args, fmt);
    int rc = vsnprintf(buffer, sizeof(buffer), fmt, args);
    va_end(args);

    memset(Buf,0,sizeof(Buf));
    ftime(&SeqEndTime);
    SeqEndTime.time = time(NULL);
    tm=localtime(&SeqEndTime.time);

    sprintf(Buf,"echo \"%04d-%02d-%02d %02d:%02d:%02d:%03d - %s\" >> /Storage/SystemLog/[%04d.%02d]PsuLog",
        tm->tm_year+1900,tm->tm_mon+1,tm->tm_mday,tm->tm_hour,tm->tm_min,tm->tm_sec,SeqEndTime.millitm,
        buffer,
        tm->tm_year+1900,tm->tm_mon+1);
    system(Buf);

    return rc;
}

void GetClockTime(struct timespec *_now_time)
{
    clock_gettime(CLOCK_MONOTONIC, _now_time);
}

// return value unit: 1us
unsigned long GetTimeoutValue(struct timespec _start_time)
{
    struct timespec ts_end;
    unsigned long ret = 0;

    clock_gettime(CLOCK_MONOTONIC, &ts_end);

    ret = ((unsigned long)(ts_end.tv_sec - _start_time.tv_sec) * 1000000) + ((unsigned long)((ts_end.tv_nsec / 1000) - (_start_time.tv_nsec/ 1000)));
    /*
    printf("\r\n TimeInterval: %ld.%09ld - %ld.%09ld = %ld.%06ld ns",
        ts_end.tv_sec, ts_end.tv_nsec,  _start_time.tv_sec, _start_time.tv_nsec,
        (ret / 1000000), (ret % 1000000));
    */
#if 0
    struct timespec ts_interval;
    ts_interval.tv_sec = ts_end.tv_sec - _start_time.tv_sec;
    ts_interval.tv_nsec = ts_end.tv_nsec - _start_time.tv_nsec;

    if(ts_interval.tv_nsec < 0)
    {
        ts_interval.tv_nsec += 1000000000;
        ts_interval.tv_sec--;
    }
#endif

    return ret;
}

// return value unit: 1s
unsigned long GetSecTimeoutValue(struct timespec _start_time)
{
    struct timespec ts_end;
    unsigned long ret = 0;

    clock_gettime(CLOCK_MONOTONIC, &ts_end);

    ret = ((unsigned long)(ts_end.tv_sec - _start_time.tv_sec) * 1000) + ((unsigned long)((ts_end.tv_nsec / 1000000) - (_start_time.tv_nsec / 1000000)));
    /*
    printf("\r\n TimeInterval: %ld.%09ld - %ld.%09ld = %ld.%03ld ms",
        ts_end.tv_sec, ts_end.tv_nsec,  _start_time.tv_sec, _start_time.tv_nsec,
        (ret / 1000), (ret % 1000));
    */
    ret /= 1000;

    return ret;
}