From 36a63d785977ae733489fca7d77f4fb213336529 Mon Sep 17 00:00:00 2001 From: Joel Sherrill Date: Wed, 16 Jan 2002 22:54:23 +0000 Subject: 2001-01-16 Joel Sherrill * Added task-based timers to the Timer Manager. This added three new directives: - rtems_timer_initiate_server - rtems_timer_server_fire_after - rtems_timer_server_fire_when In the process of doing this, a number of cleanups were made. * src/timerserver.c, src/timerserverfireafter.c, src/timerserverfirewhen.c: New files. * include/timer/timer.h: Added new prototypes and supporting types. * inline/rtems/rtems/timer.h, macros/rtems/rtems/timer.h: Enhanced _Timer_Is_interval_class() to cover the class TIMER_INTERVAL_ON_TASK. * src/Makefile.am: Accounted for new files. * src/rtemstimer.c: Added initialization of _Timer_Server variable. * src/timercancel.c, src/timerreset.c: Account for addition of timer classes. Also corrected the headers. * src/timercreate.c, src/timerdelete.c, src/timerfireafter.c, src/timerfireafter.c, src/timerident.c: Corrected header. --- c/src/exec/rtems/src/timerserver.c | 288 ++++++++++++++++++++++++++++ c/src/exec/rtems/src/timerserverfireafter.c | 79 ++++++++ c/src/exec/rtems/src/timerserverfirewhen.c | 87 +++++++++ cpukit/rtems/src/timerserver.c | 288 ++++++++++++++++++++++++++++ cpukit/rtems/src/timerserverfireafter.c | 79 ++++++++ cpukit/rtems/src/timerserverfirewhen.c | 87 +++++++++ 6 files changed, 908 insertions(+) create mode 100644 c/src/exec/rtems/src/timerserver.c create mode 100644 c/src/exec/rtems/src/timerserverfireafter.c create mode 100644 c/src/exec/rtems/src/timerserverfirewhen.c create mode 100644 cpukit/rtems/src/timerserver.c create mode 100644 cpukit/rtems/src/timerserverfireafter.c create mode 100644 cpukit/rtems/src/timerserverfirewhen.c diff --git a/c/src/exec/rtems/src/timerserver.c b/c/src/exec/rtems/src/timerserver.c new file mode 100644 index 0000000000..76fa532e91 --- /dev/null +++ b/c/src/exec/rtems/src/timerserver.c @@ -0,0 +1,288 @@ +/* + * Timer Manager - rtems_timer_initiate_server directive along with + * the Timer Server Body and support routines + * + * COPYRIGHT (c) 1989-2002. + * On-Line Applications Research Corporation (OAR). + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.OARcorp.com/rtems/license.html. + * + * $Id$ + */ + +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include + +/* + * The following chains contain the list of interval timers that are + * executed in the context of the Timer Server. + * + * NOTE: These are prototyped in rtems/timer/timer.h but since we + * do not actually use them until after the Timer Server is + * initiated, we can actually declare them here and avoid forcing + * them into the minimum footprint. + */ + +Chain_Control _Timer_Ticks_chain; +Chain_Control _Timer_Seconds_chain; + +/* + * The timer used to control when the Timer Server wakes up to service + * "when" timers. + * + * NOTE: This should NOT be used outside this file. + */ + +Watchdog_Control _Timer_Seconds_timer; + +/*PAGE + * + * _Timer_Server_body + * + * This is the server for task based timers. This task executes whenever + * a task-based timer should fire. It services both "after" and "when" + * timers. It is not created automatically but must be created explicitly + * by the application before task-based timers may be initiated. + * + * Input parameters: + * Ignored - the task argument is ignored + * + * Output parameters: NONE + */ + +Thread _Timer_Server_body( + unsigned32 ignored +) +{ + Watchdog_Interval snapshot; + Watchdog_Interval ticks_last_time; + Watchdog_Interval seconds_last_time; + Watchdog_Interval ticks; + + /* + * Initialize the "last time" markers to indicate the timer that + * the server was initiated. + */ + + ticks_last_time = _Watchdog_Ticks_since_boot; + seconds_last_time = _TOD_Seconds_since_epoch; + + _Thread_Disable_dispatch(); + while(1) { + + /* + * Block until there is something to do. + */ + + _Thread_Set_state( _Timer_Server, STATES_DELAYING ); + _Timer_Server_reset( TIMER_SERVER_RESET_TICKS ); + _Timer_Server_reset( TIMER_SERVER_RESET_SECONDS ); + _Thread_Enable_dispatch(); + + + /* + * Disable dispatching while processing the timers since we want + * to mimic the environment that non-task-based TSRs execute in. + * This ensures that the primary difference is that _ISR_Nest_level + * is 0 for task-based timers and non-zero for the others. + */ + + _Thread_Disable_dispatch(); + + /* + * Process the ticks chain + */ + + snapshot = _Watchdog_Ticks_since_boot; + ticks = snapshot - ticks_last_time; + ticks_last_time = snapshot; + _Watchdog_Adjust( &_Timer_Ticks_chain, WATCHDOG_FORWARD, ticks ); + + /* + * Process the seconds chain. Start by checking that the Time + * of Day (TOD) has not been set backwards. If it has then + * we want to adjust the _Timer_Seconds_chain to indicate this. + */ + + snapshot = _TOD_Seconds_since_epoch; + if ( snapshot > seconds_last_time ) { + /* + * This path is for normal forward movement and cases where the + * TOD has been set forward. + */ + + ticks = snapshot - seconds_last_time; + _Watchdog_Adjust( &_Timer_Seconds_chain, WATCHDOG_FORWARD, ticks ); + + } else if ( snapshot < seconds_last_time ) { + /* + * The current TOD is before the last TOD which indicates that + * TOD has been set backwards. + */ + + ticks = seconds_last_time - snapshot; + _Watchdog_Adjust( &_Timer_Seconds_chain, WATCHDOG_BACKWARD, ticks ); + } + seconds_last_time = snapshot; + } +} + +/*PAGE + * + * rtems_timer_initiate_server + * + * This directive creates and starts the server for task-based timers. + * It must be invoked before any task-based timers can be initiated. + * + * Input parameters: + * stack_size - stack size in bytes + * attribute_set - thread attributes + * + * Output parameters: + * RTEMS_SUCCESSFUL - if successful + * error code - if unsuccessful + */ + + +rtems_status_code rtems_timer_initiate_server( + unsigned32 stack_size, + rtems_attribute attribute_set +) +{ + rtems_id id; + rtems_status_code status; + + /* + * Just to make sure the test versus create/start operation are atomic. + */ + + _Thread_Disable_dispatch(); + + if ( _Timer_Server ) { + _Thread_Enable_dispatch(); + return RTEMS_INCORRECT_STATE; + } + + /* + * Create the Timer Server with the name the name of "TIME". The priority + * is always "0" which makes it higher than any other task in the system. + * It is also always NO_PREEMPT so it looks like an interrupt to other tasks. + */ + + status = rtems_task_create( + 0x4954454d, /* "TIME" */ + 1, /* create with priority 1 since 0 is illegal */ + stack_size, /* let user specify stack size */ + RTEMS_NO_PREEMPT, /* no preempt is like an interrupt */ + attribute_set, /* user may want floating point */ + &id /* get the id back */ + ); + if (status) { + _Thread_Enable_dispatch(); + return status; + } + + status = rtems_task_start( + id, /* the id from create */ + (rtems_task_entry) _Timer_Server_body, /* the timer server entry point */ + 0 /* there is no argument */ + ); + if (status) { + /* + * One would expect a call to rtems_task_delete() here to clean up + * but there is actually no way (in normal circumstances) that the + * start can fail. The id and starting address are known to be + * be good. If this service fails, something is weirdly wrong on the + * target such as a stray write in an ISR or incorrect memory layout. + */ + _Thread_Enable_dispatch(); + return status; + } + + /* + * We work with the TCB pointer, not the ID, so we need to convert + * to a TCB pointer from here out. + * + * NOTE: Setting the pointer to the Timer Server TCB to a value other than + * NULL indicates that task-based timer support is initialized. + */ + + _Timer_Server = (Thread_Control *)_Objects_Get_local_object( + &_RTEMS_tasks_Information, + _Objects_Get_index(id) + ); + + /* + * A priority of 0, higher than any user task, combined with no preemption + * makes this task the highest priority in any application. It can be + * viewed as a low priority interrupt. The FALSE argument indicates + * that the task is to be appended (not prepended) to its priority + * chain at the end of this operation. + */ + + _Thread_Change_priority( _Timer_Server, 0, FALSE ); + + /* + * Initialize the timer lists that the server will manage. + */ + + _Chain_Initialize_empty( &_Timer_Ticks_chain ); + _Chain_Initialize_empty( &_Timer_Seconds_chain ); + + /* + * Initialize the timers that will be used to control when the + * Timer Server wakes up and services the task-based timers. + */ + + _Watchdog_Initialize( &_Timer_Server->Timer, _Thread_Delay_ended, id, NULL ); + _Watchdog_Initialize( &_Timer_Seconds_timer, _Thread_Delay_ended, id, NULL ); + + _Thread_Enable_dispatch(); + return RTEMS_SUCCESSFUL; +} + +/*PAGE + * + * _Timer_Server_reset + * + * This routine resets the timers which determine when the Timer Server + * will wake up next to service task-based timers. + * + * Input parameters: + * do_ticks - TRUE indicates to process the ticks list + * FALSE indicates to process the seconds list + * + * Output parameters: NONE + */ + +void _Timer_Server_reset( + Timer_Server_reset_mode reset_mode +) +{ + Watchdog_Interval units; + + switch ( reset_mode ) { + case TIMER_SERVER_RESET_TICKS: + _Watchdog_Remove( &_Timer_Server->Timer ); + units = ((Watchdog_Control *)_Timer_Ticks_chain.first)->delta_interval; + _Watchdog_Insert_ticks( &_Timer_Server->Timer, units ); + break; + case TIMER_SERVER_RESET_SECONDS: + _Watchdog_Remove( &_Timer_Seconds_timer ); + units = ((Watchdog_Control *)_Timer_Seconds_chain.first)->delta_interval; + _Watchdog_Insert_seconds( &_Timer_Seconds_timer, units ); + break; + } +} + diff --git a/c/src/exec/rtems/src/timerserverfireafter.c b/c/src/exec/rtems/src/timerserverfireafter.c new file mode 100644 index 0000000000..32b42b77ce --- /dev/null +++ b/c/src/exec/rtems/src/timerserverfireafter.c @@ -0,0 +1,79 @@ +/* + * Timer Manager - rtems_timer_server fire_after directive + * + * + * COPYRIGHT (c) 1989-2002. + * On-Line Applications Research Corporation (OAR). + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.OARcorp.com/rtems/license.html. + * + * $Id$ + */ + +#include +#include +#include +#include +#include +#include +#include +#include + +/*PAGE + * + * rtems_timer_server_fire_after + * + * This directive allows a thread to start a timer which will by + * executed by the Timer Server when it fires. + * + * Input parameters: + * id - timer id + * ticks - interval until routine is fired + * routine - routine to schedule + * user_data - passed as argument to routine when it is fired + * + * Output parameters: + * RTEMS_SUCCESSFUL - if successful + * error code - if unsuccessful + */ + +rtems_status_code rtems_timer_server_fire_after( + Objects_Id id, + rtems_interval ticks, + rtems_timer_service_routine_entry routine, + void *user_data +) +{ + Timer_Control *the_timer; + Objects_Locations location; + extern Chain_Control _Timer_Ticks_chain; + + if ( !_Timer_Server ) + return RTEMS_INCORRECT_STATE; + + if ( ticks == 0 ) + return RTEMS_INVALID_NUMBER; + + the_timer = _Timer_Get( id, &location ); + switch ( location ) { + case OBJECTS_REMOTE: /* should never return this */ + return RTEMS_INTERNAL_ERROR; + + case OBJECTS_ERROR: + return RTEMS_INVALID_ID; + + case OBJECTS_LOCAL: + (void) _Watchdog_Remove( &the_timer->Ticker ); + the_timer->the_class = TIMER_INTERVAL_ON_TASK; + _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); + the_timer->Ticker.initial = ticks; + _Watchdog_Insert( &_Timer_Ticks_chain, &the_timer->Ticker ); + _Timer_Server_reset( TIMER_SERVER_RESET_TICKS ); + _Thread_Enable_dispatch(); + return RTEMS_SUCCESSFUL; + } + + return RTEMS_INTERNAL_ERROR; /* unreached - only to remove warnings */ +} diff --git a/c/src/exec/rtems/src/timerserverfirewhen.c b/c/src/exec/rtems/src/timerserverfirewhen.c new file mode 100644 index 0000000000..6309315a75 --- /dev/null +++ b/c/src/exec/rtems/src/timerserverfirewhen.c @@ -0,0 +1,87 @@ +/* + * Timer Manager - rtems_timer_server fire_when directive + * + * + * COPYRIGHT (c) 1989-2002. + * On-Line Applications Research Corporation (OAR). + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.OARcorp.com/rtems/license.html. + * + * $Id$ + */ + +#include +#include +#include +#include +#include +#include +#include +#include + +/*PAGE + * + * rtems_timer_server_fire_when + * + * This directive allows a thread to start a timer which will by + * executed by the Timer Server when it fires. + * + * Input parameters: + * id - timer id + * wall_time - time of day to fire timer + * routine - routine to schedule + * user_data - passed as argument to routine when it is fired + * + * Output parameters: + * RTEMS_SUCCESSFUL - if successful + * error code - if unsuccessful + */ + +rtems_status_code rtems_timer_server_fire_when( + Objects_Id id, + rtems_time_of_day *wall_time, + rtems_timer_service_routine_entry routine, + void *user_data +) +{ + Timer_Control *the_timer; + Objects_Locations location; + rtems_interval seconds; + extern Chain_Control _Timer_Seconds_chain; + + if ( !_Timer_Server ) + return RTEMS_INCORRECT_STATE; + + if ( !_TOD_Is_set ) + return RTEMS_NOT_DEFINED; + + if ( !_TOD_Validate( wall_time ) ) + return RTEMS_INVALID_CLOCK; + + seconds = _TOD_To_seconds( wall_time ); + if ( seconds <= _TOD_Seconds_since_epoch ) + return RTEMS_INVALID_CLOCK; + + the_timer = _Timer_Get( id, &location ); + switch ( location ) { + case OBJECTS_REMOTE: /* should never return this */ + return RTEMS_INTERNAL_ERROR; + + case OBJECTS_ERROR: + return RTEMS_INVALID_ID; + + case OBJECTS_LOCAL: + (void) _Watchdog_Remove( &the_timer->Ticker ); + the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; + _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); + the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch; + _Watchdog_Insert( &_Timer_Seconds_chain, &the_timer->Ticker ); + _Timer_Server_reset( TIMER_SERVER_RESET_SECONDS ); + _Thread_Enable_dispatch(); + return RTEMS_SUCCESSFUL; + } + + return RTEMS_INTERNAL_ERROR; /* unreached - only to remove warnings */ +} diff --git a/cpukit/rtems/src/timerserver.c b/cpukit/rtems/src/timerserver.c new file mode 100644 index 0000000000..76fa532e91 --- /dev/null +++ b/cpukit/rtems/src/timerserver.c @@ -0,0 +1,288 @@ +/* + * Timer Manager - rtems_timer_initiate_server directive along with + * the Timer Server Body and support routines + * + * COPYRIGHT (c) 1989-2002. + * On-Line Applications Research Corporation (OAR). + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.OARcorp.com/rtems/license.html. + * + * $Id$ + */ + +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include + +/* + * The following chains contain the list of interval timers that are + * executed in the context of the Timer Server. + * + * NOTE: These are prototyped in rtems/timer/timer.h but since we + * do not actually use them until after the Timer Server is + * initiated, we can actually declare them here and avoid forcing + * them into the minimum footprint. + */ + +Chain_Control _Timer_Ticks_chain; +Chain_Control _Timer_Seconds_chain; + +/* + * The timer used to control when the Timer Server wakes up to service + * "when" timers. + * + * NOTE: This should NOT be used outside this file. + */ + +Watchdog_Control _Timer_Seconds_timer; + +/*PAGE + * + * _Timer_Server_body + * + * This is the server for task based timers. This task executes whenever + * a task-based timer should fire. It services both "after" and "when" + * timers. It is not created automatically but must be created explicitly + * by the application before task-based timers may be initiated. + * + * Input parameters: + * Ignored - the task argument is ignored + * + * Output parameters: NONE + */ + +Thread _Timer_Server_body( + unsigned32 ignored +) +{ + Watchdog_Interval snapshot; + Watchdog_Interval ticks_last_time; + Watchdog_Interval seconds_last_time; + Watchdog_Interval ticks; + + /* + * Initialize the "last time" markers to indicate the timer that + * the server was initiated. + */ + + ticks_last_time = _Watchdog_Ticks_since_boot; + seconds_last_time = _TOD_Seconds_since_epoch; + + _Thread_Disable_dispatch(); + while(1) { + + /* + * Block until there is something to do. + */ + + _Thread_Set_state( _Timer_Server, STATES_DELAYING ); + _Timer_Server_reset( TIMER_SERVER_RESET_TICKS ); + _Timer_Server_reset( TIMER_SERVER_RESET_SECONDS ); + _Thread_Enable_dispatch(); + + + /* + * Disable dispatching while processing the timers since we want + * to mimic the environment that non-task-based TSRs execute in. + * This ensures that the primary difference is that _ISR_Nest_level + * is 0 for task-based timers and non-zero for the others. + */ + + _Thread_Disable_dispatch(); + + /* + * Process the ticks chain + */ + + snapshot = _Watchdog_Ticks_since_boot; + ticks = snapshot - ticks_last_time; + ticks_last_time = snapshot; + _Watchdog_Adjust( &_Timer_Ticks_chain, WATCHDOG_FORWARD, ticks ); + + /* + * Process the seconds chain. Start by checking that the Time + * of Day (TOD) has not been set backwards. If it has then + * we want to adjust the _Timer_Seconds_chain to indicate this. + */ + + snapshot = _TOD_Seconds_since_epoch; + if ( snapshot > seconds_last_time ) { + /* + * This path is for normal forward movement and cases where the + * TOD has been set forward. + */ + + ticks = snapshot - seconds_last_time; + _Watchdog_Adjust( &_Timer_Seconds_chain, WATCHDOG_FORWARD, ticks ); + + } else if ( snapshot < seconds_last_time ) { + /* + * The current TOD is before the last TOD which indicates that + * TOD has been set backwards. + */ + + ticks = seconds_last_time - snapshot; + _Watchdog_Adjust( &_Timer_Seconds_chain, WATCHDOG_BACKWARD, ticks ); + } + seconds_last_time = snapshot; + } +} + +/*PAGE + * + * rtems_timer_initiate_server + * + * This directive creates and starts the server for task-based timers. + * It must be invoked before any task-based timers can be initiated. + * + * Input parameters: + * stack_size - stack size in bytes + * attribute_set - thread attributes + * + * Output parameters: + * RTEMS_SUCCESSFUL - if successful + * error code - if unsuccessful + */ + + +rtems_status_code rtems_timer_initiate_server( + unsigned32 stack_size, + rtems_attribute attribute_set +) +{ + rtems_id id; + rtems_status_code status; + + /* + * Just to make sure the test versus create/start operation are atomic. + */ + + _Thread_Disable_dispatch(); + + if ( _Timer_Server ) { + _Thread_Enable_dispatch(); + return RTEMS_INCORRECT_STATE; + } + + /* + * Create the Timer Server with the name the name of "TIME". The priority + * is always "0" which makes it higher than any other task in the system. + * It is also always NO_PREEMPT so it looks like an interrupt to other tasks. + */ + + status = rtems_task_create( + 0x4954454d, /* "TIME" */ + 1, /* create with priority 1 since 0 is illegal */ + stack_size, /* let user specify stack size */ + RTEMS_NO_PREEMPT, /* no preempt is like an interrupt */ + attribute_set, /* user may want floating point */ + &id /* get the id back */ + ); + if (status) { + _Thread_Enable_dispatch(); + return status; + } + + status = rtems_task_start( + id, /* the id from create */ + (rtems_task_entry) _Timer_Server_body, /* the timer server entry point */ + 0 /* there is no argument */ + ); + if (status) { + /* + * One would expect a call to rtems_task_delete() here to clean up + * but there is actually no way (in normal circumstances) that the + * start can fail. The id and starting address are known to be + * be good. If this service fails, something is weirdly wrong on the + * target such as a stray write in an ISR or incorrect memory layout. + */ + _Thread_Enable_dispatch(); + return status; + } + + /* + * We work with the TCB pointer, not the ID, so we need to convert + * to a TCB pointer from here out. + * + * NOTE: Setting the pointer to the Timer Server TCB to a value other than + * NULL indicates that task-based timer support is initialized. + */ + + _Timer_Server = (Thread_Control *)_Objects_Get_local_object( + &_RTEMS_tasks_Information, + _Objects_Get_index(id) + ); + + /* + * A priority of 0, higher than any user task, combined with no preemption + * makes this task the highest priority in any application. It can be + * viewed as a low priority interrupt. The FALSE argument indicates + * that the task is to be appended (not prepended) to its priority + * chain at the end of this operation. + */ + + _Thread_Change_priority( _Timer_Server, 0, FALSE ); + + /* + * Initialize the timer lists that the server will manage. + */ + + _Chain_Initialize_empty( &_Timer_Ticks_chain ); + _Chain_Initialize_empty( &_Timer_Seconds_chain ); + + /* + * Initialize the timers that will be used to control when the + * Timer Server wakes up and services the task-based timers. + */ + + _Watchdog_Initialize( &_Timer_Server->Timer, _Thread_Delay_ended, id, NULL ); + _Watchdog_Initialize( &_Timer_Seconds_timer, _Thread_Delay_ended, id, NULL ); + + _Thread_Enable_dispatch(); + return RTEMS_SUCCESSFUL; +} + +/*PAGE + * + * _Timer_Server_reset + * + * This routine resets the timers which determine when the Timer Server + * will wake up next to service task-based timers. + * + * Input parameters: + * do_ticks - TRUE indicates to process the ticks list + * FALSE indicates to process the seconds list + * + * Output parameters: NONE + */ + +void _Timer_Server_reset( + Timer_Server_reset_mode reset_mode +) +{ + Watchdog_Interval units; + + switch ( reset_mode ) { + case TIMER_SERVER_RESET_TICKS: + _Watchdog_Remove( &_Timer_Server->Timer ); + units = ((Watchdog_Control *)_Timer_Ticks_chain.first)->delta_interval; + _Watchdog_Insert_ticks( &_Timer_Server->Timer, units ); + break; + case TIMER_SERVER_RESET_SECONDS: + _Watchdog_Remove( &_Timer_Seconds_timer ); + units = ((Watchdog_Control *)_Timer_Seconds_chain.first)->delta_interval; + _Watchdog_Insert_seconds( &_Timer_Seconds_timer, units ); + break; + } +} + diff --git a/cpukit/rtems/src/timerserverfireafter.c b/cpukit/rtems/src/timerserverfireafter.c new file mode 100644 index 0000000000..32b42b77ce --- /dev/null +++ b/cpukit/rtems/src/timerserverfireafter.c @@ -0,0 +1,79 @@ +/* + * Timer Manager - rtems_timer_server fire_after directive + * + * + * COPYRIGHT (c) 1989-2002. + * On-Line Applications Research Corporation (OAR). + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.OARcorp.com/rtems/license.html. + * + * $Id$ + */ + +#include +#include +#include +#include +#include +#include +#include +#include + +/*PAGE + * + * rtems_timer_server_fire_after + * + * This directive allows a thread to start a timer which will by + * executed by the Timer Server when it fires. + * + * Input parameters: + * id - timer id + * ticks - interval until routine is fired + * routine - routine to schedule + * user_data - passed as argument to routine when it is fired + * + * Output parameters: + * RTEMS_SUCCESSFUL - if successful + * error code - if unsuccessful + */ + +rtems_status_code rtems_timer_server_fire_after( + Objects_Id id, + rtems_interval ticks, + rtems_timer_service_routine_entry routine, + void *user_data +) +{ + Timer_Control *the_timer; + Objects_Locations location; + extern Chain_Control _Timer_Ticks_chain; + + if ( !_Timer_Server ) + return RTEMS_INCORRECT_STATE; + + if ( ticks == 0 ) + return RTEMS_INVALID_NUMBER; + + the_timer = _Timer_Get( id, &location ); + switch ( location ) { + case OBJECTS_REMOTE: /* should never return this */ + return RTEMS_INTERNAL_ERROR; + + case OBJECTS_ERROR: + return RTEMS_INVALID_ID; + + case OBJECTS_LOCAL: + (void) _Watchdog_Remove( &the_timer->Ticker ); + the_timer->the_class = TIMER_INTERVAL_ON_TASK; + _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); + the_timer->Ticker.initial = ticks; + _Watchdog_Insert( &_Timer_Ticks_chain, &the_timer->Ticker ); + _Timer_Server_reset( TIMER_SERVER_RESET_TICKS ); + _Thread_Enable_dispatch(); + return RTEMS_SUCCESSFUL; + } + + return RTEMS_INTERNAL_ERROR; /* unreached - only to remove warnings */ +} diff --git a/cpukit/rtems/src/timerserverfirewhen.c b/cpukit/rtems/src/timerserverfirewhen.c new file mode 100644 index 0000000000..6309315a75 --- /dev/null +++ b/cpukit/rtems/src/timerserverfirewhen.c @@ -0,0 +1,87 @@ +/* + * Timer Manager - rtems_timer_server fire_when directive + * + * + * COPYRIGHT (c) 1989-2002. + * On-Line Applications Research Corporation (OAR). + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.OARcorp.com/rtems/license.html. + * + * $Id$ + */ + +#include +#include +#include +#include +#include +#include +#include +#include + +/*PAGE + * + * rtems_timer_server_fire_when + * + * This directive allows a thread to start a timer which will by + * executed by the Timer Server when it fires. + * + * Input parameters: + * id - timer id + * wall_time - time of day to fire timer + * routine - routine to schedule + * user_data - passed as argument to routine when it is fired + * + * Output parameters: + * RTEMS_SUCCESSFUL - if successful + * error code - if unsuccessful + */ + +rtems_status_code rtems_timer_server_fire_when( + Objects_Id id, + rtems_time_of_day *wall_time, + rtems_timer_service_routine_entry routine, + void *user_data +) +{ + Timer_Control *the_timer; + Objects_Locations location; + rtems_interval seconds; + extern Chain_Control _Timer_Seconds_chain; + + if ( !_Timer_Server ) + return RTEMS_INCORRECT_STATE; + + if ( !_TOD_Is_set ) + return RTEMS_NOT_DEFINED; + + if ( !_TOD_Validate( wall_time ) ) + return RTEMS_INVALID_CLOCK; + + seconds = _TOD_To_seconds( wall_time ); + if ( seconds <= _TOD_Seconds_since_epoch ) + return RTEMS_INVALID_CLOCK; + + the_timer = _Timer_Get( id, &location ); + switch ( location ) { + case OBJECTS_REMOTE: /* should never return this */ + return RTEMS_INTERNAL_ERROR; + + case OBJECTS_ERROR: + return RTEMS_INVALID_ID; + + case OBJECTS_LOCAL: + (void) _Watchdog_Remove( &the_timer->Ticker ); + the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; + _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); + the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch; + _Watchdog_Insert( &_Timer_Seconds_chain, &the_timer->Ticker ); + _Timer_Server_reset( TIMER_SERVER_RESET_SECONDS ); + _Thread_Enable_dispatch(); + return RTEMS_SUCCESSFUL; + } + + return RTEMS_INTERNAL_ERROR; /* unreached - only to remove warnings */ +} -- cgit v1.2.3