CN109542134A - 一种解决机构间隙引起抖动的速度控制算法 - Google Patents
一种解决机构间隙引起抖动的速度控制算法 Download PDFInfo
- Publication number
- CN109542134A CN109542134A CN201811294421.4A CN201811294421A CN109542134A CN 109542134 A CN109542134 A CN 109542134A CN 201811294421 A CN201811294421 A CN 201811294421A CN 109542134 A CN109542134 A CN 109542134A
- Authority
- CN
- China
- Prior art keywords
- speed
- reaches
- motion
- position reaches
- control algorithm
- 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.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D13/00—Control of linear speed; Control of angular speed; Control of acceleration or deceleration, e.g. of a prime mover
- G05D13/62—Control of linear speed; Control of angular speed; Control of acceleration or deceleration, e.g. of a prime mover characterised by the use of electric means, e.g. use of a tachometric dynamo, use of a transducer converting an electric value into a displacement
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种解决机构间隙引起抖动的速度控制算法,涉及机器人控制技术领域,包括以下步骤:步骤S1,机构从V0=0开始以恒定加速度a1开始运动t1秒,速度到达Vt时,位置到达S1;步骤S2,当速度达到Vt,位置达到S1时,机构开始以速度Vt作匀速运动t2秒,直到位置到达S2;步骤S3,当位置到达S2时,机构从Vt开始以恒定减速度a2开始运动t3秒,速度到达0时,恰好位置到达S。本发明将速度位置曲线变成匀速上升、匀速运动、匀速下降三个部分,可以有效解决启动时因机械本体齿轮啮合不到位等机构缺陷和各轴速度突变引起的震动问题,实现了机械本体平稳启动,消除机构抖动,提高工作精度。
Description
技术领域
本发明涉及机器人控制技术领域,特别是涉及一种解决机构间隙引起抖动的速度控制算法。
背景技术
随着时代进步,科技发展,越来越多的机械制造、装配行业需要使用机器人代替人工操作来使得工作效率上升一个等级,从而实现降低成本提高质量的目标。然而,国内大多数的机器人硬件制作水平良莠不齐,会有机械零件之间啮合不到位的情况,例如机器人各轴的齿轮啮合不到位问题。而且目前的机器人启动时,控制器给的启动速度是反应时间短,可以看成瞬间将速度提至目标速度(速度曲线接近矩形),机械本体来不及反应,容易产生启动或者停止时的抖动,影响到机械的定位精度等等导致工作精度受到影响。
在生产线上,机器人往往多次进行速度变换,为了减少机械本体零件之间的碰撞抖动,提高工作精度,延长机械零件的寿命,如何将机械运动控制时的启动速度逐渐上升到目标速度,再逐渐将目标速度降为0(速度曲线为等腰梯形),是很关键的。
发明内容
本发明的目的是提供一种解决机构间隙引起抖动的速度控制算法,将速度位置曲线变成匀速上升、匀速运动、匀速下降三个部分,可以有效解决启动时因机械本体齿轮啮合不到位等机构缺陷和各轴速度突变引起的震动问题,实现了机械本体平稳启动,消除机构抖动,提高工作精度。为实现上述目的,本发明提供了如下方案:
本发明提供一种解决机构间隙引起抖动的速度控制算法,包括以下步骤:
步骤S1,机构从V0=0开始以恒定加速度a1开始运动t1秒,速度到达Vt时,位置到达S1;
步骤S2,当速度达到Vt,位置达到S1时,机构开始以速度Vt作匀速运动t2秒,直到位置到达S2;
步骤S3,当位置到达S2时,机构从Vt开始以恒定减速度a2开始运动t3秒,速度到达0时,恰好位置到达S。
优选地,所述步骤S1中包含以下步骤:
S1.1、当V0=0时,有Vt=a1·t1,已知a1是***给定,Vt是目标速度,计算得出t1;
S1.2、那么可以算出速度上升阶段,所走过的路程:
优选地,所述步骤S2中包含以下步骤:
S2.1、其中t2无需理会,因为速度曲线是等腰梯形,那么速度上升阶段和速度下降阶段是等距离,当距离跑到:其中S是目标距离,结束步骤2,进入步骤3。
优选地,所述步骤S3中包含以下步骤:
S3.1、当到达S2时,机构从Vt开始以恒定加速度a2做运动,速度到达0时,恰好位置到达S,其中a2与a1大小相等方向相反。
本发明相对于现有技术取得了以下有益技术效果:
本发明将速度位置曲线变成匀速上升、匀速运动、匀速下降三个部分,可以有效解决启动时因机械本体齿轮啮合不到位等机构缺陷和各轴速度突变引起的震动问题,实现了机械本体平稳启动,消除机构抖动,提高工作精度。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为机器人运动速度与位置关系图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明的目的是提供一种解决机构间隙引起抖动的速度控制算法,将速度位置曲线变成匀速上升、匀速运动、匀速下降三个部分,可以有效解决启动时因机械本体齿轮啮合不到位等机构缺陷和各轴速度突变引起的震动问题,实现了机械本体平稳启动,消除机构抖动,提高工作精度。
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。
本实施例提供一种解决机构间隙引起抖动的速度控制算法,包括以下步骤:
步骤S1,机构从V0=0开始以恒定加速度a1开始运动t1秒,速度到达Vt时,位置到达S1;
步骤S2,当速度达到Vt,位置达到S1时,机构开始以速度Vt作匀速运动t2秒,直到位置到达S2;
步骤S3,当位置到达S2时,机构从Vt开始以恒定减速度a2开始运动t3秒,速度到达0时,恰好位置到达S。
进一步地,所述步骤S1中包含以下步骤:
S1.1、当V0=0时,有Vt=a1·t1,已知a1是***给定,Vt是目标速度,计算得出t1;
S1.2、那么可以算出速度上升阶段,所走过的路程:
进一步地,所述步骤S2中包含以下步骤:
S2.1、其中t2无需理会,因为速度曲线是等腰梯形,那么速度上升阶段和速度下降阶段是等距离,当距离跑到:其中S是目标距离,结束步骤2,进入步骤3。
进一步地,所述步骤S3中包含以下步骤:
S3.1、当到达S2时,机构从Vt开始以恒定加速度a2做运动,速度到达0时,恰好位置到达S,其中a2与a1大小相等方向相反。
本发明应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处。综上,本说明书内容不应理解为对本发明的限制。
Claims (4)
1.一种解决机构间隙引起抖动的速度控制算法,其特征在于,包括以下步骤:
步骤S1,机构从V0=0开始以恒定加速度a1开始运动t1秒,速度到达Vt时,位置到达S1;
步骤S2,当速度达到Vt,位置达到S1时,机构开始以速度Vt作匀速运动t2秒,直到位置到达S2;
步骤S3,当位置到达S2时,机构从Vt开始以恒定减速度a2开始运动t3秒,速度到达0时,恰好位置到达S。
2.根据权利要求1所述的一种解决机构间隙引起抖动的速度控制算法,所述步骤S1中包含以下步骤:
S1.1、当V0=0时,有Vt=a1·t1,已知a1是***给定,Vt是目标速度,计算得出t1;S1.2、那么可以算出速度上升阶段,所走过的路程:
3.根据权利要求1所述的一种解决机构间隙引起抖动的速度控制算法,所述步骤S2中包含以下步骤:
S2.1、其中t2无需理会,因为速度曲线是等腰梯形,那么速度上升阶段和速度下降阶段是等距离,当距离跑到:其中S是目标距离,结束步骤2,进入步骤3。
4.根据权利要求1所述的一种解决机构间隙引起抖动的速度控制算法,所述步骤S3中包含以下步骤:
S3.1、当到达S2时,机构从Vt开始以恒定加速度a2做运动,速度到达0时,恰好位置到达S,其中a2与a1大小相等方向相反。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811294421.4A CN109542134A (zh) | 2018-10-24 | 2018-10-24 | 一种解决机构间隙引起抖动的速度控制算法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811294421.4A CN109542134A (zh) | 2018-10-24 | 2018-10-24 | 一种解决机构间隙引起抖动的速度控制算法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109542134A true CN109542134A (zh) | 2019-03-29 |
Family
ID=65845776
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811294421.4A Pending CN109542134A (zh) | 2018-10-24 | 2018-10-24 | 一种解决机构间隙引起抖动的速度控制算法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109542134A (zh) |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101615038A (zh) * | 2009-07-21 | 2009-12-30 | 西安交通大学 | 高速加工中心速度优化与平滑运动控制方法 |
CN103728923A (zh) * | 2013-12-24 | 2014-04-16 | 嘉兴学院 | 一种高效高平稳的数控***柔性加减速控制方法 |
CN106346497A (zh) * | 2016-08-31 | 2017-01-25 | 天津市松正电动汽车技术股份有限公司 | 一种电动车充电桩机械臂的控制方法 |
CN106444645A (zh) * | 2016-08-17 | 2017-02-22 | 义乌朝晖智能科技有限公司 | 一种基于嵌入式裁床控制器的多轴联动运动控制方法 |
CN107290959A (zh) * | 2017-06-08 | 2017-10-24 | 浙江理工大学 | 一种基于位移等效的机器人笛卡尔空间速度优化方法 |
CN107825424A (zh) * | 2017-10-31 | 2018-03-23 | 河北工业大学 | 一种高速机械手减少残余振动的非对称s型轨迹规划方法 |
CN107844058A (zh) * | 2017-11-24 | 2018-03-27 | 北京特种机械研究所 | 一种运动曲线离散动态规划方法 |
CN108153246A (zh) * | 2017-12-26 | 2018-06-12 | 哈工大机器人(合肥)国际创新研究院 | 一种基于指定速度的参数自适应s形速度规划插补方法 |
CN108189038A (zh) * | 2018-01-18 | 2018-06-22 | 广东工业大学 | 一种实用的工业六轴机械臂直线运动轨迹规划方法及*** |
-
2018
- 2018-10-24 CN CN201811294421.4A patent/CN109542134A/zh active Pending
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101615038A (zh) * | 2009-07-21 | 2009-12-30 | 西安交通大学 | 高速加工中心速度优化与平滑运动控制方法 |
CN103728923A (zh) * | 2013-12-24 | 2014-04-16 | 嘉兴学院 | 一种高效高平稳的数控***柔性加减速控制方法 |
CN106444645A (zh) * | 2016-08-17 | 2017-02-22 | 义乌朝晖智能科技有限公司 | 一种基于嵌入式裁床控制器的多轴联动运动控制方法 |
CN106346497A (zh) * | 2016-08-31 | 2017-01-25 | 天津市松正电动汽车技术股份有限公司 | 一种电动车充电桩机械臂的控制方法 |
CN107290959A (zh) * | 2017-06-08 | 2017-10-24 | 浙江理工大学 | 一种基于位移等效的机器人笛卡尔空间速度优化方法 |
CN107825424A (zh) * | 2017-10-31 | 2018-03-23 | 河北工业大学 | 一种高速机械手减少残余振动的非对称s型轨迹规划方法 |
CN107844058A (zh) * | 2017-11-24 | 2018-03-27 | 北京特种机械研究所 | 一种运动曲线离散动态规划方法 |
CN108153246A (zh) * | 2017-12-26 | 2018-06-12 | 哈工大机器人(合肥)国际创新研究院 | 一种基于指定速度的参数自适应s形速度规划插补方法 |
CN108189038A (zh) * | 2018-01-18 | 2018-06-22 | 广东工业大学 | 一种实用的工业六轴机械臂直线运动轨迹规划方法及*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106060380A (zh) | 一种联动相机控制***及控制方法 | |
CN101373947B (zh) | 一种步进电机速度的控制方法、装置及*** | |
CN107070327B (zh) | 一种步进电机控制方法及装置 | |
CN110023856B (zh) | 通过使用s型曲线生成运动轮廓的方法及计算装置 | |
JPH0776490A (ja) | クレーンの旋回自動停止制御装置 | |
CN106044567B (zh) | 桥式吊车局部饱和自适应控制器、控制***及控制方法 | |
CN109449598A (zh) | 一种电调天线的倾角调整方法及对应装置 | |
CN103375662A (zh) | 三维悬挂运动控制高空拍摄用吊挂***及其运动拍摄方法 | |
CN109542134A (zh) | 一种解决机构间隙引起抖动的速度控制算法 | |
CN113489393A (zh) | 一种永磁式步进电机细分驱动方法 | |
CN109807297B (zh) | 连铸结晶器非正弦振动方法 | |
CN106374798B (zh) | 一种可变细分数的步进电机加减速控制方法 | |
CN116808408A (zh) | 介入导丝控制方法和介入导航*** | |
CN109766514B (zh) | 连铸结晶器非正弦振动方法 | |
CN109483551B (zh) | 一种控制机器人多轴运动的方法、装置及*** | |
CN111051010B (zh) | 机器人控制装置 | |
CN105118079A (zh) | 动画位移拉伸方法、装置及运动控制方法、装置 | |
JP3237557B2 (ja) | クレーン吊り荷の振れ止め制御方法 | |
CN110815217B (zh) | 一种基于速度控制模式的机器人伺服力矩控制方法 | |
CN106149672B (zh) | 防止夯锤晃动的控制***和方法、及强夯机 | |
CN113635306A (zh) | 机器人紧急制动方法、机器人及存储介质 | |
JP2008056424A (ja) | 移動体の位置表示装置 | |
JP2017102730A (ja) | 同期運転教示データ作成時の確認手段を備える制御装置 | |
CN1920722A (zh) | 模拟型位置s型平滑命令产生方法 | |
JP2001092508A (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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190329 |
|
RJ01 | Rejection of invention patent application after publication |