#include "tpl_os.h"

#define APP_Task_blink_START_SEC_CODE
#include "tpl_memmap.h"

uint8 shared_memory[16][16];
uint8 result_array[4][17];

uint32 g_counter = 0;

extern volatile TickType tpl_time_counter; // 10msec/count 
#define TICK_TO_MSEC(t)	(t*10)
#define TICK_TO_SEC(t)	(t/100)

/**
 * external functions
 */
extern void dhrystone_main(void);
extern void coremark_main(void);

void float_to_char(uint8 input_array[], float input) {
  uint8 i, n;
  uint8 ascii_offset = 0x20; // 0x30 = '0' / 0x20 = ' '
  float tmp;

  for (i=0; i<16; ++i){
    tmp = input;
    if (i < 8) {
      for(n=i+1; n<8;++n)
        tmp = tmp / 10;
    }
    else {
      for(n=7; n<i; ++n)
        tmp = tmp * 10;
    }

    if((int)tmp%10 != 0 || i == 7)
      ascii_offset = 0x30; // changed at once

    input_array[i+(i/8)] = (ascii_offset + (int)tmp%10); // if (i==8) i+1, else i
  }
  input_array[8] = '.';
  input_array[16] = '\0';
}
void int_to_char(uint8 input_array[], int input) {
  uint8 i, n;
  uint8 ascii_offset = 0x20; // 0x30 = '0' / 0x20 = ' '
  int tmp;

  for (i=0; i<16; ++i){
    tmp = input;
      for(n=i+1; n<16;++n)
        tmp = tmp / 10;
    if((int)tmp%10 != 0)
      ascii_offset = 0x30; // changed at once

    input_array[i] = (ascii_offset + (int)tmp%10); // if (i==8) i+1, else i
  }
}

// return msec
uint32 ms_time() { return TICK_TO_MSEC(tpl_time_counter); }
// return sec
uint32 time() { return TICK_TO_SEC(tpl_time_counter); }

void sec_sleep(int sec)
{
	uint32 end;
	end = time() + sec;
	while(end > time());
}

void ms_sleep(int ms)
{
	uint32 end;
	end = ms_time() + ms;
	while(end > ms_time());
}

FUNC(int, OS_APPL_CODE) main(void)
{
	StartOS(OSDEFAULTAPPMODE);
	return 0;
}

TASK(benchmark)
{
	dhrystone_main();
	ms_sleep(100);

	coremark_main();
	sec_sleep(1);

	while(1) {
		g_counter = time();
		sec_sleep(1);
	}
	TerminateTask();
}

#define APP_Task_blink_STOP_SEC_CODE
#include "tpl_memmap.h"