双工业机器人不同约束下协同运动轨迹规划

针对双工业机器人协作过程中的轨迹规划问题,对IRB200机器人进行建模,并求解机器人的正逆运动学。结合求解的正逆运动学提出紧约束下耦合运动和松约束下叠加运动算法。紧约束将机器人末端执行器之间建立不变的约束关系,实现机器人末端执行器之间产生耦合运动;松约束将机器人末端执行器之间建立随时间变化的约束关系,实现机器人末端执行器之间产生叠加运动。最终在MATLAB中分别进行协同搬运、协同绘制“铜钱”仿真实验验证算法,从姿态图、轨迹图及从机器人理论位置和实际位置对比能够看出,在不考虑机械误差、标定误差及机器人制造误差的情况下能够满足相关任务要求,实现从机器轨迹的自适应规划,避免对双工业机器人分别进行轨迹规划。