Subversion Repositories openrisc

/*  Task_1
 *
 *  This routine serves as a test task.  It verifies the basic task
 *  switching capabilities of the executive.
 *
 *  Input parameters:
 *    argument - task argument
 *
 *  Output parameters:  NONE
 *
 *  COPYRIGHT (c) 1989-1999.
 *  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: task.c,v 1.2 2001-09-27 12:02:24 chris Exp $
 */
 
#include "system.h"
#include <time.h>
#include <sched.h>
 
void diff_timespec(
  struct timespec *start,
  struct timespec *stop,
  struct timespec *result
)
{
   int nsecs_per_sec = 1000000000;
 
   result->tv_sec = stop->tv_sec - start->tv_sec;
   if ( stop->tv_nsec < start->tv_nsec ) {
      result->tv_nsec = nsecs_per_sec - start->tv_nsec + stop->tv_nsec;
      result->tv_sec--;
   } else
      result->tv_nsec = stop->tv_nsec - start->tv_nsec;
 
}
 
void *Task_1(
  void *argument
)
{
  int status;
  struct timespec start;
  struct timespec current;
  struct timespec difference;
  struct timespec delay;
 
  status = clock_gettime( CLOCK_REALTIME, &start );
  assert( !status );
 
  status = sched_rr_get_interval( getpid(), &delay );
  assert( !status );
 
  /* double the rr interval for confidence */
 
  delay.tv_sec *= 2;
  delay.tv_nsec *= 2;
  if ( delay.tv_nsec >= 1000000000 ) {   /* handle overflow/carry */
    delay.tv_nsec -= 1000000000;
    delay.tv_sec++;
  }
 
 
  puts( "Task_1: killing time" );
  for ( ; ; ) {
 
    status = clock_gettime( CLOCK_REALTIME, &current );
    assert( !status );
 
    diff_timespec( &start, &current, &difference );
 
    if ( difference.tv_sec < delay.tv_sec )
      continue;
 
    if ( difference.tv_sec > delay.tv_sec )
      break;
 
    if ( difference.tv_nsec > delay.tv_nsec )
      break;
 
  }
 
  puts( "Task_1: exitting" );
  pthread_exit( NULL );
 
  return NULL; /* just so the compiler thinks we returned something */
}