赛前指导：第二届未来飞行器挑战赛实践赛道之技术详解

最新推荐文章于 2023-08-04 16:15:56 发布

阿木实验室

最新推荐文章于 2023-08-04 16:15:56 发布

阅读量541

点赞数 1

文章标签：仿真 Prometheus

本文链接：https://blog.csdn.net/msq19895070/article/details/126557836

版权

2022（第二届）四川省大学生未来飞行器挑战赛正在火热进行中，本次挑战赛中的实践类赛道将面向全省高校大学生个人或团队征集未来先进侦察打一体化无人机的实地竞赛，主要考察路劲规划、视觉目标搜索、舵机控制、车机协同等需要团队协作的多方面技术能力。

主办方将在赛场内提供 UWB 基站信号覆盖，参赛队伍可以自主选择目标识别和定位方式。阿木实验室作为大赛技术支持方，为给参赛队员提供更全面的指导，在赛事中更好地发挥，我们根据实践类比赛规则做了一版实践类赛道仿真demo，供参赛队员参考~

仿真效果展示

本功能包（future_aircraft）为Prometheus仿真功能包之一，主要用于实现2022（第二届）四川省大学生未来飞行器挑战赛的实践类仿真，仿真效果如下：

2022年四川省大学生未来飞行器挑战赛-实践类赛道仿真demo_哔哩哔哩_bilibili

首先我们需要通过gazebo仿真器搭建比赛区域，增加飞机模型以及相机模型，此时无人机将由H位置一键起飞，起飞后无人机会立即转换为自动模式，开始通过机载传感器（下视相机）自主搜索目标标靶，并在目标标靶上方保持动态跟踪悬停（precision loiter）尽可能模拟投掷子弹状态。

若您对于实践类赛道仿真demo有任何疑问或建议，欢迎在文章下方给我们留言发起讨论~接下来我们将给大家分享该仿真场景的一些代码设计思路。

代码设计思路

该仿真场景的代码设计主要由控制部分和视觉识别部分组成，具体介绍如下：

控制部分

根据比赛要求，我们可以将该比赛区域分割为三部分，如下图所示：

在三部分区域中，设计10种状态机分别为：

当无人机执行起飞命令，起飞完成后会进入航点1阶段，进而进入搜索状态，以绕圈的方式进行搜索目标标靶；如果搜索到目标标靶，就将进入跟踪状态机，跟踪状态机进行跟踪并且在目标标靶上方保持悬停，这时候区域1任务结束。

接着无人机将继续执行区域2任务，先进入航点2阶段，再进入搜索状态，搜索目标标靶，当搜索到目标标靶后会进入跟踪状态并在目标标靶上方保持悬停，此时区域2任务结束。

最后无人机执行任务3进行动态跟踪，首先执行航点3飞行，飞行完成后无人机将在上空进行识别移动的目标标靶，识别到之后进入动态跟踪阶段并实时保持上方动态跟踪，此时区域3任务结束。

视觉部分

视觉部分采用的是椭圆检测识别方法：

其中图像处理的过程如下：

第一步：图像去噪声，去除图像中的椒盐噪声。

第二步：弧检测，挑选出可能为弧的对象。

第三步：弧分类，判定弧属于四个象限中的哪一类。

第四步：弧过滤，运用两段弧约束、CNC约束(三段弧约束)，过滤不满足要求的弧。

第五步：椭圆估计，在剩下的四个象限的弧中进行排列组合，使用优化算法，通过4个弧线估计一个椭圆。

第六步：椭圆打分，使用特定打分算法，计算椭圆与4个弧线的拟合程度，给椭圆打分，最后选出得分较高的椭圆。

用到了哪些技术

航点状态机的实现，更多的是依赖于如何使用Prometheus控制子模块，因此也建议各位开发者在学习该仿真场景之前，先参考Prometheus使用手册学习Prometheus的控制子模块的内容。以下为用到的技术以及对应的代码实现：

WAY* 航点状态机：使用惯性系或者机体系下的位置控制。

WAY1:
            uav_command.header.frame_id = "ENU";
            uav_command.Agent_CMD = prometheus_msgs::UAVCommand::Move;
            uav_command.Move_mode = prometheus_msgs::UAVCommand::XYZ_POS;
            uav_command.position_ref[0] = waypoint1[0];
            uav_command.position_ref[1] = waypoint1[1];
            uav_command.position_ref[2] = waypoint1[2];

搜索状态机的实现，绕圆运动进行搜寻：


SEARCH:
            // sleep(10);
            //坐标系
            uav_command.header.frame_id = "ENU";
            // Move模式
            uav_command.Agent_CMD = prometheus_msgs::UAVCommand::Move;
            // Move_mode
            uav_command.Move_mode = prometheus_msgs::UAVCommand::XY_VEL_Z_POS;
            //无人机按照圆形轨迹飞行
            uav_command.velocity_ref[0] = -line_velocity * std::sin(count * angle_increment);
            uav_command.velocity_ref[1] = line_velocity * std::cos(count * angle_increment);
            uav_command.velocity_ref[2] = 0;
            uav_command.position_ref[2] = 1.5;

跟踪状态机的实现，使用对无人机速度控制的P调节：


TRACKING:
            if (!is_detected)
            {
                --loss_count;
                if(loss_count < 0)
                    exec_state = RETURN;
                    PCOUT(0, YELLOW, "Return");
            }
            //坐标系
            uav_command.header.frame_id = "BODY";
            // Move模式
            uav_command.Agent_CMD = prometheus_msgs::UAVCommand::Move;
            // 机体系下的速度控制
            uav_command.Move_mode = prometheus_msgs::UAVCommand::XY_VEL_Z_POS_BODY;
            uav_command.velocity_ref[0] = -0.9 * ellipse_det.sight_angle[0];
            uav_command.velocity_ref[1] = 0.9 * ellipse_det.sight_angle[1];
            uav_command.velocity_ref[2] = 0;
            uav_command.position_ref[2] = 1.5;

视觉端数据的处理，坐标系变化：

for(auto &ellipes : msg->detection_infos)
    {
        ellipse_det = ellipes;
        if (ellipse_det.detected && ellipse_det.object_name == "T")
        {
            num_regain++;
            num_lost = 0;
        }
        else{
            num_regain = 0;
            num_lost++;
        }
        if(num_lost > VISION_THRES)
        {
            is_detected = false;
            // PCOUT(1, GREEN, "no detect");
        }
        if(num_regain > VISION_THRES){
            is_detected = true;
            // PCOUT(1, GREEN, "detected");
        }
        ellipse_det.sight_angle[0] = ellipes.sight_angle[1];
        ellipse_det.sight_angle[1] = ellipes.sight_angle[0];

更多详情请参考：https://github.com/amov-lab/Prometheus/tree/main/Modules/future_aircraft