CN106843293A - 一种用于高速滚转载体的陀螺稳定平台漂移抑制方法 - Google Patents
一种用于高速滚转载体的陀螺稳定平台漂移抑制方法 Download PDFInfo
- Publication number
- CN106843293A CN106843293A CN201710008795.4A CN201710008795A CN106843293A CN 106843293 A CN106843293 A CN 106843293A CN 201710008795 A CN201710008795 A CN 201710008795A CN 106843293 A CN106843293 A CN 106843293A
- Authority
- CN
- China
- Prior art keywords
- gyro
- stage body
- gyroscope
- platform
- high speed
- 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
- 238000005096 rolling process Methods 0.000 title claims abstract description 20
- 238000000034 method Methods 0.000 title claims abstract description 13
- 238000011217 control strategy Methods 0.000 claims abstract description 5
- 238000005259 measurement Methods 0.000 claims description 8
- 230000001360 synchronised effect Effects 0.000 description 10
- 238000002955 isolation Methods 0.000 description 3
- 230000010354 integration Effects 0.000 description 2
- 230000005389 magnetism Effects 0.000 description 2
- 230000006641 stabilisation Effects 0.000 description 2
- 238000011105 stabilization Methods 0.000 description 2
- 229910000838 Al alloy Inorganic materials 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 239000000956 alloy Substances 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000000969 carrier Substances 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
- G05D3/12—Control of position or direction using feedback
- G05D3/20—Control of position or direction using feedback using a digital comparing device
- G05D3/203—Control of position or direction using feedback using a digital comparing device using fine or coarse devices
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/18—Stabilised platforms, e.g. by gyroscope
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Ac Motors In General (AREA)
Abstract
本发明公开了一种用于高速滚转载体的陀螺稳定平台漂移抑制方法。采用陀螺仪作为角运动信息传感器,测量平台台体相对基准平面的角速度运动信息;采用加速度计测量平台台体的角度,为闭环控制提供角度反馈信息。伺服驱动控制器根据陀螺仪和加速度计传送过来的角运动信息,采用位置、速度、电流的三环PID控制策略,实现对驱动电机的控制,抵消载体的滚转运动。
Description
技术领域
本发明涉及一种陀螺稳定平台漂移抑制方法。
背景技术
应用于高速滚转载体的陀螺稳定平台,主要隔离载体高速滚转运动,在载体运动状态下建立稳定基准面,使安装在平台上的设备不会因载体高速运动而无法正常工作。其主要特征是采用惯性测量单元作为角运动敏感元件,不断测量平台姿态位置的变化,通过伺服作动机构使平台台体与载体的滚转运动相隔离,精确保持平台台体的姿态基准。陀螺稳定平台集惯性导航、数据采集及信号处理、精密机械动力学建模和仿真、电机运动控制等多项技术于一身,是以机电一体化和目标识别自动控制技术为主体,多个学科有机结合的产物,有广泛的应用需求。例如:在滚转弹的制导系统,陀螺稳定平台可以隔离掉弹体的滚转速度,使得安装在平台的制导设备工作过程中,不受弹体滚转运动的影响。
陀螺仪在载体高速滚转运行过程中产生较大测量误差,使陀螺稳定平台存在漂移现象。文献《基于连续旋转的陀螺稳定平台漂移动态标定新方法》提出通过标定陀螺仪进行减小或消除漂移误差。文献《一种陀螺稳定平台瞄准线漂移的惯性补偿方法》提出通过地球自转速率补偿速度环,降低平台漂移的影响。上述这两种方法,主要通过提高陀螺仪的测量精度,降低平台漂移。高速滚转载体运行过程中,会使陀螺仪在测量原理上存在测量误差,很难将陀螺仪测量得到的角速度提高到较高的精度。直接采用陀螺仪输出积分进行角度闭环控制,会使平台产生较大的漂移。因此,上述文献给出的两种陀螺稳定平台漂移抑制方法,很难直接应用到高速滚转载体用陀螺稳定平台中。
发明内容
为了克服现有技术无法满足高速滚转载体用陀螺稳定平台的工作特性,本发明提供一种用于高速滚转载体的陀螺稳定平台漂移抑制方法,使得平台台体在高速滚转载体运行过程中,保持姿态基准,并同时适用于各种滚转载体的稳定基准面问题。
本发明解决其技术问题所采用的技术方案是:包括平台台体、驱动电机、编码器和伺服驱动控制器,平台台体上安装有被稳定对象、陀螺仪和加速度计。伺服驱动控制器由CPU和逆变器组成。陀螺仪作为角运动信息传感器,测量平台台体相对基准平面的角速度运动信息,给伺服驱动控制器提供控制反馈信息。编码器测量伺服电机转子相对定子的信息,为伺服驱动控制器的高精度跟踪控制提供角度信息。加速度计用于测量平台台体的角度,为闭环控制提供角度反馈信息。伺服驱动控制器根据陀螺仪和加速度计传送过来的角运动信息,采用位置、速度、电流的三环PID控制策略,实现对驱动电机的控制,抵消载体的滚转运动。
三环PID控制策略中,内环控制采用电流环,中间控制环节是速度环,外环控制是位置环。位置环的反馈为平台台体相对基准平面的角度,通过加速度计的输出得到;位置环的给定为零。速度环依据位置环的输出、陀螺仪测量的平台台体相对基准平面角速度,结合PID控制方法,输出速度环的控制指令。电流环的给定为速度环的输出;电流环的反馈为伺服电机的相电流。
本发明的有益效果是:采用加速度计输出产生角度环控制用反馈信息,降低陀螺稳定平台的漂移,提高其稳定性能。
附图说明
图1为所提高速滚转载体陀螺稳定平台漂移抑制方法实现的组成框图。
图中,1—CPU,2—逆变器,3—永磁同步电机,4—平台台体,5—电流采样,6—编码器。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
本发明装置实施实例的结构参照图1,由CPU 1、逆变器2、驱动电机3、平台台体4、电流采样5、编码器6组成。
CPU 1采用TMS320F2812DSP芯片,时钟频率为150MHz。
逆变器2采用分立器件搭建。DSP的弱电和驱动电机的强电隔离,采用隔离芯片ADUM1401。开关器件选用功率MOSFET IRFR3412。栅极驱动芯片选用高速功率场效应管驱动芯片IR2103S。
驱动电机3选用永磁同步电机。电机额定参数为:额定电流2.1A、额定电压27V、额定转速1800rpm。
平台台体4采用铝合金材料加工,厚度为3mm。安装在平台台体上的陀螺仪采用L3G420D,加速度计采用ADXL345。
电流采样5采用霍尔电流传感器ACS712,实现永磁同步电机相电流的隔离采样,为永磁同步电机控制提供电流信号。
编码器6采用霍尔磁电编码器作为位置检测元件,为永磁同步电机的高精度控制提供角度信息。
永磁同步电机转子,编码器转子及平台台体同轴联结;而永磁同步电机定子,编码器定子则与载体外壳相连。
平台台体的运动速度由陀螺仪L3G420D直接测量得到。平台台体的角度信息由加速度计ADXL345的输出,结合重力加速度得到。所采用的三环PID控制策略中,电流环的控制周期为0.1ms;速度环的控制周期为1ms;角度环的控制周期为5ms。
CPU通过采集加速度计ADXL345的输出,得到位置环的反馈。位置环的给定为零。CPU结合位置环的输出和采集到的陀螺仪L3G420D得到,以及PID控制参数,得到速度环的输出。电流环的输入为速度环的输出。永磁同步电机的控制方法采用直轴电流为零的矢量控制方法。通过霍尔磁电编码器测量永磁同步电机转子的位置信息;通过霍尔电流传感器测量定子电流信号。结合空间矢量变换,得到反馈的交、直轴电流作为电流环的反馈。结合电流环PID控制器,发出控制指令。控制指令经ADUM1401隔离后送入IR2103S,控制6个MOSFETIRFR3412的开通和关断,驱动永磁同步电机运行,保持平台台体的高精度姿态稳定。
Claims (1)
1.一种用于高速滚转载体的陀螺稳定平台漂移抑制方法,其特征在于:平台台体的运动信息分别由陀螺仪和加速度计共同测量得到。位置、速度、电流的三环PID控制策略中,位置环反馈通过加速度计的输出得到。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710008795.4A CN106843293A (zh) | 2017-01-06 | 2017-01-06 | 一种用于高速滚转载体的陀螺稳定平台漂移抑制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710008795.4A CN106843293A (zh) | 2017-01-06 | 2017-01-06 | 一种用于高速滚转载体的陀螺稳定平台漂移抑制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106843293A true CN106843293A (zh) | 2017-06-13 |
Family
ID=59117964
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710008795.4A Pending CN106843293A (zh) | 2017-01-06 | 2017-01-06 | 一种用于高速滚转载体的陀螺稳定平台漂移抑制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106843293A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108333938A (zh) * | 2018-02-06 | 2018-07-27 | 贵州电网有限责任公司 | 一种多闭环复合陀螺稳定控制方法 |
CN111238537A (zh) * | 2020-03-11 | 2020-06-05 | 西安应用光学研究所 | 机载光电观瞄系统瞄准线漂移智能补偿方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2210740C1 (ru) * | 2002-01-30 | 2003-08-20 | Открытое акционерное общество "Раменское приборостроительное конструкторское бюро" | Способ гирокомпасирования с применением гироскопического датчика угловой скорости, установленного на управляемую в азимуте и стабилизированную в плоскости местного горизонта платформу |
CN102297694A (zh) * | 2011-06-10 | 2011-12-28 | 北京航空航天大学 | 一种轻量化快响应航空遥感惯性稳定平台控制系统 |
CN102436262A (zh) * | 2011-09-26 | 2012-05-02 | 北京航空航天大学 | 高精度大负载航空遥感三轴惯性稳定平台控制系统及方法 |
CN102495645A (zh) * | 2011-11-28 | 2012-06-13 | 西北工业大学 | 一种用于高速滚转载体的陀螺稳定平台及其控制方法 |
CN202351714U (zh) * | 2011-11-28 | 2012-07-25 | 西北工业大学 | 一种用于高速滚转载体的陀螺稳定平台 |
CN102707080A (zh) * | 2011-10-21 | 2012-10-03 | 哈尔滨工程大学 | 一种星敏感器模拟捷联惯导陀螺的方法 |
CN102788598A (zh) * | 2012-08-16 | 2012-11-21 | 辽宁工程技术大学 | 基于三轴旋转的光纤捷联惯导系统误差抑制方法 |
US20130158940A1 (en) * | 2011-10-31 | 2013-06-20 | University Of Florida Research Foundation, Inc. | Vestibular dynamic inclinometer |
CN104316079A (zh) * | 2014-09-30 | 2015-01-28 | 北京航天控制仪器研究所 | 一种基于火箭橇试验的惯性测量系统落点精度估计方法 |
-
2017
- 2017-01-06 CN CN201710008795.4A patent/CN106843293A/zh active Pending
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2210740C1 (ru) * | 2002-01-30 | 2003-08-20 | Открытое акционерное общество "Раменское приборостроительное конструкторское бюро" | Способ гирокомпасирования с применением гироскопического датчика угловой скорости, установленного на управляемую в азимуте и стабилизированную в плоскости местного горизонта платформу |
CN102297694A (zh) * | 2011-06-10 | 2011-12-28 | 北京航空航天大学 | 一种轻量化快响应航空遥感惯性稳定平台控制系统 |
CN102436262A (zh) * | 2011-09-26 | 2012-05-02 | 北京航空航天大学 | 高精度大负载航空遥感三轴惯性稳定平台控制系统及方法 |
CN102707080A (zh) * | 2011-10-21 | 2012-10-03 | 哈尔滨工程大学 | 一种星敏感器模拟捷联惯导陀螺的方法 |
US20130158940A1 (en) * | 2011-10-31 | 2013-06-20 | University Of Florida Research Foundation, Inc. | Vestibular dynamic inclinometer |
CN102495645A (zh) * | 2011-11-28 | 2012-06-13 | 西北工业大学 | 一种用于高速滚转载体的陀螺稳定平台及其控制方法 |
CN202351714U (zh) * | 2011-11-28 | 2012-07-25 | 西北工业大学 | 一种用于高速滚转载体的陀螺稳定平台 |
CN102788598A (zh) * | 2012-08-16 | 2012-11-21 | 辽宁工程技术大学 | 基于三轴旋转的光纤捷联惯导系统误差抑制方法 |
CN104316079A (zh) * | 2014-09-30 | 2015-01-28 | 北京航天控制仪器研究所 | 一种基于火箭橇试验的惯性测量系统落点精度估计方法 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108333938A (zh) * | 2018-02-06 | 2018-07-27 | 贵州电网有限责任公司 | 一种多闭环复合陀螺稳定控制方法 |
CN111238537A (zh) * | 2020-03-11 | 2020-06-05 | 西安应用光学研究所 | 机载光电观瞄系统瞄准线漂移智能补偿方法 |
CN111238537B (zh) * | 2020-03-11 | 2023-06-02 | 西安应用光学研究所 | 机载光电观瞄系统瞄准线漂移智能补偿方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103344243B (zh) | 一种航空遥感惯性稳定平台摩擦参数辨识方法 | |
CN104635746B (zh) | 一种两轴四框架光电吊舱的伺服控制方法及系统 | |
CN102495645B (zh) | 一种用于高速滚转载体的陀螺稳定平台及其控制方法 | |
CN101709975B (zh) | 一种航空遥感惯性稳定平台不平衡力矩估计与补偿方法 | |
CN204831330U (zh) | 一种三轴转台的姿态传感器测试系统 | |
CN104697525B (zh) | 一种基于磁悬浮控制敏感陀螺构型的姿态角速度测量方法 | |
CN100588107C (zh) | 一种磁悬浮反作用飞轮电机速率模式控制系统 | |
CN103792957B (zh) | 一种轻型二自由度相机稳定平台装置 | |
CN102818569B (zh) | 一种五自由度主动磁悬浮惯性稳定平台 | |
CN202939489U (zh) | 一种多旋翼自动平衡飞行控制器 | |
CN106896820A (zh) | 惯性稳定平台及其控制方法 | |
CN108168550B (zh) | 一种高速旋转载体惯性姿态测量装置 | |
CN101852818A (zh) | 一种基于旋转机构的加速度计误差标定与补偿方法 | |
CN106092073B (zh) | 微机械陀螺寻北仪 | |
CN104197907A (zh) | 一种基于磁悬浮控制力矩陀螺的姿态角速率测量方法 | |
CN106843293A (zh) | 一种用于高速滚转载体的陀螺稳定平台漂移抑制方法 | |
CN202351714U (zh) | 一种用于高速滚转载体的陀螺稳定平台 | |
CN206300661U (zh) | 一种光纤陀螺仪仪器测试装置 | |
CN105973270B (zh) | 一种陀螺定向仪角动量检测及补偿方法 | |
CN109471459A (zh) | 一种采用分步积分pi算法的寻北仪转位控制装置及方法 | |
CN100567905C (zh) | 一种用于超导球形转子的光纤测量装置及测量方法 | |
CN102252692A (zh) | 一种基于旋转机构的陀螺与加速度相关漂移的标定与补偿方法 | |
CN103345149A (zh) | 一种动力调谐陀螺仪伺服控制回路 | |
CN111258337B (zh) | 负载偏心下二维转台俯仰运动的高精度伺服控制系统及方法 | |
CN106933095A (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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20170613 |
|
WD01 | Invention patent application deemed withdrawn after publication |