[发明专利]一种六轴机器人空间运动规划方法

摘要

本发明公开了一种机器人空间运动规划方法，适用于六轴机器人，该方法包括：读取示教器中人工示教好的空间点位坐标与对应运动命令；计算出空间运动轨迹；根据空间运动轨迹得到示教中间点；计算各路径曲线在示教点处的空间切线方向夹角及其空间姿态角；计算相邻路径在中间示教点处的切线方向夹角差和空间姿态角度之差；通过所得值与设定阈值比较，计算经过该示教中间点的速度和加速度；通过路径规划函数，得到各个路径段的加减速运动参数；加减速运动参数输入到机器人运动控制库中，实时计算末端对应位置、姿态及相应编码器值，控制机器人各轴电机运动，完成机器人在示教路径上的空间运动。上述技术方案的有益效果是：保证了机器人运动的快速性和连续性，并通过减小冲击提高了运动的准确性。

主权项

1.一种机器人空间运动规划方法，适用于六轴机器人，其特征在于，所述六轴机器人的机器人控制器连接一示教器，于所述示教器中预先设定了多个空间示教点以及各个所述空间示教点所对应的运动命令，还包括以下步骤：步骤S1：所述机器人控制器读取所述示教器中的所述空间示教点的坐标与对应的运动命令；步骤S2：所述机器人控制器根据所述运动命令中的参数，计算出对应的所述空间示教点之间的空间运动路径；步骤S3，所述机器人控制器根据各个所述空间示教点以及对应的所述空间运动路径计算得到各个所述空间运动路径所对应的示教中间点；步骤S4：所述机器人控制器计算各个所述空间运动路径在所述示教中间点处的空间切线方向的夹角及空间姿态矩阵，随后计算出相邻的所述空间运动路径在所述示教中间点处的空间切线方向的夹角之间的第一角度差和空间姿态角之间的第二角度差；步骤S5：分别将所述第一角度差和所述第二角度差与预设定的阈值进行比较，并根据比较结果计算出经过所述示教中间点的速度和加速度；步骤S6：将所述运动运命令中的参数及所述示教中间点的速度和加速度作为输入参数输入到所述机器人控制器中，以采用预设的运动规划函数对所述六轴机器人的运动进行规划，并得到所述六轴机器人的规划运动参数；步骤S7：所述机器人控制器根据所述规划运动参数形成的机器人运动轨迹，控制所述六轴机器人在经过所述示教中间点的示教路径上进行空间运动。