CN109814496B - 一种s型加减速轨迹规划中多轴时间同步方法 - Google Patents
一种s型加减速轨迹规划中多轴时间同步方法 Download PDFInfo
- Publication number
- CN109814496B CN109814496B CN201910097753.1A CN201910097753A CN109814496B CN 109814496 B CN109814496 B CN 109814496B CN 201910097753 A CN201910097753 A CN 201910097753A CN 109814496 B CN109814496 B CN 109814496B
- Authority
- CN
- China
- Prior art keywords
- acceleration
- type
- parameters
- curve
- displacement
- 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
Landscapes
- Numerical Control (AREA)
Abstract
Description
技术领域
本发明涉及工业机器人运动控制及伺服电机速度同步控制领域,特别是涉及速度规划方法与机器人运动规划方面的一种S型加减速轨迹规划中多轴时间同步方法。
背景技术
在机器人运动过程中,一条运动指令往往有多轴同时参与运动,而多轴运动插补的最短时间取决于单轴运动规划时间最长的那个轴。多关节的同起同停会使机器人运动轨迹更加自然,如果将时间同步方法用于笛卡尔空间的路径插补,则中间段轨迹匀速在实际中广泛应用,例如机器人涂胶,焊接等。
传统的多轴时间同步轨迹规划方法往往只考虑所有轴初始运动状态互相成比例关系,末端运动状态和运动约束条件也是这种比例关系的情况。而本方法则拓展了传统的时间同步方法,考虑了任意初始运动状态、约束条件和加速度等于零的末端运动条件,应用场合更加广泛。本发明适用于在线实时生成轨迹,能够使机器人在运动状态下,针对未知事件能够及时做出反应,具有计算速度快精度高的特点,为以后机器人加入传感器并自主规划轨迹具有重要意义。
发明内容
针对现有技术存在的技术问题,本发明提供一种加减速轨迹规划中多轴时间同步方法,该方法适用于在线实时生成轨迹,能够使机器人在运动状态下,针对未知事件能够及时做出反应,具有计算速度快精度高的特点,为以后机器人加入传感器并自主规划轨迹具有重要意义。
为了克服传统多轴时间同步轨迹规划方法的不足,本发明解决其技术问题采用的方案如下:
一种S型加减速轨迹规划中多轴时间同步方法,包括如下步骤:
Step4,判断加速度曲线类型Typea是否等于TriZeroTri,如果满足条件,进入下一步;否则进入对粗略轨迹参数进行修正过程;
Step5,根据Step4的修正参数和插补周期Δt生成轨迹Pi(t)。
所述Step4步骤中对粗略轨迹参数进行修正过程:
2.3、若加速度曲线类型Typea不等于TrapZeroTrap,则需要对参数进行修正计算得到经过参数修正后需要再次判断加速度曲线类型Typea=TrapZeroTrap?如果加速度曲线类型Typea为TrapZeroTrap,则需要再次计算参数否则经过上面修正计算之后得到的参数即为最终参数,可以直接输入Step5。
所述Step5步骤中Pi(t)轨迹生成的过程:
与现有技术相比,本发明具有的优点:
附图说明
图1为本发明一种S型加减速轨迹规划中多轴时间同步方法流程图。
图2为本发明中部分时间同步加速度曲线类型Typea(横轴时间t,纵轴加速度A)示意图。
图3为本发明中关节时间同步轨迹测试结果。
具体实施方式
下面结合附图对本发明的技术方案作进一步说明。
如图1所示,本发明提供一种S型加减速轨迹规划中多轴时间同步方法,包括如下步骤:Step1,通过S型加减速单轴规划,分别计算规划每个轴的运动时间Tj=[tj1,tj2,tj3,…tjn]选取所有轴规划的最大时间max(Tj)作为关节同步时间tsync;进而生成各关节初始加加速度该步骤是计算边界加速度类型和初始加加速度Js。
边界曲线构造:首先以最大加加速度将关节i的加速度由初始加速度降到零,然后再保持加速度等于零段。最后在同步时间tsync约束条件下,再通过在某一时刻加速或减速来达到目标速度,将这样的加速度曲线作为边界加速度类型曲线
将关节i以边界加速度曲线所经过的位移与实际目标位移进行比较。若小于目标位移则初始加加速度等于若等于目标位移则初始加加速度等于边界加速度曲线对应的初始加加速度,且边界加速度曲线就是实际加速度曲线;否则,初始加加速度等于
Step2,不考虑加速度极限值并计算轨迹参数如图2所示,将速度曲线分成三部分,第一段加速部分、第二段匀速部分、第三段加速部分。该图包括了时间同步加速度轨迹的所有情况,其中前4幅图的共同特点是第一段初始加加速度和第三段初始加加速度符号相异。后4幅图表示了第一段初始加加速度和第三段初始加加速度符号相同。图2的8种情况可以分成4大类,1和5一类表示为TriZeroTri、2和6一类表示为TrapZeroTri,3和7一类表示为TriZeroTrap,4和8一类表示为TrapZeroTrap。其中TriZeroTri表示不存在匀加速段的所有情况;TrapZeroTri包含了只有第一段含有匀加速段的情况;TriZeroTrap包含了2段含有匀加速段的情况;TrapZeroTrap包含了第一段和第三段都含有匀加速段的情况。这4大类即可覆盖所有双S型加减速规划的所有情况。
Step3,考虑加速度极限值再次计算轨迹参数并确定加速曲线形状Typea。为了计算加速度曲线的第一段和第三段加速部分的详细参数,首先假设第一段加速部分不存在匀加速段,通过第一段加速时间计算第一段加速曲线规划过程中达到的最大加速度如果最大加速度大于加速度极限值则存在匀加速度段和两段变加速段,否则不存在匀加速段,则第一段加速曲线只包括两段匀加速段。第三段加速曲线处理方法同第一段,不同的是第三段需要计算第三段开始的加加速度值通过匀速速度与首末速度相比较,若匀速速度大于始末速度中的最大值或小于始末速度的最小值,则等于否则等于
Step4,判断加速度曲线类型Typea是否等于TripZeroTri,如果满足条件,进入下一步;否则进入对粗略轨迹参数进行修正过程;
3、若加速度曲线类型Typea不等于TrapZeroTrap,则需要对参数进行修正计算得到ypea。经过参数修正后需要再次判断加速度曲线类型Typea=TrapZeroTrap?如果加速度曲线类型Typea为TrapZeroTrap,则需要再次计算参数否则经过上面修正计算之后得到的参数即为最终参数,可以直接输入Step5。
由于Step3计算的轨迹参数不适用于存在匀加速度段Trap的情况,因此对于存在匀加速段的轨迹需要再次计算轨迹参数。如图2所示,其中TriZeroTrap、TriZeroTrap、TrapZeroTrap这3种加速类型曲线需要再次修正计算。
修正计算的方法为考虑匀速部分速度并不一定等于速度极限值,匀加速度部分的加速度等于加速度极限值,以位移作为约束条件,以速度和加速度的微分几何关系针对上面3种情况可以分别列写非线性方程组。利用牛顿法对方程组进行求解,最终得到修正后的轨迹参数,即第一部分加速段、第二部分匀速段、第三部分加速段的时间第二部分匀速速度第三段开始加加速度的值和加速度曲线类型Typea。
Step5,根据Step4修正参数和插补周期Δt生成轨迹Pi(t)。
时间同步S型加速曲线主要包括3大部分:加速段、匀速段、加速段。具体可能包括加加速段、匀加速段、减加速段、匀速段、加减速段、匀减速段、减减速段。
轨迹曲线Pi(t)可以通过对加速度曲线Ai(t)进行2次积分得到。速度曲线Vi(t)可以通过对加速度曲线Ai(t)进行1次积分。加加速度曲线Ji(t)是对加速度曲线Ai(t)对时间进行1阶求导。
Pi(t)具体如下:
通过以上5个主要步骤即可实现各关节的时间同步。
测试结果
输入以下参数进行测试,同步时间tsync是由单轴时间最优规划而得,最终得到的多轴轨迹如图3所示。
Jmax=[2500,2500,2500,2500,2500,2500]
Amax=[500,500,500,500,500,500]
Vmax=[200,150,180,180,180,180]
As=[50,0,10,50,0,0]
Vs=[0,20,20,0,0,0]
Ps=[0,0,0,0,0,0]
Vtrgt=[60,-20,30,0,0,0]
dP=[50,50,200,20,100,0]
从图3可以看出,本发明的方法规划结果可靠。
应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。
Claims (1)
1.一种S型加减速轨迹规划中多轴时间同步方法,其特征在于,包括如下步骤:
Step4,判断加速度曲线类型Typea是否等于TriZeroTri,如果满足条件,进入下一步;否则进入对粗略轨迹参数进行修正过程;
Step5,根据Step4的修正参数和插补周期Δt生成轨迹Pi(t);
所述Step4步骤中对粗略轨迹参数进行修正过程,其中:
2.3、若加速度曲线类型Typea不等于TrapZeroTrap,则需要对参数进行修正计算得到Typea;经过参数修正后需要再次判断加速度曲线类型Typea=TrapZeroTrap?如果加速度曲线类型Typea为TrapZeroTrap,则需要再次计算参数否则经过上面修正计算之后得到的参数即为最终参数,可以直接输入Step5;
所述Step5步骤中Pi(t)轨迹生成的过程,其中:
然后,由上面计算的参数可以直接得到各关节轨迹Pi(t),具体如下:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910097753.1A CN109814496B (zh) | 2019-01-31 | 2019-01-31 | 一种s型加减速轨迹规划中多轴时间同步方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910097753.1A CN109814496B (zh) | 2019-01-31 | 2019-01-31 | 一种s型加减速轨迹规划中多轴时间同步方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109814496A CN109814496A (zh) | 2019-05-28 |
CN109814496B true CN109814496B (zh) | 2022-04-08 |
Family
ID=66606082
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910097753.1A Active CN109814496B (zh) | 2019-01-31 | 2019-01-31 | 一种s型加减速轨迹规划中多轴时间同步方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109814496B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110209173A (zh) * | 2019-06-28 | 2019-09-06 | 中科新松有限公司 | 基于s型速度规划的时间最优在线轨迹规划方法 |
CN111002315B (zh) * | 2019-12-27 | 2022-04-15 | 深圳市越疆科技有限公司 | 一种轨迹规划方法、装置及机器人 |
CN112276949B (zh) * | 2020-10-21 | 2022-03-11 | 哈工大机器人(合肥)国际创新研究院 | 一种相邻关节空间-笛卡尔空间轨迹过渡方法及装置 |
CN112192575B (zh) * | 2020-10-21 | 2022-06-14 | 哈工大机器人(合肥)国际创新研究院 | 一种相邻关节空间轨迹过渡方法及装置 |
CN113715027A (zh) * | 2021-09-13 | 2021-11-30 | 哈工大机器人(合肥)国际创新研究院 | 7自由度双臂协作机器人防止自碰撞轨迹规划方法及系统 |
CN114217573B (zh) * | 2021-12-10 | 2023-12-29 | 江苏集萃智能制造技术研究所有限公司 | 一种速度前瞻控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004258700A (ja) * | 2003-02-24 | 2004-09-16 | Keyence Corp | 位置決めシステムの同期曲線設定方法及びコンピュータプログラム |
CN106695787A (zh) * | 2016-12-17 | 2017-05-24 | 上海新时达电气股份有限公司 | 一种速度规划方法 |
CN107160394A (zh) * | 2017-05-27 | 2017-09-15 | 西安精雕软件科技有限公司 | 一种直线运动模组精确控制方法 |
CN107198832A (zh) * | 2016-06-14 | 2017-09-26 | 上海联影医疗科技有限公司 | 统一的轨迹生成方法及系统 |
CN108804562A (zh) * | 2018-05-22 | 2018-11-13 | 深圳市数字城市工程研究中心 | 一种保持速度特征的道路网约束轨迹线化简方法 |
CN108890645A (zh) * | 2018-06-30 | 2018-11-27 | 天津大学 | 一种五自由度混联机器人驱动关节零点误差的补偿方法 |
-
2019
- 2019-01-31 CN CN201910097753.1A patent/CN109814496B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004258700A (ja) * | 2003-02-24 | 2004-09-16 | Keyence Corp | 位置決めシステムの同期曲線設定方法及びコンピュータプログラム |
CN107198832A (zh) * | 2016-06-14 | 2017-09-26 | 上海联影医疗科技有限公司 | 统一的轨迹生成方法及系统 |
CN106695787A (zh) * | 2016-12-17 | 2017-05-24 | 上海新时达电气股份有限公司 | 一种速度规划方法 |
CN107160394A (zh) * | 2017-05-27 | 2017-09-15 | 西安精雕软件科技有限公司 | 一种直线运动模组精确控制方法 |
CN108804562A (zh) * | 2018-05-22 | 2018-11-13 | 深圳市数字城市工程研究中心 | 一种保持速度特征的道路网约束轨迹线化简方法 |
CN108890645A (zh) * | 2018-06-30 | 2018-11-27 | 天津大学 | 一种五自由度混联机器人驱动关节零点误差的补偿方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109814496A (zh) | 2019-05-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109814496B (zh) | 一种s型加减速轨迹规划中多轴时间同步方法 | |
CN108319144B (zh) | 一种机器人轨迹跟踪控制方法及系统 | |
CN103080859B (zh) | 轨迹控制装置 | |
CN107850887B (zh) | S型曲线规划方法、装置及数控机床 | |
CN110989650B (zh) | 一种基于火箭返回的着陆控制方法和装置 | |
US8290611B2 (en) | Blending algorithm for trajectory planning | |
CN108628172B (zh) | 一种基于扩张状态观测器的机械臂高精度运动控制方法 | |
CN107608344B (zh) | 基于轨迹规划的车辆运动控制方法、装置及相关设备 | |
CN111506081B (zh) | 一种机器人轨迹跟踪方法、系统及存储介质 | |
CN108890644B (zh) | 一种多轴同步轨迹规划方法、系统及计算机可读存储介质 | |
CN109991934B (zh) | 一种时间最优的在线s型加减速规划方法 | |
CN114952868B (zh) | 7自由度srs型机械臂控制方法及装置、弹琴机器人 | |
CN104204977A (zh) | 轨迹控制装置 | |
CN105955203A (zh) | CANopen伺服系统中速度前馈和转矩前馈的处理方法 | |
CN111052015A (zh) | 数控系统及电动机控制装置 | |
CN108472808B (zh) | 多个机器人的同步 | |
CN113111404B (zh) | 一种加工轨迹的空间连续小线段圆弧与直线拟合方法 | |
CN113442170B (zh) | 一种对机械臂路径冗余节点的反向拆分计算的方法及系统 | |
CN113021329B (zh) | 一种机器人运动控制方法、装置、可读存储介质及机器人 | |
CN112405537A (zh) | 一种机器人空间轨迹插补方法及机器人 | |
CN107016209B (zh) | 一种工业机器人和导轨协同规划方法 | |
CN116872197A (zh) | 单杆机械臂的自适应神经网络反演控制方法及其控制系统 | |
CN115586770A (zh) | 基于龙芯嵌入式系统部署ros的机器人路径规划方法 | |
CN113848978A (zh) | 一种基于精确线性化的三维轨迹跟踪制导律设计方法 | |
CN109711010B (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 |