基于旋量理论的 Franka 机械臂逆运动学求解器 GeoFIK 研究
Franka Research 3机械臂是机器人研究领域应用广泛的7自由度冗余操作臂，在学术研究、工业实验与人机协作场景中使用频次较高。该机械臂通过腕部与肘部连杆偏置设计，降低末端有效质量、提升交互安全性，但也带来了复杂的运动学特性。
结构特性
7自由度冗余构型，存在一维自运动流形，理论上有无穷多组逆运动学解
腕部、肘部非球形对称，传统解析法依赖的几何条件不成立
关节限位与连杆干涉约束严格，有效解范围有限
现有求解器局限
多数方法仅锁定关节q7作为自由变量，构型探索空间受限
代数解法缺少几何直观，奇异性位形下易失效
数值解法速度较慢，难以满足实时控制需求
部分求解器存在错误解、超限解，实体部署稳定性不足
图1：Franka机械臂在各关节角qi=0(i=1,…,7)时的初始构型，以及末端执行器坐标系的细节。注：坐标系8与坐标系E均刚性固连在夹持器上。
创新解算方案：GeoFIK几何解算器
针对上述挑战，Lopez-Custodio等人提出了名为GeoFIK（Geometric 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