基于旋量理论的 Franka 机械臂逆运动学求解器 GeoFIK 研究

Franka Research 3机械臂是机器人研究领域应用广泛的7自由度冗余操作臂在学术研究、工业实验与人机协作场景中使用频次较高。该机械臂通过腕部与肘部连杆偏置设计降低末端有效质量、提升交互安全性但也带来了复杂的运动学特性。结构特性7自由度冗余构型存在一维自运动流形理论上有无穷多组逆运动学解腕部、肘部非球形对称传统解析法依赖的几何条件不成立关节限位与连杆干涉约束严格有效解范围有限现有求解器局限多数方法仅锁定关节q7作为自由变量构型探索空间受限代数解法缺少几何直观奇异性位形下易失效数值解法速度较慢难以满足实时控制需求部分求解器存在错误解、超限解实体部署稳定性不足图1Franka机械臂在各关节角qi0(i1,…,7)时的初始构型以及末端执行器坐标系的细节。注坐标系8与坐标系E均刚性固连在夹持器上。创新解算方案GeoFIK几何解算器针对上述挑战Lopez-Custodio等人提出了名为GeoFIKGeometric Franka IK的新型分析求解器 。基于螺旋理论Screw Theory与依赖纯代数公式的传统解算器不同GeoFIK利用螺旋理论从几何角度描述机械臂 。它先确定机械臂的螺旋轴然后再系统地计算关节角度 。多参数冗余解析GeoFIK不仅支持锁定关节$q_7$还允许开发者锁定$q_4$、$q_6$或使用“摆动角”Swivel-angle来解析冗余 。这种灵活性使得机械臂在复杂的作业空间中能找到更多有效的构型从而保证任务的连续性 。图2肩轴与S7 奇异位形下的肘部上位与肘部下位解。奇异位姿处理由于采用了螺旋理论该方案能更直观地识别并处理奇异点如肩膀持平奇异点等在其他求解器可能失效的极端位姿下依然能维持解算的可靠性。图3平肩奇异位形示例高效计算该求解器在计算关节角的同时可以不增加额外成本地提供雅可比矩阵Jacobian matrix 。这对于动态控制和实时路径规划至关重要。性能对比与实体机器人实验验证研究将GeoFIK与HeLiu、IKFast、IKGeo三类主流求解器进行对比覆盖计算效率、解有效性、奇异位形表现与实体部署效果。计算效率与解质量关节角求解速度处于较优水平雅可比矩阵计算速度优势明显单次调用最多输出8组有效解无错误解末端误差较低轨迹跟踪实验如下图所示约10秒处HeLiu与以q₇为自由变量的GeoFIK均出现求解失效机器人运动中断以旋转角为自由变量的GeoFIK全程可找到可行解关节轨迹平滑连续清扫等实操任务如图下图所示IKFast常输出无效解易引发机械臂急剧转动、姿态翻转等问题GeoFIK在轨迹跟踪、清扫任务中均可稳定完成无异常运动结语Franka Research 3作为现代机器人研究的核心工具其复杂的运动学特性对解算软件提出了很高要求。GeoFIK等新型几何解算器的出现不仅为Franka提供了更为稳健、快速的逆运动学支持也通过开源C代码等形式进一步促进了机器人学术界在复杂路径规划、人机协作及自动化工业应用方面的探索 。项目详情https://arxiv.org/abs/2503.03992