基于光流和加速度计的速度融合方法、装置和计算机设备制造方法及图纸

技术编号:33633581 阅读:32 留言:0更新日期:2022-06-02 01:42
本发明专利技术公开了基于光流和加速度计的速度融合方法,该方法包括:在清洁机器人运行的过程当中,连续通过加速度计和光流检测清洁机器人的速度,并通过加速度计获取加速度计速度,通过光流获取光流速度;根据时间上相互对应的加速度计速度和光流速度确定瞬时误差;在设定时间段内获取加速度计速度和光流速度之间的累计误差;根据累计误差和瞬时误差确定偏移速度,偏移速度是在累计误差开始累加以来加速度计速度与清洁机器人目标速度之间所产生的速度差;根据偏移速度调整加速度计速度。本方案消除了光流数据瞬时误差的数据波动,通过计算偏移速度确定加速度计速度与目标速度的差距,以降低上述数据波动造成的影响,更准确的调整加速度计速度的值。加速度计速度的值。加速度计速度的值。

【技术实现步骤摘要】
基于光流和加速度计的速度融合方法、装置和计算机设备


[0001]本申请涉及速度加
,尤其涉及基于光流和加速度计的速度融合方法、装置和计算机设备。

技术介绍

[0002]清洁机器人在运行过程当中需要记录自身的速度信息,以实现导航的过程当中,对行进的控制,在现有的方案当中,清洁机器人通常通过加速度计计算行进的速度和距离,而在环境因素的影响之下,加速度计会出现计数上的偏差,上述偏差还会随着时间累加,因此需要对加速度计所产生的速度值进行修正,以保证清洁机器人的速度信息能够被正确反应;光流是获取清洁机器人速度的另一种形式,通过获取一个方向上的连续图像,观察图像当中的事物在像素之间运动的速度,并且将单位时间内移动的像素数,转化成移动的距离从而得到被测物体实际的运行速度,清洁机器人工作的场景是复杂的,在长距离运行的过程当中,摄取的图像无法保证永远处于一个平面上,也就无法保证像素与距离之间能够做到完全准确的对应,从而在清洁机器人运行速度的获取上出现偏差。

技术实现思路

[0003]本申请实施例的目的在于提出一种能够在清洁机器人运行过程当中本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.基于光流和加速度计的速度融合方法,其特征在于:该方法包括:在清洁机器人运行的过程当中,连续通过加速度计和光流检测清洁机器人的速度,并通过加速度计获取加速度计速度,通过光流获取光流速度;根据时间上相互对应的所述加速度计速度和光流速度确定瞬时误差;在设定时间段内获取加速度计速度和光流速度之间的累计误差;根据所述累计误差和所述瞬时误差确定偏移速度,所述偏移速度是清洁机器人在所述设定时间段内产生的加速度计速度与清洁机器人目标速度之间所产生的速度差;根据所述偏移速度调整所述加速度计速度。2.根据权利要求1所述的基于光流和加速度计的速度融合方法,其特征在于:所述步骤在设定时间段内获取加速度计速度和光流速度之间的累计误差,具体通过在设定时间内通过对所述瞬时误差积分获得。3.根据权利要求2所述的基于光流和加速度计的速度融合方法,其特征在于:在所述对瞬时误差积分过程中,具体是通过第一系数消除瞬时误差在积分过程中会造成的稳态误差之后,对所述累计误差进行累加,具体基于以下公式:Vel_S+=ki*Vel_E*time其中Vel_S为设定时间段内的累计误差,ki为第一系数,Vel_E为瞬时误差,time为设定的时间段。4.根据权利要求1所述的基于光流和加速度计的速度融合方法,其特征在于:所述步骤根据所述累计误差和所述瞬时误差确定偏移速度,具体包括:通过第二系数调整所述瞬时误差,以调整偏移速度对瞬时误差的响应快慢;对调整权重的所述瞬时误差叠加所述累计误差,以获取所述加速度计速度在设定时间内的误差变化速率;根据所述误差变化速率和设定时间段计算偏移速度;所述根据所述偏移速度调整所述加速度计速度具体基于以下公式:acc_V+=(kp*Vel_E+Vel_S)*time其中,acc_V为加速度计速度,kp为第二系数,Vel_E为瞬时误差,Vel_S为设定时间段内的累计误差,time为设定的时间段。5.根据权利要求1所述的基于光流和加速度计的速度融合方法,其特征在于:所述加速度计速度的获取方法,具体包括:连续获取加速度计上加载的压力,所述压力为矢量;将所述压力投影在清洁机器人所在的坐标系当中,并且投影在清洁机器人在坐标系中的前进方向上;对投影的所述压力积分,以获取所述加速度计速度,所述加速度计...

【专利技术属性】
技术研发人员:李伟
申请(专利权)人:深圳市云鼠科技开发有限公司
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1