一种冗余自由度机械臂构型奇异快速判决方法
摘要:
本发明公开了种冗余自由度机械臂构型奇异快速判决方法,其特征在于,包括如下步骤:针对冗余自由度机械臂,其末端速度与各关节角速度之间存在如下映射关系:表示末端速度,表示关节角速度,J表示雅可比矩阵;计算所述雅可比矩阵的最大奇异值与最小奇异值,以最大奇异值与最小奇异值的比值为条件数,当条件数大于设定数值时,则判定机械臂构型发生奇异;计算所述雅可比矩阵的条件数的过程中,采用基于广义逆计算中间结果迭代求取最大奇异值和最小奇异值的实时值,达到实时计算条件数的要求。该方法解决了通过奇异值分解求取雅克比矩阵条件数的复杂计算问题,同时加快计算效率。
公开/授权文献
0/0