#include "bsp_init.h"
#include "robot.h"
#include "robot_def.h"
#include "robot_task.h"

#include "gimbal.h"
#include "robot_cmd.h"

void RobotInit()
{
    __disable_irq();

    BSPInit();
    RobotCMDInit();
    GimbalInit();
    OSTaskInit();

    __enable_irq();
}

void RobotTask()
{
    RobotCMDTask();
    GimbalTask();
}