一、导航坐标系转换

  • 坐标系介绍
    • 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):导航坐标系及相互转换相关推荐

  1. 惯性导航原理(二)-平台式+捷联式+INS精度

    文章目录 惯性导航原理 1D 2D/3D 平台式系统 捷联式系统 平台式与捷联式惯导特点对比 惯性导航系统特性 优点 缺点 INS的精度等级 典型战术级惯导 惯性器件的相对测量能力 惯性导航原理 航位 ...

  2. 自动驾驶(五十二)---------惯性导航原理

    惯性导航一般集成在GPS设备中,都是由供应商集成,那在这里有什么讨论的必要呢,要知道在车辆行驶中,我们可以拿到GPS的yawrate和speed信号,而且车辆本身还有一套传感器获取yawrate和sp ...

  3. 导航基础之坐标系整理——导航坐标系、地球坐标系、载体坐标系

    概述 在三维空间中,无约束的物体具有6个自由度,即三个方向的位置和三个欧拉角.故在导航中,明确坐标系的定义是基础.坐标系分为左手坐标系和右手坐标系,实际中,常常采用右手坐标系. 三维坐标系是描述空间中 ...

  4. 深蓝学院-多传感器融合定位课程-第5章-惯性导航原理及误差分析

    专栏文章: 深蓝学院-多传感器融合定位课程-第1章-概述_goldqiu的博客-CSDN博客 深蓝学院-多传感器融合定位课程-第2章-3D激光里程计I_goldqiu的博客-CSDN博客 深蓝学院-多 ...

  5. 轮换对称性实质 和差化积公式之sinθ+cosθ推导 rd原理,二重积分坐标系转化为什么多了个r; 二重积分几何意义: 二重积分物理意义: 二重积分求导:

    目录 轮换对称性实质 和差化积公式之sinθ+cosθ推导 rd原理,二重积分坐标系转化为什么多了个r:

  6. 导航坐标系:地心惯性坐标系、地心地固坐标系、当地水平坐标系、载体/机体坐标系

    导航中的几种常用坐标系 地心惯性坐标系(ECI) 地心地固坐标系(ECEF) 当地水平坐标系(LLF).东北天坐标系ENU 地平坐标系 载体/机体坐标系 机动目标跟踪/室内定位/导航/优化技术探讨:W ...

  7. 多传感器融合定位六-惯性导航原理及误差分析

    多传感器融合定位六-惯性导航原理及误差分析 1. 惯性技术简介 1.1 惯性技术发展历史 1.2 惯性器件 1.2.1 机械陀螺(几乎没人用了) 1.2.2 激光陀螺 1.2.3 光纤陀螺 1.2.4 ...

  8. 北东地坐标系转换c语言,北东地/东北天两种导航坐标系与姿态转换

    一. 坐标系 1. 导航坐标系 常用的导航坐标系有北东地和东北天两种. 两种坐标系的指向分别定义如下: 1.1 北东地坐标系 X轴:指北; Y轴:指东; Z轴:指地. 1. 2 东北天坐标系 X轴:指 ...

  9. BetaFlight深入传感设计之九:传感坐标系/机体坐标系/导航坐标系/经纬度坐标系

    BetaFlight深入传感设计之九:传感坐标系/机体坐标系/导航坐标系/经纬度坐标系 1. 问题症结 2. 入手分析 2.1 传感坐标系 2.2 机体坐标系 2.3 导航坐标系 2.4 经纬坐标系 ...

最新文章

  1. android Button 监听的几种方式
  2. sql 12天内的数据_想要在12周内成为数据科学家吗?
  3. 相对不容易用计算机语言编程实现的是,在描述算法的方法中,相对不容易用计算机语言编程实现的是(    )....
  4. (三)C语言之九条语句
  5. Joe一款个人博客typecho主题(扩展版)
  6. python程序在线更新_Python自动更新功能
  7. 如何在苹果Mac上截屏或录制屏幕?
  8. SpringMVC中实现文件上传
  9. 闪迪内存卡软件测试,存储卡不稳定?我们用微波炉测试 结果震惊了!
  10. lammps教程:boundary命令详解
  11. linux查看nginx昅 电视,PHP实现查询汉字笔画、笔画排序、笔画统计
  12. 平行四边形不等式优化详解
  13. Handler execution resulted in exception: Content type 'application/json;charset=UTF-8' not supported
  14. 用VB开发USB接口POS打印机进行打印和弹钱箱
  15. win10蓝牙断断续续问题
  16. win10设置虚拟内存_小技巧| 电脑经内存不够用,教你如何设置虚拟内存
  17. 【Android-I】Android开发之常见错误:Dx unsupported class file version 52.0...while parsing com/...
  18. Qt执行bash命令并获取返回结果
  19. ACG-crcme1(★★★)
  20. aes128 cmac java_使用PHP进行CMAC-AES散列

热门文章

  1. 支持三个cpu的服务器,产品技术-新华三发布搭载英特尔第三代可扩展处理器的H3C UniServer R6900 G5 服务器-新华三集团-H3C...
  2. 小米4c+android+6,小米4c有什么接口?小米4c有HDMI接口吗?
  3. IIS5、IIS6、IIS7的ASP.net 请求处理过程比较转
  4. 手机App测试点归纳
  5. 菜鸟弟弟从零开始的爬取Bilibili弹幕的Python爬虫教程-哔哩哔哩 - ( ゜- ゜)つロ 干杯~
  6. 计算机学院请假管理系统,《计算机学院在校学生离校请销假管理暂行规定》
  7. asynctaskdemo(Info)5
  8. python中找最小值,使用循环python查找最小值
  9. 【C++基础】头文件定义问题导致的重定义问题
  10. 屏幕色温自动调节小助手