FAST Planner实战：在ROS Noetic上从零搭建无人机避障仿真环境（附完整代码）

FAST Planner实战：在ROS Noetic上从零搭建无人机避障仿真环境（附完整代码）

当你第一次接触FAST Planner这个强大的无人机轨迹规划框架时，是否曾被复杂的依赖关系和编译错误困扰？本文将带你穿越重重障碍，从零开始搭建完整的仿真环境。不同于理论分析的论文，我们聚焦于那些让开发者夜不能寐的实操细节——从Ubuntu系统配置到ROS Noetic环境搭建，从源码编译到避障仿真运行，每个步骤都经过真实项目验证。

1. 环境准备：打好地基才能建高楼

在开始之前，请确保你的系统满足以下基本要求：

• 操作系统：Ubuntu 20.04 LTS（推荐纯净安装）
• ROS版本：Noetic（最后一个支持Python2/3双版本的ROS发行版）
• 硬件配置：至少4核CPU/8GB内存（Gazebo仿真较吃资源）

注意：如果你的系统时间不准确，可能导致证书验证失败。建议先执行sudo apt install ntpdate && sudo ntpdate ntp.ubuntu.com

1.1 基础依赖安装

打开终端，按顺序执行以下命令：

# 添加ROS软件源 sudo sh -c 'echo "deb http://packages.ros.org/ros/ubuntu $(lsb_release -sc) main" > /etc/apt/sources.list.d/ros-latest.list' sudo apt-key adv --keyserver 'hkp://keyserver.ubuntu.com:80' --recv-key C1CF6E31E6BADE8868B172B4F42ED6FBAB17C654 # 安装基础工具链 sudo apt update && sudo apt install -y \ build-essential \ cmake \ git \ python3-catkin-tools \ python3-rosdep \ python3-rosinstall-generator \ python3-vcstool \ python3-pip

1.2 ROS Noetic完整安装

# 初始化rosdep sudo rosdep init rosdep update # 安装桌面完整版ROS sudo apt install -y ros-noetic-desktop-full # 配置环境变量 echo "source /opt/ros/noetic/setup.bash" >> ~/.bashrc source ~/.bashrc

验证安装是否成功：

rosversion -d # 应输出"noetic" roscore & # 启动ROS核心

2. 构建FAST Planner工作空间

2.1 创建工作区结构

mkdir -p ~/fast_ws/src cd ~/fast_ws catkin init catkin config --extend /opt/ros/noetic catkin config --cmake-args -DCMAKE_BUILD_TYPE=Release

2.2 获取源码与子模块

cd ~/fast_ws/src git clone --recursive https://github.com/HKUST-Aerial-Robotics/Fast-Planner.git

关键子模块说明：

• plan_env：环境感知模块（含ESDF地图构建）
• bspline_opt：B样条轨迹优化核心
• path_searching：前端路径搜索实现

2.3 安装特定版本依赖

FAST Planner对nlopt库有特殊要求，标准apt版本可能不兼容：

# 编译安装nlopt 2.7.0 cd ~ wget https://github.com/stevengj/nlopt/archive/v2.7.0.tar.gz tar -xzf v2.7.0.tar.gz cd nlopt-2.7.0 mkdir build && cd build cmake -DCMAKE_INSTALL_PREFIX=/usr/local .. make -j$(nproc) sudo make install

修改bspline_opt/CMakeLists.txt确保找到正确版本：

find_package(NLopt REQUIRED) include_directories(${NLOPT_INCLUDE_DIR})

3. 解决常见编译问题

3.1 Eigen3头文件冲突

如果遇到Eigen相关错误，尝试：

sudo apt install libeigen3-dev # 然后在出问题的CMakeLists.txt中添加： find_package(Eigen3 REQUIRED) include_directories(${EIGEN3_INCLUDE_DIR})

3.2 PCL版本不匹配

Ubuntu 20.04默认安装PCL 1.10，但某些模块需要1.8+：

sudo apt install libpcl-dev # 如果仍有问题，考虑源码安装： git clone https://github.com/PointCloudLibrary/pcl.git cd pcl && mkdir build && cd build cmake -DCMAKE_BUILD_TYPE=Release .. make -j$(nproc) sudo make install

3.3 内存不足处理

大型仿真可能导致OOM，建议：

# 临时增加交换空间（4GB示例） sudo fallocate -l 4G /swapfile sudo chmod 600 /swapfile sudo mkswap /swapfile sudo swapon /swapfile

4. 启动避障仿真全流程

4.1 编译工作空间

cd ~/fast_ws catkin build -j$(nproc) --mem-limit 50% # 限制内存使用 source devel/setup.bash

4.2 启动仿真环境

终端1：启动RVIZ可视化

roslaunch plan_manage rviz.launch

终端2：启动Gazebo世界

roslaunch plan_manage gazebo_sim.launch

终端3：运行规划器核心

roslaunch plan_manage kino_replan.launch

4.3 交互式目标点设置

在RVIZ中：

1. 点击顶部工具栏的"2D Nav Goal"
2. 在地图上点击设置目标位置
3. 无人机将自动规划避障路径

关键参数实时调整（动态调参）：

rosrun rqt_reconfigure rqt_reconfigure

5. 深度定制与性能优化

5.1 修改避障参数

编辑plan_manage/params.yaml：

traj_planner: max_vel: 2.0 # 最大速度(m/s) max_acc: 1.5 # 最大加速度(m/s²) collision_detection: safety_margin: 0.3 # 障碍物安全距离(m) resolution: 0.1 # 地图分辨率(m)

5.2 自定义仿真场景

在plan_env/worlds中添加新场景：

<?xml version="1.0" ?> <sdf version="1.5"> <world name="custom_world"> <include> <uri>model://ground_plane</uri> </include> <include> <uri>model://sun</uri> </include> <!-- 添加障碍物 --> <model name="obstacle_1"> <pose>2 0 0.5 0 0 0</pose> <static>true</static> <link name="link"> <collision name="collision"> <geometry> <box> <size>1 1 1</size> </box> </geometry> </collision> <visual name="visual"> <geometry> <box> <size>1 1 1</size> </box> </geometry> </visual> </link> </model> </world> </sdf>

5.3 性能监控技巧

实时查看计算负载：

# CPU/内存监控 htop # ROS通信诊断 rostopic hz /fast_planner/trajectory # 轨迹可视化保存 rosbag record -O path.bag /fast_planner/trajectory

6. 进阶开发：集成真实无人机

当仿真验证通过后，可对接真实硬件：

#!/usr/bin/env python3 import rospy from nav_msgs.msg import Path from geometry_msgs.msg import PoseStamped class HardwareInterface: def __init__(self): self.path_sub = rospy.Subscriber("/fast_planner/trajectory", Path, self.callback) self.drone_pub = rospy.Publisher("/mavros/setpoint_position/local", PoseStamped, queue_size=10) def callback(self, msg): for pose in msg.poses: target = PoseStamped() target.header = pose.header target.pose = pose.pose self.drone_pub.publish(target) rospy.sleep(0.1) if __name__ == "__main__": rospy.init_node("hardware_bridge") interface = HardwareInterface() rospy.spin()

记得在实际飞行前：

1. 校准IMU和磁罗盘
2. 测试失控保护机制
3. 在开阔无干扰环境操作