1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228 |
- /*
- * Copyright (c) 2006-2023, RT-Thread Development Team
- *
- * SPDX-License-Identifier: Apache-2.0
- *
- * Change Logs:
- * Date Author Notes
- * 2019-08-21 zhangjun copy from minilibc
- * 2020-09-07 Meco Man combine gcc armcc iccarm
- * 2021-02-05 Meco Man add timegm()
- * 2021-02-07 Meco Man fixed gettimeofday()
- * 2021-02-08 Meco Man add settimeofday() stime()
- * 2021-02-10 Meco Man add ctime_r() and re-implement ctime()
- * 2021-02-11 Meco Man fix bug #3183 - align days[] and months[] to 4 bytes
- * 2021-02-12 Meco Man add errno
- * 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
- * 2021-03-15 Meco Man fixed a bug of leaking memory in asctime()
- * 2021-05-01 Meco Man support fixed timezone
- * 2021-07-21 Meco Man implement that change/set timezone APIs
- * 2023-07-03 xqyjlj refactor posix time and timer
- * 2023-07-16 Shell update signal generation routine for lwp
- * adapt to new api and do the signal handling in thread context
- * 2023-08-12 Meco Man re-implement RT-Thread lightweight timezone API
- * 2023-09-15 xqyjlj perf rt_hw_interrupt_disable/enable
- * 2023-10-23 Shell add lock for _g_timerid
- * 2023-11-16 Shell Fixup of nanosleep if previous call was interrupted
- */
- #include "sys/time.h"
- #include <rthw.h>
- #include <rtdevice.h>
- #include <drivers/rtc.h>
- #include <sys/errno.h>
- #include <unistd.h>
- #ifdef RT_USING_SMART
- #include <lwp.h>
- #endif
- #ifdef RT_USING_POSIX_DELAY
- #include <delay.h>
- #endif
- #ifdef RT_USING_KTIME
- #include <ktime.h>
- #endif
- #define DBG_TAG "time"
- #define DBG_LVL DBG_INFO
- #include <rtdbg.h>
- #define _WARNING_NO_RTC "Cannot find a RTC device!"
- /* days per month -- nonleap! */
- static const short __spm[13] =
- {
- 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),
- };
- rt_align(RT_ALIGN_SIZE) static const char *days = "Sun Mon Tue Wed Thu Fri Sat ";
- rt_align(RT_ALIGN_SIZE) static const char *months = "Jan Feb Mar Apr May Jun Jul Aug Sep Oct Nov Dec ";
- #ifndef __isleap
- static int __isleap(int year)
- {
- /* 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)));
- }
- #endif
- static void num2str(char *c, int i)
- {
- c[0] = i / 10 + '0';
- c[1] = i % 10 + '0';
- }
- static rt_err_t _control_rtc(int cmd, void *arg)
- {
- #ifdef RT_USING_RTC
- static rt_device_t device = RT_NULL;
- rt_err_t rst = -RT_ERROR;
- 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, cmd, arg);
- rt_device_close(device);
- }
- }
- else
- {
- LOG_W(_WARNING_NO_RTC);
- return -RT_ENOSYS;
- }
- return rst;
- #else
- LOG_W(_WARNING_NO_RTC);
- return -RT_ENOSYS;
- #endif /* RT_USING_RTC */
- }
- /* lightweight timezone and daylight saving time */
- #ifdef RT_LIBC_USING_LIGHT_TZ_DST
- #ifndef RT_LIBC_TZ_DEFAULT_HOUR
- #define RT_LIBC_TZ_DEFAULT_HOUR (8U)
- #endif /* RT_LIBC_TZ_DEFAULT_HOUR */
- #ifndef RT_LIBC_TZ_DEFAULT_MIN
- #define RT_LIBC_TZ_DEFAULT_MIN (0U)
- #endif /* RT_LIBC_TZ_DEFAULT_MIN */
- #ifndef RT_LIBC_TZ_DEFAULT_SEC
- #define RT_LIBC_TZ_DEFAULT_SEC (0U)
- #endif /* RT_LIBC_TZ_DEFAULT_SEC */
- static volatile int32_t _current_tz_offset_sec = \
- RT_LIBC_TZ_DEFAULT_HOUR * 3600U + RT_LIBC_TZ_DEFAULT_MIN * 60U + RT_LIBC_TZ_DEFAULT_SEC;
- /* return current timezone offset in seconds */
- void rt_tz_set(int32_t offset_sec)
- {
- _current_tz_offset_sec = offset_sec;
- }
- int32_t rt_tz_get(void)
- {
- return _current_tz_offset_sec;
- }
- int8_t rt_tz_is_dst(void)
- {
- return 0U; /* TODO */
- }
- #endif /* RT_LIBC_USING_LIGHT_TZ_DST */
- struct tm *gmtime_r(const time_t *timep, struct tm *r)
- {
- int i;
- int work;
- if(timep == RT_NULL || r == RT_NULL)
- {
- rt_set_errno(EFAULT);
- return RT_NULL;
- }
- rt_memset(r, RT_NULL, sizeof(struct tm));
- work = *timep % (24*60*60);
- r->tm_sec = work % 60;
- work /= 60;
- r->tm_min = work % 60;
- r->tm_hour = work / 60;
- work = (int)(*timep / (24*60*60));
- r->tm_wday = (4 + work) % 7;
- for (i = 1970;; ++i)
- {
- int k = __isleap(i) ? 366 : 365;
- 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;
- }
- for (i = 11; i && (__spm[i] > work); --i);
- r->tm_mon = i;
- r->tm_mday += work - __spm[i];
- #if defined(RT_LIBC_USING_LIGHT_TZ_DST)
- r->tm_isdst = rt_tz_is_dst();
- #else
- r->tm_isdst = 0U;
- #endif /* RT_LIBC_USING_LIGHT_TZ_DST */
- return r;
- }
- RTM_EXPORT(gmtime_r);
- struct tm* gmtime(const time_t* t)
- {
- static struct tm tmp;
- return gmtime_r(t, &tmp);
- }
- RTM_EXPORT(gmtime);
- struct tm* localtime_r(const time_t* t, struct tm* r)
- {
- time_t local_tz;
- #if defined(RT_LIBC_USING_LIGHT_TZ_DST)
- local_tz = *t + rt_tz_get();
- #else
- local_tz = *t + 0U;
- #endif /* RT_LIBC_USING_LIGHT_TZ_DST */
- return gmtime_r(&local_tz, r);
- }
- RTM_EXPORT(localtime_r);
- struct tm* localtime(const time_t* t)
- {
- static struct tm tmp;
- return localtime_r(t, &tmp);
- }
- RTM_EXPORT(localtime);
- time_t mktime(struct tm * const t)
- {
- time_t timestamp;
- timestamp = timegm(t);
- #if defined(RT_LIBC_USING_LIGHT_TZ_DST)
- timestamp = timestamp - rt_tz_get();
- #else
- timestamp = timestamp - 0U;
- #endif /* RT_LIBC_USING_LIGHT_TZ_DST */
- return timestamp;
- }
- RTM_EXPORT(mktime);
- char* asctime_r(const struct tm *t, char *buf)
- {
- if(t == RT_NULL || buf == RT_NULL)
- {
- rt_set_errno(EFAULT);
- return RT_NULL;
- }
- rt_memset(buf, RT_NULL, 26);
- /* Checking input validity */
- if ((int)rt_strlen(days) <= (t->tm_wday << 2) || (int)rt_strlen(months) <= (t->tm_mon << 2))
- {
- 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;
- }
- /* "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';
- buf[25] = '\0';
- return buf;
- }
- RTM_EXPORT(asctime_r);
- char *asctime(const struct tm *timeptr)
- {
- static char buf[26];
- return asctime_r(timeptr, buf);
- }
- RTM_EXPORT(asctime);
- char *ctime_r(const time_t * tim_p, char * result)
- {
- struct tm tm;
- return asctime_r(localtime_r(tim_p, &tm), result);
- }
- RTM_EXPORT(ctime_r);
- char *ctime(const time_t *tim_p)
- {
- return asctime(localtime(tim_p));
- }
- RTM_EXPORT(ctime);
- #if (!defined __ARMCC_VERSION) && (!defined __CC_ARM) && (!defined __ICCARM__)
- double difftime(time_t time1, time_t time2)
- {
- return (double)(time1 - time2);
- }
- #endif
- RTM_EXPORT(difftime);
- RTM_EXPORT(strftime); /* inherent in the toolchain */
- /**
- * 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)
- {
- time_t _t;
- if (_control_rtc(RT_DEVICE_CTRL_RTC_GET_TIME, &_t) != RT_EOK)
- {
- rt_set_errno(EFAULT);
- return (time_t)-1;
- }
- if (t)
- *t = _t;
- return _t;
- }
- RTM_EXPORT(time);
- rt_weak clock_t clock(void)
- {
- return rt_tick_get(); // TODO should return cpu usage time
- }
- RTM_EXPORT(clock);
- int stime(const time_t *t)
- {
- if ((t != RT_NULL) && (_control_rtc(RT_DEVICE_CTRL_RTC_SET_TIME, (void *)t) == RT_EOK))
- {
- return 0;
- }
- rt_set_errno(EFAULT);
- return -1;
- }
- RTM_EXPORT(stime);
- time_t timegm(struct tm * const t)
- {
- time_t day;
- time_t i;
- time_t years;
- if(t == RT_NULL)
- {
- rt_set_errno(EFAULT);
- return (time_t)-1;
- }
- years = (time_t)t->tm_year - 70;
- if (t->tm_sec > 60) /* seconds after the minute - [0, 60] including leap second */
- {
- t->tm_min += t->tm_sec / 60;
- t->tm_sec %= 60;
- }
- if (t->tm_min >= 60) /* minutes after the hour - [0, 59] */
- {
- t->tm_hour += t->tm_min / 60;
- t->tm_min %= 60;
- }
- if (t->tm_hour >= 24) /* hours since midnight - [0, 23] */
- {
- t->tm_mday += t->tm_hour / 24;
- t->tm_hour %= 24;
- }
- if (t->tm_mon >= 12) /* months since January - [0, 11] */
- {
- 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)
- {
- rt_set_errno(EINVAL);
- return (time_t) -1;
- }
- /* 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 = (int)((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;
- }
- RTM_EXPORT(timegm);
- int gettimeofday(struct timeval *tv, struct timezone *tz)
- {
- /* 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(tz != RT_NULL)
- {
- tz->tz_dsttime = DST_NONE;
- #if defined(RT_LIBC_USING_LIGHT_TZ_DST)
- tz->tz_minuteswest = -(rt_tz_get() / 60);
- #else
- tz->tz_minuteswest = 0;
- #endif /* RT_LIBC_USING_LIGHT_TZ_DST */
- }
- if (tv != RT_NULL)
- {
- tv->tv_sec = 0;
- tv->tv_usec = 0;
- if (_control_rtc(RT_DEVICE_CTRL_RTC_GET_TIMEVAL, tv) == RT_EOK)
- {
- return 0;
- }
- else
- {
- if (_control_rtc(RT_DEVICE_CTRL_RTC_GET_TIME, (void *)&tv->tv_sec) == RT_EOK)
- {
- return 0;
- }
- }
- }
- rt_set_errno(EINVAL);
- return -1;
- }
- RTM_EXPORT(gettimeofday);
- int settimeofday(const struct timeval *tv, const struct timezone *tz)
- {
- /* 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 && (long)tv->tv_usec >= 0 && (long)tv->tv_sec >= 0)
- {
- if (_control_rtc(RT_DEVICE_CTRL_RTC_SET_TIMEVAL, (void *)tv) == RT_EOK)
- {
- return 0;
- }
- else
- {
- if (_control_rtc(RT_DEVICE_CTRL_RTC_SET_TIME, (void *)&tv->tv_sec) == RT_EOK)
- {
- return 0;
- }
- }
- }
- rt_set_errno(EINVAL);
- return -1;
- }
- RTM_EXPORT(settimeofday);
- #if defined(RT_USING_POSIX_DELAY) && defined(RT_USING_KTIME)
- int nanosleep(const struct timespec *rqtp, struct timespec *rmtp)
- {
- struct timespec old_ts = {0};
- struct timespec new_ts = {0};
- if (rqtp == RT_NULL)
- {
- rt_set_errno(EFAULT);
- return -1;
- }
- if (rqtp->tv_sec < 0 || rqtp->tv_nsec < 0 || rqtp->tv_nsec >= NANOSECOND_PER_SECOND)
- {
- rt_set_errno(EINVAL);
- return -1;
- }
- unsigned long ns = rqtp->tv_sec * NANOSECOND_PER_SECOND + rqtp->tv_nsec;
- rt_ktime_boottime_get_ns(&old_ts);
- rt_ktime_hrtimer_ndelay(ns);
- if (rt_get_errno() == RT_EINTR)
- {
- if (rmtp)
- {
- rt_base_t rsec, rnsec;
- rt_ktime_boottime_get_ns(&new_ts);
- rsec = old_ts.tv_sec + rqtp->tv_sec - new_ts.tv_sec;
- rnsec = old_ts.tv_nsec + rqtp->tv_nsec - new_ts.tv_nsec;
- if (rnsec < 0)
- {
- rmtp->tv_sec = rsec - 1;
- rmtp->tv_nsec = NANOSECOND_PER_SECOND + rnsec;
- }
- else
- {
- rmtp->tv_sec = rsec;
- rmtp->tv_nsec = rnsec;
- }
- }
- rt_set_errno(EINTR);
- return -1;
- }
- return 0;
- }
- RTM_EXPORT(nanosleep);
- #endif /* RT_USING_POSIX_DELAY && RT_USING_KTIME */
- #if defined(RT_USING_POSIX_CLOCK) && defined(RT_USING_KTIME)
- int clock_getres(clockid_t clockid, struct timespec *res)
- {
- if (res == RT_NULL)
- {
- rt_set_errno(EFAULT);
- return -1;
- }
- switch (clockid)
- {
- case CLOCK_REALTIME: // use RTC
- case CLOCK_REALTIME_COARSE:
- return _control_rtc(RT_DEVICE_CTRL_RTC_GET_TIMERES, res);
- case CLOCK_MONOTONIC: // use cputimer
- case CLOCK_MONOTONIC_COARSE:
- case CLOCK_MONOTONIC_RAW:
- case CLOCK_BOOTTIME:
- case CLOCK_PROCESS_CPUTIME_ID:
- case CLOCK_THREAD_CPUTIME_ID:
- res->tv_sec = 0;
- res->tv_nsec = (rt_ktime_cputimer_getres() / RT_KTIME_RESMUL);
- return 0;
- default:
- rt_set_errno(EINVAL);
- return -1;
- }
- }
- RTM_EXPORT(clock_getres);
- int clock_gettime(clockid_t clockid, struct timespec *tp)
- {
- if (tp == RT_NULL)
- {
- rt_set_errno(EFAULT);
- return -1;
- }
- switch (clockid)
- {
- case CLOCK_REALTIME: // use RTC
- case CLOCK_REALTIME_COARSE:
- return _control_rtc(RT_DEVICE_CTRL_RTC_GET_TIMESPEC, tp);
- case CLOCK_MONOTONIC: // use boottime
- case CLOCK_MONOTONIC_COARSE:
- case CLOCK_MONOTONIC_RAW:
- case CLOCK_BOOTTIME:
- return rt_ktime_boottime_get_ns(tp);
- case CLOCK_PROCESS_CPUTIME_ID:
- case CLOCK_THREAD_CPUTIME_ID:
- return rt_ktime_boottime_get_ns(tp); // TODO not yet implemented
- default:
- tp->tv_sec = 0;
- tp->tv_nsec = 0;
- rt_set_errno(EINVAL);
- return -1;
- }
- }
- RTM_EXPORT(clock_gettime);
- int clock_nanosleep(clockid_t clockid, int flags, const struct timespec *rqtp, struct timespec *rmtp)
- {
- struct timespec ts = {0};
- rt_err_t err = -RT_EINVAL;
- if (rqtp == RT_NULL)
- {
- rt_set_errno(EFAULT);
- return -1;
- }
- if (rqtp->tv_sec < 0 || rqtp->tv_nsec < 0 || rqtp->tv_nsec >= NANOSECOND_PER_SECOND)
- {
- rt_set_errno(EINVAL);
- return -1;
- }
- switch (clockid)
- {
- case CLOCK_REALTIME: // use RTC
- if (flags & TIMER_ABSTIME)
- err = _control_rtc(RT_DEVICE_CTRL_RTC_GET_TIMESPEC, &ts);
- break;
- case CLOCK_MONOTONIC: // use boottime
- case CLOCK_PROCESS_CPUTIME_ID:
- if (flags & TIMER_ABSTIME)
- err = rt_ktime_boottime_get_ns(&ts);
- break;
- default:
- rt_set_errno(EINVAL);
- return -1;
- }
- if (err != RT_EOK)
- return err;
- int64_t ns = rqtp->tv_nsec - ts.tv_nsec + (rqtp->tv_sec - ts.tv_sec) * NANOSECOND_PER_SECOND;
- if (ns <= 0)
- return 0;
- if (flags & TIMER_ABSTIME)
- {
- ts.tv_nsec = ns % NANOSECOND_PER_SECOND;
- ts.tv_sec = ns / NANOSECOND_PER_SECOND;
- return nanosleep(&ts, rmtp);
- }
- else
- {
- return nanosleep(rqtp, rmtp);
- }
- }
- RTM_EXPORT(clock_nanosleep);
- int clock_settime(clockid_t clockid, const struct timespec *tp)
- {
- if (tp == RT_NULL)
- {
- rt_set_errno(EFAULT);
- return -1;
- }
- if (tp->tv_sec < 0 || tp->tv_nsec < 0 || tp->tv_nsec >= NANOSECOND_PER_SECOND)
- {
- rt_set_errno(EINVAL);
- return -1;
- }
- switch (clockid)
- {
- case CLOCK_REALTIME:
- return _control_rtc(RT_DEVICE_CTRL_RTC_SET_TIMESPEC, (void *)tp);
- case CLOCK_REALTIME_COARSE:
- case CLOCK_MONOTONIC:
- case CLOCK_MONOTONIC_COARSE:
- case CLOCK_MONOTONIC_RAW:
- case CLOCK_BOOTTIME:
- case CLOCK_PROCESS_CPUTIME_ID:
- case CLOCK_THREAD_CPUTIME_ID:
- rt_set_errno(EPERM);
- return -1;
- default:
- rt_set_errno(EINVAL);
- return -1;
- }
- }
- RTM_EXPORT(clock_settime);
- int rt_timespec_to_tick(const struct timespec *time)
- {
- int tick;
- int second;
- long long nsecond;
- struct timespec tp = {0};
- 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;
- }
- RTM_EXPORT(rt_timespec_to_tick);
- #endif /* RT_USING_POSIX_CLOCK && RT_USING_KTIME */
- #if defined(RT_USING_POSIX_TIMER) && defined(RT_USING_KTIME)
- #include <resource_id.h>
- #define ACTIVE 1
- #define NOT_ACTIVE 0
- struct timer_obj
- {
- struct rt_ktime_hrtimer hrtimer;
- void (*sigev_notify_function)(union sigval val);
- union sigval val;
- struct timespec interval; /* Reload value */
- struct timespec value; /* Reload value */
- unsigned long reload; /* Reload value in ms */
- rt_uint32_t status;
- int sigev_signo;
- clockid_t clockid;
- timer_t timer_id;
- #ifdef RT_USING_SMART
- pid_t pid;
- struct rt_work *work;
- rt_list_t lwp_node;
- #endif
- };
- #ifdef RT_USING_SMART
- struct lwp_timer_event_param
- {
- struct rt_work work;
- union
- {
- int tid;
- pid_t pid;
- };
- int signo;
- };
- static void _lwp_timer_event_from_tid(struct rt_work *work, void *param)
- {
- rt_err_t ret;
- struct lwp_timer_event_param *data = rt_container_of(work, struct lwp_timer_event_param, work);
- rt_thread_t thread;
- RT_ASSERT(data->tid);
- /* stop others from delete thread */
- thread = lwp_tid_get_thread_and_inc_ref(data->tid);
- /** The tid of thread is a READ ONLY value, but here still facing the risk of thread already been delete error */
- ret = lwp_thread_signal_kill(thread, data->signo, SI_TIMER, 0);
- lwp_tid_dec_ref(thread);
- if (ret)
- {
- LOG_D("%s: Do kill failed(tid %d) returned %d", __func__, data->tid, ret);
- }
- }
- static void _lwp_timer_event_from_pid(struct rt_work *work, void *param)
- {
- rt_err_t ret;
- struct lwp_timer_event_param *data = rt_container_of(work, struct lwp_timer_event_param, work);
- struct rt_lwp *lwp;
- lwp_pid_lock_take();
- lwp = lwp_from_pid_locked(data->pid);
- if (lwp)
- lwp_ref_inc(lwp);
- lwp_pid_lock_release();
- ret = lwp_signal_kill(lwp, data->signo, SI_TIMER, 0);
- if (lwp)
- lwp_ref_dec(lwp);
- if (ret)
- {
- LOG_D("%s: Do kill failed(pid %d) returned %d", __func__, data->pid, ret);
- }
- }
- int timer_list_free(rt_list_t *timer_list)
- {
- struct timer_obj *pos, *n;
- rt_list_for_each_entry_safe(pos, n, timer_list, lwp_node)
- {
- timer_delete(pos->timer_id);
- }
- return 0;
- }
- #endif /* RT_USING_SMART */
- static void rtthread_timer_wrapper(void *timerobj)
- {
- struct timer_obj *timer;
- timer = (struct timer_obj *)timerobj;
- if (timer->reload == 0U)
- {
- timer->status = NOT_ACTIVE;
- }
- timer->reload = ((timer->interval.tv_sec * NANOSECOND_PER_SECOND + timer->interval.tv_nsec) * RT_KTIME_RESMUL) /
- rt_ktime_cputimer_getres();
- if (timer->reload)
- {
- rt_ktime_hrtimer_control(&timer->hrtimer, RT_TIMER_CTRL_SET_TIME, &(timer->reload));
- rt_ktime_hrtimer_start(&timer->hrtimer);
- }
- #ifdef RT_USING_SMART
- /* this field is named as tid in musl */
- void *ptid = &timer->sigev_notify_function;
- int tid = *(int *)ptid;
- struct lwp_timer_event_param *data = rt_container_of(timer->work, struct lwp_timer_event_param, work);
- data->signo = timer->sigev_signo;
- if (!tid)
- {
- data->pid = timer->pid;
- rt_work_init(timer->work, _lwp_timer_event_from_pid, 0);
- }
- else
- {
- data->tid = tid;
- rt_work_init(timer->work, _lwp_timer_event_from_tid, 0);
- }
- if (rt_work_submit(timer->work, 0))
- RT_ASSERT(0);
- #else
- if(timer->sigev_notify_function != RT_NULL)
- {
- (timer->sigev_notify_function)(timer->val);
- }
- #endif /* RT_USING_SMART */
- }
- #define TIMER_ID_MAX 50
- static struct rt_spinlock _timer_id_lock = RT_SPINLOCK_INIT;
- static struct timer_obj *_g_timerid[TIMER_ID_MAX];
- static void *timer_id[TIMER_ID_MAX];
- static resource_id_t id_timer = RESOURCE_ID_INIT(TIMER_ID_MAX, timer_id);
- /**
- * @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;
- int _timerid = 0;
- struct timer_obj *timer;
- char timername[RT_NAME_MAX] = {0};
- if (evp == RT_NULL || timerid == RT_NULL)
- {
- rt_set_errno(EINVAL);
- return -1;
- }
- if (evp->sigev_notify == SIGEV_THREAD) // TODO need to implement
- {
- rt_set_errno(EINVAL);
- return -1;
- }
- switch (clockid)
- {
- case CLOCK_REALTIME:
- case CLOCK_REALTIME_ALARM:
- case CLOCK_MONOTONIC:
- case CLOCK_BOOTTIME:
- case CLOCK_BOOTTIME_ALARM:
- case CLOCK_PROCESS_CPUTIME_ID:
- case CLOCK_THREAD_CPUTIME_ID:
- break; // Only these ids are supported
- default:
- rt_set_errno(EINVAL);
- return -1;
- }
- timer = rt_malloc(sizeof(struct timer_obj));
- if(timer == RT_NULL)
- {
- rt_set_errno(ENOMEM);
- return -1;
- }
- rt_snprintf(timername, RT_NAME_MAX, "psx_tm%02d", num++);
- num %= 100;
- timer->sigev_signo = evp->sigev_signo;
- #ifdef RT_USING_SMART
- struct rt_work *work;
- struct rt_lwp *lwp = lwp_self();
- struct lwp_timer_event_param *param;
- param = rt_malloc(sizeof(struct lwp_timer_event_param));
- work = ¶m->work;
- if (!work)
- {
- rt_set_errno(ENOMEM);
- return -1;
- }
- if (lwp)
- {
- timer->pid = lwp_self()->pid;
- rt_list_insert_after(&lwp->timer, &timer->lwp_node);
- }
- else
- {
- timer->pid = 0; /* pid 0 is never used */
- }
- timer->work = work;
- #endif /* RT_USING_SMART */
- 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;
- timer->clockid = clockid;
- rt_ktime_hrtimer_init(&timer->hrtimer, timername, 0, RT_TIMER_FLAG_ONE_SHOT | RT_TIMER_FLAG_HARD_TIMER,
- rtthread_timer_wrapper, timer);
- _timerid = resource_id_get(&id_timer);
- if (_timerid < 0)
- {
- #ifdef RT_USING_SMART
- rt_free(param);
- #endif /* RT_USING_SMART */
- rt_ktime_hrtimer_detach(&timer->hrtimer);
- rt_free(timer);
- rt_set_errno(ENOMEM);
- return -1;
- }
- _g_timerid[_timerid] = timer;
- timer->timer_id = (timer_t)(rt_ubase_t)_timerid;
- *timerid = (timer_t)(rt_ubase_t)_timerid;
- return 0;
- }
- RTM_EXPORT(timer_create);
- /**
- * @brief Delete a per-process timer.
- *
- * See IEEE 1003.1
- */
- int timer_delete(timer_t timerid)
- {
- struct timer_obj *timer;
- rt_ubase_t ktimerid;
- ktimerid = (rt_ubase_t)timerid;
- if (ktimerid < 0 || ktimerid >= TIMER_ID_MAX)
- {
- rt_set_errno(EINVAL);
- return -1;
- }
- RT_DEBUG_NOT_IN_INTERRUPT;
- rt_spin_lock(&_timer_id_lock);
- timer = _g_timerid[ktimerid];
- if (timer != NULL)
- {
- _g_timerid[ktimerid] = RT_NULL;
- resource_id_put(&id_timer, ktimerid);
- }
- rt_spin_unlock(&_timer_id_lock);
- if (timer == RT_NULL)
- {
- rt_set_errno(EINVAL);
- LOG_D("can not find timer %ld", ktimerid);
- return -1;
- }
- if (timer->status == ACTIVE)
- {
- timer->status = NOT_ACTIVE;
- rt_ktime_hrtimer_stop(&timer->hrtimer);
- }
- rt_ktime_hrtimer_detach(&timer->hrtimer);
- #ifdef RT_USING_SMART
- if (timer->pid)
- rt_list_remove(&timer->lwp_node);
- rt_free(timer->work);
- #endif
- rt_free(timer);
- return 0;
- }
- 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 -1;
- }
- /**
- * @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;
- rt_uint32_t seconds, nanoseconds;
- timer = _g_timerid[(rt_ubase_t)timerid];
- if (timer == NULL)
- {
- rt_set_errno(EINVAL);
- return -1;
- }
- if (its == NULL)
- {
- rt_set_errno(EFAULT);
- return -1;
- }
- if (timer->status == ACTIVE)
- {
- unsigned long remain_cnt;
- rt_ktime_hrtimer_control(&timer->hrtimer, RT_TIMER_CTRL_GET_REMAIN_TIME, &remain_cnt);
- nanoseconds = ((remain_cnt - rt_ktime_cputimer_getcnt()) * rt_ktime_cputimer_getres()) / RT_KTIME_RESMUL;
- seconds = nanoseconds / NANOSECOND_PER_SECOND;
- nanoseconds = nanoseconds % NANOSECOND_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 0;
- }
- 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 timespec ts = {0};
- rt_err_t err = RT_EOK;
- struct timer_obj *timer;
- timer = _g_timerid[(rt_ubase_t)timerid];
- if (timer == NULL ||
- value->it_interval.tv_nsec < 0 ||
- value->it_interval.tv_nsec >= NANOSECOND_PER_SECOND ||
- value->it_interval.tv_sec < 0 ||
- value->it_value.tv_nsec < 0 ||
- value->it_value.tv_nsec >= NANOSECOND_PER_SECOND ||
- value->it_value.tv_sec < 0)
- {
- rt_set_errno(EINVAL);
- return -1;
- }
- /* 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_ktime_hrtimer_stop(&timer->hrtimer);
- }
- timer->status = NOT_ACTIVE;
- return 0;
- }
- switch (timer->clockid)
- {
- case CLOCK_REALTIME:
- case CLOCK_REALTIME_ALARM:
- if (flags & TIMER_ABSTIME)
- err = _control_rtc(RT_DEVICE_CTRL_RTC_GET_TIMESPEC, &ts);
- break;
- case CLOCK_MONOTONIC:
- case CLOCK_BOOTTIME:
- case CLOCK_BOOTTIME_ALARM:
- case CLOCK_PROCESS_CPUTIME_ID:
- case CLOCK_THREAD_CPUTIME_ID:
- if (flags & TIMER_ABSTIME)
- err = rt_ktime_boottime_get_ns(&ts);
- break;
- default:
- rt_set_errno(EINVAL);
- return -1;
- }
- if (err != RT_EOK)
- return err;
- int64_t ns = value->it_value.tv_nsec - ts.tv_nsec + (value->it_value.tv_sec - ts.tv_sec) * NANOSECOND_PER_SECOND;
- if (ns <= 0)
- return 0;
- unsigned long res = rt_ktime_cputimer_getres();
- timer->reload = (ns * RT_KTIME_RESMUL) / res;
- timer->interval.tv_sec = value->it_interval.tv_sec;
- timer->interval.tv_nsec = value->it_interval.tv_nsec;
- timer->value.tv_sec = value->it_value.tv_sec;
- timer->value.tv_nsec = value->it_value.tv_nsec;
- if (timer->status == ACTIVE)
- {
- rt_ktime_hrtimer_stop(&timer->hrtimer);
- }
- timer->status = ACTIVE;
- if ((value->it_interval.tv_sec == 0) && (value->it_interval.tv_nsec == 0))
- rt_ktime_hrtimer_control(&timer->hrtimer, RT_TIMER_CTRL_SET_ONESHOT, RT_NULL);
- else
- rt_ktime_hrtimer_control(&timer->hrtimer, RT_TIMER_CTRL_SET_PERIODIC, RT_NULL);
- rt_ktime_hrtimer_control(&timer->hrtimer, RT_TIMER_CTRL_SET_TIME, &(timer->reload));
- rt_ktime_hrtimer_start(&timer->hrtimer);
- return 0;
- }
- RTM_EXPORT(timer_settime);
- #endif /* RT_USING_POSIX_TIMER && RT_USING_KTIME */
|