implement set_timeval

This commit is contained in:
Meco Man 2021-04-15 14:01:55 +08:00
parent 6d7dafe090
commit 8e2a456d7a
3 changed files with 130 additions and 68 deletions

View File

@ -40,7 +40,7 @@ struct timeval {
#endif
#endif /* _TIMEVAL_DEFINED */
#if !(defined(__GNUC__) && !defined(__ARMCC_VERSION)) && !defined (__ICCARM__) && !defined (_WIN32)
#if !(defined(__GNUC__) && !defined(__ARMCC_VERSION)/*GCC*/) && !defined (__ICCARM__) && !defined (_WIN32)
struct timespec {
time_t tv_sec; /* seconds */
long tv_nsec; /* and nanoseconds */
@ -56,6 +56,9 @@ int stime(const time_t *t);
time_t timegm(struct tm * const t);
int gettimeofday(struct timeval *tv, struct timezone *tz);
int settimeofday(const struct timeval *tv, const struct timezone *tz);
#if defined(__ARMCC_VERSION) || defined (__ICCARM__)
struct tm *gmtime_r(const time_t *timep, struct tm *r);
#endif
#ifdef RT_USING_POSIX
#include <sys/types.h>

View File

@ -68,6 +68,104 @@ static void num2str(char *c, int i)
c[1] = i % 10 + '0';
}
/**
* Get time from RTC device (without timezone)
* @param tv: struct timeval
* @return -1 failure; 1 success
*/
static int get_timeval(struct timeval *tv)
{
#ifdef RT_USING_RTC
static rt_device_t device = RT_NULL;
#endif
rt_err_t rst = -RT_ERROR;
if (tv == RT_NULL)
return -1;
/* default is 0 */
tv->tv_sec = 0;
tv->tv_usec = 0;
#ifdef RT_USING_RTC
/* optimization: find rtc device only first */
if (device == RT_NULL)
{
device = rt_device_find("rtc");
}
/* read timestamp from RTC device */
if (device != RT_NULL)
{
if (rt_device_open(device, 0) == RT_EOK)
{
rst = rt_device_control(device, RT_DEVICE_CTRL_RTC_GET_TIME, &tv->tv_sec);
rt_device_control(device, RT_DEVICE_CTRL_RTC_GET_TIME_US, &tv->tv_usec);
rt_device_close(device);
}
}
else
{
/* LOG_W will cause a recursive printing if ulog timestamp function is turned on */
rt_kprintf("Cannot find a RTC device to provide time!\r\n");
return -1;
}
return (rst < 0) ? -1 : 1;
#else
/* LOG_W will cause a recursive printing if ulog timestamp function is turned on */
rt_kprintf("Cannot find a RTC device to provide time!\r\n");
return -1;
#endif /* RT_USING_RTC */
}
/**
* Set time to RTC device (without timezone)
* @param tv: struct timeval
* @return -1 failure; 1 success
*/
static int set_timeval(struct timeval *tv)
{
rt_err_t rst = -RT_ERROR;
#ifdef RT_USING_RTC
static rt_device_t device = RT_NULL;
#endif
if (tv == RT_NULL)
return -1;
#ifdef RT_USING_RTC
/* optimization: find rtc device only first */
if (device == RT_NULL)
{
device = rt_device_find("rtc");
}
/* read timestamp from RTC device */
if (device != RT_NULL)
{
if (rt_device_open(device, 0) == RT_EOK)
{
rst = rt_device_control(device, RT_DEVICE_CTRL_RTC_SET_TIME, &tv->tv_sec);
rt_device_control(device, RT_DEVICE_CTRL_RTC_SET_TIME_US, &tv->tv_usec);
rt_device_close(device);
}
}
else
{
LOG_W("Cannot find a RTC device to provide time!");
return -1;
}
return (rst < 0) ? -1 : 1;
#else
LOG_W("Cannot find a RTC device to provide time!");
return -1;
#endif /* RT_USING_RTC */
}
struct tm *gmtime_r(const time_t *timep, struct tm *r)
{
time_t i;
@ -183,49 +281,6 @@ char* ctime(const time_t *tim_p)
}
RTM_EXPORT(ctime);
/*-1 failure; 1 success*/
static int get_timeval(struct timeval *tv)
{
if (tv == RT_NULL)
return -1;
/* default is not available */
tv->tv_sec = -1;
/* default is 0 */
tv->tv_usec = 0;
#ifdef RT_USING_RTC
static rt_device_t device = RT_NULL;
/* optimization: find rtc device only first */
if (device == RT_NULL)
{
device = rt_device_find("rtc");
}
/* read timestamp from RTC device */
if (device != RT_NULL)
{
if (rt_device_open(device, 0) == RT_EOK)
{
rt_device_control(device, RT_DEVICE_CTRL_RTC_GET_TIME, &tv->tv_sec);
rt_device_control(device, RT_DEVICE_CTRL_RTC_GET_TIME_US, &tv->tv_usec);
rt_device_close(device);
}
}
#endif /* RT_USING_RTC */
if (tv->tv_sec == (time_t) -1)
{
/* LOG_W will cause a recursive printing if ulog timestamp function is turned on */
rt_kprintf("Cannot find a RTC device to provide time!\r\n");
tv->tv_sec = 0;
return -1;
}
return 1;
}
/**
* Returns the current time.
*
@ -239,7 +294,7 @@ RT_WEAK time_t time(time_t *t)
{
struct timeval now;
if(get_timeval(&now)>0)
if(get_timeval(&now) > 0)
{
if (t)
{
@ -263,28 +318,24 @@ RTM_EXPORT(clock);
int stime(const time_t *t)
{
#ifdef RT_USING_RTC
rt_device_t device;
struct timeval tv;
/* read timestamp from RTC device. */
device = rt_device_find("rtc");
if (rt_device_open(device, 0) == RT_EOK)
if (!t)
{
errno = EFAULT;
return -1;
}
tv.tv_sec = *t;
if (set_timeval(&tv) > 0)
{
return 0;
}
else
{
rt_device_control(device, RT_DEVICE_CTRL_RTC_SET_TIME, (void*)t);
rt_device_close(device);
}
else
{
LOG_W("Cannot find a RTC device to provide time!");
errno = EFAULT;
return -1;
}
return 0;
#else
LOG_W("Cannot find a RTC device to provide time!");
errno = EFAULT;
return -1;
#endif /* RT_USING_RTC */
}
RTM_EXPORT(stime);
@ -366,7 +417,7 @@ RTM_EXPORT(timegm);
/* TODO: timezone */
int gettimeofday(struct timeval *tv, struct timezone *tz)
{
if (tv != RT_NULL && get_timeval(tv)>0)
if (tv != RT_NULL && get_timeval(tv) > 0)
{
return 0;
}
@ -385,7 +436,15 @@ int settimeofday(const struct timeval *tv, const struct timezone *tz)
{
if(tv->tv_sec >= 0 && tv->tv_usec >= 0)
{
return stime((const time_t *)&tv->tv_sec);
if(set_timeval((struct timeval *)tv) > 0)
{
return 0;
}
else
{
errno = EFAULT;
return -1;
}
}
else
{

View File

@ -964,10 +964,10 @@ enum rt_device_class_type
#define RT_DEVICE_CTRL_MTD_FORMAT 0x10 /**< format a MTD device */
#define RT_DEVICE_CTRL_RTC_GET_TIME 0x10 /**< get second time */
#define RT_DEVICE_CTRL_RTC_SET_TIME 0x11 /**< set second time */
#define RT_DEVICE_CTRL_RTC_GET_ALARM 0x12 /**< get alarm */
#define RT_DEVICE_CTRL_RTC_SET_ALARM 0x13 /**< set alarm */
#define RT_DEVICE_CTRL_RTC_GET_TIME_US 0x14 /**< get microsecond time */
#define RT_DEVICE_CTRL_RTC_SET_TIME_US 0x15 /**< set microsecond time */
#define RT_DEVICE_CTRL_RTC_GET_TIME_US 0x12 /**< get microsecond time */
#define RT_DEVICE_CTRL_RTC_SET_TIME_US 0x13 /**< set microsecond time */
#define RT_DEVICE_CTRL_RTC_GET_ALARM 0x14 /**< get alarm */
#define RT_DEVICE_CTRL_RTC_SET_ALARM 0x15 /**< set alarm */
typedef struct rt_device *rt_device_t;