分享自:

多关节机器人运动规划的高效轨迹优化

期刊:2018 15th international conference on control, automation, robotics and vision (icarcv)

这篇文章属于类型a:单篇原创研究的学术报告。以下是针对该研究的详细报告:


作者及发表信息

该研究由Yu Zhao、Hsien-Chung Lin和Masayoshi Tomizuka完成,三位作者均来自美国加州大学伯克利分校机械工程系(Department of Mechanical Engineering, University of California at Berkeley)。论文发表于2018年11月18-21日在新加坡举办的2018 15th International Conference on Control, Automation, Robotics and Vision (ICARCV),并被IEEE收录。

研究背景与目标

科学领域:该研究属于机器人运动规划(Robot Motion Planning)领域,涉及最优控制(optimal control)、轨迹优化(trajectory optimization)和动力学约束(dynamic constraints)等问题。

研究动机:多关节机器人的运动规划因复杂的几何结构和非线性动力学特性而具有挑战性。传统方法通常将运动规划分解为路径规划(path planning)和轨迹规划(trajectory planning)两个子问题,但由于子问题的性能指标不一致,这种方法只能得到次优解。因此,作者提出了一种基于最优控制的新方法,旨在同时解决路径规划和轨迹规划问题,并实现更高效率的计算。

研究目标
1. 设计一种既能满足机器人动力学约束,又能实现时间最优(time-optimal)的运动规划算法。
2. 通过高效的数值优化方法,缩短计算时间,同时避免忽略动力学或碰撞避免(collision avoidance)等关键约束。

研究流程与方法

1. 问题建模

研究首先将机器人运动规划问题建模为一个最优控制问题(optimal control problem),定义了以下核心组成部分:
- 状态变量(state)与控制变量(control)
- 状态变量包括关节位置(joint position,$q(t)$)和速度(joint velocity,$\dot{q}(t)$)。
- 控制变量为关节扭矩(joint torque,$\tau(t)$)。
- 成本函数(cost function)
结合运动时间$t_f$和平滑性正则项(regularization term),目标是最小化总成本:
$$ J = t_f + \mu \int_0^{t_f} \dddot{q}(t)^T Q \dddot{q}(t) dt $$
其中$\dddot{q}(t)$为关节加加速度(jerk),$\mu$为权重系数,$Q$为针对高传动比关节的惩罚矩阵。
- 动力学约束(dynamic constraints)
基于拉格朗日方程或牛顿-欧拉法建立的机器人动力学方程:
$$ M(q)\ddot{q} + C(q,\dot{q})\dot{q} + g(q) + f_f = \tau $$
其中$M(q)$为惯性矩阵,$C(q,\dot{q})$为科里奥利力项,$g(q)$为重力项,$f_f$为摩擦力项。
- 路径约束(path constraints)
包括关节位置、速度、扭矩及其变化率的界限,以及碰撞避免条件。作者采用球体近似(sphere approximation)法简化碰撞检测,将机器人和障碍物表示为球体集合。
- 边界条件(boundary conditions)
包括初始和目标位置、速度、加速度,以及终端时间$t_f$的上下限。

2. 数值优化方法

传统数值方法(如直接转录法)难以高效处理非线性问题,因此作者提出了一种基于伪谱法(pseudospectral method)自动微分(automatic differentiation)的优化流程:
- 伪谱法离散化
- 选择Chebyshev-Lobatto点作为插值节点(knots),将连续时间问题转化为离散优化问题。
- 利用重心拉格朗日插值(barycentric Lagrange interpolation)和Clenshaw-Curtis积分规则近似状态、控制变量及积分项。
- 自动微分
采用CasADI工具包高效计算目标函数和约束的导数,避免数值微分(numerical differentiation)的误差和符号微分(symbolic differentiation)的低效问题。
- 优化求解器
使用内点法(interior-point method)求解离散化后的非线性规划问题。

3. 实验验证

研究通过仿真和实际实验验证算法的有效性:
- 仿真测试
- 针对6轴工业机器人,设置不同的初始和目标位置(图5),测试不同节点数(8或12)和正则化权重$\mu$的影响。
- 结果显示,12个节点可在2-3秒内得到接近时间最优的解,且碰撞避免条件均被满足(表II)。
- 实际实验
- 在加州大学伯克利分校的机械系统控制实验室中,将规划轨迹应用于真实机器人(图6),验证了运动可行性和动态约束的满足性(图7)。

主要结果

  1. 计算效率:相比现有研究(需20秒至数分钟),该算法仅需1-3秒即可完成规划,且支持复杂动力学和碰撞避免约束。
  2. 时间最优性:通过调整终端时间$t_f$和正则化权重$\mu$,算法能够在平滑性和时间最优性之间平衡。例如,当$\mu=0.3$时,运动时间缩短至1.2秒,同时满足所有关节扭矩和速度限制(图7)。
  3. 通用性:算法适用于多关节机器人,且无需预先固定几何路径,灵活性显著优于传统分解方法。

结论与价值

科学价值
- 提出了一种将路径规划和轨迹规划统一求解的最优控制框架,避免了传统分解方法的次优性。
- 通过伪谱法和自动微分的结合,显著提升了非线性优化问题的计算效率。

应用价值
- 可应用于工业机器人、自动驾驶等需要实时运动规划的领域。
- 实验证明算法在实际机器人中的可行性,为未来在复杂环境中的部署奠定了基础。

研究亮点

  1. 创新性方法:首次将伪谱法与自动微分结合用于机器人运动规划,兼顾精度和效率。
  2. 全面约束处理:同时考虑动力学、碰撞避免和执行器限制,逼近时间最优解。
  3. 实验验证充分:通过数值仿真和真实机器人实验双重验证算法的实用性。

其他值得关注的内容

  • 球体近似法的引入简化了碰撞检测的数学表达,为后续研究提供了新思路。
  • 论文开源了部分代码实现(基于CasADI),有助于学术界复现和扩展该方法。

(报告总字数:约1500字)

上述解读依据用户上传的学术文献,如有不准确或可能侵权之处请联系本站站长:admin@fmread.com