基于模式函数的超冗余机械臂混合逆向求解方法及系统

摘要

本发明公开了一种基于模式函数的超冗余机械臂混合逆向求解方法，包括：系统求得空间脊线；利用机械臂末端点与脊线末端点重合，求得末端万向节节点U_2N在空间的位置；系统根据求得末端万向节节点位置，确定点U_2N‑1位置；基于双段连杆长，依次确定各奇数万向节的节点位置；确定各臂型角，并求得各偶数万向节点位置；求解各关节的角度。本发明提供一种基于模式函数的超冗余机械臂混合逆向求解系统。首先通过关节点与脊线匹配的方式给定有限的约束条件，然后基于奇数万向节点与偶数万向节点，根据附加任务优化特定的臂型角参数值以达到求解关节角度，实现超冗余机械臂的空间合理规划的目标，可广泛应用于超冗余机器人的逆运动学领域。