【技术实现步骤摘要】
本专利技术属于多机器人协同领域，尤其涉及一种空中机器人自主协助地面盲车集群导航的方法。
技术介绍
1、如今，盲无人车和空中机器人被广泛应用于许多领域，如监视、农业、搜救、运输等领域，几乎都依赖于各种外部传感器来感知环境，如激光雷达、摄像头、雷达等。感知能力是在障碍物密集的未知区域实现自主导航的关键功能之一，也是后续导航模块(如建图、规划和高层策略)的条件。对于一个感知受限的机器人来说，安全导航是一项挑战，尤其是当它缺乏探测环境的传感器时，就会出现本专利技术所描述的“盲”机器人。此外，由于缺乏感知，当机器人群组存在潜在的机器人间碰撞时，导航就会变得更加困难。当机器人群的规模增大时，为所有机器人配备昂贵的感知或slam系统的成本会很高。盲无人车具有低成本、高负载能力和低能耗等显著优势。由于这些优势，盲无人车经常被用作任务执行单元，并以蜂群的形式工作，例如多机器人协同运输。为所有机器人配备传感器不仅成本高昂，而且地面视角也无法充分利用这些昂贵的传感器。而空中机器人在三维空间中具有超强的机动性，因此有更大的感知范围。将它们的优势结合起来，形成一个由盲无人车和空中机器人组成的协作系统，可以低成本高效率地完成高要求的任务。
2、对异构机器人系统，尤其是空地协作机器人系统，已有大量研究。大量研究集中于结合两种机器人协同执行任务，如探索和重建，充分利用每种机器人的互补优势。这些研究旨在解决不同类型机器人在整体性能和能力方面固有的局限性。
3、一些研究涉及利用空中机器人协助盲无人车移动，利用空中机器人更宽广的视场为盲无人车
4、有些研究去掉了盲无人车携带的环境感知传感器，利用空中机器人与盲无人车之间的相对位姿估计来获得盲无人车的定位。《m.cognetti,g.oriolo,p.peliti,l.rosa,andp.stegagno,“cooperative control of a heterogeneous multi-robot system basedon relative localization,”in 2014ieee/rsj international conference onintelligent robots and systems.ieee,2014,pp.350-356.》使用一个带相机的空中机器人为多个盲无人车提供定位，并开发了一种协同控制方案，使盲无人车处于相机视场内。《f.gu′erin,f.guinand,j.-f.breth′e,h.pelvillain et al.,“uavugv cooperation forobjects transportation in an industrial area,”in 2015ieee internationalconference on industrial technology(icit).ieee,2015,pp.547-552.》使用空中机器人上的视觉舵机使领头的盲无人车保持在图像平面的中心，以实现盲无人车的定位，导航航点由人类操作员给出。《e.mueggler,m.faessler,f.fontana,and d.scaramuzza,“aerialguided navigation of a ground robot among movable obstacles,”in2014ieee international symposium on safety,security,and rescue robotics(2014).ieee,2014,pp.1-8.》用空中机器人的摄像头可以检测到的二维码对盲无人车进行定位，以补偿盲无人车车轮里程计的漂移。这些方法在盲无人车上安装视觉设备为盲无人车提供关键的定位信息，这需要空中机器人的持续观测。
5、这不仅效率低下，而且限制了空中机器人的机动性，然而如果没有观测，盲无人车的定位就会面临漂移和不确定性。
6、在盲车导航中，针对盲无人车，本专利技术设计了一种严格安全的路径规划策略，其中包括基于不确定性传播的轨迹生成和碰撞预测；针对空中机器人，本专利技术设计了一种制定为带时间窗的车辆路径规划的调度方法，以引导空中机器人为盲无人车提供支持。
技术实现思路
1、本申请实施例的目的是提供一种空中机器人自主协助地面盲车集群导航的方法，针对盲无人车，设计了一种严格安全的路径规划策略，其中包括基于不确定性传播的轨迹生成和碰撞预测；针对空中机器人，设计了一种制定为带时间窗的车辆路径规划的调度方法，以引导空中机器人为盲无人车提供支持。
2、根据本申请实施例的第一方面，提供一种空中机器人自主协助地面盲车集群导航的方法，包括：
3、(1)空中机器人通过激光雷达slam获取空中机器人里程计和地图，并与盲无人车进行相对位姿估计；
4、(2)盲无人车获取自身的里程计，结合空中机器人里程计和相对位姿估计结果，利用扩展卡尔曼滤波预测自身的位姿信息；
5、(3)盲无人车基于空中机器人共享的地图，规划自身的轨迹并预测因里程计估计的不确定性和地图中的未知区域而发生的碰撞，将预测到的碰撞信息发送至空中机器人；
6、(4)空中机器人接收所有盲无人车发送的碰撞信息，基于带时间窗的车辆路径规划方法规划自身的飞行路径，为可能发生碰撞的盲无人车提供新的相对位姿估计和地图信息，以使得盲无人车重新进行轨迹规划，避免碰撞。
7、进一步地，步骤(2)中，盲无人车利用扩本文档来自技高网...
【技术保护点】
1.一种空中机器人自主协助地面盲车集群导航的方法，其特征在于，包括：
2.根据权利要求1所述的方法，其特征在于，步骤(2)中，盲无人车利用扩展卡尔曼滤波的预测模型，根据自身的里程计来预测自身的位姿信息；
3.根据权利要求2所述的方法，其特征在于，扩展卡尔曼滤波的预测模型为
4.根据权利要求2所述的方法，其特征在于，扩展卡尔曼滤波的观测模型为
5.根据权利要求1所述的方法，其特征在于，利用扩展卡尔曼滤波来表示盲无人车位姿估计的不确定性，通过扩展卡尔曼滤波的预测步骤沿规划轨迹按一定距离步长计算预测步骤，以传播盲无人车的不确定性。
6.根据权利要求1所述的方法，其特征在于，步骤(3)中，在碰撞地图中进行基于不确定性的碰撞预测，其中所述碰撞地图为将未知栅格视为占用栅格的地图，碰撞预测过程为：
7.根据权利要求1所述的方法，其特征在于，步骤(4)包括：
8.一种空中机器人自主协助地面盲车集群导航的系统，其特征在于，包括：
9.一种电子设备，其特征在于，包括：
10.一种计算机可读存储
...【技术特征摘要】
1.一种空中机器人自主协助地面盲车集群导航的方法，其特征在于，包括：
2.根据权利要求1所述的方法，其特征在于，步骤(2)中，盲无人车利用扩展卡尔曼滤波的预测模型，根据自身的里程计来预测自身的位姿信息；
3.根据权利要求2所述的方法，其特征在于，扩展卡尔曼滤波的预测模型为
4.根据权利要求2所述的方法，其特征在于，扩展卡尔曼滤波的观测模型为
5.根据权利要求1所述的方法，其特征在于，利用扩展卡尔曼滤波来表示盲无人车位姿估计的不确定性，通过扩展卡尔曼滤波的预测步骤沿规划轨迹按一定距离步长计算预测步骤...
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。