文章目录

一、坐标系定义
- 1.东北天坐标系（ENU）
- 2.北东地坐标系（NED）
二、在ENU坐标系向量变换到NED坐标系向量
三、将载体相对ENU的姿态和位置，变换为载体相对NED的姿态和位置
- 1、外旋和内旋
- 2、各个轴旋转矩阵
- 3、ENU和右前上载体坐标系的姿态
- 3、NED和前右下载体坐标系的姿态
- 3、转换

一、坐标系定义

1.东北天坐标系（ENU）

1）x轴指向东， y轴指向北， z轴指向天
2）绕x轴转动，称为pitch角
绕y轴转动，称为roll角
绕z轴转动，成为yaw角
注意：这里和常规定义不太一样，主要是为了配合保证前向角是roll角。如果你不想这么定义，后续的旋转矩阵和旋转顺序进行一个改变。

3）对应的IMU载体坐标系是右前上

4）欧拉角旋转顺序：z-x-y

2.北东地坐标系（NED）

1）x轴指向北， y轴指向地， z轴指向地
2）绕x轴转动，称为roll角
绕y轴转动，称为pitch角
绕z轴转动，成为yaw角
3）对应的IMU载体坐标系是前右下

4）欧拉角旋转顺序：z-y-x

二、在ENU坐标系向量变换到NED坐标系向量

从坐标系定义中，可以看出，ENU和NED的坐标变换关系是：
X(ENU) = Y(NED)
Y(ENU) = X(NED)
Z(ENU) = -Z(NED)
Yaw(ENU) = -Yaw（NED）+ 90

注意：虽然ENU和NED旋转顺序不同，但是都是根据yaw-pitch-roll顺序进行旋转的。

三、将载体相对ENU的姿态和位置，变换为载体相对NED的姿态和位置

1、外旋和内旋

旋转轴分绕固定坐标系旋转和绕动坐标系旋转，前者称为外旋，后者称为内旋。 - Fixed Angles 外旋 - Euler Angles 内旋

1）外旋（Fixed Angles）
外旋为绕静止坐标系旋转，也就是每次旋转都绕参考的静止坐标系进行三轴旋转。外旋为旋转矩阵按照先后依次左乘。

2）内旋（Euler Angles）
外旋为动坐标系旋转，也就是每次旋转后绕变化后的坐标系进行三轴旋转。内旋为旋转矩阵按照先后依次右乘。

在外旋和内旋中有一个特性很重要，这里先提一下：X-Y-Z的外旋等价于Z-Y-X内旋

2、各个轴旋转矩阵

默认情况下的旋转，参考系为n系（ENU，或者NED），载体系为b系，旋转的时候，参考系不动，载体系进行旋转

3、ENU和右前上载体坐标系的姿态

参考系（导航系）：(ENU)东北天
载体系（机体系）：(XYZ)右前上
旋转顺序：Z-X-Y
姿态顺序：(Yaw-Pitch-Roll)偏航-俯仰-横滚
旋转轴：内旋
要计算内旋的Z-X-Y，我们只需要计算外旋的Y-X-Z即可，也就是计算出ENU_Y-X-Z_Fixed_Angles：

但是内旋的右乘就是从左到右乘了，从这里也可以看出左乘的Y-X-Z等于右乘的Z-X-Y了。

下面的旋转矩阵是从载体系到参考系的旋转矩阵R_b2n，左上角标有F表示是外旋下的DCM:

注意：内旋是按照旋转顺序右乘，外旋是按照旋转顺序左乘，所以内旋的Z-X-Y等于外旋的Y-X-Z。

根据外旋内旋规则那么得到内旋的旋转矩阵R_b2n：从载体系到参考系:

求转置可得到从参考系到载体系的旋转矩阵：

3、NED和前右下载体坐标系的姿态

参考系（导航系）：(NED)北东地
载体系（机体系）：(XYZ)前右下
旋转顺序：Z-Y-X
姿态顺序：(Yaw-Pitch-Roll)偏航-俯仰-横滚
旋转轴：内旋前面我们说了，旋转矩阵和坐标系无关，所以NED下的ZYX和ENU下的ZYX是一样的哦，唯一不同的就是，姿态的命名和正负方向不一样了，绕X轴变成了横滚，绕Y轴变成了俯仰，Z轴还是偏航。

这个旋转矩阵是从载体系到参考系：

求转置可得到从参考系到载体系的旋转矩阵：

注意：
我们说的姿态角是载体相对参考坐标系的旋转欧拉角

3、转换

参考：
https://zhuanlan.zhihu.com/p/336357646

东北天（ENU）和北东地（NED）相关推荐

使用matlab/simulink将东北天坐标转化为北东地坐标
使用matlab代码 1.方法一(东北天转北东地) % 定义东北天坐标系中的向量 x = 1; y = 2; z = 3; % 定义转换矩阵 R = [0 1 0; 1 0 0; 0 0 -1]; % ...
北东地坐标系转换c语言,北东地/东北天两种导航坐标系与姿态转换
一. 坐标系 1. 导航坐标系常用的导航坐标系有北东地和东北天两种. 两种坐标系的指向分别定义如下: 1.1 北东地坐标系 X轴:指北; Y轴:指东; Z轴:指地. 1. 2 东北天坐标系 X轴:指 ...
北东地/东北天两种导航坐标系与姿态转换
一. 坐标系 1. 导航坐标系常用的导航坐标系有北东地和东北天两种. 两种坐标系的指向分别定义如下: 1.1 北东地坐标系 X轴:指北; Y轴:指东; Z轴:指地. 1. 2 东北天坐标系 ...
ROS中ENU坐标系与无人机中NED坐标系的转换关系理解
ROS中ENU坐标系与无人机中NED坐标系的转换关系理解项目地址无人机中NED坐标理解 ENU与NED转换无人机中NED坐标理解机体坐标系:机体坐标系固连飞机,其原点取在多旋翼的重心位置上. ...
北斗导航 | NED(北东地)转ECEF(地心地固)或ECEF转NED（Matlab源代码）
================================================ 博主github:https://github.com/MichaelBeechan 博主CSDN:h ...
惯性导航原理（1）：导航坐标系及相互转换
一.导航坐标系转换坐标系介绍 1.惯性坐标系(地心惯性坐标系)i系 2.地球坐标系(地心地固坐标系)e系 3.WGS-84坐标系(常用)blh坐标系 4.当地水平地理坐标系g系(常用东北天ENU或者 ...
PX4使用手册-自主避障-ObstacleAvoidance
P200的VFH避障是航点避障么? 转载自:https://www.rdplat.com/news/25444.html PX4使用手册-自主避障-ObstacleAvoidance 2018-12- ...
导航系统中坐标系介绍
日常开发中常用到八大坐标系: 1. 惯性坐标系圆心是地球的原点,Z轴沿地轴方向朝向北极, X轴和Y轴位于赤道平面内,与Z轴满足右手法则,并且X轴和Y轴分别指向两个恒星.也就是说不随着地球的自转而发生 ...
ML之FE：利用【数据分析+数据处理】算法对国内某平台上海2020年6月份房价数据集【12+1】进行特征工程处理(史上最完整，建议收藏)
ML之FE:利用[数据分析+数据处理]算法对国内某平台上海2020年6月份房价数据集[12+1]进行特征工程处理(史上最完整,建议收藏) 目录利用[数据分析+数据处理]算法对链家房价数据集[12+1 ...

东北天（ENU）和北东地（NED）