分享自:

安全平面移动物体操作的时空最优轨迹规划

期刊:IEEE Transactions on Industrial ElectronicsDOI:10.1109/TIE.2023.3301512

类型a:

学术研究报告:

本文介绍了一项发表于2024年7月IEEE Transactions on Industrial Electronics(第71卷,第7期)的研究,题为《Spatiotemporal Optimal Trajectory Planning for Safe Planar Manipulation of a Moving Object》。主要作者包括Yixuan Zhou、Guanzhong Sun、Yanzi Miao(IEEE会员)、Yuanhao Zhang、Xiaojing Chen以及Hesheng Wang(IEEE高级会员)。该研究由上海交通大学自动化系、中国矿业大学信息与控制工程学院、中煤科工集团常州研究院等机构合作完成。

学术背景与研究目的

该研究聚焦于工业机器人领域中的动态平面操作(dynamic planar manipulation)问题,即在传送带上安全、高效地操控移动物体。在许多工业场景(如矿物分拣)中,传送带上的物体过重(40-200公斤),无法直接抓取,而需采用“推/拉”方式在平面上操控。然而,现有机器人抓取和操作研究多针对静态或刚性物体,对动态环境下的障碍物避障和时间优化轨迹规划研究较少。因此,本研究提出了一种结合时空最优轨迹规划和障碍物避障的算法,旨在实现工业机械臂对移动物体的高效、安全操作。

研究方法与流程

研究采用分步优化策略,涵盖初始轨迹生成、时空约束建模和轨迹优化三部分:

1. 初始轨迹生成(Free Space Planning)

目标:尽可能快地让机器人末端执行器(end-effector)接触移动目标,无需预先指定接触时刻。流程包括:
- 路径规划:基于几何信息生成四段路径(包括直线段和插入段),考虑物体移动预测和静态碰撞检测。其中,接触点(contact point)设计为距物体中心一定距离,以避免碰撞。
- 时间参数化:采用时间最优轨迹生成(time-optimal trajectory generation, TOTG)算法对路径进行平滑处理,生成时间最优但非完全安全的轨迹。
- 目标预测:假设物体在传送带上匀速运动,结合图像采集时间(t1)和机械臂响应时间(tc)计算最优接触时刻(t5)。算法通过二分搜索优化到达时间(δta),确保尽早操作目标(Algorithm 1)。

2. 时空安全流形构建(Spatiotemporal Safe Manifold)

为处理动态障碍物,研究定义了流形M = M1 ∩ M2:
- M1:几何约束,确保末端执行器始终接触物体表面。
- M2:时空约束,通过距离函数(distance function)量化机器人、目标物体与动态障碍物的安全距离(如公式7-15)。研究采用广义Sediel算法高效求解凸包距离(convex hull distance),并引入补充距离函数(dfj和doj)处理物体完全重叠时的局部极小值问题。
- 投影优化:将初始轨迹投影到流形M上,生成安全但可能不平滑的轨迹(公式17)。

3. 局部最优轨迹优化(Constrained Nonlinear Optimization)

目标:在满足安全约束的同时,优化轨迹的平滑性和时间效率。流程包括:
- 参数化与连续性约束:将轨迹分段为三次样条(cubic spline),通过调整节点时间(ti)和控制点(qi)优化目标函数(公式19)。优化目标包括空间平滑项(λs)、时间项(λt)和时间平滑项(λp)。
- 物理约束:关节位置、速度和加速度限制通过公式21-24转换为矩阵求解问题,利用带状PLU分解(banded PLU decomposition)加速计算。

主要结果

  1. 仿真验证(2D平面案例):研究在模拟传送带环境中测试算法,结果显示优化后的轨迹能够动态避障(如t=8.7–13.3秒规避障碍物,t=16.5–20.8秒加速完成任务),且运动曲线(图6)满足速度和加速度限制。
  2. 实际实验(机械臂案例):在工业机械臂(Motoman GP88)和RGB-D相机组成的系统中,算法成功操控40-200公斤的矿物进入目标区域(图8),总规划时间仅50毫秒,轨迹执行时间从7.3秒优化至4.4秒(表III)。
  3. 鲁棒性分析:不同传送带速度(表I)和权重参数(表II、IV)下的测试表明,算法在低速(障碍物更多)和高λt(时间优化权重)场景下表现优异。

结论与价值

本研究的核心贡献包括:
1. 算法创新:提出无需预设接触时刻的动态目标跟踪方法(Algorithm 1)和时空安全流形定义(公式1-16),弥补了动态抓取研究中时间优化和平滑性不足的缺陷。
2. 工业适用性:在矿物分拣等重载场景中,首次实现了动态平面操作的全流程自动化,效率接近人工水平(4秒/次)。
3. 理论扩展性:为3D空间内的动态操作规划提供了基础框架(需进一步研究体积距离函数)。

研究亮点

  • 多约束联合优化:首次将几何约束(M1)、动态避障(M2)和时间最优性统一建模为非线性优化问题(公式25)。
  • 计算效率:通过带状矩阵求解(公式27)和距离函数分层处理(dpj、dfj、doj),算法在毫秒级完成规划。
  • 实验全面性:涵盖仿真(2D/3D)和真实工业场景验证,数据支持充分(图5-10,表I-IV)。

其他价值

研究开源了部分代码(如LBFGS优化库),并探讨了未来方向(如基于B样条的全局安全轨迹保证)。该成果对物流分拣、重工业自动化等领域具有直接应用潜力。

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