CN103017793A - 一种舰载经纬仪的船摇视轴稳定的方法 - Google Patents
一种舰载经纬仪的船摇视轴稳定的方法 Download PDFInfo
- Publication number
- CN103017793A CN103017793A CN2012105628183A CN201210562818A CN103017793A CN 103017793 A CN103017793 A CN 103017793A CN 2012105628183 A CN2012105628183 A CN 2012105628183A CN 201210562818 A CN201210562818 A CN 201210562818A CN 103017793 A CN103017793 A CN 103017793A
- Authority
- CN
- China
- Prior art keywords
- cos
- ship
- sin
- angle
- theodolite
- 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.)
- Granted
Links
Images
Landscapes
- Navigation (AREA)
Abstract
一种舰载经纬仪的船摇视轴稳定的方法,涉及伺服控制系统领域,解决舰载经纬仪在没有船上姿态测量数据的情况下,实现经纬仪视轴稳定的问题。在舰载经纬仪的底座安装一台测量姿态的局部基准,利用局部基准的姿态测量数据去修正由船摇引起的经纬仪视轴晃动,实现经纬仪在船摇晃动下的视轴稳定。本发明中利用局部基准的姿态测量数据,经过大地坐标到甲板坐标的坐标转换,计算出经纬仪在船摇晃动下的速度修正量,送到经纬仪伺服控制的速度回路参与速度运算,从而抑制了经纬仪的船摇扰动,实现了船摇晃动下的视轴稳定。本发明适用于舰载经纬仪的视轴稳定跟踪,特别是针对舰载、车载经纬仪的视轴稳定跟踪具有显著效果。
Description
技术领域
本发明涉及伺服控制系统领域,具体涉及舰载经纬仪船摇视轴稳定的有效方法。
背景技术
近年来,随着海上测量技术的发展和各种武器设备的试验需求,舰载经纬仪在海上的需求越来越多,因此舰载经纬仪在船摇下的视轴稳定问题也越来越受到重视,成为了一种必须解决的问题。针对远望号等国家大型测量舰船,船上配备了大型的高精度捷联惯导系统,利用捷联惯导的姿态测量数据可以修正因为船摇晃动而引起的视轴晃动。但是对于一些中小型海上测量船只,捷联惯导是没有配备的,或者测量的精度和数据帧频较低,对于经纬仪来说这样的姿态数据是不可用的。所以舰载经纬仪的视轴稳定问题不能仅仅依赖于船上的姿态测量设备。
发明内容
本发明为解决现有利用捷联惯导系统的姿态测量数据存在精度和数据帧频较低的问题,提供一种舰载经纬仪的船摇视轴稳定的方法。
一种舰载经纬仪的船摇视轴稳定的方法,该方法由以下步骤实现:
步骤一、将局部基准安装在经纬仪底座的下部或者一侧,使局部基准的Y轴线与船的纵摇线平行,局部基准的X轴线与船的首尾线平行;
步骤二、采用局部基准的姿态数据,根据大地坐标系到甲板坐标系的转化公式,分别计算出经纬仪的方位角的角度修正值和速度修正值以及俯仰角的角度修正值和速度修正值;
所述方位角和俯仰角的修正角度计算公式为:
所述方位角和俯仰角的修正角速度计算公式为:
式中:A为经纬仪方位编码器的实测值;
E为经纬仪俯仰编码器的实测值;
R为局部基准测得的大地坐标系下Y轴角度值;
P为局部基准测得的大地坐标系下X轴角度值;
ωR为局部基准测得的大地坐标系下Y轴角速度值;
ωP为局部基准测得的大地坐标系下X轴角速度值;
Ac为经大地坐标系到甲板坐标系转换后的方位角的角度修正值;
Ec为经大地坐标系到甲板坐标系转换后的俯仰角的角度修正值;
Acv为经大地坐标系到甲板坐标系转换后的方位角的速度修正值;
Ecv为经大地坐标系到甲板坐标系转换后的俯仰角的速度修正值;
步骤三、将步骤二计算出的方位角的速度修正值Acv和俯仰角的速度修正值Ecv输入到经纬仪的速度回路,用公式表示为:
其中:eka为经纬仪方位速度回路的速度偏差;
eke为经纬仪俯仰速度回路的速度偏差;
ya为经纬仪方位速度回路的速度输入值;
ye为经纬仪俯仰速度回路速度输入值;
aa为经纬仪方位速度回路速度测量值;
ee为经纬仪俯仰速度回路速度测量值;
获得方位速度回路的速度偏差和俯仰速度回路的速度偏差;实现对船摇扰动的修正,使视轴稳定。
本发明的工作原理:本发明中设计了一种舰载经纬仪视轴稳定的有效方法,这种视轴稳定方法采用局部基准进行姿态测量,并将得到的姿态测量数据带入本发明推导出的大地坐标系到甲板坐标系的两轴姿态坐标转换公式,从而计算出修正船摇晃动所需的速度修正量,然后将计算出的速度修正量带入速度回路,从而消除因船摇晃动而引起的视轴晃动,实现了船摇下的视轴指向稳定。
本发明的有益效果:本发明方法在多种型号经纬仪上得到了应用,并且实现的视轴稳定精度较高。本发明采用小型局部基准进行姿态测量,采用两轴坐标转换公式实时计算速度修正量,采用抑制扰动的控制原理实现船摇晃动下的视轴稳定,方法有效而简洁,使用方便。同样本发明也适用于实现动机座经纬仪的视轴稳定,比如车载经纬仪的视轴稳定。
附图说明
图1为本发明所述的一种舰载经纬仪的船摇视轴稳定的方法中局部基准在摇摆台上的安装示意图;
图2为本发明所述的一种舰载经纬仪的船摇视轴稳定的方法采用电视或数引跟踪方式下船摇修正原理框图;
图3为本发明所述的一种舰载经纬仪的船摇视轴稳定的方法采用单杆跟踪方式下船摇修正原理框图;
图4为本发明所述的一种舰载经纬仪的船摇视轴稳定的方法中5度幅值10秒周期正弦摇摆信号下电视跟踪误差曲线示意图;
图5为本发明所述的一种舰载经纬仪的船摇视轴稳定的方法中5度幅值10秒周期正弦摇摆信号下单杆跟踪方式下视轴晃动误差曲线示意图。
具体实施方式
具体实施方式一、结合图1至图5说明本实施方式,一种舰载经纬仪的船摇视轴稳定的方法,该方法采用XW-ADU7635局部基准进行船摇姿态测量,将局部基准的姿态测量数据带入由大地坐标系转换到甲板坐标系的船摇修正公式,从而计算出船摇角位置和角速度修正量,利用计算出的速度修正量去修正船摇视轴晃动,从而达到视轴稳定。该方法由以下步骤实现:
步骤一、将局部基准安装在经纬仪底座的下部或者一侧,使局部基准的Y轴线与船的纵摇线平行,局部基准的X轴线与船的首尾线平行;
步骤二、利用局部基准的姿态数据,按照大地坐标系到甲板坐标系的转化公式计算出经纬仪方位、俯仰修正角度和方位、俯仰修正角速度。
所述方位角和俯仰角的修正角度计算公式为:
所述方位角和俯仰角的修正角速度计算公式为:
式中:A为经纬仪方位编码器的实测值;
E为经纬仪俯仰编码器的实测值;
R为局部基准测得的大地坐标系下Y轴角度值;
P为局部基准测得的大地坐标系下X轴角度值;
ωR为局部基准测得的大地坐标系下Y轴角速度值;
ωP为局部基准测得的大地坐标系下X轴角速度值;
Ac为经大地坐标系到甲板坐标系转换后的方位角的角度修正值;
Ec为经大地坐标系到甲板坐标系转换后的俯仰角的角度修正值;
Acv为经大地坐标系到甲板坐标系转换后的方位角的速度修正值;
Ecv为经大地坐标系到甲板坐标系转换后的俯仰角的速度修正值;
步骤三、将步骤二计算出的方位角的速度修正值Acv和俯仰角的速度修正值Ecv输入到经纬仪的速度回路,用公式表示为:
其中:eka为经纬仪方位速度回路的速度偏差;
eke为经纬仪俯仰速度回路的速度偏差;
ya为经纬仪方位速度回路的速度输入值;
ye为经纬仪俯仰速度回路速度输入值;
aa为经纬仪方位速度回路速度测量值;
ee为经纬仪俯仰速度回路速度测量值;
从而实现船摇扰动的修正,保证视轴稳定。
结合图2至图5说明本实施方式,图2为采用电视跟踪或数引跟踪方式下船摇扰动修正的原理框图,其中G1是位置回路控制器,G2是速度回路控制器加负载模型传函,1/S是编码器引进的位置积分环节,R(t)是位置回路输入,-S是船摇晃动F(t)的位置差分取反。图3为单杆跟踪方式下的船摇扰动修正的原理框图,其中各个符号的意义和图2中相同,只是没有位置闭环。其中图4为电视跟踪下的船摇隔离误差曲线。船摇隔离度的计算是采用公式: dB ,其中move是船摇晃动量,error是视轴晃动误差,h是船摇隔离度,船摇隔离度的单位是dB,dB表示两个量的比值,在电视跟踪方式下可以做到船摇隔离度大于45dB,图5为单杆跟踪下的船摇隔离数据曲线,在单杆跟踪方式下可以实现船摇隔离度大于27dB。
本实施方式中局部基准的安装精度很重要,如果局部基准的X轴线与船的首尾线平行度差,或者局部基准的Y轴线与船的纵摇线平行度差,将会直接影响局部基准的姿态测量精度,从而影响视轴稳定精度。
Claims (2)
1.一种舰载经纬仪的船摇视轴稳定的方法,其特征是,该方法由以下步骤实现:
步骤一、将局部基准安装在经纬仪底座的下部或者一侧,使局部基准的Y轴线与船的纵摇线平行,局部基准的X轴线与船的首尾线平行;
步骤二、采用局部基准的姿态数据,根据大地坐标系到甲板坐标系的转化公式,分别计算出经纬仪的方位角的角度修正值和速度修正值以及俯仰角的角度修正值和速度修正值;
所述方位角和俯仰角的修正角度计算公式为:
所述方位角和俯仰角的修正角速度计算公式为:
式中:A为经纬仪方位编码器的实测值;
E为经纬仪俯仰编码器的实测值;
R为局部基准测得的大地坐标系下Y轴角度值;
P为局部基准测得的大地坐标系下X轴角度值;
ωR为局部基准测得的大地坐标系下Y轴角速度值;
ωP为局部基准测得的大地坐标系下X轴角速度值;
Ac为经大地坐标系到甲板坐标系转换后的方位角的角度修正值;
Ec为经大地坐标系到甲板坐标系转换后的俯仰角的角度修正值;
Acv为经大地坐标系到甲板坐标系转换后的方位角的速度修正值;
Ecv为经大地坐标系到甲板坐标系转换后的俯仰角的速度修正值;
步骤三、将步骤二计算出的方位角的速度修正值Acv和俯仰角的速度修正值Ecv输入到经纬仪的速度回路,用公式表示为:
其中:eka为经纬仪方位速度回路的速度偏差;
eke为经纬仪俯仰速度回路的速度偏差;
ya为经纬仪方位速度回路的速度输入值;
ye为经纬仪俯仰速度回路速度输入值;
aa为经纬仪方位速度回路速度测量值;
ee为经纬仪俯仰速度回路速度测量值;
获得方位速度回路的速度偏差和俯仰速度回路的速度偏差;实现对船摇扰动的修正,使视轴稳定。
2.根据权利要求1所述的一种舰载经纬仪的船摇视轴稳定的方法,其特征在于,步骤一中的局部基准的测量数据正负符号与大地坐标系中的正负符号方向一致。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210562818.3A CN103017793B (zh) | 2012-12-21 | 2012-12-21 | 一种舰载经纬仪的船摇视轴稳定的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210562818.3A CN103017793B (zh) | 2012-12-21 | 2012-12-21 | 一种舰载经纬仪的船摇视轴稳定的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103017793A true CN103017793A (zh) | 2013-04-03 |
CN103017793B CN103017793B (zh) | 2015-09-30 |
Family
ID=47966666
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210562818.3A Expired - Fee Related CN103017793B (zh) | 2012-12-21 | 2012-12-21 | 一种舰载经纬仪的船摇视轴稳定的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103017793B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105549636A (zh) * | 2015-12-04 | 2016-05-04 | 中国科学院长春光学精密机械与物理研究所 | 振动环境下加速度计辅助视轴稳定系统及稳定方法 |
CN105868505A (zh) * | 2016-04-27 | 2016-08-17 | 中国人民解放军63680部队 | 基于目标模拟器的船摇隔离度静态测试方法 |
CN108036801A (zh) * | 2017-12-30 | 2018-05-15 | 湖北航天技术研究院总体设计所 | 视轴惯性稳定参考基准装置 |
CN109827541A (zh) * | 2019-03-06 | 2019-05-31 | 中国科学院光电技术研究所 | 一种提高协同工作的多台光电经纬仪互引导精度的方法 |
CN110588483A (zh) * | 2019-10-14 | 2019-12-20 | 中国科学院长春光学精密机械与物理研究所 | 一种经纬仪载车整体载具车体 |
CN115342838A (zh) * | 2022-10-20 | 2022-11-15 | 中国科学院长春光学精密机械与物理研究所 | 一种光电经纬仪船摇隔离度检测方法 |
CN117687346A (zh) * | 2024-02-01 | 2024-03-12 | 中国科学院长春光学精密机械与物理研究所 | 舰载光电经纬仪的空间稳像控制系统及控制方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5562266A (en) * | 1992-10-29 | 1996-10-08 | Aerospatiale Societe Nationale Industrielle | Rate gyro calibration method and apparatus for a three-axis stabilized satellite |
CN101169323A (zh) * | 2006-12-14 | 2008-04-30 | 中国科学院长春光学精密机械与物理研究所 | 在室内用旋转靶标测量电视经纬仪动态测角精度的方法 |
-
2012
- 2012-12-21 CN CN201210562818.3A patent/CN103017793B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5562266A (en) * | 1992-10-29 | 1996-10-08 | Aerospatiale Societe Nationale Industrielle | Rate gyro calibration method and apparatus for a three-axis stabilized satellite |
CN101169323A (zh) * | 2006-12-14 | 2008-04-30 | 中国科学院长春光学精密机械与物理研究所 | 在室内用旋转靶标测量电视经纬仪动态测角精度的方法 |
Non-Patent Citations (2)
Title |
---|
葛兵等: "舰载经纬仪视轴自稳定方法研究", 《舰船科学技术》, vol. 28, no. 6, 31 December 2006 (2006-12-31) * |
蔡立华等: "舰载光电跟踪设备视轴稳定H混合灵敏度方法的研究", 《仪器仪表学报》, vol. 31, no. 8, 31 August 2010 (2010-08-31) * |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105549636A (zh) * | 2015-12-04 | 2016-05-04 | 中国科学院长春光学精密机械与物理研究所 | 振动环境下加速度计辅助视轴稳定系统及稳定方法 |
CN105868505A (zh) * | 2016-04-27 | 2016-08-17 | 中国人民解放军63680部队 | 基于目标模拟器的船摇隔离度静态测试方法 |
CN108036801A (zh) * | 2017-12-30 | 2018-05-15 | 湖北航天技术研究院总体设计所 | 视轴惯性稳定参考基准装置 |
CN108036801B (zh) * | 2017-12-30 | 2020-05-19 | 湖北航天技术研究院总体设计所 | 视轴惯性稳定参考基准装置 |
CN109827541A (zh) * | 2019-03-06 | 2019-05-31 | 中国科学院光电技术研究所 | 一种提高协同工作的多台光电经纬仪互引导精度的方法 |
CN109827541B (zh) * | 2019-03-06 | 2021-06-18 | 中国科学院光电技术研究所 | 一种提高协同工作的多台光电经纬仪互引导精度的方法 |
CN110588483A (zh) * | 2019-10-14 | 2019-12-20 | 中国科学院长春光学精密机械与物理研究所 | 一种经纬仪载车整体载具车体 |
CN110588483B (zh) * | 2019-10-14 | 2024-01-26 | 中国科学院长春光学精密机械与物理研究所 | 一种经纬仪载车整体载具车体 |
CN115342838A (zh) * | 2022-10-20 | 2022-11-15 | 中国科学院长春光学精密机械与物理研究所 | 一种光电经纬仪船摇隔离度检测方法 |
CN115342838B (zh) * | 2022-10-20 | 2022-12-27 | 中国科学院长春光学精密机械与物理研究所 | 一种光电经纬仪船摇隔离度检测方法 |
CN117687346A (zh) * | 2024-02-01 | 2024-03-12 | 中国科学院长春光学精密机械与物理研究所 | 舰载光电经纬仪的空间稳像控制系统及控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103017793B (zh) | 2015-09-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103017793B (zh) | 一种舰载经纬仪的船摇视轴稳定的方法 | |
CN103245360B (zh) | 晃动基座下的舰载机旋转式捷联惯导系统自对准方法 | |
WO2020062791A1 (zh) | 一种深海潜航器的sins/dvl水下抗晃动对准方法 | |
CN109782323B (zh) | 一种深海水下自主航行器导航定位及校准方法 | |
KR101370649B1 (ko) | 무인잠수정의 경로 제어방법 | |
CN106643723B (zh) | 一种无人艇安全航行船位推算方法 | |
CN103076026B (zh) | 一种捷联惯导系统中确定多普勒计程仪测速误差的方法 | |
RU2348903C1 (ru) | Способ определения навигационных параметров бесплатформенной инерциальной навигационной системой | |
CN103955218A (zh) | 一种基于非线性控制理论的无人艇轨迹跟踪控制装置及方法 | |
CN109269526B (zh) | 基于阻尼网络的旋转式格网惯导水平阻尼方法 | |
CN103175528B (zh) | 基于捷联惯导系统的捷联罗经姿态测量方法 | |
CN103308722B (zh) | 一种船舶风向风速测量仪误差修正方法 | |
CN105258698A (zh) | 一种高动态自旋制导炮弹空中组合导航方法 | |
CN103217160A (zh) | 一种船舶动力定位卡尔曼滤波方法 | |
CN109425339A (zh) | 一种基于惯性技术的考虑杆臂效应的舰船升沉误差补偿方法 | |
JP2011163930A (ja) | 水中航走体の位置較正方法 | |
CN104776847B (zh) | 一种适用于水下导航系统单点估计陀螺漂移的方法 | |
CN107110979A (zh) | 姿态角计算装置、姿态角计算方法及姿态角计算程序 | |
CN110308719A (zh) | 一种水面无人艇路径跟踪控制方法 | |
CN110763872A (zh) | 一种多普勒测速仪多参数在线标定方法 | |
CN111538339A (zh) | 船舶航迹控制方法及装置 | |
CN101650186A (zh) | 一种对舰船甲板静态变形角进行测量的方法 | |
CN106123917A (zh) | 考虑外杆臂效应的捷联惯导系统罗经对准方法 | |
CN101234663A (zh) | 带有“gps”的减摇鳍控制装置 | |
CN105930595A (zh) | 基于跟踪真实目标的船摇隔离度静态测试方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20150930 Termination date: 20161221 |
|
CF01 | Termination of patent right due to non-payment of annual fee |