运行曲线在线规划方法、设备、存储介质和程序产品与流程

摘要: 本技术涉及运动控制领域,特别是涉及一种运行曲线在线规划方法、设备、存储介质和程序产品。背景技术:1、在伺服运动控制系统、工业机器人及电梯控制等典型运动控制领域中...
运行曲线在线规划方法、设备、存储介质和程序产品与流程

本技术涉及运动控制领域,特别是涉及一种运行曲线在线规划方法、设备、存储介质和程序产品。

背景技术:

1、在伺服运动控制系统、工业机器人及电梯控制等典型运动控制领域中,轨迹规划方法直接决定系统的动态性能与运行品质。传统上广泛采用的梯形速度曲线以分段恒加速度为特征,其在加速段与减速段之间存在加速度突变,即加加速度(jerk)趋于无穷大。这种不连续的动态特性在系统启停及速度切换过程中容易引发明显的冲击与振动,例如,表现为设备运行顿挫、轨迹不平滑以及定位稳定时间延长等问题。同时,较大的冲击载荷还会加剧机械结构与传动部件的疲劳损伤,降低设备使用寿命,并在高精度或高动态应用场景中进一步放大跟踪误差,限制系统性能提升。因此,针对如何在满足速度与加速度约束的同时,实现更高阶动态量的连续变化的问题,出现了对加加速度进行约束的s曲线轨迹规划方法,以实现运动过程的平滑过渡和冲击抑制。

2、目前,s 曲线轨迹规划通常以加加速度(jerk)为约束条件,通过对加速度进行分段积分得到速度与位移曲线,其本质属于三阶积分链在多重约束情况下的时间最优控制问题。在求解过程中,各阶段时间参数及运动状态变量之间存在较强的耦合关系,不同运动阶段之间相互制约,通常需要进行复杂的分段判定及多参数联立求解,计算过程涉及高阶方程求解或迭代计算,整体实现难度大,效率低,难以在工程应用中实现快速部署及在线实时更新。

技术实现思路

1、鉴于现有技术中的上述缺陷或不足,期望提供一种运行曲线在线规划方法,能够提高运行曲线的规划效率和实时性。

2、第一方面,本技术提供了一种运行曲线在线规划方法,应用于伺服系统。该方法包括:

3、按照初始运行曲线控制伺服系统,在监测到发生变更的目标运行参数时,对目标运行参数进行有效性判断;

4、在有效性判断结果表征目标运行参数对初始运行曲线的变更存在有效影响的情况下,若目标运行参数为制动无效参数,或者已完成对伺服系统的紧急制动处理,则对伺服系统进行过冲判断,根据过冲判断结果确定峰值速度搜索区间,并在峰值速度搜索区间中确定运行曲线的峰值速度;

5、以当前运行参数为起始运行参数,以峰值速度为终止运行参数,确定加速段的运行曲线;以峰值速度为恒定速度确定匀速段的运行曲线;以峰值速度为起始运行参数,结合终止运行参数,确定减速段的运行曲线;基于加速段的运行曲线、匀速段的运行曲线和减速段的运行曲线确定更新后的运行曲线,并按照更新后的运行曲线控制伺服系统。

6、结合第一方面,在一种可能的实现方式中,基于目标运行参数对伺服系统进行过冲判断,根据过冲判断结果确定峰值速度搜索区间,并在峰值速度搜索区间中确定运行曲线的峰值速度,包括:以当前运行参数为初始运行参数,结合预设终止参数确定伺服系统的目标位移;在伺服系统的目标剩余位移大于0的情况下,若目标位移小于或等于目标剩余位移,则确定伺服系统正向不过冲,确定峰值速度搜索区间为从第一临界速度到目标速度的闭区间;若目标位移大于目标剩余位移,则确定伺服系统正向过冲,确定峰值速度搜索区间为从目标负速度到0的闭区间;在服系统的目标剩余位移小于或等于0的情况下,若目标位移大于或等于目标剩余位移,则确定伺服系统反向不过冲,确定峰值速度搜索区间为从目标负速度到第一临界速度的闭区间;若目标位移小于目标剩余位移,则确定伺服系统反向过冲,确定峰值速度搜索区间为从0到目标速度的闭区间。

7、结合第一方面,在一种可能的实现方式中,目标运行参数为制动风险参数的情况下,方法还包括:基于目标运行参数进行紧急制动判断,若紧急制动判断结果表征需要对伺服系统进行紧急制动处理,则基于目标运行参数生成制动曲线,并按照制动曲线控制伺服系统。

8、结合第一方面,在一种可能的实现方式中,目标运行参数为速度时,基于目标运行参数进行紧急制动判断,包括:基于初始运行参数和目标速度,确定第一临界速度;第一临界速度表征伺服系统在最大加加速度约束下的最大速度;对初始速度和目标速度、初始速度和目标负速度、第一临界速度和目标速度、第一临界速度和目标负速度进行比较;在初始速度大于或等于目标负速度且小于或等于目标速度,第一临界速度大于或等于目标负速度且小于或等于目标速度的情况下,对初始运行曲线进行更新;否则,基于目标速度生成制动曲线,并按照制动曲线控制伺服系统。

9、结合第一方面,在一种可能的实现方式中,基于目标速度生成制动曲线,包括:在初始速度、目标速度和第一临界速度满足第一条件的情况下,以目标速度为终止速度生成制动曲线;第一条件包括初始速度大于目标速度,且第一临界速度大于目标负速度;或者,初始速度小于或等于目标速度,且初始速度小于目标负速度,且第一临界速度大于目标速度;或者,初始速度小于或等于目标速度,且大于或等于目标负速度,且第一临界速度大于目标速度;在初始速度、目标速度和第一临界速度满足第二条件的情况下,以目标负速度为终止速度生成制动曲线;第二条件包括初始速度大于目标速度,且第一临界速度小于或等于目标负速度;或者,初始速度小于或等于目标速度,且初始速度小于目标负速度,且第一临界速度小于或等于目标速度;或者,初始速度小于或等于目标速度,且大于或等于目标负速度,且第一临界速度小于或等于目标速度,且第一临界速度小于目标负速度。

10、结合第一方面,在一种可能的实现方式中,目标运行参数为最大加速度时,基于目标运行参数进行紧急制动判断,包括:对初始加速度和目标加速度进行比较,在初始加速度小于或等于目标加速度的情况下,对初始运行曲线进行更新;在初始加速度大于目标加速度的情况下,基于初始运行参数和目标加速度,确定第二临界速度;第二临界速度表征伺服系统在负的最大加加速度约束下的最大速度;在第二临界速度大于目标速度的情况下,以目标速度为终止速度生成制动曲线;在第二临界速度小于或等于目标速度的情况下,以第二临界速度为终止速度生成制动曲线。

11、结合第一方面,在一种可能的实现方式中,目标运行参数为最大减速度时,基于目标运行参数进行紧急制动判断,包括:对初始加速度和目标减速度进行比较,在初始加速度大于或等于目标减速度的情况下,对初始运行曲线进行更新;基于初始运行参数和目标减速度,确定第三临界速度;第三临界速度表征伺服系统在最大加加速度约束下的最小速度;在第三临界速度小于目标负速度的情况下,以目标负速度为终止速度生成制动曲线;在第三临界速度大于或等于目标负速度的情况下,以第三临界速度为终止速度生成制动曲线。

12、第二方面,本技术还提供了一种计算机设备。该计算机设备包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现如第一方面所述的方法。

13、第三方面,本技术还提供了一种计算机可读存储介质。该计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现如第一方面所述的方法。

14、第四方面,本技术还提供了一种计算机程序产品。该计算机程序产品,包括计算机程序,该计算机程序被处理器执行时实现如第一方面所述的方法。

15、本技术实施例提供一种运行曲线在线规划方法、设备、存储介质和程序产品,可以在按照初始运行参数控制伺服系统运行的过程中,监测发生变更的目标运行参数,并基于目标运行参数进行在线的运行曲线规划。在规划伺服系统的运行曲线时,可以先基于发生更改的目标运行参数确定峰值速度,然后,基于峰值速度将整个运行曲线分为加速段、匀速段和减速段。从而将三阶积分链在多重约束情况下的时间最优规划过程,拆分为两个二阶积分链在多重约束下的时间最优规划过程,有效降低了运行曲线的规划难度和计算量,提高了运行曲线的规划效率。且高效的规划方式可以应用在伺服系统运行过程中更改参数的场景,即可以实现工程应用过程中的快速部署和在线实时更新。