申请/专利权人：深圳市汇川技术股份有限公司

申请日：2018-03-07

公开（公告）日：2020-11-24

公开（公告）号：CN108388206B

主分类号：G05B19/416(20060101)

分类号：G05B19/416(20060101)

优先权：

专利状态码：有效-授权

法律状态：2020.11.24#授权;2018.09.04#实质审查的生效;2018.08.10#公开

摘要：本发明提供了一种进给速度实时动态规划方法及系统，所述方法包括以下步骤：根据当前时刻进给速度、当前时刻目标进给速度将调速到结束速度的过程分为第一阶段和第二阶段；规划所述第一阶段的加速度变化过程，并根据所述第一阶段的加速度变化过程计算所述第一阶段的第一运动距离；规划第二阶段的加速度变化过程，并根据所述第二阶段的加速度变化过程计算所述第二阶段的第二运动距离；在所述第一运动距离、第二运动距离之和小于或等于剩余运动距离时，根据所述第一阶段的加速度变化过程以及第二阶段的加速度变化过程获得当前时刻目标进给速度曲线。本发明规划的进给速度可实现时间最优，并适合不同数字控制系统。

主权项：1.一种进给速度实时动态规划方法，其特征在于，包括以下步骤：根据当前时刻进给速度、当前时刻目标进给速度将调速到结束速度的过程分为第一阶段和第二阶段，所述第一阶段为由当前时刻进给速度调速到当前时刻目标进给速度的过程，所述第二阶段为由当前时刻目标进给速度调速到结束速度的过程；根据所述当前时刻进给速度、当前时刻目标进给速度、当前时刻的加速度、最大允许加速度、最大允许加加速度、最大允许减速度，规划所述第一阶段的加速度变化过程，并根据所述第一阶段的加速度变化过程计算所述第一阶段的第一运动距离；根据所述当前时刻目标进给速度、结束速度、最大允许加速度、最大允许减速度以及最大允许加加速度，规划第二阶段的加速度变化过程，并根据所述第二阶段的加速度变化过程计算所述第二阶段的第二运动距离；在所述第一运动距离、第二运动距离之和小于或等于剩余运动距离时，根据所述第一阶段的加速度变化过程以及第二阶段的加速度变化过程获得当前时刻目标进给速度曲线。

全文数据：进给速度实时动态规划方法及系统技术领域[0001]本发明涉及数控系统领域，更具体地说，涉及一种进给速度实时动态规划方法及系统。背景技术[0002]在数控加工中，需要随时改变进给速度，例如通过倍率调节开关或旋钮来改变加工进给速度，在手轮模拟时使加工进给速度跟随手摇速度，在手动运动时使轴的进给速度在慢速和快速之间切换等。而进给速度的响应性能直接影响到加工零件的表面质量和加工效率，因此进给速度的实时动态规划是数控系统中必不可少的功能之一。[0003]进给速度的实时动态规划是在获取新的目标速度值后对后续的进给速度进行实时重新规划，要求重新规划后的进给速度与规划之前的进给速度在速度和加速度上连续。[0004]目前的进给速度规划大多涉及运动速度的静态规划方法，如S型进给速度曲线规划方法、梯型进给速度规划方法、三角函数进给速度规划方法等，在这些方法中，初始和结束的加速度必须为零。而在实际操作中，初始的加速度不一定为零，进给速度可能处于加速、匀速或减速之间的任意状态，因此上述方法不适用。[0005]此外，现有的采用三次多项式加减速模型进行进给速度规划的方法，其规划的进给速度不是时间最优的，并且不适用于轨迹距离改变的场合，应用范围有限。发明内容[0006]本发明要解决的技术问题在于，针对上述进给速度规划的应用范围有限的问题，提供一种进给速度实时动态规划方法及系统。[0007]本发明解决上述技术问题的技术方案是，提供一种进给速度实时动态规划方法，包括以下步骤：[0008]根据当前时刻进给速度、当前时刻目标进给速度将调速到结束速度的过程分为第一阶段和第二阶段，所述第一阶段为由当前时刻进给速度调速到当前时刻目标进给速度的过程，所述第二阶段为由当前时刻目标进给速度调速到结束速度的过程；[0009]根据所述当前时刻进给速度、当前时刻目标进给速度、当前时刻的加速度、最大允许加速度、最大允许加加速度、最大允许减速度，规划所述第一阶段的加速度变化过程，并根据所述第一阶段的加速度变化过程计算所述第一阶段的第一运动距离；[0010]根据所述当前时刻目标进给速度、结束速度、最大允许加速度、最大允许减速度以及最大允许加加速度，规划第二阶段的加速度变化过程，并根据所述第二阶段的加速度变化过程计算所述第二阶段的第二运动距离；[0011]在所述第一运动距离、第二运动距离之和小于或等于剩余运动距离时，根据所述第一阶段的加速度变化过程以及第二阶段的加速度变化过程获得当前时刻目标进给速度曲线。[0012]在本发明所述的进给速度实时动态规划方法中，所述方法包括:在所述第一运动距离、第二运动距离之和大于剩余运动距离时，调整所述当前时刻目标进给速度，并根据调整后的当前时刻目标进给速度，重新规划第一阶段的加速度变化过程以及第二阶段的加速度变化过程，直到所述第一运动距离、第二运动距离之和与剩余运动距离之差的绝对值小于预设值。[0013]在本发明所述的进给速度实时动态规划方法中，所述调整所述当前时刻目标进给速度，并根据调整后的当前时刻目标进给速度，重新规划第一阶段的加速度变化过程以及第二阶段的加速度变化过程包括：[0014]仏1使当前时刻目标进给速度¥1=0.5¥1。1^1^，其中¥1_为所述结束速度，¥1^为前一次规划时的当前时刻目标进给速度；[0015]a2根据当前时刻进给速度、当前时刻目标进给速度将调速到结束速度的过程分为第一阶段和第二阶段，所述第一阶段为由当前时刻进给速度调速到当前时刻目标进给速度的过程，所述第二阶段为由当前时刻目标进给速度调速到结束速度的过程；[0016]a3根据所述当前时刻进给速度、当前时刻目标进给速度、当前时刻的加速度、最大允许加速度、最大允许加加速度、最大允许减速度，规划所述第一阶段的加速度变化过程，并根据所述第一阶段的加速度变化过程计算所述第一阶段的第一运动距离；[0017]a4根据所述当前时刻目标进给速度、结束速度、最大允许加速度、最大允许减速度以及最大允许加加速度，规划第二阶段的加速度变化过程，并根据所述第二阶段的加速度变化过程计算所述第二阶段的第二运动距离；[0018]a5判断所述第一运动距离、第二运动距离之和与剩余运动距离之差的绝对值是否小于预设值，并在所述第一运动距离、第二运动距离之和与剩余运动距离之差的绝对值小于所述预设值时，执行步骤a6，否则执行步骤a7;[0019]a6根据所述第一阶段的加速度变化过程以及第二阶段的加速度变化过程获得当前时刻目标进给速度曲线；[0020]a7在所述第一运动距离、第二运动距离之和大于所述剩余运动距离时，使Vhlgh的值为所述当前时刻目标进给速度，并返回步骤al;在所述第一运动距离、第二运动距离之和小于或等于所述剩余运动距离时，使V1ot的值为所述当前时刻的目标进给速度，并返回步骤al。[0021]在本发明所述的进给速度实时动态规划方法中，在所述当前时刻目标进给速度大于当前时刻进给速度时，所述规划所述第一阶段的加速度变化过程包括：[0022]若当前时刻的加速度大于或等于零，且所述第一阶段的速度改变量大于第一临界速度时，按以下顺序规划所述第一阶段的加速度变化过程:加加速、匀加速、减加速，且所述第一阶段的起始加加速度为最大允许加加速度；[0023]若当前时刻的加速度大于或等于零，且所述第一阶段的速度改变量小于或等于第一临界速度并大于第二临界速度时，按以下顺序规划所述第一阶段的加速度变化过程:加加速、减加速，且所述第一阶段的起始加加速度为最大允许加加速度；[0024]若当前时刻的加速度大于或等于零，且所述第一阶段的速度改变量小于或等于第二临界速度并大于第三临界速度时，按以下顺序规划所述第一阶段的加速度调整过程:减加速、加减速、减减速，且所述第一阶段的起始加加速度为最大允许加加速度的相反数；[0025]若当前时刻的加速度大于或等于零，且所述第一阶段的速度改变量小于第三临界速度时，按以下顺序规划所述第一阶段的加速度调整过程:减加速、加减速、匀减速、减减速，且所述第一阶段的起始加加速度为最大允许加加速度的相反数；[0026]若当前时刻的加速度小于零，且所述第一阶段的速度改变量大于第一临界速度时，按以下顺序规划所述第一阶段的加速度变化过程:减减速、加加速，匀加速、减加速，且所述第一阶段的起始加加速度为最大允许加加速度；[0027]若当前时刻的加速度小于零，且所述第一阶段的速度改变量小于或等于第一临界速度时，按以下顺序规划所述第一阶段的加速度变化过程:减减速、加加速、减加速，且所述第一阶段的起始加加速度为最大允许加加速度。[0028]在本发明所述的进给速度实时动态规划方法中，在所述当前时刻目标进给速度大于当前时刻进给速度时，所述规划所述第一阶段的加速度变化过程包括：[0029]若当前时刻的加速度大于或等于零，且所述第一阶段的速度改变量大于第一临界速度时，按以下顺序规划所述第一阶段的加速度变化过程:减加速、加减速，匀减速、减减速，且所述第一阶段的起始加加速度为最大允许加加速度的相反数；[0030]若当前时刻的加速度大于或等于零，且所述第一阶段的速度改变量小于或等于第一临界速度时，按以下顺序规划所述第一阶段的加速度变化过程:减加速、加减速、减减速，且所述第一阶段的起始加加速度为最大允许加加速度的相反数；[0031]若当前时刻的加速度小于零，且所述第一阶段的速度改变量大于第一临界速度时，按以下顺序规划所述第一阶段的加速度变化过程:加减速、匀减速、减减速，且所述第一阶段的起始加加速度为最大允许加加速度的相反数；[0032]若当前时刻的加速度小于零，且所述第一阶段的速度改变量小于或等于第一临界速度并大于第二临界速度时，按以下顺序规划所述第一阶段的加速度变化过程:加减速、减减速，且所述第一阶段的起始加加速度为最大允许加加速度；[0033]若当前时刻的加速度小于零，且所述第一阶段的速度改变量小于或等于第二临界速度并大于第三临界速度时，按以下顺序规划所述第一阶段的加速度调整过程:减减速、加加速、减加速，且所述第一阶段的起始加加速度为最大允许加加速度；[0034]若当前时刻的加速度小于零，且所述第一阶段的速度改变量小于第三临界速度时，按以下顺序规划所述第一阶段的加速度调整过程:减减速、加加速、匀加速、减加速，且所述第一阶段的起始加加速度为最大允许加加速度。[0035]在本发明所述的进给速度实时动态规划方法中，在所述当前时刻目标进给速度为零时，若当前时刻目标进给速度V1=〇，则在第一阶段加速度规划及第一运动距离计算完成后，根据所述第一阶段的加速度变化过程获得当前时刻目标进给速度曲线。[0036]在本发明所述的进给速度实时动态规划方法中，在当前时刻目标进给速度小于结束速度时，所述规划所述第二阶段的加速度变化过程包括：[0037]若结束速度与当前时刻目标进给速度之差大于第一预设速度，按以下顺序规划所述第二阶段的加速度调整过程:加加速、匀加速、减加速，且所述第二阶段的起始加加速度为最大允许加加速度；[0038]若结束速度与当前时刻目标进给速度之差小于或等于第一预设速度时，按以下顺序规划所述第二阶段的加速度调整过程:加加速、减加速，且所述第二阶段的起始加加速度为最大允许加加速度。[0039]在本发明所述的进给速度实时动态规划方法中，在当前时刻目标进给速度大于或等于结束速度时，所述规划所述第二阶段的加速度变化过程包括：[0040]若当前时刻目标进给速度与结束速度之差大于第二预设速度时，按以下顺序规划所述第二阶段的加速度调整过程:加减速、匀减速、减减速，且所述第二阶段的起始加加速度为最大允许加加速度的相反数；[0041]若当前时刻目标进给速度与结束速度之差小于或等于第二预设速度时，按以下顺序规划所述第二阶段的加速度调整过程:加减速、减减速，且所述第二阶段的起始加加速度为最大允许加加速度的相反数。[0042]在本发明所述的进给速度实时动态规划方法中，所述方法包括:在所述第一运动距离、第二运动距离之和小于剩余运动距离时，按照所述第一运动距离和第二运动距离规划在第一阶段的加速度变化过程和第二阶段的加速度变化过程之间的匀速运动过程。[0043]本发明还提供一种进给速度实时动态规划系统，包括存储装置和处理装置，所述处理单元运行所述存储装置中的代码并执行如上所述的方法。[0044]本发明的进给速度实时动态规划方法及系统，通过将调速过程分为第一阶段和第二阶段，并针对第一阶段和第二阶段分别进行加速度规划，使得生成的速度曲线具有加速度和速度连续，且运动过程平滑。并且，本发明规划的进给速度可实现时间最优，并适合不同数字控制系统。附图说明[0045]图1是本发明进给速度实时动态规划方法实施例的流程示意图；[0046]图2是直线轨迹的示意图；[0047]图3是本发明进给速度实时动态规划方法实施例在当前时刻目标进给速度大于或等于当前时刻进给速度，且处于加速或匀速状态的第一阶段加速度变化过程的示意图；[0048]图4是本发明进给速度实时动态规划方法实施例在当前时刻目标进给速度大于或等于当前时刻进给速度，且处于减速状态的第一阶段加速度变化过程的示意图；[0049]图5是本发明进给速度实时动态规划方法实施例在当前时刻目标进给速度小于当前时刻进给速度，且处于加速或匀速状态的第一阶段加速度变化过程的示意图；[0050]图6是本发明进给速度实时动态规划方法实施例在当前时刻目标进给速度小于当前时刻进给速度，且处于减速状态的第一阶段加速度变化过程的示意图；[0051]图7是使用本发明进给速度实时动态规划方法将图2中直线轨迹进行实时动态速度规划获得的进给速度曲线。具体实施方式[0052]为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。[0053]图1是本发明进给速度实时动态规划方法实施例的流程示意图，该方法用于数控系统轨迹插补。该实施例以一条直线轨迹为例对本发明的方法进行具体说明，直线轨迹起点为（〇，〇，〇，终点为（30，40，0unit单位，该单位可根据需要设置，例如1单位为1mm、0.5mm等），如图2所示。上述动态规划方法的插补周期设为lms，最大允许加加速度为Jm=20000units3，最大允许加速度为Am=2000units2，最大允许减速度为Dm=1000units2，初始和结束的速度和加速度均为零，每隔100个插补周期随机生成当前时刻目标进给速度，范围为0到150units，具体实施步骤如下：[0054]SI:在控制系统发出目标速度改变的指令时，从控制系统中获取动态规划参数，上述动态规划参数具体包括：当前时刻目标进给速度Vi、剩余运动距离Si、当前时刻进给速度Vo、加速度Ao以及结束速度Ve，并根据当前时刻进给速度Vo、当前时刻目标进给速度¥1将调速到结束速度I的过程分为第一阶段和第二阶段，其中第一阶段为由当前时刻进给速度V0调速到当前时刻目标进给速度V1的过程，第二阶段为由当前时刻目标进给速度V1调速到结束速度Ve3的过程。[0055]具体地，每次即每隔100个插补周期获取的动态规划参数可如表1所示：[0057]表1动态规划参数表[0058]S2:根据当前时刻进给速度Vo、当前时刻目标进给速度¥1、当前时刻的加速度Ao、最大允许加速度Am、最大允许加加速度Jm、最大允许减速度0„，规划第一阶段的加速度变化过程，并根据第一阶段的加速度变化过程计算第一阶段的第一运动距离。[0059]上述规划第一阶段的加速度变化过程时，可先根据当前时刻目标进给速度V1与当前时刻进给速度Vo的值判断第一阶段的运动状态，即在在当前时刻目标进给速度V1大于当前时刻进给速度Vo时，第一阶段的运动状态为升速过程，否则第一阶段的运动状态为降速过程。[0060]具体地，当第一阶段的运动状态为升速过程时，计算第一阶段的速度改变量AV=V1-Vo和三个临界速度改变量:第一临界速度，第二临界速度和第三临界速度，并且：[0061]1若当前时刻的加速度Ao大于或等于零，且第一阶段的速度改变量AV大于第一临界速度AV2时，按以下顺序规划第一阶段的加速度变化过程:加加速持续时间t3=匀加速持续时间t2=减加速持续时间t，如图3a所示，且此时第一阶段的起始加加速度1。。及各个速度变化过程的时间满足：[0063]2若当前时刻的加速度Ao大于或等于零，且第一阶段的速度改变量ΔV小于或等于第一临界速度AV2并大于第二临界速度Δ%时，按以下顺序规划第一阶段的加速度变化过程:加加速持续时间t3=减加速持续时间^，如图3b所示，且此时第一阶段的起始加加速度Ja。。及各个速度变化过程的时间满足：[0065]3若当前时刻的加速度Ao大于或等于零，且第一阶段的速度改变量AV小于或等于第二临界速度AV1并大于第三临界速度ΔVo时，按以下顺序规划第一阶段的加速度变化过程:减加速持续时间t3_t〇=加减速持续时间=减减速持续时间t，如图3c所示，且此时第一阶段的起始加加速度Ja。。及各个速度变化过程的时间满足：[0067]4若当前时刻的加速度Ao大于或等于零，且第一阶段的速度改变量AV小于第三临界速度AVo时，按以下顺序规划第一阶段的加速度调整过程:减加速持续时间ts-ti=〉加减速游续时间tl=匀减速游续时间t2=减减速游续时间tl，如图3⑹所示，且此时第一阶段的起始加加速度Ja。。及各个速度变化过程的时间满足：[0069]5若当前时刻的加速度Ao小于零，且第一阶段的速度改变量ΔV大于第一临界速度ΔV2时，按以下顺序规划所述第一阶段的加速度变化过程:减减速持续时间t3-ti=加加速游续时间1：1=匀加速游续时间〖2=减加速游续时间1：1，如图43所示，且此时第一阶段的起始加加速度Ja。。及各个速度变化过程的时间满足：[0071]6若当前时刻的加速度Ao小于零，且第一阶段的速度改变量AV小于或等于第一临界速度AV2时，按以下顺序规划所述第一阶段的加速度变化过程:减减速持续时间t3_ti=加加速持续时间ti=减加速持续时间ti，如图4b所示，且此时第一阶段的起始加加速度Ja。。及各个速度变化过程的时间满足：[0073]当第一阶段的运动状态为降速过程（即当前时刻目标进给速度％小于或等于当前时刻进给速度Vo时，计算第一阶段的速度改变量AV=Vo-VjP三个临界速度改变量第一临界速度U第二临界速度和第一临界速度并且：[0074]1若当前时刻的加速度Ao大于或等于零，且第一阶段的速度改变量AV大于第一临界速度AV2时，按以下顺序规划所述第一阶段的加速度变化过程:减加速持续时间t3_ti=加减速游续时间ti=匀减速游续时间t2=减减速持续时间ti，如图5a所示，且此时第一阶段的起始加加速度Ja。。及各个速度变化过程的时间满足：[0076]2若当前时刻的加速度Ao大于或等于零，且第一阶段的速度改变量AV小于或等于第一临界速度AV2时，按以下顺序规划第一阶段的加速度变化过程:减加速持续时间t3-ti=、加减速持续时间ti=、减减速持续时间ti，如图5b所示，且此时第一阶段的起始加加速度Ja。。及各个速度变化过程的时间满足：[0078]3若当前时刻的加速度Ao小于零，且第一阶段的速度改变量ΔV大于第一临界速度ΔV2时，按以下顺序规划第一阶段的加速度变化过程:加减速持续时间t3=匀减速持续时间t2=减减速持续时间t，如图6a所示，且此时第一阶段的起始加加速度Jacc及各个速度变化过程的时间满足：[0080]4若当前时刻的加速度Ao小于零，且第一阶段的速度改变量ΔV小于或等于第一临界速度AV2并大于第二临界速度Δ%时，按以下顺序规划第一阶段的加速度变化过程:加减速游续时间t3=减减速游续时间tl，如图6⑹所示，且此时第一阶段的起始加加速度1。。及各个速度变化过程的时间满足：[0082]5若当前时刻的加速度Ao小于零，且第一阶段的速度改变量ΔV小于或等于第二临界速度AV1并大于第三临界速度ΔVo时，按以下顺序规划第一阶段的加速度调整过程:减减速持续时间t3-tl=加加速持续时间tl=减加速持续时间tl，如图6C所示，且此时第一阶段的起始加加速度1。。及各个速度变化过程的时间满足：[0084]6若当前时刻的加速度Ao小于零，且第一阶段的速度改变量ΔV小于第三临界速度AVo时，按以下顺序规划第一阶段的加速度调整过程:减减速持续时间t3-ti=加加速游续时间tl=匀加速游续时间t2=减加速游续时间tl，如图6⑹所示，且此时第一阶段的起始加加速度Ja。。及各个速度变化过程的时间满足：[0086]然后，根据上述各种情况下的第一阶段的加速度变化过程计算第一阶段的第一运动距离Sacc:[0088]S3:根据当前时刻目标进给速度V1、结束速度Ve、最大允许加速度六》、最大允许减速度〇„以及最大允许加加速度1，规划第二阶段的加速度变化过程，并根据第二阶段的加速度变化过程计算第二阶段的第二运动距离。[0089]在该步骤中，在当前时刻目标进给速度V1大于或等于结束速度Ve，确认第二阶段运动状态为升速过程，否则第二阶段的运动过程为降速过程。[0090]具体地，当第二阶段为升速过程时，若结束速度Ve3与当前时刻目标进给速度V1之差大于第一预设速度该第一预设速度可以为时，按以下顺序规划所述第二阶段的加速度调整过程:加加速持续时间t4=匀加速持续时间t5=减加速持续时间t4，且此时第二阶段的起始加加速度Jk及各个速度变化过程的时间满足：Jk=Jm;若结束速度Ve3与当前时刻目标进给速度V1之差小于或等于第一预设速度时，按以下顺序规划所述第二阶段的加速度调整过程：加加速（持续时间t4=减加速持续时间t4，且此时第二阶段的起始加加速度Jde。及各个速度变化过程的时间满足Ϊ5—0，Jdec—Jm〇[0091]当第二阶段为降速过程时，若当前时刻目标进给速度V1与结束速度Ve3之差大于第二预设速度（该第二预设速度可以为时，按以下顺序规划第二阶段的加速度调整过程:加减速持续时间t4=匀减速持续时间t5=减减速持续时间t4，且此时第二阶段的起始加加速度J。及各个速度变化过程的时间满足：，Jd3。=_Jm;若当前时刻目标进给速度V1与结束速度Ve3之差小于或等于第二预设速度时，按以下顺序规划第二阶段的加速度调整过程:加减速持续时间t4=减减速持续时间t4，且此时第二阶段的起始加加速度Jde。及各个速度变化过程的时间满足：[0092]然后，根据上述各种情况下的第二阶段的加速度变化过程计算第二阶段的第二运动距离Sdec:[0094]S4:在第一运动距离、第二运动距离之和小于或等于剩余运动距离时，表示当前时刻目标进给速度¥:可达，此时可先计算匀速阶段的时间，即在到达当前时刻目标进给速度后保持匀速运动，然后再按照规划的第二阶段的加速度变化过程调速，其中匀速运动时间[0095]最后，根据动态规划参数（当前时刻目标进给速度V1、剩余运动距离51、当前时刻进给速度Vo、加速度Ao以及结束速度Ve、第一阶段的加速度变化过程以及第二阶段的加速度变化过程加42山、1、仏匕払。和^获得当前时刻目标进给速度（即后续的进给速度）曲线。具体地，后续进给速度可按以下计算式采样计算：[0097]其中：[0099]并且可根据以上的计算式3、（4，通过对时间参数t进行微分和积分可分别得到进给加速度和进给位移的计算式。最终动态规划的速度曲线如图7所示。[0100]在上述方法中，若当前时刻目标进给速度V1=O,则在第一阶段加速度规划完成后，可直接令1：。=〖4=〖5=0,然后根据计算式3、⑷采样计算后续进给速度。[0101]在上述步骤S4中，还可包括:在第一运动距离5%。、第二运动距离Sdec之和大于剩余运动距离31时，S卩Sac^SdeJS1，则当前剩余运动距离不足以使速度达到当前时刻目标进给速度％，需调整当前时刻目标进给速度V1，然后再根据调整后的当前时刻目标进给速度V1，重新规划第一阶段的加速度变化过程以及第二阶段的加速度变化过程，直到第一运动距离Sacc、第二运动距离Sde。之和与剩余运动距离S1之差的绝对值小于预设值。[0102]具体地，在调整当前时刻目标进给速度化时，可包括以下步骤：[0103]al采用二分法修正当前时刻目标速度，即使当前时刻目标进给速度¥1=0.5Vi™+Vhigh，其中Vi™为结束速度Ve3，Vhigh为前一次规划时的当前时刻目标进给速度V1;[0104]a2根据当前时刻进给速度Vo、当前时刻目标进给速度新的Vj#调速到结束速度Ve3的过程分为第一阶段和第二阶段，该第一阶段为由当前时刻进给速度Vo调速到当前时刻目标进给速度¥:的过程，第二阶段为由当前时刻目标进给速度％调速到结束速度Ve3的过程，具体过程可参考上述步骤Sl;[0105]a3根据当前时刻进给速度Vo、当前时刻目标进给速度¥1、当前时刻的加速度、最大允许加速度、最大允许加加速度、最大允许减速度，规划第一阶段的加速度变化过程，并根据第一阶段的加速度变化过程计算第一阶段的第一运动距离，具体过程可参考上述步骤S2；[0106]a4根据当前时刻目标进给速度、结束速度、最大允许加速度、最大允许减速度以及最大允许加加速度，规划第二阶段的加速度变化过程，并根据所述第二阶段的加速度变化过程计算所述第二阶段的第二运动距离，具体过程可参考上述步骤S3;[0107]a5判断第一运动距离、第二运动距离之和与剩余运动距离之差的绝对值是否小于预设值，并在第一运动距离、第二运动距离之和与剩余运动距离之差的绝对值小于预设值（例如）时，即（其中emax为求解精度，例如可设为le-6，执行步骤a6，否则执行步骤a7;[0108]a6根据第一阶段的加速度变化过程以及第二阶段的加速度变化过程获得当前时刻目标进给速度曲线；[0109]a7在第一运动距离、第二运动距离之和大于剩余运动距离时，使Vhlgh的值为当前时刻目标进给速度，并返回步骤al;在第一运动距离、第二运动距离之和小于或等于剩余运动距离时，使V1ot的值为当前时刻的目标进给速度，并返回步骤al。[0110]本发明还提供一种进给速度实时动态规划系统，用于数控系统轨迹插补，该系统包括存储装置和处理装置，所述处理单元运行所述存储装置中的代码并执行如上所述的方法。[0111]以上所述，仅为本发明较佳的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，可轻易想到的变化或替换，都应涵盖在本发明的保护范围之内。因此，本发明的保护范围应该以权利要求的保护范围为准。

权利要求：1.一种进给速度实时动态规划方法，其特征在于，包括以下步骤：根据当前时刻进给速度、当前时刻目标进给速度将调速到结束速度的过程分为第一阶段和第二阶段，所述第一阶段为由当前时刻进给速度调速到当前时刻目标进给速度的过程，所述第二阶段为由当前时刻目标进给速度调速到结束速度的过程；根据所述当前时刻进给速度、当前时刻目标进给速度、当前时刻的加速度、最大允许加速度、最大允许加加速度、最大允许减速度，规划所述第一阶段的加速度变化过程，并根据所述第一阶段的加速度变化过程计算所述第一阶段的第一运动距离；根据所述当前时刻目标进给速度、结束速度、最大允许加速度、最大允许减速度以及最大允许加加速度，规划第二阶段的加速度变化过程，并根据所述第二阶段的加速度变化过程计算所述第二阶段的第二运动距离；在所述第一运动距离、第二运动距离之和小于或等于剩余运动距离时，根据所述第一阶段的加速度变化过程以及第二阶段的加速度变化过程获得当前时刻目标进给速度曲线。2.根据权利要求1所述的进给速度实时动态规划方法，其特征在于，所述方法包括:在所述第一运动距离、第二运动距离之和大于剩余运动距离时，调整所述当前时刻目标进给速度，并根据调整后的当前时刻目标进给速度，重新规划第一阶段的加速度变化过程以及第二阶段的加速度变化过程，直到所述第一运动距离、第二运动距离之和与剩余运动距离之差的绝对值小于预设值。3.根据权利要求2所述的进给速度实时动态规划方法，其特征在于，所述调整所述当前时刻目标进给速度，并根据调整后的当前时刻目标进给速度，重新规划第一阶段的加速度变化过程以及第二阶段的加速度变化过程包括：a1使当前时刻目标进给速度V1=0.5Vi™+Vhigh，其中Vi™为所述结束速度，Vhigh为前一次规划时的当前时刻目标进给速度；a2根据当前时刻进给速度、当前时刻目标进给速度将调速到结束速度的过程分为第一阶段和第二阶段，所述第一阶段为由当前时刻进给速度调速到当前时刻目标进给速度的过程，所述第二阶段为由当前时刻目标进给速度调速到结束速度的过程；a3根据所述当前时刻进给速度、当前时刻目标进给速度、当前时刻的加速度、最大允许加速度、最大允许加加速度、最大允许减速度，规划所述第一阶段的加速度变化过程，并根据所述第一阶段的加速度变化过程计算所述第一阶段的第一运动距离；a4根据所述当前时刻目标进给速度、结束速度、最大允许加速度、最大允许减速度以及最大允许加加速度，规划第二阶段的加速度变化过程，并根据所述第二阶段的加速度变化过程计算所述第二阶段的第二运动距离；a5判断所述第一运动距离、第二运动距离之和与剩余运动距离之差的绝对值是否小于预设值，并在所述第一运动距离、第二运动距离之和与剩余运动距离之差的绝对值小于所述预设值时，执行步骤a6，否则执行步骤a7;a6根据所述第一阶段的加速度变化过程以及第二阶段的加速度变化过程获得当前时刻目标进给速度曲线；a7在所述第一运动距离、第二运动距离之和大于所述剩余运动距离时，使Vhlgh的值为所述当前时刻目标进给速度，并返回步骤al;在所述第一运动距离、第二运动距离之和小于或等于所述剩余运动距离时，使V1ot的值为所述当前时刻的目标进给速度，并返回步骤alο4.根据权利要求1所述的进给速度实时动态规划方法，其特征在于，在所述当前时刻目标进给速度大于当前时刻进给速度时，所述规划所述第一阶段的加速度变化过程包括：若当前时刻的加速度大于或等于零，且所述第一阶段的速度改变量大于第一临界速度时，按以下顺序规划所述第一阶段的加速度变化过程:加加速、匀加速、减加速，且所述第一阶段的起始加加速度为最大允许加加速度；若当前时刻的加速度大于或等于零，且所述第一阶段的速度改变量小于或等于第一临界速度并大于第二临界速度时，按以下顺序规划所述第一阶段的加速度变化过程:加加速、减加速，且所述第一阶段的起始加加速度为最大允许加加速度；若当前时刻的加速度大于或等于零，且所述第一阶段的速度改变量小于或等于第二临界速度并大于第三临界速度时，按以下顺序规划所述第一阶段的加速度调整过程:减加速、加减速、减减速，且所述第一阶段的起始加加速度为最大允许加加速度的相反数；若当前时刻的加速度大于或等于零，且所述第一阶段的速度改变量小于第三临界速度时，按以下顺序规划所述第一阶段的加速度调整过程:减加速、加减速、匀减速、减减速，且所述第一阶段的起始加加速度为最大允许加加速度的相反数；若当前时刻的加速度小于零，且所述第一阶段的速度改变量大于第一临界速度时，按以下顺序规划所述第一阶段的加速度变化过程:减减速、加加速，匀加速、减加速，且所述第一阶段的起始加加速度为最大允许加加速度；若当前时刻的加速度小于零，且所述第一阶段的速度改变量小于或等于第一临界速度时，按以下顺序规划所述第一阶段的加速度变化过程:减减速、加加速、减加速，且所述第一阶段的起始加加速度为最大允许加加速度。5.根据权利要求1所述的进给速度实时动态规划方法，其特征在于，在所述当前时刻目标进给速度大于当前时刻进给速度时，所述规划所述第一阶段的加速度变化过程包括：若当前时刻的加速度大于或等于零，且所述第一阶段的速度改变量大于第一临界速度时，按以下顺序规划所述第一阶段的加速度变化过程:减加速、加减速，匀减速、减减速，且所述第一阶段的起始加加速度为最大允许加加速度的相反数；若当前时刻的加速度大于或等于零，且所述第一阶段的速度改变量小于或等于第一临界速度时，按以下顺序规划所述第一阶段的加速度变化过程:减加速、加减速、减减速，且所述第一阶段的起始加加速度为最大允许加加速度的相反数；若当前时刻的加速度小于零，且所述第一阶段的速度改变量大于第一临界速度时，按以下顺序规划所述第一阶段的加速度变化过程:加减速、匀减速、减减速，且所述第一阶段的起始加加速度为最大允许加加速度的相反数；若当前时刻的加速度小于零，且所述第一阶段的速度改变量小于或等于第一临界速度并大于第二临界速度时，按以下顺序规划所述第一阶段的加速度变化过程：加减速、减减速，且所述第一阶段的起始加加速度为最大允许加加速度的相反数；若当前时刻的加速度小于零，且所述第一阶段的速度改变量小于或等于第二临界速度并大于第三临界速度时，按以下顺序规划所述第一阶段的加速度调整过程:减减速、加加速、减加速，且所述第一阶段的起始加加速度为最大允许加加速度；若当前时刻的加速度小于零，且所述第一阶段的速度改变量小于第三临界速度时，按以下顺序规划所述第一阶段的加速度调整过程:减减速、加加速、匀加速、减加速，且所述第一阶段的起始加加速度为最大允许加加速度。6.根据权利要求1所述的进给速度实时动态规划方法，其特征在于，在所述当前时刻目标进给速度为零时，则在第一阶段加速度规划及第一运动距离计算完成后，根据所述第一阶段的加速度变化过程获得当前时刻目标进给速度曲线。7.根据权利要求1所述的进给速度实时动态规划方法，其特征在于，在当前时刻目标进给速度小于结束速度时，所述规划所述第二阶段的加速度变化过程包括：若结束速度与当前时刻目标进给速度之差大于第一预设速度，按以下顺序规划所述第二阶段的加速度调整过程:加加速、匀加速、减加速，且所述第二阶段的起始加加速度为最大允许加加速度；若结束速度与当前时刻目标进给速度之差小于或等于第一预设速度时，按以下顺序规划所述第二阶段的加速度调整过程:加加速、减加速，且所述第二阶段的起始加加速度为最大允许加加速度。8.根据权利要求1所述的进给速度实时动态规划方法，其特征在于，在当前时刻目标进给速度大于或等于结束速度时，所述规划所述第二阶段的加速度变化过程包括：若当前时刻目标进给速度与结束速度之差大于第二预设速度时，按以下顺序规划所述第二阶段的加速度调整过程:加减速、匀减速、减减速，且所述第二阶段的起始加加速度为最大允许加加速度的相反数；若当前时刻目标进给速度与结束速度之差小于或等于第二预设速度时，按以下顺序规划所述第二阶段的加速度调整过程:加减速、减减速，且所述第二阶段的起始加加速度为最大允许加加速度的相反数。9.根据权利要求1所述的进给速度实时动态规划方法，其特征在于，在所述第一运动距离、第二运动距离之和小于剩余运动距离时，按照所述第一运动距离和第二运动距离规划在第一阶段的加速度变化过程和第二阶段的加速度变化过程之间的匀速运动过程。10.—种进给速度实时动态规划系统，其特征在于，包括存储装置和处理装置，所述处理单元运行所述存储装置中的代码并执行如权利要求1-9中任一项所述的方法。

百度查询： 深圳市汇川技术股份有限公司 进给速度实时动态规划方法及系统

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。

阅读全文 双屏查看 官方信息 专利公告 收藏专利 下载PDF 下载WORD