CN115077521B - 一种基于虚拟框架载体坐标系惯性导航系统姿态解耦方法 - Google Patents

一种基于虚拟框架载体坐标系惯性导航系统姿态解耦方法 Download PDF

Info

Publication number
CN115077521B
CN115077521B CN202211003826.4A CN202211003826A CN115077521B CN 115077521 B CN115077521 B CN 115077521B CN 202211003826 A CN202211003826 A CN 202211003826A CN 115077521 B CN115077521 B CN 115077521B
Authority
CN
China
Prior art keywords
virtual
coordinate system
carrier coordinate
angle
matrix
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
Application number
CN202211003826.4A
Other languages
English (en)
Other versions
CN115077521A (zh
Inventor
胡小毛
赵小明
颜苗
翁海娜
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
707th Research Institute of CSIC
Original Assignee
707th Research Institute of CSIC
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 707th Research Institute of CSIC filed Critical 707th Research Institute of CSIC
Priority to CN202211003826.4A priority Critical patent/CN115077521B/zh
Publication of CN115077521A publication Critical patent/CN115077521A/zh
Application granted granted Critical
Publication of CN115077521B publication Critical patent/CN115077521B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • 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
    • 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/183—Compensation of inertial measurements, e.g. for temperature effects

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

本发明属于惯性导航系统应用技术领域，尤其涉及一种基于虚拟框架载体坐标系惯性导航系统姿态解耦方法。通过台体载体坐标系到虚拟内框载体坐标系转换，虚拟内框载体坐标系到虚拟中框载体坐标系转换，虚拟中框载体坐标系到虚拟外框载体坐标系转换，虚拟外框载体坐标系到舰船载体坐标系转换，通过四步转换获取台体载体坐标系到舰船载体坐标系姿态矩阵，实现姿态解耦。通过虚拟三框架载体坐标系，同时考虑轴摆误差角与旋转角相关的正弦误差项，将台体载体坐标系解耦至舰船载体坐标系，实现三轴旋转式惯性导航系统高精度姿态解耦，具有较高的工程应用价值。

Description

一种基于虚拟框架载体坐标系惯性导航系统姿态解耦方法
技术领域
本发明属于惯性导航系统应用技术领域，尤其涉及一种基于虚拟框架载体坐标系惯性导航系统姿态解耦方法。
背景技术
运载体在机动过程中存在三个方向载体角运动，三轴旋转式惯性导航系统为保持台体稳定在导航载体坐标系，需通过三框联动方式，完全隔离外部角运动，三轴联动过程中三个方向轴摆角误差之间存在相互耦合，单轴旋转式惯性导航系统可从数学定义上假设电机载体坐标系“虚拟内框”和“虚拟中框”方向与台体载体坐标系水平方向一致，因此不存在轴角误差之间的相互耦合，三轴旋转式惯性导航系统三框电机敏感轴由于加工装配造成彼此之间非正交，同时由于旋转过程中轴摆角误差的常值、正弦等误差因素影响，姿态解耦时三框彼此之间产生耦合，无法采用与单轴旋转式惯性导航系统一样的数学假设，三轴旋转式惯性导航系统的轴摆角误差补偿较单轴/双轴旋转式惯性导航系统更为复杂。
针对上述问题，本发明提供了一种基于虚拟框架载体坐标系的三轴旋转式惯性导航系统高精度姿态解耦方法，即实现非耦合状态下的三框数据表示三轴旋转式惯性导航系统姿态。
发明内容
本发明提供了一种基于虚拟框架载体坐标系的三轴旋转式惯性导航系统高精度姿态解耦方法，为了解决现有技术中三轴旋转式惯性导航系统的姿态解耦和高精度轴摆角误差补偿，实现三轴旋转式惯性导航系统高精度姿态输出。
为了解决上述技术问题，本发明采用如下技术方案：
一种基于虚拟框架载体坐标系惯性导航系统姿态解耦方法，包括如下步骤：
S1.台体载体坐标系到虚拟内框载体坐标系转换，
S2.虚拟内框载体坐标系到虚拟中框载体坐标系转换，
S3.虚拟中框载体坐标系到虚拟外框载体坐标系转换，
S4.虚拟外框载体坐标系到舰船载体坐标系转换，
S5. 依次完成S1、S2、S3、S4四步转换，获得台体载体坐标系到舰船载体坐标系姿态矩阵，实现姿态解耦。
其中S1步骤台体载体坐标系到虚拟内框载体坐标系转换为台体载体坐标系到虚拟内框载体坐标系的姿态矩阵：
Figure 411724DEST_PATH_IMAGE001
其中
Figure 860023DEST_PATH_IMAGE002
为台体姿态矩阵，
Figure 311864DEST_PATH_IMAGE003
为台体到虚拟内框的轴摆角误差矩阵，
Figure 238232DEST_PATH_IMAGE004
为虚拟 内框旋转矩阵，
Figure 787025DEST_PATH_IMAGE005
为与虚拟内框旋转相关的正弦轴摆角误差矩阵，
Figure 281591DEST_PATH_IMAGE006
,
Figure 283045DEST_PATH_IMAGE007
，
Figure 13104DEST_PATH_IMAGE008
，
Figure 852622DEST_PATH_IMAGE009
上式中
Figure 580406DEST_PATH_IMAGE010
、
Figure 131473DEST_PATH_IMAGE011
、
Figure 602906DEST_PATH_IMAGE012
分别为台体的横摇角、纵摇角和航向角，
Figure 798395DEST_PATH_IMAGE013
角度为虚拟内框轴 转动角度，
Figure 759398DEST_PATH_IMAGE014
、
Figure 735444DEST_PATH_IMAGE015
为虚拟内框轴摆角常值误差；
Figure 682672DEST_PATH_IMAGE016
、
Figure 60563DEST_PATH_IMAGE017
为与虚拟内框旋转角相关的正 弦项轴摆角误差幅值，
Figure 192467DEST_PATH_IMAGE018
、
Figure 327914DEST_PATH_IMAGE019
为与虚拟内框旋转角相关的正弦项轴摆角的角度系数值，
Figure 141149DEST_PATH_IMAGE020
、
Figure 435864DEST_PATH_IMAGE021
为与虚拟内框旋转角相关的正弦项轴摆角初始相位。
其中S2步骤虚拟内框载体坐标系到虚拟中框载体坐标系转换为虚拟内框载体坐标系到虚拟中框载体坐标系姿态矩阵：
Figure 941932DEST_PATH_IMAGE022
其中
Figure 803489DEST_PATH_IMAGE023
为虚拟内框载体坐标系到虚拟中框的轴摆角误差矩阵，
Figure 482732DEST_PATH_IMAGE024
为虚拟中 框旋转矩阵，
Figure 569637DEST_PATH_IMAGE025
为与虚拟中框旋转相关的正弦轴摆角误差矩阵，
Figure 184289DEST_PATH_IMAGE026
，
Figure 356644DEST_PATH_IMAGE027
，
Figure 573999DEST_PATH_IMAGE029
上式中
Figure 453093DEST_PATH_IMAGE030
角度为虚拟中框轴转动角度，
Figure 300964DEST_PATH_IMAGE031
、
Figure 22932DEST_PATH_IMAGE032
为虚拟中框轴摆角常值误 差；
Figure 653765DEST_PATH_IMAGE033
、
Figure 449682DEST_PATH_IMAGE034
为虚拟中框旋转角相关的正弦项轴摆误差幅值，
Figure 530771DEST_PATH_IMAGE035
、
Figure 677718DEST_PATH_IMAGE036
为与虚拟中 框旋转角相关的正弦项轴摆角的角度系数值，
Figure 876356DEST_PATH_IMAGE037
、
Figure 792360DEST_PATH_IMAGE038
为与虚拟中框旋转角相关的 正弦项轴摆角初始相位。
其中S3步骤虚拟中框载体坐标系到虚拟外框载体坐标系转换为虚拟中框载体坐标系到虚拟外框载体坐标系姿态矩阵：
Figure 513191DEST_PATH_IMAGE039
其中
Figure 85118DEST_PATH_IMAGE040
为虚拟中框载体坐标系到虚拟外框的轴摆角误差矩阵，
Figure 182387DEST_PATH_IMAGE041
为虚拟外框旋 转矩阵，
Figure 218476DEST_PATH_IMAGE042
为与虚拟外框旋转相关的正弦轴摆角误差矩阵，
Figure 251154DEST_PATH_IMAGE043
，
Figure 372694DEST_PATH_IMAGE044
，
Figure 539233DEST_PATH_IMAGE045
上式中
Figure 164249DEST_PATH_IMAGE046
角度为虚拟外框轴转动角度，
Figure 367829DEST_PATH_IMAGE047
、
Figure 773402DEST_PATH_IMAGE048
为虚拟外框轴摆角常值误 差；
Figure 681315DEST_PATH_IMAGE049
、
Figure 862636DEST_PATH_IMAGE050
为与虚拟外框旋转角相关的正弦项轴摆角误差幅值，
Figure 361750DEST_PATH_IMAGE051
、
Figure 192303DEST_PATH_IMAGE052
为与虚拟 外框旋转角相关的正弦项轴摆角的角度系数值，
Figure 576011DEST_PATH_IMAGE053
、
Figure 175620DEST_PATH_IMAGE054
为与虚拟外框旋转角相关的 正弦项轴摆角初始相位。
其中S4步骤虚拟外框载体坐标系到舰船载体坐标系转换为虚拟外框载体坐标系到舰船载体坐标系姿态矩阵：
Figure 111215DEST_PATH_IMAGE055
当虚拟外框载体坐标系与舰船载体坐标系不重合时，通过标定或测量计算出舰船 相对于惯性导航系统的姿态零位：
Figure 101167DEST_PATH_IMAGE056
表示横摇角零位、
Figure 85304DEST_PATH_IMAGE057
表示纵摇角零位和
Figure 867315DEST_PATH_IMAGE058
表示航向 角零位。
其中步骤5中台体载体坐标系到舰船载体坐标系转换矩阵为：
Figure 583598DEST_PATH_IMAGE059
。
本发明的有益效果是：
本发明提供了一种三轴旋转式惯性导航系统姿态解耦方法，通过虚拟三框架载体坐标系，同时考虑轴摆误差角与旋转角相关的正弦误差项，将台体载体坐标系解耦至舰船载体坐标系，实现三轴旋转式惯性导航系统高精度姿态解耦，具有较高的工程应用价值。
具体实施方式
为了使本技术领域的技术人员更好地理解本发明的技术方案，下面结合最佳实施例对本发明作进一步的详细说明。
理想情况下，舰船载体姿态矩阵一般可以表示为：
Figure 388743DEST_PATH_IMAGE060
(1)
Figure 238888DEST_PATH_IMAGE061
为台体姿态矩阵，
Figure 983727DEST_PATH_IMAGE004
为虚拟内框载体坐标系至初始虚拟内框载体坐标系的转 换矩阵，
Figure 198808DEST_PATH_IMAGE024
为虚拟中框载体坐标系至初始虚拟内框载体坐标系的转换矩阵，
Figure 287987DEST_PATH_IMAGE062
为虚拟 外框载体坐标系至初始虚拟外框载体坐标系的转换矩阵，
Figure 879505DEST_PATH_IMAGE063
为舰船载体姿态矩阵。
三轴旋转式惯性导航系统轴摆角误差补偿方法依次为：台体载体坐标系到虚拟内框载体坐标系补偿，虚拟内框载体坐标系到虚拟中框载体坐标系补偿，虚拟中框载体坐标系到虚拟外框载体坐标系补偿，虚拟外框载体坐标系到舰船载体坐标系补偿。
而舰船载体姿态矩阵依次通过台体载体坐标系到虚拟内框载体坐标系转换，虚拟内框载体坐标系到虚拟中框载体坐标系转换，虚拟中框载体坐标系到虚拟外框载体坐标系转换，虚拟外框载体坐标系到舰船载体坐标系转换，具体为：
1 .台体载体坐标系到虚拟内框载体坐标系转换
Figure 245896DEST_PATH_IMAGE064
为台体姿态矩阵，由于轴摆角误差的影响，
Figure 428615DEST_PATH_IMAGE003
为台体到虚拟内框的轴摆角误差 矩阵，
Figure 208352DEST_PATH_IMAGE004
为虚拟内框旋转矩阵，
Figure 10086DEST_PATH_IMAGE005
为与虚拟内框旋转相关的正弦轴摆角误差矩阵，四者 的乘积可得到台体载体坐标系到虚拟内框载体坐标系的姿态矩阵
Figure 355617DEST_PATH_IMAGE065
，具体为：
Figure 178079DEST_PATH_IMAGE001
(2)
其中
Figure 117217DEST_PATH_IMAGE066
,
Figure 50538DEST_PATH_IMAGE067
，
Figure 250575DEST_PATH_IMAGE068
,
Figure 243939DEST_PATH_IMAGE069
上式中
Figure 897468DEST_PATH_IMAGE010
、
Figure 431218DEST_PATH_IMAGE011
、
Figure 689024DEST_PATH_IMAGE012
分别为台体的横摇角、纵摇角和航向角，
Figure 525393DEST_PATH_IMAGE013
角度为虚拟内框轴 转动角度，
Figure 298177DEST_PATH_IMAGE014
、
Figure 573300DEST_PATH_IMAGE015
为虚拟内框轴摆角常值误差；
Figure 888875DEST_PATH_IMAGE016
、
Figure 755200DEST_PATH_IMAGE017
为与虚拟内框旋转角相关的正 弦项轴摆角误差幅值，
Figure 218542DEST_PATH_IMAGE018
、
Figure 969461DEST_PATH_IMAGE019
为与虚拟内框旋转角相关的正弦项轴摆角的角度系数值，
Figure 201859DEST_PATH_IMAGE020
、
Figure 504664DEST_PATH_IMAGE021
为与虚拟内框旋转角相关的正弦项轴摆角初始相位。
2 .虚拟内框载体坐标系到虚拟中框载体坐标系转换
由于轴摆角误差的影响，
Figure 625942DEST_PATH_IMAGE070
为虚拟内框载体坐标系到虚拟中框的轴摆角误差矩 阵，
Figure 242868DEST_PATH_IMAGE024
为虚拟中框旋转矩阵，
Figure 392090DEST_PATH_IMAGE071
为与虚拟中框旋转相关的正弦轴摆角误差矩阵，三者 的乘积可得到虚拟内框载体坐标系到虚拟中框载体坐标系姿态矩阵
Figure 69059DEST_PATH_IMAGE072
，具体为：
Figure 179097DEST_PATH_IMAGE022
(3)
其中
Figure 130872DEST_PATH_IMAGE073
，
Figure 337863DEST_PATH_IMAGE074
，
Figure 857837DEST_PATH_IMAGE076
上式中
Figure 517489DEST_PATH_IMAGE077
角度为虚拟中框轴转动角度，
Figure 538534DEST_PATH_IMAGE031
、
Figure 600031DEST_PATH_IMAGE078
为虚拟中框轴摆角常值误差；
Figure 556486DEST_PATH_IMAGE033
、
Figure 703433DEST_PATH_IMAGE079
为虚拟中框旋转角相关的正弦项轴摆误差幅值，
Figure 997011DEST_PATH_IMAGE035
、
Figure 349233DEST_PATH_IMAGE080
为与虚拟中框旋 转角相关的正弦项轴摆角的角度系数值，
Figure 538906DEST_PATH_IMAGE081
、
Figure 235467DEST_PATH_IMAGE038
为与虚拟中框旋转角相关的正弦 项轴摆角初始相位。
3 .虚拟中框载体坐标系到虚拟外框载体坐标系转换
由于轴摆角误差的影响，
Figure 535998DEST_PATH_IMAGE082
为虚拟中框载体坐标系到虚拟外框的轴摆角误差矩 阵，
Figure 244191DEST_PATH_IMAGE062
为虚拟外框旋转矩阵，
Figure 401503DEST_PATH_IMAGE083
为与虚拟外框旋转相关的正弦轴摆角误差矩阵，三者的 乘积可得到虚拟中框载体坐标系到虚拟外框载体坐标系姿态矩阵
Figure 523043DEST_PATH_IMAGE084
，具体为：
Figure 299369DEST_PATH_IMAGE039
(4)
其中
Figure 189964DEST_PATH_IMAGE085
，
Figure 783757DEST_PATH_IMAGE086
，
Figure 799117DEST_PATH_IMAGE087
上式中
Figure 707030DEST_PATH_IMAGE088
角度为虚拟外框轴转动角度，
Figure 514449DEST_PATH_IMAGE047
、
Figure 216826DEST_PATH_IMAGE048
为虚拟外框轴摆角常值误差；
Figure 218018DEST_PATH_IMAGE049
、
Figure 460780DEST_PATH_IMAGE050
为与虚拟外框旋转角相关的正弦项轴摆角误差幅值，
Figure 325968DEST_PATH_IMAGE051
、
Figure 136929DEST_PATH_IMAGE089
为与虚拟外 框旋转角相关的正弦项轴摆角的角度系数值，
Figure 454778DEST_PATH_IMAGE053
、
Figure 235652DEST_PATH_IMAGE054
为与虚拟外框旋转角相关的正弦 项轴摆角初始相位。
4．虚拟外框载体坐标系到舰船载体坐标系转换
Figure 893030DEST_PATH_IMAGE090
为虚拟外框载体坐标系至舰船载体坐标系的转换矩阵，也可称为姿态零位矩 阵。当虚拟外框载体坐标系与舰船载体坐标系不重合时，通过标定或测量计算出舰船相对 于惯性导航系统的姿态零位：
Figure 937209DEST_PATH_IMAGE091
表示横摇角零位、
Figure 804671DEST_PATH_IMAGE092
表示纵摇角零位和
Figure 592499DEST_PATH_IMAGE058
表示航向角零 位，此时
Figure 104382DEST_PATH_IMAGE093
(5)
一般只考察惯性导航系统姿态时，可将
Figure 319463DEST_PATH_IMAGE094
设为单位矩阵。
5．台体载体坐标系到舰船载体坐标系转换
由前面四个步骤，可得舰船载体姿态矩阵为：
Figure 143063DEST_PATH_IMAGE095
(6)
通过上述公式可以对三轴旋转式惯性导航系统姿态解耦。实现用非耦合状态下的三框数据表示三轴旋转式惯性导航系统姿态。通过虚拟三框架载体坐标系，同时考虑轴摆误差角与旋转角相关的正弦误差项，获得台体载体坐标系到舰船载体坐标系转换矩阵，实现三轴旋转式惯性导航系统高精度姿态解耦，具有较高的工程应用价值。
以上所述仅是本发明的优选实施方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理的前提下，还可以做出若干改进和润饰，这些改进和润饰也应视为本发明的保护范围。

Claims (3)

1.一种基于虚拟框架载体坐标系惯性导航系统姿态解耦方法，其特征在于，包括如下步骤：
S1.台体载体坐标系到虚拟内框载体坐标系转换，其中虚拟内框载体坐标系的姿态矩阵：
Figure 853668DEST_PATH_IMAGE001
，
Figure 247740DEST_PATH_IMAGE002
为台体姿态矩阵，
Figure 193087DEST_PATH_IMAGE003
为台体到虚拟内框的轴摆角误差矩阵，
Figure 723425DEST_PATH_IMAGE004
为虚拟内框旋转 矩阵，
Figure 742197DEST_PATH_IMAGE005
为与虚拟内框旋转相关的正弦轴摆角误差矩阵，
Figure 623565DEST_PATH_IMAGE006
，
Figure 385985DEST_PATH_IMAGE007
，
Figure 285676DEST_PATH_IMAGE008
，
Figure 209770DEST_PATH_IMAGE009
上式中
Figure 578435DEST_PATH_IMAGE010
、
Figure 613387DEST_PATH_IMAGE011
、
Figure 649476DEST_PATH_IMAGE012
分别为台体的横摇角、纵摇角和航向角，
Figure 728159DEST_PATH_IMAGE013
角度为虚拟内框轴转动 角度，
Figure 23268DEST_PATH_IMAGE014
、
Figure 111178DEST_PATH_IMAGE015
为虚拟内框轴摆角常值误差；
Figure 736195DEST_PATH_IMAGE016
、
Figure 2091DEST_PATH_IMAGE017
为与虚拟内框旋转角相关的正弦项 轴摆角误差幅值，
Figure 345347DEST_PATH_IMAGE018
、
Figure 987681DEST_PATH_IMAGE019
为与虚拟内框旋转角相关的正弦项轴摆角的角度系数值，
Figure 731120DEST_PATH_IMAGE020
、
Figure 433497DEST_PATH_IMAGE021
为与虚拟内框旋转角相关的正弦项轴摆角初始相位，
S2.虚拟内框载体坐标系到虚拟中框载体坐标系转换，其中虚拟内框载体坐标系到虚拟中框载体坐标系姿态矩阵：
Figure 998471DEST_PATH_IMAGE022
，
Figure 444495DEST_PATH_IMAGE023
为虚拟内框载体坐标系到虚拟中框的轴摆角误差矩阵，
Figure 778525DEST_PATH_IMAGE024
为虚拟中框旋转矩阵，
Figure 901070DEST_PATH_IMAGE025
为与虚拟中框旋转相关的正弦轴摆角误差矩阵，
Figure 953340DEST_PATH_IMAGE026
，
Figure 671897DEST_PATH_IMAGE027
，
Figure 126013DEST_PATH_IMAGE028
上式中
Figure 170192DEST_PATH_IMAGE029
角度为虚拟中框轴转动角度，
Figure 959025DEST_PATH_IMAGE030
、
Figure 746853DEST_PATH_IMAGE031
为虚拟中框轴摆角常值误差；
Figure 55474DEST_PATH_IMAGE032
、
Figure 4976DEST_PATH_IMAGE033
为虚拟中框旋转角相关的正弦项轴摆误差幅值，
Figure 31838DEST_PATH_IMAGE034
、
Figure 607044DEST_PATH_IMAGE035
为与虚拟中框旋转 角相关的正弦项轴摆角的角度系数值，
Figure 35752DEST_PATH_IMAGE036
、
Figure 156154DEST_PATH_IMAGE037
为与虚拟中框旋转角相关的正弦项轴 摆角初始相位，
S3.虚拟中框载体坐标系到虚拟外框载体坐标系转换，其中虚拟中框载体坐标系到虚拟外框载体坐标系姿态矩阵：
Figure 935891DEST_PATH_IMAGE038
，
Figure 799942DEST_PATH_IMAGE039
为虚拟中框载体坐标系到虚拟外框的轴摆角误差矩阵，
Figure 69774DEST_PATH_IMAGE040
为虚拟外框旋转矩阵，
Figure 626657DEST_PATH_IMAGE041
为与虚拟外框旋转相关的正弦轴摆角误差矩阵，
Figure 628111DEST_PATH_IMAGE042
，
Figure 295853DEST_PATH_IMAGE043
，
Figure 433573DEST_PATH_IMAGE044
上式中
Figure 410626DEST_PATH_IMAGE045
角度为虚拟外框轴转动角度，
Figure 899376DEST_PATH_IMAGE046
、
Figure 105229DEST_PATH_IMAGE047
为虚拟外框轴摆角常值误差；
Figure 97456DEST_PATH_IMAGE048
、
Figure 261721DEST_PATH_IMAGE049
为与虚拟外框旋转角相关的正弦项轴摆角误差幅值，
Figure 955876DEST_PATH_IMAGE050
、
Figure 699841DEST_PATH_IMAGE051
为与虚拟外框旋转 角相关的正弦项轴摆角的角度系数值，
Figure 812154DEST_PATH_IMAGE052
、
Figure 881741DEST_PATH_IMAGE053
为与虚拟外框旋转角相关的正弦项轴 摆角初始相位，
S4.虚拟外框载体坐标系到舰船载体坐标系转换，
S5. 依次完成S1、S2、S3、S4四步转换，获得台体载体坐标系到舰船载体坐标系姿态矩阵，实现姿态解耦。
2.根据权利要求1所述的一种基于虚拟框架载体坐标系惯性导航系统姿态解耦方法，其特征在于，其中S4步骤虚拟外框载体坐标系到舰船载体坐标系转换为虚拟外框载体坐标系到舰船载体坐标系姿态矩阵：
Figure 328772DEST_PATH_IMAGE054
当虚拟外框载体坐标系与舰船载体坐标系不重合时，通过标定或测量计算出舰船相对 于惯性导航系统的姿态零位：
Figure 142007DEST_PATH_IMAGE055
表示横摇角零位、
Figure 108826DEST_PATH_IMAGE056
表示纵摇角零位和
Figure 349315DEST_PATH_IMAGE057
表示航向角零 位。
3.根据权利要求2所述的一种基于虚拟框架载体坐标系惯性导航系统姿态解耦方法，其特征在于，其中步骤5中台体载体坐标系到舰船载体坐标系转换矩阵为：
Figure 34374DEST_PATH_IMAGE058
。
CN202211003826.4A 2022-08-22 2022-08-22 一种基于虚拟框架载体坐标系惯性导航系统姿态解耦方法 Active CN115077521B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211003826.4A CN115077521B (zh) 2022-08-22 2022-08-22 一种基于虚拟框架载体坐标系惯性导航系统姿态解耦方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211003826.4A CN115077521B (zh) 2022-08-22 2022-08-22 一种基于虚拟框架载体坐标系惯性导航系统姿态解耦方法

Publications (2)

Publication Number Publication Date
CN115077521A CN115077521A (zh) 2022-09-20
CN115077521B true CN115077521B (zh) 2022-11-01

Family

ID=83244570

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211003826.4A Active CN115077521B (zh) 2022-08-22 2022-08-22 一种基于虚拟框架载体坐标系惯性导航系统姿态解耦方法

Country Status (1)

Country Link
CN (1) CN115077521B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116026330B (zh) * 2023-03-30 2023-06-16 中国船舶集团有限公司第七〇七研究所 基于光纤陀螺数字信号的三轴旋转式框架施矩方法及系统

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102721417A (zh) * 2011-12-23 2012-10-10 北京理工大学 一种捷联惯性导航系统凝固惯性系粗对准误差抑制方法
CN103591949A (zh) * 2013-10-25 2014-02-19 西安石油大学 三轴姿态测量系统非正交性误差的正交补偿方法
CN104501809A (zh) * 2014-12-04 2015-04-08 哈尔滨工程大学 一种基于姿态耦合的捷联惯导/星敏感器组合导航方法
CN108507592A (zh) * 2018-03-30 2018-09-07 北京理工大学 一种双轴旋转惯性导航系统转轴非正交角标定方法
CN109974749A (zh) * 2019-04-09 2019-07-05 哈尔滨工业大学 一种三轴转台综合指向误差的评定方法
CN113465631A (zh) * 2021-07-02 2021-10-01 中国人民解放军海军工程大学 基于体对角线旋转的惯导误差调制方法

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103674023B (zh) * 2013-12-26 2014-10-15 中国人民解放军国防科学技术大学 一种基于陀螺精确角度关联的星敏感器动态测姿方法
CN110488853B (zh) * 2019-08-29 2021-06-08 北京航空航天大学 一种降低转轴涡动影响的混合式惯导系统稳定控制指令的计算方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102721417A (zh) * 2011-12-23 2012-10-10 北京理工大学 一种捷联惯性导航系统凝固惯性系粗对准误差抑制方法
CN103591949A (zh) * 2013-10-25 2014-02-19 西安石油大学 三轴姿态测量系统非正交性误差的正交补偿方法
CN104501809A (zh) * 2014-12-04 2015-04-08 哈尔滨工程大学 一种基于姿态耦合的捷联惯导/星敏感器组合导航方法
CN108507592A (zh) * 2018-03-30 2018-09-07 北京理工大学 一种双轴旋转惯性导航系统转轴非正交角标定方法
CN109974749A (zh) * 2019-04-09 2019-07-05 哈尔滨工业大学 一种三轴转台综合指向误差的评定方法
CN113465631A (zh) * 2021-07-02 2021-10-01 中国人民解放军海军工程大学 基于体对角线旋转的惯导误差调制方法

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
光纤陀螺惯导稳定平台与旋转调制方法;胡小毛等;《导航定位与授时》;20180315(第02期);全文 *
单轴旋转惯导系统"航向耦合效应"分析与补偿;许江宁等;《中国惯性技术学报》;20130215(第01期);全文 *
基于双轴转台的捷联惯导系统姿态精度评定算法;张和杰等;《舰船电子工程》;20150420(第04期);全文 *
某姿态测量系统标定用转台指向误差补偿;霍炬等;《哈尔滨工业大学学报》;20100115(第01期);全文 *

Also Published As

Publication number Publication date
CN115077521A (zh) 2022-09-20

Similar Documents

Publication Publication Date Title
CN109211269B (zh) 一种双轴旋转惯导系统姿态角误差标定方法
CA2398704C (en) Attitude estimation in tiltable body using modified quaternion data representation
CN115077521B (zh) 一种基于虚拟框架载体坐标系惯性导航系统姿态解耦方法
WO2022135011A1 (zh) 合质心状态获取方法、装置、仿人机器人和可读存储介质
CN106500733B (zh) 一种三轴旋转惯导系统框架不正交角自标定及补偿方法
CN109375651B (zh) 一种运动平台地平式光电跟踪系统抗滚动轴扰动方法
CN116734887B (zh) 基于速度误差修正模型的极地双惯导协同标定方法
CN116448145A (zh) 一种基于偏振矢量空间差分的航姿确定方法
CN116817896B (zh) 一种基于扩展卡尔曼滤波的姿态解算方法
CN108489485B (zh) 一种无误差的捷联惯导数值更新方法
CN110986928A (zh) 光电吊舱三轴陀螺仪漂移实时修正方法
CN114216456A (zh) 一种基于imu与机器人本体参数融合的姿态测量方法
CN112129322A (zh) 一种捷联惯组与三轴转台的安装误差检测方法及校正方法
CN109443352B (zh) 一种四轴惯性稳定平台系统的伺服回路解耦方法
Wei et al. Novel rotation scheme for dual-axis rotational inertial navigation system based on body diagonal rotation of inertial measurement unit
CN112284412B (zh) 一种避免欧拉转换奇异导致精度下降的地面静态对准方法
CN116242397B (zh) 一种速度误差修正模型下的双惯导协同标定方法
CN110955255B (zh) 基于cmg的高精度轨控姿态维持方法、系统及介质
CN112857366A (zh) 一种基于压缩结构的光纤捷联惯导系统姿态解算方法
CN116026330B (zh) 基于光纤陀螺数字信号的三轴旋转式框架施矩方法及系统
CN115790668A (zh) 一种高精度惯导标度因数误差计算方法
CN115855063A (zh) 基于绝对姿态递推修正的交会对接敏感器数据预处理方法
CN114252073B (zh) 一种机器人姿态数据融合方法
CN113447018A (zh) 一种水下惯性导航系统的姿态实时估计方法
CN114166215B (zh) 一种旋转捷联惯组的转位机构和imu同步标定及补偿方法

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