主从式机械臂仿真模型的优化方法、装置、设备及存储介质

摘要: 本申请涉及机械臂仿真,尤其涉及主从式机械臂仿真模型的优化方法、装置、设备及存储介质。背景技术: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、根据所述零点补偿量和主动臂实时关节采样数据构建上电自动零点校准函数;

24、根据所述平滑插值函数、所述上电自动零点校准函数、比例积分微分函数、前馈补偿函数以及低通滤波函数构建主从臂协同控制函数。

25、在一实施例中,所述获取实物样机的实时运行数据,根据所述实时运行数据和所述主从臂协同控制函数对所述第二机械臂仿真模型进行仿真优化,得到目标机械臂仿真模型的步骤包括:

26、获取实物样机的实时运行数据,将所述实时运行数据中的关节姿态数据输入至所述主从臂协同控制函数中,得到第二从动臂驱动指令;

27、基于所述第二从动臂驱动指令驱动所述第二机械臂仿真模型进行仿真运动,采集仿真运动过程中的仿真输出;

28、根据所述实时运行数据和所述仿真输出对所述第二机械臂仿真模型进行仿真优化,得到目标机械臂仿真模型。

29、在一实施例中,所述根据所述实时运行数据和所述仿真输出对所述第二机械臂仿真模型进行仿真优化,得到目标机械臂仿真模型的步骤包括:

30、将所述实时运行数据和所述仿真输出进行对比计算,得到运行偏差值;

31、基于所述运行偏差值对所述第二机械臂仿真模型中的控制参数进行修正优化,得到目标机械臂仿真模型。

32、此外,为实现上述目的,本申请还提出一种主从式机械臂仿真模型的优化装置,所述主从式机械臂仿真模型的优化装置包括:

33、获取模块,用于获取主从式机械臂三维模型的格式文件和主从臂协同控制函数,其中,所述主从臂协同控制函数为从动臂跟随主动臂运动的算法;

34、处理模块,用于将所述格式文件和物理行为模型相结合,构建第一机械臂仿真模型;

35、优化模块,用于基于所述主从臂协同控制函数对所述第一机械臂仿真模型进行仿真优化,得到第二机械臂仿真模型;

36、所述优化模块,还用于获取实物样机的实时运行数据,根据所述实时运行数据和所述主从臂协同控制函数对所述第二机械臂仿真模型进行仿真优化,得到目标机械臂仿真模型。

37、此外,为实现上述目的,本申请还提出一种主从式机械臂仿真模型的优化设备,所述设备包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述计算机程序配置为实现如上文所述的主从式机械臂仿真模型的优化方法的步骤。

38、此外,为实现上述目的,本申请还提出一种存储介质,所述存储介质为计算机可读存储介质,所述存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如上文所述的主从式机械臂仿真模型的优化方法的步骤。

39、此外,为实现上述目的,本申请还提供一种计算机程序产品,所述计算机程序产品包括计算机程序,所述计算机程序被处理器执行时实现如上文所述的主从式机械臂仿真模型的优化方法的步骤。

40、本申请提出的一个或多个技术方案,至少具有以下技术效果:

41、1)通过预先构建的主从臂协同控制函数,将主从臂协同控制函数与仿真过程相结合,能降低主从同步延迟与关节角度误差,在变负载工况下也能保证接近无漂移与无抖动。

42、2)通过获取主从臂协同控制函数,并基于主从臂协同控制函数对第一机械臂仿真模型进行仿真优化,能够提高机械臂仿真模型的保真度与可信度。

43、3)通过获取实物样机的实时运行数据,并根据实时运行数据和主从臂协同控制函数对第二机械臂仿真模型进行仿真优化,能提高主从臂同步跟随精度。

1.一种主从式机械臂仿真模型的优化方法,其特征在于,所述主从式机械臂仿真模型的优化方法包括:

2.如权利要求1所述的方法,其特征在于,所述基于所述主从臂协同控制函数对所述第一机械臂仿真模型进行仿真优化,得到第二机械臂仿真模型的步骤包括:

3.如权利要求2所述的方法,其特征在于,所述基于所述第一从动臂驱动指令对所述第一机械臂仿真模型进行仿真优化,得到第二机械臂仿真模型的步骤包括:

4.如权利要求3所述的方法,其特征在于,所述根据所述时序动作在不同工况下对所述配置后的第一机械臂仿真模型进行仿真优化,得到第二机械臂仿真模型的步骤包括:

5.如权利要求1所述的方法,其特征在于,获取主从臂协同控制函数的步骤包括:

6.如权利要求1所述的方法,其特征在于,所述获取实物样机的实时运行数据,根据所述实时运行数据和所述主从臂协同控制函数对所述第二机械臂仿真模型进行仿真优化,得到目标机械臂仿真模型的步骤包括:

7.如权利要求6所述的方法,其特征在于,所述根据所述实时运行数据和所述仿真输出对所述第二机械臂仿真模型进行仿真优化,得到目标机械臂仿真模型的步骤包括:

8.一种主从式机械臂仿真模型的优化装置,其特征在于,所述主从式机械臂仿真模型的优化装置包括:

9.一种主从式机械臂仿真模型的优化设备,其特征在于,所述设备包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述计算机程序配置为实现如权利要求1至7中任一项所述的主从式机械臂仿真模型的优化方法的步骤。

10.一种存储介质,其特征在于,所述存储介质为计算机可读存储介质,所述存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如权利要求1至7中任一项所述的主从式机械臂仿真模型的优化方法的步骤。