/*
 *  COPYRIGHT (c) 1989-2007.
 *  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.com/license/LICENSE.
 *
 *  $Id$
 */

#include <stdio.h>
#include <bsp.h>

#include "../../testmacros.h"
#include "../led.h"

rtems_id          Timer1;
rtems_id          Timer2;

#define USE_TIMER_SERVER
#if defined(__LED_PRINTING)
volatile int led_do_print;
volatile int led_value;
#endif

rtems_timer_service_routine Timer_Routine( rtems_id id, void *ignored )
{
  rtems_status_code status;

#if defined(__LED_PRINTING)
  if ( id == Timer1 )
    led_value = 1;
  else
    led_value = 0;
  led_do_print = 1;
#else
  if ( id == Timer1 )
    LED_ON();
  else
    LED_OFF();
#endif

#if defined(USE_TIMER_SERVER)
  status = rtems_timer_server_fire_after(
#else
  status = rtems_timer_fire_after(
#endif
    id,
    2 * get_ticks_per_second(),
    Timer_Routine,
    NULL
  );
}

rtems_task Init(
  rtems_task_argument argument
)
{
  rtems_status_code status;

  puts( "\n\n*** LED BLINKER -- timer ***" );

  LED_INIT();

#if defined(USE_TIMER_SERVER)
  status = rtems_timer_initiate_server(
    1, 
    RTEMS_MINIMUM_STACK_SIZE * 2,
    RTEMS_DEFAULT_ATTRIBUTES
  );

  if ( status != RTEMS_SUCCESSFUL )
    fputs( "timer create server failed\n", stderr );
#endif

  status = rtems_timer_create(rtems_build_name( 'T', 'M', 'R', '1' ), &Timer1);
  if ( status != RTEMS_SUCCESSFUL )
    fputs( "Timer1 create failed\n", stderr );

  status = rtems_timer_create(rtems_build_name( 'T', 'M', 'R', '2' ), &Timer2);
  if ( status != RTEMS_SUCCESSFUL )
    fputs( "Timer2 create failed\n", stderr );

  Timer_Routine(Timer1, NULL);

  status = rtems_task_wake_after( get_ticks_per_second() );

  Timer_Routine(Timer2, NULL);


#if defined(__LED_PRINTING)
  
  while (1) {
    int _led_do_print;
    int _led_value;

    status = rtems_task_wake_after( 10 );

    /* technically the following 4 statements are a critical section */
    _led_do_print = led_do_print;
    _led_value = led_value;
    led_do_print = 0;
    led_value = 0;
    
    if ( _led_do_print ) {
      if ( _led_value )
        LED_ON();
      else
        LED_OFF();

    }
  }
#endif
  status = rtems_task_delete( RTEMS_SELF );
}


/**************** START OF CONFIGURATION INFORMATION ****************/

#define CONFIGURE_INIT
#define CONFIGURE_APPLICATION_NEEDS_CONSOLE_DRIVER
#define CONFIGURE_APPLICATION_NEEDS_CLOCK_DRIVER

#define CONFIGURE_MAXIMUM_TASKS         4
#define CONFIGURE_MAXIMUM_TIMERS        2
#define CONFIGURE_MAXIMUM_SEMAPHORES    20

#define CONFIGURE_RTEMS_INIT_TASKS_TABLE

#define CONFIGURE_EXTRA_TASK_STACKS         (3 * RTEMS_MINIMUM_STACK_SIZE)

#include <rtems/confdefs.h>

/****************  END OF CONFIGURATION INFORMATION  ****************/