摘要
本申请涉及机械臂技术领域,更具体涉及一种机械臂的全轨迹规划方法及系统。所述方法包括:获取码垛区域的空间尺寸信息和位置信息、待码垛物品箱信息和传送带信息,对物品箱进行分类和确定码放排列方式;获取机械臂的参数信息,建立机械臂的数学模型;根据机械臂的数学模型和传送带信息生成第一运动轨迹,根据机械臂工作空间的障碍物信息对第一运动轨迹进行优化;根据机械臂的数学模型、传送带信息、目标物品箱信息和距离信息生成第二运动轨迹,根据机械臂的数学模型、码垛区域的空间尺寸信息和位置信息、机械臂工作空间的静态障碍物信息生成第三运动轨迹,基于机械臂工作空间的动态障碍物信息对第三运动轨迹进行优化。