避障功能紧紧是加到植保功能上,植保功能没有分块模式,由于植保中碰到的障碍物比较小,采用的方法是绕过障碍物继续飞行,因此需要把原路径删除,添加新航迹点。

障碍物目前就考虑是凸多边形,航线和凸多边形只有两个交点,

多边形需要首先进行外扩

QGC避障实现

QGC避障实现QGC避障实现

 

若是有两个交点,需要把障碍物按这条航线把左右划分,并把左边的点和右边的按逆时针排序

分别计算左边点列和右边点列的长度,取距离最短的方向, 作为环绕方向。

 

效果如下图

QGC避障实现QGC避障实现QGC避障实现QGC避障实现

相关文章:

  • 2022-12-23
  • 2021-12-10
  • 2022-12-23
  • 2021-10-26
  • 2022-12-23
  • 2021-07-22
  • 2022-01-05
  • 2021-10-24
猜你喜欢
  • 2021-11-21
  • 2021-12-10
  • 2021-09-20
  • 2021-05-31
  • 2022-01-15
  • 2021-07-06
  • 2022-01-24
相关资源
相似解决方案