一种基于腕点重构的拟人机械臂逆解方法、设备及介质

摘要: 本申请涉及机械臂控制,特别是涉及一种基于腕点重构的拟人机械臂逆解方法、设备及介质。背景技术:1、人体上肢具有多自由度、结构冗余和关节协调运动等特征,能够在完成前...
一种基于腕点重构的拟人机械臂逆解方法、设备及介质

本申请涉及机械臂控制,特别是涉及一种基于腕点重构的拟人机械臂逆解方法、设备及介质。

背景技术:

1、人体上肢具有多自由度、结构冗余和关节协调运动等特征,能够在完成前伸、抬举、抓取、转移和放置等任务时,根据任务方向和空间位置自然调整肩、肘、前臂及腕部构型。为使拟人机械臂获得类似人体上肢的自然运动能力,通常需要根据给定的手端位置轨迹,求解拟人机械臂各关节的运动状态,并使其肩部、肘部、腕部及末端之间保持协调。现有任务规划通常能够直接给出手端位置轨迹,但难以同时给出腕点位置、腕—手轴方向、肘部摆位及各关节角,因此如何由手端位置轨迹恢复具有仿生特征的完整构型,是拟人机械臂自然运动生成中的重要问题。

2、人体上肢及具有类人肩—肘—腕结构的拟人机械臂可近似表示为七自由度串联运动链,而多数任务仅对三维手端位置进行约束,因此同一手端位置通常对应多组关节构型。现有广义逆、阻尼最小二乘、任务优先级、二次规划及多目标数值优化方法,通常以降低手端位置误差和满足关节限位为主要目标。虽然上述方法能够获得数值可行的关节解,但存在关节运动不连续、肘部摆位不稳定或整体构型缺乏仿生自然性的问题。

技术实现思路

1、本申请的目的是提供一种基于腕点重构的拟人机械臂逆解方法、设备及介质,可提高拟人机械臂自然构型恢复的连续性、稳定性和生理可解释性。

2、为实现上述目的,本申请提供了如下方案:

3、第一方面,本申请提供了一种基于腕点重构的拟人机械臂逆解方法,包括:

4、获取目标拟人机械臂的任务数据、结构参数和初始状态,并根据结构参数和初始状态建立目标拟人机械臂的七自由度运动模型;所述任务数据为由多帧手端期望位置构成的手端期望位置轨迹序列;

5、根据所述七自由度运动模型,计算所述任务数据中各帧手端期望位置对应的各帧自然腕—手轴参考方向;

6、基于预设联合约束,根据各帧自然腕—手轴参考方向、各帧手端期望位置和手部等效长度反算各帧手端期望位置对应的目标腕点,并对不可达的目标腕点进行修正,得到各帧重构后目标腕点;

7、根据各帧重构后目标腕点、肩部基准点、上臂长度和前臂长度构建理论肘圆;基于各帧理论肘圆生成候选肘点和候选关节入口构型;

8、基于各帧手端期望位置对应的候选肘点和候选关节入口构型,依次进行手端任务求解、腕肘结构校正、自然运动优化和有限容差验收,输出通过有限容差验收的候选解;

9、根据各帧手端期望位置的候选解生成所述目标拟人机械臂的帧级自然构型轨迹。

10、第二方面,本申请提供了一种计算机设备,包括:存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述计算机程序以实现所述的基于腕点重构的拟人机械臂逆解方法;

11、所述计算机设备为拟人机械臂控制器、工作站、边缘计算设备或嵌入式控制器。

12、第三方面,本申请提供了一种计算机可读存储介质,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现所述的基于腕点重构的拟人机械臂逆解方法。

13、根据本申请提供的具体实施例,本申请公开了以下技术效果:

14、本申请提供了一种基于腕点重构的拟人机械臂逆解方法、设备及介质,根据各帧自然腕—手轴参考方向、各帧手部末端(手端)期望位置和手部等效长度反算各帧手端期望位置对应的目标腕点,并对不可达的目标腕点进行修正,将目标腕—手轴和目标腕点作为显式结构变量,在关节角逆解之前完成腕点重构和可达性保护;基于各帧手端期望位置对应的候选肘点和候选关节入口构型,依次进行手端任务求解、腕肘结构校正、自然运动优化和有限容差验收,输出通过有限容差验收的候选解,实现手端任务、腕肘结构和自然运动优化三个层级的求解,采用有限容差验收机制控制低优先级更新对高优先级目标的影响,且通过自然运动优化,可减少腕部过度补偿和肘部构型突变,提高了拟人机械臂自然构型恢复的连续性、稳定性和生理可解释性。

1.一种基于腕点重构的拟人机械臂逆解方法,其特征在于,包括:

2.根据权利要求1所述的基于腕点重构的拟人机械臂逆解方法,其特征在于,根据结构参数和初始状态建立目标拟人机械臂的七自由度运动模型,具体包括:

3.根据权利要求2所述的基于腕点重构的拟人机械臂逆解方法,其特征在于,根据所述七自由度运动模型,计算所述任务数据中各帧手端期望位置对应的各帧自然腕—手轴参考方向,具体包括:

4.根据权利要求1所述的基于腕点重构的拟人机械臂逆解方法,其特征在于,基于预设联合约束,根据各帧自然腕—手轴参考方向、各帧手端期望位置和手部等效长度反算各帧手端期望位置对应的目标腕点,并对不可达的目标腕点进行修正,得到各帧重构后目标腕点,具体包括:

5.根据权利要求1所述的基于腕点重构的拟人机械臂逆解方法,其特征在于,根据各帧重构后目标腕点、肩部基准点、上臂长度和前臂长度构建理论肘圆;基于各帧理论肘圆生成候选肘点和候选关节入口构型,具体包括:

6.根据权利要求1所述的基于腕点重构的拟人机械臂逆解方法,其特征在于,基于各帧手端期望位置对应的候选肘点和候选关节入口构型,依次进行手端任务求解、腕肘结构校正、自然运动优化和有限容差验收,输出通过有限容差验收的候选解,具体包括:

7.根据权利要求6所述的基于腕点重构的拟人机械臂逆解方法,其特征在于,对于每一帧,以候选关节入口构型对应的关节角向量作为关节角向量的初值,根据手端位置误差迭代修正关节角向量,直到手端位置误差小于设定误差阈值,根据最后一个迭代得到的手端位置误差计算手端任务代价,并输出最后一个迭代的关节角向量对应的关节入口构型作为当前帧的初选关节入口构型,具体包括:

8.根据权利要求1所述的基于腕点重构的拟人机械臂逆解方法,其特征在于,根据各帧手端期望位置的候选解生成所述目标拟人机械臂的帧级自然构型轨迹,具体包括:

9.一种计算机设备,包括:存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序以实现权利要求1-8中任一项所述的基于腕点重构的拟人机械臂逆解方法;

10.一种计算机可读存储介质,所述计算机可读存储介质上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1-8中任一项所述的基于腕点重构的拟人机械臂逆解方法。