输入数据
- 从MID360 的点云数据转换到可以构建障碍物地图的点云数据
- 无人机状态数据x,y,z 订阅mavros
- 目标点数据 话题:local_planner/cmd; 消息类型local_planner_cmd.msg int local_planner_cmd; #控制规划器的启动停止 float32 goal_x; #目标x; float32 goal_y; #目标y; float32 goal_z; #目标z;
数据预处理
- 将三维点云简化为 “极坐标直方图”VFH
路径规划 VFH
执行 将路径转换为航点发布