[发明专利]机械臂空间位置调整方法、装置、机械臂及存储介质

权利要求书

1.一种机械臂空间位置调整方法，其特征在于，应用于包括冗余自由度的机械臂，所述方法包括：

获取人工重力场的预设加速度、所述人工重力场在预设参考坐标系中的第一向量、所述机械臂中的特征点在所述预设参考坐标系中的第二向量以及参考点在所述预设参考坐标系中的第三向量，其中，所述第一向量的方向与该机械臂的运动趋势相对应，所述机械臂的运动速度与所述预设加速度的大小成正相关；

根据所述预设加速度、所述第一向量、所述第二向量以及所述第三向量计算所述机械臂的特征点移动到所述参考点的过程中的势能函数；

基于预设零空间算子，根据所述势能函数计算所述机械臂中各个关节的零空间虚拟力矩，其中，所述预设零空间算子用于使得该机械臂在运动过程中末端的位姿不变；

根据所述各个关节的零空间虚拟力矩对各关节的状态进行调整。

2.根据权利要求1所述的机械臂空间位置调整方法，其特征在于，所述根据所述预设加速度、所述第一向量、所述第二向量以及所述第三向量计算所述机械臂的特征点移动到所述参考点的过程中的势能函数的步骤包括：

根据所述第二向量以及所述第三向量计算所述特征点到所述参考点之间的第四向量；

根据所述第一向量、第四向量以及所述预设加速度计算获得所述势能函数。

3.根据权利要求2所述的机械臂空间位置调整方法，其特征在于，所述根据所述第一向量、第四向量以及所述预设加速度计算获得所述势能函数的公式如下：

式中，表示该势能函数，k表示该预设加速度，表示该第四向量，表示该第一向量，表示所述第四向量与所述第一向量之间的点乘。

4.根据权利要求1所述的机械臂空间位置调整方法，其特征在于，所述基于预设零空间算子，根据所述势能函数计算所述机械臂中各个关节的零空间虚拟力矩的步骤，包括：

基于预设阻尼参数，根据所述势能函数计算所述机械臂中各关节的虚拟力矩，其中所述预设阻尼参数用于抑制所述机械臂运动过程中的震荡；

根据所述预设零空间算子以及所述各关节的虚拟力矩计算获得所述机械臂中各个关节的零空间虚拟力矩。

5.根据权利要求4所述的机械臂空间位置调整方法，其特征在于，所述基于预设阻尼参数，根据所述势能函数计算所述机械臂中各关节的虚拟力矩的公式如下：

式中，表示所述机械臂中关节i的虚拟力矩，表示所述势能函数，表示关节i的速度，D表示所述预设阻尼参数。

6.根据权利要求5所述的机械臂空间位置调整方法，其特征在于，所述根据所述预设零空间算子以及所述各关节的虚拟力矩计算获得所述机械臂中各个关节的零空间虚拟力矩的公式如下：

N＝I-J^T(J^M+)^T；

J^M+＝M^-1J^T(JM^-1J^T)^-1；

式中，表示n个关节的虚拟力矩，表示所述机械臂中所有关节的零空间虚拟力矩，N表示所述预设零空间算子，J^M+表示由所述机械臂的惯量矩阵加权计算的雅可比逆矩阵，M^-1为所述机械臂的惯量矩阵，I表示单位矩阵。