blob: 51ab42f5d6e3681d2c72ebd11d50646ac5a8203f (
plain) (
tree)
|
|
/*
* COPYRIGHT (c) 1989-2009.
* 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.rtems.org/license/LICENSE.
*/
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include <tmacros.h>
#include <intrcritical.h>
#define INTERRUPT_CRITICAL_NAME rtems_build_name( 'I', 'C', 'R', 'I' )
typedef struct {
uint_fast32_t minimum;
uint_fast32_t maximum;
uint_fast32_t maximum_current;
rtems_timer_service_routine_entry tsr;
rtems_id timer;
uint64_t t0;
uint64_t t1;
} interrupt_critical_control;
static interrupt_critical_control interrupt_critical;
static void wait_for_tick_change( void )
{
rtems_interval initial = rtems_clock_get_ticks_since_boot();
rtems_interval now;
do {
now = rtems_clock_get_ticks_since_boot();
} while ( now == initial );
}
static bool interrupt_critical_busy_wait( void )
{
uint_fast32_t max = interrupt_critical.maximum_current;
bool reset = max <= interrupt_critical.minimum;
if ( reset ) {
interrupt_critical.maximum_current = interrupt_critical.maximum;
} else {
interrupt_critical.maximum_current = max - 1;
}
rtems_test_busy( max );
return reset;
}
void interrupt_critical_section_test_support_initialize(
rtems_timer_service_routine_entry tsr
)
{
uint_fast32_t m;
interrupt_critical.tsr = tsr;
if ( tsr != NULL && interrupt_critical.timer == 0 ) {
rtems_status_code sc = rtems_timer_create(
INTERRUPT_CRITICAL_NAME,
&interrupt_critical.timer
);
rtems_test_assert( sc == RTEMS_SUCCESSFUL );
}
m = rtems_test_get_one_tick_busy_count();
interrupt_critical.minimum = 0;
interrupt_critical.maximum = m;
interrupt_critical.maximum_current = m;
}
static void timer_fire_after(void)
{
if ( interrupt_critical.tsr != NULL ) {
rtems_status_code sc = rtems_timer_fire_after(
interrupt_critical.timer,
1,
interrupt_critical.tsr,
NULL
);
rtems_test_assert( sc == RTEMS_SUCCESSFUL );
}
}
bool interrupt_critical_section_test_support_delay(void)
{
timer_fire_after();
return interrupt_critical_busy_wait();
}
static void thread_switch( Thread_Control *executing, Thread_Control *heir )
{
(void) executing;
(void) heir;
if ( interrupt_critical.t1 == 0 && heir->is_idle ) {
interrupt_critical.t1 = rtems_clock_get_uptime_nanoseconds();
}
}
static const rtems_extensions_table extensions = {
.thread_switch = thread_switch
};
bool interrupt_critical_section_test(
bool ( *test_body )( void * ),
void *test_body_arg,
rtems_timer_service_routine_entry tsr
)
{
bool done;
rtems_status_code sc;
rtems_id id;
uint64_t delta;
uint_fast32_t busy_delta;
int retries = 3;
interrupt_critical_section_test_support_initialize( tsr );
sc = rtems_extension_create(
INTERRUPT_CRITICAL_NAME,
&extensions,
&id
);
rtems_test_assert( sc == RTEMS_SUCCESSFUL );
wait_for_tick_change();
timer_fire_after();
/* Get estimate for test body duration */
interrupt_critical.t0 = rtems_clock_get_uptime_nanoseconds();
done = ( *test_body )( test_body_arg );
if ( interrupt_critical.t1 == 0 ) {
interrupt_critical.t1 = rtems_clock_get_uptime_nanoseconds();
}
/* Update minimum */
delta = interrupt_critical.t1 - interrupt_critical.t0;
busy_delta = (uint_fast32_t)
( ( interrupt_critical.maximum * ( 2 * delta ) )
/ rtems_configuration_get_nanoseconds_per_tick() );
if ( busy_delta < interrupt_critical.maximum ) {
interrupt_critical.minimum = interrupt_critical.maximum - busy_delta;
}
sc = rtems_extension_delete( id );
rtems_test_assert( sc == RTEMS_SUCCESSFUL );
while ( !done && retries >= 0 ) {
wait_for_tick_change();
if ( interrupt_critical_section_test_support_delay() ) {
--retries;
}
done = ( *test_body )( test_body_arg );
}
return done;
}
|