CN115655271B - 一种动态条件下的大范围姿态角提取方法 - Google Patents
一种动态条件下的大范围姿态角提取方法 Download PDFInfo
- Publication number
- CN115655271B CN115655271B CN202211651292.6A CN202211651292A CN115655271B CN 115655271 B CN115655271 B CN 115655271B CN 202211651292 A CN202211651292 A CN 202211651292A CN 115655271 B CN115655271 B CN 115655271B
- Authority
- CN
- China
- Prior art keywords
- angle
- carrier
- attitude
- range
- extracting
- 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
Landscapes
- Navigation (AREA)
Abstract
本发明涉及捷联惯性导航系统技术领域,尤其是捷联惯导系统应用于大范围姿态角变化的载体上的动态条件下的大范围姿态角提取方法,捷联惯性导航系统为载体提供实时姿态角输出,用来描述载体系与导航系之间的空间旋转关系。当载体俯仰角接近正负90度时,利用传统姿态角提取算法,将无法正确提取三个姿态角,特别是无法独立求解横滚角和方位角各自的数值。本发明设计动态条件下的大范围姿态角提取方法,利用惯导参考信息辅助,计算载体横倾角,最终实现横滚角与方位角的独立求解,使得捷联惯导系统在动态条件下仍可以保证大范围姿态角的准确提取。
Description
技术领域
本发明涉及捷联惯性导航系统技术领域,尤其是捷联惯导系统应用于大范围姿态角变化的载体上的动态条件下的大范围姿态角提取方法。
背景技术
捷联惯导系统是一种为载体提供实时姿态角、速度和位置信息的导航系统。在导航参数中姿态角用于描述载体系相对于导航系的三维旋转角度关系。在一般载体应用环境中,横滚角为载体立轴与纵轴所在平面与铅垂面之间的夹角,左高右低为正,角度范围为(-180°,180°];纵摇角为载体纵轴与其水平面投影之间的夹角。抬头为正,角度范围为(-90°,90°);航向角为载体纵轴在当地水平面上的投影与当地地理北向的夹角,北偏东为正,角度范围为[0°,360°)。
在大范围姿态角变化的载体上如飞行器等应用环境中,当纵摇角在±90°附近时,横滚角和航向角之间无法单独分离,存在多值性。如何准确的得到横滚角、航向角及纵摇角各自的准确信息是亟待解决的问题。
发明内容
本发明旨在至少解决相关技术中存在的技术问题之一。为此,本发明提供利用横倾角参考信息,设计了一种简洁快速的动态条件下的大范围姿态角提取方法。
本发明提供一种动态条件下的大范围姿态角提取方法,包括如下步骤:
根据本发明提供的还包括:
本发明实施例中的上述一个或多个技术方案,至少具有如下技术效果之一:
本发明的计算方法,利用惯导参考信息辅助,计算横倾角,最终实现横滚角、纵摇角及航向角的独立求解,使得捷联惯导系统在动态条件下仍可以保证大范围姿态角的准确提取。
本发明的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
为了更清楚地说明本发明或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明实施例提供的导航坐标系n系至载体坐标系b系的转换原理示意图;
图2是本发明实施例提供的导航坐标系n系至载体坐标系b系的转换坐标示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合本发明中的附图,对本发明中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。以下实施例用于说明本发明,但不能用来限制本发明的范围。
在本发明实施例的描述中,需要说明的是,术语“中心”、“纵向”、“横向”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明实施例和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明实施例的限制。
在本发明实施例的描述中,需要说明的是,除非另有明确的规定和限定,术语“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体连接;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连。对于本领域的普通技术人员而言,可以具体情况理解上述术语在本发明实施例中的具体含义。
下面将参照附图更详细地描述本公开的实施例。虽然附图中显示了本公开的某些实施例,然而应当理解的是,本公开可以通过各种形式来实现,而且不应该被解释为限于这里阐述的实施例,相反提供这些实施例是为了更加透彻和完整地理解本公开。应当理解的是,本公开的附图及实施例仅用于示例性作用,并非用于限制本公开的保护范围。
本发明提供了一种动态条件下的大范围姿态角提取方法。
载体纵轴轴向在水平面内的投影称为航向,用北向基准线和航向之间的夹角表示航向角,以北偏东方向为正向,取值[0,360°)。
载体纵轴与水平面之间的夹角为纵摇角,以艏高为正向,取值(-90°,90°)。
载体立轴与纵轴所在平面与铅垂面之间的夹角为横滚角,以右低为正向,取值(-180°,180°)。
如图1、图2所示导航坐标系n系至载体坐标系b系的转换关系,这个过程可按照航向角、纵摇角和横滚角的定义转动三次实现。
Ox n y n z n 绕Oz n 转动H角对应的姿态转换矩阵为:
Ox 1 y 1 z 1绕Ox 1转动P角对应的姿态转换矩阵为:
Ox 2 y 2 z 2绕Oy 2转动R角对应的姿态转换矩阵为:
导航坐标系n系到载体坐标系b系的姿态转换矩阵为
由上式可求
其中atan2为标准C函数库中四象限反正切函数。
同理,由上式可求
其中atan2为标准C函数库中四象限反正切函数。
横滚角与横倾角有如下关系:
可先利用加速度计对当地重力加速度的测量值来计算横倾角。惯导系统中的惯性
测量组件(IMU)包含三轴加速度计,利用加速度计可计算载体系各轴相对于当地地理水平
的倾斜角,其中载体横轴与当地水平面之间的夹角为横倾角,在载体静态条件下可利用
横向加速度计测量值计算如下
在实际工作环境中,载体运动过程中会产生额外的运动加速度,惯性测量组件中的加速度计测量的和加速度为当地重力加速度与载体运动加速度的矢量和,此时计算横倾角需要从加速度计测量的和加速度矢量中剔除运动加速度的分量,得到当地重力加速度沿载体系的测量值,计算如下所示
本发明的计算方法,利用惯导参考信息辅助,计算横倾角,最终实现横滚角、纵摇角及航向角的独立求解,使得捷联惯导系统在动态条件下仍可以保证大范围姿态角的准确提取。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (7)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211651292.6A CN115655271B (zh) | 2022-12-22 | 2022-12-22 | 一种动态条件下的大范围姿态角提取方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211651292.6A CN115655271B (zh) | 2022-12-22 | 2022-12-22 | 一种动态条件下的大范围姿态角提取方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115655271A CN115655271A (zh) | 2023-01-31 |
CN115655271B true CN115655271B (zh) | 2023-03-10 |
Family
ID=85022866
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211651292.6A Active CN115655271B (zh) | 2022-12-22 | 2022-12-22 | 一种动态条件下的大范围姿态角提取方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115655271B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117091596A (zh) * | 2023-10-09 | 2023-11-21 | 腾讯科技(深圳)有限公司 | 一种姿态信息获取方法以及相关设备 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103900565A (zh) * | 2014-03-04 | 2014-07-02 | 哈尔滨工程大学 | 一种基于差分gps的惯导系统姿态获取方法 |
CN109115212A (zh) * | 2018-10-30 | 2019-01-01 | 中国船舶重工集团公司第七0七研究所 | 一种惯导系统全范围姿态角提取方法 |
CN110764119A (zh) * | 2019-11-07 | 2020-02-07 | 中国人民解放军火箭军工程大学 | 不依赖于卫星导航信息的卫星天线自主测控方法及系统 |
CN110851776A (zh) * | 2019-11-19 | 2020-02-28 | 东南大学 | 一种高动态变转速载体的姿态解算方法 |
CN111044038A (zh) * | 2019-12-05 | 2020-04-21 | 河北汉光重工有限责任公司 | 一种基于坐标变换的捷联惯导艏向变换方法 |
CN111623768A (zh) * | 2020-04-24 | 2020-09-04 | 北京航天控制仪器研究所 | 一种基于克雷洛夫角奇异条件下的姿态角解算方法 |
CN111780749A (zh) * | 2020-05-26 | 2020-10-16 | 北京航天控制仪器研究所 | 一种变轨机动飞机全姿态惯性导航的姿态控制方法 |
CN114111835A (zh) * | 2020-09-01 | 2022-03-01 | 北京原子机器人科技有限公司 | 实时磁场标定系统和方法 |
CN115024715A (zh) * | 2022-05-20 | 2022-09-09 | 北京航天时代光电科技有限公司 | 一种人体运动智能测量与数字训练系统 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1152237C (zh) * | 2001-03-30 | 2004-06-02 | 清华大学 | 基于微机电技术的微型导航系统 |
CN104064869B (zh) * | 2014-06-13 | 2016-10-05 | 北京航天万达高科技有限公司 | 基于mems惯导的双四元数动中通天线控制方法及系统 |
-
2022
- 2022-12-22 CN CN202211651292.6A patent/CN115655271B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103900565A (zh) * | 2014-03-04 | 2014-07-02 | 哈尔滨工程大学 | 一种基于差分gps的惯导系统姿态获取方法 |
CN109115212A (zh) * | 2018-10-30 | 2019-01-01 | 中国船舶重工集团公司第七0七研究所 | 一种惯导系统全范围姿态角提取方法 |
CN110764119A (zh) * | 2019-11-07 | 2020-02-07 | 中国人民解放军火箭军工程大学 | 不依赖于卫星导航信息的卫星天线自主测控方法及系统 |
CN110851776A (zh) * | 2019-11-19 | 2020-02-28 | 东南大学 | 一种高动态变转速载体的姿态解算方法 |
CN111044038A (zh) * | 2019-12-05 | 2020-04-21 | 河北汉光重工有限责任公司 | 一种基于坐标变换的捷联惯导艏向变换方法 |
CN111623768A (zh) * | 2020-04-24 | 2020-09-04 | 北京航天控制仪器研究所 | 一种基于克雷洛夫角奇异条件下的姿态角解算方法 |
CN111780749A (zh) * | 2020-05-26 | 2020-10-16 | 北京航天控制仪器研究所 | 一种变轨机动飞机全姿态惯性导航的姿态控制方法 |
CN114111835A (zh) * | 2020-09-01 | 2022-03-01 | 北京原子机器人科技有限公司 | 实时磁场标定系统和方法 |
CN115024715A (zh) * | 2022-05-20 | 2022-09-09 | 北京航天时代光电科技有限公司 | 一种人体运动智能测量与数字训练系统 |
Non-Patent Citations (2)
Title |
---|
Fangjun Qin et al..Inertial Navigation System Calibration based on Direction Cosine Matrix Matching.2018,全文. * |
黄翔宇 ; 张洪华 ; 王大轶 ; 李骥 ; 关轶峰 ; 王鹏基 ; ."嫦娥三号"探测器软着陆自主导航与制导技术.2014,第1卷(第01期),全文. * |
Also Published As
Publication number | Publication date |
---|---|
CN115655271A (zh) | 2023-01-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110887481B (zh) | 基于mems惯性传感器的载体动态姿态估计方法 | |
CN109211269B (zh) | 一种双轴旋转惯导系统姿态角误差标定方法 | |
CN110954102B (zh) | 用于机器人定位的磁力计辅助惯性导航系统及方法 | |
CN112629538A (zh) | 基于融合互补滤波和卡尔曼滤波的舰船水平姿态测量方法 | |
CN111351482A (zh) | 基于误差状态卡尔曼滤波的多旋翼飞行器组合导航方法 | |
CN109186597B (zh) | 一种基于双mems-imu的室内轮式机器人的定位方法 | |
CN102809377A (zh) | 飞行器惯性/气动模型组合导航方法 | |
US11274788B2 (en) | Gimbal pose correction method and device | |
CN108731664B (zh) | 机器人状态估计方法、装置、计算机设备和存储介质 | |
CN106370178B (zh) | 移动终端设备的姿态测量方法及装置 | |
CN113587925B (zh) | 一种惯性导航系统及其全姿态导航解算方法与装置 | |
US20180088685A1 (en) | Attitude detecting device | |
JP2012173190A (ja) | 測位システム、測位方法 | |
CN105910606A (zh) | 一种基于角速度差值的方向修正方法 | |
CN112611380B (zh) | 基于多imu融合的姿态检测方法及其姿态检测装置 | |
CN108170297A (zh) | 实时六自由度vr/ar/mr设备定位方法 | |
CN115655271B (zh) | 一种动态条件下的大范围姿态角提取方法 | |
CN108426575A (zh) | 用地球椭球模型改进的捷联惯导极地横向导航方法 | |
CN114485641A (zh) | 一种基于惯导卫导方位融合的姿态解算方法及装置 | |
CN115540860A (zh) | 一种多传感器融合位姿估计算法 | |
CN111189442A (zh) | 基于cepf的无人机多源导航信息状态预测方法 | |
CN107677292A (zh) | 基于重力场模型的垂线偏差补偿方法 | |
CN115855048A (zh) | 一种多传感器融合位姿估计方法 | |
CN116817896A (zh) | 一种基于扩展卡尔曼滤波的姿态解算方法 | |
CN114926547A (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 |