一种控制机械臂末端执行空间曲线动作的方法技术

本发明专利技术提供了一种控制机械臂末端执行空间曲线动作的方法，包括步骤：A、确定机械臂待执行空间曲线动作的轨迹表达式；B、基于所述表达式，将所述待执行空间曲线动作的轨迹分别投影至水平和垂直的两平面中；C、分别在所述水平和垂直的两平面中进行圆弧轨迹还原，并以还原结果输出控制指令；D、机械臂执行所述控制指令以完成曲线动作。由上，基于空间圆弧曲线的表达函数，即机械臂待执行空间曲线动作的轨迹表达式对机械臂末端的运动轨迹进行规划控制。

A Method of Controlling Space Curve Actions at the End of Manipulator

The invention provides a method for controlling the end of a manipulator to perform the space curve action, including steps A, determining the trajectory expression of the space curve action to be performed by the manipulator, B, projecting the trajectory of the space curve action to be performed to the horizontal and vertical planes respectively based on the expression, C, and carrying out the circular orbit in the horizontal and vertical planes respectively. Trace reduction, and output control instructions with the result of reduction; D, the manipulator executes the control instructions to complete the curve action. From above, the trajectory of the end of the manipulator is planned and controlled based on the expression function of the space arc curve, i.e. the trajectory expression of the space curve to be executed by the manipulator.

【技术实现步骤摘要】
一种控制机械臂末端执行空间曲线动作的方法
本专利技术涉及自动控制
，特别是一种控制机械臂末端执行空间曲线动作的方法。
技术介绍
随着产业升级和企业技术进步的加快，机械臂成为了机器人
中被得到广泛实际应用的自动化机械装置，此类机械臂具有多自由度，允许在三维空间进行运动，通过接收控制指令以完成各种作业。工业机器人的作业包括喷涂、切割等等，涉及到机械臂末端在空间进行圆周动作。从原理上讲，空间任意曲线都可以用分段空间圆弧去逼近拟合，然而在计算机中做圆弧点的逼近拟合计算，首先要确定空间圆弧曲线的表达函数，但该函数复杂且难于对空间园弧上任意点坐标做求解运算，更谈不上用分段空间圆弧逼近方法来实现圆弧真实轨迹的跟踪了。申请号为CN201510163464.9的中国专利技术专利公开了一种机器人的控制方法及机器人，涉及到了采用几何解析的方法计算运动学逆解，获取到机械臂末端位姿在世界坐标系中的描述，进而采用位姿信息插补，规划机械臂末端的运行轨迹，最终采用插补的形式约束机械臂末端的运行轨迹，实现精确的轨迹控制。上述方案并不适用于机械臂末端执行空间曲线动作，因为无法确定空间圆弧曲线的表达函数以及对空间园弧上任意点坐标做求解运算。
技术实现思路
本专利技术的主要目的在于提供一种控制机械臂末端进行空间曲线动作的方法，基于空间圆弧曲线的表达函数，即机械臂待执行空间曲线动作的轨迹表达式对机械臂末端的运动轨迹进行规划控制。为实现上述目的，本专利技术包括步骤：A、确定机械臂待执行空间曲线动作的轨迹表达式；B、基于所述表达式，将所述待执行空间曲线动作的轨迹分别投影至水平和垂直的两平面中；C、分别在所述水平和垂直的两平面中进行圆弧轨迹还原，并以还原结果输出控制指令；D、机械臂执行所述控制指令以完成曲线动作。其中，所述轨迹表达式为：式中G(x，y，z)表示以机械臂末端为坐标原点的空间二次曲面；(x，y，z)表示机械臂待执行空间曲线动作的轨迹上任一一点的坐标；(ax，ay，az)，(bx，by，bz)，(cx，cy，cz)分别表示机械臂待执行空间曲线动作的轨迹上已知的三个位置的坐标。由上，通过上述正交变换可以将复杂的空间二次曲面的标准式转化为矩阵方程形式，由于有了空间曲线动作的轨迹上上表示其轮廓的三个位置的坐标，通过该矩阵方程可以更简便的、采用更少运算量求出空间二次曲面的圆心，以及经过该圆心与上述a、b、c三点所确定的平面。其中，所述步骤B包括：采用高斯消元对以机械臂末端为坐标原点的空间二次曲面G(x，y，z)进行计算，所得的在两个坐标系下的椭圆方程组表示为:式中，X’、Y’分别表示在水平坐标系下的横坐标和纵坐标，b1、a1分别表示在水平坐标系下椭圆的长轴和短轴数值；Y”、Z’分别表示在垂直坐标系下的横坐标和纵坐标，b2、a2分别表示在垂直坐标系下椭圆的长轴和短轴数值。由上，将空间二次曲面原表达式G(x，y，z)中的三维运算降维成二维，从而减少了运算量。其中，步骤C包括：C1：计算待执行空间曲线动作的轨迹上任一点到空间坐标原点的距离R，所述任一点的坐标表示为(xi，yi，zi)，空间坐标原点的坐标表示为(0，0，0)；C2：确定机械臂待执行空间曲线动作轨迹的圆心，将所述任一点和所述圆心分别投影至所述水平和垂直的两平面中；所述圆心坐标表示为(x0，y0，z0)；C3：分别在所述两平面的坐标系下，计算投影到当前坐标系下的所述任一点的与所述圆心的距离，在水平面上，该距离表示为Rxoy，在垂直面上，该距离表示为Ryoz；C4：分别比较Rxoy2与R2的大小以及Ryoz2与R2的大小，当Rxoy2≥R2时，输出控制指令以使机械臂末端向X轴的负方向进给一步以进行调整；当Ryoz2＜R2时，输出控制指令以使机械臂末端向Y轴的正方向进给一步以进行调整。由上，采用两个平面坐标系的圆弧还原转换为对空间坐标系的圆弧还原，实现了机械臂末端执行空间曲线动作。其中，所述距离R的计算式包括：R2＝xi2+yi2+zi2。由上，基于勾股定理的原理计算出空间曲线动作的轨迹上任一点到空间坐标原点的距离。附图说明图1为本专利技术的流程图。具体实施方式下面参见图1对本专利技术所述的控制机械臂末端执行空间曲线动作的方法进行详细说明。本申请实施例以机械臂末端执行圆周运动为例进行说明，即机械臂的操作对象为圆形，例如机械臂执行轮胎喷漆工作。如图1所示，包括以下步骤：S100：确定操作对象相对于机械臂的位置表达式。以机械臂末端为坐标原点，获取操作对象上表示其轮廓的至少三个位置的坐标，即获取三个位置的坐标即可确定一个圆面，由此可使机械臂控制端获取操作对象相对于机械臂末端的位置和大小。获取操作对象的三个位置的坐标点以及将操作对象划归至以机械臂末端所在的坐标系中已属现有技术，本申请不再赘述。以操作对象上表示其轮廓的三个位置分别为a、b、c为例说明，a、b、c三个位置的坐标分别表示为(ax，ay，az)，(bx，by，bz)，(cx，cy，cz)。空间二次曲面(即对应本实施例的空间任意位置的圆形轮胎)的标准式表示为Ax2+By2+Cz2+Dxy+Eyx+Fzx+Gx+Hy+Iz+J＝0，其中A、B、……、J分别表示系数常量，对上述空间二次曲面的标准式进行正交变换，转换为下列表达式：式中(x，y，z)表示操作对象上任一一点的坐标，G(x，y，z)表示以机械臂末端为坐标原点的空间二次曲面。通过上述正交变换可以将复杂的空间二次曲面的标准式转化为矩阵方程形式，由于有了操作对象上表示其轮廓的三个位置的坐标，通过任意两点的中垂线便可以求出圆心O点(x0，y0，z0)。通过该矩阵方程可以表示出空间二次曲面的圆心，以及经过该圆心与上述a、b、c三点所确定的平面。S200：对步骤S100中的表达式进行消元处理。将所述表达式G(x，y，z)表达的空间二次曲面分别在XOY、YOZ两个坐标系下投影，空间二次曲面投影后分别在上述两个坐标系下呈现为椭圆。具体的，采用高斯消元对步骤S100所变换后的空间二次曲面G(x，y，z)进行计算，所得的在两个坐标系下的椭圆方程组表示为:式中，X’、Y’分别表示在XOY坐标系下的横坐标和纵坐标，b1、a1分别表示在XOY坐标系下椭圆的长轴和短轴数值；Y”、Z’分别表示在YOZ坐标系下的横坐标和纵坐标，b2、a2分别表示在YOZ坐标系下椭圆的长轴和短轴数值。本步骤的目的是将空间二次曲面原表达式G(x，y，z)中的三维运算降维成二维，从而减少了运算量。步骤S300：针对步骤S200中消元处理后的方程进行圆弧轨迹还原。首先以XOY坐标系为例，进行说明。假设在空间二次曲面G(x，y，z)上的任意点为A(xi，yi，zi)，A点到坐标原点(0，0，0)的距离为D，D＝R，R表示空间二次曲面的半径，则有：D2＝R2＝xi2+yi2+zi2。将上述A点和圆心O点分别投影至XOY坐标系下，即令zi＝z0＝0。则投影后的A点与投影后的圆心O点的距离Rxoy表达式为：Rxoy2＝b12+a12。计算Rxoy2与R2的大小，以δx表示，即δx＝Rxoy2-R2，当δx≥0表示圆弧轨迹的还原落在圆弧曲线外或其上，则需要向X轴的负方向进给一步以进行调整。对应的，再将上述A点和圆心O分别投影至YOZ坐标系下，即令xi＝x0＝本文档来自技高网...

【技术保护点】
1.一种控制机械臂末端执行空间曲线动作的方法，其特征在于，包括步骤：A、确定机械臂待执行空间曲线动作的轨迹表达式；B、基于所述表达式，将所述待执行空间曲线动作的轨迹分别投影至水平和垂直的两平面中；C、分别在所述水平和垂直的两平面中进行圆弧轨迹还原，并以还原结果输出控制指令；D、机械臂执行所述控制指令以完成曲线动作。

【技术特征摘要】
1.一种控制机械臂末端执行空间曲线动作的方法，其特征在于，包括步骤：A、确定机械臂待执行空间曲线动作的轨迹表达式；B、基于所述表达式，将所述待执行空间曲线动作的轨迹分别投影至水平和垂直的两平面中；C、分别在所述水平和垂直的两平面中进行圆弧轨迹还原，并以还原结果输出控制指令；D、机械臂执行所述控制指令以完成曲线动作。2.根据权利要求1所述的方法，其特征在于，所述轨迹表达式为：式中G(x，y，z)表示以机械臂末端为坐标原点的空间二次曲面；(x，y，z)表示机械臂待执行空间曲线动作的轨迹上任一一点的坐标；(ax，ay，az)，(bx，by，bz)，(cx，cy，cz)分别表示机械臂待执行空间曲线动作的轨迹上已知的三个位置的坐标。3.根据权利要求2所述的方法，其特征在于，所述步骤B包括：采用高斯消元对以机械臂末端为坐标原点的空间二次曲面G(x，y，z)进行计算，所得的在两个坐标系下的椭圆方程组表示为:式中，X’、Y’分别表示在水平坐标系下的横坐标和纵坐标，b1、a1分别表示在水平坐标系下椭圆的长轴和短轴数值；Y”、Z’分...

【专利技术属性】
技术研发人员：王相伟，
申请(专利权)人：北京芯合科技有限公司，
类型：发明
国别省市：北京,11