一种用于大型构件空间曲线轨迹焊接的运动控制方法与流程

技术特征：
1.一种用于大型构件空间曲线轨迹焊接的运动控制方法，其特征在于，该方法采用的装置包括底座(1)、运动控制器(2)、焊接能量源(3)、焊炬(4)、三维平移机构(5)和双自由度旋转机构(6)；所述底座(1)与所述三维平移机构(5)机械连接，所述双自由度旋转机构(6)安装在所述三维平移机构(5)的运动输出端，焊炬(4)安装在所述双自由度旋转机构(6)的运动输出端；或所述底座(1)与所述双自由度旋转机构(6)机械连接，所述三维平移机构(5)安装在所述双自由度旋转机构(6)的运动输出端，焊炬(4)安装在所述三维平移机构(5)的运动输出端；所述运动控制器(2)分别与所述三维平移机构(5)和所述双自由度旋转机构(6)通过导线连接，或通过无线传输方式通讯；所述焊炬(4)与所述焊接能量源(3)通过导线连接，或通过光路连接；所述三维平移机构(5)包括第一一维平移机构(51)、第二一维平移机构(52)和第三一维平移机构(53)；所述第一一维平移机构(51)、所述第二一维平移机构(52)和所述第三一维平移机构(53)的运动方向相互正交；所述双自由度旋转机构(6)包括第一旋转机构(61)和第二旋转机构(62)；所述第一旋转机构(61)和所述第二旋转机构(62)的旋转轴相互正交；待焊工件(7)安装在底座(1)上；所述方法包括以下步骤：1)建立与所述待焊工件固结的世界坐标系{W}；建立与所述焊炬固结的焊炬坐标系{P}，所述焊炬坐标系{P}的原点Op与所述焊炬末端点重合，zp轴与所述焊炬轴线重合；初始时刻所述焊炬坐标系{P}的zp轴方向与世界坐标系{W}的zw轴方向相互平行；2)在待焊轨迹上自起点至终点测量N个离散空间点的三维坐标以及各点处的单位法向量，其中N为大于或等于2的正整数，记第i个离散空间点在所述世界坐标系{W}中的三维坐标为Xi，第i个离散空间点处的单位法向量在所述世界坐标系{W}中的三维坐标为mi，其中i是小于或等于N的正整数，Xi和mi均为三维列向量；3)设焊炬轴线与待焊轨迹的交点为待焊点；在焊接前，预先设定焊接速度C、焊炬末端点与待焊点之间的有向距离h以及焊炬倾角α，其中C为任意不等于零的实数，h、α为任意实数；4)对所述离散空间点在所述世界坐标系{W}中的三维坐标Xi和所述离散空间点处的单位法向量在所述世界坐标系{W}中的三维坐标mi进行曲线插补，包括以下步骤：a)对Xi进行B样条曲线插补，使得插补的样条曲线Xw(u)满足Xw(ui)＝Xi，其中u为样条曲线Xw(u)的自变量，且：b)计算所述样条曲线Xw(u)的一阶导数sw(u)：c)计算：对rw,i进行B样条曲线插补，使得插补的样条曲线rw(u)满足rw(ui)＝rw,i；d)计算法向量插补函数nw(u)＝sw(u)×rw(u)；5)采用焊接能量源提供焊接时的能量输入，并使所述运动控制器发出控制信号，驱动所述三维平移机构和所述双自由度旋转机构联合运动；设当所述第一旋转机构的旋转角为θ，且所述第二旋转机构的旋转角为γ，且所述三维平移机构的位移量为G时，所述焊炬坐标系{P}和所述世界坐标系{W}的旋转转换矩阵和平移转换矩阵分别为R(θ,γ)和T(θ,γ,G)，其中θ和γ为任意实数，G为任意三维列向量；设t为任意非负实数；在t时刻，运动控制器驱动所述第一旋转机构和所述第二旋转机构运动，使所述第一旋转机构的旋转角θ(t)和所述第二旋转机构的旋转角γ(t)满足：R(θ(t),γ(t))·e3＝lw(t)式中，e3为所述世界坐标系{W}的zw轴的单位方向向量，lw(t)由下式确定：式中，u(t)由下式确定：式中，ξ为积分变量；在t时刻，运动控制器驱动所述第一旋转机构和所述第二旋转机构运动，使所述第一旋转机构的瞬时角速度和所述第二旋转机构的瞬时角速度满足：式中，在t时刻，运动控制器驱动所述三维平移机构运动，使所述三维平移机构的位移量G(t)满足：T(θ(t),γ(t),G(t))＝Xw(u(t))+h·lw(t)在t时刻，运动控制器驱动所述三维平移机构运动，使所述三维平移机构的瞬时速度满足：根据所述焊炬、待焊工件和世界坐标系{W}的相对位姿关系，实时调整所述焊接能量源的能量输入参数。2.如权利要求1所述的一种用于大型构件空间曲线轨迹焊接的运动控制方法，其特征在于：所述焊接能量源为电弧焊焊接电源、激光焊热源或搅拌摩擦焊运动驱动器。3.如权利要求1所述的一种用于大型构件空间曲线轨迹焊接的运动控制方法，其特征在于：该方法采用的装置还包括送丝机构和送丝机构控制器；所述送丝机构控制器与所述送丝机构相连；所述送丝机构末端与所述焊炬相连；使送丝机构控制器发出控制信号，控制送丝机构在焊接过程进行送丝。4.如权利要求1所述的一种用于大型构件空间曲线轨迹焊接的运动控制方法，其特征在于：所述运动控制器为电机控制器或液压控制器。