基于高阶S型运动轨迹的位置与速度控制方法技术

基于高阶S型运动轨迹的位置与速度控制方法，属于精密运动控制领域。为了解决利用传统的轨迹规划算法的位置与速度控制方法的可移植性差的问题。所述控制方法包括：一：根据第N阶S曲线的限定值求取第N阶S曲线在各分段点的值S(N)[k]；二：求取第k个分段点对应的时间值T[k]和第n阶S曲线在第k个分段点的值S(n)[k]；三：对确定T[k]和S(n)[k]的S曲线进行采样，获得规划后的N阶S型运动轨迹；四：根据规划后的N阶S型运动轨迹，利用位置的采样值、位置的第1阶导数的采样值分别对位置与速度进行控制。本发明专利技术用于运动机构位置与速度的控制。

【技术实现步骤摘要】
基于高阶S型运动轨迹的位置与速度控制方法
本专利技术属于精密运动控制领域。
技术介绍
在精密数控加工系统、机器人系统及精密工作台系统等精密运动控制系统中，为了避免各轴产生的冲击、失步、超程和振荡，以保证在高加速度、高速度的情况下，各运动机构的平稳定位，常需要进行加减速控制，常用的方法有两种，一种是梯形加速度运动轨迹，一种是S型运动轨迹。梯形加速度运动轨迹计算量小、易于实现，但是由于加速度轨迹不平滑，存在突变，易激起系统振荡，对系统造成冲击，因此在实际工程中很少应用。S型运动轨迹能够保证加速度曲线的连续变化，而且阶数越高，轨迹越平滑，对系统的冲击越小。3阶、4阶、5阶S曲线在实际工程中得到了大量应用。S曲线的阶数越高，轨迹规划算法越复杂。传统的轨迹规划算法往往针对给定的行程、速度、加速度等参数值进行设计，当参数值发生改变时，需重新修改算法程序。为了在任意给定行程、速度、加速度等参数值的情况下，不需重新更改算法程序而进行运动轨迹规划，一种方法是求出各阶曲线关于行程、速度、加速度等参数的分段解析表达式，然后将表达式写成函数，行程、速度、加速度等参数作为形参，这种方法程序设计非常简单，但是运动轨迹解析表达式的求解非常复杂，易出错，S曲线阶数越高越复杂，3阶S曲线有7个分段，4阶S曲线有15个分段，对于更高阶的S曲线，这种方法是几乎不被采用的。
技术实现思路
本专利技术的目的是为了解决利用传统的轨迹规划算法的位置与速度控制方法的可移植性差的问题，本专利技术提供一种基于高阶S型运动轨迹的位置与速度控制方法。本专利技术的基于高阶S型运动轨迹的位置与速度控制方法，所述高阶S型运动轨迹为N阶S曲线；所述控制方法包括如下步骤：步骤一：待规划的N阶S曲线共有2N个分段点，为各阶S曲线限定值，表示位置的第n阶导数最大值，n＝0，1，，N；根据第N阶S曲线的限定值求取第N阶S曲线在各分段点的值S(N)[k]，k＝0，1，2，，2N-1；步骤二：求取第k个分段点对应的时间值T[k]和第n阶S曲线在第k个分段点的值S(n)[k]，k＝0，1，2，，2N-1，n＝0，1，，N-1；步骤三：对确定T[k]和S(n)[k]的S曲线进行采样，获得规划后的N阶S型运动轨迹；步骤四：根据规划后的N阶S型运动轨迹，利用位置的采样值、位置的第1阶导数的采样值分别对位置与速度进行控制。所述步骤一中，根据第N阶S曲线的限定值求取第N阶S曲线在各分段点的值S(N)[k]的方法为：S(N)[1]＝0；根据S(N)[2j-1+i]＝(-1)*S(N)[i]；j＝2，...，N，i＝0，1，...，2j-1，确定当k＝2，，2N-1时的S(N)[k]。所述步骤二中，求取第k个分段点对应的时间值T[k]和第n阶S曲线在第k个分段点的值S(n)[k]的方法为：(1)当k＝0时：S(n)[0]＝0，n＝0，1，...，N-1；T[0]＝0；(2)当k＝1，2，...，2N-1时：首先，求取T[k]的值：T[3]＝T[1]+T[2]；k≥4时，根据和T[2j+i]＝T[2j]+T[i]，j＝2，，N-1，i＝1，，2j-1，获得T[k]；根据获得的T[k]、T[k-1]和S(n)[k-1]，获得第n阶S曲线在第k个分段点的值S(n)[k]：其中，t＝T[k]。所述步骤三中，对确定T[k]和S(n)[k]的S曲线进行采样，获得规划后的N阶S型运动轨迹的方法为：根据采样频率f，求取各阶S曲线在第l(l＝1，2，...)个采样点的值：当时，S(n)＝0；n＝0，1，....，N；当时，S(n)＝0；n＝1，....，N；当时，首先从T[0]至T[2N-1]判断所属的分段区间，对于其所属的区间段各阶S曲线在处的采样值为：S(N)＝S(N)[k]；当l＝1至l＝T[2N-1]×f+1，共T[2N-1]×f+1个采样点的值均求取完成后，N阶S型运动轨迹规划完成。本专利技术的有益效果在于，本专利技术针对给定行程、速度、加速度及加速度各阶导数限定值的情况下，提出了一种高阶S型运动轨迹规划算法，该算法可移植性强，可应用于任意阶S曲线的轨迹规划，具有较强的使用价值。附图说明图1为具体实施方式一所述的控制方法的流程示意图。图2为4阶S曲线的示意图，Sm、Vm、Am、Jm和Dm所标注的5条曲线依次表示位置、速度、加速度、加速度一阶导数、加速度二阶导数的轨迹。具体实施方式结合图1和图2说明本实施方式，本实施方式所述的基于高阶S型运动轨迹的位置与速度控制方法，本实施方式高阶S型运动轨迹为4阶S曲线，4阶S曲线位置、速度(位置一阶导数)、加速度(位置二阶导数)、加速度一阶导数(位置三阶导数)和加速度二阶导数(位置四阶导数)的限定值分别为和4阶S曲线共有24＝16个分段点，设第k个分段点对应的时间值为T[k]，各阶曲线在第k个分段点的值分别为S[k]、V[k]、A[k]、J[k]和D[k]，k＝0，1，2，，15；所述方法包括如下步骤：步骤一：根据加速度二阶导数求取D[k]：D[0]＝Dm；D[1]＝0；根据S(N)[2j-1+i]＝(-1)*S(N)[i]；其中j＝2，...，N，i＝0，1，...，2j-1，确定D＝{Dm，0，-Dm，0，-Dm，0，Dm，0，-Dm，0，Dm，0，Dm，0，-Dm，0}；步骤二：T[k]、S[k]、V[k]、A[k]、J[k]，k＝0，1，2，，15：(1)当k＝0时：T[0]＝S[0]＝V[0]＝A[0]＝J[0]＝0；(2)当k＝1，2，...，15时：首先，求取T[k]的值：T[0]＝0；T[1]＝Jm/Dm；T[2]＝Am/Jm；T[3]＝T[2]+T[1]；T[4]＝T[3]+(Vm-2V[3])/Am；T[5]＝T[4]+T[1]；T[6]＝T[4]+T[2]；T[7]＝T[4]+T[3]；T[8]＝T[7]+(Sm-2S[7])/Vm；T[9]＝T[8]+T[1]；T[10]＝T[8]+T[2]；T[11]＝T[8]+T[3]；T[12]＝T[8]+T[4]；T[13]＝T[8]+T[5]；T[14]＝T[8]+T[6]；T[15]＝T[8]+T[7]；根据获得的T[k]、T[k-1]和S(n)[k-1]，获得第n阶S曲线在第k个分段点的值S(n)[k]：其中，t＝T[k]；步骤三：对确定T[k]和S(n)[k]的S曲线进行采样，获得规划后的N阶S型运动轨迹：根据采样频率f，求取各阶S曲线在第l(l＝1，2，...)个采样点的值：当时，d＝j＝a＝v＝s＝0；当时，d＝j＝a＝v＝0，s＝Sm；当时，首先从T[0]至T[2N-1]判断所属的分段区间，对于其所属的区间段各阶S曲线在处的采样值为：d＝D[k]；当l＝1至l＝T[15]×f+1，共T[15]×f+1个采样点的值均求取完成后，4阶S型运动轨迹规划完成，如图2所示；步骤四：根据规划后的N阶S型运动轨迹，利用位置的采样值与位置的第1阶导数的采样值分别对位置与速度进行控制。本文档来自技高网...

【技术保护点】
基于高阶S型运动轨迹的位置与速度控制方法，其特征在于，所述高阶S型运动轨迹为N阶S曲线；所述控制方法包括如下步骤：步骤一：待规划的N阶S曲线共有2N个分段点，为各阶S曲线限定值，表示位置的第n阶导数最大值，n＝0,1,,N；根据第N阶S曲线的限定值求取第N阶S曲线在各分段点的值S(N)[k]，k＝0,1,2,,2N‑1；步骤二：求取第k个分段点对应的时间值T[k]和第n阶S曲线在第k个分段点的值S(n)[k]，k＝0,1,2,,2N‑1，n＝0,1,,N‑1；步骤三：对确定T[k]和S(n)[k]的S曲线进行采样，获得规划后的N阶S型运动轨迹；步骤四：根据规划后的N阶S型运动轨迹，利用位置的采样值、位置的第1阶导数的采样值分别对位置与速度进行控制。

【技术特征摘要】
1.基于高阶S型运动轨迹的位置与速度控制方法，其特征在于，所述高阶S型运动轨迹为N阶S曲线；所述控制方法包括如下步骤：步骤一：待规划的N阶S曲线共有2N个分段点，为各阶S曲线限定值，表示位置的第n阶导数最大值，n＝0,1,...,N；根据第N阶S曲线的限定值求取第N阶S曲线在各分段点的值S(N)[k]，k＝0,1,2,...,2N-1；步骤二：求取第k个分段点对应的时间值T[k]和第n阶S曲线在第k个分段点的值S(n)[k]，k＝0,1,2,...,2N-1，n＝0,1,...,N-1；步骤三：对确定T[k]和S(n)[k]的S曲线进行采样，获得规划后的N阶S型运动轨迹；步骤四：根据规划后的N阶S型运动轨迹，利用位置的采样值、位置的第1阶导数的采样值分别对位置与速度进行控制；所述步骤一中，根据第N阶S曲线的限定值求取第N阶S曲线在各分段点的值S(N)[k]的方法为：S(N)[1]＝0；根据S(N)[2j-1+i]＝(-1)*S(N)[i]；j＝2，...，N，i＝0，1，...，2j-1，确定当k＝2,...,2N-1时的S(N)[k]；所述步骤二中，求取第k个分段点对应...

【专利技术属性】
技术研发人员：陈兴林，宋法质，王一光，董岳，刘杨，陈震宇，张常江，万勇利，刘洋，何良辰，
申请(专利权)人：哈尔滨工业大学，
类型：发明
国别省市：黑龙江;23