ctime.c 25.2 KB
Newer Older
1
/*
2
 * Copyright (c) 2006-2022, 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 29 30 31
#include <unistd.h>
#ifdef RT_USING_POSIX_DELAY
#include <delay.h>
#endif
mysterywolf's avatar
mysterywolf 已提交
32
#ifdef RT_USING_RTC
33 34 35
#include <rtdevice.h>
#endif

36
#define DBG_TAG    "time"
mysterywolf's avatar
mysterywolf 已提交
37 38 39
#define DBG_LVL    DBG_INFO
#include <rtdbg.h>

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

42 43 44
/* seconds per day */
#define SPD 24*60*60

45
/* days per month -- nonleap! */
46
static const short __spm[13] =
47 48 49 50 51 52 53 54 55 56 57 58 59 60 61
{
    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),
};
62

mysterywolf's avatar
mysterywolf 已提交
63 64
ALIGN(4) static const char *days = "Sun Mon Tue Wed Thu Fri Sat ";
ALIGN(4) static const char *months = "Jan Feb Mar Apr May Jun Jul Aug Sep Oct Nov Dec ";
65

66
static int __isleap(int year)
67 68 69 70 71 72 73
{
    /* 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)));
}

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

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

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

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

120
    return rst;
mysterywolf's avatar
mysterywolf 已提交
121 122

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

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

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

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

164
    return rst;
mysterywolf's avatar
mysterywolf 已提交
165 166

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

172 173 174
struct tm *gmtime_r(const time_t *timep, struct tm *r)
{
    time_t i;
175
    time_t work = *timep % (SPD);
176 177 178 179 180 181 182

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

183
    rt_memset(r, RT_NULL, sizeof(struct tm));
184

185 186 187 188 189 190 191 192
    r->tm_sec = work % 60;
    work /= 60;
    r->tm_min = work % 60;
    r->tm_hour = work / 60;
    work = *timep / (SPD);
    r->tm_wday = (4 + work) % 7;
    for (i = 1970;; ++i)
    {
193
        time_t k = __isleap(i) ? 366 : 365;
194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209
        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;
    }

210 211
    for (i = 11; i && (__spm[i] > work); --i);

212 213
    r->tm_mon = i;
    r->tm_mday += work - __spm[i];
mysterywolf's avatar
mysterywolf 已提交
214

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

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

struct tm* localtime_r(const time_t* t, struct tm* r)
{
229 230
    time_t local_tz;

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

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

time_t mktime(struct tm * const t)
{
mysterywolf's avatar
mysterywolf 已提交
245 246 247
    time_t timestamp;

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

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

261
    rt_memset(buf, RT_NULL, 26);
262

263
    /* Checking input validity */
264
    if ((int)rt_strlen(days) <= (t->tm_wday << 2) || (int)rt_strlen(months) <= (t->tm_mon << 2))
265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285
    {
        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;
    }

286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301
    /* "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';
302
    buf[25] = '\0';
303 304
    return buf;
}
mysterywolf's avatar
update  
mysterywolf 已提交
305
RTM_EXPORT(asctime_r);
306 307 308

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

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

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

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

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

337 338 339 340 341 342 343 344 345 346 347 348 349
/**
 * 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.
 *
 */
RT_WEAK time_t time(time_t *t)
{
    struct timeval now;

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

RT_WEAK clock_t clock(void)
{
    return rt_tick_get();
}
mysterywolf's avatar
update  
mysterywolf 已提交
370
RTM_EXPORT(clock);
371

mysterywolf's avatar
mysterywolf 已提交
372
int stime(const time_t *t)
373
{
mysterywolf's avatar
mysterywolf 已提交
374 375
    struct timeval tv;

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

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

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

    if(t == RT_NULL)
    {
        rt_set_errno(EFAULT);
        return (time_t)-1;
    }
406

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

    /* 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;
    t->tm_wday = (day + 4) % i; /* Sunday=0, Monday=1, ..., Saturday=6 */

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

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

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

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

mysterywolf's avatar
mysterywolf 已提交
526 527 528 529 530 531 532 533 534 535 536
#ifdef RT_USING_POSIX_DELAY
int nanosleep(const struct timespec *rqtp, struct timespec *rmtp)
{
    sleep(rqtp->tv_sec);
    ndelay(rqtp->tv_nsec);
    return 0;
}
RTM_EXPORT(nanosleep);
#endif /* RT_USING_POSIX_DELAY */

#ifdef RT_USING_POSIX_CLOCK
537 538
#ifdef RT_USING_RTC
static volatile struct timeval _timevalue;
还_没_想_好's avatar
还_没_想_好 已提交
539
static int _rt_clock_time_system_init(void)
540
{
541
    rt_base_t level;
542
    time_t time = 0;
543 544 545 546 547 548 549
    rt_tick_t tick;
    rt_device_t device;

    device = rt_device_find("rtc");
    if (device != RT_NULL)
    {
        /* get realtime seconds */
550 551 552 553 554 555 556 557 558
        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;
        }
559 560
    }

561 562 563 564
    level = rt_hw_interrupt_disable();
    _timevalue.tv_usec = 0;
    _timevalue.tv_sec = 0;
    rt_hw_interrupt_enable(level);
565

566
    return -1;
567
}
568 569
INIT_COMPONENT_EXPORT(_rt_clock_time_system_init);
#endif /* RT_USING_RTC */
570 571 572

int clock_getres(clockid_t clockid, struct timespec *res)
{
573
#ifndef RT_USING_RTC
574
    LOG_W(_WARNING_NO_RTC);
575 576
    return -1;
#else
577 578 579 580
    int ret = 0;

    if (res == RT_NULL)
    {
581
        rt_set_errno(EFAULT);
582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599
        return -1;
    }

    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:
600 601
        res->tv_sec  = 0;
        res->tv_nsec = 0;
602 603 604 605 606 607
        ret = -1;
        rt_set_errno(EINVAL);
        break;
    }

    return ret;
608
#endif /* RT_USING_RTC */
609 610 611 612 613
}
RTM_EXPORT(clock_getres);

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

    if (tp == RT_NULL)
    {
622
        rt_set_errno(EFAULT);
623 624 625 626 627 628 629
        return -1;
    }

    switch (clockid)
    {
    case CLOCK_REALTIME:
        {
630
            int tick;
631
            rt_base_t level;
632

633 634
            level = rt_hw_interrupt_disable();
            tick = rt_tick_get(); /* get tick */
635 636
            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;
637
            rt_hw_interrupt_enable(level);
638 639 640 641 642 643 644 645 646 647 648 649
        }
        break;

#ifdef RT_USING_CPUTIME
    case CLOCK_CPUTIME_ID:
        {
            float unit = 0;
            long long cpu_tick;

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

650 651
            tp->tv_sec  = ((long long)(cpu_tick * unit)) / NANOSECOND_PER_SECOND;
            tp->tv_nsec = ((long long)(cpu_tick * unit)) % NANOSECOND_PER_SECOND;
652 653 654 655
        }
        break;
#endif
    default:
656 657
        tp->tv_sec  = 0;
        tp->tv_nsec = 0;
658 659 660 661 662
        rt_set_errno(EINVAL);
        ret = -1;
    }

    return ret;
663
#endif /* RT_USING_RTC */
664 665 666
}
RTM_EXPORT(clock_gettime);

667 668 669 670 671 672 673 674 675 676 677
int clock_nanosleep(clockid_t clockid, int flags, const struct timespec *rqtp, struct timespec *rmtp)
{
    if ((clockid != CLOCK_REALTIME) || (rqtp == RT_NULL))
    {
        rt_set_errno(EINVAL);
        return -1;
    }

    return nanosleep(rqtp, rmtp);
}

678 679
int clock_settime(clockid_t clockid, const struct timespec *tp)
{
680
#ifndef RT_USING_RTC
681
    LOG_W(_WARNING_NO_RTC);
682 683
    return -1;
#else
684
    rt_base_t level;
685 686 687 688 689 690
    int second;
    rt_tick_t tick;
    rt_device_t device;

    if ((clockid != CLOCK_REALTIME) || (tp == RT_NULL))
    {
691
        rt_set_errno(EFAULT);
692 693 694 695 696 697
        return -1;
    }

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

698 699
    level = rt_hw_interrupt_disable();
    tick = rt_tick_get(); /* get tick */
700 701 702
    /* update timevalue */
    _timevalue.tv_usec = MICROSECOND_PER_SECOND - (tick % RT_TICK_PER_SECOND) * MICROSECOND_PER_TICK;
    _timevalue.tv_sec = second - tick/RT_TICK_PER_SECOND - 1;
703
    rt_hw_interrupt_enable(level);
704 705 706 707 708 709

    /* update for RTC device */
    device = rt_device_find("rtc");
    if (device != RT_NULL)
    {
        /* set realtime seconds */
710 711 712 713
        if(rt_device_control(device, RT_DEVICE_CTRL_RTC_SET_TIME, &second) == RT_EOK)
        {
            return 0;
        }
714 715
    }

716 717
    return -1;
#endif /* RT_USING_RTC */
718 719
}
RTM_EXPORT(clock_settime);
mysterywolf's avatar
mysterywolf 已提交
720

721
int rt_timespec_to_tick(const struct timespec *time)
mysterywolf's avatar
mysterywolf 已提交
722 723 724
{
    int tick;
    int nsecond, second;
725
    struct timespec tp = {0};
mysterywolf's avatar
mysterywolf 已提交
726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751

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

754 755
#endif /* RT_USING_POSIX_CLOCK */

X
xiangxistu 已提交
756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 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 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 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 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016
#ifdef RT_USING_POSIX_TIMER

#define ACTIVE 1
#define NOT_ACTIVE 0

struct timer_obj
{
    struct rt_timer timer;
    void (*sigev_notify_function)(union sigval val);
    union sigval val;
    struct timespec interval;              /* Reload value */
    rt_uint32_t reload;                    /* Reload value in ms */
    rt_uint32_t status;
};

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

    timer = (struct timer_obj *)timerobj;

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

    if(timer->sigev_notify_function != RT_NULL)
    {
        (timer->sigev_notify_function)(timer->val);
    }
}

/**
 * @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;
    struct timer_obj *timer;
    char timername[RT_NAME_MAX] = {0};

    if (clockid != CLOCK_MONOTONIC || evp == NULL ||
        (evp->sigev_notify != SIGEV_NONE &&
         evp->sigev_notify != SIGEV_SIGNAL))
    {
        rt_set_errno(EINVAL);
        return -RT_ERROR;
    }

    timer = rt_malloc(sizeof(struct timer_obj));
    if(timer == RT_NULL)
    {
        rt_set_errno(ENOMEM);
        return -RT_ENOMEM;
    }

    RT_ASSERT(evp->sigev_notify_function != RT_NULL);
    rt_snprintf(timername, RT_NAME_MAX, "psx_tm%02d", num++);
    num %= 100;
    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;

    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);
    }

    *timerid = (timer_t)timer;

    return RT_EOK;
}
RTM_EXPORT(timer_create);

/**
 * @brief Delete a per-process timer.
 *
 * See IEEE 1003.1
 */
int timer_delete(timer_t timerid)
{
    struct timer_obj *timer = (struct timer_obj *)timerid;

    if (timer == RT_NULL)
    {
        rt_set_errno(EINVAL);
        return -RT_ERROR;
    }

    if (timer->status == ACTIVE)
    {
        timer->status = NOT_ACTIVE;
        rt_timer_stop(&timer->timer);
    }

    rt_free(timer);

    return RT_EOK;
}
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);
    return -RT_ERROR;
}

/**
 * @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)
{
    struct timer_obj *timer = (struct timer_obj *)timerid;
    rt_tick_t remaining;
    rt_uint32_t seconds, nanoseconds;

    if (timer == NULL)
    {
        rt_set_errno(EINVAL);
        return -RT_ERROR;
    }

    if (its == NULL)
    {
        rt_set_errno(EFAULT);
        return -RT_ERROR;
    }

    if (timer->status == ACTIVE)
    {
        rt_tick_t remain_tick;

        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 ;

        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;
    return RT_EOK;
}
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)
{
    struct timer_obj *timer = (struct timer_obj *)timerid;

    if (timer == NULL ||
        value->it_interval.tv_nsec < 0 ||
        value->it_interval.tv_nsec >= NANOSECOND_PER_SECOND ||
        value->it_value.tv_nsec < 0 ||
        value->it_value.tv_nsec >= NANOSECOND_PER_SECOND)
    {
        rt_set_errno(EINVAL);
        return -RT_ERROR;
    }

    if (value == NULL || ovalue == NULL)
    {
        rt_set_errno(EFAULT);
        return -RT_ERROR;
    }

    /*  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)
        {
            rt_timer_stop(&timer->timer);
        }

        timer->status = NOT_ACTIVE;
        return RT_EOK;
    }

    /* 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
        *
        */
    timer->reload = (value->it_interval.tv_sec * RT_TICK_PER_SECOND) + (value->it_interval.tv_nsec * RT_TICK_PER_SECOND) / NANOSECOND_PER_SECOND;
    timer->interval.tv_sec = value->it_interval.tv_sec;
    timer->interval.tv_nsec = value->it_interval.tv_nsec;

    if (timer->status == ACTIVE)
    {
        rt_timer_stop(&timer->timer);
    }

    timer->status = ACTIVE;
    rt_timer_control(&timer->timer, RT_TIMER_CTRL_SET_TIME, (void *)timer->reload);
    rt_timer_control(&timer->timer, RT_TIMER_CTRL_SET_PERIODIC, RT_NULL);
    rt_timer_start(&timer->timer);

    return RT_EOK;
}
RTM_EXPORT(timer_settime);
#endif /* RT_USING_POSIX_TIMER */


1017 1018 1019 1020 1021 1022 1023 1024 1025
/* 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)
{
1026
    rt_base_t level;
1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040
    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;
}