CN115963782A - 一种基于初始加速度不为零的s型速度规划方法 - Google Patents

一种基于初始加速度不为零的s型速度规划方法 Download PDF

Info

Publication number
CN115963782A
CN115963782A CN202310046849.1A CN202310046849A CN115963782A CN 115963782 A CN115963782 A CN 115963782A CN 202310046849 A CN202310046849 A CN 202310046849A CN 115963782 A CN115963782 A CN 115963782A
Authority
CN
China
Prior art keywords
speed
acceleration
planning
initial
velocity
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202310046849.1A
Other languages
English (en)
Other versions
CN115963782B (zh
Inventor
请求不公布姓名
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Limaisheng Control Technology Co ltd
Original Assignee
Beijing Limaisheng Control Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Limaisheng Control Technology Co ltd filed Critical Beijing Limaisheng Control Technology Co ltd
Priority to CN202310046849.1A priority Critical patent/CN115963782B/zh
Publication of CN115963782A publication Critical patent/CN115963782A/zh
Application granted granted Critical
Publication of CN115963782B publication Critical patent/CN115963782B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Manipulator (AREA)

Abstract

本发明涉及数控系统技术领域，公开了一种基于初始加速度不为零的S型速度规划方法，包括速度规划层和位置规划层两部分，其中速度规划层根据给定的输入参数进行满足需求的速度平滑规划，得到速度变化过程中加加速段、减加速段、匀加速段、加减速段和减减速段的持续时间；位置规划层根据速度规划层的输出结果，计算得到任意时刻的位置、速度和加速度。相比于传传统型速度规划方法本发明方法在运动状态切换时避免了加速度阶跃，整体平稳性更高且对于速度过零的连续运动可保持加速度不为零，保证了规划轨迹的时间最优。本发明保证位置、速度和加速度的连续平滑过渡，保证到达末端点时的平滑和精度，保证了规划轨迹的时间最优。

Description

一种基于初始加速度不为零的S型速度规划方法
技术领域
本发明涉及数控系统技术领域，具体为一种基于初始加速度不为零的S型速度规划方法。
背景技术
目前，用于数控系统、工业机器人操作作业的运动速度曲线有很多种，例如T型速度规划、S型速度规划和多项式速度规划。速度规划的作用是保证电机等执行器再启动、停止、变速或者状态过渡时不产生震荡、阶跃和冲击，从而提高运动控制的精度及运动的平稳性。
目前，大多数的速度规划算法都要求给定的首末加速度为零，这就使得在规划完成后不能随意调整给定的轮廓速度和给定末端点速度，有从而使得算法难以实现调速、暂停等功能，并且不能在加速度不阶跃的条件下实现状态切换。
除此之外，目前S型速度规划算法在计算最大速度时的公式过于复杂、推导及编程难度大，使得实现起来困难、运行时计算量大。所以就需要一种基于初始加速度不为零的S型速度规划方法。
发明内容
本发明的目的在于提供一种基于初始加速度不为零的S型速度规划方法，本发明通过能够在初始加速度不为零的情况下规划出一条平滑的轨迹。不仅可以保证位置、速度和加速度的连续平滑过渡，保证到达末端点时的平滑和精度，同时能够在运动过程中发生状态切换时加速度不发生阶跃。除此之外，对于速度过零的连续运动可保持加速度不为零，保证了规划轨迹的时间最优。
本发明是这样实现的：具体按以下步骤执行：
S1:在工业机器人同向加速、同向减速、初末速度反向三种不同情况时进行速度规划；
首先同向加速时，设|v_e|>|v_s|，根据a_s方向可分为：a_s方向与速度变化方向相同以及a_s方向与速度变化方向相反2种情况；
S1。1:a_s方向与速度变化方向相同时，首先计算a_s直接减到0的速度变化量deltaV1，根据deltaV1是否大于|v_e-v_s|分为以下两种情况：速度不会超过v_e或速度会超过v_e；
其中，速度不超过v_e，如果加速度能达到轮廓加速度accel时，轨迹分为：加速度从a_s到accel、按照accel匀加速、加速度从accel到0；如果加速度不能达到轮廓加速度accel时，首先计算实际可以达到的加速度：a_m＝sqrt((|v_e-v_s|+a_s^2/jerk/2)*jerk)；
如果速度超过v_e时，轨迹分为：a_s减为0，速度到达v1、速度从v1减速到v_e；如果加速度不能达到轮廓减速度decel时，首先计算可以达到的减速度：a_m＝-sqrt(|v_e-v1|)。
在工业机器人同向减速时；
初始速度v_s和结束速度v_e同向并且|v_e|<|v_s|，根据初始加速度a_s方向可分为以下2种情况：
S2.1：初始加速度方向与速度变化方向相同时；
首先计算a_s直接减到0的速度变化量deltaV1，根据deltaV1是否大于|v_e-v_s|和|v_s|分为以下3三种情况：速度不会超过v_e、速度会超过v_e但不会反向、速度会超过v_e且会反向；
其中速度不超过v_e，如果加速度能达到轮廓减速度decel时，轨迹分为：a_s加速到decel、以decel匀减速、加速度从decel到0；
如果加速度不能达到轮廓减速度decel时，首先计算实际可以达到的减速度：a_m＝-sqrt((|v_e-v_s|+a_s^2/jerk/2)*jerk)，此时速度会超过v_e但不会反向，轨迹分为：a_s减为0，速度到达v1、速度从v1加速到v_e；
如果加速度不能达到轮廓加速度accel时，首先计算可以达到的加速度：a_m＝-sqrt(|v_e-v1|)，此时速度会超过v_e且会反向，使用速度反向方法进行规划；
S2.2：初始加速度方向与速度变化方向相反；
轨迹分为：a_s减为0，速度到v1、v1加速到v_e，第二步若不能达到轮廓减速度decel，首先计算可达的减速度：a_m＝-sqrt(|v_e-v1|)。
在工业机器人初末速度反向时；当速度出现减速过零、反向加速时，加速度不为0，以此得到的轨迹为时间最优轨迹；首先计算加速度从a_s直接减到0的速度变化量deltaV1，根据deltaV1是否大于|v_e-v_s|分为：速度会超过v_e、速度不会超过v_e；
进一步，当速度会超过v_e时，轨迹分为：a_s减到0，速度到达v1、v1加速到v_e，若不能达到轮廓减速度decel时，首先计算可达的减速度：a_m＝-sqrt(|v_e-v1|)；
速度不会超过v_e时，根据初始加速度方向分为：初始加速度与速度变化方向相同、初始加速度与速度变化方向相反两种情况；
变化方向相同时，轨迹分为：v_s减到0、速度从0加速到v_e；
变化方向相反时，轨迹分为：a_s减到0，速度到v1、v1加速到v_e。
S2:根据不同初末速度下中间速度对于总位移的影响，可分为以下情况：
初末速度都大于0，初始加速度大于0；
初末速度都大于0，初始加速度小于0；
初速度都大于0、末速度小于0，初始加速度大于0；
初速度都大于0、末速度小于0，初始加速度小于0；
初速度小于0、末速度大于0，初始加速度大于0；
初速度小于0、末速度大于0，初始加速度小于0；
初末速度都小于0，初始加速度大于0；
初末速度都小于0，初始加速度小于0；
S3：对工业机器人进行轨迹规划，具体根据上述分段方法找到可以达到的中间速度v_m，然后使用速度规划方法分别规划速度从v_s到v_m以及v_m到v_e两个过程的轨迹。
进一步，在工业机器人能达到正向轮廓速度v_p时，先用速度规划方法分别规划v_s到v_p以及v_p到v_e两个过程，如果总位移大于这两个过程位移之和则判定能达到轮廓速度v_p，此时整个轨迹可以分为以下三个阶段：
第一阶段从v_s到v_p，使用速度规划方法进行规划，总位移为S1；
第二阶段按照v_p匀速运动，位移S2＝S-S1-S3，时间T2＝S2/v_p；
第三阶段从v_p到v_e，使用速度规划方法进行规划，总位移为S3；
进一步，在工业机器人能达到负向轮廓速度-v_p时，
先用速度规划方法规划从v_s直接减速或减速到v_e的位移S_fast，再用速度规划方法分别规划v_s到-v_p以及-v_p到v_e两个过程，如果总位移
(L＝|p_e-p_s|)小于S_fast并且小于这两个过程位移之和(L1+L2)则速度需要反向可以达到反向轮廓速度-v_p，此时整个轨迹可以分为以下三个阶段：
第一阶段从v_s到-v_p，使用速度规划方法进行规划，总位移为L1
第二阶段按照-v_p匀速运动，位移L2＝L1+L3-L，时间T2＝L2/v_p
第三阶段从-v_p到v_e，使用速度规划方法进行规划，总位移为L3
在工业机器人不能达到轮廓速度时，此时，实际可以达到的速度使用二分插方法计算出。
进一步，本发明提供一种计算机可读存储介质，其上存储有计算机程序，所述程序被主控制器执行时实现上述中任一项所述的方法。
与现有技术相比，本发明的有益效果是：
1、能够在初始加速度不为零的情况下规划出一条平滑的轨迹。不仅可以保证位置、速度和加速度的连续平滑过渡，保证到达末端点时的平滑和精度，同时能够在运动过程中发生状态切换时加速度不发生阶跃。除此之外，对于速度过零的连续运动可保持加速度不为零，保证了规划轨迹的时间最优。
附图说明
为了更清楚地说明本发明实施方式的技术方案，下面将对实施方式中所需要使用的附图作简单地介绍，应当理解，以下附图仅示出了本发明的某些实施例，因此不应被看作是对范围的限定，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他相关的附图。
图1是本发明的方法流程图；
图2是其他规划算法针对加速度阶跃问题规划效果图；
图3是本发明的针对加速度阶跃问题规划效果图；
图4是其他规划算法针对速度过0轨迹规划效果图；
图5是本发明的算法针对速度过0轨迹规划效果图。
具体实施方式
为使本发明实施方式的目的、技术方案和优点更加清楚，下面将结合本发明实施方式中的附图，对本发明实施方式中的技术方案进行清楚、完整地描述，显然，所描述的实施方式是本发明一部分实施方式，而不是全部的实施方式。基于本发明中的实施方式，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施方式，都属于本发明保护的范围。因此，以下对在附图中提供的本发明的实施方式的详细描述并非旨在限制要求保护的本发明的范围，而是仅仅表示本发明的选定实施方式。基于本发明中的实施方式，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施方式，都属于本发明保护的范围。
请参阅图1-5，一种基于初始加速度不为零的S型速度规划方法，
本实施例中，具体按以下步骤执行：所述速度规划分以下三种情况：同向加速、同向减速、初末速度反向。速度规划，所述速度规划分以下三种情况：同向加速、同向减速、初末速度反向。
S1：工业机器人同向加速时，初始速度v_s和结束速度v_e同向并且|v_e|>|v_s|，根据初始加速度a_s方向可分为以下2种情况：初始加速度方向与速度变化方向相同以及初始加速度方向与速度变化方向相反。
S1.1：初始加速度方向与速度变化方向相同时，首先计算加速度从a_s直接减到0的速度变化量deltaV1＝a_s^2/jerk/2，根据deltaV1是否大于|v_e-v_s|分为以下两种情况：速度不会超过v_e、速度会超过v_e。
a)速度不超过v_e，如果加速度可以达到轮廓加速度accel时，轨迹分为以下3个过程：
第一步，加速度从a_s到accel；
第二步，按照accel匀加速；
第三步，加速度从accel到0；
如果加速度不能达到轮廓加速度accel时，首先计算实际能达到的加速度a_m：
deltaV＝|v_e-v_s|，a_m＝sqrt((deltaV+a_s^2/jerk/2)*jerk)
b)速度会超过v_e时，轨迹分为以下两个过程：
第一步，加速度从a_s到0，速度到达v1
第二步，速度从v1减速到v_e
本实施例中，第二步如果加速度不能达到轮廓减速度decel时，首先计算可以达到的减速度：
deltaV＝|v_e-v1|，a_m＝-sqrt(deltaV)
S1.2：初始加速度方向与速度变化方向相反时，首先计算加速度从a_s直接减到0的速度变化量deltaV1＝a_s^2/jerk/2.0，根据deltaV1是否大于|v_s|分为以下两种情况：速度不反向、速度会反向。
a)速度不会反向时，轨迹分为以下两个过程：
第一步，加速度从a_s到0，速度到达v1
第二步，速度从v1加速到v_e
第二步如果加速度不能达到轮廓加速度accel时，首先计算能达到的加速度：
deltaV＝|v_e-v1|，a_m＝sqrt(deltaV)
b)速度不会反向时，使用速度反向方法进行规划。
S2：同向减速时
初始速度v_s和结束速度v_e同向并且|v_e|<|v_s|，根据初始加速度a_s方向可分为以下2种情况：
S2.1：初始加速度方向与速度变化方向相同
首先计算a_s直接减到0时的速度变化量deltaV1，根据deltaV1是否大于|v_e-v_s|和|v_s|分为以下三种情况：速度不会超过v_e、速度会超过v_e但不会反向、速度会超过v_e且会反向。
a)速度不超过v_e，如果加速度能达到轮廓减速度decel时，轨迹分为以下3个过程：
第一步，加速度从a_s到decel；
第二步，按照decel匀加速；
第三步，加速度从decel到0
当加速度不能达到轮廓减速度decel时，首先计算可达的减速度a_m；
deltaV＝|v_e-v_s|，a_m＝-sqrt((deltaV+a_s^2/jerk/2)*jerk)
b)速度会超过v_e但不会反向，轨迹分为以下两个过程：
第一步，加速度从a_s到0，速度到达v1；
第二步，速度从v1加速到v_e；
第二步加速度不能达到轮廓加速度accel时，首先计算可达的加速度：
deltaV＝|v_e-v1|，a_m＝sqrt(deltaV)；
速度会超过v_e且会反向，使用速度反向方法进行规划。
S2.2：初始加速度方向与速度变化方向相反
轨迹分为以下2个过程：
第一步，加速度从a_s到0，速度到达v1；
第二步，速度从v1加速到v_e；
第二步加速度不能达到轮廓减速度decel时，首先计算可达的减速度：
deltaV＝|v_e-v1|，a_m＝-sqrt(deltaV)
S3：速度反向
首先计算a_s直接减到0时速度变化量deltaV1，根据deltaV1是否大于|v_e-v_s|分为以下两种情况：速度会超过v_e、速度不会超过v_e。
S3.1：速度会超过v_e
轨迹分为以下2个过程：
第一步，加速度从a_s到0，速度到达v1；
第二步，速度从v1加速到v_e；
第二步加速度不能达到轮廓减速度decel时，首先计算可达的减速度：
deltaV＝|v_e-v1|，a_m＝-sqrt(deltaV)；
本实施例中，S3.2：速度不会超过v_e；
根据初始加速度方向分为以下两种情况：初始加速度与速度变化方向相同、初始加速度与速度变化方向相反。
初始加速度与速度变化方向相同时，轨迹分为：v_s减速到0、从0加速到v_e2个过程。其中关键为在速度为0时选择合适的过渡加速度使总体时间最优：
计算从v_s减速到0时可以达到的加速度a_m，如果a_m小于a_s:
当a_s^2/jerk/2>|v_s|时，a1_min＝sqrt((a_s^2/jerk/2-|v_s|)*jerk*2)。
当a_s^2/jerk/2<＝|v_s|时，a1_min＝0。
如果decel大于|a_s|时，a1_max＝sqrt((|v_s|+a_s^2/jerk/2)*jerk*2)。
如果decel<＝|a_s|时，a1_max＝0。
计算速度从0加速到v_e时可以达到的加速度a_m：
a2_m＝sqrt(|v_e|*jerk*2)
a2_m＝min(a2_m,min(accel,decel))
本实施例中，根据上述两个过程中可以达到的加速度确定最合适速度过0时的过渡加速度：
如果a2_m大于a1_max,则过渡速度a_m＝a1_max。
如果a2_m小于a1_min,则过渡速度，a_m＝a1_min。
如果a2_m在a1_min和a1_max之间,则过渡速度a_m＝a2_m。
确定过渡加速度后分别规划从v_s到0以及从0到v_e两个过程。
本实施例中，初始加速度与速度变化方向相反时，轨迹分为以下2个过程：
第一步，加速度从a_s到0，速度到达v1
第二步，按照初始加速度与速度变化方向相同时的方法规划速度从v1加速到v_e。
本实施例中，对工业机器人进行位置规划；
S4：根据不同初末速度下中间速度对于总位移的影响，可以分为：
a.初末速度都大于0，初始加速度大于0；
b.初末速度都大于0，初始加速度小于0；
c.初速度都大于0、末速度小于0，初始加速度大于0；
d.初速度都大于0、末速度小于0，初始加速度小于0；
e.初速度小于0、末速度大于0，初始加速度大于0；
f.初速度小于0、末速度大于0，初始加速度小于0；
g.初末速度都小于0，初始加速度大于0；
h.初末速度都小于0，初始加速度小于0；
S4.1：可以达到正向轮廓速度v_p；
先用速度规划方法分别规划v_s到v_p以及v_p到v_e两个过程，如果总位移大于这两个过程位移之和则说明可以达到轮廓速度v_p，此时整个轨迹可以分为以下三个阶段：
第一阶段从v_s到v_p，使用速度规划方法进行规划，总位移为S1
第二阶段按照v_p匀速运动，位移S2＝S-S1-S3，时间T2＝S2/v_p
第三阶段从v_p到v_e，使用速度规划方法进行规划，总位移为S3
本实施例中，工业机器人的速度能达到负向轮廓速度-v_p时，先用速度规划方法规划从v_s直接减速或减速到v_e的位移S_fast。
再用速度规划方法分别规划v_s到-v_p以及-v_p到v_e两个过程，如果总位移(L＝|p_e-p_s|)小于L_fast并且小于这两个过程位移之和(L1+L2)则说明速度需要反向可以达到反向轮廓速度-v_p，此时整个轨迹可以分为以下三个阶段：
第一阶段从v_s到-v_p，使用速度规划方法进行规划，总位移为L1
第二阶段按照-v_p匀速运动，位移S2＝S1+S3-S，时间T2＝S2/v_p
第三阶段从-v_p到v_e，使用速度规划方法进行规划，总位移为L3
S4.3：不能达到轮廓速度；
此时，实际可以达到的速度可使用二分插找法计算出。
S5：轨迹规划
根据上述分段方法找到可以达到的中间速度v_m，然后使用速度规划方法分别规划速度从v_s到v_m以及v_m到v_e两个过程的轨迹即可。
S6：通过给定相同的输入参数，对比该算法与初始加速度为零的S型速度规划算法在加速度阶跃问题和速度过零优化问题上的规划效果，其仿真结果如图2至图5所示，速度曲线(上)和加速度曲线(下)对比。
本实施例中，本发明提供一种计算机可读存储介质，其上存储有计算机程序，所述程序被主控制器执行时实现上述中任一项所述的方法。
以上所述仅为本发明的优选实施方式而已，并不用于限制本发明，对于本领域的技术人员来说，本发明可以有各种更改和变化。凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (6)

1.一种基于初始加速度不为零的S型速度规划方法，其特征在于：具体按以下步骤执行：
S1:在工业机器人同向加速、同向减速、初末速度反向三种不同情况时进行速度规划；
S2:根据不同初末速度下中间速度对于总位移的影响，可分为以下情况：
初末速度都大于0，初始加速度大于0；
初末速度都大于0，初始加速度小于0；
初速度都大于0、末速度小于0，初始加速度大于0；
初速度都大于0、末速度小于0，初始加速度小于0；
初速度小于0、末速度大于0，初始加速度大于0；
初速度小于0、末速度大于0，初始加速度小于0；
初末速度都小于0，初始加速度大于0；
初末速度都小于0，初始加速度小于0；
S3：对工业机器人进行轨迹规划，具体根据上述分段方法找到可以达到的中间速度v_m，然后使用速度规划方法分别规划速度从v_s到v_m以及v_m到v_e两个过程的轨迹。
2.根据权利要求1所述的一种基于初始加速度不为零的S型速度规划方法，其特征在于，在步骤S1中，首先同向加速时，设|v_e|>|v_s|，根据a_s方向可分为：a_s方向与速度变化方向相同以及a_s方向与速度变化方向相反2种情况；
S1。1:a_s方向与速度变化方向相同时，首先计算a_s直接减到0的速度变化量deltaV1，根据deltaV1是否大于|v_e-v_s|分为以下两种情况：速度不会超过v_e或速度会超过v_e；
其中，速度不超过v_e，如果加速度能达到轮廓加速度accel时，轨迹分为：加速度从a_s到accel、按照accel匀加速、加速度从accel到0；如果加速度不能达到轮廓加速度accel时，首先计算实际可以达到的加速度：a_m＝sqrt((|v_e-v_s|+a_s^2/jerk/2)*jerk)；
如果速度超过v_e时，轨迹分为：a_s减为0，速度到达v1、速度从v1减速到v_e；如果加速度不能达到轮廓减速度decel时，首先计算可以达到的减速度：a_m＝-sqrt(|v_e-v1|)。
3.根据权利要求2所述的一种基于初始加速度不为零的S型速度规划方法，其特征在于,在工业机器人同向减速时；
初始速度v_s和结束速度v_e同向并且|v_e|<|v_s|，根据初始加速度a_s方向可分为以下2种情况：
S2.1：初始加速度方向与速度变化方向相同时；
首先计算a_s直接减到0的速度变化量deltaV1，根据deltaV1是否大于|v_e-v_s|和|v_s|分为以下3三种情况：速度不会超过v_e、速度会超过v_e但不会反向、速度会超过v_e且会反向；
其中速度不超过v_e，如果加速度能达到轮廓减速度decel时，轨迹分为：a_s加速到decel、以decel匀减速、加速度从decel到0；
如果加速度不能达到轮廓减速度decel时，首先计算实际可以达到的减速度：a_m＝-sqrt((|v_e-v_s|+a_s^2/jerk/2)*jerk)，此时速度会超过v_e但不会反向，轨迹分为：a_s减为0，速度到达v1、速度从v1加速到v_e；
如果加速度不能达到轮廓加速度accel时，首先计算可以达到的加速度：a_m＝-sqrt(|v_e-v1|)，此时速度会超过v_e且会反向，使用速度反向方法进行规划；
S2.2：初始加速度方向与速度变化方向相反；
轨迹分为：a_s减为0，速度到v1、v1加速到v_e，第二步若不能达到轮廓减速度decel，首先计算可达的减速度：a_m＝-sqrt(|v_e-v1|)。
4.根据权利要求3所述的一种基于初始加速度不为零的S型速度规划方法，其特征在于，在工业机器人初末速度反向时；当速度出现减速过零、反向加速时，加速度不为0，以此得到的轨迹为时间最优轨迹；首先计算加速度从a_s直接减到0的速度变化量deltaV1，根据deltaV1是否大于|v_e-v_s|分为：速度会超过v_e、速度不会超过v_e；
S4.1：当速度会超过v_e时，轨迹分为：a_s减到0，速度到达v1、v1加速到v_e，若不能达到轮廓减速度decel时，首先计算可达的减速度：a_m＝-sqrt(|v_e-v1|)；
S4.2：速度不会超过v_e时，根据初始加速度方向分为：初始加速度与速度变化方向相同、初始加速度与速度变化方向相反两种情况；
变化方向相同时，轨迹分为：v_s减到0、速度从0加速到v_e；
变化方向相反时，轨迹分为：a_s减到0，速度到v1、v1加速到v_e。
5.根据权利要求4所述的一种基于初始加速度不为零的S型速度规划方法，其特征在于，
S5.1:在工业机器人能达到正向轮廓速度v_p时，先用速度规划方法分别规划v_s到v_p以及v_p到v_e两个过程，如果总位移大于这两个过程位移之和则判定能达到轮廓速度v_p，此时整个轨迹可以分为以下三个阶段：
第一阶段从v_s到v_p，使用速度规划方法进行规划，总位移为S1；
第二阶段按照v_p匀速运动，位移S2＝S-S1-S3，时间T2＝S2/v_p；
第三阶段从v_p到v_e，使用速度规划方法进行规划，总位移为S3；
S5.2：在工业机器人能达到负向轮廓速度-v_p时，
先用速度规划方法规划从v_s直接减速或减速到v_e的位移S_fast，再用速度规划方法分别规划v_s到-v_p以及-v_p到v_e两个过程，如果总位移
(L＝|p_e-p_s|)小于S_fast并且小于这两个过程位移之和(L1+L2)则速度需要反向可以达到反向轮廓速度-v_p，此时整个轨迹可以分为以下三个阶段：
第一阶段从v_s到-v_p，使用速度规划方法进行规划，总位移为L1
第二阶段按照-v_p匀速运动，位移L2＝L1+L3-L，时间T2＝L2/v_p
第三阶段从-v_p到v_e，使用速度规划方法进行规划，总位移为L3
S5.3：在工业机器人不能达到轮廓速度时，此时，实际可以达到的速度使用二分插方法计算出。
6.一种计算机可读存储介质，其上存储有计算机程序，其特征在于，所述程序被主控制器执行时实现如权利要求1-5中任一项所述的方法。
CN202310046849.1A 2023-01-31 2023-01-31 一种基于初始加速度不为零的s型速度规划方法 Active CN115963782B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310046849.1A CN115963782B (zh) 2023-01-31 2023-01-31 一种基于初始加速度不为零的s型速度规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310046849.1A CN115963782B (zh) 2023-01-31 2023-01-31 一种基于初始加速度不为零的s型速度规划方法

Publications (2)

Publication Number Publication Date
CN115963782A true CN115963782A (zh) 2023-04-14
CN115963782B CN115963782B (zh) 2023-08-18

Family

ID=87358055

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310046849.1A Active CN115963782B (zh) 2023-01-31 2023-01-31 一种基于初始加速度不为零的s型速度规划方法

Country Status (1)

Country Link
CN (1) CN115963782B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116166061A (zh) * 2023-04-26 2023-05-26 中国农业大学 无人驾驶的速度控制方法、装置、无人驾驶机和电子设备

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102467109A (zh) * 2010-11-12 2012-05-23 上海微电子装备有限公司 高效精密运动轨迹规划实现方法
CN103135501A (zh) * 2013-02-01 2013-06-05 北京配天大富精密机械有限公司 基于s型曲线的加减速控制方法和装置及数控机床
US20160224018A1 (en) * 2015-01-29 2016-08-04 National Taiwan University Trajectory Planning System For Integrated Computer Numerical control (CNC) Machine, Trajectory Planning Device, Trajectory Planning method, And Computer Program Thereof
CN106354102A (zh) * 2016-10-18 2017-01-25 西平县朗玛数控设备有限公司 一种初加速度不为零的s型曲线速度控制方法
CN108279644A (zh) * 2018-02-02 2018-07-13 上海维宏电子科技股份有限公司 基于叠加指令的直线插补控制方法
CN109901518A (zh) * 2019-02-28 2019-06-18 清华大学 一种恒力约束条件下的数控机床加减速速度规划方法
CN109991934A (zh) * 2019-03-10 2019-07-09 天津大学 一种时间最优的在线s型加减速规划方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102467109A (zh) * 2010-11-12 2012-05-23 上海微电子装备有限公司 高效精密运动轨迹规划实现方法
CN103135501A (zh) * 2013-02-01 2013-06-05 北京配天大富精密机械有限公司 基于s型曲线的加减速控制方法和装置及数控机床
US20160224018A1 (en) * 2015-01-29 2016-08-04 National Taiwan University Trajectory Planning System For Integrated Computer Numerical control (CNC) Machine, Trajectory Planning Device, Trajectory Planning method, And Computer Program Thereof
CN106354102A (zh) * 2016-10-18 2017-01-25 西平县朗玛数控设备有限公司 一种初加速度不为零的s型曲线速度控制方法
CN108279644A (zh) * 2018-02-02 2018-07-13 上海维宏电子科技股份有限公司 基于叠加指令的直线插补控制方法
CN109901518A (zh) * 2019-02-28 2019-06-18 清华大学 一种恒力约束条件下的数控机床加减速速度规划方法
CN109991934A (zh) * 2019-03-10 2019-07-09 天津大学 一种时间最优的在线s型加减速规划方法

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116166061A (zh) * 2023-04-26 2023-05-26 中国农业大学 无人驾驶的速度控制方法、装置、无人驾驶机和电子设备

Also Published As

Publication number Publication date
CN115963782B (zh) 2023-08-18

Similar Documents

Publication Publication Date Title
JP3900789B2 (ja) モータの速度・加速度決定方法、加減速生成方法、加減速制御方法、加減速制御装置及びモータ制御装置
CN108958173B (zh) 基于梯形求解的任意位移速度下的s曲线加减速规划方法
US9678500B2 (en) Machining program creating device numerical control device, machining system, machining program creating method, numerical control method, and machining program
CN101477354B (zh) 位置s型指令产生方法
CN108319228B (zh) 一种数控系统轨迹规划中加减速控制方法
CN110879569B (zh) 一种前瞻控制方法
CN115963782B (zh) 一种基于初始加速度不为零的s型速度规划方法
CN112965443B (zh) 一种裁床拐角轨迹跟踪高精度插值控制方法
CN111158318B (zh) 一种非对称性四次曲线柔性加减速规划方法
CN105867376A (zh) 基于三角函数的工业机器人轨迹规划升降速控制方法
CN109901518B (zh) 一种恒力约束条件下的数控机床加减速速度规划方法
CN108829044B (zh) 一种应对始末速度出现负值的s曲线加减速规划方法
CN113311783A (zh) 一种s型运动曲线规划方法及系统
JP4627740B2 (ja) 数値制御装置
CN114995118A (zh) 一种抑制过冲和反向的跃度自适应s型速度曲线规划方法
CN110398993B (zh) 速度控制方法、装置及计算机可读存储介质
CN112363505B (zh) 一种基于目标距离的铰接式扫地车速度规划方法及系统
JP3204042B2 (ja) ロボットの軌道の生成装置
KR20200047123A (ko) 가상 공작 기계를 활용하여 가공 오차를 제한하는 수치 제어 장치
JP4407083B2 (ja) 指令値生成方法および指令値生成システム
JP2001216008A (ja) ロボット制御方法
JP5028674B2 (ja) 移動体の指令生成方法および指令生成装置
JP2000163114A (ja) 補間曲線内加減速処理方法
JP2002366208A (ja) 工作機械の自由曲線補間方法及び数値制御装置
JP4118538B2 (ja) 速度制御装置、速度制御方法およびその方法をコンピュータに実行させるプログラム

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant