CN106020122B

CN106020122B - 基于牛顿迭代的数控轨迹控制方法

Info

Publication number: CN106020122B
Application number: CN201610442386.0A
Authority: CN
Inventors: 杨亮亮; 沈波; 胡鑫杰; 胡建; 吴达伟
Original assignee: Zhejiang University of Technology ZJUT
Current assignee: Beijing Huahong Electronic Technology Co ltd
Priority date: 2016-06-17
Filing date: 2016-06-17
Publication date: 2018-10-30
Anticipated expiration: 2036-06-17
Also published as: CN106020122A

Abstract

本发明公开了基于牛顿迭代的数控轨迹控制方法，属于数控系统领域，现有技术的控制方法，两次利用牛顿迭代法求解高阶方程组，并进行二次迭代修正，最终得到符合加工要求的时间规划值。但是直接利用牛顿迭代法求解方程组得到收敛值误差大，需要消耗较长的时间进行修正。根据效率最优原则以及位移、速度、加速度约束条件，对运动的7个不同时间段进行规划。对关于加速度变化时间的一元高次方程进行数学分析，根据它的单调性，构造平方函数，转换为单一凸形函数，进而利用牛顿迭代法求出它的收敛值。本发明解决现有控制方法过程复杂、繁琐问题，提供了一种简洁、高效的轨迹控制方法。

Description

基于牛顿迭代的数控轨迹控制方法

技术领域

本发明属于数控系统领域，涉及基于牛顿迭代的数控轨迹控制方法。

背景技术

随着技术的飞速发展，开放式的数控系统研究已经成为世界各国数控界研究的热点，而我国目前在这一领域的研究相对落后，尤其是在轨迹规划技术的研究上，与国外还有很大的差距。在机械运动的控制上，运动过程的平稳、无冲击、曲线光滑、均匀等特点对机械运动的质量、精度都产生了极大的影响，受限于机械零件材质、精度等因素，机械运动往往达不到所预期的效果，运动过程可能存在较大振动，运动末位置精度不良，运动时间过长效率低下等。中国专利(申请号：201410421152.9)数控机床S型加减速控制方法公开了一种始末速度不为零的轨迹规划方法，对较为复杂的始末速度不为零的S型加减速控制算法所涉及的十几种速度变化曲线，根据速度变化特点，分为三个阶段，三个阶段又包括七个时间段，两次利用牛顿迭代法求解始末速度不为零S型加减速控制算法涉及的高阶方程组，并进行二次迭代修正，最终得到符合加工要求的规划值。但是直接利用牛顿迭代法求解方程组得到收敛值误差大，需要消耗较长的时间进行修正，采用此种控制方法计算繁琐、不够简洁，求解效率和轨迹规划精度都很难得到保证。

发明内容

为解决上述问题，本发明的目的在于提供一种计算简洁、求解高效、轨迹规划精度高的基于牛顿迭代的数控轨迹控制方法。

为实现上述目的，本发明的技术方案为：

基于牛顿迭代的数控轨迹控制方法，已知待加工轨迹位移，机器硬件限制条件：最大限制速度、最大限制加速度、最大加加速度，根据机器硬件限制，对轨迹进行时间规划：第一阶段，求待加工轨迹匀加加速度阶段加加速度段时间t_j1、加减速度段t_j2；第二阶段，求待加工轨迹匀加速度阶段匀加速段t_a1、匀减速段时间即t_a2值；第三阶段，求待加工轨迹匀速段时间t_v1值，其特征在于，根据效率最优原则，对匀加加速度阶段的位移和始末速度方程进行数学分析，化简为一元高次方程，并根据其变化的单调性构造其平方函数，使其转换为单一凸形函数，进而利用牛顿迭代法求出它的收敛值；根据规划出的时间值，求出速度曲线以及起始点，进行插补运算计算出中间点的坐标值，根据坐标值变化向相应坐标输出脉冲信号，控制各执行元件的进给速度、进给方向和进给长度量等，进而完成工件的加工任务。

本发明通过化简为一元高次方程，进而构造平方函数函数，使得关于加加速度段时间t_j1为未知量的高阶函数的变化性质，得以显示出来，并且通过构造平方函数，使得直接准确求解t_j1得以实现。

进一步地，求待加工轨迹匀加速度阶段匀加速段t_a1、匀减速段时间即t_a2值，t_a1表示t_a2，得到关于t_a1的一元二次方程，求解一元二次方程即可得到t_a1的值。t_a1、t_a2为未知量的方程组如下所示，此时t_j1、t_j2为已知量：

方程组比较复杂，直接求解，很繁琐并且不准确，但利用t_a1表示t_a2后，得到关于t_a1的一元二次方程，求解变得简单、准确。

进一步地，一元高次方程为：

其中，s为轨迹规划出的加工位移，v_s为起始速度，j_max为最大加加速度值，v_c为终止速度。

进一步地，单一凸形函数为：

进一步地，牛顿迭代法为：

n为牛顿迭代次数的计数量，n＝1，2，3…..。

在选取迭代初值时，令t_j1＝t_j2＝t_j，可得t_j计算公式：将t_j作为迭代初值。

进一步地，对t_j1进行速度约束修正，由于规划后最大速度出现在减加速度段结束时，当结束速度取速度约束值v_max时可得到在速度约束条件下t_j1所能取得的最大值：再考虑对t_j1进行加速度约束修正，加速度最大值出现在加加速度段结束时，当加速度取加速度约束值a_max时，可得到在加速度约束条件下t_j1所能取得的最大值：

为满足所有的约束条件，t_j1取三者中的最小值：

其中，v_max为最大限制速度，a_ma为最大限制加速度。

进一步地，t_a1表示t_a2：

一元二次方程为：

进一步地，对t_a1进行速度约束修正，速度最大值出现在减加速度段结束时，当结束速度取速度约束值v_max时，可得到在速度约束条件下t_a1所能取得的最大值：取两者中的最小值：其中，v_max为最大限制速度。

与现有技术相比，本发明具有以下有益效果：

1.本发明根据效率最优原则以及位移、速度、加速度约束条件，对运动的7个不同时间段进行规划。对关于加速度变化时间的一元高次方程进行数学分析，根据它的单调性，构造平方函数，转换为单一凸形函数，进而利用牛顿迭代法求出它的收敛值；对匀加速度时间的规划，直接根据其公式特点，进行消元转换为一元二次方程进行规划；对于匀速运动时间可直接根据一元一次方程的解法进行规划，得到时间规划值，进而速度曲线，进行数控机床的运动控制。本发明解决现有控制方法程复杂、繁琐问题，提供了一种简洁、高效的轨迹规划控制方法。

2.通过与现有技术对比，本发明在控制时，所需要的计算时间更短，精度更高，规划出的时间能很好的满足加工要求，减少机床运动冲击和震荡，特别适合高速高精加工，提高了机床的加工精度和效率。

附图说明

图1为本发明加速度变化示意图；

图2为本发明函数F随时间t_j1变化图；

图3为本发明函数G随着时间的变化图。

具体实施方式

为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。

相反，本发明涵盖任何由权利要求定义的在本发明的精髓和范围上做的替代、修改、等效方法以及方案。进一步，为了使公众对本发明有更好的了解，在下文对本发明的细节描述中，详尽描述了一些特定的细节部分。对本领域技术人员来说没有这些细节部分的描述也可以完全理解本发明。

基于牛顿迭代的数控轨迹控制方法，已知待加工轨迹位移，机器硬件限制条件：最大限制速度、最大限制加速度、最大加加速度，根据机器硬件限制，对轨迹进行时间规划：第一阶段，求待加工轨迹匀加加速度阶段加加速度段时间t_j1、加减速度段t_j2；第二阶段，求待加工轨迹匀加速度阶段匀加速段t_a1、匀减速段时间即t_a2值；第三阶段，求待加工轨迹匀速段时间t_v1值。

基于牛顿迭代的数控轨迹控制方法分为三种变化阶段七个时间段，三变化阶段为匀加加速度阶段、匀加速度阶段、匀速度阶段，匀加加速度阶段包括四个时间段：加加速度段、减加速度段、加减速度段、减减速度段；匀加速度阶段包括两个时间段：加速度段、减速度段；匀速度阶段只包括一个时间段：匀速度段。其中加加速度段与减加速段的时间相同，加减速段与减减速段的时间相同，始末速度与加减速时间的关系如式(1)所示，位移与加减速时间的关系如式(2)所示。

根据加工情形考虑，希望以最高的加工效率完成加工任务，同时需要满足工件的精度要求，由于涉及方程为五元三次方程组，并且只有二个方程，因此无法按照常规的方程组直接求解，因此可以先考虑加工效率问题，再考虑加工精度问题，逐步得到满足要求的时间规划方案即按照效率最高原则进行规划。

第一步，根据效率最优原则，对匀加加速度阶段的位移和始末速度方程进行数学分析，化简为一元高次方程，并根据其变化的单调性构造其平方函数，使其转换为单一凸形函数，进而利用牛顿迭代法求出它的收敛值。所述一元高次方程为：

所述单一凸形函数为：

所述牛顿迭代法为：

n为牛顿迭代次数的计数量，n＝1，2，3…..。

在选取迭代初值时，令t_j1＝t_j2＝t_j，可得t_j计算公式：将t_j作为迭代初值，并进行迭代计算，计算出t_j1收敛值。

对t_j1进行速度约束修正，由于规划后最大速度出现在减加速度段结束时，当结束速度取速度约束值v_max时可得到在速度约束条件下t_j1所能取得的最大值：再考虑对t_j1进行加速度约束修正，加速度最大值出现在加加速度段结束时，当加速度取加速度约束值a_max时，可得到在加速度约束条件下t_j1所能取得的最大值：

为满足所有的约束条件，t_j1取三者中的最小值：

其中，v_max为最大限制速度，a_ma为最大限制加速度。

第二步，求待加工轨迹匀加速度阶段匀加速段t_a1、匀减速段时间即t_a2值，t_a1表示t_a2，得到关于t_a1的一元二次方程，求解一元二次方程即可得到t_a1的值。

所述t_a1表示t_a2：

所述一元二次方程为：

对t_a1进行速度约束修正，速度最大值出现在减加速度段结束时，当结束速度取速度约束值v_max时，可得到在速度约束条件下t_a1所能取得的最大值：取两者中的最小值：

其中，v_max为最大限制速度。

第三步，求待加工轨迹匀速度段时间t_v1，由于t_a1、t_a2进行速度约束修正后可能无法满足位移方程，因此，要完成指定位移的运动，存在匀速运动段即tv₁≠0。此时t_j1、t_j2、t_a1、t_a2均为已知量，由公式(2)可知，该方程为t_v1的一元一次方程，因此很容易求得t_v1的值。

第四步，根据已求出t_j1、t_j2、t_v1、t_a1、t_a2完成轨迹规划，至此第一段待加工轨迹的加减速变化时间都已经求出，根据加减速变化时间，可以得到此待加工轨迹的速度曲线。

第五步，判断是否还存在其他加工轨迹线段如果还有则重复一、二、三、四步，并且上一段轨迹的末速度作为下一段轨迹的起始速度代入计算，最后一段的末速度为零；如果没有其他线段则进行第六步。

第六步，根据求出的速度曲线以及起始点，进行插补运算计算出中间点的坐标值，根据坐标值变化向相应坐标输出脉冲信号，控制各执行元件的进给速度、进给方向和进给长度量等，进而完成工件的加工任务。

以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。

Claims

1.基于牛顿迭代的数控轨迹控制方法，包括待加工轨迹位移，机器硬件限制条件：最大限制速度、最大限制加速度、最大加加速度，根据机器硬件限制，对轨迹进行时间规划：第一阶段，求待加工轨迹匀加加速度阶段加加速度段时间t_j1、加减速度段t_j2；第二阶段，求待加工轨迹匀加速度阶段匀加速段t_a1、匀减速段时间即t_a2值；第三阶段，求待加工轨迹匀速段时间t_v1值，其特征在于，根据效率最优原则，对匀加加速度阶段的位移和始末速度方程进行数学分析，化简为一元高次方程，并根据其变化的单调性构造其平方函数，使其转换为单一凸形函数，进而利用牛顿迭代法求出它的收敛值；根据规划出的时间值，求出速度曲线以及起始点，进行插补运算计算出中间点的坐标值，根据坐标值变化向相应坐标输出脉冲信号，控制各执行元件的进给速度、进给方向和进给长度量，进而完成工件的加工任务；

求待加工轨迹匀加速度阶段匀加速段t_a1、匀减速段时间即t_a2值，用t_a1表示t_a2，得到关于t_a1的一元二次方程，求解一元二次方程即可得到t_a1的值；

所述一元高次方程为：

其中，s为轨迹规划出的加工位移，v_s为起始速度，j_max为最大加加速度值，v_e为终止速度；

所述单一凸形函数为：

所述牛顿迭代法为：

n为牛顿迭代次数的计数量，n＝1，2，3.....；

2.如权利要求1所述的基于牛顿迭代的数控轨迹控制方法，其特征在于，对t_j1进行速度约束修正，由于规划后最大速度出现在减加速度段结束时，当结束速度取速度约束值v_max时可得到在速度约束条件下t_j1所能取得的最大值：再考虑对t_j1进行加速度约束修正，加速度最大值出现在加加速度段结束时，当加速度取加速度约束值a_max时，可得到在加速度约束条件下t_j1所能取得的最大值：

为满足所有的约束条件，t_j1取三者中的最小值：

其中，v_max为最大限制速度，a_ma为最大限制加速度。

3.如权利要求2所述的基于牛顿迭代的数控轨迹控制方法，其特征在于，所述t_a1表示t_a2：

4.如权利要求3所述的基于牛顿迭代的数控轨迹控制方法，其特征在于，所述一元二次方程为：

5.如权利要求4所述的基于牛顿迭代的数控轨迹控制方法，其特征在于，对t_a1进行速度约束修正，速度最大值出现在减加速度段结束时，当结束速度取速度约束值v_max时，可得到在速度约束条件下t_a1所能取得的最大值：取两者中的最小值：

其中，v_max为最大限制速度。