机器人底盘的控制方法、装置、电子设备及存储介质与流程

摘要: 本公开涉及机器人控制,具体而言,本公开涉及一种机器人底盘的控制方法、装置、电子设备及存储介质。背景技术:1、随着机器人技术的发展,移动机器人在服务、物流、巡检及...
机器人底盘的控制方法、装置、电子设备及存储介质与流程

本公开涉及机器人控制,具体而言,本公开涉及一种机器人底盘的控制方法、装置、电子设备及存储介质。

背景技术:

1、随着机器人技术的发展,移动机器人在服务、物流、巡检及协作等场景中得到广泛应用。上述应用通常依赖于对机器人底盘状态的实时估计,例如对机器人底盘的位置、速度等状态信息进行估计,以支撑导航、运动控制及避障等功能的实现。

2、在相关方案中,通常可以基于机器人底盘在不同时刻的运动状态,通过状态转移方程和观测方程对机器人底盘的状态进行递推估计。然而,现有的状态估计方案得到的状态估计结果存在较大误差。因此,如何提高机器人底盘状态估计的准确性,仍有待进一步改进。

技术实现思路

1、本公开实施例提供了一种机器人底盘的控制方法、装置、电子设备、计算机可读存储介质及计算机程序产品,可以解决现有技术在进行状态估计时,精确度低的问题。本公开提供的技术方案如下:

2、根据本公开实施例的一个方面,提供了一种机器人底盘的控制方法,所述方法应用于机器人底盘,所述机器人底盘设置有控制器和多个传感器,所述方法由所述控制器执行,所述方法包括:

3、获取所述多个传感器采集的所述机器人底盘在当前时刻的测量信息,所述测量信息包括多个测量项的测量值;

4、基于所述机器人底盘上一时刻的状态估计信息,对所述机器人底盘当前时刻的状态进行预测,得到当前时刻的预测结果;其中,所述状态估计信息包括多个运动状态项的估计值、以及所述多个测量项中的至少一个测量项的偏差项的估计值,所述预测结果包括所述多个运动状态项的预测值、以及所述至少一个测量项的偏差项的预测值;

5、基于所述预测结果中的所述至少一个测量项的偏差项的预测值,对当前时刻的测量信息进行更新,得到更新后的测量信息;基于更新后的测量信息对所述预测结果中的多个运动状态项的预测值进行更新,基于更新后的多个运动状态项的预测值、以及所述预测结果中的所述至少一个测量项的偏差项的预测值,得到当前时刻所述机器人底盘的状态估计信息;

6、根据所述机器人底盘当前时刻的状态估计信息中的所述多个运动状态项的估计值,得到当前时刻用于对所述机器人底盘进行控制的控制量,基于当前时刻的控制量对所述机器人底盘进行控制。

7、根据本公开实施例的另一个方面,提供了一种机器人底盘的控制装置,所述装置应用于机器人底盘的控制器,所述机器人底盘设置有控制器和多个传感器,所述装置包括:

8、获取模块,用于获取所述多个传感器采集的所述机器人底盘在当前时刻的测量信息,所述测量信息包括多个测量项的测量值;

9、状态估计模块,用于基于所述机器人底盘上一时刻的状态估计信息,对所述机器人底盘当前时刻的状态进行预测,得到当前时刻的预测结果;其中,所述状态估计信息包括多个运动状态项的估计值、以及所述多个测量项中的至少一个测量项的偏差项的估计值,所述预测结果包括所述多个运动状态项的预测值、以及所述至少一个测量项的偏差项的预测值;

10、测量更新模块,用于基于所述预测结果中的所述至少一个测量项的偏差项的预测值,对当前时刻的测量信息进行更新,得到更新后的测量信息;基于更新后的测量信息对所述预测结果中的多个运动状态项的预测值进行更新,基于更新后的多个运动状态项的预测值、以及所述预测结果中的所述至少一个测量项的偏差项的预测值,得到当前时刻所述机器人底盘的状态估计信息;

11、控制模块,用于根据所述机器人底盘当前时刻的状态估计信息中的所述多个运动状态项的估计值,得到当前时刻用于对所述机器人底盘进行控制的控制量,基于当前时刻的控制量对所述机器人底盘进行控制。

12、可选地,状态估计模块在基于所述机器人底盘上一时刻的状态估计信息,对所述机器人底盘当前时刻的状态进行预测时,具体用于:

13、获取上一时刻用于对所述机器人底盘进行控制的控制量;

14、基于所述机器人底盘上一时刻的状态估计信息、以及上一时刻用于对所述机器人底盘进行控制的控制量,对当前时刻所述机器人底盘的状态进行预测。

15、可选地,状态估计模块在基于所述机器人底盘上一时刻的状态估计信息、以及上一时刻用于对所述机器人底盘进行控制的控制量,对当前时刻所述机器人底盘的状态进行预测时,具体用于:

16、基于所述机器人底盘上一时刻的状态估计信息、以及上一时刻用于对所述机器人底盘进行控制的控制量,通过预设的状态转移方程,对当前时刻所述机器人底盘的状态进行预测;

17、其中,所述状态转移方程用于描述所述机器人底盘上一时刻的状态估计信息以及上一时刻用于控制所述机器人底盘的控制量,与当前时刻所述机器人底盘的状态信息之间的对应关系。

18、可选地,用于对所述机器人底盘进行控制的控制量包括:所述机器人底盘在水平方向和垂直方向的线速度的期望值、以及所述机器人底盘的角速度的期望值;

19、状态估计模块在基于所述机器人底盘上一时刻的状态估计信息、以及上一时刻用于对所述机器人底盘进行控制的控制量,通过预设的状态转移方程,对当前时刻所述机器人底盘的状态进行预测时,具体用于:

20、基于上一时刻的所述控制量中所述机器人底盘在水平方向和垂直方向的线速度的期望值、以及上一时刻的状态估计信息中机器人底盘在水平方向和垂直方向的线速度的估计值,确定所述机器人底盘上一时刻在水平方向和垂直方向的线加速度的估计值;

21、基于上一时刻的所述控制量中所述机器人底盘的角速度的期望值、以及上一时刻的状态估计信息中机器人底盘的角速度的估计值,确定所述机器人底盘上一时刻的角加速度的估计值;

22、基于所述机器人底盘上一时刻的状态估计信息、所述机器人底盘上一时刻在水平方向和垂直方向的线加速度的估计值、以及所述机器人底盘上一时刻的角加速度的估计值,对当前时刻所述机器人底盘的状态进行预测。

23、作为一种可选实施例,多个传感器包括编码器和惯性测量单元imu,所述编码器的测量项包括所述机器人底盘在水平方向和垂直方向的线速度,所述imu的测量项为所述机器人底盘的角速度,所述至少一个测量项的偏差项,包括所述编码器的测量项的偏差项、以及所述imu的测量项的偏差项;

24、所述多个运动状态项包括,所述至少一个测量项的偏差项包括;

25、其中,分别为所述机器人底盘在水平方向和垂直方向的位置,为所述机器人底盘的航向角,为机器人底盘在水平方向和垂直方向的线速度,为机器人底盘的角速度,为所述编码器的测量项的偏差项,为所述imu的测量项的偏差项。

26、可选地,所述状态转移方程为:

27、

28、其中,为当前时刻与上一时刻的时间差,和分别为根据时刻的所述控制量得到的时刻所述机器人底盘在水平方向和垂直方向上的线加速度,为根据时刻的所述控制量得到的时刻所述机器人底盘的角加速度,为k-1时刻的状态估计信息,和为k时刻的所述预测结果,和分别为k-1时刻所述编码器的测量值的偏差项的随机扰动值,为所述imu的测量值的偏差项的随机扰动值。

29、可选地,控制模块在根据所述机器人底盘当前时刻的状态估计信息中的所述多个运动状态项的估计值,得到当前时刻用于对所述机器人底盘进行控制的控制量时,具体用于:

30、获取当前时刻的期望状态信息,所述期望状态信息包括所述多个运动状态项的期望值;

31、根据当前时刻所述机器人底盘的状态估计信息中的所述多个运动状态项的估计值、以及当前时刻的所述期望状态信息,通过自抗扰控制adrc算法得到当前时刻用于对所述机器人底盘进行控制的控制量。

32、可选地,测量更新模块在基于更新后的测量信息对所述预测结果中的多个运动状态项的预测值进行更新时,具体用于:

33、对于所述更新后的测量信息中的每个测量值,基于所述测量值与当前时刻所述预测结果中对应运动状态项的预测值之间的差异,对所述当前时刻所述预测结果中所述对应运动状态项的预测值进行更新,得到当前时刻所述对应运动状态项的估计值。

34、作为一种可选实施例,各传感器预设有各自对应测量项的噪声值;

35、测量更新模块在基于所述测量值与当前时刻所述预测结果中对应运动状态项的预测值之间的差异,对所述当前时刻所述预测结果中所述对应运动状态项的预测值进行更新时,具体用于:

36、基于所述测量值与当前时刻所述预测结果中对应运动状态项的预测值之间的差异、以及所述测量值对应的噪声值,对所述当前时刻所述预测结果中所述对应运动状态项的预测值进行更新;

37、状态估计模块还用于:

38、对每个传感器采集的测量项的测量值的进行有效性判断,得到有效性判断结果,所述有效性判断结果为有效或无效;

39、对于每个传感器,在确定所述传感器采集的测量项的有效性判断结果为无效的情况下,将所述传感器对应的噪声值扩大预设倍数。

40、可选地,所述多个传感器还包括:超带宽uwb和视觉传感器,其中,

41、视觉传感器的测量项为所述机器人底盘在水平方向和垂直方向的位置、以及所述机器人底盘的航向角;

42、所述uwb的测量项为所述机器人底盘在水平方向和垂直方向的位置;

43、其中,各传感器对应有各自的优先级,每个传感器基于各自的优先级被配置对应的采集频率,各传感器以各自对应的采集频率,采集各自对应的测量项的测量值。

44、根据本公开实施例的另一个方面,提供了一种机器人底盘的控制器,该所述机器人底盘设置有多个传感器和所述控制器,所述控制器被配置为执行上述机器人底盘的控制方法。

45、根据本公开实施例的另一个方面,提供了一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现上述机器人底盘的控制方法。

46、根据本公开实施例的另一个方面,提供了一种计算机程序产品,包括计算机程序,所述计算机程序被处理器执行时实现上述机器人底盘的控制方法。

47、本公开实施例提供的技术方案带来的有益效果是:

48、本公开实施例,通过获取多个传感器采集的机器人底盘在当前时刻的测量信息,实现了对机器人底盘当前运动状态相关测量数据的获取,为机器人底盘的状态估计提供数据基础;通过基于上一时刻的状态估计信息,对当前时刻的多个运动状态项以及至少一个测量项的偏差项进行预测,实现了对机器人底盘当前运动状态和传感器测量偏差的同步预测;通过基于偏差项的预测值对当前时刻的测量信息进行更新,实现了对传感器测量信息中测量偏差的补偿,降低了测量偏差对状态估计的影响;通过基于更新后的测量信息对多个运动状态项的预测值进行更新,实现了利用偏差补偿后的测量信息对预测的运动状态进行校正,提高了机器人底盘状态估计的准确性;通过将更新后的多个运动状态项的预测值以及偏差项的预测值作为当前时刻的状态估计信息,实现了运动状态和测量偏差的递推估计,为后续时刻的状态预测和偏差补偿提供依据;通过根据当前时刻多个运动状态项的估计值确定控制量,并基于该控制量对机器人底盘进行控制,实现了基于经过偏差补偿的状态估计结果对机器人底盘进行控制,提高了机器人底盘运动控制的准确性和稳定性。