/*
 * printable.cpp
 *
 *  Created on: Aug 30, 2023
 *      Author: Dario
 */

#include <sta/debug/debug.hpp>
#include <tasks/can_task.hpp>
#include <tasks/thermo.hpp>
#include <tasks/relay.hpp>
#include <sta/devices/stm32/gpio_pin.hpp>
#include <sta/rtos/debug/heap_stats.hpp>

#include <sta/tacos.hpp>


#include <memory>

extern CAN_HandleTypeDef hcan1;

namespace sta
{
	namespace tacos
	{
		void onStatemachineInit()
		{

		}

		void onManagerInit()
		{
			// ###### Register different threads for different states here. ######

			Manager::instance()->registerThread(std::make_shared<tasks::CanTask>(SYSTEM_CAN_MSG_HANDLER), {ALL_STATES});
			Manager::instance()->registerThread(std::make_shared<tasks::ThermoTask>(SYSTEM_CAN_THERMO), {ALL_STATES});
			Manager::instance()->registerThread(std::make_shared<tasks::RelayTask>(SYSTEM_CAN_RELAY), {ALL_STATES});

			STA_DEBUG_PRINTF("The answer to everything is %d", 42);

			STA_DEBUG_HEAP_STATS();
		}
	} // namespace tacos
} // namespace sta