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
    tv.tv_usec = 0;
387
    if (set_timeval(&tv) == RT_EOK)
mysterywolf's avatar
mysterywolf 已提交
388
    {
mysterywolf's avatar
mysterywolf 已提交
389
        return 0;
mysterywolf's avatar
mysterywolf 已提交
390 391
    }
    else
392
    {
393
        rt_set_errno(EFAULT);
394
        return -1;
395 396
    }
}
mysterywolf's avatar
update  
mysterywolf 已提交
397
RTM_EXPORT(stime);
398 399 400

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

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

411
    years = (time_t)t->tm_year - 70;
还_没_想_好's avatar
还_没_想_好 已提交
412
    if (t->tm_sec > 60)         /* seconds after the minute - [0, 60] including leap second */
413 414 415 416
    {
        t->tm_min += t->tm_sec / 60;
        t->tm_sec %= 60;
    }
还_没_想_好's avatar
还_没_想_好 已提交
417
    if (t->tm_min >= 60)        /* minutes after the hour - [0, 59] */
418 419 420 421
    {
        t->tm_hour += t->tm_min / 60;
        t->tm_min %= 60;
    }
还_没_想_好's avatar
还_没_想_好 已提交
422
    if (t->tm_hour >= 24)       /* hours since midnight - [0, 23] */
423 424 425 426
    {
        t->tm_mday += t->tm_hour / 24;
        t->tm_hour %= 24;
    }
还_没_想_好's avatar
还_没_想_好 已提交
427
    if (t->tm_mon >= 12)        /* months since January - [0, 11] */
428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447
    {
        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)
448 449
    {
        rt_set_errno(EINVAL);
450
        return (time_t) -1;
451
    }
452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474

    /* 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;
475
    t->tm_wday = (int)((day + 4) % i); /* Sunday=0, Monday=1, ..., Saturday=6 */
476 477 478 479 480 481

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

int gettimeofday(struct timeval *tv, struct timezone *tz)
{
mysterywolf's avatar
mysterywolf 已提交
486 487 488 489 490
    /* 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.
     */
491 492
    if(tz != RT_NULL)
    {
mysterywolf's avatar
mysterywolf 已提交
493
        tz->tz_dsttime = DST_NONE;
494
        tz->tz_minuteswest = -(tz_get() * 60);
495 496 497
    }

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

int settimeofday(const struct timeval *tv, const struct timezone *tz)
{
mysterywolf's avatar
mysterywolf 已提交
511 512 513 514 515 516 517
    /* 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 已提交
518
        && set_timeval((struct timeval *)tv) == RT_EOK)
mysterywolf's avatar
mysterywolf 已提交
519
    {
mysterywolf's avatar
mysterywolf 已提交
520
        return 0;
mysterywolf's avatar
mysterywolf 已提交
521 522 523
    }
    else
    {
mysterywolf's avatar
mysterywolf 已提交
524
        rt_set_errno(EINVAL);
525
        return -1;
mysterywolf's avatar
mysterywolf 已提交
526 527
    }
}
mysterywolf's avatar
update  
mysterywolf 已提交
528
RTM_EXPORT(settimeofday);
529

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

    if (rt_get_errno() == -RT_EINTR)
    {
        if (rmtp)
        {
548
            uint64_t rmtp_cpu_tick = tick - clock_cpu_gettime();
X
xieyangrun 已提交
549 550
            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 已提交
551 552
        }
        rt_set_errno(EINTR);
553
        return -1;
G
guo 已提交
554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569
    }
#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);
570
        return -1;
G
guo 已提交
571 572
    }
#endif
mysterywolf's avatar
mysterywolf 已提交
573 574 575 576 577 578
    return 0;
}
RTM_EXPORT(nanosleep);
#endif /* RT_USING_POSIX_DELAY */

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

    device = rt_device_find("rtc");
    if (device != RT_NULL)
    {
        /* get realtime seconds */
592 593 594 595 596 597 598 599 600
        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;
        }
601 602
    }

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

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

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

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

    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:
642 643
        res->tv_sec  = 0;
        res->tv_nsec = 0;
644
        ret = -1;
645 646 647 648 649
        rt_set_errno(EINVAL);
        break;
    }

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

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

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

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

675 676
            level = rt_hw_interrupt_disable();
            tick = rt_tick_get(); /* get tick */
677 678
            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;
679
            rt_hw_interrupt_enable(level);
680 681 682 683
        }
        break;

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

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

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

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

710 711
int clock_nanosleep(clockid_t clockid, int flags, const struct timespec *rqtp, struct timespec *rmtp)
{
G
guo 已提交
712 713
#ifndef RT_USING_RTC
    LOG_W(_WARNING_NO_RTC);
714
    return -1;
G
guo 已提交
715 716
#else
    if (rqtp->tv_sec < 0 || rqtp->tv_nsec < 0 || rqtp->tv_nsec >= NANOSECOND_PER_SECOND)
717 718
    {
        rt_set_errno(EINVAL);
719
        return -1;
720
    }
G
guo 已提交
721 722 723 724 725
    switch (clockid)
    {
    case CLOCK_REALTIME:
    {
        rt_tick_t tick, tick_old = rt_tick_get();
726
        if ((flags & TIMER_ABSTIME) == TIMER_ABSTIME)
G
guo 已提交
727
        {
Z
zhkag 已提交
728 729 730
            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 已提交
731 732 733 734 735 736 737 738
            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 已提交
739

G
guo 已提交
740 741 742 743 744 745 746 747 748 749
        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);
750
            return -1;
G
guo 已提交
751 752 753
        }
    }
    break;
754

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

        if (rt_get_errno() == -RT_EINTR)
        {
            if (rmtp)
            {
771
                uint64_t rmtp_cpu_tick = tick - clock_cpu_gettime();
X
xieyangrun 已提交
772 773
                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 已提交
774 775
            }
            rt_set_errno(EINTR);
776
            return -1;
G
guo 已提交
777 778 779 780 781 782
        }
    }
    break;
#endif
    default:
        rt_set_errno(EINVAL);
783
        return -1;
G
guo 已提交
784 785 786
    }
    return 0;
#endif
787
}
G
guo 已提交
788
RTM_EXPORT(clock_nanosleep);
789

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

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

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

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

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

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

833
int rt_timespec_to_tick(const struct timespec *time)
mysterywolf's avatar
mysterywolf 已提交
834 835 836
{
    int tick;
    int nsecond, second;
837
    struct timespec tp = {0};
mysterywolf's avatar
mysterywolf 已提交
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 863

    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;
}
864
RTM_EXPORT(rt_timespec_to_tick);
mysterywolf's avatar
mysterywolf 已提交
865

866 867
#endif /* RT_USING_POSIX_CLOCK */

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

#define ACTIVE 1
#define NOT_ACTIVE 0

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

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

    timer = (struct timer_obj *)timerobj;

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

906 907 908 909 910 911 912 913 914 915 916 917 918 919
#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 已提交
920

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

Z
zhkag 已提交
931 932 933
#define TIMER_ID_MAX 50
static struct timer_obj *_g_timerid[TIMER_ID_MAX];
static int timerid_idx = 0;
Z
zhkag 已提交
934
RT_DEFINE_SPINLOCK(_timer_id_lock);
Z
zhkag 已提交
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 960

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 已提交
961 962 963 964 965 966 967 968 969 970
void timer_id_lock()
{
    rt_hw_spin_lock(&_timer_id_lock);
}

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

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

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

Z
zhkag 已提交
980 981 982 983
    timer_id_lock();
    if (_g_timerid[timerid] == NULL)
    {
        timer_id_unlock();
Z
zhkag 已提交
984
        LOG_E("can not find timer!");
Z
zhkag 已提交
985 986 987 988 989 990 991 992 993 994 995 996 997 998
        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 已提交
999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009
/**
 * @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 已提交
1010
    int _timerid = 0;
X
xiangxistu 已提交
1011 1012 1013
    struct timer_obj *timer;
    char timername[RT_NAME_MAX] = {0};

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

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

    rt_snprintf(timername, RT_NAME_MAX, "psx_tm%02d", num++);
    num %= 100;
G
guo 已提交
1031
    timer->sigev_signo = evp->sigev_signo;
1032
#ifdef RT_USING_SMART
G
guo 已提交
1033 1034
    timer->pid = lwp_self()->pid;
#endif
X
xiangxistu 已提交
1035 1036 1037 1038 1039 1040
    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;
1041
    timer->clockid = clockid;
X
xiangxistu 已提交
1042

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

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

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

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

    ktimerid = (rt_ubase_t)timerid;

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

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

1108 1109
#ifdef RT_USING_CPUTIME
    if (timer->clockid == CLOCK_CPUTIME_ID && clock_cpu_issettimeout())
X
xiangxistu 已提交
1110
    {
1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126
        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 已提交
1127 1128 1129
    }
    rt_free(timer);

1130
    return 0;
X
xiangxistu 已提交
1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141
}
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);
1142
    return -1;
X
xiangxistu 已提交
1143 1144 1145 1146 1147 1148 1149 1150 1151
}

/**
 * @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)
{
1152
    struct timer_obj *timer;
X
xiangxistu 已提交
1153 1154
    rt_uint32_t seconds, nanoseconds;

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

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

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

    if (timer->status == ACTIVE)
    {
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 1209
#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 已提交
1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221
        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;
1222
    return 0;
X
xiangxistu 已提交
1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233
}
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 已提交
1234
    struct timer_obj *timer = timer_id_get((rt_ubase_t)timerid);
X
xiangxistu 已提交
1235 1236 1237
    if (timer == NULL ||
        value->it_interval.tv_nsec < 0 ||
        value->it_interval.tv_nsec >= NANOSECOND_PER_SECOND ||
G
guo 已提交
1238
        value->it_interval.tv_sec < 0 ||
X
xiangxistu 已提交
1239
        value->it_value.tv_nsec < 0 ||
G
guo 已提交
1240 1241
        value->it_value.tv_nsec >= NANOSECOND_PER_SECOND ||
        value->it_value.tv_sec < 0)
X
xiangxistu 已提交
1242 1243
    {
        rt_set_errno(EINVAL);
1244
        return -1;
X
xiangxistu 已提交
1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257
    }

    /*  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)
        {
1258 1259 1260 1261 1262 1263
#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 已提交
1264 1265 1266
        }

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

    /* 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
        *
        */
1277 1278
#ifdef RT_USING_CPUTIME
    if (timer->clockid == CLOCK_CPUTIME_ID && clock_cpu_issettimeout())
G
guo 已提交
1279
    {
1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294
        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 已提交
1295
#ifndef RT_USING_RTC
1296 1297
            LOG_W(_WARNING_NO_RTC);
            return -1;
G
guo 已提交
1298
#else
1299 1300 1301 1302 1303 1304
                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 已提交
1305
#endif
1306 1307 1308
        }
        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 已提交
1309
    }
X
xiangxistu 已提交
1310 1311
    timer->interval.tv_sec = value->it_interval.tv_sec;
    timer->interval.tv_nsec = value->it_interval.tv_nsec;
G
guo 已提交
1312 1313
    timer->value.tv_sec = value->it_value.tv_sec;
    timer->value.tv_nsec = value->it_value.tv_nsec;
X
xiangxistu 已提交
1314 1315 1316

    if (timer->status == ACTIVE)
    {
1317 1318 1319 1320 1321 1322
#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 已提交
1323 1324 1325
    }

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

1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337
#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 已提交
1338
    else
1339 1340 1341 1342 1343 1344
#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 已提交
1345

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

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


1356 1357 1358 1359 1360 1361 1362 1363 1364
/* 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)
{
1365
    rt_base_t level;
1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379
    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;
}