mirror of
https://gitlab.rtems.org/rtems/rtos/rtems.git
synced 2025-12-27 06:58:19 +00:00
2001-01-16 Joel Sherrill <joel@OARcorp.com>
* 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.
This commit is contained in:
Joel Sherrill
288
c/src/exec/rtems/src/timerserver.c
Normal file
288
c/src/exec/rtems/src/timerserver.c
Normal file
@@ -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 <rtems/system.h>
|
||||
#include <rtems/rtems/status.h>
|
||||
#include <rtems/rtems/support.h>
|
||||
#include <rtems/score/object.h>
|
||||
#include <rtems/score/thread.h>
|
||||
#include <rtems/rtems/timer.h>
|
||||
#include <rtems/score/tod.h>
|
||||
#include <rtems/score/watchdog.h>
|
||||
|
||||
#include <rtems/rtems/tasks.h>
|
||||
#include <rtems/score/thread.h>
|
||||
|
||||
/*
|
||||
* 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;
|
||||
}
|
||||
}
|
||||
|
||||
79
c/src/exec/rtems/src/timerserverfireafter.c
Normal file
79
c/src/exec/rtems/src/timerserverfireafter.c
Normal file
@@ -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 <rtems/system.h>
|
||||
#include <rtems/rtems/status.h>
|
||||
#include <rtems/rtems/support.h>
|
||||
#include <rtems/score/object.h>
|
||||
#include <rtems/score/thread.h>
|
||||
#include <rtems/rtems/timer.h>
|
||||
#include <rtems/score/tod.h>
|
||||
#include <rtems/score/watchdog.h>
|
||||
|
||||
/*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 */
|
||||
}
|
||||
87
c/src/exec/rtems/src/timerserverfirewhen.c
Normal file
87
c/src/exec/rtems/src/timerserverfirewhen.c
Normal file
@@ -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 <rtems/system.h>
|
||||
#include <rtems/rtems/status.h>
|
||||
#include <rtems/rtems/support.h>
|
||||
#include <rtems/score/object.h>
|
||||
#include <rtems/score/thread.h>
|
||||
#include <rtems/rtems/timer.h>
|
||||
#include <rtems/score/tod.h>
|
||||
#include <rtems/score/watchdog.h>
|
||||
|
||||
/*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 */
|
||||
}
|
||||
288
cpukit/rtems/src/timerserver.c
Normal file
288
cpukit/rtems/src/timerserver.c
Normal file
@@ -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 <rtems/system.h>
|
||||
#include <rtems/rtems/status.h>
|
||||
#include <rtems/rtems/support.h>
|
||||
#include <rtems/score/object.h>
|
||||
#include <rtems/score/thread.h>
|
||||
#include <rtems/rtems/timer.h>
|
||||
#include <rtems/score/tod.h>
|
||||
#include <rtems/score/watchdog.h>
|
||||
|
||||
#include <rtems/rtems/tasks.h>
|
||||
#include <rtems/score/thread.h>
|
||||
|
||||
/*
|
||||
* 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;
|
||||
}
|
||||
}
|
||||
|
||||
79
cpukit/rtems/src/timerserverfireafter.c
Normal file
79
cpukit/rtems/src/timerserverfireafter.c
Normal file
@@ -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 <rtems/system.h>
|
||||
#include <rtems/rtems/status.h>
|
||||
#include <rtems/rtems/support.h>
|
||||
#include <rtems/score/object.h>
|
||||
#include <rtems/score/thread.h>
|
||||
#include <rtems/rtems/timer.h>
|
||||
#include <rtems/score/tod.h>
|
||||
#include <rtems/score/watchdog.h>
|
||||
|
||||
/*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 */
|
||||
}
|
||||
87
cpukit/rtems/src/timerserverfirewhen.c
Normal file
87
cpukit/rtems/src/timerserverfirewhen.c
Normal file
@@ -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 <rtems/system.h>
|
||||
#include <rtems/rtems/status.h>
|
||||
#include <rtems/rtems/support.h>
|
||||
#include <rtems/score/object.h>
|
||||
#include <rtems/score/thread.h>
|
||||
#include <rtems/rtems/timer.h>
|
||||
#include <rtems/score/tod.h>
|
||||
#include <rtems/score/watchdog.h>
|
||||
|
||||
/*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 */
|
||||
}
|
||||
Reference in New Issue
Block a user