在机器人运动规划中避免运动学奇异点的方法及装置

摘要

本发明涉及一种在机器人运动规划中避免运动学奇异点的方法。该方法包括：建立工业机器人的运动学模型；根据运动学模型求出预规划路径的路径点的运动学反解并根据所求出的运动学反解建立工业机器人关节空间的运动学轨迹；当判定运动学轨迹经过球形腕运动学奇异点时，则将预规划路径的起始点的角度进行微小偏转而得到新的规划路径，然后根据新的运动学反解建立工业机器人关节空间的新的运动学轨迹；当判定新的运动学轨迹仍经过球形腕的运动学奇异点时，放弃执行上述述预规划路径；当判定新的运动学轨迹不经过球形腕的任何运动学奇异点时，执行新的规划路径。本发明还涉及一种在机器人运动规划中避免运动学奇异点的装置。