基于空间解析几何求解工业机器人中圆弧轨迹的方法

摘要

本发明提出了一种基于空间解析几何求解工业机器人中圆弧轨迹的方法，包括：示教得到工业机器人的圆弧轨迹的目标点的位置；根据目标点的位置判断是否能够确定唯一的圆弧轨迹，如果是则执行步骤S3，否则结束求解；根据目标点的位置，采用矢量算法计算圆弧轨迹的圆心空间坐标O；根据圆心空间坐标和目标点的位置，计算圆弧轨迹的半径，并计算圆弧坐标系与基坐标系的齐次变换矩阵，以根据基坐标系和齐次变换矩阵计算圆弧坐标系；分别计算向量和，计算点积值，进而求解得到圆心角，根据圆弧长和圆心角的关系计算圆心角对应的圆弧长。本发明采用解析几何矢量法求取空间三点圆心过程简单易懂，并且计算复杂度更低，求解更快速简便。