ctime.c 35.0 KB
Newer Older
1
/*
2
 * Copyright (c) 2006-2023, RT-Thread Development Team
3 4 5 6 7 8
 *
 * SPDX-License-Identifier: Apache-2.0
 *
 * Change Logs:
 * Date           Author       Notes
 * 2019-08-21     zhangjun     copy from minilibc
9
 * 2020-09-07     Meco Man     combine gcc armcc iccarm
10
 * 2021-02-05     Meco Man     add timegm()
mysterywolf's avatar
mysterywolf 已提交
11
 * 2021-02-07     Meco Man     fixed gettimeofday()
mysterywolf's avatar
mysterywolf 已提交
12
 * 2021-02-08     Meco Man     add settimeofday() stime()
13
 * 2021-02-10     Meco Man     add ctime_r() and re-implement ctime()
14
 * 2021-02-11     Meco Man     fix bug #3183 - align days[] and months[] to 4 bytes
mysterywolf's avatar
mysterywolf 已提交
15
 * 2021-02-12     Meco Man     add errno
16 17 18
 * 2012-12-08     Bernard      <clock_time.c> fix the issue of _timevalue.tv_usec initialization,
 *                             which found by Rob <rdent@iinet.net.au>
 * 2021-02-12     Meco Man     move all of the functions located in <clock_time.c> to this file
mysterywolf's avatar
mysterywolf 已提交
19
 * 2021-03-15     Meco Man     fixed a bug of leaking memory in asctime()
20
 * 2021-05-01     Meco Man     support fixed timezone
21
 * 2021-07-21     Meco Man     implement that change/set timezone APIs
22 23
 */

mysterywolf's avatar
mysterywolf 已提交
24
#include "sys/time.h"
25
#include <sys/errno.h>
26
#include <rtthread.h>
27
#include <rthw.h>
mysterywolf's avatar
update  
mysterywolf 已提交
28
#include <unistd.h>
29
#ifdef RT_USING_SMART
G
guo 已提交
30 31
#include "lwp.h"
#endif
mysterywolf's avatar
update  
mysterywolf 已提交
32 33 34
#ifdef RT_USING_POSIX_DELAY
#include <delay.h>
#endif
35
#if defined( RT_USING_RTC ) || defined( RT_USING_CPUTIME)
36 37 38
#include <rtdevice.h>
#endif

39
#define DBG_TAG    "time"
mysterywolf's avatar
mysterywolf 已提交
40 41 42
#define DBG_LVL    DBG_INFO
#include <rtdbg.h>

43
#define _WARNING_NO_RTC "Cannot find a RTC device!"
mysterywolf's avatar
mysterywolf 已提交
44

45 46 47
/* seconds per day */
#define SPD 24*60*60

48
/* days per month -- nonleap! */
49
static const short __spm[13] =
50 51 52 53 54 55 56 57 58 59 60 61 62 63 64
{
    0,
    (31),
    (31 + 28),
    (31 + 28 + 31),
    (31 + 28 + 31 + 30),
    (31 + 28 + 31 + 30 + 31),
    (31 + 28 + 31 + 30 + 31 + 30),
    (31 + 28 + 31 + 30 + 31 + 30 + 31),
    (31 + 28 + 31 + 30 + 31 + 30 + 31 + 31),
    (31 + 28 + 31 + 30 + 31 + 30 + 31 + 31 + 30),
    (31 + 28 + 31 + 30 + 31 + 30 + 31 + 31 + 30 + 31),
    (31 + 28 + 31 + 30 + 31 + 30 + 31 + 31 + 30 + 31 + 30),
    (31 + 28 + 31 + 30 + 31 + 30 + 31 + 31 + 30 + 31 + 30 + 31),
};
65

66 67
rt_align(4) static const char *days = "Sun Mon Tue Wed Thu Fri Sat ";
rt_align(4) static const char *months = "Jan Feb Mar Apr May Jun Jul Aug Sep Oct Nov Dec ";
68

69
static int __isleap(int year)
70 71 72 73 74 75 76
{
    /* every fourth year is a leap year except for century years that are
     * not divisible by 400. */
    /*  return (year % 4 == 0 && (year % 100 != 0 || year % 400 == 0)); */
    return (!(year % 4) && ((year % 100) || !(year % 400)));
}

77 78 79 80 81 82
static void num2str(char *c, int i)
{
    c[0] = i / 10 + '0';
    c[1] = i % 10 + '0';
}

mysterywolf's avatar
mysterywolf 已提交
83
/**
84
 * Get time from RTC device (without timezone, UTC+0)
mysterywolf's avatar
mysterywolf 已提交
85
 * @param tv: struct timeval
86
 * @return the operation status, RT_EOK on successful
mysterywolf's avatar
mysterywolf 已提交
87
 */
88
static rt_err_t get_timeval(struct timeval *tv)
mysterywolf's avatar
mysterywolf 已提交
89 90 91 92 93 94
{
#ifdef RT_USING_RTC
    static rt_device_t device = RT_NULL;
    rt_err_t rst = -RT_ERROR;

    if (tv == RT_NULL)
95
        return -RT_EINVAL;
mysterywolf's avatar
mysterywolf 已提交
96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112

    /* default is 0 */
    tv->tv_sec = 0;
    tv->tv_usec = 0;

    /* 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);
113
            rt_device_control(device, RT_DEVICE_CTRL_RTC_GET_TIMEVAL, tv);
mysterywolf's avatar
mysterywolf 已提交
114 115 116 117 118
            rt_device_close(device);
        }
    }
    else
    {
119
        LOG_W(_WARNING_NO_RTC);
120
        return -RT_ENOSYS;
mysterywolf's avatar
mysterywolf 已提交
121 122
    }

123
    return rst;
mysterywolf's avatar
mysterywolf 已提交
124 125

#else
126
    LOG_W(_WARNING_NO_RTC);
127
    return -RT_ENOSYS;
mysterywolf's avatar
mysterywolf 已提交
128 129 130 131 132 133
#endif /* RT_USING_RTC */
}

/**
 * Set time to RTC device (without timezone)
 * @param tv: struct timeval
134
 * @return the operation status, RT_EOK on successful
mysterywolf's avatar
mysterywolf 已提交
135 136 137 138 139
 */
static int set_timeval(struct timeval *tv)
{
#ifdef RT_USING_RTC
    static rt_device_t device = RT_NULL;
140
    rt_err_t rst = -RT_ERROR;
mysterywolf's avatar
mysterywolf 已提交
141 142

    if (tv == RT_NULL)
143
        return -RT_EINVAL;
mysterywolf's avatar
mysterywolf 已提交
144 145 146 147 148 149 150 151 152 153 154 155 156

    /* 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);
157
            rt_device_control(device, RT_DEVICE_CTRL_RTC_SET_TIMEVAL, tv);
mysterywolf's avatar
mysterywolf 已提交
158 159 160 161 162
            rt_device_close(device);
        }
    }
    else
    {
163
        LOG_W(_WARNING_NO_RTC);
164
        return -RT_ENOSYS;
mysterywolf's avatar
mysterywolf 已提交
165 166
    }

167
    return rst;
mysterywolf's avatar
mysterywolf 已提交
168 169

#else
170
    LOG_W(_WARNING_NO_RTC);
171
    return -RT_ENOSYS;
mysterywolf's avatar
mysterywolf 已提交
172 173 174
#endif /* RT_USING_RTC */
}

175 176
struct tm *gmtime_r(const time_t *timep, struct tm *r)
{
177 178
    int i;
    int work = *timep % (SPD);
179 180 181 182 183 184 185

    if(timep == RT_NULL || r == RT_NULL)
    {
        rt_set_errno(EFAULT);
        return RT_NULL;
    }

186
    rt_memset(r, RT_NULL, sizeof(struct tm));
187

188 189 190 191
    r->tm_sec = work % 60;
    work /= 60;
    r->tm_min = work % 60;
    r->tm_hour = work / 60;
192
    work = (int)(*timep / (SPD));
193 194 195
    r->tm_wday = (4 + work) % 7;
    for (i = 1970;; ++i)
    {
196
        int k = __isleap(i) ? 366 : 365;
197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212
        if (work >= k)
            work -= k;
        else
            break;
    }
    r->tm_year = i - 1900;
    r->tm_yday = work;

    r->tm_mday = 1;
    if (__isleap(i) && (work > 58))
    {
        if (work == 59)
            r->tm_mday = 2; /* 29.2. */
        work -= 1;
    }

213 214
    for (i = 11; i && (__spm[i] > work); --i);

215 216
    r->tm_mon = i;
    r->tm_mday += work - __spm[i];
mysterywolf's avatar
mysterywolf 已提交
217

218
    r->tm_isdst = tz_is_dst();
219 220
    return r;
}
mysterywolf's avatar
update  
mysterywolf 已提交
221
RTM_EXPORT(gmtime_r);
222 223 224 225 226 227

struct tm* gmtime(const time_t* t)
{
    static struct tm tmp;
    return gmtime_r(t, &tmp);
}
mysterywolf's avatar
update  
mysterywolf 已提交
228
RTM_EXPORT(gmtime);
229 230 231

struct tm* localtime_r(const time_t* t, struct tm* r)
{
232 233
    time_t local_tz;

mysterywolf's avatar
mysterywolf 已提交
234
    local_tz = *t + (time_t)tz_get() * 3600;
235
    return gmtime_r(&local_tz, r);
236
}
mysterywolf's avatar
update  
mysterywolf 已提交
237
RTM_EXPORT(localtime_r);
238 239 240 241 242 243

struct tm* localtime(const time_t* t)
{
    static struct tm tmp;
    return localtime_r(t, &tmp);
}
mysterywolf's avatar
update  
mysterywolf 已提交
244
RTM_EXPORT(localtime);
245 246 247

time_t mktime(struct tm * const t)
{
mysterywolf's avatar
mysterywolf 已提交
248 249 250
    time_t timestamp;

    timestamp = timegm(t);
mysterywolf's avatar
mysterywolf 已提交
251
    timestamp = timestamp - 3600 * (time_t)tz_get();
mysterywolf's avatar
mysterywolf 已提交
252
    return timestamp;
253
}
mysterywolf's avatar
update  
mysterywolf 已提交
254
RTM_EXPORT(mktime);
255 256 257

char* asctime_r(const struct tm *t, char *buf)
{
258 259 260 261 262 263
    if(t == RT_NULL || buf == RT_NULL)
    {
        rt_set_errno(EFAULT);
        return RT_NULL;
    }

264
    rt_memset(buf, RT_NULL, 26);
265

266
    /* Checking input validity */
267
    if ((int)rt_strlen(days) <= (t->tm_wday << 2) || (int)rt_strlen(months) <= (t->tm_mon << 2))
268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288
    {
        LOG_W("asctime_r: the input parameters exceeded the limit, please check it.");
        *(int*) buf = *(int*) days;
        *(int*) (buf + 4) = *(int*) months;
        num2str(buf + 8, t->tm_mday);
        if (buf[8] == '0')
            buf[8] = ' ';
        buf[10] = ' ';
        num2str(buf + 11, t->tm_hour);
        buf[13] = ':';
        num2str(buf + 14, t->tm_min);
        buf[16] = ':';
        num2str(buf + 17, t->tm_sec);
        buf[19] = ' ';
        num2str(buf + 20, 2000 / 100);
        num2str(buf + 22, 2000 % 100);
        buf[24] = '\n';
        buf[25] = '\0';
        return buf;
    }

289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304
    /* "Wed Jun 30 21:49:08 1993\n" */
    *(int*) buf = *(int*) (days + (t->tm_wday << 2));
    *(int*) (buf + 4) = *(int*) (months + (t->tm_mon << 2));
    num2str(buf + 8, t->tm_mday);
    if (buf[8] == '0')
        buf[8] = ' ';
    buf[10] = ' ';
    num2str(buf + 11, t->tm_hour);
    buf[13] = ':';
    num2str(buf + 14, t->tm_min);
    buf[16] = ':';
    num2str(buf + 17, t->tm_sec);
    buf[19] = ' ';
    num2str(buf + 20, (t->tm_year + 1900) / 100);
    num2str(buf + 22, (t->tm_year + 1900) % 100);
    buf[24] = '\n';
305
    buf[25] = '\0';
306 307
    return buf;
}
mysterywolf's avatar
update  
mysterywolf 已提交
308
RTM_EXPORT(asctime_r);
309 310 311

char* asctime(const struct tm *timeptr)
{
312
    static char buf[26];
313 314
    return asctime_r(timeptr, buf);
}
mysterywolf's avatar
update  
mysterywolf 已提交
315
RTM_EXPORT(asctime);
316

317
char *ctime_r(const time_t * tim_p, char * result)
318
{
mysterywolf's avatar
mysterywolf 已提交
319
    struct tm tm;
mysterywolf's avatar
mysterywolf 已提交
320
    return asctime_r(localtime_r(tim_p, &tm), result);
321
}
mysterywolf's avatar
update  
mysterywolf 已提交
322
RTM_EXPORT(ctime_r);
323 324 325

char* ctime(const time_t *tim_p)
{
mysterywolf's avatar
mysterywolf 已提交
326
    return asctime(localtime(tim_p));
327
}
mysterywolf's avatar
update  
mysterywolf 已提交
328
RTM_EXPORT(ctime);
329

330
#ifndef __ICCARM__
mysterywolf's avatar
mysterywolf 已提交
331 332 333 334
double difftime(time_t time1, time_t time2)
{
    return (double)(time1 - time2);
}
335
#endif /* __ICCARM__ */
mysterywolf's avatar
mysterywolf 已提交
336 337 338 339
RTM_EXPORT(difftime);

RTM_EXPORT(strftime); /* inherent in the toolchain */

340 341 342 343 344 345 346 347 348
/**
 * Returns the current time.
 *
 * @param time_t * t the timestamp pointer, if not used, keep NULL.
 *
 * @return The value ((time_t)-1) is returned if the calendar time is not available.
 *         If timer is not a NULL pointer, the return value is also stored in timer.
 *
 */
349
rt_weak time_t time(time_t *t)
350 351 352
{
    struct timeval now;

353
    if(get_timeval(&now) == RT_EOK)
354
    {
355 356 357 358 359 360 361 362
        if (t)
        {
            *t = now.tv_sec;
        }
        return now.tv_sec;
    }
    else
    {
363
        rt_set_errno(EFAULT);
364
        return ((time_t)-1);
365
    }
366
}
mysterywolf's avatar
update  
mysterywolf 已提交
367
RTM_EXPORT(time);
368

369
rt_weak clock_t clock(void)
370 371 372
{
    return rt_tick_get();
}
mysterywolf's avatar
update  
mysterywolf 已提交
373
RTM_EXPORT(clock);
374

mysterywolf's avatar
mysterywolf 已提交
375
int stime(const time_t *t)
376
{
mysterywolf's avatar
mysterywolf 已提交
377 378
    struct timeval tv;

379
    if (t == RT_NULL)
mysterywolf's avatar
mysterywolf 已提交
380
    {
381
        rt_set_errno(EFAULT);
382
        return -1;
mysterywolf's avatar
mysterywolf 已提交
383
    }
mysterywolf's avatar
mysterywolf 已提交
384

mysterywolf's avatar
mysterywolf 已提交
385
    tv.tv_sec = *t;
386
    if (set_timeval(&tv) == RT_EOK)
mysterywolf's avatar
mysterywolf 已提交
387
    {
mysterywolf's avatar
mysterywolf 已提交
388
        return 0;
mysterywolf's avatar
mysterywolf 已提交
389 390
    }
    else
391
    {
392
        rt_set_errno(EFAULT);
393
        return -1;
394 395
    }
}
mysterywolf's avatar
update  
mysterywolf 已提交
396
RTM_EXPORT(stime);
397 398 399

time_t timegm(struct tm * const t)
{
400 401
    time_t day;
    time_t i;
402 403 404 405 406
    time_t years;

    if(t == RT_NULL)
    {
        rt_set_errno(EFAULT);
407
        return (time_t)-1;
408
    }
409

410
    years = (time_t)t->tm_year - 70;
还_没_想_好's avatar
还_没_想_好 已提交
411
    if (t->tm_sec > 60)         /* seconds after the minute - [0, 60] including leap second */
412 413 414 415
    {
        t->tm_min += t->tm_sec / 60;
        t->tm_sec %= 60;
    }
还_没_想_好's avatar
还_没_想_好 已提交
416
    if (t->tm_min >= 60)        /* minutes after the hour - [0, 59] */
417 418 419 420
    {
        t->tm_hour += t->tm_min / 60;
        t->tm_min %= 60;
    }
还_没_想_好's avatar
还_没_想_好 已提交
421
    if (t->tm_hour >= 24)       /* hours since midnight - [0, 23] */
422 423 424 425
    {
        t->tm_mday += t->tm_hour / 24;
        t->tm_hour %= 24;
    }
还_没_想_好's avatar
还_没_想_好 已提交
426
    if (t->tm_mon >= 12)        /* months since January - [0, 11] */
427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446
    {
        t->tm_year += t->tm_mon / 12;
        t->tm_mon %= 12;
    }
    while (t->tm_mday > __spm[1 + t->tm_mon])
    {
        if (t->tm_mon == 1 && __isleap(t->tm_year + 1900))
        {
            --t->tm_mday;
        }
        t->tm_mday -= __spm[t->tm_mon];
        ++t->tm_mon;
        if (t->tm_mon > 11)
        {
            t->tm_mon = 0;
            ++t->tm_year;
        }
    }

    if (t->tm_year < 70)
447 448
    {
        rt_set_errno(EINVAL);
449
        return (time_t) -1;
450
    }
451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473

    /* Days since 1970 is 365 * number of years + number of leap years since 1970 */
    day = years * 365 + (years + 1) / 4;

    /* After 2100 we have to substract 3 leap years for every 400 years
     This is not intuitive. Most mktime implementations do not support
     dates after 2059, anyway, so we might leave this out for it's
     bloat. */
    if (years >= 131)
    {
        years -= 131;
        years /= 100;
        day -= (years >> 2) * 3 + 1;
        if ((years &= 3) == 3)
            years--;
        day -= years;
    }

    day += t->tm_yday = __spm[t->tm_mon] + t->tm_mday - 1 +
                        (__isleap(t->tm_year + 1900) & (t->tm_mon > 1));

    /* day is now the number of days since 'Jan 1 1970' */
    i = 7;
474
    t->tm_wday = (int)((day + 4) % i); /* Sunday=0, Monday=1, ..., Saturday=6 */
475 476 477 478 479 480

    i = 24;
    day *= i;
    i = 60;
    return ((day + t->tm_hour) * i + t->tm_min) * i + t->tm_sec;
}
mysterywolf's avatar
update  
mysterywolf 已提交
481
RTM_EXPORT(timegm);
mysterywolf's avatar
mysterywolf 已提交
482 483 484

int gettimeofday(struct timeval *tv, struct timezone *tz)
{
mysterywolf's avatar
mysterywolf 已提交
485 486 487 488 489
    /* The use of the timezone structure is obsolete;
     * the tz argument should normally be specified as NULL.
     * The tz_dsttime field has never been used under Linux.
     * Thus, the following is purely of historic interest.
     */
490 491
    if(tz != RT_NULL)
    {
mysterywolf's avatar
mysterywolf 已提交
492
        tz->tz_dsttime = DST_NONE;
493
        tz->tz_minuteswest = -(tz_get() * 60);
494 495 496
    }

    if (tv != RT_NULL && get_timeval(tv) == RT_EOK)
mysterywolf's avatar
mysterywolf 已提交
497 498 499 500 501
    {
        return 0;
    }
    else
    {
502
        rt_set_errno(EINVAL);
503
        return -1;
mysterywolf's avatar
mysterywolf 已提交
504 505
    }
}
mysterywolf's avatar
update  
mysterywolf 已提交
506
RTM_EXPORT(gettimeofday);
mysterywolf's avatar
mysterywolf 已提交
507 508 509

int settimeofday(const struct timeval *tv, const struct timezone *tz)
{
mysterywolf's avatar
mysterywolf 已提交
510 511 512 513 514 515 516
    /* The use of the timezone structure is obsolete;
     * the tz argument should normally be specified as NULL.
     * The tz_dsttime field has never been used under Linux.
     * Thus, the following is purely of historic interest.
     */
    if (tv != RT_NULL
        && tv->tv_usec >= 0
mysterywolf's avatar
mysterywolf 已提交
517
        && set_timeval((struct timeval *)tv) == RT_EOK)
mysterywolf's avatar
mysterywolf 已提交
518
    {
mysterywolf's avatar
mysterywolf 已提交
519
        return 0;
mysterywolf's avatar
mysterywolf 已提交
520 521 522
    }
    else
    {
mysterywolf's avatar
mysterywolf 已提交
523
        rt_set_errno(EINVAL);
524
        return -1;
mysterywolf's avatar
mysterywolf 已提交
525 526
    }
}
mysterywolf's avatar
update  
mysterywolf 已提交
527
RTM_EXPORT(settimeofday);
528

mysterywolf's avatar
mysterywolf 已提交
529 530 531
#ifdef RT_USING_POSIX_DELAY
int nanosleep(const struct timespec *rqtp, struct timespec *rmtp)
{
G
guo 已提交
532 533 534
    if (rqtp->tv_sec < 0 || rqtp->tv_nsec < 0 || rqtp->tv_nsec >= NANOSECOND_PER_SECOND)
    {
        rt_set_errno(EINVAL);
535
        return -1;
G
guo 已提交
536 537
    }
#ifdef RT_USING_CPUTIME
X
xieyangrun 已提交
538
    double unit = clock_cpu_getres();
539 540 541
    rt_uint64_t ns = rqtp->tv_sec * NANOSECOND_PER_SECOND + rqtp->tv_nsec;
    rt_uint64_t tick = ns / unit;
    rt_cputime_sleep(tick);
G
guo 已提交
542 543 544 545 546

    if (rt_get_errno() == -RT_EINTR)
    {
        if (rmtp)
        {
547
            uint64_t rmtp_cpu_tick = tick - clock_cpu_gettime();
X
xieyangrun 已提交
548 549
            rmtp->tv_sec = ((time_t)(rmtp_cpu_tick * unit)) / NANOSECOND_PER_SECOND;
            rmtp->tv_nsec = ((long)(rmtp_cpu_tick * unit)) % NANOSECOND_PER_SECOND;
G
guo 已提交
550 551
        }
        rt_set_errno(EINTR);
552
        return -1;
G
guo 已提交
553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568
    }
#else
    rt_tick_t tick, tick_old = rt_tick_get();
    tick = rqtp->tv_sec * RT_TICK_PER_SECOND + ((uint64_t)rqtp->tv_nsec * RT_TICK_PER_SECOND) / NANOSECOND_PER_SECOND;
    rt_thread_delay(tick);

    if (rt_get_errno() == -RT_EINTR)
    {
        if (rmtp)
        {
            tick = tick_old + tick - rt_tick_get();
            /* get the passed time */
            rmtp->tv_sec = tick / RT_TICK_PER_SECOND;
            rmtp->tv_nsec = (tick % RT_TICK_PER_SECOND) * (NANOSECOND_PER_SECOND / RT_TICK_PER_SECOND);
        }
        rt_set_errno(EINTR);
569
        return -1;
G
guo 已提交
570 571
    }
#endif
mysterywolf's avatar
mysterywolf 已提交
572 573 574 575 576 577
    return 0;
}
RTM_EXPORT(nanosleep);
#endif /* RT_USING_POSIX_DELAY */

#ifdef RT_USING_POSIX_CLOCK
578 579
#ifdef RT_USING_RTC
static volatile struct timeval _timevalue;
还_没_想_好's avatar
还_没_想_好 已提交
580
static int _rt_clock_time_system_init(void)
581
{
582
    rt_base_t level;
583
    time_t time = 0;
584 585 586 587 588 589 590
    rt_tick_t tick;
    rt_device_t device;

    device = rt_device_find("rtc");
    if (device != RT_NULL)
    {
        /* get realtime seconds */
591 592 593 594 595 596 597 598 599
        if(rt_device_control(device, RT_DEVICE_CTRL_RTC_GET_TIME, &time) == RT_EOK)
        {
            level = rt_hw_interrupt_disable();
            tick = rt_tick_get(); /* get tick */
            _timevalue.tv_usec = (tick%RT_TICK_PER_SECOND) * MICROSECOND_PER_TICK;
            _timevalue.tv_sec = time - tick/RT_TICK_PER_SECOND - 1;
            rt_hw_interrupt_enable(level);
            return 0;
        }
600 601
    }

602 603 604 605
    level = rt_hw_interrupt_disable();
    _timevalue.tv_usec = 0;
    _timevalue.tv_sec = 0;
    rt_hw_interrupt_enable(level);
606

607
    return -1;
608
}
609 610
INIT_COMPONENT_EXPORT(_rt_clock_time_system_init);
#endif /* RT_USING_RTC */
611 612 613

int clock_getres(clockid_t clockid, struct timespec *res)
{
614
#ifndef RT_USING_RTC
615
    LOG_W(_WARNING_NO_RTC);
616
    return -1;
617
#else
618 619 620 621
    int ret = 0;

    if (res == RT_NULL)
    {
622
        rt_set_errno(EFAULT);
623
        return -1;
624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640
    }

    switch (clockid)
    {
    case CLOCK_REALTIME:
        res->tv_sec = 0;
        res->tv_nsec = NANOSECOND_PER_SECOND/RT_TICK_PER_SECOND;
        break;

#ifdef RT_USING_CPUTIME
    case CLOCK_CPUTIME_ID:
        res->tv_sec  = 0;
        res->tv_nsec = clock_cpu_getres();
        break;
#endif

    default:
641 642
        res->tv_sec  = 0;
        res->tv_nsec = 0;
643
        ret = -1;
644 645 646 647 648
        rt_set_errno(EINVAL);
        break;
    }

    return ret;
649
#endif /* RT_USING_RTC */
650 651 652 653 654
}
RTM_EXPORT(clock_getres);

int clock_gettime(clockid_t clockid, struct timespec *tp)
{
655
#ifndef RT_USING_RTC
656
    LOG_W(_WARNING_NO_RTC);
657
    return -1;
658
#else
659 660 661 662
    int ret = 0;

    if (tp == RT_NULL)
    {
663
        rt_set_errno(EFAULT);
664
        return -1;
665 666 667 668 669 670
    }

    switch (clockid)
    {
    case CLOCK_REALTIME:
        {
X
xieyangrun 已提交
671
            rt_tick_t tick;
672
            rt_base_t level;
673

674 675
            level = rt_hw_interrupt_disable();
            tick = rt_tick_get(); /* get tick */
676 677
            tp->tv_sec  = _timevalue.tv_sec + tick / RT_TICK_PER_SECOND;
            tp->tv_nsec = (_timevalue.tv_usec + (tick % RT_TICK_PER_SECOND) * MICROSECOND_PER_TICK) * 1000;
678
            rt_hw_interrupt_enable(level);
679 680 681 682
        }
        break;

#ifdef RT_USING_CPUTIME
X
xieyangrun 已提交
683
    case CLOCK_MONOTONIC:
684 685
    case CLOCK_CPUTIME_ID:
        {
X
xieyangrun 已提交
686 687
            double unit = 0;
            uint64_t cpu_tick;
688 689 690 691

            unit = clock_cpu_getres();
            cpu_tick = clock_cpu_gettime();

X
xieyangrun 已提交
692 693
            tp->tv_sec  = ((uint64_t)(cpu_tick * unit)) / NANOSECOND_PER_SECOND;
            tp->tv_nsec = ((uint64_t)(cpu_tick * unit)) % NANOSECOND_PER_SECOND;
694 695 696 697
        }
        break;
#endif
    default:
698 699
        tp->tv_sec  = 0;
        tp->tv_nsec = 0;
700
        rt_set_errno(EINVAL);
701
        ret = -1;
702 703 704
    }

    return ret;
705
#endif /* RT_USING_RTC */
706 707 708
}
RTM_EXPORT(clock_gettime);

709 710
int clock_nanosleep(clockid_t clockid, int flags, const struct timespec *rqtp, struct timespec *rmtp)
{
G
guo 已提交
711 712
#ifndef RT_USING_RTC
    LOG_W(_WARNING_NO_RTC);
713
    return -1;
G
guo 已提交
714 715
#else
    if (rqtp->tv_sec < 0 || rqtp->tv_nsec < 0 || rqtp->tv_nsec >= NANOSECOND_PER_SECOND)
716 717
    {
        rt_set_errno(EINVAL);
718
        return -1;
719
    }
G
guo 已提交
720 721 722 723 724
    switch (clockid)
    {
    case CLOCK_REALTIME:
    {
        rt_tick_t tick, tick_old = rt_tick_get();
725
        if ((flags & TIMER_ABSTIME) == TIMER_ABSTIME)
G
guo 已提交
726
        {
Z
zhkag 已提交
727 728 729
            rt_int64_t ts = ((rqtp->tv_sec - _timevalue.tv_sec) * RT_TICK_PER_SECOND);
            rt_int64_t tns = (rqtp->tv_nsec - _timevalue.tv_usec * 1000) * (RT_TICK_PER_SECOND / NANOSECOND_PER_SECOND);
            tick = ts + tns;
G
guo 已提交
730 731 732 733 734 735 736 737
            rt_tick_t rt_tick = rt_tick_get();
            tick = tick < rt_tick ? 0 : tick - rt_tick;
        }
        else
        {
            tick = rqtp->tv_sec * RT_TICK_PER_SECOND + ((uint64_t)(rqtp->tv_nsec) * RT_TICK_PER_SECOND) / NANOSECOND_PER_SECOND;
        }
        rt_thread_delay(tick);
X
xieyangrun 已提交
738

G
guo 已提交
739 740 741 742 743 744 745 746 747 748
        if (rt_get_errno() == -RT_EINTR)
        {
            if (rmtp)
            {
                tick = tick_old + tick - rt_tick_get();
                /* get the passed time */
                rmtp->tv_sec = tick / RT_TICK_PER_SECOND;
                rmtp->tv_nsec = (tick % RT_TICK_PER_SECOND) * (NANOSECOND_PER_SECOND / RT_TICK_PER_SECOND);
            }
            rt_set_errno(EINTR);
749
            return -1;
G
guo 已提交
750 751 752
        }
    }
    break;
753

G
guo 已提交
754 755 756 757
#ifdef RT_USING_CPUTIME
    case CLOCK_MONOTONIC:
    case CLOCK_CPUTIME_ID:
    {
758
        rt_uint64_t cpu_tick_old = clock_cpu_gettime();
X
xieyangrun 已提交
759
        double unit = clock_cpu_getres();
760 761
        rt_uint64_t ns = rqtp->tv_sec * NANOSECOND_PER_SECOND + rqtp->tv_nsec;
        rt_uint64_t tick = ns / unit;
762
        if ((flags & TIMER_ABSTIME) == TIMER_ABSTIME)
763 764
            tick -= cpu_tick_old;
        rt_cputime_sleep(tick);
G
guo 已提交
765 766 767 768 769

        if (rt_get_errno() == -RT_EINTR)
        {
            if (rmtp)
            {
770
                uint64_t rmtp_cpu_tick = tick - clock_cpu_gettime();
X
xieyangrun 已提交
771 772
                rmtp->tv_sec = ((time_t)(rmtp_cpu_tick * unit)) / NANOSECOND_PER_SECOND;
                rmtp->tv_nsec = ((long)(rmtp_cpu_tick * unit)) % NANOSECOND_PER_SECOND;
G
guo 已提交
773 774
            }
            rt_set_errno(EINTR);
775
            return -1;
G
guo 已提交
776 777 778 779 780 781
        }
    }
    break;
#endif
    default:
        rt_set_errno(EINVAL);
782
        return -1;
G
guo 已提交
783 784 785
    }
    return 0;
#endif
786
}
G
guo 已提交
787
RTM_EXPORT(clock_nanosleep);
788

789 790
int clock_settime(clockid_t clockid, const struct timespec *tp)
{
791
#ifndef RT_USING_RTC
792
    LOG_W(_WARNING_NO_RTC);
793
    return -1;
794
#else
795
    rt_base_t level;
796 797 798 799 800 801
    int second;
    rt_tick_t tick;
    rt_device_t device;

    if ((clockid != CLOCK_REALTIME) || (tp == RT_NULL))
    {
802
        rt_set_errno(EFAULT);
803
        return -1;
804 805 806 807 808
    }

    /* get second */
    second = tp->tv_sec;

809 810
    level = rt_hw_interrupt_disable();
    tick = rt_tick_get(); /* get tick */
811 812
    /* update timevalue */
    _timevalue.tv_usec = MICROSECOND_PER_SECOND - (tick % RT_TICK_PER_SECOND) * MICROSECOND_PER_TICK;
X
xieyangrun 已提交
813
    _timevalue.tv_sec = second - tick / RT_TICK_PER_SECOND - 1;
814
    rt_hw_interrupt_enable(level);
815 816 817 818 819 820

    /* update for RTC device */
    device = rt_device_find("rtc");
    if (device != RT_NULL)
    {
        /* set realtime seconds */
821 822 823 824
        if(rt_device_control(device, RT_DEVICE_CTRL_RTC_SET_TIME, &second) == RT_EOK)
        {
            return 0;
        }
825 826
    }

827
    return -1;
828
#endif /* RT_USING_RTC */
829 830
}
RTM_EXPORT(clock_settime);
mysterywolf's avatar
mysterywolf 已提交
831

832
int rt_timespec_to_tick(const struct timespec *time)
mysterywolf's avatar
mysterywolf 已提交
833 834 835
{
    int tick;
    int nsecond, second;
836
    struct timespec tp = {0};
mysterywolf's avatar
mysterywolf 已提交
837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862

    RT_ASSERT(time != RT_NULL);

    tick = RT_WAITING_FOREVER;
    if (time != NULL)
    {
        /* get current tp */
        clock_gettime(CLOCK_REALTIME, &tp);

        if ((time->tv_nsec - tp.tv_nsec) < 0)
        {
            nsecond = NANOSECOND_PER_SECOND - (tp.tv_nsec - time->tv_nsec);
            second  = time->tv_sec - tp.tv_sec - 1;
        }
        else
        {
            nsecond = time->tv_nsec - tp.tv_nsec;
            second  = time->tv_sec - tp.tv_sec;
        }

        tick = second * RT_TICK_PER_SECOND + nsecond * RT_TICK_PER_SECOND / NANOSECOND_PER_SECOND;
        if (tick < 0) tick = 0;
    }

    return tick;
}
863
RTM_EXPORT(rt_timespec_to_tick);
mysterywolf's avatar
mysterywolf 已提交
864

865 866
#endif /* RT_USING_POSIX_CLOCK */

X
xiangxistu 已提交
867 868 869 870 871 872 873
#ifdef RT_USING_POSIX_TIMER

#define ACTIVE 1
#define NOT_ACTIVE 0

struct timer_obj
{
874 875 876 877 878 879 880
    union
    {
        struct rt_timer timer;
#ifdef RT_USING_CPUTIME
        struct rt_cputimer cputimer;
#endif
    };
X
xiangxistu 已提交
881 882 883
    void (*sigev_notify_function)(union sigval val);
    union sigval val;
    struct timespec interval;              /* Reload value */
G
guo 已提交
884
    struct timespec value;                 /* Reload value */
885
    rt_uint64_t reload;                    /* Reload value in ms */
X
xiangxistu 已提交
886
    rt_uint32_t status;
G
guo 已提交
887
    int sigev_signo;
888
    clockid_t clockid;
889
#ifdef RT_USING_SMART
G
guo 已提交
890 891
    pid_t pid;
#endif
X
xiangxistu 已提交
892 893 894 895 896 897 898 899 900 901 902 903 904
};

static void rtthread_timer_wrapper(void *timerobj)
{
    struct timer_obj *timer;

    timer = (struct timer_obj *)timerobj;

    if (timer->reload == 0U)
    {
        timer->status = NOT_ACTIVE;
    }

905 906 907 908 909 910 911 912 913 914 915 916 917 918
#ifdef RT_USING_CPUTIME
    if (timer->clockid == CLOCK_CPUTIME_ID && clock_cpu_issettimeout())
    {
        timer->reload = (timer->interval.tv_sec * NANOSECOND_PER_SECOND + timer->interval.tv_nsec) / clock_cpu_getres();
        if (timer->reload)
            rt_cputimer_control(&timer->cputimer, RT_TIMER_CTRL_SET_TIME, &(timer->reload));
    }
    else
#endif /* RT_USING_CPUTIME */
    {
        timer->reload = (timer->interval.tv_sec * RT_TICK_PER_SECOND) + (timer->interval.tv_nsec * RT_TICK_PER_SECOND) / NANOSECOND_PER_SECOND;
        if (timer->reload)
            rt_timer_control(&timer->timer, RT_TIMER_CTRL_SET_TIME, &(timer->reload));
    }
G
guo 已提交
919

920
#ifdef RT_USING_SMART
G
guo 已提交
921 922
    sys_kill(timer->pid, timer->sigev_signo);
#else
X
xiangxistu 已提交
923 924 925 926
    if(timer->sigev_notify_function != RT_NULL)
    {
        (timer->sigev_notify_function)(timer->val);
    }
G
guo 已提交
927
#endif
X
xiangxistu 已提交
928 929
}

Z
zhkag 已提交
930 931 932
#define TIMER_ID_MAX 50
static struct timer_obj *_g_timerid[TIMER_ID_MAX];
static int timerid_idx = 0;
Z
zhkag 已提交
933
RT_DEFINE_SPINLOCK(_timer_id_lock);
Z
zhkag 已提交
934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959

void timer_id_init(void)
{
    for (int i = 0; i < TIMER_ID_MAX; i++)
    {
        _g_timerid[i] = NULL;
    }
    timerid_idx = 0;
}

int timer_id_alloc(void)
{
    for (int i = 0; i < timerid_idx; i++)
    {
        if (_g_timerid[i] == NULL)
            return i;
    }
    if (timerid_idx < TIMER_ID_MAX)
    {
        timerid_idx++;
        return timerid_idx; /* todo */
    }

    return -1;
}

Z
zhkag 已提交
960 961 962 963 964 965 966 967 968 969
void timer_id_lock()
{
    rt_hw_spin_lock(&_timer_id_lock);
}

void timer_id_unlock()
{
    rt_hw_spin_unlock(&_timer_id_lock);
}

970
struct timer_obj *timer_id_get(rt_ubase_t timerid)
Z
zhkag 已提交
971 972
{
    struct timer_obj *timer;
973 974 975 976 977 978

    if (timerid < 0 || timerid >= TIMER_ID_MAX)
    {
        return NULL;
    }

Z
zhkag 已提交
979 980 981 982
    timer_id_lock();
    if (_g_timerid[timerid] == NULL)
    {
        timer_id_unlock();
Z
zhkag 已提交
983
        LOG_E("can not find timer!");
Z
zhkag 已提交
984 985 986 987 988 989 990 991 992 993 994 995 996 997
        return NULL;
    }
    timer = _g_timerid[timerid];
    timer_id_unlock();
    return timer;
}

int timer_id_put(int id)
{
    if (_g_timerid[id] == NULL)
        return -1;
    _g_timerid[id] = NULL;
    return 0;
}
X
xiangxistu 已提交
998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008
/**
 * @brief Create a per-process timer.
 *
 * This API does not accept SIGEV_THREAD as valid signal event notification
 * type.
 *
 * See IEEE 1003.1
 */
int timer_create(clockid_t clockid, struct sigevent *evp, timer_t *timerid)
{
    static int num = 0;
Z
zhkag 已提交
1009
    int _timerid = 0;
X
xiangxistu 已提交
1010 1011 1012
    struct timer_obj *timer;
    char timername[RT_NAME_MAX] = {0};

G
guo 已提交
1013
    if (clockid > CLOCK_ID_MAX ||
X
xiangxistu 已提交
1014 1015 1016 1017
        (evp->sigev_notify != SIGEV_NONE &&
         evp->sigev_notify != SIGEV_SIGNAL))
    {
        rt_set_errno(EINVAL);
1018
        return -1;
X
xiangxistu 已提交
1019 1020 1021 1022 1023 1024
    }

    timer = rt_malloc(sizeof(struct timer_obj));
    if(timer == RT_NULL)
    {
        rt_set_errno(ENOMEM);
1025
        return -1;
X
xiangxistu 已提交
1026 1027 1028 1029
    }

    rt_snprintf(timername, RT_NAME_MAX, "psx_tm%02d", num++);
    num %= 100;
G
guo 已提交
1030
    timer->sigev_signo = evp->sigev_signo;
1031
#ifdef RT_USING_SMART
G
guo 已提交
1032 1033
    timer->pid = lwp_self()->pid;
#endif
X
xiangxistu 已提交
1034 1035 1036 1037 1038 1039
    timer->sigev_notify_function = evp->sigev_notify_function;
    timer->val = evp->sigev_value;
    timer->interval.tv_sec = 0;
    timer->interval.tv_nsec = 0;
    timer->reload = 0U;
    timer->status = NOT_ACTIVE;
1040
    timer->clockid = clockid;
X
xiangxistu 已提交
1041

1042 1043
#ifdef RT_USING_CPUTIME
    if (timer->clockid == CLOCK_CPUTIME_ID && clock_cpu_issettimeout())
X
xiangxistu 已提交
1044
    {
1045
        rt_cputimer_init(&timer->cputimer, timername, rtthread_timer_wrapper, timer, 0, RT_TIMER_FLAG_ONE_SHOT | RT_TIMER_FLAG_SOFT_TIMER);
X
xiangxistu 已提交
1046 1047
    }
    else
1048
#endif /* RT_USING_CPUTIME */
X
xiangxistu 已提交
1049
    {
1050 1051 1052 1053
        if (evp->sigev_notify == SIGEV_NONE)
            rt_timer_init(&timer->timer, timername, RT_NULL, RT_NULL, 0, RT_TIMER_FLAG_ONE_SHOT | RT_TIMER_FLAG_SOFT_TIMER);
        else
            rt_timer_init(&timer->timer, timername, rtthread_timer_wrapper, timer, 0, RT_TIMER_FLAG_ONE_SHOT | RT_TIMER_FLAG_SOFT_TIMER);
X
xiangxistu 已提交
1054 1055
    }

Z
zhkag 已提交
1056 1057 1058 1059
    timer_id_lock();
    _timerid = timer_id_alloc();
    if (_timerid < 0)
    {
Z
zhkag 已提交
1060
        timer_id_unlock();
Z
zhkag 已提交
1061 1062 1063 1064
        LOG_E("_timerid overflow!");
        return -1; /* todo:memory leak */
    }
    _g_timerid[_timerid] = timer;
G
guozhanxin 已提交
1065
    *timerid = (timer_t)(rt_ubase_t)_timerid;
Z
zhkag 已提交
1066
    timer_id_unlock();
X
xiangxistu 已提交
1067

1068
    return 0;
X
xiangxistu 已提交
1069 1070 1071 1072 1073 1074 1075 1076 1077 1078
}
RTM_EXPORT(timer_create);

/**
 * @brief Delete a per-process timer.
 *
 * See IEEE 1003.1
 */
int timer_delete(timer_t timerid)
{
Z
zhkag 已提交
1079
    struct timer_obj *timer;
1080 1081 1082 1083 1084 1085 1086 1087 1088 1089
    rt_ubase_t ktimerid;

    ktimerid = (rt_ubase_t)timerid;

    if (ktimerid < 0 || ktimerid >= TIMER_ID_MAX)
    {
        rt_set_errno(EINVAL);
        return -1;
    }

Z
zhkag 已提交
1090
    timer_id_lock();
1091
    if (_g_timerid[ktimerid] == NULL)
Z
zhkag 已提交
1092 1093
    {
        timer_id_unlock();
Z
zhkag 已提交
1094 1095
        rt_set_errno(EINVAL);
        LOG_E("can not find timer!");
Z
zhkag 已提交
1096 1097
        return -1;
    }
1098 1099
    timer = _g_timerid[ktimerid];
    timer_id_put(ktimerid);
Z
zhkag 已提交
1100
    timer_id_unlock();
1101
    if (timer == RT_NULL)
X
xiangxistu 已提交
1102 1103
    {
        rt_set_errno(EINVAL);
1104
        return -1;
X
xiangxistu 已提交
1105 1106
    }

1107 1108
#ifdef RT_USING_CPUTIME
    if (timer->clockid == CLOCK_CPUTIME_ID && clock_cpu_issettimeout())
X
xiangxistu 已提交
1109
    {
1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125
        if (timer->status == ACTIVE)
        {
            timer->status = NOT_ACTIVE;
            rt_cputimer_stop(&timer->cputimer);
        }
        rt_cputimer_detach(&timer->cputimer);
    }
    else
#endif /* RT_USING_CPUTIME */
    {
        if (timer->status == ACTIVE)
        {
            timer->status = NOT_ACTIVE;
            rt_timer_stop(&timer->timer);
        }
        rt_timer_detach(&timer->timer);
X
xiangxistu 已提交
1126 1127 1128
    }
    rt_free(timer);

1129
    return 0;
X
xiangxistu 已提交
1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140
}
RTM_EXPORT(timer_delete);

/**
 *
 *  Return the overrun count for the last timer expiration.
 *  It is subefficient to create a new structure to get overrun count.
 **/
int timer_getoverrun(timer_t timerid)
{
    rt_set_errno(ENOSYS);
1141
    return -1;
X
xiangxistu 已提交
1142 1143 1144 1145 1146 1147 1148 1149 1150
}

/**
 * @brief Get amount of time left for expiration on a per-process timer.
 *
 * See IEEE 1003.1
 */
int timer_gettime(timer_t timerid, struct itimerspec *its)
{
1151
    struct timer_obj *timer;
X
xiangxistu 已提交
1152 1153
    rt_uint32_t seconds, nanoseconds;

1154 1155
    timer = timer_id_get((rt_ubase_t)timerid);

1156
    if (timer == NULL)
X
xiangxistu 已提交
1157 1158
    {
        rt_set_errno(EINVAL);
1159
        return -1;
X
xiangxistu 已提交
1160 1161 1162 1163 1164
    }

    if (its == NULL)
    {
        rt_set_errno(EFAULT);
1165
        return -1;
X
xiangxistu 已提交
1166 1167 1168 1169
    }

    if (timer->status == ACTIVE)
    {
1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208
#ifdef RT_USING_CPUTIME
        if (timer->clockid == CLOCK_CPUTIME_ID && clock_cpu_issettimeout())
        {
            rt_uint64_t remain_tick;
            rt_uint64_t remaining;
            rt_cputimer_control(&timer->cputimer, RT_TIMER_CTRL_GET_REMAIN_TIME, &remain_tick);
            remaining = (remain_tick - clock_cpu_gettime()) / clock_cpu_getres();
            seconds = remaining / NANOSECOND_PER_SECOND;
            nanoseconds = remaining % NANOSECOND_PER_SECOND;
        }
        else
#endif /* RT_USING_CPUTIME */
        {
            rt_tick_t remain_tick;
            rt_tick_t remaining;

            rt_timer_control(&timer->timer, RT_TIMER_CTRL_GET_REMAIN_TIME, &remain_tick);

            /* 'remain_tick' is minimum-unit in the RT-Thread' timer,
            * so the seconds, nanoseconds will be calculated by 'remain_tick'.
            */
            remaining = remain_tick - rt_tick_get();

            /* calculate 'second' */
            seconds = remaining / RT_TICK_PER_SECOND;

            /* calculate 'nanosecond';  To avoid lost of accuracy, because "RT_TICK_PER_SECOND" maybe 100, 1000, 1024 and so on.
            *
            *        remain_tick                  millisecond                                 remain_tick * MILLISECOND_PER_SECOND
            *  ------------------------- = --------------------------  --->  millisecond = -------------------------------------------
            *    RT_TICK_PER_SECOND          MILLISECOND_PER_SECOND                                RT_TICK_PER_SECOND
            *
            *                    remain_tick * MILLISECOND_PER_SECOND                          remain_tick * MILLISECOND_PER_SECOND * MICROSECOND_PER_SECOND
            *   millisecond = ----------------------------------------  ---> nanosecond = -------------------------------------------------------------------
            *                         RT_TICK_PER_SECOND                                                           RT_TICK_PER_SECOND
            *
            */
            nanoseconds = (((remaining % RT_TICK_PER_SECOND) * MILLISECOND_PER_SECOND) * MICROSECOND_PER_SECOND) / RT_TICK_PER_SECOND;
        }
X
xiangxistu 已提交
1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220
        its->it_value.tv_sec = (rt_int32_t)seconds;
        its->it_value.tv_nsec = (rt_int32_t)nanoseconds;
    }
    else
    {
        /* Timer is disarmed */
        its->it_value.tv_sec = 0;
        its->it_value.tv_nsec = 0;
    }

    /* The interval last set by timer_settime() */
    its->it_interval = timer->interval;
1221
    return 0;
X
xiangxistu 已提交
1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232
}
RTM_EXPORT(timer_gettime);

/**
 * @brief Sets expiration time of per-process timer.
 *
 * See IEEE 1003.1
 */
int timer_settime(timer_t timerid, int flags, const struct itimerspec *value,
                  struct itimerspec *ovalue)
{
Z
zhkag 已提交
1233
    struct timer_obj *timer = timer_id_get((rt_ubase_t)timerid);
X
xiangxistu 已提交
1234 1235 1236
    if (timer == NULL ||
        value->it_interval.tv_nsec < 0 ||
        value->it_interval.tv_nsec >= NANOSECOND_PER_SECOND ||
G
guo 已提交
1237
        value->it_interval.tv_sec < 0 ||
X
xiangxistu 已提交
1238
        value->it_value.tv_nsec < 0 ||
G
guo 已提交
1239 1240
        value->it_value.tv_nsec >= NANOSECOND_PER_SECOND ||
        value->it_value.tv_sec < 0)
X
xiangxistu 已提交
1241 1242
    {
        rt_set_errno(EINVAL);
1243
        return -1;
X
xiangxistu 已提交
1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256
    }

    /*  Save time to expire and old reload value. */
    if (ovalue != NULL)
    {
        timer_gettime(timerid, ovalue);
    }

    /* Stop the timer if the value is 0 */
    if ((value->it_value.tv_sec == 0) && (value->it_value.tv_nsec == 0))
    {
        if (timer->status == ACTIVE)
        {
1257 1258 1259 1260 1261 1262
#ifdef RT_USING_CPUTIME
            if (timer->clockid == CLOCK_CPUTIME_ID && clock_cpu_issettimeout())
                rt_cputimer_stop(&timer->cputimer);
            else
#endif /* RT_USING_CPUTIME */
                rt_timer_stop(&timer->timer);
X
xiangxistu 已提交
1263 1264 1265
        }

        timer->status = NOT_ACTIVE;
1266
        return 0;
X
xiangxistu 已提交
1267 1268 1269 1270 1271 1272 1273 1274 1275
    }

    /* calculate timer period(tick);  To avoid lost of accuracy, because "RT_TICK_PER_SECOND" maybe 100, 1000, 1024 and so on.
        *
        *          tick                        nanosecond                          nanosecond * RT_TICK_PER_SECOND
        *  ------------------------- = --------------------------  --->  tick = -------------------------------------
        *    RT_TICK_PER_SECOND           NANOSECOND_PER_SECOND                         NANOSECOND_PER_SECOND
        *
        */
1276 1277
#ifdef RT_USING_CPUTIME
    if (timer->clockid == CLOCK_CPUTIME_ID && clock_cpu_issettimeout())
G
guo 已提交
1278
    {
1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293
        rt_uint64_t tick;
        double unit = clock_cpu_getres();

        tick = (value->it_value.tv_sec * NANOSECOND_PER_SECOND + value->it_value.tv_nsec) / unit;
        if ((flags & TIMER_ABSTIME) == TIMER_ABSTIME)
        {
            tick -= clock_cpu_gettime();
        }
        timer->reload = tick;
    }
    else
#endif /* RT_USING_CPUTIME */
    {
        if ((flags & TIMER_ABSTIME) == TIMER_ABSTIME)
        {
G
guo 已提交
1294
#ifndef RT_USING_RTC
1295 1296
            LOG_W(_WARNING_NO_RTC);
            return -1;
G
guo 已提交
1297
#else
1298 1299 1300 1301 1302 1303
                rt_int64_t ts = ((value->it_value.tv_sec - _timevalue.tv_sec) * RT_TICK_PER_SECOND);
                rt_int64_t tns = (value->it_value.tv_nsec - _timevalue.tv_usec * 1000) * (RT_TICK_PER_SECOND / NANOSECOND_PER_SECOND);
                rt_int64_t reload = ts + tns;
                rt_tick_t rt_tick = rt_tick_get();

                timer->reload = reload < rt_tick ? 0 : reload - rt_tick;
G
guo 已提交
1304
#endif
1305 1306 1307
        }
        else
            timer->reload = (value->it_value.tv_sec * RT_TICK_PER_SECOND) + value->it_value.tv_nsec * (RT_TICK_PER_SECOND / NANOSECOND_PER_SECOND);
G
guo 已提交
1308
    }
X
xiangxistu 已提交
1309 1310
    timer->interval.tv_sec = value->it_interval.tv_sec;
    timer->interval.tv_nsec = value->it_interval.tv_nsec;
G
guo 已提交
1311 1312
    timer->value.tv_sec = value->it_value.tv_sec;
    timer->value.tv_nsec = value->it_value.tv_nsec;
X
xiangxistu 已提交
1313 1314 1315

    if (timer->status == ACTIVE)
    {
1316 1317 1318 1319 1320 1321
#ifdef RT_USING_CPUTIME
        if (timer->clockid == CLOCK_CPUTIME_ID && clock_cpu_issettimeout())
            rt_cputimer_stop(&timer->cputimer);
        else
#endif /* RT_USING_CPUTIME */
            rt_timer_stop(&timer->timer);
X
xiangxistu 已提交
1322 1323 1324
    }

    timer->status = ACTIVE;
G
guo 已提交
1325

1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336
#ifdef RT_USING_CPUTIME
    if (timer->clockid == CLOCK_CPUTIME_ID && clock_cpu_issettimeout())
    {
        if ((value->it_interval.tv_sec == 0) && (value->it_interval.tv_nsec == 0))
            rt_cputimer_control(&timer->cputimer, RT_TIMER_CTRL_SET_ONESHOT, RT_NULL);
        else
            rt_cputimer_control(&timer->cputimer, RT_TIMER_CTRL_SET_PERIODIC, RT_NULL);

        rt_cputimer_control(&timer->cputimer, RT_TIMER_CTRL_SET_TIME, &(timer->reload));
        rt_cputimer_start(&timer->cputimer);
    }
G
guo 已提交
1337
    else
1338 1339 1340 1341 1342 1343
#endif /* RT_USING_CPUTIME */
    {
        if ((value->it_interval.tv_sec == 0) && (value->it_interval.tv_nsec == 0))
            rt_timer_control(&timer->timer, RT_TIMER_CTRL_SET_ONESHOT, RT_NULL);
        else
            rt_timer_control(&timer->timer, RT_TIMER_CTRL_SET_PERIODIC, RT_NULL);
G
guo 已提交
1344

1345 1346 1347
        rt_timer_control(&timer->timer, RT_TIMER_CTRL_SET_TIME, &(timer->reload));
        rt_timer_start(&timer->timer);
    }
X
xiangxistu 已提交
1348

1349
    return 0;
X
xiangxistu 已提交
1350 1351 1352 1353 1354
}
RTM_EXPORT(timer_settime);
#endif /* RT_USING_POSIX_TIMER */


1355 1356 1357 1358 1359 1360 1361 1362 1363
/* timezone */
#ifndef RT_LIBC_DEFAULT_TIMEZONE
#define RT_LIBC_DEFAULT_TIMEZONE    8
#endif

static volatile int8_t _current_timezone = RT_LIBC_DEFAULT_TIMEZONE;

void tz_set(int8_t tz)
{
1364
    rt_base_t level;
1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378
    level = rt_hw_interrupt_disable();
    _current_timezone = tz;
    rt_hw_interrupt_enable(level);
}

int8_t tz_get(void)
{
    return _current_timezone;
}

int8_t tz_is_dst(void)
{
    return 0;
}