/**
 * @file   test015.c
 * @author Scott Craig and Justin Tanner
 * @date   Mon Oct 29 16:19:32 2007
 * 
 * @brief  Test 015 - measure the latency of periodic tasks ( under a high load of busy RR tasks )
 * 
 */

#include "common.h"
#include "OS/os.h"
#include "uart/uart.h"
#include "trace/trace.h"

enum { A=1, B, C, D, E, F, G };
const unsigned int PT = 10;
const unsigned char PPP[] = {A, 1, B, 1, A, 1, B, 1, A, 1, B, 1, A, 1, B, 1, A, 1, B, 1};

uint16_t last = 0;
uint16_t time = 0;
EVENT* print_event;

void periodic_task(void)
{
    for(;;)
    {
        time = TCNT3;
        
		add_to_trace(time - last);

        last = time;

        Task_Next();
    }
}

void very_busy_rr(void)
{
    uint32_t i;
    for(;;)
    {
        for(i = 0; i < 999999; i++) {};
        Task_Next();
    }
}

int main(void)
{
    /* setup the test */
	uart_init();
	uart_write((uint8_t*)"\r\nSTART\r\n", 9);
    set_test(15);

    print_event = Event_Init();
    
    /* Run clock at 1MHz. */
    TCCR3B = _BV(CS31);

    Task_Create(very_busy_rr, 1, RR, 0);
    Task_Create(very_busy_rr, 2, RR, 0);
    Task_Create(very_busy_rr, 3, RR, 0);
    Task_Create(very_busy_rr, 4, RR, 0);
    Task_Create(very_busy_rr, 5, RR, 0);
    Task_Create(very_busy_rr, 6, RR, 0);    
    Task_Create(periodic_task, A, PERIODIC, A);
	Task_Create(periodic_task, B, PERIODIC, B);
    
    Event_Wait(print_event);
    print_trace();
}