-
地面坐标系与机体坐标系的转换和欧拉角
2020-02-24 17:45:09大家在入门四旋翼飞行器数学模型时第一个遇到的...在地面上选一点Og,使Xg轴在水平面内并指向某一方向,Zg轴垂直于地面并指向地心,Yg轴在水平面内垂直于Xg轴,是一个右手坐标系。 欧拉角 机体坐标系与地面惯性坐标系...大家在入门四旋翼飞行器数学模型时第一个遇到的就是坐标系的转换。这篇文章用尽量浅显的语言为大家讲解坐标系的转换的欧拉角。
机体坐标系
原点O取在飞机质心处, Xb轴指向机头, ,Yb轴指向机身右方, Zb指向机身下方。
地面坐标系
在地面上选一点Og,使Xg轴在水平面内并指向某一方向,Zg轴垂直于地面并指向地心,Yg轴在水平面内垂直于Xg轴,是一个右手坐标系。
欧拉角
机体坐标系与地面惯性坐标系之间的夹角就是飞机的姿态角,又称欧拉角。
(1)俯仰角θ\thetaθ: 机体轴与地平面(水平面)之间的夹角,飞机抬头为正。
(2)偏航角(方位角)ψ\psiψ:机体轴在水平面上的投影与地轴之间的夹角,以机头右偏为正。
(3)滚转角(倾斜角)ϕ\phiϕ:飞机对称面绕机体轴 转过的角度,右滚为正。飞机速度分量
坐标系转换
那么,三维坐标系的转换就有
可以的到分别绕三个轴的转换矩阵为
-
ROS中ENU坐标系与无人机中NED坐标系的转换关系理解
2019-09-19 00:43:19机体坐标系:机体坐标系固连飞机,其原点 取在多旋翼的重心位置上。 x轴在多旋翼对称平面内指向机头(机头方向与多旋+字形或X字形相关)。 z轴在飞机对称平面内,垂直轴向下。然后,按右手定则确定y轴 。 地球固联...ROS中ENU坐标系与无人机中NED坐标系的转换关系理解
- 无人机中NED坐标理解
- ENU与NED转换
无人机中NED坐标理解
- 机体坐标系:机体坐标系固连飞机,其原点 取在多旋翼的重心位置上。 x轴在多旋翼对称平面内指向机头(机头方向与多旋+字形或X字形相关)。 z轴在飞机对称平面内,垂直轴向下。然后,按右手定则确定y轴 。
- 地球固联坐标系:通常以多旋翼起飞位置作为坐标原点 。先让x轴在水平面内指向某一方向,z轴垂直于地面向下。然后,按右手定则确定y轴,坐标原点还有用地心的?比如NED坐标系为x轴为正北方向,y轴为正东方向,z轴指向下。
飞机的欧拉角就是基于上面两个坐标系的转换。pitch+为抬头,roll+为右旋转,yaw+为右偏航。
Yaw与指南针角度的关系
- 指南针的角度是确定不变的,北朝向为0度,东为90度,南为180度,西为270度。
- Yaw角是当前机头方向与正北方向的夹角(若地球固联坐标系为NED)
也就是说当我们知道YAW角时我们就可以确定飞机当前的航向(东,北哪个方向),比如我们的vision通过mavros给飞控的Yaw的角度是90度,而且飞机的地球固联坐标系为NED,那么可以确定飞机机头当前指向为正东,即使我们没有磁力计测方向,但我们假设了一个方向,此时Yaw角与指南针的角度完全重合或者说相同。
但当我们的Yaw角为90度,机头朝向为正北方向,那么我们可以确定飞机地球固联坐标系采用的是WND(W为西)。
在PX4中用到的地球固联坐标轴是NED坐标系,即x,y,z的方向固定不变(Offboard模式下除外,但是在offboard模式下,初始上电后其东北方向由Yaw角决定)
ENU与NED转换
如下图
在ROS中用到的坐标系是ENU坐标系,而我们飞控中用到的坐标系是NED所有需要转换,好在mavros已将帮我们转换好了。
下面是转化公式供参考
-
无人机导航中常见的坐标系
2017-04-04 15:04:58无人机导航中常见的坐标系包括: 地球中心坐标系(ECEF)(EarthCenteredEarthFixedCoordinateSystem,ECEF) ... 当地水平坐标系(North-East-DownCoordinateSystem,NED) 机体坐标系(BodyFr无人机导航中常见的坐标系包括:
地球中心坐标系(ECEF)(EarthCenteredEarthFixedCoordinateSystem,ECEF)
WGS-84大地坐标系(WorldGeodeticCoordinateSystem1984)
当地水平坐标系(North-East-DownCoordinateSystem,NED)
机体坐标系(BodyFrame)
机体水平坐标系(Vehicle-carriedNEDCoordinateSystem)
接下来我们就来简单说明一下这些坐标系在无人机导航中的应用。
地球中心坐标系(ECEF)
ECEF坐标系与地球固联,且随着地球转动。图中O即为坐标原点,位置在地球质心。X轴通过格林尼治线和赤道线的交点,正方向为原点指向交点方向。Z轴通过原点指向北极。Y轴与X、Z轴构成右手坐标系。
右手坐标系即符合“右手法则”的坐标系的统称,这个法则大家会经常见到,它的目的是为了以最简单的方式确定坐标轴以及正方向。如图,右手拇指,食指,中指“痉挛”状,其中任意两个手指与已确定的两个坐标轴及正方向重合,第三个手指的方向就是剩下坐标轴的正方向。
WGS-84坐标系
GPS输出的就是这个坐标系下的坐标数据!
完整一点解释是,GPS单点定位的坐标以及相对定位中解算的基线向量属于WGS-84大地坐标系。
WGS-84坐标系的X轴指向BIH(国际时间服务机构)1984.0定义的零子午面(Greenwich)和协议地球极(CTP)赤道的交点。Z轴指向CTP方向。Y轴与X、Z轴构成右手坐标系。
什么“BIH1984.0”听来很复杂有没有!一句话解释就是:把前面提到的ECEF坐标系用在GPS中,就是WGS-84坐标系。
上面图中大家很容易看出GPS输出的常见定位数据:经度(longitude),纬度(latitude),海拔(altitude)。不知大家有没有觉得奇怪,为什么有了GPS输出的海拔高度,我们还是要用气压计等其它设备来辅助定高呢?GPS的海拔数据精度没有办法支撑无人机高度定位吗?
这是因为GPS输出的信息是相对于WGS-84坐标系的。我们可以把它看做一个参考椭球体,GPS输出的高度是垂直于椭球表面的高度而非海平面高度,然而地球可不是一个标准的“椭球体”。
图中h是GPS测得的相对于椭球表面的高度;H表示正高;N表示大地水准偏差,即地球实际形状与参考椭球体的偏差,范围在正负100m之间,它随着地球重力分布变化,没有唯一的确定数值。所以,GPS直接输出的海拔数据也就会始终存在一个“误差”了。
NED坐标系
上图清晰地表明了ECEF坐标系(蓝色)和NED坐标系(绿色)之间的关系。NED坐标系是在导航计算时使用的坐标系,向量分别指向北,东,地,因此NED坐标系也经常称为“北东地坐标系”。
我们有了经纬度为什么还需要NED坐标系呢?GPS可以获得在WGS-84中的速度向量,为了方便使用速度向量进行无人机控制,我们还要把它转换在无人机所在位置的“平面坐标系”下,也就是LocalNED。
机体坐标系
机体坐标系与飞行器固联,坐标系符合右手法则,原点在飞行器重心处,X轴指向飞行器机头前进方向,Y轴由原点指向飞行器右侧,Z轴方向根据X、Y轴由右手法则确定。
机体坐标系是无人机惯性导航的基础坐标系,IMU中获得的加速度状态信息就是该坐标系下的数值。当我们获取IMU输出的X轴加速度信息时,是基于机体坐标系的,不能直接应用在NED坐标系下 -
无人机导航中的各类坐标系
2020-12-21 09:39:04机体坐标系(body frame) 1. 无人机中NED坐标理解 1.1 机体坐标系 机体坐标系固连飞机,其原点 取在多旋翼的重心位置上。 x轴在多旋翼对称平面内指向机头(机头方向与多旋+字形或X字形相关)。 z轴在飞机对称平面内...无人机中的各类坐标系学习笔记:
北东地坐标系(NED, north-east-down)
东北天(ENU, east-north-up)
机体坐标系(body frame)
…1 导航中的坐标系理解
导航中,最重要的两个坐标系是载体坐标系(body frame)和导航坐标系。
载体坐标系 是以载体为中心,主要作用是处理与传感器直接测得的物理量。
导航坐标系 可以是地固坐标系、地理坐标系等等,通常使用的是当地水平坐标系,俗称有“东北天”、“北东地”坐标系。2 无人机中NED坐标理解
2.1 机体坐标系
机体坐标系固连飞机,其原点 取在多旋翼的重心位置上。 x轴在多旋翼对称平面内指向机头(机头方向与多旋+字形或X字形相关)。 z轴在飞机对称平面内,垂直轴向下。然后,按右手定则确定y轴 。2.2 地球固联坐标系
通常以多旋翼起飞位置作为坐标原点 。先让x轴在水平面内指向某一方向,z轴垂直于地面向下。然后,按右手定则确定y轴,坐标原点还有用地心的?比如NED坐标系为x轴为正北方向,y轴为正东方向,z轴指向下。
飞机的欧拉角就是基于上面两个坐标系的转换。pitch+为抬头,roll+为右旋转,yaw+为右偏航。2.3 Yaw与指南针角度的关系
指南针的角度是确定不变的,北朝向为0度,东为90度,南为180度,西为270度。Yaw角是当前机头方向与正北方向的夹角(若地球固联坐标系为NED),也就是说当我们知道YAW角时我们就可以确定飞机当前的航向(东,北哪个方向),比如我们的vision通过mavros给飞控的Yaw的角度是90度,而且飞机的地球固联坐标系为NED,那么可以确定飞机机头当前指向为正东,即使我们没有磁力计测方向,但我们假设了一个方向,此时Yaw角与指南针的角度完全重合或者说相同。
但当我们的Yaw角为90度,机头朝向为正北方向,那么我们可以确定飞机地球固联坐标系采用的是WND(W为西)。
在PX4中用到的地球固联坐标轴是NED坐标系,即x,y,z的方向固定不变(Offboard模式下除外,但是在offboard模式下,初始上电后其东北方向由Yaw角决定)2.4 东北天坐标系与北东地坐标系的转换
在ROS中用到的坐标系是ENU坐标系,而飞控中用到的坐标系是NED。
则有:
参考资料1:阿木实验室论坛 -
Robot不同坐标系理解
2018-09-25 11:15:46地理坐标系:北东地。北为X轴、东为Y轴、地为Z轴。 地面坐标系(earth-surface inertial reference frame) ...机体坐标系(Aircraft-body coordinate frame) ①原点O取在飞机质心处,坐标系与飞机... -
OpenGL - 运动轨迹-欧拉角(姿态角)-万向锁
2016-09-29 17:10:32要了解飞机姿态,需要首先知道什么是地面坐标系和机体坐标系。 ■地面坐标系(earth-surface inertial reference frame)Sg--------Oxgygzg ①在地面上选一点Og ②使xg轴在水平面内并指向某一方向 ③zg轴垂直于... -
state estimation 学习笔记
2020-10-30 17:52:521.坐标系:在进行算法设计时,第一步就是确定坐标系,一般来说,要确定的有两个坐标系,一个是世界坐标系,一个是机体坐标系。 在读shen的博士论文时,发现论文里面并没有明确说明世界坐标系具体的朝向,只是具体... -
从零开始做两轮自平衡小车(一)
2017-07-05 22:53:43引言在玩平衡车或四轴时,经常避不开姿态解算部分。...4. yg轴在水平面内垂直于xg轴,其指向按右手定则确定机体坐标系 1. 原点O取在飞机质心处,坐标系与飞机固连 2. x轴在飞机对称平面内并平行于飞机的设计轴线 -
UAV021-V2(一):无人机姿态解算与数据融合(深入篇)
2020-08-07 23:25:39写这篇博客,已经是第四次了,花了近两个周,一遍遍修改,只为了理解好姿态解算与数据融合,并表述出来。...机体坐标系(机体系)以机头方向为 x 轴,机体水平向右为 y 轴,垂直机体向下为 z 轴,即前右下,符合右手 -
欧拉角Yaw、Pitch、Roll
2018-10-06 21:03:53姿态角,首先知道什么是地面坐标系和机体坐标系?https://jingyan.baidu.com/article/0bc808fc2c0e851bd485b9ce.html 地面坐标系(earth-surface inertial reference frame) ①在地面上选一点Og ②使xg轴在... -
无人机的偏航角,滚动角,俯仰角解释
2019-07-01 16:31:051.偏航角(yaw) 简单的定义:就是实际航向与计划航向之间的夹角 ,如图所示 ... 或者:如上图所示,机体坐标系xb轴在水平面上投影与地面坐标系xg轴(在水平面上,指向目标为正)之间的夹角,由xg轴... -
飞行器姿态角
2016-09-01 09:10:15通常说的飞行器姿态角是指机体坐标系与地面惯性坐标系之间的夹角,可用横滚角-roll、俯仰角-pitch、偏航角-yaw三个角表示。 横滚角ϕ:飞机对称平面与通过飞机机体纵轴的铅垂平面间的夹角。 俯仰角θ:机体轴与... -
光流导航设计
2018-03-07 08:33:02假设光流传感器的坐标系和无人机机体的坐标系对齐,光流传感器的视场角度为α(弧度),视场的宽度为d,视场宽度对应的像素总数是Np,无人机运动的速度为v,无人机距离地面的高度H,那么由光流传感器测得的光流经过... -
YAW PITCH ROLL 定义
2017-06-20 19:31:35要了解飞机姿态,需要首先知道什么是地面坐标系和机体坐标系。 ■地面坐标系(earth-surface inertial reference frame)Sg--------Oxgygzg ①在地面上选一点Og ②使xg轴在水平面内并指向某一方向 ③zg轴... -
无人机视频影像几何校正
2016-05-11 21:50:12首先,要了解地面坐标系和机体坐标系 ①在地面上选一点Og ②使xg轴在水平面内并指向某一方向 ③zg轴垂直于地面并指向地心 ④yg轴在水平面内垂直于xg轴,其指向按右手定则确定 ①原点O取在飞机质心处,坐标系与... -
姿态角是怎么测量出来的
2019-11-18 20:01:01■地面坐标系(ea①在地面上选一点Og ①在地面上选一点Og ②使xg轴在水平面内并指向某一方向 ③zg轴垂直于地面并指向地心 ④yg轴在水平面内垂直于xg轴...■机体坐标系(Aircraft-body coordinate frame)Sb-------oxy... -
飞行器的姿态概念
2014-08-24 09:04:23地面坐标系(earth-surface inertial reference frame)Sg--------Oxgygzg ①在地面上选一点Og ②使xg轴在水平面内并指向某一方向 ...■机体坐标系(Aircraft-body coordinate frame)Sb-------oxyz -
机器人行业中我们常说的roll、yaw、pitch是什么?
2019-04-28 21:53:00坐标系建立: 载体坐标系与载体坐标系的关系是三个Euler角:yaw,pitch,roll,反应了载体相对基准面的姿态。 pitch是围绕X轴旋转,也叫做俯仰角。当X轴的正半轴位于过坐标原点的水平面之上(抬头)时,俯仰角... -
MPU 6050姿态角度融合算法
2020-09-10 20:47:271、介绍 1.1 姿态角(Euler角)pitch yaw roll介绍 飞行器的姿态角并不是指哪个角度,是三个角度的统称。它们是:俯仰、滚转、偏航。你可以想象是飞机围绕XYZ三个轴分别转动形成的夹角。...机体坐标系(Aircraf -
近日工作知识点(未整理版)
2019-06-18 14:20:14//opencv api接口介绍(全英) ... 关于惯导角度信息(俯仰角、航向角、横滚角)的转换 载体的右、前、上三个方向构成右手系,绕向前的轴...俯仰角:机体坐标系X轴与水平面的夹角。当X轴的正半轴位于过坐标原点的水... -
「机器人」“姿态角 roll、yaw、pitch”讲解
2019-04-02 19:43:43载体坐标系与载体坐标系的关系是三个Euler角:yaw,pitch,roll,反应了载体相对基准面的姿态。 pitch是围绕X轴旋转,也叫做俯仰角。当X轴的正半轴位于过坐标原点的水平面之上(抬头)时,俯仰角为正,否则为负,... -
俯仰角与横滚角的介绍
2015-04-29 10:59:00俯仰角:机体坐标系X轴与水平面的夹角。当X轴的正半轴位于过坐标原点的水平面之上时,俯仰角为正,按习惯,俯仰角θ的范围为:-π/2≤θ≤π/2。加速度计用于测量加速度。借助一个三轴加速度计可以测得一个固定平台...