CN113414769B - 柔性六自由度运动平台保护方法 - Google Patents
柔性六自由度运动平台保护方法 Download PDFInfo
- Publication number
- CN113414769B CN113414769B CN202110799509.7A CN202110799509A CN113414769B CN 113414769 B CN113414769 B CN 113414769B CN 202110799509 A CN202110799509 A CN 202110799509A CN 113414769 B CN113414769 B CN 113414769B
- Authority
- CN
- China
- Prior art keywords
- flexible
- motion platform
- oscillation
- degree
- freedom motion
- 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/1656—Programme controls characterised by programming, planning systems for manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/06—Safety devices
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Control Of Position Or Direction (AREA)
Abstract
本发明涉及一种柔性六自由度运动平台保护方法,包括:在控制器内加入保护程序,实时监测反馈信号与控制信号;保护程序如果监测到反馈信号与控制信号有异常,则停止发送控制信号并继续对反馈信号进行监测;保护程序在震荡仍然持续时输出激励信号,激励所述柔性六自由度运动平台产生位移,提前结束震荡;待震荡结束后停止发送激励信号,使所述柔性六自由度运动平台返回激励前位置继续闭环或者等待。本发明能够及时使柔性六自由度运动平台恢复到闭环状态并防止震荡状态造成的运动平台硬件损坏。
Description
技术领域
本发明涉及一种柔性六自由度运动平台保护方法。
背景技术
在进行柔性六自由度运动平台定位精度调试时,为了实现较高的定位精度,通常控制器的控制带宽会调的很高。这时如果受到外界干扰或运动平台发生共振,会导致控制器闭环崩溃无法恢复到闭环状态或由于控制器不断发送控制信号使平台逐渐震荡。
然而,目前尚未有一种方法能够及时使柔性六自由度运动平台恢复到闭环状态并防止震荡状态造成的运动平台硬件损坏。
发明内容
有鉴于此,有必要提供一种柔性六自由度运动平台保护方法,其能够及时使柔性六自由度运动平台恢复到闭环状态并防止震荡状态造成的运动平台硬件损坏。
本发明提供一种柔性六自由度运动平台保护方法,该方法包括如下步骤:a.在控制器内加入保护程序,实时监测反馈信号与控制信号;b.保护程序如果监测到反馈信号与控制信号有异常,则停止发送控制信号并继续对反馈信号进行监测;c.保护程序在震荡仍然持续时输出激励信号,激励所述柔性六自由度运动平台产生位移,提前结束震荡;d.待震荡结束后停止发送激励信号,使所述柔性六自由度运动平台返回激励前位置继续闭环或者等待。
优选地,所述反馈信号为反馈装置反馈的柔性六自由度运动平台的位置信息,所述控制信号为在控制器末端加入保护程序后输出的控制信号。
优选地,所述的步骤a具体包括:
位置信息储存值逐点替换,对位置信息数组标准差σ进行计算,公式如下:
σ=sqrt(((x1-x)2+(x2-x)2+……(xn-x)2)/n)
优选地,所述的步骤b具体包括:
将控制信号、计算得到的位置信息数组标准差分别设置安全范围,实时对比位置信息数组标准差是否超出设定阈值、控制信号是否过大。
优选地,所述的步骤b还包括:
如果超出安全范围,保护程序自动解除控制器的闭环状态,并自动或发出询问是否需要产生激励以平复震荡。
优选地,所述的步骤c包括:
闭环状态下,如果标准差过大产生震荡,则命令控制器解除闭环,变为开环状态。
优选地,所述的步骤c还包括:
开环状态下,如果标准差过大震荡仍然持续,则输出激励信号,激励柔性六自由度运动平台产生位移提前结束震荡。
本发明有益效果如下:其一,本发明在柔性六自由度运动平台定位精度调试过程中产生共振时,能够解除闭环状态并平复震荡状态;其二,本发明在柔性六自由度运动平台受外界干扰产生震荡时,能够解除闭环状态并平复震荡状态;其三,本发明在柔性六自由度运动平台控制闭环崩溃时,能够快速会发到未闭环式平台稳定状态;其四,本发明能够在共振、震荡状态下对平台硬件提供保护措施。
附图说明
图1为本发明柔性六自由度运动平台保护方法的流程图;
图2为本发明实施例提供的柔性六自由度运动平台保护方法的运行环境示意图。
具体实施方式
下面结合附图及具体实施例对本发明作进一步详细的说明。
参阅图1所示,是本发明柔性六自由度运动平台保护方法较佳实施例的作业流程图。
请一并参阅图2,本发明实施例提供的柔性六自由度运动平台保护方法的运行环境,包括:控制器、致动器、柔性六自由度运动平台及反馈装置,其中,所述控制器包括控制所述柔性六自由度运动平台运动的控制算法。
步骤S1,在控制器内加入保护程序,实时监测反馈信号与控制信号。其中,所述反馈信号为反馈装置反馈的柔性六自由度运动平台的位置信息,所述控制信号为在控制器末端加入保护程序后输出的控制信号。
具体而言:
不断采集反馈装置反馈的位置信息并储存,储存数据量依据采样频率或控制周期而定。
在本实施例中,以3khz控制周期为例,位置信息储存数量为3000个。位置信息储存值逐点替换,对位置信息数组标准差σ进行计算,公式如下:
σ=sqrt(((x1-x)2+(x2-x)2+……(xn-x)2)/n)。
其中,x1、x2...xn分别为第1次、第2次……第n次记录位置信息,n为记录的位置信息总数。
步骤S2,保护程序如果监测到反馈信号与控制信号有异常,则停止发送控制信号并继续对反馈信号进行监测。具体而言:
将控制信号、计算得到的位置信息数组标准差分别设置安全范围,实时对比位置信息数组标准差是否超出设定阈值、控制信号是否过大。如果超出安全范围,保护程序自动解除控制器的闭环状态,并自动或发出询问是否需要产生激励以平复震荡。
步骤S3,保护程序在震荡仍然持续时输出激励信号,激励所述柔性六自由度运动平台产生位移,提前结束震荡。具体而言:
在本实施例中,所述激励设置为闭环、开环两种状态下不同的处理方式,闭环状态下,如果标准差过大产生震荡,则命令控制器解除闭环,变为开环状态;开环状态下,如果标准差过大震荡仍然持续,则输出激励信号,激励柔性六自由度运动平台产生位移提前结束震荡。
步骤S4,待震荡结束后停止发送激励信号,使所述柔性六自由度运动平台返回激励前位置继续闭环或者等待。
本发明主要基于柔性六自由度运动平台发生震荡时会产生较大位移差以及较大的控制信号,利用这种现象在控制算法中加入保护程序。保护程序负责监控位置信息反馈装置信息与控制信号,通过算法识别柔性六自由度运动平台是否处于控制器崩溃、震荡状态。处于控制器崩溃、震荡状态下利用保护程序使控制器不再输出闭环的控制信号,让柔性六自由度运动平台逐渐趋于稳定。如果控制信号不再输出时震荡仍然持续,保护程序会针对震荡自由度产生一在安全行程范围内持续的激励信号,激励柔性六自由度运动平台产生位移提前结束震荡。震荡结束后停止发送激励信号,使柔性六自由度运动平台回到控制位置继续进行闭环控制或等待。
虽然本发明参照当前的较佳实施方式进行了描述,但本领域的技术人员应能理解,上述较佳实施方式仅用来说明本发明,并非用来限定本发明的保护范围,任何在本发明的精神和原则范围之内,所做的任何修饰、等效替换、改进等,均应包含在本发明的权利保护范围之内。
Claims (2)
1.一种柔性六自由度运动平台保护方法,其特征在于,该方法包括如下步骤:
a.在控制器内加入保护程序,实时监测反馈信号与控制信号;所述反馈信号为反馈装置反馈的柔性六自由度运动平台的位置信息,所述控制信号为在控制器末端加入保护程序后输出的控制信号;
b.保护程序如果监测到反馈信号与控制信号有异常,则停止发送控制信号并继续对反馈信号进行监测;
c.保护程序在震荡仍然持续时输出激励信号,激励所述柔性六自由度运动平台产生位移,提前结束震荡;
d.待震荡结束后停止发送激励信号,使所述柔性六自由度运动平台返回激励前位置继续闭环或者等待;
所述的步骤b包括:
将控制信号、计算得到的位置信息数组标准差分别设置安全范围,实时对比位置信息数组标准差是否超出设定阈值、控制信号是否过大;
如果超出安全范围,保护程序自动解除控制器的闭环状态,并自动或发出询问是否需要产生激励以平复震荡;
所述的步骤c包括:
闭环状态下,如果标准差过大产生震荡,则命令控制器解除闭环,变为开环状态;
开环状态下,如果标准差过大震荡仍然持续,则输出激励信号,激励柔性六自由度运动平台产生位移提前结束震荡。
2.如权利要求1所述的方法,其特征在于,所述的步骤a具体包括:
位置信息储存值逐点替换,对位置信息数组标准差σ进行计算,公式如下:
σ=sqrt(((x1-x)2+(x2-x)2+……(xn-x)2)/n)
其中,x1、x2…xn分别为第1次、第2次……第n次记录位置信息,n为记录的位置信息总数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110799509.7A CN113414769B (zh) | 2021-07-15 | 2021-07-15 | 柔性六自由度运动平台保护方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110799509.7A CN113414769B (zh) | 2021-07-15 | 2021-07-15 | 柔性六自由度运动平台保护方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113414769A CN113414769A (zh) | 2021-09-21 |
CN113414769B true CN113414769B (zh) | 2022-11-22 |
Family
ID=77720990
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110799509.7A Active CN113414769B (zh) | 2021-07-15 | 2021-07-15 | 柔性六自由度运动平台保护方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113414769B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116151009B (zh) * | 2023-02-27 | 2023-07-18 | 哈尔滨工业大学 | 一种面向超精密运动系统的频响辨识方法 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3554325A (en) * | 1969-04-21 | 1971-01-12 | Westinghouse Electric Corp | Motor control mechanism |
JP3011084B2 (ja) * | 1995-12-27 | 2000-02-21 | 豊和工業株式会社 | 直線作動機 |
CN1932215B (zh) * | 2006-09-30 | 2010-08-11 | 三一重工股份有限公司 | 用于抑制混凝土泵车臂架振动的方法及装置 |
JP4893954B2 (ja) * | 2007-05-21 | 2012-03-07 | 株式会社タムロン | 像振れ防止用アクチュエータ、及びそれを備えたレンズユニット、カメラ |
CN202196247U (zh) * | 2011-08-19 | 2012-04-18 | 台湾东电化股份有限公司 | 防手震镜头对焦模块的共振抑制结构 |
CN102368113B (zh) * | 2011-10-31 | 2013-01-02 | 中国科学院长春光学精密机械与物理研究所 | 高精度光学元件装配装置的无应力装配方法 |
CN103728621B (zh) * | 2014-01-24 | 2016-03-09 | 中国科学院电子学研究所 | 一种采用顺轨干涉处理抑制平台振动的机载sal成像方法 |
US9625902B2 (en) * | 2014-03-31 | 2017-04-18 | Bose Corporation | Method and system for detecting integrity of a control loop of a physical system |
CN109080733A (zh) * | 2018-09-29 | 2018-12-25 | 北京云迹科技有限公司 | 机器人底盘和机器人 |
CN111590579B (zh) * | 2020-05-26 | 2022-09-13 | 山东理工大学 | 一种仿人柔性手臂共振抑制方法 |
-
2021
- 2021-07-15 CN CN202110799509.7A patent/CN113414769B/zh active Active
Non-Patent Citations (2)
Title |
---|
基于面形检测的光学元件多层膜均匀性测量;王辉;《基于面形检测的光学元件多层膜均匀性测量》;中国激光;20150710;第42卷(第7期);全文 * |
机电伺服系统极限环谐振现象的影响因素研究;汤力;《机电伺服系统极限环谐振现象的影响因素研究》;液压气动与密封;20190615;第39卷(第6期);第23-27页 * |
Also Published As
Publication number | Publication date |
---|---|
CN113414769A (zh) | 2021-09-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113414769B (zh) | 柔性六自由度运动平台保护方法 | |
CN204942709U (zh) | 阀定位器 | |
US9592605B2 (en) | Robot control method, robot control apparatus, robot control program, and storage medium | |
JP4720744B2 (ja) | サーボ制御装置 | |
US20110208354A1 (en) | Robot with learning control function | |
US11780515B2 (en) | Mitigating sensor noise in legged robots | |
US20210286192A1 (en) | Driving control apparatus, device, optical module and driving control method | |
JP5860755B2 (ja) | 電動機制御装置及びその自動調整法 | |
EP1758112A2 (en) | Information recording apparatus, information recording method and computer program | |
JP2010284758A (ja) | ロボットの制御装置、及びロボットの制御方法 | |
CN103234002A (zh) | 抑制臂架回转振动的设备、方法、系统及工程机械 | |
US11235470B2 (en) | Control apparatus, and processing method and program therefor | |
US11531316B2 (en) | Motor controller with preprocessing of a command value | |
US11890760B2 (en) | Balancer abnormality detection system and balancer abnormality detection method | |
WO2023246907A1 (zh) | 机械臂的控制方法、医疗系统、计算机设备 | |
JP4217254B2 (ja) | モービル型地震波検出警報装置 | |
JPH07130115A (ja) | 情報処理装置 | |
US11880120B2 (en) | Gimbal control method and device | |
JP2008264910A (ja) | ロボットの制御方法、ロボット制御装置およびロボット制御システム | |
JP2020154989A (ja) | 機械学習装置、制御システム及び機械学習方法 | |
US20210101304A1 (en) | Removably mountable abnormal motion detection device and safety feature engagement tool | |
CN111102315B (zh) | 基于磁流变阻尼器的弹射器后坐缓冲装置的控制方法 | |
JP5339152B2 (ja) | 電空変換器 | |
CN117484477A (zh) | 机械臂拖动示教方法和示教装置 | |
JP2769991B2 (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |