惯性导航原理(1):导航坐标系及相互转换
一、导航坐标系转换
- 坐标系介绍
- 1、惯性坐标系(地心惯性坐标系)i系
- 2、地球坐标系(地心地固坐标系)e系
- 3、WGS-84坐标系(常用)blh坐标系
- 4、当地水平地理坐标系g系(常用东北天ENU或者北东地NED)
- 5、平台坐标系p系
- 6、导航坐标系n系
- 7、载体坐标系b系
- 坐标系间的相对转换关系
- 1、惯性坐标系i系<=>地心地固坐标系e系
- 2、blh坐标系<=>地心地固坐标系e系
- 3、地心地固坐标系e系<=>当地水平地理坐标系g系
- 1、g系选取为东北天坐标系
- 2、g系选取为北东地坐标系
- 4、当地水平地理坐标系g(n)系<=>载体坐标系b系
- 1、g(n)系选取为东北天坐标系,b系选择右前上坐标系
- 2、g(n)系选取为北东地坐标系,b系选择前右下坐标系
写在前面(本人是导航专业,目前已经毕业入职,工作也是与惯导、组合导航相关,因为以前的知识忘的差不多了,所以开个帖子,会分几章记录一下,如有不正确的地方还请大家多多指教)
补充 由于不同参考资料中,经纬度表示不同,有的是L表示纬度, λ\lambdaλ表示经度,有的是B表示纬度,L表示经度,由于本文参考了很多资料,且博主较懒,不想打公式因此文中经纬度、卯酉圈子午圈符号有些混乱,但是已在文中加了注释
坐标系介绍
1、惯性坐标系(地心惯性坐标系)i系
O-XiYiZi,角标常用i表示。取地球中心为坐标原点O,OZ轴沿地球自转轴方向,OX轴是地球绕太阳公转的黄道平面与地球赤道平面的交线,OY轴沿右手规则确定。需要注意:地心坐标系是不与地球固联的,它不随地球自转而转动。(IMU(加表、陀螺)测量的就是相对于惯性系的运动)
2、地球坐标系(地心地固坐标系)e系
其原点为地球的质心,X轴延伸通过本初子午线(0度经度)和赤道的交点;Z轴延伸通过的北极(即与地球旋转轴重合);Y轴与X、Z轴形成右手坐标系,穿过赤道和90度经度。常表示为O-XeYeZe。导航中,一般关心的是载体相对于地球的位置,故e系常作为参考坐标系。
3、WGS-84坐标系(常用)blh坐标系
wgs84表示的就是地理经纬度,也叫经纬高坐标系(经度(longitude),纬度(latitude)和高度(altitude)LLA坐标系)。我们常说的经纬度一般都是wgs84。只不过由于地球是不规则的,所以地理坐标系分为很多种,GPS是美国的,采用的就是WGS84坐标系,中国一般使用北京54、西安80、China2000等。WGS-84坐标系的X轴指向BIH(国际时间服务机构)1984.0定义的零子午面(Greenwich)和协议地球极(CTP)赤道的交点。Z轴指向CTP方向。Y轴与X、Z轴构成右手坐标系。
1、大地纬度是过用户点P的基准椭球面法线与赤道面的夹角。纬度值在-90°到+90°之间。北半球为正,南半球为负。
2、大地经度是过用户点P的子午面与本初子午线之间的夹角。经度值在-180°到+180°之间。
3、大地高度h是过用户点P到基准椭球面的法线距离,基准椭球面以内为负,以外为正。
4、当地水平地理坐标系g系(常用东北天ENU或者北东地NED)
以东北天坐标系为例:
以点P为原点,以 P点的法线为Z轴,指向天顶为正,以子午线方向为Y轴,指向北为正,X 轴与YZ 平面垂直,向东为正
北东地坐标系定义为:X轴:指向正北;Y轴:指向东向;Z轴:与XY轴形成右手坐标系,指向地向。
5、平台坐标系p系
描述平台式惯导系统中平台指向的坐标系叫做平台坐标系,它与平台固连。如果平台无误差,指向正确,则这样的平台坐标系称为理想平台坐标系。(目前我使用的基本是捷联惯导,所以这个坐标系下文几乎不会涉及,仅仅这里介绍一下)
6、导航坐标系n系
导航坐标系是惯性导航算法的基本参考系,运动物体在导航坐标系内进行位置、速度、姿态确定,可选取e系或g系做为导航系。在e系内导航,可以直接确定地心地固系下的导航参数,便于和GNSS 等大地测量手段相结合,在惯性导航中,经常将地理坐标系g作为导航坐标系。值得注意的是,导航坐标系只是一个“虚”的概念。
7、载体坐标系b系
该系固定在载体上,时刻随着载体运动而运动。其原点与载体质心重合。
与东-北-天对应的载体系是右-前-上坐标系,X轴沿运载体横轴线指右,Y轴沿纵轴指前,Z轴沿运载体竖向并与X、Y轴构成右手直角坐标系。
与北-东-地对应的载体系是前-右-下坐标系,X轴沿载体纵轴指前,Y轴指右,Z轴沿载体竖轴与X、Y轴构成右手直角坐标系。
坐标系间的相对转换关系
1、惯性坐标系i系<=>地心地固坐标系e系
惯性坐标系i与地心地固坐标系e系之间原点重合,二者之间存在相对旋转,角速度指向Z轴,自西向东旋转,地球自转角速度(e系相对于i系)为7.292115e-5 rad/s,i系到e系的坐标转换矩阵为:
而e系到i系的坐标旋转矩阵只需要将i系到e系的坐标转换矩阵转置即可。
2、blh坐标系<=>地心地固坐标系e系
求解blh坐标系与地心地固坐标系间的坐标旋转矩阵之前,需要了解何为子午圈半径与卯酉圈半径:
设P点为旋转椭球体上某一点,n为P点处的法线,NS为椭球面的对称轴,过P作NS的垂直平面,截椭球面所得的平面曲线lPl称为P点处的纬圈,过P点和直线NS作平面截椭球面所得的平面曲线mPm称为 经圈(子午圈),过P点作纬圈lPl的切线tPt,用tPt和法线n形成的平面截椭球面所得的平面曲线rPr称为P点处的卯酉圈。P点处沿子午圈mPm的曲率半径Rm(有称Rn)为子午圈曲率半径,沿卯酉圈的曲率半径rPr的曲率半径Rn(有称Re)卯酉圈曲率半径。计算公式如下:
其中,R为地球赤道半径(椭圆的长半轴),WGS-84模型中,R = 6378137m,e为第一偏心率,e = 0.0818191908426,f为第一扁率,f = 1/298.257223563。
在高度为h处的子午圈半径为Rn+h,卯酉圈半径为Re+h。
则:blh坐标系->地心地固坐标系e系的坐标转换矩阵为:
上式中:N为卯酉圈曲率半径(同上面的Re);a为地球椭球的长半轴;b为地球椭球的短半轴,B为P点的纬度,L为P点的经度。
地心地固坐标系e系->blh坐标系的坐标转换矩阵为:
3、地心地固坐标系e系<=>当地水平地理坐标系g系
地理坐标系g与地球坐标系e之间的转动关系可以用方向余弦阵表示,常称之为位置矩阵:
1、g系选取为东北天坐标系
g系先绕OZ轴转动-pi/2,接着绕OY轴转动-(pi/2-B),其中B为纬度(弧度表示),再绕OZ轴转动-L,其中L为经度(弧度表示),此时g系与e系坐标轴平行。
e系到g系的坐标转换矩阵只需要将上式转置即可。
2、g系选取为北东地坐标系
e系转到g系(北东地)的坐标旋转矩阵CgeC^e_gCge 表示如下:(由于常将地理坐标系g作为导航坐标系,因此表示成CneC^e_nCne是同一个东西 ):
e系到g(n)系的坐标转换矩阵只需要将上式转置即可。
4、当地水平地理坐标系g(n)系<=>载体坐标系b系
1、g(n)系选取为东北天坐标系,b系选择右前上坐标系
欧拉角表达式为:
东北天——右前上坐标系下欧拉角旋转顺序:航向角(绕Z轴)—俯仰角(绕X轴)—横滚角(绕Y轴):
第一个转动角度:航向角(绕Z轴旋转−ψ-\psi−ψ角)
第二个转动角度:俯仰角(绕X轴旋转 θ\thetaθ 角)
第三个转动角度:横滚角(绕Y轴旋转ϕ\phiϕ角)
注意 俯仰角和横滚角:姿态角方向与对应轴向转动方向一致,绕对应轴正转,相应姿态为正,绕对应轴反转,相应姿态为负。航向角:姿态角方向与对应轴向转动方向相反(由于航向角定义为:Y轴指北时,航向角为零。北偏东顺时针依次从0变为360deg。而Z轴指天,Z轴反转时,航向角才依次增大)。
则旋转矩阵为:
所以姿态矩阵(b系到n系的坐标转换矩阵)为:
2、g(n)系选取为北东地坐标系,b系选择前右下坐标系
北东地——前右下坐标系下欧拉角旋转顺序:航向角(绕Z轴)—俯仰角(绕Y轴)—横滚角(绕X轴):
第一个转动角度:航向角(绕Z轴旋转ψ\psiψ角)
第二个转动角度:俯仰角(绕Y轴旋转 θ\thetaθ 角)
第三个转动角度:横滚角(绕X轴旋转ϕ\phiϕ角)
注意 俯仰角和横滚角:方向与对应轴向转动方向一致,绕对应轴正转,相应姿态为正;绕对应轴反转,相应姿态为负。X轴指北时,航向角为零。北偏东顺时针依次从0变为360deg
(个人感觉北东地坐标系要比东北天坐标系好用一些,然而国内的大佬秦永元、严恭敏等均用的东北天坐标系,北东地坐标系国外学者用的多一些)。
则旋转矩阵为:
则旋转矩阵为:
最后一定注意欧拉角旋转顺序与定义啊兄弟们,别搞混了,坐标系选取不同定义也不同的!!!!!!
惯性导航原理(1):导航坐标系及相互转换相关推荐
- 惯性导航原理(二)-平台式+捷联式+INS精度
文章目录 惯性导航原理 1D 2D/3D 平台式系统 捷联式系统 平台式与捷联式惯导特点对比 惯性导航系统特性 优点 缺点 INS的精度等级 典型战术级惯导 惯性器件的相对测量能力 惯性导航原理 航位 ...
- 自动驾驶(五十二)---------惯性导航原理
惯性导航一般集成在GPS设备中,都是由供应商集成,那在这里有什么讨论的必要呢,要知道在车辆行驶中,我们可以拿到GPS的yawrate和speed信号,而且车辆本身还有一套传感器获取yawrate和sp ...
- 导航基础之坐标系整理——导航坐标系、地球坐标系、载体坐标系
概述 在三维空间中,无约束的物体具有6个自由度,即三个方向的位置和三个欧拉角.故在导航中,明确坐标系的定义是基础.坐标系分为左手坐标系和右手坐标系,实际中,常常采用右手坐标系. 三维坐标系是描述空间中 ...
- 深蓝学院-多传感器融合定位课程-第5章-惯性导航原理及误差分析
专栏文章: 深蓝学院-多传感器融合定位课程-第1章-概述_goldqiu的博客-CSDN博客 深蓝学院-多传感器融合定位课程-第2章-3D激光里程计I_goldqiu的博客-CSDN博客 深蓝学院-多 ...
- 轮换对称性实质 和差化积公式之sinθ+cosθ推导 rd原理,二重积分坐标系转化为什么多了个r; 二重积分几何意义: 二重积分物理意义: 二重积分求导:
目录 轮换对称性实质 和差化积公式之sinθ+cosθ推导 rd原理,二重积分坐标系转化为什么多了个r:
- 导航坐标系:地心惯性坐标系、地心地固坐标系、当地水平坐标系、载体/机体坐标系
导航中的几种常用坐标系 地心惯性坐标系(ECI) 地心地固坐标系(ECEF) 当地水平坐标系(LLF).东北天坐标系ENU 地平坐标系 载体/机体坐标系 机动目标跟踪/室内定位/导航/优化技术探讨:W ...
- 多传感器融合定位六-惯性导航原理及误差分析
多传感器融合定位六-惯性导航原理及误差分析 1. 惯性技术简介 1.1 惯性技术发展历史 1.2 惯性器件 1.2.1 机械陀螺(几乎没人用了) 1.2.2 激光陀螺 1.2.3 光纤陀螺 1.2.4 ...
- 北东地坐标系转换c语言,北东地/东北天两种导航坐标系与姿态转换
一. 坐标系 1. 导航坐标系 常用的导航坐标系有北东地和东北天两种. 两种坐标系的指向分别定义如下: 1.1 北东地坐标系 X轴:指北; Y轴:指东; Z轴:指地. 1. 2 东北天坐标系 X轴:指 ...
- BetaFlight深入传感设计之九:传感坐标系/机体坐标系/导航坐标系/经纬度坐标系
BetaFlight深入传感设计之九:传感坐标系/机体坐标系/导航坐标系/经纬度坐标系 1. 问题症结 2. 入手分析 2.1 传感坐标系 2.2 机体坐标系 2.3 导航坐标系 2.4 经纬坐标系 ...
最新文章
- android Button 监听的几种方式
- sql 12天内的数据_想要在12周内成为数据科学家吗?
- 相对不容易用计算机语言编程实现的是,在描述算法的方法中,相对不容易用计算机语言编程实现的是( )....
- (三)C语言之九条语句
- Joe一款个人博客typecho主题(扩展版)
- python程序在线更新_Python自动更新功能
- 如何在苹果Mac上截屏或录制屏幕?
- SpringMVC中实现文件上传
- 闪迪内存卡软件测试,存储卡不稳定?我们用微波炉测试 结果震惊了!
- lammps教程:boundary命令详解
- linux查看nginx昅 电视,PHP实现查询汉字笔画、笔画排序、笔画统计
- 平行四边形不等式优化详解
- Handler execution resulted in exception: Content type 'application/json;charset=UTF-8' not supported
- 用VB开发USB接口POS打印机进行打印和弹钱箱
- win10蓝牙断断续续问题
- win10设置虚拟内存_小技巧| 电脑经内存不够用,教你如何设置虚拟内存
- 【Android-I】Android开发之常见错误:Dx unsupported class file version 52.0...while parsing com/...
- Qt执行bash命令并获取返回结果
- ACG-crcme1(★★★)
- aes128 cmac java_使用PHP进行CMAC-AES散列
热门文章
- 支持三个cpu的服务器,产品技术-新华三发布搭载英特尔第三代可扩展处理器的H3C UniServer R6900 G5 服务器-新华三集团-H3C...
- 小米4c+android+6,小米4c有什么接口?小米4c有HDMI接口吗?
- IIS5、IIS6、IIS7的ASP.net 请求处理过程比较转
- 手机App测试点归纳
- 菜鸟弟弟从零开始的爬取Bilibili弹幕的Python爬虫教程-哔哩哔哩 - ( ゜- ゜)つロ 干杯~
- 计算机学院请假管理系统,《计算机学院在校学生离校请销假管理暂行规定》
- asynctaskdemo(Info)5
- python中找最小值,使用循环python查找最小值
- 【C++基础】头文件定义问题导致的重定义问题
- 屏幕色温自动调节小助手