工业机器人操作空间路径复合限制求解方法

摘要

本发明提出了一种工业机器人操作空间路径复合限制求解方法，包括：设置工业机器人的操作空间路径；计算各轴的速度限制条件和加速度限制条件，根据各轴的速度限制条件和加速度限制条件计算参数的二阶导数的限制条件；根据刚体动力学模型和旋转部分路径，计算各轴力矩限制条件，并根据力矩限制条件计算参数的一阶导数的限制条件；根据工业机器人的操作空间的六维速度旋量计算操作工件的速度限制条件和加速度限制条件，根据速度限制条件和加速度限制条件计算对参数的限制条件；将对工业机器人的复合限制条件统一制对路径参数的限制条件的计算上。本发明有效地求解关节空间和操作空间的多种限制条件，将复合限制统一的表示出来。