Function nanosleep

components/libc/compilers/common/ctime.c:539–589

#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};
    struct rt_ktime_hrtimer timer;

    rt_ktime_hrtimer_delay_init(&timer);

    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(&timer, 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_ktime_hrtimer_delay_detach(&timer);
        rt_set_errno(EINTR);
        return -1;
    }

    rt_ktime_hrtimer_delay_detach(&timer);
    return 0;
}
RTM_EXPORT(nanosleep);
#endif /* RT_USING_POSIX_DELAY && RT_USING_KTIME */