摘要
本发明属于机械臂领域,公开了一种码垛机器人的工作空间确定方法,提出了关节运动和笛卡尔运动时,机械臂末端运动范围的计算方法,对于同一构型的码垛机械臂,给出关节角度和臂长,便可计算出相应的关节和末端的运动范围,该方法计算简单且省时,易于编程实现,同时考虑了机械结构的约束,保证了人和设备的安全。然后计算了末端夹持有货物的情况下而引起的运动范围的变化。最后,基于求解出的运动范围,计算末端在某一高度下的两个同心圆组成的圆环,用该圆环和机械臂第一关节确定的锥形区域取交集,然后遍历所有的高度,获得整个码垛机器人的工作空间。