CN108847807A - 电机的运动轨迹的规划方法、装置、设备以及存储介质 - Google Patents

电机的运动轨迹的规划方法、装置、设备以及存储介质 Download PDF

Info

Publication number
CN108847807A
CN108847807A CN201810691887.1A CN201810691887A CN108847807A CN 108847807 A CN108847807 A CN 108847807A CN 201810691887 A CN201810691887 A CN 201810691887A CN 108847807 A CN108847807 A CN 108847807A
Authority
CN
China
Prior art keywords
max
formula
kinematic parameter
acceleration
array
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
CN201810691887.1A
Other languages
English (en)
Other versions
CN108847807B (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.)
Guangzhou Shiyuan Electronics Thecnology Co Ltd
Original Assignee
Guangzhou Shiyuan Electronics Thecnology 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 Guangzhou Shiyuan Electronics Thecnology Co Ltd filed Critical Guangzhou Shiyuan Electronics Thecnology Co Ltd
Priority to CN201810691887.1A priority Critical patent/CN108847807B/zh
Publication of CN108847807A publication Critical patent/CN108847807A/zh
Application granted granted Critical
Publication of CN108847807B publication Critical patent/CN108847807B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P29/00—Arrangements for regulating or controlling electric motors, appropriate for both AC and DC motors
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06F—ELECTRIC DIGITAL DATA PROCESSING
    • G06F30/00—Computer-aided design [CAD]
    • G06F30/20—Design optimisation, verification or simulation

Landscapes

  • Engineering & Computer Science (AREA)
  • Theoretical Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Engineering & Computer Science (AREA)
  • Evolutionary Computation (AREA)
  • Geometry (AREA)
  • Computer Hardware Design (AREA)
  • General Physics & Mathematics (AREA)
  • Power Engineering (AREA)
  • Control Of Electric Motors In General (AREA)
  • Numerical Control (AREA)
  • Feedback Control In General (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

本申请提供电机的运动轨迹的规划方法、装置、设备以及存储介质，该方法包括：获取用于运动轨迹规划的运动参数；根据运动参数判断是否能够采用三段式规划方式进行运动轨迹的规划；若是，则根据运动参数，采用三段式规划方式进行运动轨迹规划，得到第一轨迹数组，否则，则根据运动参数，采用两段式规划方式进行运动轨迹规划，得到第二轨迹数组。在对电机的运动轨迹规划过程中通过判断开发人员输入的参数，自动判断使用两段式或者三段式规划方式进行运动轨迹规划，降低对设计人员的要求，简化调试过程。

Description

电机的运动轨迹的规划方法、装置、设备以及存储介质
技术领域
本申请实施例涉及机械自动化领域，尤其涉及一种电机的运动轨迹的规划方法、装置、设备以及存储介质。
背景技术
伺服驱动器(servo drives)又称为“伺服控制器”、“伺服放大器”，是用来控制伺服电机的一种控制器，其作用类似于变频器作用于普通交流马达，属于伺服***的一部分，主要应用于高精度的定位***。伺服驱动器是现代运动控制的重要组成部分，被广泛应用于工业机器人及数控加工中心等自动化设备中。
轮廓位置模式是伺服驱动器中一种基本的工作模式，其中S型曲线的轮廓位置有对机械冲击少，机械结构定位振动小与加速度连续等特点，是伺服驱动器中必备的重要功能之一。当前市场中大多伺服驱动器产品中的轮廓位置模式采用7段式或者3段式的规划曲线实现运动轨迹的规划，用户使用时需要对目标位置Stag，最大速度Vmax，最大加速度Accmax，最大减速度DAccmax，最大加加速度Jerkmax，最大减加速度DJerkmax进行设定，采样时间ts。
如果参数设定特别是Stag设定不满足7段式或者3段式曲线规划时，驱动器会返回参数设置的错误，而拒绝执行运动指令，这样对编程人员的理论计算水平要求较高，调试的过程也繁琐。
发明内容
本申请实施例提供一种电机的运动轨迹的规划方法、装置、设备以及存储介质，用于解决上述方案中参数设定特别是Stag设定不满足7段式或者3段式曲线规划时，驱动器会返回参数设置的错误，而拒绝执行运动指令，这样对编程人员的理论计算水平要求较高，调试的过程也繁琐的问题。
本申请第一方面提供一种电机的运动轨迹的规划方法，包括：
获取用于运动轨迹规划的运动参数；
根据所述运动参数判断是否能够采用三段式规划方式进行运动轨迹的规划；
若所述运动参数能够采用三段式规划方式，则根据所述运动参数，采用所述三段式规划方式进行运动轨迹规划，得到第一轨迹数组。
可选的，所述方法还包括：
若所述运动参数不能采用三段式规划方式，则根据所述运动参数，采用两段式规划方式进行运动轨迹规划，得到第二轨迹数组。
可选的，所述方法还包括：
获取用户选择的运动轨迹规划的约束方式：所述约束方式包括加速度约束或者加加速度约束。
可选的，若所述约束方式为加速度约束，则所述运动参数包括：目标位置、最大速度、最大加速度和最大减速度；
若所述约束方式为加加速度约束，则所述运动参数包括：目标位置、最大速度、最大加加速度和最大减加速度。
在一种具体实现方式中，若所述约束方式为加速度约束，则所述根据所述运动参数判断是否能够采用三段式规划方式进行运动轨迹的规划，包括：
根据目标位置Stag，最大速度Vmax，最大加速度Accmax以及最大减速度DAccmax，采用公式(1)计算得到t2；其中，
判断所述t2的值是否大于0；
若所述t2的值大于0，则所述运动参数能够采用三段式规划方式；
若所述t2的值小于或等于0，则所述运动参数不能采用三段式规划方式。
可选的，所述根据所述运动参数，采用所述三段式规划方式进行运动轨迹规划，得到第一轨迹数组，包括：
采用公式(2)：以及公式(3)：计算得到t1和t3；
计算t＝t1+t2+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts；
根据最大速度Vmax以及所述时间数组，采用公式(4)：
计算每个txi对应的S(t)的值，得到所述第一轨迹数组。
可选的，所述根据所述运动参数，采用两段式规划方式进行运动轨迹规划，得到第二轨迹数组，包括：
采用公式(2)：以及公式(3)：计算得到t1和t3；
计算t＝t1+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts；
根据目标位置Stag、最大速度Vmax、最大加速度Accmax以及最大减速度DAccmax以及所述时间数组，采用公式(5)：
计算每个txi对应的S(t)的值，得到所述第二轨迹数组；
其中，ω1_2与Vmax_x数值可通过公式(6)：以及公式(7)：计算得到，Acc1_2可通过公式(8)：Acc1_2＝min(Accmax,DAccmax)计算得到。
在另一种实现方式中，若所述约束方式为加加速度约束，则所述根据所述运动参数判断是否能够采用三段式规划方式进行运动轨迹的规划，包括：
根据目标位置Stag，最大速度Vmax，最大加加速度Jerkmax以及最大减加速度DJerkmax，采用公式(1)计算得到t2；其中，
判断所述t2的值是否大于0；
若所述t2的值大于0，则所述运动参数能够采用三段式规划方式；
若所述t2的值小于或等于0，则所述运动参数不能采用三段式规划方式。
可选的，所述根据所述运动参数，采用所述三段式规划方式进行运动轨迹规划，得到第一轨迹数组，包括：
采用公式(2)：以及公式(3)：计算得到t1和t3；
计算t＝t1+t2+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts；
根据最大速度Vmax以及所述时间数组，采用公式(4)：
计算每个txi对应的S(t)的值，得到所述第一轨迹数组。
可选的，所述根据所述运动参数，采用两段式规划方式进行运动轨迹规划，得到第二轨迹数组，包括：
采用公式(2)：以及公式(3)：计算得到t1和t3；
计算t＝t1+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts；
根据目标位置Stag、最大速度Vmax、最大加加速度Jerkmax以及最大减加速度DJerkmax以及所述时间数组，采用公式(5)：
计算每个txi对应的S(t)的值，得到所述第二轨迹数组；
其中，ω1_2与Vmax_x数值可通过公式(9)：以及公式(10)：计算得到，Jerk1_2通过公式(11)：Jerk1_2＝min(Jerkmax,Djerkmax)计算得到。
本申请第二方面提供一种电机的运动轨迹的规划装置，包括：
获取模块，用于获取用于运动轨迹规划的运动参数；
处理模块，用于根据所述运动参数判断是否能够采用三段式规划方式进行运动轨迹的规划；
若所述运动参数能够采用三段式规划方式，则所述处理模块还用于根据所述运动参数，采用所述三段式规划方式进行运动轨迹规划，得到第一轨迹数组。
可选的，所述处理模块还用于：
若所述运动参数不能采用三段式规划方式，则根据所述运动参数，采用两段式规划方式进行运动轨迹规划，得到第二轨迹数组。
可选的，所述获取模块还用于：
获取用户选择的运动轨迹规划的约束方式：所述约束方式包括加速度约束或者加加速度约束。
可选的，若所述约束方式为加速度约束，则所述运动参数包括：目标位置、最大速度、最大加速度和最大减速度；
若所述约束方式为加加速度约束，则所述运动参数包括：目标位置、最大速度、最大加加速度和最大减加速度。
在一种具体实现方式中，若所述约束方式为加速度约束，则所述处理模块具体用于：
根据目标位置Stag，最大速度Vmax，最大加速度Accmax以及最大减速度DAccmax，采用公式(1)计算得到t2；其中，
判断所述t2的值是否大于0；
若所述t2的值大于0，则所述运动参数能够采用三段式规划方式；
若所述t2的值小于或等于0，则所述运动参数不能采用三段式规划方式。
可选的，所述处理模块具体用于：
采用公式(2)：以及公式(3)：计算得到t1和t3；
计算t＝t1+t2+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts；
根据最大速度Vmax以及所述时间数组，采用公式(4)：
计算每个txi对应的S(t)的值，得到所述第一轨迹数组。
可选的，所述处理模块具体用于：
采用公式(2)：以及公式(3)：计算得到t1和t3；
计算t＝t1+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts；
根据目标位置Stag、最大速度Vmax、最大加速度Accmax以及最大减速度DAccmax以及所述时间数组，采用公式(5)：
计算每个txi对应的S(t)的值，得到所述第二轨迹数组；
其中，ω1_2与Vmax_x数值可通过公式(6)：以及公式(7)：计算得到，Acc1_2可通过公式(8)：Acc1_2＝min(Accmax,DAccmax)计算得到。
在另一种实现方式中，若所述约束方式为加加速度约束，则所述处理模块具体用于：
根据目标位置Stag，最大速度Vmax，最大加加速度Jerkmax以及最大减加速度DJerkmax，采用公式(1)计算得到t2；其中，
判断所述t2的值是否大于0；
若所述t2的值大于0，则所述运动参数能够采用三段式规划方式；
若所述t2的值小于或等于0，则所述运动参数不能采用三段式规划方式。
可选的，所述处理模块具体用于：
采用公式(2)：以及公式(3)：计算得到t1和t3；
计算t＝t1+t2+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts；
根据最大速度Vmax以及所述时间数组，采用公式(4)：
计算每个txi对应的S(t)的值，得到所述第一轨迹数组。
可选的，所述处理模块具体用于：
采用公式(2)：以及公式(3)：计算得到t1和t3；
计算t＝t1+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts；
根据目标位置Stag、最大速度Vmax、最大加加速度Jerkmax以及最大减加速度DJerkmax以及所述时间数组，采用公式(5)：
计算每个txi对应的S(t)的值，得到所述第二轨迹数组；
其中，ω1_2与Vmax_x数值可通过公式(9)：以及公式(10)：计算得到，Jerk1_2通过公式(11)：Jerk1_2＝min(Jerkmax,Djerkmax)计算得到。
本申请第三方面提供一种电子设备，包括：存储器和处理器；
所述存储器用于存储计算机指令；所述处理器用于运行所述存储器存储的所述计算机指令实现第一方面任一实现方式提供的电机的运动轨迹的规划方法。
本申请第四方面提供一种存储介质，包括：可读存储介质和计算机指令，所述计算机指令存储在所述可读存储介质中；所述计算机指令用于实现第一方面任一实现方式提供的电机的运动轨迹的规划方法。
本申请实施例提供的电机的运动轨迹的规划方法、装置、设备以及存储介质，通过获取用于运动轨迹规划的运动参数，根据运动参数判断是否能够采用三段式规划方式进行运动轨迹的规划，若是，则根据运动参数，采用三段式规划方式进行运动轨迹规划，得到第一轨迹数组，否则，则根据运动参数，采用两段式规划方式进行运动轨迹规划，得到第二轨迹数组。在对电机的运动轨迹规划过程中通过判断开发人员输入的参数，自动判断使用两段式或者三段式规划方式进行运动轨迹规划，降低对设计人员的要求，简化调试过程。
附图说明
为了更清楚地说明本申请实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作一简单地介绍，显而易见地，下面描述中的附图是本申请的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其它的附图。
图1为本发明实施例提供的位置时域波形图；
图2为本发明实施例提供的速度时域波形图；
图3为本申请实施例提供的电机的运动轨迹的规划方法的实施例一的流程图；
图4为本实施例提供的加速度约束、三段式规划结果示意图；
图5为本实施例提供的加速度约束、两段式规划结果示意图；
图6为本实施例提供的加加速度约束、三段式规划结果示意图；
图7为本实施例提供的加加速度约束、两段式规划结果示意图；
图8为本申请实施例提供的电机的运动轨迹的规划装置的实施例一的结构示意图。
具体实施方式
为使本申请实施例的目的、技术方案和优点更加清楚，下面将结合本申请实施例中的附图，对本申请实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本申请一部分实施例，而不是全部的实施例。基于本申请中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其它实施例，都属于本申请保护的范围。
针对背景技术中提及的，用户使用时需要对目标位置Stag，最大速度Vmax，最大加速度Accmax，最大减速度DAccmax，最大加加速度Jerkmax，最大减加速度进行设定DJerkmax，采样时间ts。如果参数设定特别是Stag设定不满足7段式或者3段式曲线规划时，驱动器会返回参数设置的错误，而拒绝执行运动指令，这样对编程人员的理论计算水平要求较高，调试的过程也繁琐的问题。本申请提供一种采用正余弦函数作为s曲线的形函数，采用3段式曲线形成s函数，在用户设定完目标位置Stag，最大速度Vmax与最大加速度Accmax等参数后，自动判断是否能进行三段式规划，如果不能实现，则采用2段式规划，该方案可以实现在用来做轨迹规划的电子设备中，可通过软件实现，方便编程人员，降低设计人员的理论水平要求，简化调试过程。
下面通过几个具体实现方式对本申请提供的电子的运动轨迹的规划方法进行详细说明。
图1为本发明实施例提供的位置时域波形图；图2为本发明实施例提供的速度时域波形图，分别示出了位置和速度的时域图。其中，
三段式速度形函数
三段式位置函数
图3为本申请实施例提供的电机的运动轨迹的规划方法的实施例一的流程图，如图3所示，该电机的运动轨迹的规划方法具体包括以下步骤：
S101：获取用于运动轨迹规划的运动参数。
在本步骤中，电子设备中安装可用来进行电机运动轨迹规划的软件，用户需要根据实际情况输入相关的运动参数以便进行后续的电机的控制。因此，在常见的实现方式中，该步骤中获取用于运动轨迹规划的运动参数的主要方式就是接收用户输入。
在该方案的一种具体的实现中，在接收输入的运动参数之前，用户还要根据实际情况选择进行运动轨迹规划的约束方式，该约束方式包括加速度约束或者加加速度约束，用户可自行选择，即对电子设备来说，仅需要获取用户的选择结果即可。
在该方案中，还应理解，当用户选择了采用加速度约束的方式进行电机的运动轨迹的规划，则至少需要输入的运动参数包括：目标位置、最大速度、最大加速度和最大减速度。当用户选择了采用加加速度约束的方式进行电机的运动轨迹的规划，则至少需要输入的运动参数包括：目标位置、最大速度、最大加加速度和最大减加速度。
S102：根据运动参数判断是否能够采用三段式规划方式进行运动轨迹的规划。
在本步骤中，电子设备获取到了用来进行电机的运动轨迹规划的参数之后，需要根据该参数自动判断能够进行三段式规划，如果采用的是加速度约束，则根据目标位置、最大速度、最大加速度和最大减速度计算出用于判断的参数，将该参数与预设的门限进行对比，确定后续规划过程中采用的规划方式是三段式规划还是两段式规划。同样的，如果采用的是加加速度约束，则根据目标位置、最大速度、最大加加速度和最大减加速度计算出用于判断的参数，将该参数与预设的门限进行对比，确定后续规划过程中采用的规划方式是三段式规划还是两段式规划。
S103：若运动参数能够采用三段式规划方式，则根据运动参数，采用三段式规划方式进行运动轨迹规划，得到第一轨迹数组。
S104：若运动参数不能采用三段式规划方式，则根据运动参数，采用两段式规划方式进行运动轨迹规划，得到第二轨迹数组。
在上述两个步骤中，如果电子设备自动判断的结果是用户输入的运动参数能够采用三段式规划，即满足三段式规划的约束条件，则直接按照该运动参数进行三段式规划得到控制该电机运动的运动轨迹对应的第一轨迹数组。
如果电子设备自动判断的结果是用户输入的运动参数不能够采用三段式规划，即满足两段式规划的约束条件，则直接按照该运动参数进行两段式规划得到控制该电机运动的运动轨迹对应的第二轨迹数组。
本实施例提供的电机的运动轨迹的规划方法，通过对用户输入的运动参数自动进行判断确定进行三段式规划还是两段式规划，不会犹豫设置人员输入的参数的问题，拒绝执行运动指令，降低对设计人员的要求，简化调试过程。
在上述实施例的基础上，下面通过具体的实现过程对该方案进行举例说明。
第一种实现方案：
安装在电子设备上，能够实现该功能的程序根据用户的操作启动，程序初始化，初始化变量，进行输入输出变量的内存分配之后，如果开发人员在选择约束方式时，选择了加速度约束方式，则用户输入的运动参数包括：目标位置Stag，最大速度Vmax，最大加速度Accmax，最大减速度DAccmax，采样时间ts，则该电机的运动轨迹的规划方法中的步骤S102的具体实现过程如下：
第一步，根据目标位置Stag，最大速度Vmax，最大加速度Accmax以及最大减速度DAccmax，采用公式(1)计算得到t2；其中，
第二步，判断所述t2的值是否大于0。
在该方案中，t2是三段式规划中的中间段(第二段)时间长度，单位一般为秒。
第三步，若所述t2的值大于0，则所述运动参数能够采用三段式规划方式。在该步骤中确定了t2的值大于0，则在后续的步骤S103中可以按照加速度约束，直接采用三段式的规划方案，对电机的运行轨迹进行规划，具体包括以下过程：
(一)、采用公式(2)：计算得到t1，并采用公式(3)：计算得到t3。
(二)、计算t＝t1+t2+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts；
(三)、根据最大速度Vmax以及所述时间数组，采用公式(4)：
计算每个txi对应的S(t)的值，得到所述第一轨迹数组。
其中，除了用户输入的最大速度Vmax之外，公式(4)中需要的t1、t2以及ω1，ω2已经在前述的过程中计算得到，可以直接带入该公式计算，每个txi可以计算得到一个S(t)值，这样在计算完成后会得到每个时间点对应的S(t)，即形成一个数组，在电机根据该第一轨迹数组进行运行的时候，形成三段式的运动轨迹。最后将该第一轨迹数组输出，完成对电机的运行轨迹规划。
假设在用户选择了加速度约束，输入的运动参数为：参数Stag＝200m，最大速度Vmax＝10m/s，最大加速度Accmax＝3m/s2，最大减速度DAccmax＝3m/s2，ts＝0.001s。经过自动判断该些运动参数满足三段式规划方案的一种具体实现中，图4为本实施例提供的加速度约束、三段式规划结果示意图，如图4所示，(a)、(b)、(c)、(d)分别示出了运行上述方案的第一轨迹数据得到的位置在曲线、速度曲线、加速度曲线以及加加速度曲线。
第四步，若所述t2的值小于或等于0，则所述运动参数不能采用三段式规划方式。在该步骤中确定了t2的值不大于0，则在后续的步骤S103中可以按照加速度约束，直接采用二段式的规划方案，对电机的运行轨迹进行规划，具体包括以下过程：
(一)、采用公式(2)：计算得到t1，并采用公式(3)：计算得到t3。
(二)、计算t＝t1+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts。
(三)、根据目标位置Stag、最大速度Vmax、最大加速度Accmax以及最大减速度DAccmax以及所述时间数组，采用公式(5)：
计算每个txi对应的S(t)的值，得到所述第二轨迹数组；
其中，除了用户输入的最大速度Vmax之外，ω1_2与Vmax_x数值可通过公式(6)：以及公式(7)：计算得到，Acc1_2可通过公式(8)：Acc1_2＝min(Accmax,DAccmax)计算得到。每个txi可以计算得到一个S(t)值，这样在计算完成后会得到每个时间点对应的S(t)，即形成一个数组，在电机根据该第二轨迹数组进行运行的时候，形成两段式的运动轨迹。最后将该第二轨迹数组输出，完成对电机的运行轨迹规划。
假设在用户选择了加速度约束，输入的运动参数为：参数Stag＝6m，最大速度Vmax＝10m/s，最大加速度Accmax＝3m/s2，最大减速度DAccmax＝3m/s2，ts＝0.001s。经过自动判断该些运动参数不满足三段式规划方案的一种具体实现中，图5为本实施例提供的加速度约束、两段式规划结果示意图，如图5所示，(a)、(b)、(c)、(d)分别示出了运行上述方案的第二轨迹数据得到的位置在曲线、速度曲线、加速度曲线以及加加速度曲线。
第二种实现方案：
安装在电子设备上，能够实现该功能的程序根据用户的操作启动，程序初始化，初始化变量，进行输入输出变量的内存分配之后，如果开发人员在选择约束方式时，选择了加加速度约束方式，则用户输入的运动参数包括：目标位置Stag，最大速度Vmax，最大加加速度Jerkmax，最大减速度DJerkmax，采样时间ts，则该电机的运动轨迹的规划方法中的步骤S102的具体实现过程如下：
第一步，根据目标位置Stag，最大速度Vmax，最大加加速度Jerkmax以及最大减加速度DJerkmax，采用公式(1)计算得到t2；其中，
第二步，判断所述t2的值是否大于0。
第三步，若所述t2的值大于0，则所述运动参数能够采用三段式规划方式。在该步骤中确定了t2的值大于0，则在后续的步骤S103中可以按照加加速度约束，直接采用三段式的规划方案，对电机的运行轨迹进行规划，具体包括以下过程：
(一)、采用公式(2)：以及公式(3)：计算得到t1和t3。
(三)、计算t＝t1+t2+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts。
(四)、根据最大速度Vmax以及所述时间数组，采用公式(4)：
计算每个txi对应的S(t)的值，得到所述第一轨迹数组。
除了用户输入的最大速度Vmax之外，公式(4)中需要的t1、t2以及ω1，ω2已经在前述的过程中计算得到，可以直接带入该公式计算，每个txi可以计算得到一个S(t)值，这样在计算完成后会得到每个时间点对应的S(t)，即形成一个数组，在电机根据该第一轨迹数组进行运行的时候，形成三段式的运动轨迹。最后将该第一轨迹数组输出，完成对电机的运行轨迹规划。
假设在用户选择了加加速度约束，输入的运动参数为：参数Stag＝200m，最大速度Vmax＝10m/s，最大加速度Jerkmax＝3m/s2，最大减速度DJerkmax＝3m/s2，ts＝0.001s。经过自动判断该些运动参数满足三段式规划方案的一种具体实现中，图6为本实施例提供的加加速度约束、三段式规划结果示意图，如图6所示，(a)、(b)、(c)、(d)分别示出了运行上述方案的第一轨迹数据得到的位置在曲线、速度曲线、加速度曲线以及加加速度曲线。
第四步，若所述t2的值小于或等于0，则所述运动参数不能采用三段式规划方式。在该步骤中确定了t2的值不大于0，则在后续的步骤S103中可以按照加加速度约束，直接采用二段式的规划方案，对电机的运行轨迹进行规划，具体包括以下过程：
(一)、采用公式(2)：以及公式(3)：计算得到t1和t3。
(二)、计算t＝t1+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts。
(三)、根据目标位置Stag、最大速度Vmax、最大加加速度Jerkmax以及最大减加速度DJerkmax以及所述时间数组，采用公式(5)：
计算每个txi对应的S(t)的值，得到所述第二轨迹数组。
其中，ω1_2与Vmax_x数值可通过公式(9)：以及公式(10)：计算得到，Jerk1_2通过公式(11)：Jerk1_2＝min(Jerkmax,Djerkmax)计算得到。每个txi可以计算得到一个S(t)值，这样在计算完成后会得到每个时间点对应的S(t)，即形成一个数组，在电机根据该第二轨迹数组进行运行的时候，形成两段式的运动轨迹。最后将该第二轨迹数组输出，完成对电机的运行轨迹规划。
假设在用户选择了加加速度约束，输入的运动参数为：参数Stag＝20m，最大速度Vmax＝10m/s，最大加速度Jerkmax＝3m/s2，最大减速度DJerkmax＝3m/s2，ts＝0.001s。经过自动判断该些运动参数不满足三段式规划方案的一种具体实现中，图7为本实施例提供的加加速度约束、两段式规划结果示意图，如图7所示，(a)、(b)、(c)、(d)分别示出了运行上述方案的第二轨迹数据得到的位置在曲线、速度曲线、加速度曲线以及加加速度曲线。
上述实现方式提供的方案中，在用户设定完目标位置Stag，最大速度Vmax与最大加速度Accmax等参数后，算法自动判别2/3段规划，即自动判断是否能进行三段式规划，如果不能实现，则采用2段式规划，可实现加速度与加加速度两种约束下进行位置s曲线规划，方便编程人员，降低设计人员的理论水平要求，简化调试过程。
图8为本申请实施例提供的电机的运动轨迹的规划装置的实施例一的结构示意图，如图8所示，该电机的运动轨迹的规划装置10，包括：
获取模块11，用于获取用于运动轨迹规划的运动参数；
处理模块12，用于根据所述运动参数判断是否能够采用三段式规划方式进行运动轨迹的规划；
若所述运动参数能够采用三段式规划方式，则所述处理模块12还用于根据所述运动参数，采用所述三段式规划方式进行运动轨迹规划，得到第一轨迹数组。
可选的，所述处理模块12还用于：
若所述运动参数不能采用三段式规划方式，则根据所述运动参数，采用两段式规划方式进行运动轨迹规划，得到第二轨迹数组。
可选的，所述获取模块11还用于：
获取用户选择的运动轨迹规划的约束方式：所述约束方式包括加速度约束或者加加速度约束。
可选的，若所述约束方式为加速度约束，则所述运动参数包括：目标位置、最大速度、最大加速度和最大减速度；
若所述约束方式为加加速度约束，则所述运动参数包括：目标位置、最大速度、最大加加速度和最大减加速度。
在一种具体实现方式中，若所述约束方式为加速度约束，则所述处理模块12具体用于：
根据目标位置Stag，最大速度Vmax，最大加速度Accmax以及最大减速度DAccmax，采用公式(1)计算得到t2；其中，
判断所述t2的值是否大于0；
若所述t2的值大于0，则所述运动参数能够采用三段式规划方式；
若所述t2的值小于或等于0，则所述运动参数不能采用三段式规划方式。
可选的，所述处理模块12具体用于：
采用公式(2)：以及公式(3)：计算得到t1和t3；
计算t＝t1+t2+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts；
根据最大速度Vmax以及所述时间数组，采用公式(4)：
计算每个txi对应的S(t)的值，得到所述第一轨迹数组。
可选的，所述处理模块12具体用于：
采用公式(2)：以及公式(3)：计算得到t1和t3；
计算t＝t1+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts；
根据目标位置Stag、最大速度Vmax、最大加速度Accmax以及最大减速度DAccmax以及所述时间数组，采用公式(5)：
计算每个txi对应的S(t)的值，得到所述第二轨迹数组；
其中，ω1_2与Vmax_x数值可通过公式(6)：以及公式(7)：计算得到，Acc1_2可通过公式(8)：Acc1_2＝min(Accmax,DAccmax)计算得到。
在另一种实现方式中，若所述约束方式为加加速度约束，则所述处理模块12具体用于：
根据目标位置Stag，最大速度Vmax，最大加加速度Jerkmax以及最大减加速度DJerkmax，采用公式(1)计算得到t2；其中，
判断所述t2的值是否大于0；
若所述t2的值大于0，则所述运动参数能够采用三段式规划方式；
若所述t2的值小于或等于0，则所述运动参数不能采用三段式规划方式。
可选的，所述处理模块12具体用于：
采用公式(2)：以及公式(3)：计算得到t1和t3；
计算t＝t1+t2+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts；
根据最大速度Vmax以及所述时间数组，采用公式(4)：
计算每个txi对应的S(t)的值，得到所述第一轨迹数组。
可选的，所述处理模块12具体用于：
采用公式(2)：以及公式(3)：计算得到t1和t3；
计算t＝t1+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts；
根据目标位置Stag、最大速度Vmax、最大加加速度Jerkmax以及最大减加速度DJerkmax以及所述时间数组，采用公式(5)：
计算每个txi对应的S(t)的值，得到所述第二轨迹数组；
其中，ω1_2与Vmax_x数值可通过公式(9)：以及公式(10)：计算得到，Jerk1_2通过公式(11)：Jerk1_2＝min(Jerkmax,Djerkmax)计算得到。
上述任一实施例提供的电机的运动轨迹的规划装置，用于实现前述任一方法实施例的技术方案，其实现原理和技术效果类似，在此不再赘述。
本申请还提供一种电子设备，包括：存储器和处理器；
所述存储器用于存储计算机指令；所述处理器用于运行所述存储器存储的所述计算机指令实现前述任一实施例提供的电机的运动轨迹的规划方法。
本申请还提供一种存储介质，包括：可读存储介质和计算机指令，所述计算机指令存储在所述可读存储介质中；所述计算机指令用于实现前述任一实施例提供的电机的运动轨迹的规划方法。
在上述电子设备的具体实现中，应理解，处理器可以是中央处理单元(英文：Central Processing Unit，简称：CPU)，还可以是其他通用处理器、数字信号处理器(英文：Digital Signal Processor，简称：DSP)、专用集成电路(英文：Application SpecificIntegrated Circuit，简称：ASIC)等。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。结合本申请实施例所公开的方法的步骤可以直接体现为硬件处理器执行完成，或者用处理器中的硬件及软件模块组合执行完成。
本领域普通技术人员可以理解：实现上述各方法实施例的全部或部分步骤可以通过程序指令相关的硬件来完成。前述的程序可以存储于一计算机可读取存储介质中。该程序在执行时，执行包括上述各方法实施例的步骤；而前述的存储介质包括：只读存储器(英文：read-only memory，缩写：ROM)、RAM、快闪存储器、硬盘、固态硬盘、磁带(英文：magnetictape)、软盘(英文：floppy disk)、光盘(英文：optical disc)及其任意组合。
最后应说明的是：以上各实施例仅用以说明本申请的技术方案，而非对其限制；尽管参照前述各实施例对本申请进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分或者全部技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本申请各实施例技术方案的范围。

Claims (13)

1.一种电机的运动轨迹的规划方法，其特征在于，包括：
获取用于运动轨迹规划的运动参数；
根据所述运动参数判断是否能够采用三段式规划方式进行运动轨迹的规划；
若所述运动参数能够采用三段式规划方式，则根据所述运动参数，采用所述三段式规划方式进行运动轨迹规划，得到第一轨迹数组。
2.根据权利要求1所述的方法，其特征在于，所述方法还包括：
若所述运动参数不能采用三段式规划方式，则根据所述运动参数，采用两段式规划方式进行运动轨迹规划，得到第二轨迹数组。
3.根据权利要求1或2所述的方法，其特征在于，所述方法还包括：
获取用户选择的运动轨迹规划的约束方式：所述约束方式包括加速度约束或者加加速度约束。
4.根据权利要求3所述的方法，其特征在于，若所述约束方式为加速度约束，则所述运动参数包括：目标位置、最大速度、最大加速度和最大减速度；
若所述约束方式为加加速度约束，则所述运动参数包括：目标位置、最大速度、最大加加速度和最大减加速度。
5.根据权利要求4所述的方法，其特征在于，若所述约束方式为加速度约束，则所述根据所述运动参数判断是否能够采用三段式规划方式进行运动轨迹的规划，包括：
根据目标位置Stag，最大速度Vmax，最大加速度Accmax以及最大减速度DAccmax，采用公式(1)计算得到t2；其中，
判断所述t2的值是否大于0；
若所述t2的值大于0，则所述运动参数能够采用三段式规划方式；
若所述t2的值小于或等于0，则所述运动参数不能采用三段式规划方式。
6.根据权利要求5所述的方法，其特征在于，所述根据所述运动参数，采用所述三段式规划方式进行运动轨迹规划，得到第一轨迹数组，包括：
采用公式(2)：以及公式(3)：计算得到t1和t3；
计算t＝t1+t2+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts；
根据最大速度Vmax以及所述时间数组，采用公式(4)：
计算每个txi对应的S(t)的值，得到所述第一轨迹数组。
7.根据权利要求5所述的方法，其特征在于，所述根据所述运动参数，采用两段式规划方式进行运动轨迹规划，得到第二轨迹数组，包括：
采用公式(2)：以及公式(3)：计算得到t1和t3；
计算t＝t1+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts；
根据目标位置Stag、最大速度Vmax、最大加速度Accmax以及最大减速度DAccmax以及所述时间数组，采用公式(5)：
计算每个txi对应的S(t)的值，得到所述第二轨迹数组；
其中，ω1_2与Vmax_x数值可通过公式(6)：以及公式(7)：计算得到，Acc1_2可通过公式(8)：Acc1_2＝min(Accmax,DAccmax)计算得到。
8.根据权利要求4所述的方法，其特征在于，若所述约束方式为加加速度约束，则所述根据所述运动参数判断是否能够采用三段式规划方式进行运动轨迹的规划，包括：
根据目标位置Stag，最大速度Vmax，最大加加速度Jerkmax以及最大减加速度DJerkmax，采用公式(1)计算得到t2；其中，
判断所述t2的值是否大于0；
若所述t2的值大于0，则所述运动参数能够采用三段式规划方式；
若所述t2的值小于或等于0，则所述运动参数不能采用三段式规划方式。
9.根据权利要求8所述的方法，其特征在于，所述根据所述运动参数，采用所述三段式规划方式进行运动轨迹规划，得到第一轨迹数组，包括：
采用公式(2)：以及公式(3)：计算得到t1和t3；
计算t＝t1+t2+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts；
根据最大速度Vmax以及所述时间数组，采用公式(4)：
计算每个txi对应的S(t)的值，得到所述第一轨迹数组。
10.根据权利要求8所述的方法，其特征在于，所述根据所述运动参数，采用两段式规划方式进行运动轨迹规划，得到第二轨迹数组，包括：
采用公式(2)：以及公式(3)：计算得到t1和t3；
计算t＝t1+t3，并根据采样时间ts将t进行等分并形成时间数组：tx[i]＝[tx1,tx2,tx3,…,txn],i＝1,2,3,…,n，且txi+1-txi＝ts；
根据目标位置Stag、最大速度Vmax、最大加加速度Jerkmax以及最大减加速度DJerkmax以及所述时间数组，采用公式(5)：
计算每个txi对应的S(t)的值，得到所述第二轨迹数组；
其中，ω1_2与Vmax_x数值可通过公式(9)：以及公式(10)：计算得到，Jerk1_2通过公式(11)：Jerk1_2＝min(Jerkmax,Djerkmax)计算得到。
11.一种电机的运动轨迹的规划装置，其特征在于，包括：
获取模块，用于获取用于运动轨迹规划的运动参数；
处理模块，用于根据所述运动参数判断是否能够采用三段式规划方式进行运动轨迹的规划；
若所述运动参数能够采用三段式规划方式，则所述处理模块还用于根据所述运动参数，采用所述三段式规划方式进行运动轨迹规划，得到第一轨迹数组。
12.一种电子设备，其特征在于，存储器和处理器；
所述存储器用于存储计算机指令；所述处理器用于运行所述存储器存储的所述计算机指令实现权利要求1至10任一项所述的电机的运动轨迹的规划方法。
13.一种存储介质，其特征在于，包括：可读存储介质和计算机指令，所述计算机指令存储在所述可读存储介质中；所述计算机指令用于实现权利要求1至10任一项所述的电机的运动轨迹的规划方法。
CN201810691887.1A 2018-06-28 2018-06-28 电机的运动轨迹的规划方法、装置、设备以及存储介质 Active CN108847807B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810691887.1A CN108847807B (zh) 2018-06-28 2018-06-28 电机的运动轨迹的规划方法、装置、设备以及存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810691887.1A CN108847807B (zh) 2018-06-28 2018-06-28 电机的运动轨迹的规划方法、装置、设备以及存储介质

Publications (2)

Publication Number Publication Date
CN108847807A true CN108847807A (zh) 2018-11-20
CN108847807B CN108847807B (zh) 2021-03-05

Family

ID=64201469

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810691887.1A Active CN108847807B (zh) 2018-06-28 2018-06-28 电机的运动轨迹的规划方法、装置、设备以及存储介质

Country Status (1)

Country Link
CN (1) CN108847807B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110504885A (zh) * 2019-09-18 2019-11-26 哈尔滨工业大学 一种适用于pmsm伺服***的快速响应高精度位置控制方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101508113A (zh) * 2009-03-11 2009-08-19 哈尔滨工业大学 一种基于余弦二阶的机器人轨迹规划方法
CN105717864A (zh) * 2016-03-16 2016-06-29 四川大学 基于修改nc程序的数控机床综合误差三阶优化补偿方法
EP3043523A1 (en) * 2013-02-21 2016-07-13 Fujitsu Limited Switch and switch system
CN106168790A (zh) * 2016-02-29 2016-11-30 华南理工大学 一种在线改变目标速度和位置的s形加减速控制方法
CN107030697A (zh) * 2017-04-28 2017-08-11 广州大学 一种机器人笛卡尔空间平滑轨迹的规划方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101508113A (zh) * 2009-03-11 2009-08-19 哈尔滨工业大学 一种基于余弦二阶的机器人轨迹规划方法
EP3043523A1 (en) * 2013-02-21 2016-07-13 Fujitsu Limited Switch and switch system
CN106168790A (zh) * 2016-02-29 2016-11-30 华南理工大学 一种在线改变目标速度和位置的s形加减速控制方法
CN105717864A (zh) * 2016-03-16 2016-06-29 四川大学 基于修改nc程序的数控机床综合误差三阶优化补偿方法
CN107030697A (zh) * 2017-04-28 2017-08-11 广州大学 一种机器人笛卡尔空间平滑轨迹的规划方法

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110504885A (zh) * 2019-09-18 2019-11-26 哈尔滨工业大学 一种适用于pmsm伺服***的快速响应高精度位置控制方法
CN110504885B (zh) * 2019-09-18 2020-11-13 哈尔滨工业大学 一种适用于pmsm伺服***的快速响应高精度位置控制方法

Also Published As

Publication number Publication date
CN108847807B (zh) 2021-03-05

Similar Documents

Publication Publication Date Title
CN110316193B (zh) 预瞄距离的设置方法、装置、设备及计算机可读存储介质
WO2017113069A1 (zh) S型曲线规划方法、装置及数控机床
US8175725B2 (en) Adapting move constraints for position based moves in a trajectory generator
CN112595337B (zh) 避障路径规划方法、装置、电子装置、车辆及存储介质
CN107710084B (zh) 一种加工路径规划方法、加工路径规划装置及数控机床
CN109827586B (zh) 自动驾驶车辆速度规划方法、装置和设备
CN110874082B (zh) 工件拐角的切割路径确定方法、设备和存储介质
CN110341710B (zh) 一种自适应巡航控制方法、装置及设备
CN109655076B (zh) 车辆转弯的速度规划方法、装置和存储介质
WO2015083513A1 (en) Method for controlling an operation of a laser processing machine and controller for controlling an operation of a first actuator of a laser processing machine
CN109814568B (zh) 无人车速度轨迹的生成方法、装置和存储介质
CN105589407A (zh) 工业用机器人的程序修正装置和程序修正方法
WO2018042704A1 (ja) 指令値生成装置
CN108847807A (zh) 电机的运动轨迹的规划方法、装置、设备以及存储介质
CN113110423A (zh) 步态轨迹规划方法、装置、计算机可读存储介质及机器人
CN114063568B (zh) 基于三次卷积插值实现数控***倍率调整控制的方法、装置、处理器及计算机可读存储介质
CN113021329B (zh) 一种机器人运动控制方法、装置、可读存储介质及机器人
JP2011203936A (ja) 特徴点抽出装置及びこれを用いた動作教示装置、動作処理装置
US6678575B1 (en) Method and system for generating numerically controlled tool paths on a solid model
EP4019899B1 (en) Method and apparatus for creating driving route of autonomous vehicle and computer program therefor
CN114384908B (zh) 一种用于轨道机器人的智能导航路径规划***及方法
CN112711252B (zh) 移动机器人及其路径跟踪方法、计算机可读存储介质
JPH09330413A (ja) 血管追跡処理方法
JP2966076B2 (ja) 学習装置の自己学習方法
CN113703433A (zh) 机器人运动轨迹的速度规划方法及装置

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