捷联惯导基础知识解析之一(姿态表示方法基础知识)

article/2025/9/29 2:08:17

1、定轴运动与非定轴运动

转轴固定不动的转动;因此可得知,在捷联惯导应用中,X、Y、Z轴在空间中都存在转动,所以整个过程为非定轴运动。

2、不可交换性误差:

起因:在非定轴转动情况下, 描述姿态运动的微分方程是非线性的, 其离散化求解会引起转动不可交换误差。

解决:通过陀螺的输出(增量形式)构造等效旋转矢量以补偿和降低不可交换误差。

3、反对称矩阵形式

并且,反对称矩阵的转置是其负矩阵:

4、反对称矩阵的矩阵指数函数:

行列式为1的单位正交矩阵为右手直角坐标系变换矩阵;

行列式为-1的单位正交矩阵为左手直角坐标系变换矩阵;

5、坐标变换矩阵和坐标系变换矩阵——(注意说法)

P :从i系到b系的坐标系变换矩阵(过渡矩阵)

为从b系到i系的坐标变换矩阵;

注意:前面是,坐标系变换,后面是坐标变换


关于P的特点:

(1)P 中任一行向量为单位向量, 且任意两个不同行向量之间正交

(2)由于矩阵 P 中的每一个元素均表示两套坐标系( b 系和i 系)相应坐标轴之间夹角的余弦值,因此常称 P 为方向余弦阵(direction cosine matrix, DCM)。

如果导航坐标系(以东北天为例)经过三次旋转,旋转顺序为3-1-2,得到载体坐标系;则其表达方式为:

即:0系为导航系、3系为载体坐标系(右前上);即导航系到载体系的方向余弦矩阵

6、等效旋转矢量推导:

纯数学推导:

既:结果如下:该变换是转轴u和转角Θ的函数

方向余弦矩阵和等效旋转矢量关系:

7、姿态角及轴向描述

当运载体水平停放时:

横轴沿左右方向,可取向右方向为正;

纵轴沿前后方向,可取向前方向为正;

立轴沿上下方向, 可取向上方向为正。

描述运载体的一组欧拉角通常也称为姿态角, 包括:

航向角( 方位角或偏航角,yaw/azimuth/heading)、

俯仰角(高低角或纵摇角, pitch/elevation)、

横滚角( 滚动角或横摇角,roll),各角参数的定义与运载体各物理轴向相联系,详细定义如下
以下来自《捷联惯导算法与组合导航原理讲义》附录B1

参见图 B-3:

航向角ψ : 运载体纵轴在当地水平面上的投影线与当地地理北向的夹角, 常取北偏东
为正,即若从空中俯视运载体, 地理北向顺时针旋转至纵轴水平投影线的角度, 角度范围为 0~360° ,
或[0,2π) ;

俯仰角θ : 运载体纵轴与其水平投影线之间的夹角, 当运载体抬头时角度定义为正,角度范
围-90° ~90° ,或[-π/2, π/2] ;

横滚角γ :运载体立轴与纵轴所在铅垂面之间的夹角,当运载体向右倾
斜时角度定义为正,角度范围-180° ~180° ,或(-π, π]。

注:如果载体坐标系为右前上,则航向角为北偏西为正!

则图 B-3 给出的运载体欧拉角定义可以简单描述为“ (-3)12”方式。 类似的, 如果oxyz(g) 和oxyz(b)分别定义为“ 北-东-地” 地理坐标系和“前-右-下” 载体坐标系, 则运载体欧拉角定义应相应地变为“ 321”方式。由此可见,实际运载体欧拉角本质上是按物理轴向定义的, 一般依次按“ 立轴下->横轴右->纵轴前” 方式进行, 而与具体数学轴向选择无关。

8、方向余弦矩阵微分方程/姿态阵微分方程:

作用:建立了动坐标系相对于参考坐标系之间方向余弦阵与动坐标系运动角速度之间的关系!

等价公式:

相似变换公式:

9、方向余弦阵微分方程的求解(前提是:定轴转动)

定轴转动的假设下,不存在不可交换性误差;此处只是理论分析,实际中不直接使用!

即:

经过推导,为如下:

这表示在时间段[0, ] T 内, b 系相对于 i 系的转动角速度方向始终不变, 即为定轴转动!

从数学角度上看, 转动的不可交换性在于/等价于矩阵乘法的不可交换性; 反之,姿态可交换矩阵对应于定轴转动,即若有C1C2=C2C1, 则由C1和C2 所代表的两转轴之间必定相互平行!

(1):

(2):

则计算结果:

10、四元数

(1)四元数乘法矩阵表示:

(2)单位四元数三角函数表示法:

(3)根据方向余弦矩阵与单位四元数(三角函数表示法),进行恒等变换:

(4)利用四元数进行不同坐标系下的矢量变换

 

(5)四元数微分方程:

以下四种四元数微分方程之间是相互等价的:

(6)四元数微分方程求解(定轴运动)

11、等效旋转矢量

(1)推导等效旋转矢量微分方程基本形式:

(2)等效旋转矢量微分方程:

经过简化处理,并假设在m-1时刻等效旋转矢量为0,既我们只考虑等效旋转矢量“增量”

等效旋转矢量微分方程的解(泰勒展开解):以如下方程为基础推导:

等效旋转矢量双子样:

等效旋转矢量三子样:

双子样:”前一周期+单子样“

如何计算姿态?

研究者们提出了先通过角增量求解等效旋转矢量(避免了不可交换性误差)、 再利用等效旋转矢量更新方向余弦阵或四元数的方法!

坐标系相对转动的四种数学描述:角速度、姿态矩阵、四元数和等效旋转矢量;

12、圆锥现象:

当陀螺仪在其旋转轴和输出轴出现同频不同相的角振动时,尽管其输入轴净指向不变(从整体上看没有随时间改变的趋势项),但陀螺仪在输入轴上还是会敏感到并输出常值角速率信号。在这种情况下,陀螺仪支架的运动角速度可描述如下:

其中, a 、 b 和c 均为常数,在 x 和 y 轴表现为同频但相位差 90° 的正弦角振动, 振动频率为Ω , 而在 z轴上表现为常值角速率。 虽然输入轴 z 轴有角速率输入,但从长时间来看陀螺仪整体上并不绕着输入轴产生明显偏转。

具体表现:

圆锥运动假设条件下:

圆锥误差补偿系数:表达式和系数表

以四字样为例:

 

 


http://chatgpt.dhexx.cn/article/0ycETIuB.shtml

相关文章

捷联惯导算法(三)姿态角和姿态矩阵

前言 文中算法公式摘自《捷联惯导算法与组合导航原理》(严恭敏、翁浚 编著)、《惯性导航》(秦永元 编著),其他理解仅代表个人观点。本文是对姿态角和姿态矩阵之间转化的理解。 一、定义 机体坐标系b系定义&#xff1…

捷联惯导系统学习7.1(捷联惯导粗对准 )

初始对准:确定导航参数姿态、方位、速度、位置的初始值,方位的初始化是最难的。 单独的惯导难以长时间维持高精度定位导航,需要与其他方式综合。 捷联惯导粗对准 初始对准具体就是确定导航参考坐标系的一个过程,寻找导航坐标系…

04 捷联式惯导系统概要

捷联式惯导与平台式惯导最本质的区别在于用数学平台代替物理平台 捷联式惯导概要 捷联式惯导的加速度计是直接装在载体上的,得出的是载体坐标系(b系)内的数据,但是载体坐标系不能当作导航坐标系。 捷联式系统加速度计测得的比力…

低成本MEMS惯导系统的捷联惯导解算MATLAB仿真

低成本MEMS惯导系统的捷联惯导解算MATLAB仿真 一、姿态角转换为四元数二、四元数转换为姿态角三、反对称阵四、位置更新五、姿态更新六、程序及数据主程序:子程序:数据及完整程序 之前将高成本的捷联惯导忽略地球自转、圆锥曲线运动以及划桨运动等化简为…

捷联惯导更新算法及误差分析汇总

一、捷联惯导数值更新算法 导航坐标系&#xff1a;东-北-天 载体坐标系&#xff1a;右-前-上 1、姿态更新算法&#xff1a; <1>姿态更新微分方程&#xff1a; ,表示导航系相对于惯性系的旋转&#xff1b;包括两部分&#xff1a; (1)地球自转引起的导航系旋转&#x…

捷联惯导系统(SINS)机械编排

目录 前言姿态更新姿态微分方程姿态更新算法 速度更新速度微分方程速度更新算法重力/哥氏积分项比力积分项右端第三积分项右端第二积分项 速度更新方程 位置更新位置微分方程位置更新算法 前言 IMU中的加速度计及陀螺仪测得原始数据为速度增量及角度增量&#xff0c;需要通过机…

捷联惯导基础知识解析之四(粗/精对准和GPS/IMU和GPS/里程计组合导航)

初始对准&#xff08;粗、精对准&#xff09;/组合导航 一、捷联惯导粗对准 目的&#xff1a;寻找、确定参考导航坐标系&#xff1b;结果表现形式&#xff1a;得到姿态矩阵&#xff08;进而可以求出欧拉角、四元数等&#xff09; 前提&#xff1a;在导航坐标系&#xff08;比…

捷联惯导总结--初始对准,位置标定,INS姿态更新,GPS/INS组合

惯导及组合导航回顾 2018.09.16 今天和17系的同学一起把惯导的流程捋了一遍&#xff0c;为了加深自己的记忆&#xff0c;这里在前面把心得大致列出来。 我们这里只考虑捷联式惯导及松组合 首先拿到惯性传感器&#xff08;加速度计和陀螺仪&#xff09;需要对其进行标定&#x…

捷联式惯导系统初始对准

1 初始对准简介 1.1 初始对准任务 所谓对准指的是确定惯导系统各坐标轴相对于参考坐标系指向的过程。 捷联式惯导系统初始对准的任务有两项:第一&#xff0c;机体起飞前将初始速度和初始位置引人惯导系统;第二&#xff0c;机体坐标系与导航坐标系的初始变换短阵。另外&#…

c语言函数指针 的定义方法,C语言 函数指针一(函数指针的定义)

//函数指针 #include #include #include //函数指针类型跟数组类型非常相似 //函数名就是函数的地址&#xff0c;函数的指针&#xff0c;对函数名进行&取地址操作&#xff0c;还是函数名本身&#xff0c;这是C语言编译器的特殊处理 void test(int a){ printf("a%d\n&q…

C语言函数指针调用函数

C语言可以定义指针变量指向函数&#xff0c;通过指针来调用函数。 使用&#xff1a; 1、定义函数指针变量&#xff1a; 函数返回值类型 (*指针变量名)(); 2、将已有函数入口赋值给函数指针变量&#xff1a;fnPt avg; 3、使用指针变量调用函数&#xff1a;(*指针变量名)(参…

C语言函数指针与调用

C语言函数指针与调用 平时我们使用函数传递的参数一般为数据变量&#xff0c;那么是否可以传递函数呢&#xff1f; 答案是不但可以&#xff0c;而且习惯以后&#xff0c;会用上瘾的。通过传递不同的函数指针&#xff0c;我们可以实现在函数中调用不同的子函数。 下面就举个栗子…

C语言函数指针与指针函数

在大家刚开始学习c语言的时候&#xff0c;总是分不清函数指针和指针函数&#xff0c;就算是知道了它们之间的区别&#xff0c;也不了解它们的使用场景&#xff0c; 我写此博客帮大家缕一缕&#xff0c;也帮我自己缕一缕 1、函数指针与指针函数的概念以及区别 指针函数 从名…

C语言 函数指针做函数参数(即回调函数)

文章目录 函数指针做函数参数(回调函数)回调函数概念一般有三种调用方式回调函数的作用回调函数调用时刻回调函数的语法&#xff1a;1.简单的函数类型为&#xff1a;无参数、无返回值的函数。2.完全形式的回调函数注&#xff1a; 代码案例&#xff1a;模拟计算器 函数指针做函数…

C语言 函数指针

一.前言 最近学了一点函数指针的东西 感觉还是比较有意思的 在某先方面用起来也确实会方便些 给大家在这里分享一下。 二.定义 函数指针就是指向代码段中函数入口地址的指针。 从上述这句话就可以看出 函数指针的本质是一个指针&#xff0c;只不过是指向函数的指针。 三.声明形…

C语言函数指针用法

C语言函数指针用法 函数指针本质上是指针&#xff0c;它指向一个函数。 例如int (*p)(int); – 从 p 处开始, 先与指针结合, 说明 p 是一个指针, 然后与()结合, 说明指针指向的是一个函数, 然后再与()里的 int 结合, 说明函数有一个int 型的参数, 再与最外层的 int 结合, 说明…

C语言函数指针详解

1、概念 函数指针就是一个指针&#xff0c;指针指向某个内存区域&#xff0c;函数指针就是指向函数入口地址的这么一个指针变量&#xff0c;在.c文件中编写一个函数&#xff0c;将.c编译为可执行程序后&#xff0c;在.c文件中编写的函数会存放在可执行程序的代码段中&#xff…

C语言——函数指针

函数指针 C语言中的指针类型有很多种&#xff0c;但是函数指针可能有些小伙伴没听过&#xff0c;下面我们引入一段定义。 函数指针是指向函数的指针变量。 因此“函数指针”本身首先应是指针变量&#xff0c;只不过该指针变量指向函数。这正如用指针变量可指向整型变量、字符型…

《信号与系统》小结

参考书目&#xff1a;《信号与系统(第四版) 徐亚宁 苏启常 编著》 信号与系统 信号是消息的表现形式&#xff0c;消息是信号的具体内容。也就是说任何可以承载某种消息的物理量都可以是信号。电信号只是生活中最快捷&#xff0c;也是最常用的一种。我们可以从变化的电流或电压…