一种基于虚拟速度向量场的机器人三维无碰轨迹规划方法

摘要

本发明公开一种基于虚拟速度向量场的机器人三维无碰轨迹规划方法，包括以下步骤：（1）建立机器人的运动学模型；（2）分析机器人的正逆运动学；（3）求解机器人雅可比矩阵；（4）基于扫掠球量对机器人机械臂进行模型简化；（5）建立机器人碰撞检测矩阵求取简化后机器人模型与障碍物的最近距离；（6）改进虚拟速度向量场的吸引速度、排斥速度、切向速度三个向量场函数进行多机器人的无碰运动规划；（7）基于路径优先策略对机器人速度进行优化。本发明对机器人无碰轨迹规划算法进行了优化，提高了机器人运行时的平稳性、轨迹的平滑度以及作业效率。