- 上一篇：MATLAB排爆机器人移动平台控制系统的设计
- 下一篇：螺母内螺旋滚道非接触式自动检测技术研究
7）载体坐标系（b 系）。是一个正交坐标系，载体的重心处为坐标原点，轴向沿安装有
第 6 页 本科毕业设计说明书
惯性测量单元（IMU）的运载体的俯仰轴，横滚轴和航向轴。 x ， y ， z 分别指向右、前、
b b b
上。
（2）姿态角定义
载体姿态角实际上是载体坐标系（b 系）和导航坐标系（n 系）之间的方位关系，两个坐 标系的角位置用航向角、俯仰角、横滚角表示。
各角度具体对应如下图：
图 2.1 姿态角含义
O XnYn Zn 绕 Zn 轴旋转形成坐标系 O X1Y1Z1 ,再绕 X1 轴旋转形成坐标系 O X 2Y2 Z2 ，
最后绕Y 轴旋转角形成坐标系
各次基本旋转对应的变换矩阵为：
所以姿态变换矩阵为：
2.2 组合导航姿态参考系统的姿态算法
组合导航姿态参考系统的姿态算法即对 b 系到 n 系转换的实时姿态矩阵的求解是组合导 航姿态参考系统的核心，其精度由姿态算法的精度直接决定。一般通过测得的角速度信息， 结合相应微分方程的求解，构建数学平台。一般来说常用的姿态算法有四大类，欧拉角法、 方向余弦法、四元数法和旋转矢量法[16]。
欧拉角算法。在计算过程中不需要进行正交化而直接通过微分方程计算、和，具有 简洁直观的优点。但是，在计算过程中需要大量的计算，使姿态解算的实时性算带来了一定
的影响。并且不能完成全姿态工作具有一定局限性。因为当接近直角 90°时方程容易产生 奇异点，所以这里不采用欧拉角法。
方向余弦法。其实质是对姿态矩阵的微分方程进行求解，但比较起四元数法姿态矩阵由 具有九个参数的线性微分方程组构成，计算量过大难以实现实时计算工程上并不适用。
四元数法。相对上面两种计算方法，能够很好地弥补它们的不足，算法简便，容易上手， 是相对较为实用的工程算法。来!自~751论-文|网www.751com.cn
旋转矢量法。选用简单的多子样算法对不可交换误差进行补偿，相对而言更容易处理， 比较适合处理角速度变化比较大的运动物体姿态更新[17]。
通过上述比较可以得出，旋转矢量法计算更精确，但是由于解算出的姿态矩阵后面还是 要通过卡尔曼来进行一定修正，而且本文针对的是低动态载体，所以单子样的旋转矢量法， 即四元数法已经满足精度要求，为了使算法更为简单、方便，最终采用四元数法进行姿态的 更新。下面，将对四元数的定义和相关算法进行详细介绍。
第 8 页 本科毕业设计说明书
2.2.1 四元数定义
四元数：
q3 是实数， i 、 j 、 k 既是互相正交的单位向量，又是虚单位 。
姿态运动用四元数描述：刚体以某一随时间变化的矢量为转轴转过某个角度，u R 为旋转
瞬轴和旋转方向，为转过的角度。
-
基于中频信号的家用治疗...
-
基于嵌入式技术的智能家...
-
基于FPGA竞赛系统设计+程序
-
Matlab基于前馈控制的加热炉温度控制系统设计
-
基于LabVIEW的车牌图像识别技术研究
-
基于LabVIEW和MATLAB混合编程...
-
基于DeepLearning的语音识别研究
乳业同业并购式全产业链...
当代大学生慈善意识研究+文献综述
电站锅炉暖风器设计任务书
河岸冲刷和泥沙淤积的监测国内外研究现状
杂拟谷盗体内共生菌沃尔...
十二层带中心支撑钢结构...
java+mysql车辆管理系统的设计+源代码
中考体育项目与体育教学合理结合的研究
大众媒体对公共政策制定的影响
酸性水汽提装置总汽提塔设计+CAD图纸