diff options
Diffstat (limited to 'cpukit/posix/src/nanosleep.c')
-rw-r--r-- | cpukit/posix/src/nanosleep.c | 116 |
1 files changed, 22 insertions, 94 deletions
diff --git a/cpukit/posix/src/nanosleep.c b/cpukit/posix/src/nanosleep.c index 8d1a4b84e4..1dcf77c8bc 100644 --- a/cpukit/posix/src/nanosleep.c +++ b/cpukit/posix/src/nanosleep.c @@ -1,3 +1,5 @@ +/* SPDX-License-Identifier: BSD-2-Clause */ + /** * @file * @@ -12,9 +14,26 @@ * * Copyright (c) 2016. Gedare Bloom. * - * The license and distribution terms for this file may be - * found in the file LICENSE in this distribution or at - * http://www.rtems.org/license/LICENSE. + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" + * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE + * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. */ #ifdef HAVE_CONFIG_H @@ -23,17 +42,8 @@ #include <time.h> -#include <rtems/score/threadimpl.h> -#include <rtems/score/threadqimpl.h> -#include <rtems/score/timespec.h> -#include <rtems/score/timecounter.h> -#include <rtems/score/watchdogimpl.h> -#include <rtems/posix/posixapi.h> #include <rtems/seterr.h> -static Thread_queue_Control _Nanosleep_Pseudo_queue = - THREAD_QUEUE_INITIALIZER( "Nanosleep" ); - /* * 14.2.5 High Resolution Sleep, P1003.1b-1993, p. 269 */ @@ -52,85 +62,3 @@ int nanosleep( return eno; } - -/* - * High Resolution Sleep with Specifiable Clock, IEEE Std 1003.1, 2001 - */ -int clock_nanosleep( - clockid_t clock_id, - int flags, - const struct timespec *rqtp, - struct timespec *rmtp -) -{ - Thread_queue_Context queue_context; - struct timespec uptime; - const struct timespec *end; - Thread_Control *executing; - int eno; - - if ( clock_id != CLOCK_REALTIME && clock_id != CLOCK_MONOTONIC ) { - return ENOTSUP; - } - - _Thread_queue_Context_initialize( &queue_context ); - _Thread_queue_Context_set_thread_state( - &queue_context, - STATES_WAITING_FOR_TIME | STATES_INTERRUPTIBLE_BY_SIGNAL - ); - - if ( ( flags & TIMER_ABSTIME ) != 0 ) { - end = rqtp; - - if ( clock_id == CLOCK_REALTIME ) { - _Thread_queue_Context_set_enqueue_timeout_realtime_timespec( - &queue_context, - end - ); - } else { - _Thread_queue_Context_set_enqueue_timeout_monotonic_timespec( - &queue_context, - end - ); - } - } else { - _Timecounter_Nanouptime( &uptime ); - end = _Watchdog_Future_timespec( &uptime, rqtp ); - _Thread_queue_Context_set_enqueue_timeout_monotonic_timespec( - &queue_context, - end - ); - } - - _Thread_queue_Acquire( &_Nanosleep_Pseudo_queue, &queue_context ); - executing = _Thread_Executing; - _Thread_queue_Enqueue( - &_Nanosleep_Pseudo_queue.Queue, - &_Thread_queue_Operations_FIFO, - executing, - &queue_context - ); - eno = _POSIX_Get_error_after_wait( executing ); - - if ( eno == ETIMEDOUT ) { - eno = 0; - } - - if ( rmtp != NULL && ( flags & TIMER_ABSTIME ) == 0 ) { - if ( eno == EINTR ) { - struct timespec actual_end; - - _Timecounter_Nanouptime( &actual_end ); - - if ( _Timespec_Less_than( &actual_end, end ) ) { - _Timespec_Subtract( &actual_end, end, rmtp ); - } else { - _Timespec_Set_to_zero( rmtp ); - } - } else { - _Timespec_Set_to_zero( rmtp ); - } - } - - return eno; -} |