CN107544247B - 一种抑制机械运动结构振动的方法及系统 - Google Patents
一种抑制机械运动结构振动的方法及系统 Download PDFInfo
- Publication number
- CN107544247B CN107544247B CN201710812925.XA CN201710812925A CN107544247B CN 107544247 B CN107544247 B CN 107544247B CN 201710812925 A CN201710812925 A CN 201710812925A CN 107544247 B CN107544247 B CN 107544247B
- Authority
- CN
- China
- Prior art keywords
- control curve
- continuous input
- control
- input shaper
- time
- 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
- 238000000034 method Methods 0.000 title claims abstract description 26
- 230000002401 inhibitory effect Effects 0.000 title description 4
- 230000036461 convulsion Effects 0.000 claims abstract description 30
- 238000013016 damping Methods 0.000 claims abstract description 14
- 238000004590 computer program Methods 0.000 claims description 3
- 230000006870 function Effects 0.000 claims description 3
- 238000007493 shaping process Methods 0.000 abstract description 5
- 230000001133 acceleration Effects 0.000 description 4
- 230000004044 response Effects 0.000 description 4
- 230000008901 benefit Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 239000003638 chemical reducing agent Substances 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
Images
Landscapes
- Control Of Position Or Direction (AREA)
- Control Of Electric Motors In General (AREA)
- Pharmaceuticals Containing Other Organic And Inorganic Compounds (AREA)
Abstract
公开了一种抑制机械运动结构振动的方法及系统。该方法包括:1)计算机械运动结构S型控制曲线的最优加加速度时间;2)基于控制系统的固有频率及阻尼比设置连续输入整形器,并按照伺服周期将其离散化;3)考虑所述连续输入整形器的时滞来计算S型控制曲线的实际加加速度时间;4)基于伺服周期对所述S型控制曲线进行离散并生成当前周期控制指令;5)应用步骤2)中离散化的连续输入整形器对所述当前周期控制指令进行离散卷积,将结果作为伺服电机的控制指令。本发明避免了一般输入整形产生的高速运行振动加剧现象,并且在原有控制基础上,无需增加硬件设备,节省成本。
Description
技术领域
本发明涉及机械控制技术领域,更具体地,涉及一种抑制机械运动结构振动的方法及系统。
背景技术
包括工业机器人、数控机床、数控机械结构等电机驱动的机械运动结构具有高速度、高精度和高平稳性的要求。由于减速器或皮带轮等传动部件的存在,机械运动结构通常具有一定程度的柔性。在低速运行及启动、停止阶段,机械运动结构末端会产生振动现象。机械结构的振动不光会降低系统对指令的响应速度,还会增加工序间的等待时间,降低生产效率与精度。因此,必须要采取有效的措施对机械运动结构的振动进行抑制。
目前的研究主要采用增大系统阻尼、增大结构刚度、PID控制、输入整形等方式控制机械运动结构的振动问题。但是这些控制方法均存在不足。采用增大系统阻尼、增大结构刚度等方法会增加系统整体重量、使系统能耗增大,也容易影响系统的响应速度。利用PID控制方法需要改变系统的控制结构及增加传感器设备,使控制系统复杂程度提高并增加控制成本。普通输入整形通常会增加系统的时滞,降低指令的响应速度。因此,有必要开发一种能够有效抑制机械运动结构振动的方法及系统。
公开于本发明背景技术部分的信息仅仅旨在加深对本发明的一般背景技术的理解,而不应当被视为承认或以任何形式暗示该信息构成已为本领域技术人员所公知的现有技术。
发明内容
为了实现机械运动结构全工况下的平稳、快速、精确位置控制,本发明提出了一种结合连续输入整形技术与最优S型控制曲线的振动抑制方法。
根据本发明的一方面,提出一种抑制机械运动结构振动的方法。该方法包括:
1)计算机械运动结构S型控制曲线的最优加加速度时间;
2)基于控制系统的固有频率及阻尼比设置连续输入整形器,并按照伺服周期将其离散化;
3)考虑所述连续输入整形器的时滞来计算S型控制曲线的实际加加速度时间;
4)基于伺服周期对所述S型控制曲线进行离散并生成当前周期控制指令;
5)应用步骤2)中离散化的连续输入整形器对所述当前周期控制指令进行离散卷积,将结果作为伺服电机的控制指令。
优选地,在步骤3)中通过将S型控制曲线的最优加加速度时间减去连续输入整形器的时滞作为S型控制曲线的实际加加速度时间。
优选地,所述S型控制曲线为五段S型控制曲线,其公式为:
其中,je为S型控制曲线的加加速度值,tr为S型控制曲线的加加速度时间,ts为S型控制曲线的总时长。
5、优选地,在步骤1)中,S型控制曲线的最优加加速度时间通过求解以下公式并结合k的最小允许值来确定:
其中,k=1,2,3...,ωn为控制系统的固有频率。
优选地,公式(2)通过使机械运动结构末端位置响应模型中Ax和Ay为零而获得,Ax和Ay的公式分别为:
其中,ωn为系统的固有频率,kx(t)、ky(t)为振幅系数函数,
优选地,连续输入整形器的公式为:
优选地,连续输入整形器的时滞通过以下公式计算:
优选地,包括5)包括以下子步骤:
5.1)初始化包含m位的指令缓存器队列P(m);
5.2)队列以先进先出的原则,进行左移位,接收当前周期控制指令并将新指令填入空位中,生成当前时刻队列;
5.3)当前时刻队列与离散化的连续输入整形器进行卷积;
5.4)将等于缓存器队列长度的对应位置上的结果值作为伺服电机的控制指令进行输出。
根据本发明的另一方面提出一种抑制机械运动结构振动的系统。所述系统包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述程序时实现以下步骤:
1)计算机械运动结构S型控制曲线的最优加加速度时间;
2)基于控制系统的固有频率及阻尼比设置连续输入整形器,并按照伺服周期将其离散化;
3)考虑所述连续输入整形器的时滞来计算S型控制曲线的实际加加速度时间;
4)基于伺服周期对所述S型控制曲线进行离散并生成当前周期控制指令;
5)应用步骤2)中离散化的连续输入整形器对所述当前周期控制指令进行离散卷积,将结果作为伺服电机的控制指令。
优选地,在步骤3)中通过将S型控制曲线的最优加加速度时间减去连续输入整形器的时滞作为S型控制曲线的实际加加速度时间。
相较于普通的最优S型控制曲线控制策略,根据本发明的抑制机械运动结构振动的方法及系统生成的控制曲线具有光滑的加速度曲线与连续的加加速度曲线,避免了应用一般输入整形器时产生的响应时滞,避免了一般输入整形产生的高速运行振动加剧现象,并且在原有控制基础上,无需增加硬件设备,节省成本。
本发明的方法和装置具有其它的特性和优点,这些特性和优点从并入本文中的附图和随后的具体实施例中将是显而易见的,或者将在并入本文中的附图和随后的具体实施例中进行详细陈述,这些附图和具体实施例共同用于解释本发明的特定原理。
附图说明
通过结合附图对本发明示例性实施例进行更详细的描述,本发明的上述以及其它目的、特征和优势将变得更加明显,其中,在本发明示例性实施例中,相同的参考标号通常代表相同部件。
图1为根据本发明的示例性实施方案的抑制机械运动结构振动的方法的流程图;
图2为根据本发明生成的控制曲线与一般S型控制曲线的对比图。
具体实施方式
下面将参照附图更详细地描述本发明。虽然附图中显示了本发明的优选实施例,然而应该理解,可以以各种形式实现本发明而不应被这里阐述的实施例所限制。相反,提供这些实施例是为了使本发明更加透彻和完整,并且能够将本发明的范围完整地传达给本领域的技术人员。
以下参考图1详细描述根据本发明的抑制机械运动结构振动的方法。该方法主要包括:
步骤1:计算机械运动结构S型控制曲线的最优加加速度时间。
在一个示例中,所述S型控制曲线为五段S型控制曲线,其公式为:
其中,je为S型控制曲线的加加速度值,tr为S型控制曲线的加加速度时间,ts为S型控制曲线的总时长。
基于上述S型控制曲线公式,其加速度、速度、位移的公式分别为:
S型控制曲线的最优加加速度时间通过求解以下公式并结合k的最小允许值来确定:
其中,k=1,2,3...,ωn为控制系统的固有频率。
公式(2)根据k的不同可以得到多个解,但由于机械结构与电机的诸多限制,使得je有限制,不能过大,因此tr不能过小,因此k需要根据允许的最小值来确定,即可以在je、tr允许的条件下尽可能的小。也就最说,公式(2)的tr是准最优解,即是多个理论上具有相同效果的解,但越大的k会引入越多的建模误差,因此只有所允许的最小值具有最优效果。
公式(2)通过使机械运动结构末端位置响应模型中Ax和Ay为零而获得,Ax和Ay的公式分别为:
其中,ωn为系统的固有频率,kx(t)、ky(t)为振幅系数函数,
步骤2:基于控制系统的固有频率及阻尼比设置连续输入整形器,并按照伺服周期将其离散化;
在一个示例中,连续输入整形器的公式为:
连续输入整形器的时滞通过以下公式计算:
步骤3:考虑所述连续输入整形器的时滞来计算S型控制曲线的实际加加速度时间。
在一个示例中,通过将S型控制曲线的最优加加速度时间减去连续输入整形器的时滞作为S型控制曲线的实际加速度时间。
则S型控制曲线的实际加加速度时间为:
其中,k=2,3…。
步骤4:基于控制器内按照步骤3确定的实际加加速度时间确定最终S型控制曲线,并基于伺服周期对其离散以生成当前周期控制指令。
步骤5:应用步骤2中离散化的连续输入整形器对所述当前周期控制指令进行离散卷积,将结果作为伺服电机的控制指令。
在一个示例中,通过以下子步骤实现离散化的连续输入整形器对所述当前周期控制指令的离散卷积:
5.1)初始化包含m位的指令缓存器队列P(m);
5.2)队列以先进先出的原则,进行左移位,接收当前周期控制指令并将新指令填入空位中,生成当前时刻队列;
5.3)当前时刻队列与离散化的连续输入整形器进行卷积;
5.4)将等于缓存器队列长度的对应位置上的结果值作为伺服电机的控制指令进行输出。
本发明还提出了一种抑制机械运动结构振动的系统,该系统包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述程序时实现以下步骤:
1)计算机械运动结构S型控制曲线的最优加加速度时间;
2)基于控制系统的固有频率及阻尼比设置连续输入整形器,并按照伺服周期将其离散化;
3)考虑所述连续输入整形器的时滞来计算S型控制曲线的实际加加速度时间;
4)基于伺服周期对所述S型控制曲线进行离散并生成当前周期控制指令;
5)应用步骤2)中离散化的连续输入整形器对所述当前周期控制指令进行离散卷积,将结果作为伺服电机的控制指令。
在一个示例中,在步骤3)中通过将S型控制曲线的最优加加速度时间减去连续输入整形器的时滞作为S型控制曲线的实际加加速度时间。
本领域技术人员应理解,上面对本发明的实施例的描述的目的仅为了示例性地说明本发明的实施例的有益效果,并不意在将本发明的实施例限制于所给出的任何示例。
以上已经描述了本发明的各实施例,上述说明是示例性的,并非穷尽性的,并且也不限于所披露的各实施例。在不偏离所说明的各实施例的范围和精神的情况下,对于本技术领域的普通技术人员来说许多修改和变更都是显而易见的。本文中所用术语的选择,旨在最好地解释各实施例的原理、实际应用或对市场中的技术的改进,或者使本技术领域的其它普通技术人员能理解本文披露的各实施例。
Claims (10)
1.一种抑制机械运动结构振动的方法,其特征在于,包括:
1)计算机械运动结构S型控制曲线的最优加加速度时间;
2)基于控制系统的固有频率及阻尼比设置连续输入整形器,并按照伺服周期将其离散化;
3)考虑所述连续输入整形器的时滞来计算S型控制曲线的实际加加速度时间;
4)基于伺服周期对所述S型控制曲线进行离散并生成当前周期控制指令;
5)应用步骤2)中离散化的连续输入整形器对所述当前周期控制指令进行离散卷积,将结果作为伺服电机的控制指令。
2.根据权利要求1所述的抑制机械运动结构振动的方法,其中,在步骤3)中通过将S型控制曲线的最优加加速度时间减去连续输入整形器的时滞作为S型控制曲线的实际加加速度时间。
8.根据权利要求1或2所述的抑制机械运动结构振动的方法,其中,包括5)包括以下子步骤:
5.1)初始化包含m位的指令缓存器队列P(m);
5.2)队列以先进先出的原则,进行左移位,接收当前周期控制指令并将新指令填入空位中,生成当前时刻队列;
5.3)当前时刻队列与离散化的连续输入整形器进行卷积;
5.4)将等于缓存器队列长度的对应位置上的结果值作为伺服电机的控制指令进行输出。
9.一种抑制机械运动结构振动的系统,其特征在于,所述系统包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述程序时实现以下步骤:
1)计算机械运动结构S型控制曲线的最优加加速度时间;
2)基于控制系统的固有频率及阻尼比设置连续输入整形器,并按照伺服周期将其离散化;
3)考虑所述连续输入整形器的时滞来计算S型控制曲线的实际加加速度时间;
4)基于伺服周期对所述S型控制曲线进行离散并生成当前周期控制指令;
5)应用步骤2)中离散化的连续输入整形器对所述当前周期控制指令进行离散卷积,将结果作为伺服电机的控制指令。
10.根据权利要求9所述的抑制机械运动结构振动的系统,其中,在步骤3)中通过将S型控制曲线的最优加加速度时间减去连续输入整形器的时滞作为S型控制曲线的实际加加速度时间。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710812925.XA CN107544247B (zh) | 2017-09-11 | 2017-09-11 | 一种抑制机械运动结构振动的方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710812925.XA CN107544247B (zh) | 2017-09-11 | 2017-09-11 | 一种抑制机械运动结构振动的方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107544247A CN107544247A (zh) | 2018-01-05 |
CN107544247B true CN107544247B (zh) | 2020-09-01 |
Family
ID=60963355
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710812925.XA Active CN107544247B (zh) | 2017-09-11 | 2017-09-11 | 一种抑制机械运动结构振动的方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107544247B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110239140B (zh) * | 2019-06-13 | 2021-06-15 | 博众精工科技股份有限公司 | 一种基于输入整形的伺服压合设备压力控制方法 |
CN113848700A (zh) * | 2020-06-28 | 2021-12-28 | 北京配天技术有限公司 | 一种机器人抖动抑制方法、装置、设备及可读存储介质 |
CN111857201B (zh) * | 2020-07-27 | 2021-06-22 | 广东博智林机器人有限公司 | 低频振动抑制方法、装置、伺服控制器及存储介质 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103713581A (zh) * | 2013-12-12 | 2014-04-09 | 南京工程学院 | 运动控制系统s曲线加减速的实现方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5246269B2 (ja) * | 2008-12-25 | 2013-07-24 | トヨタ自動車株式会社 | 減衰力制御装置 |
CN102636993A (zh) * | 2012-04-19 | 2012-08-15 | 徐州工程学院 | 抑制机器人柔性臂末端颤动的方法 |
CN106444635B (zh) * | 2015-08-04 | 2019-09-13 | 深圳市雷赛智能控制股份有限公司 | 一种运动控制系统的非对称s曲线加减速控制方法和装置 |
CN105182906B (zh) * | 2015-09-24 | 2017-09-01 | 哈尔滨工业大学 | 基于高阶s型运动轨迹的位置与速度控制方法 |
CN106154838A (zh) * | 2016-09-05 | 2016-11-23 | 深圳易能电气技术股份有限公司 | 一种定位装置的残余振荡抑制方法及系统 |
CN106945042B (zh) * | 2017-03-29 | 2019-05-28 | 浙江工业大学 | 一种机械手的离散s型曲线速度控制方法 |
-
2017
- 2017-09-11 CN CN201710812925.XA patent/CN107544247B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103713581A (zh) * | 2013-12-12 | 2014-04-09 | 南京工程学院 | 运动控制系统s曲线加减速的实现方法 |
Non-Patent Citations (2)
Title |
---|
数控系统的直线和S 形加减速研究;陈友东等;《中国机械工程》;20060831;第17卷(第15期);1600-1604 * |
数控系统的直线和S形加减速离散算法;陈友东等;《中国机械工程》;20100331;第21卷(第5期);567-570 * |
Also Published As
Publication number | Publication date |
---|---|
CN107544247A (zh) | 2018-01-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR102601888B1 (ko) | 구성 종속적인 동역학적 시스템의 진동 제어 | |
JP6490127B2 (ja) | 機械学習装置、サーボ制御装置、サーボ制御システム、及び機械学習方法 | |
CN107544247B (zh) | 一种抑制机械运动结构振动的方法及系统 | |
Xie et al. | Vibration reduction for flexible systems by command smoothing | |
CN106873383B (zh) | 一种降低工业机器人振动的在线控制方法 | |
CN105619424B (zh) | 电机驱动设备的控制设备及方法、多轴电机的控制设备 | |
CN108958036B (zh) | 一种基于频率特征识别的柔性操作臂弹性振动抑制方法 | |
Boscariol et al. | Robust point-to-point trajectory planning for nonlinear underactuated systems: Theory and experimental assessment | |
CN109571432A (zh) | 一种基于力传感器的机器人直接示教方法 | |
JP2018073097A (ja) | 工具経路生成装置、工具経路生成方法及び工具経路生成プログラム | |
Yu et al. | A rate-difference disturbance observer control for a timing-belt servo system | |
JP2007272597A (ja) | ロボットの加減速パターン生成方法 | |
JP5499865B2 (ja) | 多関節型ロボットの速度指令プロファイルの生成方法 | |
CN111015661B (zh) | 一种机器人柔性负载主动振动控制方法和系统 | |
KR100722857B1 (ko) | 속도프로파일생성장치 및 그 제어방법 | |
JP6735452B2 (ja) | モータ制御装置 | |
CN117047771A (zh) | 机器人的柔顺控制方法、装置及电子设备 | |
US20230191600A1 (en) | Motion control method, robot, and computer-readable storage medium | |
JP4587052B2 (ja) | 位置制御装置、位置制御方法及び位置制御プログラム | |
JP2014117787A (ja) | 制御装置 | |
JP2005044230A (ja) | ロボット制御装置 | |
Kubus et al. | 1kHz is not enough—How to achieve higher update rates with a bilateral teleoperation system based on commercial hardware | |
KR100975631B1 (ko) | 펄스변조용 커넥터 및 모션 제어 펄스의 실시간 변조방법 | |
Saito et al. | Compensation of Integrated Resonant and Time Delay System by UsingWave Compensator | |
KR101368847B1 (ko) | 모션 프로파일 생성방법 |
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 | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20240806 Address after: 901-189, 9th Floor, Building 17, No. 36 Shixing Street, Shijingshan District, Beijing 100041 Patentee after: Beijing Rayas Technology Co.,Ltd. Country or region after: China Address before: 100083 No. 37, Haidian District, Beijing, Xueyuan Road Patentee before: BEIHANG University Country or region before: China |