CN112987592A - 一种三轴气浮台控制过程中的动态调平系统及动态调平方法 - Google Patents
一种三轴气浮台控制过程中的动态调平系统及动态调平方法 Download PDFInfo
- Publication number
- CN112987592A CN112987592A CN202110174314.3A CN202110174314A CN112987592A CN 112987592 A CN112987592 A CN 112987592A CN 202110174314 A CN202110174314 A CN 202110174314A CN 112987592 A CN112987592 A CN 112987592A
- Authority
- CN
- China
- Prior art keywords
- dynamic
- air bearing
- attitude
- control
- bearing table
- 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
- 238000000034 method Methods 0.000 title claims abstract description 35
- 238000005259 measurement Methods 0.000 claims description 13
- 238000007667 floating Methods 0.000 claims description 10
- 238000004891 communication Methods 0.000 claims description 9
- 238000012545 processing Methods 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 2
- 238000004088 simulation Methods 0.000 abstract description 5
- 230000005540 biological transmission Effects 0.000 abstract description 2
- 230000007613 environmental effect Effects 0.000 abstract description 2
- 230000009286 beneficial effect Effects 0.000 abstract 1
- 238000010276 construction Methods 0.000 abstract 1
- 238000013500 data storage Methods 0.000 abstract 1
- 238000011161 development Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000004422 calculation algorithm Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000003032 molecular docking Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B17/00—Systems involving the use of models or simulators of said systems
- G05B17/02—Systems involving the use of models or simulators of said systems electric
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种三轴气浮台控制过程中的动态调平系统及动态调平方法,系统包括自动平衡装置、反作用飞轮、控制计算机、通信系统。动态调平方法包括无线局域网搭建、姿态数据信息传送、控制指令解算、动态干扰力矩估计与补偿、数据储存等步骤。本发明首次将反作用飞轮用于三轴气浮台的平衡调节,通过反作用飞轮对动态干扰力矩大小进行高精度估计,根据误差姿态角和右手定则原理判断动态干扰力矩方向。最后利用自动平衡装置实时补偿干扰力矩,实现三轴气浮台的高精度控制,同时提升了三轴气浮台的抗干扰能力与环境适应能力。有利于进行高置信度的航天器地面半物理仿真实验,确保航天器入轨后顺利完成指定任务。
Description
技术领域
本发明属于航天器地面半物理仿真技术领域,尤其涉及一种三轴气浮台控制过程中的动态调平系统,同时还涉及一种三轴气浮台控制过程中的动态调平方法。
背景技术
三轴气浮台是重要的航天器地面半物理仿真设备,可以对航天器姿态控制,航天器交会对接等进行高置信度的仿真。干扰力矩是限制气浮台使用的重要因素,随着半物理仿真技术的不断发展,气浮台的调平技术从开始的手动调节转变为了自动调节。现阶段大部分气浮台的干扰力矩补偿都依靠自动平衡系统完成,但仅局限于补偿气浮台正常控制前的干扰力矩,对在气浮台控制过程中产生的动态干扰力矩没有系统补偿方案,使得气浮台的控制精度难以得到较大的提升。
三轴气浮台在实际控制过程中,由于外界气流干扰、震动等因素会使原已重合的旋转中心与质心产生偏离,进而产生动态时变的干扰力矩。容易导致反作用飞轮转速饱和、气浮台控制精度降低甚至失控等问题。显而易见,传统的自动调平衡方案无法对动态时变的干扰力矩进行补偿,这极大的降低了气浮台的环境适应能力,限制了三轴气浮台的使用。
发明内容
发明目的:针对现有技术存在的问题,本发明的目的是提供一种三轴气浮台控制过程中的动态调平系统,本发明的另一目的是提供一种三轴气浮台控制过程中的动态调平方法。以实现对三轴气浮台在控制过程中产生的动态干扰力矩进行实时估计和补偿,提高提高三轴气浮台的控制精度,同时提高气浮台的环境适应能力。
技术方案:本发明所述的一种三轴气浮台控制过程中的动态调平系统,包括:
姿态测量系统,包括各类姿态传感器,其分布于气浮台体上,完成气浮台台体的姿态测量;
姿态控制系统,包括姿态控制执行机构和控制计算机;所述姿态控制执行机构包括反作用飞轮、冷气推力器以及X轴、Y轴、Z轴方向上的自动平衡装置,所述自动平衡装置包括步进电机、质量块与丝杆,所述步进电机转动时带动丝杆转动,进而移动质量块;所述控制计算机负责地面控制台和气浮台之间的通信和数据处理;
通信系统,用于气浮台及地面控制台之间的数据通信;
地面控制台,通过所述通信系统将操作指令传输至控制计算机,同时也接收显示控制计算机传输过来的气浮台的状态数据;
所述姿态控制系统通过反作用飞轮输出力矩的大小估计动态干扰力矩的大小,通过误差姿态角和右手定则原理判断动态干扰力矩的方向,最后通过步进电机的转动带动质量块移动,实现对动态干扰力矩的实时补偿。
进一步的,所述姿态传感器包括陀螺、倾角计、视觉测量系统;所述视觉测量系统以非接触方式对气浮平台的姿态进行测量,并将数据提供给控制计算机。
一种基于所述动态调平系统的三轴气浮台控制过程中的动态调平方法,包括如下步骤:
(1)动态干扰力矩大小判断:姿态敏感器采集带时间标签的气浮台实际姿态角和姿态角速度信息,控制计算机根据姿态敏感器采集的姿态信息,解算出的控制指令力矩,反作用飞轮执行该控制指令力矩,以加速或减速飞轮转子的形式来实现反作用飞轮力矩的输出,根据反作用飞轮实际输出力矩,估计动态干扰力矩大小;
(2)动态干扰力矩方向判断:根据误差姿态角和右手定则原理判断动态干扰力矩方向;步骤(2)具体包括如下内容:
定义气浮台实际姿态角为β,目标姿态角为α,误差姿态角δ=β-α;
控制计算机将误差姿态角的绝对值|δ|与姿态控制执行机构的控制精度τ(即反作用飞轮、冷气推力器控制精度)进行比较,若|δ|≥τ,则通过右手定则判断动态干扰力矩方向,根据动态干扰力矩的大小与方向,计算步进电机的转动方向及圈数,对动态干扰力矩进行补偿;若|δ|<τ,则忽略干扰力矩。
(3)动态干扰力矩补偿:控制计算机根据动态干扰力矩的大小和方向,选择气浮台X轴、Y轴、Z轴中对应坐标轴上的自动平衡装置,该坐标轴上的电机按指令方向转动,进而带动丝杆上的质量块移动,实现动态干扰力矩的补偿。
进一步的,定义姿态敏感器测得气浮台实际姿态角为β,反作用飞轮实际输出力矩大小M,由此估算出动态干扰力矩大小Md,从而计算出偏心距r,公式如下:
M≈Md=mgrsinβ
其中,m为气浮台浮起部分质量,g为重力加速度。
步进电机的转动圈数k、质量块移动距离l、偏心距r的关系式为:
式中,mi为质量块质量。
有益效果:与现有的三轴气浮台调平衡系统相比,本发明加强了三轴气浮台的环境适应能力,提高了控制精度,支持未来三轴气浮台发展需求。目前,国内外尚未有关于三轴气浮台在控制过程中的动态调平等相关研究。
附图说明
图1为本发明的三轴气浮台调平衡系统;
图2(a)-(b)为本发明的三轴气浮台,其中,图2(a)为俯视图,图2(b)为主视图;
图3为本发明的自动平衡装置;
图4为本发明的调平原理图;
图5为本发明实施例的工作流程图;
具体实施方式
下面结合具体实施例和附图对本发明的技术方案作进一步说明。
如图1-3所示,本发明的一种三轴气浮台控制过程中的动态调平系统,主要包括姿态测量系统、姿态控制系统、通信系统以及地面控制台。
具体的,姿态测量系统包括各类姿态传感器,其分布于气浮台体上,用于完成三轴气浮台1台体的姿态测量。本实施例中,姿态传感器包括陀螺仪7、倾角计8、视觉测量系统9(图1中采用相机),陀螺仪7测量气浮台的角加速度,视觉测量系统9以非接触方式对气浮平台的姿态进行测量。
姿态控制系统包括姿态控制执行机构和控制计算机;姿态控制执行机构包括反作用飞轮2、冷气推力器3以及自动平衡装置4;本实施例中,气浮台机体坐标系X轴、Y轴和Z轴方向上各安装了一个自动平衡装置4。其中,各个自动平衡装置4均由高精度步进电机401、质量块402与丝杆403组成,丝杆与高精度步进电机输出轴连接,质量块安装在丝杆上,高精度步进电机转动时带动丝杆转动,进而移动质量块,从而实现对动态干扰力矩进行实时补偿。
控制计算机5与地面控制台6之间通过无线路由器10组建的无线局域网进行信息传递,以局域网的形式在控制计算机、地面控制台两者间建立了信息数据传送机制。三轴气浮台的姿态、姿态角速度、控制指令力矩、反作用飞轮实际输出力矩和动态干扰力矩等信息可以通过局域网在综合处理计算机、地面控制台之间进行传输。同时,地面控制台可以直观的显示实时的三轴气浮台角速度等数据信息,发送控制指令。
如图4所示,综合处理计算机(即控制计算机)采用递接饱和PD控制算法解算出控制指令力矩,反作用飞轮执行指令力矩,进而估算动态干扰力矩的大小;通过计算误差姿态角的大小判断是否需要补偿干扰力矩,并进行动态干扰力矩方向的判断。最后控制计算机计算高精度步进电机主要转动的圈数与方向,带动质量块移动,实现动态干扰力矩的补偿。具体的,分为三个阶段:
(1)动态干扰力矩大小判断:反作用飞轮根据控制指令力矩,以加速或减速飞轮转子的形式来实现的输出,通过飞轮实际输出力矩估计动态干扰力矩的大小。
(2)动态干扰力矩方向判断:根据误差姿态角和右手定则原理判断动态干扰力矩的方向。定义气浮台实际姿态角为β,目标姿态角为α,误差姿态角为δ,δ=β-α。
(3)动态干扰力矩补偿:控制计算机根据动态干扰力矩的大小和方向,选择对应坐标轴上的自动平衡装置,高精度电机按指令方向转动带动丝杆上的质量块移动,实现动态干扰力矩的补偿;
其中,自动平衡装置具体工作原理如下:
姿态敏感器测得气浮台实际姿态角为β(即气浮台当前与水平面的夹角),反作用飞轮实际输出力矩大小M,则可估算出动态干扰力矩大小Md,从而计算出偏心距r,计算公式如下:
M≈Md=mgrsinβ
高精度步进电机的转动圈数k、质量块移动距离l、偏心距r关系式为:
式中,m为气浮台浮起部分质量,mi为质量块质量。
如,高精度步进电机的精度为1/3000圈,每转动一圈,质量块的移动距离为1cm,质量块最小移动步长为1/3000,丝杆有效导程为150cm,质量块质量为0.4kg。
此外,在网络终端,可储存整个控制过程中产生的所有数据,存储的数据包括带时刻标签的三轴气浮台角速度、姿态角、控制指令力矩、反作用飞轮实际输出力矩与转速、高精度步进电机转动方向与圈数。
如图5所示是本发明实施例的详细流程:
(1)启动三轴气浮台控制程序;
(2)输入目标姿态角;
(3)姿态敏感器采集气浮台姿态数据信息;
(4)误差姿态角计算;
(5)综合处理计算机计算控制指令力矩Tc;
(6)反作用飞轮执行控制指令力矩Tc,并输出力矩;
(7)根据反作用飞轮实际输出力矩,进行动态干扰力矩大小估计;
(8)误差姿态角绝对值|δ|与姿态控制执行机构的控制精度τ进行比较,若|δ|≥τ则通过右手定则判断动态干扰力矩方向,进入步骤(9);若|δ|<τ则干扰力矩可忽略,进入步骤(12);
(9)综合处理计算机根据动态干扰力矩的大小与方向,选择对应坐标轴上的自动平衡装置,并计算高精度步进电机旋转方向与圈数;
(10)高精度步进电机按指令转动,补偿干扰力矩;
(11)网络终端储存控制过程产生的所有数据;
(12)控制程序结束本周期工作,进入下一个周期。
Claims (6)
1.一种三轴气浮台控制过程中的动态调平系统,其特征在于,包括:
姿态测量系统,包括各类姿态传感器,其分布于气浮台体上,完成气浮台台体的姿态测量;
姿态控制系统,包括姿态控制执行机构和控制计算机;所述姿态控制执行机构包括反作用飞轮、冷气推力器以及X轴、Y轴、Z轴方向上的自动平衡装置,所述自动平衡装置包括步进电机、质量块与丝杆,所述步进电机转动时带动丝杆转动,进而移动质量块;所述控制计算机负责地面控制台和气浮台之间的通信和数据处理;
通信系统,用于气浮台及地面控制台之间的数据通信;
地面控制台,通过所述通信系统将操作指令传输至控制计算机,同时也接收并显示控制计算机传输过来的气浮台的状态数据;
所述姿态控制系统通过反作用飞轮输出力矩的大小估计动态干扰力矩的大小,通过误差姿态角和右手定则原理判断动态干扰力矩的方向,最后通过步进电机的转动带动质量块移动,实现对动态干扰力矩的实时补偿。
2.根据权利要求1所述的一种三轴气浮台控制过程中的动态调平系统,其特征在于,所述姿态传感器包括陀螺、倾角计、视觉测量系统;所述视觉测量系统以非接触方式对气浮平台的姿态进行测量,并将数据提供给控制计算机。
3.一种基于如权利要求1或2所述动态调平系统的三轴气浮台控制过程中的动态调平方法,其特征在于,包括如下步骤:
(1)动态干扰力矩大小判断:姿态敏感器采集带时间标签的气浮台实际姿态角和姿态角速度信息,控制计算机根据姿态敏感器采集的姿态信息,解算出的控制指令力矩,反作用飞轮执行该控制指令力矩,以加速或减速飞轮转子的形式来实现反作用飞轮力矩的输出,根据反作用飞轮实际输出力矩,估计动态干扰力矩大小;
(2)动态干扰力矩方向判断:根据误差姿态角和右手定则原理判断动态干扰力矩方向;
(3)动态干扰力矩补偿:控制计算机根据动态干扰力矩的大小和方向,选择气浮台X轴、Y轴、Z轴中对应坐标轴上的自动平衡装置,该坐标轴上的步进电机按指令方向转动,进而带动丝杆上的质量块移动,实现动态干扰力矩的补偿。
4.根据权利要求3所述的一种三轴气浮台控制过程中的动态调平方法,其特征在于:
定义气浮台实际姿态角为β,目标姿态角为α,误差姿态角δ=β-α;
反作用飞轮实际输出力矩大小M,由此估算出动态干扰力矩大小Md,从而计算出偏心距r,公式如下:
M≈Md=mgrsinβ
其中,m为气浮台浮起部分质量,g为重力加速度。
5.根据权利要求3所述的一种三轴气浮台控制过程中的动态调平方法,其特征在于,步骤(2)具体包括如下内容:
控制计算机将误差姿态角的绝对值|δ|与姿态控制执行机构的控制精度τ进行比较,若|δ|≥τ,则通过右手定则判断动态干扰力矩方向,根据动态干扰力矩的大小与方向,计算步进电机的转动方向及圈数,对动态干扰力矩进行补偿;若|δ|<τ,则忽略干扰力矩。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110174314.3A CN112987592A (zh) | 2021-02-09 | 2021-02-09 | 一种三轴气浮台控制过程中的动态调平系统及动态调平方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110174314.3A CN112987592A (zh) | 2021-02-09 | 2021-02-09 | 一种三轴气浮台控制过程中的动态调平系统及动态调平方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112987592A true CN112987592A (zh) | 2021-06-18 |
Family
ID=76349247
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110174314.3A Pending CN112987592A (zh) | 2021-02-09 | 2021-02-09 | 一种三轴气浮台控制过程中的动态调平系统及动态调平方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112987592A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113501144A (zh) * | 2021-07-27 | 2021-10-15 | 北京微纳星空科技有限公司 | 一种飞轮转速的控制方法、装置、设备及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1998030993A1 (en) * | 1997-01-06 | 1998-07-16 | Reichert Jonathan F | Teaching apparatus for magnetic torque experiments |
CN103869833A (zh) * | 2014-04-01 | 2014-06-18 | 哈尔滨工业大学 | 基于非正交结构的三轴气浮台质心调节方法 |
CN104931180A (zh) * | 2015-06-11 | 2015-09-23 | 北京控制工程研究所 | 一种六自由度气浮台干扰力矩确定方法 |
CN105173129A (zh) * | 2015-09-18 | 2015-12-23 | 南京航空航天大学 | 一种三轴气浮台调平系统及方法 |
CN105300597A (zh) * | 2015-08-04 | 2016-02-03 | 上海卫星工程研究所 | 三轴气浮台质心调平衡方法及装置 |
-
2021
- 2021-02-09 CN CN202110174314.3A patent/CN112987592A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1998030993A1 (en) * | 1997-01-06 | 1998-07-16 | Reichert Jonathan F | Teaching apparatus for magnetic torque experiments |
CN103869833A (zh) * | 2014-04-01 | 2014-06-18 | 哈尔滨工业大学 | 基于非正交结构的三轴气浮台质心调节方法 |
CN104931180A (zh) * | 2015-06-11 | 2015-09-23 | 北京控制工程研究所 | 一种六自由度气浮台干扰力矩确定方法 |
CN105300597A (zh) * | 2015-08-04 | 2016-02-03 | 上海卫星工程研究所 | 三轴气浮台质心调平衡方法及装置 |
CN105173129A (zh) * | 2015-09-18 | 2015-12-23 | 南京航空航天大学 | 一种三轴气浮台调平系统及方法 |
Non-Patent Citations (3)
Title |
---|
李延斌等: ""三自由度气浮台自动平衡系统动力学建模"", 《中国惯性技术学报》 * |
陈欢龙等: ""多体卫星物理仿真动态调平衡干扰力矩分析"", 《计算机仿真》 * |
黄成等: ""六自由度气浮台及其姿态平台自动平衡系统设计"", 《宇航学报》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113501144A (zh) * | 2021-07-27 | 2021-10-15 | 北京微纳星空科技有限公司 | 一种飞轮转速的控制方法、装置、设备及存储介质 |
CN113501144B (zh) * | 2021-07-27 | 2022-05-03 | 北京微纳星空科技有限公司 | 一种飞轮转速的控制方法、装置、设备及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN100565406C (zh) | 一种基于四个定位器的飞机部件位姿调整系统及方法 | |
CN112327942B (zh) | 三轴气浮卫星仿真平台自动调平方法 | |
CN105589468B (zh) | 三轴卫星模拟器的双电机自动配平方法 | |
CN107505846B (zh) | 一种空间机械臂系统抗干扰姿态协调验证装置及控制方法 | |
CN104950905B (zh) | 一种基于复合pid的质心调节机构及调节方法 | |
CN105182770A (zh) | 一种基于旋翼飞行器的航天器半物理仿真实验系统及方法 | |
CN103727939B (zh) | 一种双轴旋转的姿态测量系统及其测量方法 | |
CN114291295B (zh) | 一种单磁悬浮控制敏感陀螺的卫星双轴姿态测控一体方法 | |
CN103868648A (zh) | 三轴气浮仿真实验平台的质心测量方法 | |
CN107389093A (zh) | 一种静基座下惯性平台初始自对准方法 | |
CN107102653A (zh) | 一种控制无人机的挂载设备对地角度的装置和方法 | |
CN112987592A (zh) | 一种三轴气浮台控制过程中的动态调平系统及动态调平方法 | |
CN112985694B (zh) | 三轴气浮台质心调平衡的方法及系统 | |
CN111707412B (zh) | 一种大型三轴气浮台转动惯量在线辨识系统及惯量算法 | |
CN117032317A (zh) | 一种动基座光电转台控制系统的视轴稳定及跟踪控制方法 | |
CN113483784B (zh) | 一种光纤惯组数字坐标系与结构坐标系误差标定试验设备及方法 | |
CN116520719A (zh) | 适用于挠性航天器姿态动力学全物理仿真的方法及系统 | |
Xuan et al. | From PID to L1 adaptive control for automatic balancing of a spacecraft three-axis simulator | |
CN113777955A (zh) | 双航天器跟踪指向装置和方法 | |
US20210171222A1 (en) | Control System and Control Method for Controlling a Momentum Wheel Device for Stabilizing a Spacecraft | |
CN111397635A (zh) | 一种mems惯性导航系统旋转调制方法 | |
CN106597562B (zh) | 基于双涵道垂直推进技术的火星引力地面模拟系统 | |
CN112947116B (zh) | 一种三轴气浮台的联合执行机构控制方法 | |
Ran et al. | Design and Analysis of a Space Dynamic Test Platform | |
Zhuo et al. | Research on Accuracy Analysis and Motion Control of Two-axis Non-magnetic Turntable Based on Ultrasonic Motor Journal |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210618 |