一种误差可控的四轴工业机器人圆弧过渡式平顺轨迹生成方法

摘要

一种误差可控的四轴工业机器人圆弧过渡式平顺轨迹生成方法，包括：步骤1、四轴工业机器人轨迹预处理：遍历所有轨迹点，将线性轨迹按照位置距离和夹角分成需平顺轨迹段和不需平顺轨迹段，并对四轴姿态进行预处理，保证两个轨迹点之间走劣弧轨迹；步骤2、四轴轨迹平顺：遍历步骤1生成的需平顺轨迹段，对每一段需平顺轨迹段按照轨迹点误差阈值、位置点弦高误差阈值和连续性要求采用几何迭代法生成圆弧过渡式平顺轨迹。本发明圆弧过渡式平顺轨迹生成方法同时具有位置和姿态同步的G1连续性，满足轨迹点误差和轨迹点之间的位置弦高误差，且生成的轨迹能够在不改变四轴工业机器人现有指令格式情况下直接使用，提高四轴工业机器人作业效率和质量。