一种运动控制急停方法技术

本发明专利技术公开了一种运动控制急停方法，该方法的具有数学上的可解析性，能够保证计算的实时性；该方法首先获取当前运动轴的速度和加速度；在预定的时间内，按照四次样条曲线规划，计算在停止时间里运动轴的行进距离；根据初始加速度是否为0，初始加速度和初始速度的是否同号两种情况，来分析停止过程的距离和时间的关系；得出加速度、速度连续，且停止时加速度为0的轨迹规划参数；该方法能够保证运动轴在规定的时间内，平稳停止且运动方向一致；由于采用的同一时间，多轴运动时该方法能够保证多轴同步，保持停止过程的协调性；该方法可以应用于工业机器人、自动化等工控领域，保证运动轴的快速、短距离和平稳停止。短距离和平稳停止。短距离和平稳停止。

【技术实现步骤摘要】
一种运动控制急停方法


[0001]本专利技术涉及工业运动控制
，具体为一种运动控制急停方法。

技术介绍

[0002]运动轴的控制在自动化领域有着大量的应用，目前一般是采用PLC或者运动控制器控制。在一些特殊时刻，需要紧急停止，如果采用抱闸、PLC断输出或者断强电的方式，都会造成运动轴的抖动和冲击。在极短的时间内对停止过程中的运动轴进行轨迹规划，让运动轴能够短距离、快速、平稳的停下来能够使得运动轴不抖动，对机械和电机不造成冲击伤害，具有非常重要的研究意义。

技术实现思路

[0003]本专利技术的目的就在于为了解决现有采用抱闸、PLC断输出或者断强电的方式，都会造成运动轴的抖动和冲击的问题，而提出一种运动控制急停方法。
[0004]本专利技术的目的可以通过以下技术方案实现：一种运动控制急停方法，包括获取运动轴的初始速度和加速度；
[0005]在设定的极短时间里，按照四次样条规划出运动学参数；
[0006]根据加速度是否为0，加速度和速度的是否同号两种情况，来分析停止过程的距离和时间的关系；得出加速度、速度连续，且停止时加速度为0的轨迹规划参数；分析距离、速度、加速度的关系，对运动学参数进行调整。
[0007]在急停规划开始时，保持急停瞬间运动轴的速度、加速度不变。
[0008]优选的，在设定的极短时间结束时运动轴停止，并且加速度为0；
[0009]优选的，设定运动轴急停时刻的初始距离为0，初始速度为v0，初始加速度为a0，急停时刻的初始速度和加速度保持运动轴的原本的速度和加速度一致。
[0010]优选的，分析距离、速度、加速度的关系的过程具体为：
[0011]设定运动轴的急停时间为T，急停距离为p
T
，停止时刻的速度和加速度都为0；根据边界条件，列公式，对公式求解得到：x0＝0，x1＝v0，，
[0012]对二次函数分析，计算对称轴的值，当对称轴的值小于0，即初速度和加速度符号相同；当对称轴的值大于0，初速度和加速度符号相反；
[0013]确定急停时间T，并带入公式中得到急停的四次样条轨迹规划的运动学参数
[0014]与现有技术相比，本专利技术的有益效果是：能够保证急停时刻开始时，运动轴的速度和加速度连续，在停止时加速度为0，停止周期内，运动轴的运动距离不超过目标点，根据目
标距离和计算距离的关系，进行了急停时间的调整，使得运动轴停止时不会超过目标点，实现了急停的目的。
附图说明
[0015]为了便于本领域技术人员理解，下面结合附图对本专利技术作进一步的说明。
[0016]图1为本专利技术的原理框图；
[0017]图2为本专利技术的A点运行到B点到C点的示意图。
具体实施方式
[0018]下面将结合实施例对本专利技术的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其它实施例，都属于本专利技术保护的范围。
[0019]请参阅图1-2所示，一种运动控制急停方法，应用于工业机器人、自动化等领域的运动轴快速、短距离和平稳停止过程的轨迹规划。
[0020]包括在急停规划开始时，保持急停瞬间运动轴的速度、加速度；在设定的极短时间里，按照四次样条规划出运动学参数，保证规划过程中的速度、加速度连续；在设定的极短时间结束时运动轴停止，并且加速度为0；
[0021]保持了急停规划开始的速度和加速度的连续且可导。保证了运动轴开始受力停止但不抖动。
[0022]运动停止的时间是设定的较短时间，在轨迹规划过程中运动轴的速度和加速度连续、可导，急停的运动时间短，运动距离短，且过程中不抖动，对机器设备无冲击，不影响电机和机械寿命。
[0023]运动停止时的加速度为0，这样速度和加速度都不存在突变，使得运动轴的停止时刻是平稳的，顺畅的。
[0024]整个规划的过程具有完备的数学解析解，不存在通过多次学习调整参数的过程，使得该算法能够保证实现的实时性，非常适合在运动控制过程中的紧急停止；
[0025]设定运动轴的急停时间为T，急停距离为P
T
，停止初始时刻的速度和加速连续，停止时刻的速度和加速度都为0；根据边界条件，列公式：solve({0＝x0，v0＝x1，a0＝2
×
x2，P
T
＝x0+x1×
T+x2×
T2+x3×
T3+x4×
T4，0＝x1+2x2×
T+3x3×
T2+4x4×
T3，0＝2x2+6x3×
T+12x4×
T2}，{x0，x1，x2，x3，x4，P
T
})
[0026]对公式求解得到：
[0027][0028]对二次函数分析：
[0029][0030]通过二次函数可得，二次函数过0点，对称轴为当对称轴小于0，即初速度和加速度符号相同；当对称轴大于0，即初速度和加速度符号相反，那么时间的选择只能在0到区间内，否则就会出现路径的往返。如果加速度为0，退化为一次函数，即初始加速度为0的停止问题；
[0031]根据上述分析，方法流程如下：
[0032]如图2，假设运动轴正在从A运行到B，到C点时需要立即停止。其中BC之间距离为L，假定急停时间为T，运动轴运行的距离为l。
[0033](1)首先判断加速度是否为0，如果为0。
[0034]根据公式(2)计算在规定的时间T内的运动轴的距离:
[0035][0036]如果l＜L，则表示规定的时间内停下来，不会超过目标位置。
[0037]如果l＞L，则表示规定的时间内运动轴运动的距离会超过目标点，如图2中所示，超过了B点，应缩短时间，此时的T：
[0038][0039](2)加速度不为0，计算对称轴如果小于0，表示v0,a0,l同符号，则以规定的时间T规划。
[0040]计算在规定时间内的距离
[0041][0042]如果l＜L，则表示规定的时间内停下来，不会超出目标位置。
[0043]如果l＞L，则表示规定的时间内停下来，急停距离会超过目标距离，如图2超过B点位置，缩短时间，此时的急停时间T：
[0044]若a0＞0，
[0045][0046]舍去另外一个根的原因是保证时间T>0。
[0047]若a0＜0，
[0048][0049]舍去另外一个根的原因是保证时间T>0。
[0050](3)加速度不为0，计算对称轴如果大于0，表示v0,l同符号，与a0的符号相反。从二次函数的意义上讲，最大的停止时间只能是否则，速度会变方向。
[0051](a)如果急停的时间则需要调整急停时间为在这种情况下，在的时候距离达到最大值，此时的距离l：
[0052][0053]如果l＜L表明时间本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种运动控制急停方法，其特征在于，该方法包括：获取运动轴的初始速度和加速度；在设定的极短时间里，按照四次样条规划出运动学参数；分析距离、速度、加速度的关系，对运动学参数进行调整。2.根据权利要求1所述的一种运动控制急停方法，其特征在于，在获取运动轴的速度和加速度之前还包括：在急停规划开始时，保持急停瞬间运动轴的速度、加速度不变。3.根据权利要求1所述的一种运动控制急停方法，其特征在于，对运动学参数进行调整后还包括：在设定的极短时间结束时运动轴停止，并且加速度为0。4.根据权利要求1所述的一种运动控制急停方法，其特征在于，分析距离、速度、加速度的...

【专利技术属性】
技术研发人员：尤昕，胡序一，石江涛，贾仁耀，
申请(专利权)人：合肥泰禾光电科技股份有限公司，
类型：发明
国别省市：