前言

文中算法公式摘自《捷联惯导算法与组合导航原理》（严恭敏、翁浚编著）、《惯性导航》（秦永元编著），其他理解仅代表个人观点。本文是对姿态角和姿态矩阵之间转化的理解。

一、定义

机体坐标系b系定义：
o飞机质心
x轴指向机头方向
z轴处在飞机对称面垂直x轴向下
y轴垂直oxz平面指向飞机右侧

导航系n系的定义：
xyz轴指向北东地（或东北天）方向

姿态角的定义（这里地面系指北东地坐标）：
俯仰角：机体系x轴与地平面夹角，俯仰角抬头为正
横滚角：机体系z轴与包含机体系x轴铅锤面的夹角，右滚为正
航向角：机体系x轴在地平面投影与地面系x轴的夹角，投影在地面系x轴右侧为正。

二、姿态角转化为姿态矩阵

导航系转化为机体系：向右旋转航向角、向上旋转俯仰角、向右旋转横滚角，该顺序旋转符合姿态角的定义。
先用北东地坐标系

转化到三维坐标

采用北东地坐标系时：先绕z轴转航向角，再绕y轴转俯仰角，最后绕x轴转横滚角

采用东北天坐标系时（机体系右前上，航向角北偏东为正时）：先绕z轴转航向角，再绕x轴转俯仰角，最后绕y轴转横滚角。
如果航向角北偏西为正，取负即可。

三、根据姿态矩阵求姿态角

根据姿态矩阵中的角度求解姿态角。
之前程序中由于俯仰角范围在-pi/2~pi/2 范围内，余弦值为正，其实并不完全合理。
根据余弦项可以求出俯仰角，可以知道俯仰角的正负，因此可以判断出横滚和航向角正余弦
的符号，根据四象限反正切，可以求出横滚和航向角。

捷联惯导算法（三）姿态角和姿态矩阵相关推荐

捷联惯导算法与组合导航原理学习——四元数和姿态阵转换（二）
四元数和姿态阵转换学习资料参考: [1] 严恭敏,翁浚. 捷联惯导算法与组合导航原理[M]. 西安: 西北工业大学出版社, 2019.8. Quaternion.h #pragma once #in ...
捷联惯导算法与组合导航原理学习——等效旋转矢量和姿态阵转换（一）
等效旋转矢量和姿态阵转换学习资料参考: [1] 严恭敏,翁浚. 捷联惯导算法与组合导航原理[M]. 西安: 西北工业大学出版社, 2019.8. EquRotationVec.h #pragma o ...
捷联惯导基础知识解析之一（姿态表示方法基础知识）
1.定轴运动与非定轴运动即转轴固定不动的转动:因此可得知,在捷联惯导应用中,X.Y.Z轴在空间中都存在转动,所以整个过程为非定轴运动. 2.不可交换性误差: 起因:在非定轴转动情况下, 描述姿态运动 ...
基于matlab的捷联惯导算法设计及仿真,基于 Matlab 的捷联惯导算法设计及仿真1doc.doc...
基于 Matlab 的捷联惯导算法设计及仿真1doc 基于 Matlab 的捷联惯导算法设计及仿真1 严恭敏西北工业大学航海学院,西安 (710072) E-mail:yangongmin@163. ...
捷联惯导算法--体会与心得
本文转自:http://www.amobbs.com/thread-5492189-1-1.html,收藏学习! 1.四个概念:"地理"坐标系."机体"坐标系. ...
【算法学习笔记001】捷联惯导算法心得
1.四个概念:"地理"坐标系."机体"坐标系.他们之间换算公式.换算公式用的系数. 地理坐标系:东.北.天,以下简称地理.在这个坐标系里有重力永远是(0,0,1 ...
捷联惯导算法（二）位置更新算法的理解
前言文中算法公式摘自<捷联惯导算法与组合导航原理>(严恭敏.翁浚编著).<惯性导航>(秦永元编著),其他理解仅代表个人观点.本文是对位置更新算法,按照自己学习的思路整理得 ...
捷联惯导算法（四）姿态更新算法
前言本文是对姿态更新算法的理解. 一.姿态更新算法地心惯性坐标系(i系)绝对不动的惯性参考坐标系,与时间无关. 个人理解: 地心惯性坐标系是绝对不动的,因此机体系到导航系的姿态矩阵可以先由机体系到 ...
035捷联惯导中三种姿态更新算法说明
看到了不同的姿态更新算法,很迷惑,陷入了谁相对于谁的思考中.翻翻严老师博客,贴出来如下: 原文地址:http://blog.sina.com.cn/s/blog_40edfdc90102v6il.ht ...

捷联惯导算法（三）姿态角和姿态矩阵

前言

一、定义

二、姿态角转化为姿态矩阵

三、根据姿态矩阵求姿态角

捷联惯导算法（三）姿态角和姿态矩阵相关推荐

最新文章

热门文章