#include <stdbool.h>
#include <stdint.h>

#include "board_devices.h"
#include "stack.h"
#include "queue.h"
#include "kernel.h"
#include "driver.h"
#include "list.h"
#include "shell.h"
#include "shell_commands.h"
#include "drive_ctrl.h"
#include "collision_ctrl.h"
#include "sensor_data.h"
#include "system_state.h"

int main(void)
{
	shell_init(&uart_1);
	shell_commands_init();
	drive_ctrl_init();
	collision_ctrl_init();
	sensor_data_init();
	system_state_init();

	while(1) {
		system_state_poll();
		sleep_ms(0);
	}

	return 0;
}