rtems_task Init(
rtems_task_argument argument
)
{
rtems_status_code status;
puts( "\n\n*** TEST 2 ***" );
Preempt_task_name = rtems_build_name( 'P', 'R', 'M', 'T' );
status = rtems_task_create(
Preempt_task_name,
1,
RTEMS_MINIMUM_STACK_SIZE,
RTEMS_DEFAULT_MODES,
RTEMS_DEFAULT_ATTRIBUTES,
&Preempt_task_id
);
directive_failed( status, "rtems_task_create of RTEMS_PREEMPT" );
status = rtems_task_start( Preempt_task_id, Preempt_task, 0 );
directive_failed( status, "rtems_task_start of RTEMS_PREEMPT" );
puts( "INIT - rtems_task_wake_after - yielding processor" );
status = rtems_task_wake_after( RTEMS_YIELD_PROCESSOR );
directive_failed( status, "rtems_task_wake_after" );
Task_name[ 1 ] = rtems_build_name( 'T', 'A', '1', ' ' );
Task_name[ 2 ] = rtems_build_name( 'T', 'A', '2', ' ' );
Task_name[ 3 ] = rtems_build_name( 'T', 'A', '3', ' ' );
status = rtems_task_create(
Task_name[ 1 ],
3,
RTEMS_MINIMUM_STACK_SIZE,
RTEMS_DEFAULT_MODES,
RTEMS_DEFAULT_ATTRIBUTES,
&Task_id[ 1 ]
);
directive_failed( status, "rtems_task_create of TA1" );
status = rtems_task_create(
Task_name[ 2 ],
3,
RTEMS_MINIMUM_STACK_SIZE,
RTEMS_DEFAULT_MODES,
RTEMS_DEFAULT_ATTRIBUTES,
&Task_id[ 2 ]
);
directive_failed( status, "rtems_task_create of TA2" );
status = rtems_task_create(
Task_name[ 3 ],
3,
RTEMS_MINIMUM_STACK_SIZE,
RTEMS_DEFAULT_MODES,
RTEMS_DEFAULT_ATTRIBUTES,
&Task_id[ 3 ]
);
directive_failed( status, "rtems_task_create of TA3" );
status = rtems_task_start( Task_id[ 1 ], Task_1, 0 );
directive_failed( status, "rtems_task_start of TA1" );
status = rtems_task_start( Task_id[ 2 ], Task_2, 0 );
directive_failed( status, "rtems_task_start of TA2" );
status = rtems_task_start( Task_id[ 3 ], Task_3, 0 );
directive_failed( status, "rtems_task_start of TA3" );
puts( "INIT - suspending TA2 while middle task on a ready chain" );
status = rtems_task_suspend( Task_id[ 2 ] );
directive_failed( status, "rtems_task_suspend of TA2" );
status = rtems_task_delete( Task_id[ 1 ] );
directive_failed( status, "rtems_task_delete of TA1" );
status = rtems_task_delete( Task_id[ 2 ] );
directive_failed( status, "rtems_task_delete of TA2" );
status = rtems_task_delete( Task_id[ 3 ] );
directive_failed( status, "rtems_task_delete of TA3" );
status = rtems_task_create(
Task_name[ 1 ],
1,
RTEMS_MINIMUM_STACK_SIZE,
RTEMS_DEFAULT_MODES,
RTEMS_DEFAULT_ATTRIBUTES,
&Task_id[ 1 ]
);
directive_failed( status, "rtems_task_create of TA1" );
status = rtems_task_create(
Task_name[ 2 ],
3,
RTEMS_MINIMUM_STACK_SIZE,
RTEMS_DEFAULT_MODES,
RTEMS_DEFAULT_ATTRIBUTES,
&Task_id[ 2 ]
);
directive_failed( status, "rtems_task_create of TA2" );
status = rtems_task_create(
Task_name[ 3 ],
3,
RTEMS_MINIMUM_STACK_SIZE,
RTEMS_DEFAULT_MODES,
RTEMS_DEFAULT_ATTRIBUTES,
&Task_id[ 3 ]
);
directive_failed( status, "rtems_task_create of TA3" );
status = rtems_task_start( Task_id[ 1 ], Task_1, 0 );
directive_failed( status, "rtems_task_start of TA1" );
status = rtems_task_start( Task_id[ 2 ], Task_2, 0 );
directive_failed( status, "rtems_task_start of TA2" );
status = rtems_task_start( Task_id[ 3 ], Task_3, 0 );
directive_failed( status, "rtems_task_start of TA3" );
status = rtems_task_delete( RTEMS_SELF );
directive_failed( status, "rtems_task_delete of RTEMS_SELF" );
}
rtems_task Task_Periodic(
rtems_task_argument argument
)
{
rtems_id rmid;
rtems_status_code status;
time_t approved_budget, exec_time, abs_time, remaining_budget;
int start, stop, now;
rtems_cbs_server_id server_id, tsid;
rtems_cbs_parameters params, tparams;
params.deadline = Period;
params.budget = Execution+1;
/* Taks 1 will be attached to a server, task 2 not. */
if ( argument == 1 ) {
printf( "Periodic task: Create server and Attach thread\n" );
if ( rtems_cbs_create_server( ¶ms, NULL, &server_id ) )
printf( "ERROR: CREATE SERVER FAILED\n" );
if ( rtems_cbs_attach_thread( server_id, Task_id ) )
printf( "ERROR: ATTACH THREAD FAILED\n" );
printf( "Periodic task: ID and Get parameters\n" );
if ( rtems_cbs_get_server_id( Task_id, &tsid ) )
printf( "ERROR: GET SERVER ID FAILED\n" );
if ( tsid != server_id )
printf( "ERROR: SERVER ID MISMATCH\n" );
if ( rtems_cbs_get_parameters( server_id, &tparams ) )
printf( "ERROR: GET PARAMETERS FAILED\n" );
if ( params.deadline != tparams.deadline ||
params.budget != tparams.budget )
printf( "ERROR: PARAMETERS MISMATCH\n" );
printf( "Periodic task: Detach thread and Destroy server\n" );
if ( rtems_cbs_detach_thread( server_id, Task_id ) )
printf( "ERROR: DETACH THREAD FAILED\n" );
if ( rtems_cbs_destroy_server( server_id ) )
printf( "ERROR: DESTROY SERVER FAILED\n" );
if ( rtems_cbs_create_server( ¶ms, NULL, &server_id ) )
printf( "ERROR: CREATE SERVER FAILED\n" );
printf( "Periodic task: Remaining budget and Execution time\n" );
if ( rtems_cbs_get_remaining_budget( server_id, &remaining_budget ) )
printf( "ERROR: GET REMAINING BUDGET FAILED\n" );
if ( remaining_budget != params.budget )
printf( "ERROR: REMAINING BUDGET MISMATCH\n" );
if ( rtems_cbs_get_execution_time( server_id, &exec_time, &abs_time ) )
printf( "ERROR: GET EXECUTION TIME FAILED\n" );
printf( "Periodic task: Set parameters\n" );
if ( rtems_cbs_attach_thread( server_id, Task_id ) )
printf( "ERROR: ATTACH THREAD FAILED\n" );
params.deadline = Period * 2;
params.budget = Execution * 2 +1;
if ( rtems_cbs_set_parameters( server_id, ¶ms ) )
printf( "ERROR: SET PARAMS FAILED\n" );
if ( rtems_cbs_get_parameters( server_id, &tparams ) )
printf( "ERROR: GET PARAMS FAILED\n" );
if ( params.deadline != tparams.deadline ||
params.budget != tparams.budget )
printf( "ERROR: PARAMS MISMATCH\n" );
params.deadline = Period;
params.budget = Execution+1;
if ( rtems_cbs_set_parameters( server_id, ¶ms ) )
printf( "ERROR: SET PARAMS FAILED\n" );
if ( rtems_cbs_get_approved_budget( server_id, &approved_budget ) )
printf( "ERROR: GET APPROVED BUDGET FAILED\n" );
printf( "Periodic task: Approved budget\n" );
if ( approved_budget != params.budget )
printf( "ERROR: APPROVED BUDGET MISMATCH\n" );
}
status = rtems_rate_monotonic_create( argument, &rmid );
directive_failed( status, "rtems_rate_monotonic_create" );
/* Starting periodic behavior of the task */
printf( "Periodic task: Starting periodic behavior\n" );
status = rtems_task_wake_after( 1 + Phase );
directive_failed( status, "rtems_task_wake_after" );
while ( FOREVER ) {
if ( rtems_rate_monotonic_period(rmid, Period) == RTEMS_TIMEOUT )
printf( "P%" PRIdPTR " - Deadline miss\n", argument );
rtems_clock_get( RTEMS_CLOCK_GET_TICKS_SINCE_BOOT, &start );
printf( "P%" PRIdPTR "-S ticks:%d\n", argument, start );
if ( start > 4*Period+Phase ) break; /* stop */
/* active computing */
while(FOREVER) {
rtems_clock_get( RTEMS_CLOCK_GET_TICKS_SINCE_BOOT, &now );
if ( now >= start + Execution ) break;
if ( rtems_cbs_get_execution_time( server_id, &exec_time, &abs_time ) )
printf( "ERROR: GET EXECUTION TIME FAILED\n" );
if ( rtems_cbs_get_remaining_budget( server_id, &remaining_budget) )
printf( "ERROR: GET REMAINING BUDGET FAILED\n" );
if ( (remaining_budget + exec_time) > (Execution + 1) ) {
printf( "ERROR: REMAINING BUDGET AND EXECUTION TIME MISMATCH\n" );
rtems_test_exit( 0 );
}
}
rtems_clock_get( RTEMS_CLOCK_GET_TICKS_SINCE_BOOT, &stop );
printf( "P%" PRIdPTR "-F ticks:%d\n", argument, stop );
}
/* delete period and SELF */
status = rtems_rate_monotonic_delete( rmid );
if ( status != RTEMS_SUCCESSFUL ) {
printf("rtems_rate_monotonic_delete failed with status of %d.\n", status);
rtems_test_exit( 0 );
}
printf( "Periodic task: Deleting self\n" );
status = rtems_task_delete( RTEMS_SELF );
directive_failed( status, "rtems_task_delete of RTEMS_SELF" );
}
void __po_hi_gqueue_wait_for_incoming_event (__po_hi_task_id id,
__po_hi_local_port_t* port)
{
#ifdef RTEMS_PURE
rtems_status_code ret;
#endif
#ifdef _WIN32
DWORD ret;
#endif
#if defined (POSIX) || defined (RTEMS_POSIX) || defined (XENO_POSIX)
int error = pthread_mutex_lock (&__po_hi_gqueues_mutexes[id]);
__DEBUGMSG("*** Locking (%d) %d\n", id, error);
#elif defined (XENO_NATIVE)
rt_mutex_acquire (&__po_hi_gqueues_mutexes[id], TM_INFINITE);
#elif defined (RTEMS_PURE)
ret = rtems_semaphore_obtain (__po_hi_gqueues_semaphores[id], RTEMS_WAIT, RTEMS_NO_TIMEOUT);
if (ret != RTEMS_SUCCESSFUL)
{
__DEBUGMSG ("[GQUEUE] Cannot obtain semaphore in __po_hi_gqueue_store_in()\n");
}
#elif defined (_WIN32)
EnterCriticalSection(&__po_hi_gqueues_cs[id]);
#endif
while(__po_hi_gqueues_queue_is_empty[id] == 1)
{
__PO_HI_INSTRUMENTATION_VCD_WRITE("0t%d\n", id);
#if defined (POSIX) || defined (RTEMS_POSIX) || defined (XENO_POSIX)
__DEBUGMSG("*** Waiting (%d)\n", id);
int error = pthread_cond_wait (&__po_hi_gqueues_conds[id],
&__po_hi_gqueues_mutexes[id]);
__DEBUGMSG("*** Done Waiting (%d) %d\n", id, error);
#elif defined (XENO_NATIVE)
rt_cond_wait (&__po_hi_gqueues_conds[id], &__po_hi_gqueues_mutexes[id], TM_INFINITE);
#elif defined (RTEMS_PURE)
ret = rtems_semaphore_release (__po_hi_gqueues_semaphores[id]);
if (ret != RTEMS_SUCCESSFUL)
{
__DEBUGMSG ("[GQUEUE] Cannot obtain semaphore in __po_hi_gqueue_store_in()\n");
}
rtems_task_wake_after (1);
ret = rtems_semaphore_obtain (__po_hi_gqueues_semaphores[id], RTEMS_WAIT, RTEMS_NO_TIMEOUT);
if (ret != RTEMS_SUCCESSFUL)
{
__DEBUGMSG ("[GQUEUE] Cannot obtain semaphore in __po_hi_gqueue_store_in()\n");
}
else
{
__PO_HI_DEBUG_CRITICAL ("[GQUEUE] semaphore %d obtained\n", id);
}
#elif defined (_WIN32)
LeaveCriticalSection(&__po_hi_gqueues_cs[id]);
ret = WaitForSingleObject (__po_hi_gqueues_events[id], INFINITE);
if (ret == WAIT_FAILED)
{
__PO_HI_DEBUG_DEBUG ("[GQUEUE] Wait failed\n");
}
EnterCriticalSection(&__po_hi_gqueues_cs[id]);
#endif
__PO_HI_INSTRUMENTATION_VCD_WRITE("1t%d\n", id);
}
__DEBUGMSG ("[GQUEUE] Gogo kiki\n");
*port = __po_hi_gqueues_global_history[id][__po_hi_gqueues_global_history_offset[id]];
#if defined (POSIX) || defined (RTEMS_POSIX) || defined (XENO_POSIX)
pthread_mutex_unlock (&__po_hi_gqueues_mutexes[id]);
#elif defined (XENO_NATIVE)
rt_mutex_release (&__po_hi_gqueues_mutexes[id]);
#elif defined (_WIN32)
LeaveCriticalSection(&__po_hi_gqueues_cs[id]);
#elif defined (RTEMS_PURE)
ret = rtems_semaphore_release (__po_hi_gqueues_semaphores[id]);
if (ret != RTEMS_SUCCESSFUL)
{
__DEBUGMSG ("[GQUEUE] Cannot release semaphore in __po_hi_gqueue_store_in()\n");
}
__PO_HI_DEBUG_CRITICAL ("[GQUEUE] semaphore %d released\n", id);
#endif
}
rtems_task Task_1(
rtems_task_argument argument
)
{
rtems_id rnid;
void *segment_address_1;
void *segment_address_2;
void *segment_address_3;
void *segment_address_4;
rtems_status_code status;
status = rtems_region_ident( Region_name[ 1 ], &rnid );
printf( "TA1 - rtems_region_ident - rnid => %08" PRIxrtems_id "\n", rnid );
directive_failed( status, "rtems_region_ident of RN1" );
puts(
"TA1 - rtems_region_get_segment - wait on 100 byte segment from region 2"
);
status = rtems_region_get_segment(
Region_id[ 2 ],
100,
RTEMS_DEFAULT_OPTIONS,
RTEMS_NO_TIMEOUT,
&segment_address_1
);
directive_failed( status, "rtems_region_get_segment" );
puts_nocr( "TA1 - got segment from region 2 - " );
Put_address_from_area_2( segment_address_1 );
new_line;
puts( "TA1 - rtems_region_get_segment - wait on 3K segment from region 3" );
status = rtems_region_get_segment(
Region_id[ 3 ],
3072,
RTEMS_DEFAULT_OPTIONS,
RTEMS_NO_TIMEOUT,
&segment_address_2
);
directive_failed( status, "rtems_region_get_segment" );
puts_nocr( "TA1 - got segment from region 3 - " );
Put_address_from_area_3( segment_address_2 );
new_line;
puts_nocr( "TA1 - rtems_region_get_segment - get 3080 byte segment " );
puts ( "from region 1 - NO_WAIT" );
status = rtems_region_get_segment(
Region_id[ 1 ],
3080,
RTEMS_NO_WAIT,
RTEMS_NO_TIMEOUT,
&segment_address_3
);
directive_failed( status, "rtems_region_get_segment" );
puts_nocr( "TA1 - got segment from region 1 - " );
Put_address_from_area_1( segment_address_3 );
new_line;
puts( "TA1 - rtems_task_wake_after - yield processor" );
status = rtems_task_wake_after( RTEMS_YIELD_PROCESSOR );
directive_failed( status, "rtems_task_wake_after" );
rtems_test_pause();
puts_nocr(
"TA1 - rtems_region_return_segment - return segment to region 1 - "
);
Put_address_from_area_1( segment_address_3 );
status = rtems_region_return_segment( Region_id[ 1 ], segment_address_3 );
directive_failed( status, "rtems_region_return_segment" );
new_line;
puts(
"TA1 - rtems_region_get_segment - wait 10 seconds for 3K "
"segment from region 1"
);
status = rtems_region_get_segment(
Region_id[ 1 ],
3072,
RTEMS_DEFAULT_OPTIONS,
10 * rtems_clock_get_ticks_per_second(),
&segment_address_4
);
directive_failed( status, "rtems_region_get_segment" );
puts_nocr( "TA1 - got segment from region 1 - " );
Put_address_from_area_1( segment_address_4 );
new_line;
puts_nocr(
"TA1 - rtems_region_return_segment - return segment to region 2 - "
);
Put_address_from_area_2( segment_address_1 );
new_line;
status = rtems_region_return_segment( Region_id[ 2 ], segment_address_1 );
directive_failed( status, "rtems_region_return_segment" );
puts( "TA1 - rtems_task_wake_after - yield processor" );
status = rtems_task_wake_after( RTEMS_YIELD_PROCESSOR );
directive_failed( status, "rtems_task_wake_after" );
puts( "TA1 - rtems_task_delete - delete TA3" );
status = rtems_task_delete( Task_id[ 3 ] );
directive_failed( status, "rtems_task_delete of TA3" );
rtems_test_pause();
status = rtems_task_create(
Task_name[ 4 ],
BASE_PRIORITY,
RTEMS_MINIMUM_STACK_SIZE,
RTEMS_DEFAULT_MODES,
RTEMS_DEFAULT_ATTRIBUTES,
&Task_id[ 4 ]
);
directive_failed( status, "rtems_task_create of TA4" );
status = rtems_task_create(
Task_name[ 5 ],
BASE_PRIORITY,
RTEMS_MINIMUM_STACK_SIZE,
RTEMS_DEFAULT_MODES,
RTEMS_DEFAULT_ATTRIBUTES,
&Task_id[ 5 ]
);
directive_failed( status, "rtems_task_create of TA5" );
status = rtems_task_start( Task_id[ 4 ], Task_4, 0 );
directive_failed( status, "rtems_task_start of TA4" );
status = rtems_task_start( Task_id[ 5 ], Task5, 0 );
directive_failed( status, "rtems_task_start of TA5" );
puts( "TA1 - rtems_task_wake_after - yield processor" );
status = rtems_task_wake_after( 1 * rtems_clock_get_ticks_per_second() );
directive_failed( status, "rtems_task_wake_after" );
puts_nocr(
"TA1 - rtems_region_return_segment - return segment to region 1 - "
);
Put_address_from_area_1( segment_address_4 );
status = rtems_region_return_segment( Region_id[ 1 ], segment_address_4 );
directive_failed( status, "rtems_region_return_segment" );
new_line;
puts( "TA1 - rtems_task_wake_after - yield processor" );
status = rtems_task_wake_after( 1 * rtems_clock_get_ticks_per_second() );
directive_failed( status, "rtems_task_wake_after" );
puts_nocr( "TA1 - rtems_region_get_segment - wait 10 seconds for 3K " );
puts ( "segment from region 1");
status = rtems_region_get_segment(
Region_id[ 1 ],
3072,
RTEMS_DEFAULT_OPTIONS,
10 * rtems_clock_get_ticks_per_second(),
&segment_address_4
);
directive_failed( status, "rtems_region_get_segment" );
puts_nocr( "TA1 - got segment from region 1 - " );
Put_address_from_area_1( segment_address_4 );
new_line;
puts( "TA1 - rtems_task_wake_after - yield processor" );
status = rtems_task_wake_after( 1 * rtems_clock_get_ticks_per_second() );
directive_failed( status, "rtems_task_wake_after" );
puts( "TA1 - rtems_task_delete - delete TA4" );
status = rtems_task_delete( Task_id[ 4 ] );
directive_failed( status, "rtems_task_delete of TA4" );
puts_nocr(
"TA1 - rtems_region_return_segment - return segment to region 1 - "
);
Put_address_from_area_1( segment_address_4 );
status = rtems_region_return_segment( Region_id[ 1 ], segment_address_4 );
directive_failed( status, "rtems_region_return_segment" );
new_line;
puts( "TA1 - rtems_task_wake_after - yield processor" );
status = rtems_task_wake_after( RTEMS_YIELD_PROCESSOR );
puts( "TA1 - rtems_region_delete - delete region 1" );
status = rtems_region_delete( Region_id[ 1 ] );
directive_failed( status, "rtems_region_delete" );
puts( "TA1 - rtems_region_get_segment - get 3K segment from region 4" );
status = rtems_region_get_segment(
Region_id[ 4 ],
3072,
RTEMS_DEFAULT_OPTIONS,
RTEMS_NO_TIMEOUT,
&segment_address_1
);
directive_failed( status, "rtems_region_get_segment" );
puts_nocr( "TA1 - got segment from region 4 - " );
Put_address_from_area_4( segment_address_1 );
new_line;
puts(
"TA1 - rtems_region_get_segment - attempt to get 3K segment from region 4"
);
status = rtems_region_get_segment(
Region_id[ 4 ],
3072,
RTEMS_NO_WAIT,
RTEMS_NO_TIMEOUT,
&segment_address_2
);
fatal_directive_status(
status,
RTEMS_UNSATISFIED,
"rtems_region_get_segment with no memory left"
);
puts( "TA1 - rtems_region_get_segment - RTEMS_UNSATISFIED" );
puts( "TA1 - rtems_region_extend - extend region 4 by 1" );
status = rtems_region_extend(
Region_id[ 4 ],
&Area_4[4096],
1
);
fatal_directive_status(
status,
RTEMS_INVALID_ADDRESS,
"rtems_region_extend with too small memory area"
);
puts( "TA1 - rtems_region_extend - RTEMS_INVALID_ADDRESS" );
puts( "TA1 - rtems_region_extend - extend region 4 by 4K - 1" );
status = rtems_region_extend(
Region_id[ 4 ],
(char *) &Area_4[4096] + 1,
4096 - 1
);
directive_failed( status, "rtems_region_extend" );
puts(
"TA1 - rtems_region_get_segment - attempt to get 3K segment from region 4"
);
status = rtems_region_get_segment(
Region_id[ 4 ],
3072,
RTEMS_NO_WAIT,
RTEMS_NO_TIMEOUT,
&segment_address_3
);
directive_failed( status, "rtems_region_get_segment" );
puts_nocr( "TA1 - got 3K segment from region 4 - " );
Put_address_from_area_4( segment_address_3 );
new_line;
puts_nocr(
"TA1 - rtems_region_return_segment - return segment to region 4 - "
);
Put_address_from_area_4( segment_address_1 );
status = rtems_region_return_segment( Region_id[ 4 ], segment_address_1 );
directive_failed( status, "rtems_region_return_segment" );
new_line;
puts_nocr(
"TA1 - rtems_region_return_segment - return segment to region 4 - "
);
Put_address_from_area_4( segment_address_3 );
status = rtems_region_return_segment( Region_id[ 4 ], segment_address_3 );
directive_failed( status, "rtems_region_return_segment" );
new_line;
puts( "TA1 - rtems_region_delete - delete region 4" );
status = rtems_region_delete( Region_id[ 4 ] );
directive_failed( status, "rtems_region_delete" );
puts( "*** END OF TEST 16 ***" );
rtems_test_exit( 0 );
}
/*
* sh4uart_set_attributes --
* This function parse the termios attributes structure and perform
* the appropriate settings in hardware.
*
* PARAMETERS:
* uart - pointer to the UART descriptor structure
* t - pointer to termios parameters
*
* RETURNS:
* RTEMS_SUCCESSFUL
*/
rtems_status_code
sh4uart_set_attributes(sh4uart *uart, const struct termios *t)
{
int level;
speed_t baud;
uint16_t smr;
smr = (uint16_t)(*(uint8_t*)SH7750_SCSMR(uart->chn));
baud = cfgetospeed(t);
/* Set flow control XXX*/
if ((t->c_cflag & CRTSCTS) != 0) {
}
/* Set character size -- only 7 or 8 bit */
switch (t->c_cflag & CSIZE) {
case CS5:
case CS6:
case CS7: smr |= SH7750_SCSMR_CHR_7; break;
case CS8: smr &= ~SH7750_SCSMR_CHR_7; break;
}
/* Set number of stop bits */
if ((t->c_cflag & CSTOPB) != 0)
smr |= SH7750_SCSMR_STOP_2;
else
smr &= ~SH7750_SCSMR_STOP_2;
/* Set parity mode */
if ((t->c_cflag & PARENB) != 0) {
smr |= SH7750_SCSMR_PE;
if ((t->c_cflag & PARODD) != 0)
smr |= SH7750_SCSMR_PM_ODD;
else
smr &= ~SH7750_SCSMR_PM_ODD;
} else
smr &= ~SH7750_SCSMR_PE;
rtems_interrupt_disable(level);
/* wait untill all data is transmitted */
/* XXX JOEL says this is broken -- interrupts are OFF so NO ticks */
rtems_task_wake_after(RTEMS_MILLISECONDS_TO_TICKS(100));
if ( uart->chn == 1 ) {
volatile uint8_t *scrP = (volatile uint8_t *)SH7750_SCSCR1;
volatile uint8_t *smrP = (volatile uint8_t *)SH7750_SCSMR1;
*scrP &= ~(SH7750_SCSCR_TE | SH7750_SCSCR_RE); /* disable operations */
sh4uart_set_baudrate(uart, baud);
*smrP = (uint8_t)smr;
*scrP |= SH7750_SCSCR_TE | SH7750_SCSCR_RE; /* enable operations */
} else {
volatile uint16_t *scrP = (volatile uint16_t *)SH7750_SCSCR2;
volatile uint16_t *smrP = (volatile uint16_t *)SH7750_SCSMR2;
*scrP &= ~(SH7750_SCSCR_TE | SH7750_SCSCR_RE); /* disable operations */
sh4uart_set_baudrate(uart, baud);
*smrP = (uint8_t)smr;
*scrP |= SH7750_SCSCR_TE | SH7750_SCSCR_RE; /* enable operations */
}
rtems_interrupt_enable(level);
return RTEMS_SUCCESSFUL;
}
void Screen10()
{
rtems_rate_monotonic_period_status period_status;
rtems_status_code status;
/*
* Check create error cases.
*/
status = rtems_rate_monotonic_create( Period_name[ 1 ], NULL );
fatal_directive_status(
status,
RTEMS_INVALID_ADDRESS,
"rtems_rate_monotonic_create with NULL param"
);
puts( "TA1 - rtems_rate_monotonic_create - RTEMS_INVALID_ADDRESS" );
status = rtems_rate_monotonic_create( 0, &Junk_id );
fatal_directive_status(
status,
RTEMS_INVALID_NAME,
"rtems_rate_monotonic_create with illegal name"
);
puts( "TA1 - rtems_rate_monotonic_create - RTEMS_INVALID_NAME" );
status = rtems_rate_monotonic_create( Period_name[ 1 ], &Period_id[ 1 ] );
directive_failed( status, "rtems_rate_monotonic_create successful" );
puts( "TA1 - rtems_rate_monotonic_create - RTEMS_SUCCESSFUL" );
status = rtems_rate_monotonic_create( Period_name[ 1 ], &Junk_id );
fatal_directive_status(
status,
RTEMS_TOO_MANY,
"rtems_rate_monotonic_create of too many"
);
puts( "TA1 - rtems_rate_monotonic_create - RTEMS_TOO_MANY" );
/*
* Check ident error cases.
*/
status = rtems_rate_monotonic_ident( 0, &Junk_id );
fatal_directive_status(
status,
RTEMS_INVALID_NAME,
"rtems_rate_monotonic_ident with illegal name"
);
puts( "TA1 - rtems_rate_monotonic_ident - RTEMS_INVALID_NAME" );
/*
* Check period error cases.
*/
status = rtems_rate_monotonic_period( 100, 5 );
fatal_directive_status(
status,
RTEMS_INVALID_ID,
"rtems_rate_monotonic_period with illegal id"
);
puts( "TA1 - rtems_rate_monotonic_period - RTEMS_INVALID_ID" );
status = rtems_rate_monotonic_period( rtems_build_id( 1, 1, 1, 256 ), 5 );
fatal_directive_status(
status,
RTEMS_INVALID_ID,
"rtems_rate_monotonic_period with illegal id"
);
puts( "TA1 - rtems_rate_monotonic_period - local RTEMS_INVALID_ID" );
status = rtems_rate_monotonic_period( Period_id[ 1 ], RTEMS_PERIOD_STATUS );
fatal_directive_status(
status,
RTEMS_NOT_DEFINED,
"rtems_rate_monotonic_period status not defined"
);
puts(
"TA1 - rtems_rate_monotonic_period(RTEMS_PERIOD_STATUS) - RTEMS_NOT_DEFINED"
);
status = rtems_rate_monotonic_period( Period_id[ 1 ], 100 );
directive_failed( status, "rtems_rate_monotonic_period successful" );
puts( "TA1 - rtems_rate_monotonic_period - 100 ticks - RTEMS_SUCCESSFUL" );
status = rtems_rate_monotonic_period( Period_id[ 1 ], RTEMS_PERIOD_STATUS );
directive_failed( status, "rtems_rate_monotonic_period status" );
puts(
"TA1 - rtems_rate_monotonic_period(RTEMS_PERIOD_STATUS) - RTEMS_SUCCESSFUL"
);
while ( FOREVER ) {
status = rtems_rate_monotonic_period(Period_id[ 1 ], RTEMS_PERIOD_STATUS);
if ( status == RTEMS_TIMEOUT ) break;
directive_failed(
status,
"rtems_rate_monotonic_period waiting for timeout"
);
rtems_task_wake_after( 1 );
}
puts(
"TA1 - rtems_rate_monotonic_period(RTEMS_PERIOD_STATUS) - RTEMS_TIMEOUT"
);
/*
* Check get_statistics error cases.
*/
status = rtems_rate_monotonic_get_statistics( Period_id[ 1 ], NULL );
fatal_directive_status(
status,
RTEMS_INVALID_ADDRESS,
"rtems_rate_monotonic_get_statistics with NULL param"
);
puts( "TA1 - rtems_rate_monotonic_get_statistics - RTEMS_INVALID_ADDRESS" );
/*
* Check get_status error cases.
*/
status = rtems_rate_monotonic_get_status( Period_id[ 1 ], NULL );
fatal_directive_status(
status,
RTEMS_INVALID_ADDRESS,
"rtems_rate_monotonic_get_status with NULL param"
);
puts( "TA1 - rtems_rate_monotonic_get_status - RTEMS_INVALID_ADDRESS" );
status = rtems_rate_monotonic_get_status( 100, &period_status );
fatal_directive_status(
status,
RTEMS_INVALID_ID,
"rtems_rate_monotonic_get_status with illegal id"
);
puts( "TA1 - rtems_rate_monotonic_get_status - RTEMS_INVALID_ID" );
/*
* Check cancel error cases.
*/
status = rtems_rate_monotonic_cancel( 100 );
fatal_directive_status(
status,
RTEMS_INVALID_ID,
"rtems_rate_monotonic_cancel with illegal id"
);
puts( "TA1 - rtems_rate_monotonic_cancel - RTEMS_INVALID_ID" );
status = rtems_rate_monotonic_cancel( rtems_build_id( 1, 1, 1, 256 ) );
fatal_directive_status(
status,
RTEMS_INVALID_ID,
"rtems_rate_monotonic_cancel will illegal id"
);
puts( "TA1 - rtems_rate_monotonic_cancel - local RTEMS_INVALID_ID" );
status = rtems_rate_monotonic_cancel( Period_id[ 1 ] );
directive_failed( status, "rtems_rate_monotonic_cancel" );
puts( "TA1 - rtems_rate_monotonic_cancel - RTEMS_SUCCESSFUL" );
status = rtems_rate_monotonic_period( Period_id[ 1 ], 5 );
directive_failed( status, "rtems_rate_monotonic_period restart" );
status = rtems_task_wake_after( rtems_clock_get_ticks_per_second() );
directive_failed( status, "rtems_task_wake_after" );
status = rtems_rate_monotonic_period( Period_id[ 1 ], 5 );
fatal_directive_status(
status,
RTEMS_TIMEOUT,
"rtems_rate_monotonic_period"
);
puts( "TA1 - rtems_rate_monotonic_period - 5 ticks - RTEMS_TIMEOUT" );
status = rtems_task_start( Task_id[ 4 ], Task_4, 0 );
directive_failed( status, "rtems_task_start of TA4" );
puts( "TA1 - yielding to TA4" );
status = rtems_task_wake_after( RTEMS_YIELD_PROCESSOR );
/*
* Check delete error cases.
*/
status = rtems_rate_monotonic_delete( 100 );
fatal_directive_status(
status,
RTEMS_INVALID_ID,
"rtems_rate_monotonic_delete with illegal id"
);
puts( "TA1 - rtems_rate_monotonic_delete - RTEMS_INVALID_ID" );
status = rtems_rate_monotonic_delete( rtems_build_id( 1, 1, 1, 256 ) );
fatal_directive_status(
status,
RTEMS_INVALID_ID,
"rtems_rate_monotonic_delete with illegal id"
);
puts( "TA1 - rtems_rate_monotonic_delete - local RTEMS_INVALID_ID" );
status = rtems_rate_monotonic_delete( Period_id[ 1 ] );
directive_failed( status, "rtems_rate_monotonic_delete" );
puts( "TA1 - rtems_rate_monotonic_delete - RTEMS_SUCCESSFUL" );
}
rtems_task Tasks_Periodic(
rtems_task_argument argument
)
{
rtems_id rmid;
rtems_id test_rmid;
rtems_status_code status;
bool scenario_done = 0;
int start, stop, now;
rtems_cbs_server_id server_id, tsid;
rtems_cbs_parameters params, tparams;
params.deadline = Periods[ argument ];
params.budget = Execution[ argument ]+1;
if ( argument == 4 ) {
if ( rtems_cbs_create_server( ¶ms, &overrun_handler_task_4, &server_id ))
printf( "ERROR: CREATE SERVER FAILED\n" );
}
else {
if ( rtems_cbs_create_server( ¶ms, NULL, &server_id ) )
printf( "ERROR: CREATE SERVER FAILED\n" );
}
if ( rtems_cbs_attach_thread( server_id, Task_id[ argument ] ) )
printf( "ERROR: ATTACH THREAD FAILED\n" );
if ( rtems_cbs_get_server_id( Task_id[ argument ], &tsid ) )
printf( "ERROR: GET SERVER ID FAILED\n" );
if ( tsid != server_id )
printf( "ERROR: SERVER ID MISMATCH\n" );
if ( rtems_cbs_get_parameters( server_id, &tparams ) )
printf( "ERROR: GET PARAMETERS FAILED\n" );
if ( params.deadline != tparams.deadline ||
params.budget != tparams.budget )
printf( "ERROR: PARAMETERS MISMATCH\n" );
status = rtems_rate_monotonic_create( argument, &rmid );
directive_failed( status, "rtems_rate_monotonic_create" );
put_name( Task_name[ argument ], FALSE );
printf( "- rtems_rate_monotonic_create id = 0x%08" PRIxrtems_id "\n",
rmid );
status = rtems_rate_monotonic_ident( argument, &test_rmid );
directive_failed( status, "rtems_rate_monotonic_ident" );
put_name( Task_name[ argument ], FALSE );
printf( "- rtems_rate_monotonic_ident id = 0x%08" PRIxrtems_id "\n",
test_rmid );
if ( rmid != test_rmid ) {
printf( "RMID's DO NOT MATCH (0x%" PRIxrtems_id " and 0x%"
PRIxrtems_id ")\n", rmid, test_rmid );
rtems_test_exit( 0 );
}
put_name( Task_name[ argument ], FALSE );
printf( "- (0x%08" PRIxrtems_id ") period %" PRIu32 "\n",
rmid, Periods[ argument ] );
status = rtems_task_wake_after( 2 + Phases[argument] );
directive_failed( status, "rtems_task_wake_after" );
while (FOREVER) {
if (rtems_rate_monotonic_period(rmid, Periods[argument])==RTEMS_TIMEOUT)
printf("P%" PRIdPTR " - Deadline miss\n", argument);
rtems_clock_get(RTEMS_CLOCK_GET_TICKS_SINCE_BOOT, &start);
printf("P%" PRIdPTR "-S ticks:%d\n", argument, start);
if ( start >= 2*HP_LENGTH ) break; /* stop */
/* Specific scenario for task 4: tries to exceed announced budget,
the task priority has to be pulled down to background. */
if ( !scenario_done && argument == 4 && now >= 200 ) {
Violating_task[ argument ] = 1;
scenario_done = 1;
}
/* Specific scenario for task 3: changes scheduling parameters. */
if ( !scenario_done && argument == 3 && now >= 250 ) {
Periods[ argument ] = Periods[ argument ] * 2;
Execution[ argument ] = Execution[ argument ] * 2;
params.deadline = Periods[ argument ];
params.budget = Execution[ argument ]+1;
if ( rtems_cbs_set_parameters( server_id, ¶ms) )
printf( "ERROR: SET PARAMETERS FAILED\n" );
if ( rtems_cbs_get_parameters( server_id, &tparams ) )
printf( "ERROR: GET PARAMETERS FAILED\n" );
if ( params.deadline != tparams.deadline ||
params.budget != tparams.budget )
printf( "ERROR: PARAMETERS MISMATCH\n" );
scenario_done = 1;
}
/* Specific scenario for task 2: late unblock after being blocked by
itself, the task priority has to be pulled down to background. */
if ( !scenario_done && argument == 2 && now >= 500 ) {
Violating_task[ argument ] = 1;
scenario_done = 1;
}
if (argument == 2 && Violating_task[ argument ])
rtems_task_wake_after( 10 );
/* active computing */
while(FOREVER) {
rtems_clock_get(RTEMS_CLOCK_GET_TICKS_SINCE_BOOT, &now);
if ( argument == 4 && !Violating_task[ argument ] &&
(now >= start + Execution[argument]))
break;
if ( argument != 4 && (now >= start + Execution[argument]) )
break;
}
rtems_clock_get(RTEMS_CLOCK_GET_TICKS_SINCE_BOOT, &stop);
printf("P%" PRIdPTR "-F ticks:%d\n", argument, stop);
}
/* delete period and SELF */
status = rtems_rate_monotonic_delete( rmid );
if ( status != RTEMS_SUCCESSFUL ) {
printf("rtems_rate_monotonic_delete failed with status of %d.\n",status);
rtems_test_exit( 0 );
}
if ( rtems_cbs_cleanup() )
printf( "ERROR: CBS CLEANUP\n" );
fflush(stdout);
puts( "*** END OF TEST CBS SCHEDULER 3 ***" );
rtems_test_exit( 0 );
}
static void
rtems_cpuusage_top_thread (rtems_task_argument arg)
{
rtems_cpu_usage_data* data = (rtems_cpu_usage_data*) arg;
char name[13];
int i;
Heap_Information_block wksp;
uint32_t ival, fval;
int task_count;
rtems_event_set out;
rtems_status_code sc;
bool first_time = true;
data->thread_active = true;
_TOD_Get_uptime(&data->last_uptime);
CPU_usage_Set_to_zero(&data->zero);
while (data->thread_run)
{
Timestamp_Control uptime_at_last_reset = CPU_usage_Uptime_at_last_reset;
size_t tasks_size;
size_t usage_size;
Timestamp_Control load;
data->task_count = 0;
rtems_iterate_over_all_threads_2(task_counter, data);
tasks_size = sizeof(Thread_Control*) * (data->task_count + 1);
usage_size = sizeof(Timestamp_Control) * (data->task_count + 1);
if (data->task_count > data->task_size)
{
data->tasks = realloc(data->tasks, tasks_size);
data->usage = realloc(data->usage, usage_size);
data->current_usage = realloc(data->current_usage, usage_size);
if ((data->tasks == NULL) || (data->usage == NULL) || (data->current_usage == NULL))
{
rtems_printf(data->printer, "top worker: error: no memory\n");
data->thread_run = false;
break;
}
}
memset(data->tasks, 0, tasks_size);
memset(data->usage, 0, usage_size);
memset(data->current_usage, 0, usage_size);
_Timestamp_Set_to_zero(&data->total);
_Timestamp_Set_to_zero(&data->current);
data->stack_size = 0;
_TOD_Get_uptime(&data->uptime);
_Timestamp_Subtract(&uptime_at_last_reset, &data->uptime, &data->uptime);
_Timestamp_Subtract(&data->last_uptime, &data->uptime, &data->period);
data->last_uptime = data->uptime;
rtems_iterate_over_all_threads_2(task_usage, data);
if (data->task_count > data->task_size)
{
data->last_tasks = realloc(data->last_tasks, tasks_size);
data->last_usage = realloc(data->last_usage, usage_size);
if ((data->last_tasks == NULL) || (data->last_usage == NULL))
{
rtems_printf(data->printer, "top worker: error: no memory\n");
data->thread_run = false;
break;
}
data->task_size = data->task_count;
}
memcpy(data->last_tasks, data->tasks, tasks_size);
memcpy(data->last_usage, data->usage, usage_size);
data->last_task_count = data->task_count;
/*
* We need to loop again to get suitable current usage values as we need a
* last sample to work.
*/
if (first_time)
{
rtems_task_wake_after(RTEMS_MILLISECONDS_TO_TICKS(500));
first_time = false;
continue;
}
_Protected_heap_Get_information(&_Workspace_Area, &wksp);
if (data->single_page)
rtems_printf(data->printer,
"\x1b[H\x1b[J"
" ENTER:Exit SPACE:Refresh"
" S:Scroll A:All <>:Order +/-:Lines\n");
rtems_printf(data->printer, "\n");
/*
* Uptime and period of this sample.
*/
rtems_printf(data->printer, "Uptime: ");
print_time(data, &data->uptime, 20);
rtems_printf(data->printer, " Period: ");
print_time(data, &data->period, 20);
/*
* Task count, load and idle levels.
*/
rtems_printf(data->printer, "\nTasks: %4i ", data->task_count);
_Timestamp_Subtract(&data->idle, &data->total, &load);
_Timestamp_Divide(&load, &data->uptime, &ival, &fval);
rtems_printf(data->printer,
"Load Average: %4" PRIu32 ".%03" PRIu32 "%%", ival, fval);
_Timestamp_Subtract(&data->current_idle, &data->current, &load);
_Timestamp_Divide(&load, &data->period, &ival, &fval);
rtems_printf(data->printer,
" Load: %4" PRIu32 ".%03" PRIu32 "%%", ival, fval);
_Timestamp_Divide(&data->current_idle, &data->period, &ival, &fval);
rtems_printf(data->printer,
" Idle: %4" PRIu32 ".%03" PRIu32 "%%", ival, fval);
/*
* Memory usage.
*/
if (rtems_configuration_get_unified_work_area())
{
rtems_printf(data->printer, "\nMem: ");
print_memsize(data, wksp.Free.total, "free");
print_memsize(data, wksp.Used.total, "used");
}
else
{
region_information_block libc_heap;
malloc_info(&libc_heap);
rtems_printf(data->printer, "\nMem: Wksp: ");
print_memsize(data, wksp.Free.total, "free");
print_memsize(data, wksp.Used.total, "used Heap: ");
print_memsize(data, libc_heap.Free.total, "free");
print_memsize(data, libc_heap.Used.total, "used");
}
print_memsize(data, data->stack_size, "stack\n");
rtems_printf(data->printer,
"\n"
" ID | NAME | RPRI | CPRI | TIME | TOTAL | CURRENT\n"
"-%s---------+---------------------+-%s-----%s-----+---------------------+-%s------+--%s----\n",
data->sort_order == RTEMS_TOP_SORT_ID ? "^^" : "--",
data->sort_order == RTEMS_TOP_SORT_REAL_PRI ? "^^" : "--",
data->sort_order == RTEMS_TOP_SORT_CURRENT_PRI ? "^^" : "--",
data->sort_order == RTEMS_TOP_SORT_TOTAL ? "^^" : "--",
data->sort_order == RTEMS_TOP_SORT_CURRENT ? "^^" : "--"
);
task_count = 0;
for (i = 0; i < data->task_count; i++)
{
Thread_Control* thread = data->tasks[i];
Timestamp_Control usage;
Timestamp_Control current_usage;
if (thread == NULL)
break;
if (data->single_page && (data->show != 0) && (i >= data->show))
break;
/*
* We need to count the number displayed to clear the remainder of the
* the display.
*/
++task_count;
/*
* If the API os POSIX print the entry point.
*/
rtems_object_get_name(thread->Object.id, sizeof(name), name);
if (name[0] == '\0')
snprintf(name, sizeof(name) - 1, "(%p)", thread->Start.Entry.Kinds.Numeric.entry);
rtems_printf(data->printer,
" 0x%08" PRIx32 " | %-19s | %3" PRId64 " | %3" PRId64 " | ",
thread->Object.id,
name,
thread->Real_priority.priority,
_Thread_Get_priority(thread));
usage = data->usage[i];
current_usage = data->current_usage[i];
/*
* Print the information
*/
print_time(data, &usage, 19);
_Timestamp_Divide(&usage, &data->total, &ival, &fval);
rtems_printf(data->printer,
" |%4" PRIu32 ".%03" PRIu32, ival, fval);
_Timestamp_Divide(¤t_usage, &data->period, &ival, &fval);
rtems_printf(data->printer,
" |%4" PRIu32 ".%03" PRIu32 "\n", ival, fval);
}
if (data->single_page && (data->show != 0) && (task_count < data->show))
{
i = data->show - task_count;
while (i > 0)
{
rtems_printf(data->printer, "\x1b[K\n");
i--;
}
}
sc = rtems_event_receive(RTEMS_EVENT_1,
RTEMS_EVENT_ANY,
RTEMS_MILLISECONDS_TO_TICKS (data->poll_rate_usecs),
&out);
if ((sc != RTEMS_SUCCESSFUL) && (sc != RTEMS_TIMEOUT))
{
rtems_printf(data->printer,
"error: event receive: %s\n", rtems_status_text(sc));
break;
}
}
free(data->tasks);
free(data->last_tasks);
free(data->last_usage);
free(data->current_usage);
data->thread_active = false;
rtems_task_delete (RTEMS_SELF);
}
void rtems_cpu_usage_top_with_plugin(
const rtems_printer *printer
)
{
rtems_status_code sc;
rtems_task_priority priority;
rtems_name name;
rtems_id id;
rtems_cpu_usage_data data;
int show_lines = 25;
memset(&data, 0, sizeof(data));
data.thread_run = true;
data.single_page = true;
data.sort_order = RTEMS_TOP_SORT_CURRENT;
data.poll_rate_usecs = 3000;
data.show = show_lines;
data.printer = printer;
sc = rtems_task_set_priority (RTEMS_SELF, RTEMS_CURRENT_PRIORITY, &priority);
if (sc != RTEMS_SUCCESSFUL)
{
rtems_printf (printer,
"error: cannot obtain the current priority: %s\n", rtems_status_text (sc));
return;
}
name = rtems_build_name('C', 'P', 'l', 't');
sc = rtems_task_create (name, priority, 4 * 1024,
RTEMS_NO_FLOATING_POINT | RTEMS_LOCAL,
RTEMS_PREEMPT | RTEMS_TIMESLICE | RTEMS_NO_ASR,
&id);
if (sc != RTEMS_SUCCESSFUL)
{
rtems_printf (printer,
"error: cannot create helper thread: %s\n", rtems_status_text (sc));
return;
}
sc = rtems_task_start (id, rtems_cpuusage_top_thread, (rtems_task_argument) &data);
if (sc != RTEMS_SUCCESSFUL)
{
rtems_printf (printer,
"error: cannot start helper thread: %s\n", rtems_status_text (sc));
rtems_task_delete (id);
return;
}
while (true)
{
int c = getchar ();
if ((c == '\r') || (c == '\n') || (c == 'q') || (c == 'Q'))
{
int loops = 50;
data.thread_run = false;
rtems_event_send(id, RTEMS_EVENT_1);
while (loops && data.thread_active)
rtems_task_wake_after (RTEMS_MICROSECONDS_TO_TICKS (100000));
rtems_printf (printer, "load monitoring stopped.\n");
return;
}
else if (c == '<')
{
if (data.sort_order == 0)
data.sort_order = RTEMS_TOP_SORT_MAX;
else
--data.sort_order;
rtems_event_send(id, RTEMS_EVENT_1);
}
else if (c == '>')
{
if (data.sort_order >= RTEMS_TOP_SORT_MAX)
data.sort_order = 0;
else
++data.sort_order;
rtems_event_send(id, RTEMS_EVENT_1);
}
else if ((c == 's') || (c == 'S'))
{
data.single_page = !data.single_page;
rtems_event_send(id, RTEMS_EVENT_1);
}
else if ((c == 'a') || (c == 'A'))
{
if (data.show == 0)
data.show = show_lines;
else
data.show = 0;
rtems_event_send(id, RTEMS_EVENT_1);
}
else if (c == '+')
{
++show_lines;
if (data.show != 0)
data.show = show_lines;
}
else if (c == '-')
{
if (show_lines > 5)
--show_lines;
if (data.show != 0)
data.show = show_lines;
}
else if (c == ' ')
{
rtems_event_send(id, RTEMS_EVENT_1);
}
}
}
rtems_task Task_1_through_5(
rtems_task_argument argument
)
{
rtems_id rmid;
rtems_id test_rmid;
uint32_t index;
uint32_t pass;
uint32_t failed;
rtems_status_code status;
status = rtems_rate_monotonic_create( argument, &rmid );
directive_failed( status, "rtems_rate_monotonic_create" );
put_name( Task_name[ argument ], FALSE );
printf( "- rtems_rate_monotonic_create id = 0x%08" PRIxrtems_id "\n", rmid );
status = rtems_rate_monotonic_ident( argument, &test_rmid );
directive_failed( status, "rtems_rate_monotonic_ident" );
put_name( Task_name[ argument ], FALSE );
printf( "- rtems_rate_monotonic_ident id = 0x%08" PRIxrtems_id "\n", test_rmid );
if ( rmid != test_rmid ) {
printf( "RMID's DO NOT MATCH (0x%" PRIxrtems_id " and 0x%" PRIxrtems_id ")\n", rmid, test_rmid );
rtems_test_exit( 0 );
}
put_name( Task_name[ argument ], FALSE );
printf( "- (0x%08" PRIxrtems_id ") period %" PRIu32 "\n", rmid, Periods[ argument ] );
status = rtems_task_wake_after( 2 );
directive_failed( status, "rtems_task_wake_after" );
switch ( argument ) {
case 1:
case 2:
case 3:
case 4:
while ( FOREVER ) {
status = rtems_rate_monotonic_period( rmid, Periods[ argument ] );
directive_failed( status, "rtems_rate_monotonic_period" );
Count.count[ argument ]++;
}
break;
case 5:
pass = 0;
failed = 0;
status = rtems_rate_monotonic_period( rmid, Periods[ argument ] );
directive_failed( status, "rtems_rate_monotonic_period 1 of TA5" );
Get_all_counters();
while ( FOREVER ) {
status = rtems_rate_monotonic_period( rmid, Periods[ argument ] );
directive_failed( status, "rtems_rate_monotonic_period 2 of TA5" );
Get_all_counters();
for( index = 1 ; index <= 4 ; index++ ) {
if ( Temporary_count.count[ index ] != Iterations[ index ] ) {
puts_nocr( "FAIL -- " );
put_name ( Task_name[ index ], FALSE );
printf ( " Actual=%" PRIu32 ", Expected=%" PRIu32 "\n",
Temporary_count.count[ index ],
Iterations[ index ]
);
failed += 1;
}
}
if ( failed == 5 )
rtems_test_exit( 0 );
pass += 1;
printf( "TA5 - PERIODS CHECK OK (%" PRIu32 ")\n", pass );
FLUSH_OUTPUT();
if ( pass == 10 ) {
puts( "" );
rtems_rate_monotonic_report_statistics();
rtems_rate_monotonic_reset_statistics( rmid );
puts( "" );
puts( "TA5 - PERIOD STATISTICS RESET" );
puts( "" );
rtems_rate_monotonic_report_statistics();
rtems_rate_monotonic_reset_all_statistics();
puts( "" );
puts( "TA5 - ALL PERIOD STATISTICS RESET" );
puts( "" );
rtems_rate_monotonic_report_statistics();
puts( "" );
puts( "*** END OF RATE MONOTONIC PERIOD STATISTICS TEST ***" );
rtems_test_exit( 0 );
}
}
break;
}
}
void termios_test_driver_wait_for_tx_to_complete(void)
{
rtems_task_wake_after( 2 * rtems_clock_get_ticks_per_second() );
}
rtems_task Test_task(
rtems_task_argument argument
)
{
uint32_t count;
rtems_status_code status;
puts( "Getting SMID of semaphore" );
do {
status = rtems_semaphore_ident(
Semaphore_name[ 1 ],
RTEMS_SEARCH_ALL_NODES,
&Semaphore_id[ 1 ]
);
} while ( !rtems_is_status_successful( status ) );
if ( Multiprocessing_configuration.node == 2 ) {
status = rtems_semaphore_delete( Semaphore_id[ 1 ] );
fatal_directive_status(
status,
RTEMS_ILLEGAL_ON_REMOTE_OBJECT,
"rtems_semaphore_delete did not return RTEMS_ILLEGAL_ON_REMOTE_OBJECT"
);
puts(
"rtems_semaphore_delete correctly returned RTEMS_ILLEGAL_ON_REMOTE_OBJECT"
);
}
count = 0; /* number of times node 1 releases semaphore */
while ( FOREVER ) {
put_dot( 'p' );
status = rtems_semaphore_obtain(
Semaphore_id[ 1 ],
RTEMS_DEFAULT_OPTIONS,
RTEMS_NO_TIMEOUT
);
if ( status != RTEMS_SUCCESSFUL ) {
fatal_directive_status(
status,
RTEMS_OBJECT_WAS_DELETED,
"rtems_semaphore_obtain"
);
puts( "\nGlobal semaphore deleted" );
puts( "*** END OF TEST 8 ***" );
rtems_test_exit( 0 );
}
if ( Multiprocessing_configuration.node == 1 && ++count == 1000 ) {
status = rtems_task_wake_after( rtems_clock_get_ticks_per_second() );
directive_failed( status, "rtems_task_wake_after" );
puts( "\nDeleting global semaphore" );
status = rtems_semaphore_delete( Semaphore_id[ 1 ] );
directive_failed( status, "rtems_semaphore_delete" );
puts( "*** END OF TEST 8 ***" );
rtems_test_exit( 0 );
}
else {
put_dot( 'v' );
status = rtems_semaphore_release( Semaphore_id[ 1 ] );
directive_failed( status, "rtems_semaphore_release FAILED!!" );
}
}
}
/**
* @brief Set attributes of the HW peripheral
*
* Sets attributes of the HW peripheral (parity, baud rate, etc.)
*
* @param[in] base context of the driver
* @param[in] t termios driver
* @retval true peripheral setting is changed
*/
bool tms570_sci_set_attributes(
rtems_termios_device_context *base,
const struct termios *t
)
{
tms570_sci_context *ctx = (tms570_sci_context *) base;
rtems_interrupt_lock_context lock_context;
int32_t bauddiv;
int32_t baudrate;
uint32_t flr_tx_ready = TMS570_SCI_FLR_TX_EMPTY;
/*
* Test for TMS570_SCI_FLR_TXRDY is not necessary
* because both SCITD and SCITXSHF has to be empty
* to TX_EMPTY be asserted. But there is no interrupt
* option for TX_EMPTY. Polling is used isntead.
*/
/* Baud rate */
baudrate = rtems_termios_baud_to_number(cfgetospeed(t));
rtems_termios_device_lock_acquire(base, &lock_context);
while ( (ctx->regs->GCR1 & TMS570_SCI_GCR1_TXENA) &&
(ctx->regs->FLR & flr_tx_ready) != flr_tx_ready) {
/*
* There are pending characters in the hardware,
* change in the middle of the character Tx leads
* to disturb of the character and SCI engine
*/
rtems_interval tw;
rtems_termios_device_lock_release(base, &lock_context);
tw = rtems_clock_get_ticks_per_second();
tw = tw * 5 / baudrate + 1;
rtems_task_wake_after( tw );
rtems_termios_device_lock_acquire(base, &lock_context);
}
ctx->regs->GCR1 &= ~( TMS570_SCI_GCR1_SWnRST | TMS570_SCI_GCR1_TXENA |
TMS570_SCI_GCR1_RXENA );
ctx->regs->GCR1 &= ~TMS570_SCI_GCR1_STOP; /*one stop bit*/
ctx->regs->FORMAT = TMS570_SCI_FORMAT_CHAR(0x7);
switch ( t->c_cflag & ( PARENB|PARODD ) ) {
case ( PARENB|PARODD ):
/* Odd parity */
ctx->regs->GCR1 &= ~TMS570_SCI_GCR1_PARITY;
ctx->regs->GCR1 |= TMS570_SCI_GCR1_PARITY_ENA;
break;
case PARENB:
/* Even parity */
ctx->regs->GCR1 |= TMS570_SCI_GCR1_PARITY;
ctx->regs->GCR1 |= TMS570_SCI_GCR1_PARITY_ENA;
break;
default:
case 0:
case PARODD:
/* No Parity */
ctx->regs->GCR1 &= ~TMS570_SCI_GCR1_PARITY_ENA;
}
/* Apply baudrate to the hardware */
baudrate *= 2 * 16;
bauddiv = (BSP_PLL_OUT_CLOCK + baudrate / 2) / baudrate;
ctx->regs->BRS = bauddiv? bauddiv - 1: 0;
ctx->regs->GCR1 |= TMS570_SCI_GCR1_SWnRST | TMS570_SCI_GCR1_TXENA |
TMS570_SCI_GCR1_RXENA;
rtems_termios_device_lock_release(base, &lock_context);
return true;
}
int __po_hi_gqueue_get_value (__po_hi_task_id id,
__po_hi_local_port_t port,
__po_hi_request_t* request)
{
__po_hi_request_t* ptr;
#ifdef RTEMS_PURE
rtems_status_code ret;
#endif
#ifdef _WIN32
DWORD ret;
#endif
ptr = &__po_hi_gqueues_most_recent_values[id][port];
#if defined (POSIX) || defined (RTEMS_POSIX) || defined (XENO_POSIX)
pthread_mutex_lock (&__po_hi_gqueues_mutexes[id]);
#elif defined (XENO_NATIVE)
rt_mutex_acquire (&__po_hi_gqueues_mutexes[id], TM_INFINITE);
#elif defined (RTEMS_PURE)
ret = rtems_semaphore_obtain (__po_hi_gqueues_semaphores[id], RTEMS_WAIT, RTEMS_NO_TIMEOUT);
if (ret != RTEMS_SUCCESSFUL)
{
__DEBUGMSG ("[GQUEUE] Cannot obtain semaphore in __po_hi_gqueue_store_in()\n");
}
#elif defined (_WIN32)
EnterCriticalSection(&__po_hi_gqueues_cs[id]);
#endif
/*
* If the port is an event port, with no value queued, then we block
* the thread.
*/
if (__po_hi_gqueues_sizes[id][port] != __PO_HI_GQUEUE_FIFO_INDATA)
{
while (__po_hi_gqueues_port_is_empty[id][port] == 1)
{
#if defined (POSIX) || defined (RTEMS_POSIX) || defined (XENO_POSIX)
pthread_cond_wait (&__po_hi_gqueues_conds[id],
&__po_hi_gqueues_mutexes[id]);
#elif defined (XENO_NATIVE)
rt_cond_wait (&__po_hi_gqueues_conds[id], &__po_hi_gqueues_mutexes[id], TM_INFINITE);
#elif defined (RTEMS_PURE)
rtems_task_wake_after( RTEMS_YIELD_PROCESSOR );
#elif defined (_WIN32)
LeaveCriticalSection(&__po_hi_gqueues_cs[id]);
ret = WaitForSingleObject (__po_hi_gqueues_events[id], INFINITE);
if (ret == WAIT_FAILED)
{
__PO_HI_DEBUG_DEBUG ("[GQUEUE] Wait failed\n");
}
EnterCriticalSection(&__po_hi_gqueues_cs[id]);
#endif
}
}
#if defined (MONITORING)
update_sporadic_dispatch (id, port);
#endif
if (__po_hi_gqueues_used_size[id][port] == 0)
{
memcpy (request, ptr, sizeof (__po_hi_request_t));
//update_runtime (id, port, ptr);
}
else
{
ptr = ((__po_hi_request_t *) &__po_hi_gqueues[id][port]) + __po_hi_gqueues_first[id][port] + __po_hi_gqueues_offsets[id][port];
memcpy (request, ptr, sizeof (__po_hi_request_t));
}
#if defined (TIMEBENCH)
po_hi_put_time_stamp(id, port,__po_hi_get_CPU_time( ));
#endif
__PO_HI_DEBUG_INFO ("[GQUEUE] Task %d get a value on port %d\n", id, port);
#if defined (POSIX) || defined (RTEMS_POSIX) || defined (XENO_POSIX)
pthread_mutex_unlock (&__po_hi_gqueues_mutexes[id]);
#elif defined (XENO_NATIVE)
rt_mutex_release (&__po_hi_gqueues_mutexes[id]);
#elif defined (RTEMS_PURE)
ret = rtems_semaphore_release (__po_hi_gqueues_semaphores[id]);
if (ret != RTEMS_SUCCESSFUL)
{
__DEBUGMSG ("[GQUEUE] Cannot release semaphore in __po_hi_gqueue_store_in()\n");
}
#elif defined (_WIN32)
LeaveCriticalSection(&__po_hi_gqueues_cs[id]);
#endif
return 0;
}
rtems_task Message_queue_task(
rtems_task_argument index
)
{
rtems_status_code status;
uint32_t count;
uint32_t yield_count;
uint32_t *buffer_count;
uint32_t *overflow_count;
size_t size;
Msg_buffer[ index ][0] = 0;
Msg_buffer[ index ][1] = 0;
Msg_buffer[ index ][2] = 0;
Msg_buffer[ index ][3] = 0;
puts( "Getting ID of msg queue" );
while ( FOREVER ) {
status = rtems_message_queue_ident(
Queue_name[ 1 ],
RTEMS_SEARCH_ALL_NODES,
&Queue_id[ 1 ]
);
if ( status == RTEMS_SUCCESSFUL )
break;
puts( "rtems_message_queue_ident FAILED!!" );
rtems_task_wake_after(2);
}
if ( Multiprocessing_configuration.node == 1 ) {
status = rtems_message_queue_send(
Queue_id[ 1 ],
(long (*)[4])Msg_buffer[ index ],
16
);
directive_failed( status, "rtems_message_queue_send" );
overflow_count = &Msg_buffer[ index ][0];
buffer_count = &Msg_buffer[ index ][1];
} else {
overflow_count = &Msg_buffer[ index ][2];
buffer_count = &Msg_buffer[ index ][3];
}
while ( Stop_Test == false ) {
yield_count = 100;
for ( count=MESSAGE_DOT_COUNT ; Stop_Test == false && count ; count-- ) {
status = rtems_message_queue_receive(
Queue_id[ 1 ],
Msg_buffer[ index ],
&size,
RTEMS_DEFAULT_OPTIONS,
RTEMS_NO_TIMEOUT
);
directive_failed( status, "rtems_message_queue_receive" );
if ( *buffer_count == (uint32_t)0xffffffff ) {
*buffer_count = 0;
*overflow_count += 1;
} else
*buffer_count += 1;
status = rtems_message_queue_send(
Queue_id[ 1 ],
Msg_buffer[ index ],
16
);
directive_failed( status, "rtems_message_queue_send" );
if (Stop_Test == false)
if ( Multiprocessing_configuration.node == 1 && --yield_count == 0 ) {
status = rtems_task_wake_after( RTEMS_YIELD_PROCESSOR );
directive_failed( status, "rtems_task_wake_after" );
yield_count = 100;
}
}
put_dot( 'm' );
}
Exit_test();
}
rtems_task Init(
rtems_task_argument argument
)
{
rtems_status_code status;
void *bufaddr;
printf(
"\n\n*** TEST 12 -- NODE %" PRId32 " ***\n",
Multiprocessing_configuration.node
);
Task_name[ 1 ] = rtems_build_name( '1', '1', '1', ' ' );
Task_name[ 2 ] = rtems_build_name( '2', '2', '2', ' ' );
Partition_name[ 1 ] = rtems_build_name( 'P', 'A', 'R', ' ' );
puts( "Got to initialization task" );
if ( Multiprocessing_configuration.node == 2 ) {
status = rtems_task_wake_after( rtems_clock_get_ticks_per_second() );
directive_failed( status, "rtems_task_wake_after" );
puts( "Getting ID of remote Partition (Global)" );
do {
status = rtems_partition_ident(
Partition_name[ 1 ],
RTEMS_SEARCH_ALL_NODES,
&Partition_id[ 1 ]
);
} while ( !rtems_is_status_successful( status ) );
puts( "Attempting to delete remote Partition (Global)" );
status = rtems_partition_delete( Partition_id[ 1 ] );
fatal_directive_status(
status,
RTEMS_ILLEGAL_ON_REMOTE_OBJECT,
"rtems_partition_delete"
);
puts(
"rtems_partition_delete correctly returned RTEMS_ILLEGAL_ON_REMOTE_OBJECT"
);
puts( "Obtaining a buffer from the global partition" );
status = rtems_partition_get_buffer( Partition_id[ 1 ], &bufaddr );
directive_failed( status, "rtems_partition_get_buffer" );
printf( "Address returned was : 0x%p\n", bufaddr );
puts( "Releasing a buffer to the global partition" );
status = rtems_partition_return_buffer( Partition_id[ 1 ], bufaddr );
directive_failed( status, "rtems_partition_return_buffer" );
status = rtems_task_wake_after( 2 * rtems_clock_get_ticks_per_second() );
directive_failed( status, "rtems_task_wake_after" );
}
else {
puts( "Creating Partition (Global)" );
status = rtems_partition_create(
Partition_name[ 1 ],
Partition_area,
128,
64,
RTEMS_GLOBAL,
&Partition_id[ 1 ]
);
directive_failed( status, "rtems_partition_create" );
puts( "Sleeping for two seconds" );
status = rtems_task_wake_after( 2 * rtems_clock_get_ticks_per_second() );
directive_failed( status, "rtems_task_wake_after" );
puts( "Deleting Partition (Global)" );
status = rtems_partition_delete( Partition_id[ 1 ] );
directive_failed( status, "rtems_partition_delete" );
}
puts( "*** END OF TEST 12 ***" );
rtems_test_exit( 0 );
}
static void test(void)
{
test_context *ctx = &ctx_instance;
rtems_status_code sc;
rtems_task_argument runner_index;
rtems_id stopper_id;
uint32_t expected_tokens;
uint32_t total_delta;
uint64_t total_cycles;
uint32_t average_cycles;
sc = rtems_task_create(
rtems_build_name('S', 'T', 'O', 'P'),
PRIO_STOP,
RTEMS_MINIMUM_STACK_SIZE,
RTEMS_DEFAULT_MODES,
RTEMS_DEFAULT_ATTRIBUTES,
&stopper_id
);
rtems_test_assert(sc == RTEMS_SUCCESSFUL);
for (runner_index = 0; runner_index < RUNNER_COUNT; ++runner_index) {
sc = rtems_task_create(
rtems_build_name('R', 'U', 'N', (char) ('0' + runner_index)),
PRIO_HIGH + runner_index,
RTEMS_MINIMUM_STACK_SIZE,
RTEMS_DEFAULT_MODES,
RTEMS_DEFAULT_ATTRIBUTES,
&ctx->runner_ids[runner_index]
);
rtems_test_assert(sc == RTEMS_SUCCESSFUL);
}
for (runner_index = 0; runner_index < RUNNER_COUNT; ++runner_index) {
sc = rtems_task_start(ctx->runner_ids[runner_index], runner, runner_index);
rtems_test_assert(sc == RTEMS_SUCCESSFUL);
}
sc = rtems_task_wake_after(10 * rtems_clock_get_ticks_per_second());
rtems_test_assert(sc == RTEMS_SUCCESSFUL);
sc = rtems_task_start(stopper_id, stopper, 0);
rtems_test_assert(sc == RTEMS_SUCCESSFUL);
for (runner_index = 0; runner_index < RUNNER_COUNT; ++runner_index) {
sc = rtems_task_delete(ctx->runner_ids[runner_index]);
rtems_test_assert(sc == RTEMS_SUCCESSFUL);
}
total_cycles = 0;
for (runner_index = 0; runner_index < RUNNER_COUNT; ++runner_index) {
const test_counters *counters = &ctx->counters[runner_index];
size_t cpu;
for (cpu = 0; cpu < CPU_COUNT; ++cpu) {
total_cycles += counters->cycles_per_cpu[cpu].counter;
}
}
average_cycles = (uint32_t) (total_cycles / (RUNNER_COUNT * CPU_COUNT));
printf(
"total cycles %" PRIu64 "\n"
"average cycles %" PRIu32 "\n",
total_cycles,
average_cycles
);
for (runner_index = 0; runner_index < RUNNER_COUNT; ++runner_index) {
const test_counters *counters = &ctx->counters[runner_index];
size_t cpu;
printf("runner %" PRIuPTR "\n", runner_index);
for (cpu = 0; cpu < CPU_COUNT; ++cpu) {
uint32_t tokens = counters->tokens_per_cpu[cpu].counter;
uint32_t cycles = counters->cycles_per_cpu[cpu].counter;
double cycle_deviation = ((double) cycles - average_cycles)
/ average_cycles;
printf(
"\tcpu %zu tokens %" PRIu32 "\n"
"\tcpu %zu cycles %" PRIu32 "\n"
"\tcpu %zu cycle deviation %f\n",
cpu,
tokens,
cpu,
cycles,
cpu,
cycle_deviation
);
}
}
expected_tokens = ctx->counters[0].tokens_per_cpu[0].counter;
total_delta = 0;
for (runner_index = 0; runner_index < RUNNER_COUNT; ++runner_index) {
test_counters *counters = &ctx->counters[runner_index];
size_t cpu;
for (cpu = 0; cpu < CPU_COUNT; ++cpu) {
uint32_t tokens = counters->tokens_per_cpu[cpu].counter;
uint32_t delta = abs_delta(tokens, expected_tokens);
rtems_test_assert(delta <= 1);
total_delta += delta;
}
}
rtems_test_assert(total_delta <= (RUNNER_COUNT * CPU_COUNT - 1));
}
static void
mcf5282_fec_initialize_hardware(struct mcf5282_enet_struct *sc)
{
int i;
const unsigned char *hwaddr;
rtems_status_code status;
rtems_isr_entry old_handler;
uint32_t clock_speed = get_CPU_clock_speed();
/*
* Issue reset to FEC
*/
MCF5282_FEC_ECR = MCF5282_FEC_ECR_RESET;
rtems_task_wake_after(1);
MCF5282_FEC_ECR = 0;
/*
* Configuration of I/O ports is done outside of this function
*/
#if 0
imm->gpio.pbcnt |= MCF5282_GPIO_PBCNT_SET_FEC; /* Set up port b FEC pins */
#endif
/*
* Set our physical address
*/
hwaddr = sc->arpcom.ac_enaddr;
MCF5282_FEC_PALR = (hwaddr[0] << 24) | (hwaddr[1] << 16) |
(hwaddr[2] << 8) | (hwaddr[3] << 0);
MCF5282_FEC_PAUR = (hwaddr[4] << 24) | (hwaddr[5] << 16);
/*
* Clear the hash table
*/
MCF5282_FEC_GAUR = 0;
MCF5282_FEC_GALR = 0;
/*
* Set up receive buffer size
*/
MCF5282_FEC_EMRBR = 1520; /* Standard Ethernet */
/*
* Allocate mbuf pointers
*/
sc->rxMbuf = malloc(sc->rxBdCount * sizeof *sc->rxMbuf, M_MBUF, M_NOWAIT);
sc->txMbuf = malloc(sc->txBdCount * sizeof *sc->txMbuf, M_MBUF, M_NOWAIT);
if (!sc->rxMbuf || !sc->txMbuf)
rtems_panic("No memory for mbuf pointers");
/*
* Set receiver and transmitter buffer descriptor bases
*/
sc->rxBdBase = mcf5282_bd_allocate(sc->rxBdCount);
sc->txBdBase = mcf5282_bd_allocate(sc->txBdCount);
MCF5282_FEC_ERDSR = (int)sc->rxBdBase;
MCF5282_FEC_ETDSR = (int)sc->txBdBase;
/*
* Set up Receive Control Register:
* Not promiscuous
* MII mode
* Full duplex
* No loopback
*/
MCF5282_FEC_RCR = MCF5282_FEC_RCR_MAX_FL(MAX_MTU_SIZE) |
MCF5282_FEC_RCR_MII_MODE;
/*
* Set up Transmit Control Register:
* Full duplex
* No heartbeat
*/
MCF5282_FEC_TCR = MCF5282_FEC_TCR_FDEN;
/*
* Initialize statistic counters
*/
MCF5282_FEC_MIBC = MCF5282_FEC_MIBC_MIB_DISABLE;
{
vuint32 *vuip = &MCF5282_FEC_RMON_T_DROP;
while (vuip <= &MCF5282_FEC_IEEE_R_OCTETS_OK)
*vuip++ = 0;
}
MCF5282_FEC_MIBC = 0;
/*
* Set MII speed to <= 2.5 MHz
*/
i = (clock_speed + 5000000 - 1) / 5000000;
MCF5282_FEC_MSCR = MCF5282_FEC_MSCR_MII_SPEED(i);
/*
* Set PHYS to 100 Mb/s, full duplex
*/
setMII(1, 0, 0x2100);
setMII(1, 4, 0x0181);
setMII(1, 0, 0x0000);
rtems_task_wake_after(2);
sc->mii_sr2 = getMII(1, 17);
setMII(1, 18, 0x0072);
setMII(1, 0, 0x1000);
/*
* Set up receive buffer descriptors
*/
for (i = 0 ; i < sc->rxBdCount ; i++)
(sc->rxBdBase + i)->status = 0;
/*
* Set up transmit buffer descriptors
*/
for (i = 0 ; i < sc->txBdCount ; i++) {
sc->txBdBase[i].status = 0;
sc->txMbuf[i] = NULL;
}
sc->txBdHead = sc->txBdTail = 0;
sc->txBdActiveCount = 0;
/*
* Set up interrupts
*/
status = rtems_interrupt_catch( mcf5282_fec_tx_interrupt_handler, FEC_INTC0_TX_VECTOR, &old_handler );
if (status != RTEMS_SUCCESSFUL)
rtems_panic ("Can't attach MCF5282 FEC TX interrupt handler: %s\n",
rtems_status_text(status));
status = rtems_interrupt_catch(mcf5282_fec_rx_interrupt_handler, FEC_INTC0_RX_VECTOR, &old_handler);
if (status != RTEMS_SUCCESSFUL)
rtems_panic ("Can't attach MCF5282 FEC RX interrupt handler: %s\n",
rtems_status_text(status));
MCF5282_INTC0_ICR23 = MCF5282_INTC_ICR_IL(FEC_IRQ_LEVEL) |
MCF5282_INTC_ICR_IP(FEC_IRQ_TX_PRIORITY);
MCF5282_INTC0_IMRL &= ~(MCF5282_INTC_IMRL_INT23 | MCF5282_INTC_IMRL_MASKALL);
MCF5282_INTC0_ICR27 = MCF5282_INTC_ICR_IL(FEC_IRQ_LEVEL) |
MCF5282_INTC_ICR_IP(FEC_IRQ_RX_PRIORITY);
MCF5282_INTC0_IMRL &= ~(MCF5282_INTC_IMRL_INT27 | MCF5282_INTC_IMRL_MASKALL);
status = rtems_interrupt_catch(mcf5282_mii_interrupt_handler, MII_VECTOR, &old_handler);
if (status != RTEMS_SUCCESSFUL)
rtems_panic ("Can't attach MCF5282 FEC MII interrupt handler: %s\n",
rtems_status_text(status));
MCF5282_EPORT_EPPAR &= ~MII_EPPAR;
MCF5282_EPORT_EPDDR &= ~MII_EPDDR;
MCF5282_EPORT_EPIER |= MII_EPIER;
MCF5282_INTC0_IMRL &= ~(MCF5282_INTC_IMRL_INT7 | MCF5282_INTC_IMRL_MASKALL);
}
rtems_task Task_1_through_6(
rtems_task_argument argument
)
{
rtems_id rmid;
rtems_id test_rmid;
int index;
int pass;
uint32_t failed;
rtems_status_code status;
status = rtems_rate_monotonic_create( argument, &rmid );
directive_failed( status, "rtems_rate_monotonic_create" );
put_name( Task_name[ argument ], FALSE );
printf( "- rtems_rate_monotonic_create id = 0x%08" PRIxrtems_id "\n",
rmid );
status = rtems_rate_monotonic_ident( argument, &test_rmid );
directive_failed( status, "rtems_rate_monotonic_ident" );
put_name( Task_name[ argument ], FALSE );
printf( "- rtems_rate_monotonic_ident id = 0x%08" PRIxrtems_id "\n",
test_rmid );
if ( rmid != test_rmid ) {
printf( "RMID's DO NOT MATCH (0x%" PRIxrtems_id " and 0x%" PRIxrtems_id ")\n",
rmid, test_rmid );
rtems_test_exit( 0 );
}
put_name( Task_name[ argument ], FALSE );
printf( "- (0x%08" PRIxrtems_id ") period %" PRIu32 "\n",
rmid, Periods[ argument ] );
status = rtems_task_wake_after( 2 );
directive_failed( status, "rtems_task_wake_after" );
switch ( argument ) {
case 1:
case 2:
case 3:
case 4:
while ( FOREVER ) {
status = rtems_rate_monotonic_period( rmid, Periods[ argument ] );
directive_failed( status, "rtems_rate_monotonic_period" );
Count.count[ argument ]++;
}
break;
case 5:
pass = 0;
failed = 0;
status = rtems_rate_monotonic_period( rmid, Periods[ argument ] );
directive_failed( status, "rtems_rate_monotonic_period 1 of TA5" );
Get_all_counters();
while ( FOREVER ) {
status = rtems_rate_monotonic_period( rmid, Periods[ argument ] );
directive_failed( status, "rtems_rate_monotonic_period 2 of TA5" );
Get_all_counters();
for( index = 1 ; index <= 4 ; index++ ) {
if ( Temporary_count.count[ index ] != Iterations[ index ] ) {
puts_nocr( "FAIL -- " );
put_name ( Task_name[ index ], FALSE );
printf ( " Actual=%" PRIu32 ", Expected=%" PRIu32 "\n",
Temporary_count.count[ index ],
Iterations[ index ]
);
failed += 1;
}
}
if ( failed == 5 )
rtems_test_exit( 0 );
pass += 1;
printf( "TA5 - PERIODS CHECK OK (%d)\n", pass );
fflush( stdout );
if ( pass == 10 ) {
TEST_END();
rtems_test_exit( 0 );
}
}
break;
case 6:
/* test changing periods */
{
uint32_t time[TA6_ITERATIONS+1];
rtems_interval period;
period = 1*TA6_PERIOD_FACTOR;
status = rtems_rate_monotonic_period( rmid, period);
directive_failed( status, "rtems_rate_monotonic_period of TA6" );
time[0] = _Watchdog_Ticks_since_boot; /* timestamp */
/*printf("%d - %d\n", period, time[0]);*/
for (index = 1; index <= TA6_ITERATIONS; index++)
{
period = (index+1)*TA6_PERIOD_FACTOR;
status = rtems_rate_monotonic_period( rmid, period);
directive_failed( status, "rtems_rate_monotonic_period of TA6" );
time[index] = _Watchdog_Ticks_since_boot; /* timestamp */
/*printf("%d - %d\n", period, time[index]);*/
}
for (index = 1; index <= TA6_ITERATIONS; index++)
{
rtems_interval meas = time[index] - time[index-1];
period = index*TA6_PERIOD_FACTOR;
printf( "TA6 - Actual: %" PRIdrtems_interval " Expected: %"
PRIdrtems_interval, meas, period );
if (period == meas) printf(" - OK\n");
else printf(" - FAILED\n");
}
}
rtems_task_suspend(RTEMS_SELF);
break;
}
}
void Screen10()
{
rtems_status_code status;
status = rtems_rate_monotonic_create( 0, &Junk_id );
fatal_directive_status(
status,
RTEMS_INVALID_NAME,
"rtems_rate_monotonic_create with illegal name"
);
puts( "TA1 - rtems_rate_monotonic_create - RTEMS_INVALID_NAME" );
status = rtems_rate_monotonic_create( Period_name[ 1 ], &Period_id[ 1 ] );
directive_failed( status, "rtems_rate_monotonic_create successful" );
puts( "TA1 - rtems_rate_monotonic_create - RTEMS_SUCCESSFUL" );
status = rtems_rate_monotonic_create( Period_name[ 1 ], &Junk_id );
fatal_directive_status(
status,
RTEMS_TOO_MANY,
"rtems_rate_monotonic_create of too many"
);
puts( "TA1 - rtems_rate_monotonic_create - RTEMS_TOO_MANY" );
status = rtems_rate_monotonic_ident( 0, &Junk_id );
fatal_directive_status(
status,
RTEMS_INVALID_NAME,
"rtems_rate_monotonic_ident with illegal name"
);
puts( "TA1 - rtems_rate_monotonic_ident - RTEMS_INVALID_NAME" );
status = rtems_rate_monotonic_period( 100, 5 );
fatal_directive_status(
status,
RTEMS_INVALID_ID,
"rtems_rate_monotonic_period with illegal id"
);
puts( "TA1 - rtems_rate_monotonic_period - unknown RTEMS_INVALID_ID" );
status = rtems_rate_monotonic_period( 0x10100, 5 );
fatal_directive_status(
status,
RTEMS_INVALID_ID,
"rtems_rate_monotonic_period with illegal id"
);
puts( "TA1 - rtems_rate_monotonic_period - local RTEMS_INVALID_ID" );
status = rtems_rate_monotonic_period( Period_id[ 1 ], RTEMS_PERIOD_STATUS );
fatal_directive_status(
status,
RTEMS_NOT_DEFINED,
"rtems_rate_monotonic_period status not defined"
);
puts(
"TA1 - rtems_rate_monotonic_period(RTEMS_PERIOD_STATUS) - RTEMS_NOT_DEFINED"
);
status = rtems_rate_monotonic_period( Period_id[ 1 ], 100 );
directive_failed( status, "rtems_rate_monotonic_period successful" );
puts( "TA1 - rtems_rate_monotonic_period - 100 ticks - RTEMS_SUCCESSFUL" );
status = rtems_rate_monotonic_period( Period_id[ 1 ], RTEMS_PERIOD_STATUS );
directive_failed( status, "rtems_rate_monotonic_period status" );
puts(
"TA1 - rtems_rate_monotonic_period(RTEMS_PERIOD_STATUS) - RTEMS_SUCCESSFUL"
);
while ( FOREVER ) {
status = rtems_rate_monotonic_period(Period_id[ 1 ], RTEMS_PERIOD_STATUS);
if ( status == RTEMS_TIMEOUT ) break;
directive_failed(
status,
"rtems_rate_monotonic_period waiting for timeout"
);
}
puts(
"TA1 - rtems_rate_monotonic_period(RTEMS_PERIOD_STATUS) - RTEMS_TIMEOUT"
);
status = rtems_rate_monotonic_cancel( 100 );
fatal_directive_status(
status,
RTEMS_INVALID_ID,
"rtems_rate_monotonic_cancel with illegal id"
);
puts( "TA1 - rtems_rate_monotonic_cancel - unknown RTEMS_INVALID_ID" );
status = rtems_rate_monotonic_cancel( 0x10100 );
fatal_directive_status(
status,
RTEMS_INVALID_ID,
"rtems_rate_monotonic_cancel will illegal id"
);
puts( "TA1 - rtems_rate_monotonic_cancel - local RTEMS_INVALID_ID" );
status = rtems_rate_monotonic_cancel( Period_id[ 1 ] );
directive_failed( status, "rtems_rate_monotonic_cancel" );
puts( "TA1 - rtems_rate_monotonic_cancel - RTEMS_SUCCESSFUL" );
status = rtems_rate_monotonic_period( Period_id[ 1 ], 5 );
directive_failed( status, "rtems_rate_monotonic_period restart" );
status = rtems_task_wake_after( 1 * TICKS_PER_SECOND );
directive_failed( status, "rtems_task_wake_after" );
status = rtems_rate_monotonic_period( Period_id[ 1 ], 5 );
fatal_directive_status(
status,
RTEMS_TIMEOUT,
"rtems_rate_monotonic_period"
);
puts( "TA1 - rtems_rate_monotonic_period - 5 ticks - RTEMS_TIMEOUT" );
status = rtems_task_start( Task_id[ 4 ], Task_4, 0 );
directive_failed( status, "rtems_task_start of TA4" );
puts( "TA1 - yielding to TA4" );
status = rtems_task_wake_after( RTEMS_YIELD_PROCESSOR );
status = rtems_rate_monotonic_delete( 100 );
fatal_directive_status(
status,
RTEMS_INVALID_ID,
"rtems_rate_monotonic_delete with illegal id"
);
puts( "TA1 - rtems_rate_monotonic_delete - unknown RTEMS_INVALID_ID" );
status = rtems_rate_monotonic_delete( 0x10100 );
fatal_directive_status(
status,
RTEMS_INVALID_ID,
"rtems_rate_monotonic_delete with illegal id"
);
puts( "TA1 - rtems_rate_monotonic_delete - local RTEMS_INVALID_ID" );
status = rtems_rate_monotonic_delete( Period_id[ 1 ] );
directive_failed( status, "rtems_rate_monotonic_delete" );
puts( "TA1 - rtems_rate_monotonic_delete - RTEMS_SUCCESSFUL" );
}
rtems_task Test_task(
rtems_task_argument argument
)
{
rtems_status_code status;
uint32_t count;
uint32_t remote_node;
rtems_id remote_tid;
rtems_event_set event_out;
Stop_Test = false;
remote_node = (Multiprocessing_configuration.node == 1) ? 2 : 1;
puts_nocr( "Remote task's name is : " );
put_name( Task_name[ remote_node ], TRUE );
puts( "Getting TID of remote task" );
do {
status = rtems_task_ident(
Task_name[ remote_node ],
RTEMS_SEARCH_ALL_NODES,
&remote_tid
);
} while ( !rtems_is_status_successful( status ) );
if ( Multiprocessing_configuration.node == 1 ) {
puts( "Sending first event to remote task" );
status = rtems_event_send( remote_tid, RTEMS_EVENT_16 );
directive_failed( status, "rtems_event_send" );
}
status = rtems_timer_fire_after(
Timer_id[ 1 ],
5 * rtems_clock_get_ticks_per_second(),
Stop_Test_TSR,
NULL
);
directive_failed( status, "rtems_timer_fire_after" );
while ( true ) {
for ( count=DOT_COUNT ; count && (Stop_Test == false) ; count-- ) {
status = rtems_event_receive(
RTEMS_EVENT_16,
RTEMS_DEFAULT_OPTIONS,
rtems_clock_get_ticks_per_second(),
&event_out
);
if ( status == RTEMS_TIMEOUT ) {
printf("\nTA1 - RTEMS_TIMEOUT .. probably OK if the other node exits");
Stop_Test = true;
break;
} else
directive_failed( status, "rtems_event_receive" );
status = rtems_event_send( remote_tid, RTEMS_EVENT_16 );
directive_failed( status, "rtems_event_send" );
}
if ( Stop_Test )
break;
put_dot('.');
}
/*
* Wait a bit before shutting down so we don't screw up the other node
* when our MPCI shuts down
*/
rtems_task_wake_after(10);
puts( "\n*** END OF TEST 7 ***" );
rtems_test_exit( 0 );
}
void mc9328mxl_enet_init_hw(mc9328mxl_enet_softc_t *sc)
{
uint16_t stat;
uint16_t my = 0;
lan91c11x_write_reg(LAN91C11X_RCR, LAN91C11X_RCR_RST);
lan91c11x_write_reg(LAN91C11X_RCR, 0);
rtems_task_wake_after(1);
/* Reset the PHY */
lan91c11x_write_phy_reg(PHY_CTRL, PHY_CTRL_RST);
while(lan91c11x_read_phy_reg(PHY_CTRL) & PHY_CTRL_RST) {
rtems_task_wake_after(1);
}
stat = lan91c11x_read_phy_reg(PHY_STAT);
if(stat & PHY_STAT_CAPT4) {
my |= PHY_ADV_T4;
}
/* 100Mbs doesn't work, so we won't advertise it */
if(stat & PHY_STAT_CAPTXF) {
my |= PHY_ADV_TXFDX;
}
if(stat & PHY_STAT_CAPTXH) {
my |= PHY_ADV_TXHDX;
}
if(stat & PHY_STAT_CAPTF) {
my |= PHY_ADV_10FDX;
}
if(stat & PHY_STAT_CAPTH) {
my |= PHY_ADV_10HDX;
}
my |= PHY_ADV_CSMA;
lan91c11x_write_phy_reg(PHY_AD, my);
/* Enable Autonegotiation */
#if 0
lan91c11x_write_phy_reg(PHY_CTRL,
(PHY_CTRL_ANEGEN | PHY_CTRL_ANEGRST));
#endif
/* Enable full duplex, let MAC take care
* of padding and CRC.
*/
lan91c11x_write_reg(LAN91C11X_TCR,
(LAN91C11X_TCR_PADEN |
LAN91C11X_TCR_SWFDUP));
/* Disable promisc, don'tstrip CRC */
lan91c11x_write_reg(LAN91C11X_RCR, 0);
/* Enable auto-negotiation, LEDA is link, LEDB is traffic */
lan91c11x_write_reg(LAN91C11X_RPCR,
(LAN91C11X_RPCR_ANEG |
LAN91C11X_RPCR_LS2B));
/* Don't add wait states, enable PHY power */
lan91c11x_write_reg(LAN91C11X_CONFIG,
(LAN91C11X_CONFIG_NOWAIT |
LAN91C11X_CONFIG_PWR));
/* Disable error interrupts, enable auto release */
lan91c11x_write_reg(LAN91C11X_CTRL, LAN91C11X_CTRL_AUTO);
/* Reset MMU */
lan91c11x_write_reg(LAN91C11X_MMUCMD,
LAN91C11X_MMUCMD_RESETMMU );
rtems_task_wake_after(100);
/* Enable Autonegotiation */
lan91c11x_write_phy_reg(PHY_CTRL, 0x3000);
rtems_task_wake_after(100);
/* Enable Interrupts for RX */
lan91c11x_write_reg(LAN91C11X_INT, LAN91C11X_INT_RXMASK);
/* Enable interrupts on GPIO Port A3 */
/* Make pin 3 an input */
MC9328MXL_GPIOA_DDIR &= ~bit(3);
/* Use GPIO function for pin 3 */
MC9328MXL_GPIOA_GIUS |= bit(3);
/* Set for active high, level triggered interupt */
MC9328MXL_GPIOA_ICR1 = ((MC9328MXL_GPIOA_ICR1 & ~(3 << 6)) |
(2 << 6));
/* Enable GPIO port A3 interrupt */
MC9328MXL_GPIOA_IMR |= bit(3);
/* Install the interrupt handler */
BSP_install_rtems_irq_handler(&mc9328mxl_enet_isr_data);
} /* mc9328mxl_enet_init_hw() */
rtems_task Test_task(
rtems_task_argument argument
)
{
rtems_status_code status;
uint32_t count;
uint32_t remote_node;
rtems_id remote_tid;
rtems_event_set event_out;
remote_node = ((Multiprocessing_configuration.node == 1) ? 2 : 1);
puts( "About to go to sleep!" );
status = rtems_task_wake_after( rtems_clock_get_ticks_per_second() );
directive_failed( status, "rtems_task_wake_after" );
puts( "Waking up!" );
puts_nocr( "Remote task's name is : " );
put_name( Task_name[ remote_node ], TRUE );
puts( "Getting TID of remote task" );
while ( FOREVER ) {
status = rtems_task_ident(
Task_name[ remote_node ],
RTEMS_SEARCH_ALL_NODES,
&remote_tid
);
if ( status == RTEMS_SUCCESSFUL )
break;
puts( "rtems_task_ident FAILED!!" );
rtems_task_wake_after(2);
}
if ( Multiprocessing_configuration.node == 1 ) {
puts( "Sending events to remote task" );
while ( Stop_Test == false ) {
for ( count=EVENT_TASK_DOT_COUNT; Stop_Test == false && count; count-- ) {
status = rtems_event_send( remote_tid, RTEMS_EVENT_16 );
directive_failed( status, "rtems_event_send" );
}
put_dot( 'e' );
}
}
puts( "Receiving events from remote task" );
while ( Stop_Test == false ) {
for ( count=EVENT_TASK_DOT_COUNT ; Stop_Test == false && count ; count-- ) {
status = rtems_event_receive(
RTEMS_EVENT_16,
RTEMS_DEFAULT_OPTIONS,
RTEMS_NO_TIMEOUT,
&event_out
);
directive_failed( status, "rtems_event_receive" );
}
put_dot( 'e' );
}
Exit_test();
}
rtems_task Test_task(
rtems_task_argument argument
)
{
rtems_status_code status;
uint32_t count;
uint32_t remote_node;
rtems_id remote_tid;
rtems_event_set event_out;
rtems_event_set event_for_this_iteration;
Stop_Test = false;
remote_node = (Multiprocessing_configuration.node == 1) ? 2 : 1;
puts_nocr( "Remote task's name is : " );
put_name( Task_name[ remote_node ], TRUE );
puts( "Getting TID of remote task" );
do {
status = rtems_task_ident(
Task_name[ remote_node ],
RTEMS_SEARCH_ALL_NODES,
&remote_tid
);
} while ( status != RTEMS_SUCCESSFUL );
directive_failed( status, "rtems_task_ident FAILED!!" );
if ( Multiprocessing_configuration.node == 1 )
puts( "Sending events to remote task" );
else
puts( "Receiving events from remote task" );
status = rtems_timer_fire_after(
Timer_id[ 1 ],
5 * rtems_clock_get_ticks_per_second(),
Stop_Test_TSR,
NULL
);
directive_failed( status, "rtems_timer_fire_after" );
count = 0;
for ( ; ; ) {
if ( Stop_Test == true )
break;
event_for_this_iteration = Event_set_table[ count % 32 ];
if ( Multiprocessing_configuration.node == 1 ) {
status = rtems_event_send( remote_tid, event_for_this_iteration );
directive_failed( status, "rtems_event_send" );
status = rtems_task_wake_after( 1 );
directive_failed( status, "rtems_task_wake_after" );
} else {
status = rtems_event_receive(
event_for_this_iteration,
RTEMS_DEFAULT_OPTIONS,
1 * rtems_clock_get_ticks_per_second(),
&event_out
);
if ( rtems_are_statuses_equal( status, RTEMS_TIMEOUT ) ) {
if ( Multiprocessing_configuration.node == 2 )
puts( "\nCorrect behavior if the other node exitted." );
else
puts( "\nERROR... node 1 died" );
break;
} else
directive_failed( status, "rtems_event_receive" );
}
if ( (count % DOT_COUNT) == 0 )
put_dot('.');
count++;
}
putchar( '\n' );
if ( Multiprocessing_configuration.node == 2 ) {
/* Flush events */
puts( "Flushing RTEMS_EVENT_16" );
(void) rtems_event_receive(RTEMS_EVENT_16, RTEMS_NO_WAIT, 0, &event_out);
puts( "Waiting for RTEMS_EVENT_16" );
status = rtems_event_receive(
RTEMS_EVENT_16,
RTEMS_DEFAULT_OPTIONS,
1 * rtems_clock_get_ticks_per_second(),
&event_out
);
fatal_directive_status( status, RTEMS_TIMEOUT, "rtems_event_receive" );
puts( "rtems_event_receive - correctly returned RTEMS_TIMEOUT" );
}
puts( "*** END OF TEST 6 ***" );
rtems_test_exit( 0 );
}
rtems_task Task_1(
rtems_task_argument argument
)
{
rtems_mode previous_mode;
rtems_status_code status;
puts( "TA1 - rtems_signal_catch - RTEMS_INTERRUPT_LEVEL( 3 )" );
status = rtems_signal_catch( Process_asr, RTEMS_INTERRUPT_LEVEL(3) );
directive_failed( status, "rtems_signal_catch" );
puts( "TA1 - rtems_signal_send - RTEMS_SIGNAL_16 to self" );
status = rtems_signal_send( RTEMS_SELF, RTEMS_SIGNAL_16 );
directive_failed( status, "rtems_signal_send" );
puts( "TA1 - rtems_signal_send - RTEMS_SIGNAL_0 to self" );
status = rtems_signal_send( RTEMS_SELF, RTEMS_SIGNAL_0 );
directive_failed( status, "rtems_signal_send" );
puts( "TA1 - rtems_signal_catch - RTEMS_NO_ASR" );
status = rtems_signal_catch( Process_asr, RTEMS_NO_ASR );
directive_failed( status, "rtems_signal_catch" );
FLUSH_OUTPUT();
rtems_test_pause();
puts( "TA1 - rtems_signal_send - RTEMS_SIGNAL_1 to self" );
status = rtems_signal_send( RTEMS_SELF, RTEMS_SIGNAL_1 );
directive_failed( status, "rtems_signal_send" );
puts( "TA1 - rtems_task_mode - disable ASRs" );
status = rtems_task_mode( RTEMS_NO_ASR, RTEMS_ASR_MASK, &previous_mode );
directive_failed( status, "rtems_task_mode" );
Timer_got_this_id = 0;
Timer_got_this_pointer = NULL;
puts( "TA1 - sending signal to RTEMS_SELF from timer" );
status = rtems_timer_fire_after(
Timer_id[ 1 ],
rtems_clock_get_ticks_per_second() / 2,
Signal_3_to_task_1,
(void *) Task_1
);
directive_failed( status, "rtems_timer_fire_after" );
puts( "TA1 - waiting for signal to arrive" );
Signals_sent = FALSE;
Asr_fired = FALSE;
while ( Signals_sent == FALSE )
;
if ( Timer_got_this_id == Timer_id[ 1 ] &&
Timer_got_this_pointer == Task_1 )
puts( "TA1 - timer routine got the correct arguments" );
else
printf(
"TA1 - timer got (0x%" PRIxrtems_id ", %p) instead of (0x%"
PRIxrtems_id ", %p)!!!!\n",
Timer_got_this_id,
Timer_got_this_pointer,
Timer_id[ 1 ],
Task_1
);
puts( "TA1 - rtems_task_mode - enable ASRs" );
FLUSH_OUTPUT();
status = rtems_task_mode( RTEMS_ASR, RTEMS_ASR_MASK, &previous_mode );
directive_failed( status, "rtems_task_mode" );
status = rtems_task_wake_after(2 * rtems_clock_get_ticks_per_second());
directive_failed( status, "rtems_task_wake_after" );
puts( "TA1 - rtems_signal_catch - asraddr of NULL" );
status = rtems_signal_catch( NULL, RTEMS_DEFAULT_MODES );
directive_failed( status, "rtems_signal_catch" );
puts( "TA1 - rtems_task_delete - delete self" );
status = rtems_task_delete( RTEMS_SELF );
directive_failed( status, "rtems_task_delete of RTEMS_SELF" );
}
void Screen8()
{
long buffer[ 4 ];
rtems_status_code status;
status = rtems_message_queue_delete( Queue_id[ 1 ] );
directive_failed( status, "rtems_message_queue_delete successful" );
puts( "TA1 - rtems_message_queue_delete - Q 1 - RTEMS_SUCCESSFUL" );
status = rtems_message_queue_create(
Queue_name[ 1 ],
2,
MESSAGE_SIZE,
RTEMS_DEFAULT_ATTRIBUTES,
&Queue_id[ 1 ]
);
directive_failed( status, "rtems_message_queue_create successful" );
puts(
"TA1 - rtems_message_queue_create - Q 1 - 2 DEEP - RTEMS_SUCCESSFUL"
);
status = rtems_message_queue_send( Queue_id[ 1 ], buffer, MESSAGE_SIZE );
directive_failed( status, "rtems_message_queue_send successful" );
puts( "TA1 - rtems_message_queue_send - BUFFER 1 TO Q 1 - RTEMS_SUCCESSFUL" );
status = rtems_message_queue_send( Queue_id[ 1 ], buffer, MESSAGE_SIZE );
directive_failed( status, "rtems_message_queue_send successful" );
puts( "TA1 - rtems_message_queue_send - BUFFER 2 TO Q 1 - RTEMS_SUCCESSFUL" );
status = rtems_message_queue_send( Queue_id[ 1 ], buffer, MESSAGE_SIZE );
fatal_directive_status(
status,
RTEMS_TOO_MANY,
"rtems_message_queue_send too many to limited queue"
);
puts( "TA1 - rtems_message_queue_send - BUFFER 3 TO Q 1 - RTEMS_TOO_MANY" );
status = rtems_message_queue_delete( Queue_id[ 1 ] );
directive_failed( status, "rtems_message_queue_delete successful" );
puts( "TA1 - rtems_message_queue_delete - Q 1 - RTEMS_SUCCESSFUL" );
status = rtems_message_queue_create(
Queue_name[ 1 ],
3,
MESSAGE_SIZE,
RTEMS_DEFAULT_ATTRIBUTES,
&Queue_id[ 1 ]
);
directive_failed( status, "rtems_message_queue_create successful" );
puts(
"TA1 - rtems_message_queue_create - Q 1 - 3 DEEP - RTEMS_SUCCESSFUL"
);
status = rtems_message_queue_send( Queue_id[ 1 ], buffer, MESSAGE_SIZE );
directive_failed( status, "rtems_message_queue_send successful" );
puts( "TA1 - rtems_message_queue_send - BUFFER 1 TO Q 1 - RTEMS_SUCCESSFUL" );
status = rtems_message_queue_send( Queue_id[ 1 ], buffer, MESSAGE_SIZE );
directive_failed( status, "rtems_message_queue_send successful" );
puts( "TA1 - rtems_message_queue_send - BUFFER 2 TO Q 1 - RTEMS_SUCCESSFUL" );
status = rtems_message_queue_send( Queue_id[ 1 ], buffer, MESSAGE_SIZE );
directive_failed( status, "rtems_message_queue_send successful" );
puts( "TA1 - rtems_message_queue_send - BUFFER 3 TO Q 1 - RTEMS_SUCCESSFUL" );
status = rtems_message_queue_send( Queue_id[ 1 ], buffer, MESSAGE_SIZE );
fatal_directive_status(
status,
RTEMS_TOO_MANY,
"rtems_message_queue_send too many to limited queue"
);
puts(
"TA1 - rtems_message_queue_send - BUFFER 4 TO Q 1 - RTEMS_TOO_MANY"
);
status = rtems_message_queue_delete( Queue_id[ 1 ] );
directive_failed( status, "rtems_message_queue_delete successful" );
puts( "TA1 - rtems_message_queue_delete - Q 1 - RTEMS_SUCCESSFUL" );
status = rtems_message_queue_create(
Queue_name[ 1 ],
3,
MESSAGE_SIZE,
RTEMS_DEFAULT_ATTRIBUTES,
&Queue_id[ 1 ]
);
directive_failed( status, "rtems_message_queue_create successful" );
puts(
"TA1 - rtems_message_queue_create - Q 1 - 3 DEEP - RTEMS_SUCCESSFUL"
);
puts( "TA1 - rtems_task_start - start TA3 - RTEMS_SUCCESSFUL" );
status = rtems_task_start( Task_id[ 3 ], Task_3, 0 );
directive_failed( status, "rtems_task_start of TA3" );
puts( "TA1 - rtems_task_wake_after - yield processor - RTEMS_SUCCESSFUL" );
status = rtems_task_wake_after( RTEMS_YIELD_PROCESSOR );
directive_failed( status, "rtems_task_wake_after (yield)" );
puts( "TA1 - rtems_message_queue_delete - delete Q 1 - RTEMS_SUCCESSFUL" );
status = rtems_message_queue_delete( Queue_id[ 1 ] );
directive_failed( status, "rtems_message_queue_delete successful" );
puts( "TA1 - rtems_task_wake_after - yield processor - RTEMS_SUCCESSFUL" );
status = rtems_task_wake_after( RTEMS_YIELD_PROCESSOR );
directive_failed( status, "rtems_task_wake_after (yield)" );
}
rtems_task Task_2(
rtems_task_argument argument
)
{
rtems_event_set eventout;
rtems_time_of_day time;
rtems_status_code status;
status = rtems_task_wake_after( rtems_clock_get_ticks_per_second() );
directive_failed( status, "rtems_task_wake_after" );
puts( "TA2 - rtems_event_receive - waiting forever on RTEMS_EVENT_16" );
status = rtems_event_receive(
RTEMS_EVENT_16,
RTEMS_DEFAULT_OPTIONS,
RTEMS_NO_TIMEOUT,
&eventout
);
directive_failed( status, "rtems_event_receive" );
printf(
"TA2 - RTEMS_EVENT_16 received - eventout => %08" PRIxrtems_event_set "\n",
eventout
);
puts(
"TA2 - rtems_event_send - send RTEMS_EVENT_14 and RTEMS_EVENT_15 to TA1"
);
status = rtems_event_send( Task_id[ 1 ], RTEMS_EVENT_14 | RTEMS_EVENT_15 );
directive_failed( status, "rtems_event_send" );
puts(
"TA2 - rtems_event_receive - RTEMS_EVENT_17 or "
"RTEMS_EVENT_18 - forever and ANY"
);
status = rtems_event_receive(
RTEMS_EVENT_17 | RTEMS_EVENT_18,
RTEMS_EVENT_ANY,
RTEMS_NO_TIMEOUT,
&eventout
);
directive_failed( status, "rtems_event_receive" );
printf(
"TA2 - RTEMS_EVENT_17 or RTEMS_EVENT_18 received - "
"eventout => %08" PRIxrtems_event_set "\n",
eventout
);
puts( "TA2 - rtems_event_send - send RTEMS_EVENT_14 to TA1" );
status = rtems_event_send( Task_id[ 1 ], RTEMS_EVENT_14 );
directive_failed( status, "rtems_event_send" );
build_time( &time, 2, 12, 1988, 8, 15, 0, 0 );
print_time( "TA2 - rtems_clock_set - ", &time, "\n" );
status = rtems_clock_set( &time );
directive_failed( status, "TA2 rtems_clock_set" );
time.second += 4;
puts(
"TA2 - rtems_event_send - sending RTEMS_EVENT_10 to self after 4 seconds"
);
status = rtems_timer_fire_when(
Timer_id[ 5 ],
&time,
TA2_send_10_to_self,
NULL
);
directive_failed( status, "rtems_timer_fire_when after 4 seconds" );
puts( "TA2 - rtems_event_receive - waiting forever on RTEMS_EVENT_10" );
status = rtems_event_receive(
RTEMS_EVENT_10,
RTEMS_DEFAULT_OPTIONS,
RTEMS_NO_TIMEOUT,
&eventout
);
directive_failed( status, "rtems_event_receive" );
status = rtems_clock_get_tod( &time );
directive_failed( status, "rtems_clock_get_tod" );
printf(
"TA2 - RTEMS_EVENT_10 received - eventout => %08" PRIxrtems_event_set "\n",
eventout
);
print_time( "TA2 - rtems_clock_get_tod - ", &time, "\n" );
puts( "TA2 - rtems_event_receive - RTEMS_PENDING_EVENTS" );
status = rtems_event_receive(
RTEMS_PENDING_EVENTS,
RTEMS_DEFAULT_OPTIONS,
RTEMS_NO_TIMEOUT,
&eventout
);
directive_failed( status, "rtems_event_receive" );
printf( "TA2 - eventout => %08" PRIxrtems_event_set "\n", eventout );
puts( "TA2 - rtems_event_receive - RTEMS_EVENT_19 - RTEMS_NO_WAIT" );
status = rtems_event_receive(
RTEMS_EVENT_19,
RTEMS_NO_WAIT,
RTEMS_NO_TIMEOUT,
&eventout
);
directive_failed( status, "rtems_event_receive" );
printf(
"TA2 - RTEMS_EVENT_19 received - eventout => %08" PRIxrtems_event_set "\n",
eventout
);
puts( "TA2 - rtems_task_delete - deletes self" );
status = rtems_task_delete( Task_id[ 2 ] );
directive_failed( status, "rtems_task_delete of TA2" );
}
rtems_task Init(
rtems_task_argument ignored
)
{
rtems_status_code status;
rtems_id task_id;
void *address_1;
rtems_task_priority priority;
puts( "\n\n*** TEST 59 ***" );
priority = RTEMS_MAXIMUM_PRIORITY / 4;
priority = (priority * 3) + (priority / 2);
printf(
"Init - blocking task priority will be %" PRIdrtems_task_priority "\n",
priority
);
puts( "Init - rtems_task_create - delay task - OK" );
status = rtems_task_create(
rtems_build_name( 'T', 'A', '1', ' ' ),
priority,
RTEMS_MINIMUM_STACK_SIZE,
RTEMS_DEFAULT_OPTIONS,
RTEMS_DEFAULT_ATTRIBUTES,
&task_id
);
directive_failed( status, "rtems_task_create" );
puts( "Init - rtems_task_start - delay task - OK" );
status = rtems_task_start( task_id, Blocking_task, 0 );
directive_failed( status, "rtems_task_start" );
puts( "Init - rtems_region_create - OK" );
status = rtems_region_create(
rtems_build_name('R', 'N', '0', '1'),
Region_Memory,
sizeof( Region_Memory ),
64,
RTEMS_PRIORITY,
&Region
);
directive_failed( status, "rtems_region_create of RN1" );
puts( "Init - rtems_region_get_segment - get segment to consume memory" );
rtems_region_get_segment(
Region,
ALLOC_SIZE,
RTEMS_PRIORITY,
RTEMS_NO_TIMEOUT,
&address_1
);
directive_failed( status, "rtems_region_get_segment" );
puts( "Init - rtems_task_wake_after - let other task block - OK" );
status = rtems_task_wake_after( RTEMS_MILLISECONDS_TO_TICKS(1000) );
directive_failed( status, "rtems_task_wake_after" );
puts( "Init - rtems_region_get_segment - return segment" );
status = rtems_region_return_segment( Region, address_1 );
directive_failed( status, "rtems_region_return_segment" );
puts( "Init - rtems_task_wake_after - let other task run again - OK" );
status = rtems_task_wake_after( RTEMS_MILLISECONDS_TO_TICKS(1000) );
directive_failed( status, "rtems_task_wake_after" );
puts( "*** END OF TEST 59 ***" );
rtems_test_exit(0);
}
