#include <stdio.h>
#include <rtems.h>
#include <rtems/error.h>
#include <time.h>


void helloWorld(void)
{
    printf(">>>> Hello World! <<<<\n");
}



rtems_task  helloWorld2(rtems_task_argument ignored)
{
    char shadow_reg_led = 0x01;
    char *reg_led = 0x9fff0003; 
    char *reg_sw  = 0x9fff0101;

    char sw;


    struct timespec req, rem;
    req.tv_sec  = 0;
    req.tv_nsec = (1./16.) * 1000000000L;

    printf(">>>> Hello World2 <<<<\n");

    for(;;) {
        if(shadow_reg_led == 0x80) shadow_reg_led = 0x01;
        else shadow_reg_led <<= 1; 
        output_byte(reg_led, shadow_reg_led);

        sw = input_byte(reg_sw);
        if(!(sw & 0x80)) break;
        
        nanosleep(&req, &rem);
    }

}