#include "app/app.h"
#include "bsp/bsp.h"
#include "os/timer.h"
#include "os/co_task.h"
#include "libs/logger.h"
#include "prot/can_message.h"
#include "foc/foc_api.h"


static void _test_timer_handler(timer_t *t);
static void _log_test(void *args);

static timer_t test_timer = TIMER_INIT(test_timer, _test_timer_handler);

void app_start(void){
	set_log_level(MOD_SYSTEM, L_debug);
	can_message_init();
	foc_init();
	co_task_create(_log_test, NULL, 512);
	timer_post(&test_timer, 200);
	co_task_schedule();
}

static void _test_timer_handler(timer_t *t){
	//foc_start_motor();
}


static void _log_test(void *args) {
	int count = 0;
	while(1) {
		sys_debug("log test count %d\n", count++);
		co_task_delay(500);
	}
}