Direct Kinematics, Inverse Kinematics, and Motion Planning of 1-DoF Rational Linkages

📄 arXiv: 2409.01198v2 📥 PDF

作者: Daniel Huczala, Andreas Mair, Tomas Postulka

分类: cs.RO

发布日期: 2024-09-02 (更新: 2025-06-02)

备注: This is the final published version of the article, available as open access in Mechanism and Machine Theory, Volume 213, 2025. DOI: 10.1016/j.mechmachtheory.2025.106074. Licensed under CC BY license

期刊: Mechanism and Machine Theory Mechanism and Machine Theory Mechanism and Machine Theory, Volume 213, October 2025, 106074

DOI: 10.1016/j.mechmachtheory.2025.106074

💡 一句话要点

提出基于对偶四元数的有理连杆机构运动学与轨迹规划算法

🎯 匹配领域: 支柱一：机器人控制 (Robot Control)

关键词: 有理连杆机构 单自由度 运动学 逆运动学 轨迹规划 对偶四元数 高斯-牛顿搜索

📋 核心要点

  1. 现有单自由度连杆机构的轨迹规划方法通常需要复杂的几何分析，通用性不足。
  2. 论文利用对偶四元数表示有理运动，简化了运动学分析，并提出了基于高斯-牛顿搜索的逆运动学算法。
  3. 实验验证了所提方法在实验室环境下的可行性，适用于四到七个关节的单自由度机构。

📝 摘要（中文）

本研究提出了一系列算法，用于处理具有单自由度（DoF）的有理单环机构的轨迹规划问题。利用有理运动的对偶四元数表示，提供了一种直接（正向）运动学公式、一种数值逆运动学算法以及驱动关节轨迹的生成方法。提出了一种使用高斯-牛顿搜索解决单参数逆运动学问题的新方法。此外，通过应用弧长重参数化，提供了一种执行工具平滑等距运动的方法。这种通用方法可以应用于具有四到七个关节的、以有理运动为特征的单自由度机构，而无需任何额外的几何分析。通过实验验证了其在实验室环境中的应用。

🔬 方法详解

问题定义：论文旨在解决单自由度有理连杆机构的运动学分析和轨迹规划问题。现有方法通常需要针对特定机构进行复杂的几何分析，缺乏通用性，且逆运动学求解较为困难。

核心思路：论文的核心思路是利用对偶四元数来表示有理运动，从而将复杂的几何关系转化为代数运算，简化运动学分析。通过对偶四元数，可以方便地推导出正向运动学公式，并利用数值方法求解逆运动学问题。

技术框架：该方法主要包含三个阶段：1) 基于对偶四元数建立连杆机构的正向运动学模型；2) 提出基于高斯-牛顿搜索的数值逆运动学算法，求解给定工具位姿下的关节变量；3) 通过弧长重参数化方法，生成平滑的等距工具轨迹。

关键创新：该方法最重要的创新点在于利用对偶四元数表示有理运动，避免了复杂的几何分析，使得该方法具有通用性，可以应用于多种单自由度有理连杆机构。此外，提出的基于高斯-牛顿搜索的逆运动学算法，能够有效地求解单参数逆运动学问题。

关键设计：在逆运动学求解中，采用了高斯-牛顿搜索算法，通过迭代优化关节变量，使得工具位姿尽可能接近目标位姿。弧长重参数化用于生成平滑的等距轨迹，确保工具在运动过程中速度均匀。

🖼️ 关键图片

fig_0
fig_1
fig_2

📊 实验亮点

论文通过实验验证了所提方法在实验室环境下的可行性。该方法能够有效地求解单自由度有理连杆机构的正向和逆向运动学问题，并生成平滑的等距轨迹。实验结果表明，该方法具有较高的精度和鲁棒性，能够满足实际应用的需求。

🎯 应用场景

该研究成果可应用于机器人、自动化设备、医疗器械等领域，尤其适用于需要精确轨迹控制的单自由度连杆机构。例如，可以用于设计具有特定运动轨迹的机械臂、手术机器人或自动化生产线上的执行机构。该方法简化了机构设计和控制的复杂性，降低了开发成本。

📄 摘要（原文）

This study presents a set of algorithms that deal with trajectory planning of rational single-loop mechanisms with one degree of freedom (DoF). Benefiting from a dual quaternion representation of a rational motion, a formula for direct (forward) kinematics, a numerical inverse kinematics algorithm, and the generation of a driving-joint trajectory are provided. A novel approach using the Gauss-Newton search for the one-parameter inverse kinematics problem is presented. Additionally, a method for performing smooth equidistant travel of the tool is provided by applying arc-length reparameterization. This general approach can be applied to one-DoF mechanisms with four to seven joints characterized by a rational motion, without any additional geometrical analysis. An experiment was performed to demonstrate the usage in a laboratory setup.