CN113524181B - 在线速度调整方法、设备、单元、机器人及存储介质 - Google Patents
在线速度调整方法、设备、单元、机器人及存储介质 Download PDFInfo
- Publication number
- CN113524181B CN113524181B CN202110780599.5A CN202110780599A CN113524181B CN 113524181 B CN113524181 B CN 113524181B CN 202110780599 A CN202110780599 A CN 202110780599A CN 113524181 B CN113524181 B CN 113524181B
- Authority
- CN
- China
- Prior art keywords
- motion
- curve
- time
- segment
- speed
- 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.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1651—Programme controls characterised by the control loop acceleration, rate control
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
Abstract
本申请公开了一种在线速度调整方法、设备、单元、机器人及存储介质,涉及速度控制技术领域,方法包括获取当前时刻下实测的第一运动系数以及规划的第二运动系数;根据第一运动系数进行曲线重规划;根据第二运动系数、第一运动曲线,选取第一时刻;并将通过五阶多项式得到从当前时刻到第一时刻的目标线段;通过约束参数校验目标线段的合法性,若目标线段不合法则重新确定第一时刻以重新规划过渡曲线;否则将目标线段作为过渡曲线,并根据过渡曲线、第一运动曲线得到速度调整曲线,以进行调整机器人的第三运动系数。通过本申请的方案进行速度调控可以保证整个运动过程其速度调整是平滑过渡的,保证运动的完整性同时用于调整的速度计算更加简单。
Description
技术领域
本发明涉及速度控制技术领域,特别是涉及一种在线速度调整方法、设备、单元及存储介质。
背景技术
机器人实际应用过程中,机器人的运动轨迹,如S型曲线,会被划分为多个运动段,每个运动段为规律性变化,因此,通常通过调整机器人的robot speed(运动系数)来控制机器人的轨迹行走,但是,robot speed在机器人运动一段轨迹后会发生变化。这就需要及时调整运动系数,为使机器人在接下来的运动中,保证原始的运动轨迹不变,会在当前时刻点进行加速度不为0的曲线规划,但是,这种方式会破坏机器人运动的整体性,其速度变化轨迹会陡变。
发明内容
本申请旨在至少解决相关技术中存在的技术问题之一。为此,提出一种在线速度调整方法、设备、单元、机器人及存储介质,可以保证运动的整体性。
根据本申请第一方面实施例的在线速度调整方法,方法包括:
获取机器人在当前时刻的第一运动系数以及规划的第二运动系数;
若所述第一运动系数不等于所述第二运动系数,则根据所述第一运动系数、所述第二运动系数,得到速度调整曲线;
其中,所述根据所述第一运动系数、所述第二运动系数,得到速度调整曲线,包括:
根据所述第一运动系数进行曲线重规划,得到第一运动曲线;
根据所述第二运动系数、所述第一运动曲线,选取第一时刻作为待规划的过渡曲线的结束时刻;
根据所述机器人在所述第一时刻的第一运动参数、当前时刻的第二运动参数,通过五阶多项式得到从当前时刻到所述第一时刻的目标线段;
获取约束参数;
通过所述约束参数校验所述目标线段的合法性,若所述目标线段合法,则将所述目标线段作为过渡曲线,并根据所述过渡曲线、所述第一运动曲线得到速度调整曲线;其中所述速度调整曲线用于调整机器人的速度;
若所述目标线段不合法,则重新确定所述第一时刻以重新规划得到所述过渡曲线。
根据本申请第二方面实施例的速度调整的设备,包括:
至少一个处理器,以及与所述至少一个处理器通信连接的存储器;其中,所述存储器存储有指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器执行所述指令时实现如第一方面任一所述的在线速度调整方法。
根据本申请第三方面实施例的速度调整单元,包括:
参数获取模块,所述参数获取模块用于获取规划的第二运动系数、当前时刻的第一运动系数、约束参数;
规划模块,所述规划模块用于根据所述第二运动系数、所述第一运动系数进行五阶多项式规划得到目标线段,根据所述约束参数校验所述目标线段的合法性,将合法的所述目标线段设置为过渡曲线,若所述目标线段不合法,则重新规划得到合法的所述目标线段作为所述过渡曲线;根据所述第一运动系数、所述过渡曲线得到速度调整曲线。
根据本申请第四方面实施例的机器人,包括:
调速模块,所述调速模块用于执行如第一方面任一所述的在线速度调整方法,得到速度调整曲线;
控制器,所述控制器用于根据所述速度调整曲线调整行走的速度参数。
根据本申请第五方面实施例的一种存储介质,包括存储有计算机可执行指令,所述计算机可执行指令用于执行如第一方面任一项所述的在线速度调整方法。
根据本申请的上述实施例,至少具有如下有益效果:通过第一运动系数重新规划得到的加速度为0的第一运动曲线,相对于加速度不为0的曲线规划更为简单。同时,通过五阶多项式得到过渡曲线,再利用五阶多项式得到过渡曲线的速度变化具有平滑性的特点,使得从初始规划的曲线到过渡曲线到重规划的第一曲线的整个过程是平滑的,不会破坏运动的整体性。因此,通过本申请的方案进行速度调控可以保证整个运动过程其速度调整是平滑过渡的,保证运动的完整性的同时用于调整的速度计算更加简单。
本申请的其它特征和优点将在随后的说明书中阐述,并且,部分地从说明书中变得显而易见,或者通过实施本申请而了解。本申请的目的和其他优点可通过在说明书、权利要求书以及附图中所特别指出的结构来实现和获得。
附图说明
本申请的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1为本申请实施例的一种速度调整单元的示意图;
图2为本申请实施例的一种机器人的示意图;
图3为本申请实施例的一种在线速度调整方法的流程示意图;
图4为本申请实施例的在线速度调整方法的步骤S220的流程示意图;
图5为本申请实施例的在线速度调整方法的步骤S230的流程示意图;
图6为本申请实施例的在线速度调整方法的步骤S250的流程示意图;
图7为本申请实施例的在线速度调整方法的步骤S254的流程示意图;
图8为本申请实施例的在线速度调整方法的重规划第一运动曲线的流程示意图;
图9为本申请实施例的在线速度调整方法的第一时刻重确定的流程示意图;
图10为本申请实施例的在线速度调整方法的步骤S240的流程示意图。
具体实施方式
下面详细描述本申请的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,仅用于解释本申请,而不能理解为对本申请的限制。
在本申请的描述中,如果有描述到第一、第二只是用于区分技术特征为目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量或者隐含指明所指示的技术特征的先后关系。
实际应用过程中,对于既定轨迹的行使,通常会规划出一条运动曲线,然后沿既定的运动曲线进行速度控制,但是实际应用中,通常会出现实际的行走速度与规划的速度不符,因此需要重新规划行走的运动曲线,以避免沿原始的运动曲线进行速度控制出现超调或者速度陡变。示例性的,对于S型的运动曲线,可将其运动曲线通常会分为加加速段,匀加速段,加减速段,匀速段,加减速段,匀减速段,减减速段多个运动段;其中每个阶段的加速度、加加速度、速度等均呈阶段性的规律变化。因此,对于此类分为多运动段的运动曲线,对于每一运动段,通常通过修改对应运动段的运动系数k进行速度控制。以其中一个运动段为例,其可以通过如下公式表示:
s'=s (1)
v'=vm×k (2)
a'=am×k2 (3)
j'=jm×k3 (4)
其中,s、vm、am、jm分别表示运动曲线的最大位移、最大速度、最大加速度以及最大加速度;s'、v'、a'、j'表示对应运动段的最大位移、最大速度、最大加速度以及最大加速度。当速度发生改变后,如采用当前的加速度进行重新规划,会破坏运动的整体性,且计算极为复杂。基于此,本申请提供一种在线速度调整方法、设备、装置及存储介质,可以缩短当前运动段的速度过渡调整时间,实现更高效率的速度调整。
如图1所示,本申请提供一种速度调整单元,包括:
参数获取模块110,参数获取模块110用于获取规划的第二运动系数、当前时刻的第一运动系数、约束参数;
规划模块120,规划模块120用于根据第二运动系数、第一运动系数进行五阶多项式规划得到目标线段,根据约束参数校验目标线段的合法性,将合法的目标线段设置为过渡曲线,若目标线段不合法,则重新规划得到合法的目标线段作为过渡曲线;根据第一运动系数、过渡曲线得到速度调整曲线。
其中,规划模块120与参数获取模块110电连接,速度调整单元可以为一单独的设备,也可以为一独立的芯片或模块。第一运动系数为实时检测的。在一些实施例中,如图1所示,速度调整单元还包括检测模块130,检测模块130用于实时检测第一运动系数即当前时刻的k'。在另一些实施例中,可以通过其他设备或装置将检测得到的第一运动系数发送给参数获取模块110。
其中,速度调整曲线包括过渡曲线以及新规划的第一运动曲线,第一运动曲线为起始速度为0、加速度为0的S型曲线。调整时,先根据过渡曲线进行速度调整直至运动至过渡曲线与第一运动曲线的衔接处的时间点,然后根据第一运动曲线进行当前时刻的速度调整。需说明的是,当在根据第一运动曲线进行调整的过程中再次出现速度偏差时,可以以第一运动曲线为初始规划曲线,重新进行过渡曲线以及新的第一运动曲线的规划。
本领域技术人员可以理解的是,图1中示出的速度调整单元并不构成对本申请实施例的限定,可以包括比图示更多或更少的部件,或者组合某些部件,或者不同的部件布置。
如图2所示,本申请还提供一种机器人,包括调速模块100以及控制器200,其中调速模块100集成了如图1所示的速度调整单元的功能,输出速度调整曲线。控制器200用于根据速度调整曲线调整机器人行走的速度。
本申请还提供一种在线速度调整方法,可应用于上述速度调整单元、调速模块。
如图3所示,方法包括:
步骤S100、获取机器人在当前时刻的第一运动系数以及规划的第二运动系数。
若第一运动系数不等于第二运动系数,则根据第一运动系数、第二运动系数,得到速度调整曲线。
其中,根据第一运动系数、第二运动系数,得到速度调整曲线,包括:
步骤S210、根据第一运动系数进行曲线重规划,得到第一运动曲线。
需说明的是,第一运动曲线,其规划方式与第二运动系数对应的第二运动曲线的规划相同,与第二运动曲线均为起始加速度为0、起始速度为0的S型曲线,如Double S速度曲线(双S型速度曲线);对于第一运动曲线而言,其运动过程中的速度、位移、加速度、加加速度均可参照公式(1)~公式(4)表示。
因此,示例性的,参照公式(1)~公式(4),根据第一运动系数k'能得到为起点到终点的距离s'、速度限度v'、加速度限度a'、加加速限度j';此时根据k'、v'、a'、j'以及起止点的速度为0、加速度为0、加加速度为0进行重规划,得到第一运动曲线。
步骤S220、根据第二运动系数、第一运动曲线,选取第一时刻作为待规划的过渡曲线的结束时刻。
需说明的是,第一时刻的选取范围为第一运动曲线上从当前时刻至整个运动曲线结束时刻之间任一运动段结束的时刻。其实现整个运动段的规划,不破坏运动的整体性。
步骤S230、根据机器人在第一时刻的第一运动参数、当前时刻的第二运动参数,通过五阶多项式得到从当前时刻到第一时刻的目标线段。
需说明的是,第一运动参数包括第一位移、第一速度、第一加速度及第一加加速度。
需说明的是,五阶多项式规划得到目标线段是平滑的,其速度、加速度、加加速度不会出现陡变,其速度计算更为简单,响应更快。
步骤S240、获取约束参数。
步骤S250、通过约束参数校验目标线段的合法性,若目标线段合法,则将目标线段作为过渡曲线,并根据过渡曲线、第一运动曲线得到速度调整曲线;其中速度调整曲线用于调整机器人的速度。
示例性的,假设在C时刻点处发生速度偏移,A为第二运动系数对应的第二运动曲线对应的路径的起始时刻,B为最终期望到达的终点的时刻点,D为过渡曲线结束时的第一时刻,则不断选取D点,直至C->D通过五阶多项式进行规划得到的目标线段满足约束参数的条件,此时,过渡曲线为C->D时间段内的目标线段,其运动可通过位移曲线、速度曲线、加速度曲线以及加加速度曲线表示,以实时调整对应时刻的速度参数。此时,速度调整曲线为C->D以及D->B的曲线;此时,整个运动过程的曲线为A->C->D->B,其中A->C为第二运动曲线对应的运动段;C->D为过渡曲线,D->B为第一运动曲线中对应的运动段。
步骤S260、若目标线段不合法,则重新确定第一时刻以重新规划得到过渡曲线。
需说明的是,重新确定第一时刻后,会参照步骤S230、S240得到合法的目标线段作为过渡曲线。
需说明的是,当再次发生速度偏移时,第二运动系数为速度调整曲线中第一运动曲线在速度偏移时的运动系数。此时,参照步骤S100、S210~S260得到新的速度调整曲线。
因此,通过第一运动系数重新规划得到的加速度为0的第一运动曲线,相对于加速度不为0的曲线规划更为简单。同时,通过五阶多项式得到过渡曲线,再利用五阶多项式得到过渡曲线的速度变化具有平滑性的特点,使得从初始规划的曲线到过渡曲线到重规划的第一曲线的整个过程是平滑的,不会破坏运动的整体性。因此,通过本申请的方案进行速度调控可以保证整个运动过程其速度调整是平滑过渡的,保证运动的完整性的同时用于调整的速度计算更加简单。
可理解为,如图4所示,对于包括多个运动段的第一运动曲线;步骤S220包括:
步骤S221、获取当前时刻下第二运动系数对应的运动段的第一运动段类型。
步骤S222、将第一运动曲线中与第一运动段类型相同的运动段的结束时刻作为第一时刻。
需说明的是,S型曲线规划会根据运动的距离长短,最大速度,最大加速度等参数,规划出一条加减速的运动曲线,对于运动曲线而言,如果是七段(加加速段,匀加速段,减加速段,匀速段,加减速段,匀减速段,减减速段)都有运动时间,则可分为七个运动段;如果是匀加速段或者匀减速段的时间为0,则是只有六个运动段或五个运动段;如匀加速段、匀减速段、匀速段时间为0,则为4个运动段。具体的根据计算出的时间是否为0,确定速度规划出的段数。
示例性的,对于第二运动系数而言,假设规划的第二运动曲线的完整运动过程的运动段有3段,分别为Type1,Type2,Type3;其中,第二运动系数为控制Type2的速度的运动系数,重规划后,对于第一运动曲线而言,其完整的运动过程的运动段有5段,分别为Type1',Type2',Type3',Type4',Type5';则在第一运动曲线中选取与Type2类型一致的运动段Type3'(如Type2、Type3'均为加速段),此时,第一时刻为Type3'的结束时刻。
示例性的,假设规划的第二运动曲线的完整运动过程的运动段分为Type1,Type2,Type3,Type4四段,第二运动曲线运动段为Type1',Type2',Type3',Type4',且每一运动段的运动段类型一一对应;则当速度偏移时刻在Type1中时,第一时刻为Type1'的结束时刻。
示例性的,对于第二运动系数而言,假设规划的第二运动曲线的完整运动过程的运动段分为Type1,Type2,Type3,Type4,Type5,Type6,Type7;第二运动曲线运动段为Type1',Type2',Type3',Type4',Type5',Type6',Type7',且每一运动段的运动段类型一一对应;则当速度偏移时刻在Type2中时,第一时刻为Type2'的结束时刻。此时,通过这种方式得到过渡曲线后,可以对整个运动段进行速度规划,保证运动的整体性。
可理解为,如图5所示,目标线段包括位移曲线、速度曲线、加速度曲线以及加加速度曲线;步骤S230,包括:
步骤S231、建立第一表达式,第一表达式表征目标线段对应的过渡时间与第一运动参数、第二运动参数之间的关系。
需说明的是,假定当前时刻i的第二运动参数wi=(Si,Vi,Ai,Ji),第一运动参数为we=(Se,Ve,Ae,Je),则第一表达式为T=2×(Se-Si)/(Vi+Ve)。其中T为过渡时间。
步骤S232、根据第一表达式、第一运动参数、第二运动参数、预设的五阶多项式,得到五阶多项式的若干参数解。
示例性的,预设的五阶多项式如下:
s(t)=a0+a1(t-t0)+a2t(t-t0)2+a3(t-t0)3+a4(t-t0)4+a5(t-t0)5 (5)
v(t)=a1+2a2(t-t0)+3a3(t-t0)2+4a4(t-t0)3+5a5(t-t0)4 (6)
acc(t)=2a2+6a3(t-t0)+12a4(t-t0)2+20a5(t-t0)3 (7)
jerk(t)=6a3+24a4(t-t0)+60a5(t-t0)2 (8)
将wi=(Si,Vi,Ai,Ji)、we=(Se,Ve,Ae,Je)分别代入上述公式,求解得到:
a0=si
a1=vi
其中,a1、a2、a3、a4、a5为参数解。
步骤S233、根据若干参数解、五阶多项式,分别得到位移曲线、速度曲线、加速度曲线以及加加速度曲线。
需说明的是,将a1、a2、a3、a4、a5代入公式(5)~(8),即可得到位移与时间的方程式,即位移曲线;速度与时间的方程式,即速度曲线;加速度与时间的方程式,即加速度曲线;加加速度与时间的方程式,即加加速度曲线。
可理解为,如图6所示,约束参数包括:约束时间、约束速度、约束加速度;步骤S250中通过约束参数校验目标线段的合法性,包括:
步骤S251、计算加加速度曲线对应的第一实数根。
示例性的,根据公式(8):jerk(t)=6a3+24a4(t-t0)+60a5(t-t0)2可知,公式(8)存在两个对应时间的第一实数根,假定分别为rj1、rj2。
步骤S252、若第一实数根合法,则将第一实数根输入到加速度曲线中,得到第一实数根对应的第二实数根。
需说明的是,合法表示rj1、rj2存在,且rj1、rj2满足(0,T]。示例性的,若rj1∈(0,T],则将rj1输入公式(7):acc(t)=2a2+6a3(t-t0)+12a4(t-t0)2+20a5(t-t0)3得到acc1。若rj2∈(0,T],则将rj2输入公式(7)得到acc2。
步骤S253、若第二实数根小于等于约束加速度,则判定目标线段不合法。
示例性的,假定约束加速度为Amax,则若abs(acc2)>Amax且abs(acc1)>Amax,则目标线段合法,否则需要重新确定第一时刻以重新规划得到合法的目标线段作为过渡曲线。
步骤S254、若第二实数根大于约束加速度,则根据速度曲线的合法性,判断目标线段的合法性。
速度曲线的合法表示该速度曲线中的速度均超过约束速度。
可理解为,如图7所示,步骤S254包括:
步骤S2541、计算加速度曲线对应的第三实数根。
示例性的,根据公式(7):acc(t)=2a2+6a3(t-t0)+12a4(t-t0)2+20a5(t-t0)3可知,公式(7)存在三个对应时间的第三实数根,假定分别为ra1、ra2、ra3。
步骤S2542、若第三实数根合法,则将第三实数根输入到速度曲线中,得到第三实数根对应的第四实数根。
需说明的是,合法表示第三实数根:ra1、ra2、ra3存在,且ra1、ra2、ra3满足(0,T]。示例性的,若ra1∈(0,T],则将ra1输入公式(6)得到v1。若ra2∈(0,T],则将ra2输入公式(6)得到v2。若ra3∈(0,T],则将ra3输入公式(6)得到v3。
步骤S2543、若第四实数根小于等于约束速度,则判定目标线段不合法。
示例性的,假定约束速度为Vmax,则若abs(v1)>Vmax、abs(v2)>Vmax、abs(v3)>Vmax,则该目标线段为合法的,否则需要重新确定第一时刻以重新规划得到合法的目标线段作为过渡曲线。
可理解为,如图8所示,第一运动曲线包括多个运动段;步骤S260中重新确定第一时刻,包括:
步骤S310、将第一时刻更新为第一运动段的结束时刻;其中,第一运动段为第一运动曲线中,前一次规划中以第一时刻为结束时刻的第二运动段的下一运动段。
示例性的,假定第一运动曲线的完整的运动过程的运动段划分为Type1',Type2',Type3',Type4',Type5'(如分别为加加速度段、减加速段、匀速段、加减速段、减速段),第一次规划时,当前第二运动系数对应的运动段为Type3',此时,第一次规划时的第一时刻为Type3'结束的时刻。当根据第一次规划的第一时刻得到的过渡曲线不满足约束参数时,会进行第二次规划,此时,对于第二次规划而言,第二运动段为第一次规划中Type3',第一运动段为Type4',此时,第二次规划的第一时刻为Type4'的结束时刻。同样,对于第三次规划,第二运动段为第二次规划的Type4',第一运动段为Type5'。
示例性的,假定第一运动曲线的完整的运动过程的运动段划分为Type1',Type2',Type3',Type4',Type5',Type6',Type7'(对应分别为加加速段,匀加速段,减加速段,匀速段,加减速段,匀减速段,减减速段),第一次规划时,当前第二运动系数对应的运动段为Type1',此时,第一次规划时的第一时刻为Type1'结束的时刻。当根据第一次规划的第一时刻得到的过渡曲线不满足约束参数时,会进行第二次规划,此时,对于第二次规划而言,第二运动段为第一次规划中Type1',第一运动段为Type2',此时,第二次规划的第一时刻为Type2'的结束时刻。同样,对于第三次规划,第二运动段为第二次规划的Type2',第一运动段为Type3'。
可理解为,在一些实施例中,对于第一时刻的确定除步骤S310以外还可以采用下述方式:
获取第二运动段的第二运动段类型;其中,第二运动段为第一运动曲线中,前一次规划中以第一时刻为结束时刻的运动段。
根据第二运动段类型,将第一时刻更新为第二运动段中预设目标时刻或更新为第一运动段的结束时刻。
需说明的是,在实际运动过程中,存在前一次规划中的第二运动段为匀速段,此时,可以在第二运动段中选取第一时刻以判断是否存在一个时刻可以满足约束条件。
可理解为,若第二运动段为匀速段,如图9所示,则根据第二运动段类型,将第一时刻更新为第二运动段中预设目标时刻或更新为第一运动段的结束时刻,包括:
步骤S311、获取第二运动段所需的第一时间,将第一时间分割成N个子时间段。
示例性的,假定匀速段的开始时间为ts,结束时间为tf,则每一子时间段所需时间为(tf-ts)/n。
步骤S312、获取当前时刻的重规划次数K。
需说明的是,K的初始值为1;即对第二运动段进行重规划处理时,K会被初始化为1。K的取值为1~N。此时,第K次重规划后,预设目标时刻为tk=tf-k×(tf-ts)/n。
步骤S313、获取第N-K个子时间段结束时的第一位置。
第一位置sek为tk时刻的位置信息。
步骤S314、若第一位置大于第二运动参数对应的第二位置,则将第一时刻更新为预设目标时刻;并将重规划次数K的值加1;其中,目标时刻为第一位置对应的时刻;
即sek>si,则we=(Sek,Vek,Aek,Jek)。此时,第一时刻为tk。示例性的,假设当前的重规划次数k=2,则步骤S314执行完成后,重规划次数k=3。
需说明的是,将重规划次数K的值递增是为了重规划的目标线段不满足约束条件需要重新确定第一时刻时,用于重新确定预设目标时刻。
步骤S315、若第一位置小于等于第二运动参数对应的第二位置,则将第一时刻更新为第一运动段的结束时刻。
可理解为,约束参数包括:约束时间、约束速度、约束加速度;如图10所示,步骤S240包括:
步骤S241、将第二运动系数对应的第二运动曲线、第一运动曲线中最大的速度设置为约束速度。
示例性的,假设第二运动曲线的最大速度(即匀速段的允许达到的最大速度)为V1max,第一运动曲线的最大速度(即匀速段的允许达到的最大速度)V2max,若V1max>V2max,则Vmax=V1max,否则V1max=V2max。
步骤S242、根据第二运动曲线、第一运动曲线中最大的加速度,得到约束加速度。
假定第二运动曲线的最大加速度为acc1max;第一运动曲线的最大加速度为acc2max;则示例性的,若acc1max>acc2max;则约束加速度Amax=acc1max,否则Amax=acc2max。在另一些实施例中,若acc2max、acc2max均满足小于预设的加速度门限值,则根据acc1max、acc2max的值的大小将Amax提升预设倍数的acc1max或acc2max。如Amax=2acc1max,acc1max>acc2max。
步骤S243、获取自适应时间以及预设的过渡调整时间,并根据自适应时间、过渡调整时间得到约束时间。
需说明的是,自适应时间为Tadj=max(accramp)+time_r,其中accramp为第一运动曲线、第二运动曲线中加加速运动段所需时间的最大值;time_r为设定预留时间。此时,可以根据加速上升的时间accramp为基准,进行自适应时间设置。示例性的,当accramp=0.1,此时,得到的自适应时间由于time_r不会设置过小,从而提升过渡曲线规划的成功率。其中,accramp最小设置为0,最大不超过到达目的地的总运行时间。
需说明的是,过渡调整时间tmax为期望过渡曲线运行的最大时间,由用户设置,若tmax<Tadj,则约束时间Tmax=tmax,以供下一速度调整时使用。否则,约束时间为Tmax=max(decramp)+time_r。
可理解为,本申请还提供一种速度调整的设备,包括:
至少一个处理器,以及与所述至少一个处理器通信连接的存储器;其中,所述存储器存储有指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器执行所述指令时实现如上述的在线速度调整方法。
存储器作为一种非暂态计算机可读存储介质,可用于存储非暂态软件程序以及非暂态性计算机可执行程序。此外,存储器可以包括高速随机存取存储器,还可以包括非暂态存储器,例如至少一个磁盘存储器件、闪存器件、或其他非暂态固态存储器件。在一些实施方式中,存储器可选包括相对于处理器远程设置的存储器,这些远程存储器可以通过网络连接至该处理器。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
可理解为,本申请还提供一种速存储介质,包括存储有计算机可执行指令,所述计算机可执行指令用于执行如上述的在线速度调整方法。
本领域普通技术人员可以理解,上文中所公开方法中的全部或某些步骤、系统可以被实施为软件、固件、硬件及其适当的组合。某些物理组件或所有物理组件可以被实施为由处理器,如中央处理器、数字信号处理器或微处理器执行的软件,或者被实施为硬件,或者被实施为集成电路,如专用集成电路。这样的软件可以分布在计算机可读介质上,计算机可读介质可以包括计算机存储介质(或非暂时性介质)和通信介质(或暂时性介质)。如本领域普通技术人员公知的,术语计算机存储介质包括在用于存储信息(诸如计算机可读指令、数据结构、程序模块或其他数据)的任何方法或技术中实施的易失性和非易失性、可移除和不可移除介质。计算机存储介质包括但不限于RAM、ROM、EEPROM、闪存或其他存储器技术、CD-ROM、数字多功能盘(DVD)或其他光盘存储、磁盒、磁带、磁盘存储或其他磁存储装置、或者可以用于存储期望的信息并且可以被计算机访问的任何其他的介质。此外,本领域普通技术人员公知的是,通信介质通常包含计算机可读指令、数据结构、程序模块或者诸如载波或其他传输机制之类的调制数据信号中的其他数据,并且可包括任何信息递送介质。
因此,使用基于五阶多项式方法结合第一时刻的给定时间选取策略时间进行过渡曲线规划。此时,从第二运动曲线到调整曲线的加速度不发生跳变,维持原运动轨迹,保证运动整体性,并通过约束参数验证合法性,简单高效。上述在线速度调整方法,是以一个运动段为基础,使用初始加速度为0的进行第一运动曲线的S型曲线规划,计算实际的匀速速度值计算相对于初始加速度不为0的曲线规划更加简单,并且由于初始加速度不为0的S型规划是属于加减速规划,当出现机器人速度降速时,将会直接减速,并不会出现减速-匀速-减速的更优越的规划曲线。因此,所以上述的在线速度调整方法可以大幅减小速度计算的复杂度,并可得到更为理想的速度规划曲线。
尽管已经示出和描述了本申请的实施例,本领域的普通技术人员可以理解:在不脱离本申请的原理和宗旨的情况下可以对这些实施例进行多种变化、修改、替换和变型,本申请的范围由权利要求及其等同物限定。
上面结合附图对本申请实施例作了详细说明,但是本申请不限于上述实施例,在技术领域普通技术人员所具备的知识范围内,还可以在不脱离本申请宗旨的前提下做出各种变化。
Claims (13)
1.一种在线速度调整方法,其特征在于,所述方法包括:
获取机器人在当前时刻的第一运动系数以及规划的第二运动系数;
若所述第一运动系数不等于所述第二运动系数,则根据所述第一运动系数、所述第二运动系数,得到速度调整曲线;
其中,所述根据所述第一运动系数、所述第二运动系数,得到速度调整曲线,包括:
根据所述第一运动系数进行曲线重规划,得到第一运动曲线;
根据所述第二运动系数、所述第一运动曲线,选取第一时刻作为待规划的过渡曲线的结束时刻;所述第一时刻的选取范围为第一运动曲线上从当前时刻至整个运动曲线结束时刻之间任一运动段结束的时刻;
根据所述机器人在所述第一时刻的第一运动参数、当前时刻的第二运动参数,通过五阶多项式得到从当前时刻到所述第一时刻的目标线段;其中,所述目标线段包括位移曲线、
速度曲线、加速度曲线以及加加速度曲线;所述第一运动参数包括第一位移、第一速度、
第一加速度及第一加加速度;
获取约束参数;所述约束参数包括:约束速度、约束加速度;
通过所述约束参数校验所述目标线段的合法性,若所述目标线段合法,则将所述目标线段作为过渡曲线,并根据所述过渡曲线、所述第一运动曲线得到速度调整曲线;其中所述速度调整曲线用于调整机器人的速度;所述目标线段合法表示所述目标线段满足所述约束参数的条件;
若所述目标线段不合法,则重新确定所述第一时刻以重新规划得到所述过渡曲线。
2.根据权利要求1所述的在线速度调整方法,其特征在于,
所述第一运动曲线包括多个运动段;所述根据所述第二运动系数、所述第一运动曲线,选取第一时刻作为待规划的过渡曲线的结束时刻,包括:
获取当前时刻下所述第二运动系数对应的运动段的第一运动段类型;
将所述第一运动曲线中与所述第一运动段类型相同的运动段的结束时刻作为第一时刻。
3.根据权利要求1所述的在线速度调整方法,其特征在于,
所述根据所述机器人在所述第一时刻的第一运动参数、当前时刻的第二运动参数,通过五阶多项式得到从当前时刻到所述第一时刻的目标线段,包括:
建立第一表达式,所述第一表达式表征所述目标线段对应的过渡时间与所述第一运动参数、所述第二运动参数之间的关系;
根据所述第一表达式、所述第一运动参数、所述第二运动参数、预设的五阶多项式,得到所述五阶多项式的若干参数解;
根据若干所述参数解、所述五阶多项式,分别得到所述位移曲线、所述速度曲线、所述加速度曲线以及所述加加速度曲线。
4.根据权利要求3所述的在线速度调整方法,其特征在于,
所述通过所述约束参数校验所述目标线段的合法性,包括:
计算所述加加速度曲线对应的第一实数根;
若所述第一实数根合法,则将所述第一实数根输入到所述加速度曲线中,得到所述第一实数根对应的第二实数根;
若所述第二实数根小于等于所述约束加速度,则判定所述目标线段不合法;
若所述第二实数根大于所述约束加速度,则根据所述速度曲线的合法性,判断所述目标线段的合法性。
5.根据权利要求4所述的在线速度调整方法,其特征在于,
所述根据所述速度曲线的合法性,判断所述目标线段的合法性,包括:
计算所述加速度曲线对应的第三实数根;
若所述第三实数根合法,则将所述第三实数根输入到所述速度曲线中,得到所述第三实数根对应的第四实数根;
若所述第四实数根小于等于所述约束速度,则判定所述目标线段不合法。
6.根据权利要求1所述的在线速度调整方法,其特征在于,
所述第一运动曲线包括多个运动段;所述重新确定所述第一时刻,包括:
将所述第一时刻更新为第一运动段的结束时刻;其中,所述第一运动段为所述第一运动曲线中,前一次规划中以所述第一时刻为结束时刻的第二运动段的下一运动段。
7.根据权利要求6所述的在线速度调整方法,其特征在于,
所述重新确定所述第一时刻,包括:
获取所述第二运动段的第二运动段类型;其中,所述第二运动段为所述第一运动曲线中,前一次规划中以所述第一时刻为结束时刻的运动段;
根据所述第二运动段类型,将所述第一时刻更新为所述第二运动段中预设目标时刻或更新为第一运动段的结束时刻。
8.根据权利要求7所述的在线速度调整方法,其特征在于,
若所述第二运动段类型为匀速段,则根据所述第二运动段类型,将所述第一时刻更新为所述第二运动段中预设目标时刻或更新为所述第一运动段的结束时刻,包括:
获取所述第二运动段所需的第一时间,将所述第一时间分割成N个子时间段;
获取当前时刻的重规划次数K;
获取第N-K个所述子时间段结束时的第一位置;
若所述第一位置大于所述第二运动参数对应的第二位置,则将所述第一时刻更新为预设目标时刻;并将所述重规划次数K的值加1;其中,所述目标时刻为所述第一位置对应的时刻;
若所述第一位置小于等于所述第二运动参数对应的第二位置,则将所述第一时刻更新为所述第一运动段的结束时刻。
9.根据权利要求1至8任一所述的在线速度调整方法,其特征在于,
所述约束参数还包括:约束时间;所述获取约束参数,包括:
将所述第二运动系数对应的第二运动曲线、所述第一运动曲线中最大的速度设置为所述约束速度;
根据所述第二运动曲线、所述第一运动曲线中最大的加速度,得到所述约束加速度;
获取自适应时间以及预设的过渡调整时间,并根据所述自适应时间、所述过渡调整时间得到所述约束时间。
10.一种在线速度调整的设备,其特征在于,包括:
至少一个处理器,以及与所述至少一个处理器通信连接的存储器;其中,所述存储器存储有指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器执行所述指令时实现如权利要求1至9任一所述的在线速度调整方法。
11.一种在线速度调整单元,其特征在于,实现如权利要求1至9任一所述的在线速度调整方法。
12.一种机器人,其特征在于,包括:
调速模块,所述调速模块用于执行如权利要求1至9任一所述的在线速度调整方法,得到速度调整曲线;
控制器,所述控制器用于根据所述速度调整曲线调整行走的速度参数。
13.一种存储介质,其特征在于,包括存储有计算机可执行指令,所述计算机可执行指令用于执行如权利要求1至9中任一项所述的在线速度调整方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110780599.5A CN113524181B (zh) | 2021-07-09 | 2021-07-09 | 在线速度调整方法、设备、单元、机器人及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110780599.5A CN113524181B (zh) | 2021-07-09 | 2021-07-09 | 在线速度调整方法、设备、单元、机器人及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113524181A CN113524181A (zh) | 2021-10-22 |
CN113524181B true CN113524181B (zh) | 2023-03-10 |
Family
ID=78098321
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110780599.5A Active CN113524181B (zh) | 2021-07-09 | 2021-07-09 | 在线速度调整方法、设备、单元、机器人及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113524181B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114200892B (zh) * | 2021-11-01 | 2024-07-05 | 苏州谋迅智能科技有限公司 | 交互输入设备平滑输出的方法和装置、存储介质和设备 |
CN114217573B (zh) * | 2021-12-10 | 2023-12-29 | 江苏集萃智能制造技术研究所有限公司 | 一种速度前瞻控制方法 |
CN117621533B (zh) * | 2024-01-26 | 2024-04-19 | 南通锻压设备如皋有限公司 | 一种复合材料液压机滑块快速下行的控制方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003091320A (ja) * | 2001-09-18 | 2003-03-28 | Matsushita Electric Ind Co Ltd | モータ駆動軸の速度パターン調整方法および調整装置、並びに当該速度パターン調整装置を備えた部品実装装置および粘性材料塗布装置 |
JP2007233613A (ja) * | 2006-02-28 | 2007-09-13 | Kyushu Institute Of Technology | 速度制御方法及び速度制御装置 |
CN102749888A (zh) * | 2012-06-29 | 2012-10-24 | 上海三一精机有限公司 | 一种进给速度实时修调方法 |
CN104908040A (zh) * | 2015-06-23 | 2015-09-16 | 广东顺德中山大学卡内基梅隆大学国际联合研究院 | 一种冗余度机械臂加速度层的容错规划方法 |
CN106003067A (zh) * | 2016-07-14 | 2016-10-12 | 东莞市李群自动化技术有限公司 | 工业机器人示教方法和示教文件制作方法及装置 |
CN107065901A (zh) * | 2017-01-18 | 2017-08-18 | 北京京东尚科信息技术有限公司 | 一种旋翼无人机姿态控制方法、装置及无人机 |
CN108748138A (zh) * | 2018-04-17 | 2018-11-06 | 上海达野智能科技有限公司 | 速度规划方法、系统、控制系统、机器人、及存储介质 |
CN109313429A (zh) * | 2017-04-24 | 2019-02-05 | 深圳配天智能技术研究院有限公司 | S型速度规划方法、装置、系统、机器人以及数控机床 |
CN112276906A (zh) * | 2020-10-16 | 2021-01-29 | 深圳市华成工业控制股份有限公司 | 一种运动速度的控制方法、系统、主机及存储介质 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9679215B2 (en) * | 2012-01-17 | 2017-06-13 | Leap Motion, Inc. | Systems and methods for machine control |
CN109815536B (zh) * | 2018-12-19 | 2020-10-30 | 西南交通大学 | 城市轨道交通节能时刻表和运行曲线优化方法 |
CN112965501A (zh) * | 2021-03-31 | 2021-06-15 | 东风商用车有限公司 | 一种自动驾驶速度规划方法及装置 |
-
2021
- 2021-07-09 CN CN202110780599.5A patent/CN113524181B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003091320A (ja) * | 2001-09-18 | 2003-03-28 | Matsushita Electric Ind Co Ltd | モータ駆動軸の速度パターン調整方法および調整装置、並びに当該速度パターン調整装置を備えた部品実装装置および粘性材料塗布装置 |
JP2007233613A (ja) * | 2006-02-28 | 2007-09-13 | Kyushu Institute Of Technology | 速度制御方法及び速度制御装置 |
CN102749888A (zh) * | 2012-06-29 | 2012-10-24 | 上海三一精机有限公司 | 一种进给速度实时修调方法 |
CN104908040A (zh) * | 2015-06-23 | 2015-09-16 | 广东顺德中山大学卡内基梅隆大学国际联合研究院 | 一种冗余度机械臂加速度层的容错规划方法 |
CN106003067A (zh) * | 2016-07-14 | 2016-10-12 | 东莞市李群自动化技术有限公司 | 工业机器人示教方法和示教文件制作方法及装置 |
CN107065901A (zh) * | 2017-01-18 | 2017-08-18 | 北京京东尚科信息技术有限公司 | 一种旋翼无人机姿态控制方法、装置及无人机 |
CN109313429A (zh) * | 2017-04-24 | 2019-02-05 | 深圳配天智能技术研究院有限公司 | S型速度规划方法、装置、系统、机器人以及数控机床 |
CN108748138A (zh) * | 2018-04-17 | 2018-11-06 | 上海达野智能科技有限公司 | 速度规划方法、系统、控制系统、机器人、及存储介质 |
CN112276906A (zh) * | 2020-10-16 | 2021-01-29 | 深圳市华成工业控制股份有限公司 | 一种运动速度的控制方法、系统、主机及存储介质 |
Non-Patent Citations (2)
Title |
---|
Simplified dynamic modelling of variable speed wind turbine generators based on capability diagrams;Davood Raoofsheibani;《Simplified dynamic modelling of variable speed wind turbine generators based on capability diagrams》;IEEE;20150903;第1-6页 * |
车联网环境下自动驾驶车辆车道选择决策模型;杨达;《车联网环境下自动驾驶车辆车道选择决策模型》;中国公路学报;20210706;第35卷(第4期);第243-255页 * |
Also Published As
Publication number | Publication date |
---|---|
CN113524181A (zh) | 2021-10-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113524181B (zh) | 在线速度调整方法、设备、单元、机器人及存储介质 | |
CN110793784B (zh) | 自动驾驶车辆的测试方法、装置、存储介质及电子装置 | |
CA2859049C (en) | Multi-agent reinforcement learning for integrated and networked adaptive traffic signal control | |
US20140343759A1 (en) | Methods and systems for aircraft guidance | |
Atagoziyev et al. | Lane change scheduling for autonomous vehicles | |
JP2010036862A (ja) | 走行制御装置及び走行制御システム | |
US8159912B2 (en) | Recording parameter setting device, program thereof, computer-readable recording medium containing the program, information recording medium, recording/reproducing device, and recording parameter setting method | |
CN112965501A (zh) | 一种自动驾驶速度规划方法及装置 | |
WO2020030992A1 (en) | Controller, system and method for vehicle control | |
US20070242584A1 (en) | Dynamic write strategy modification method and apparatus | |
JP2010061385A (ja) | 走行制御装置 | |
CN114613169A (zh) | 一种基于双经验池dqn的交通信号灯控制方法 | |
JP5776724B2 (ja) | 走行制御装置 | |
CN115454100A (zh) | 全局速度规划方法、全局速度规划装置与规划系统 | |
US8849937B2 (en) | Apparatus and method for time synchronization by automatically controlling sending message count of master | |
CN114167860A (zh) | 一种自动驾驶最优轨迹生成方法及装置 | |
US20220413453A1 (en) | Positioning control device and positioning control method | |
US8139456B2 (en) | Optical recording method and optical recording device | |
CN113353076A (zh) | 车辆行驶控制方法、装置及设备 | |
EP4163837A1 (en) | Methods and systems for determining a driving trajectory as training data for machine learning based adaptive cruise control | |
CN1983398A (zh) | 光信息记录再现装置和光信息记录处理方法 | |
CN110244739A (zh) | 一种空中自行小车输送方法、装置及计算机存储介质 | |
CN109815754A (zh) | 一种读写器rfid发射功率自适应控制方法 | |
CN114613168B (zh) | 一种基于记忆网络的深度强化学习交通信号控制方法 | |
CN114995283A (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 |