大疆无人机飞行器航空器坐标知识整理

news/2024/11/15 1:22:13/

一、大地坐标系。GIS开发,移动开发,web开发,GPS(非专业GIS人士,若有错误求轻锤)。全文以大疆无人机开发为背景举例说明。

我们常用的民用坐标系常用的有:

1、WGS84坐标系:即地球坐标系(World Geodetic System),国际上通用的坐标系。设备包含的GPS芯片或者北斗芯片获取的经纬度一般都是为WGS84地理坐标系,目前谷歌地图采用的是WGS84坐标系(中国范围除外)。WGS-84坐标系的原点在地球质心,Z轴指向BIH1984.0定义的协定地球极(CTP)方向,X轴指向BIH1984.0的零度子午面和CTP赤道的交点,Y轴和Z、X轴构成右手坐标系。其参数为经度、纬度、海拔高度。

2、GCJ02坐标系:即火星坐标系,国测局坐标系。是由中国国家测绘局制定。由WGS84坐标系经加密后的坐标系。谷歌中国和搜搜中国采用的GCJ02地理坐标系。

3、BD09坐标系:百度坐标系,GCJ02坐标系经加密后的坐标系。

(以上参考于百度)

其他各种各样的坐标基本都是在此基础上加密。


有关第三方API坐标系情况如下:(以下截图来源自百度,若侵删)


转换代码附上(项目中用了很多年的,留下你的赞,放心用):

/*** 提供了百度坐标(BD09)、国测局坐标(火星坐标,GCJ02)、和WGS84坐标系之间的转换*/
public class CoordinateTransformUtil {private static final double x_PI = 3.14159265358979324 * 3000.0 / 180.0;private static final double PI = 3.1415926535897932384626;private static final double a = 6378245.0;private static final double ee = 0.00669342162296594323;/*** 百度坐标(BD09)转 GCJ02** @param lng 百度经度* @param lat 百度纬度* @return GCJ02 坐标:[经度,纬度]*/public static double[] transformBD09ToGCJ02(double lng, double lat) {double x = lng - 0.0065;double y = lat - 0.006;double z = Math.sqrt(x * x + y * y) - 0.00002 * Math.sin(y * x_PI);double theta = Math.atan2(y, x) - 0.000003 * Math.cos(x * x_PI);double gcj_lng = z * Math.cos(theta);double gcj_lat = z * Math.sin(theta);return new double[]{gcj_lng, gcj_lat};}/*** GCJ02 转百度坐标** @param lng GCJ02 经度* @param lat GCJ02 纬度* @return 百度坐标:[经度,纬度]*/public static double[] transformGCJ02ToBD09(double lng, double lat) {double z = Math.sqrt(lng * lng + lat * lat) + 0.00002 * Math.sin(lat * x_PI);double theta = Math.atan2(lat, lng) + 0.000003 * Math.cos(lng * x_PI);double bd_lng = z * Math.cos(theta) + 0.0065;double bd_lat = z * Math.sin(theta) + 0.006;return new double[]{bd_lng, bd_lat};}/*** GCJ02 转 WGS84** @param lng 经度* @param lat 纬度* @return WGS84坐标:[经度,纬度]*/public static double[] transformGCJ02ToWGS84(double lng, double lat) {if (outOfChina(lng, lat)) {return new double[]{lng, lat};} else {double dLat = transformLat(lng - 105.0, lat - 35.0);double dLng = transformLng(lng - 105.0, lat - 35.0);double radLat = lat / 180.0 * PI;double magic = Math.sin(radLat);magic = 1 - ee * magic * magic;double sqrtMagic = Math.sqrt(magic);dLat = (dLat * 180.0) / ((a * (1 - ee)) / (magic * sqrtMagic) * PI);dLng = (dLng * 180.0) / (a / sqrtMagic * Math.cos(radLat) * PI);double mgLat = lat + dLat;double mgLng = lng + dLng;return new double[]{lng * 2 - mgLng, lat * 2 - mgLat};}}/*** WGS84 坐标 转 GCJ02** @param lng 经度* @param lat 纬度* @return GCJ02 坐标:[经度,纬度]*/public static double[] transformWGS84ToGCJ02(double lng, double lat) {if (outOfChina(lng, lat)) {return new double[]{lng, lat};} else {double dLat = transformLat(lng - 105.0, lat - 35.0);double dLng = transformLng(lng - 105.0, lat - 35.0);double redLat = lat / 180.0 * PI;double magic = Math.sin(redLat);magic = 1 - ee * magic * magic;double sqrtMagic = Math.sqrt(magic);dLat = (dLat * 180.0) / ((a * (1 - ee)) / (magic * sqrtMagic) * PI);dLng = (dLng * 180.0) / (a / sqrtMagic * Math.cos(redLat) * PI);double mgLat = lat + dLat;double mgLng = lng + dLng;return new double[]{mgLng, mgLat};}}/*** 百度坐标BD09 转 WGS84** @param lng 经度* @param lat 纬度* @return WGS84 坐标:[经度,纬度]*/public static double[] transformBD09ToWGS84(double lng, double lat) {double[] lngLat = transformBD09ToGCJ02(lng, lat);return transformGCJ02ToWGS84(lngLat[0], lngLat[1]);}/*** WGS84 转 百度坐标BD09** @param lng 经度* @param lat 纬度* @return BD09 坐标:[经度,纬度]*/public static double[] transformWGS84ToBD09(double lng, double lat) {double[] lngLat = transformWGS84ToGCJ02(lng, lat);return transformGCJ02ToBD09(lngLat[0], lngLat[1]);}private static double transformLat(double lng, double lat) {double ret = -100.0 + 2.0 * lng + 3.0 * lat + 0.2 * lat * lat + 0.1 * lng * lat + 0.2 * Math.sqrt(Math.abs(lng));ret += (20.0 * Math.sin(6.0 * lng * PI) + 20.0 * Math.sin(2.0 * lng * PI)) * 2.0 / 3.0;ret += (20.0 * Math.sin(lat * PI) + 40.0 * Math.sin(lat / 3.0 * PI)) * 2.0 / 3.0;ret += (160.0 * Math.sin(lat / 12.0 * PI) + 320 * Math.sin(lat * PI / 30.0)) * 2.0 / 3.0;return ret;}private static double transformLng(double lng, double lat) {double ret = 300.0 + lng + 2.0 * lat + 0.1 * lng * lng + 0.1 * lng * lat + 0.1 * Math.sqrt(Math.abs(lng));ret += (20.0 * Math.sin(6.0 * lng * PI) + 20.0 * Math.sin(2.0 * lng * PI)) * 2.0 / 3.0;ret += (20.0 * Math.sin(lng * PI) + 40.0 * Math.sin(lng / 3.0 * PI)) * 2.0 / 3.0;ret += (150.0 * Math.sin(lng / 12.0 * PI) + 300.0 * Math.sin(lng / 30.0 * PI)) * 2.0 / 3.0;return ret;}/*** 判断坐标是否不在国内** @param lng 经度* @param lat 纬度* @return 坐标是否在国内*/public static boolean outOfChina(double lng, double lat) {return (lng < 72.004 || lng > 137.8347) || (lat < 0.8293 || lat > 55.8271);}
}

这里以常用的高德API举例:

无人机GPS给到的WGS84坐标longitude、latitude如果要展示在高德地图上,就需要转换为GCJ02坐标,再去用new LatLng(lat, lng)。


二、局部切线平面(参考1)

  从定义来分类,局部切线平面可分为基于垂直和水平尺寸定义的平面,其表现在纵坐标为上还是下。纵坐标为上时,称为ENU(东、北、天)坐标系,主要用于地理方面;纵坐标为下时,称为NED(北、东、地)坐标系,特别用于航空航天。 

无人机属于航空飞行器,使用的是NED坐标系。即以自身平面为坐标系,大疆无人机机头朝向的yaw、pitch、roll。

使用场景:在一些计算调整无人机飞行方向等,算法用到。

比如要求无人机在一定范围内飞行,即将飞出则自动让无人机刹车。如何判断无人机即将飞出?

那就需要用到高中几何知识了,在NED坐标系中解析无人机机头yaw朝向,与边界线做垂线。。。。。。

 

 

参考:

坐标系基础知识,文中图引自 https://www.cnblogs.com/ethanda/p/10325109.html

 


http://www.ppmy.cn/news/497381.html

相关文章

大疆热红外图片温度读取

适用于 大疆禅思 Zenmuse H20 系列拍摄的红外图片&#xff0c;依赖于大疆发布的TSDK&#xff08;DJI Thermal SDK&#xff09;&#xff0c;可用于视频的动态测温。 其实对TSDK并未深入研究&#xff0c;只是某一个小项目要使用TSDK处理H20拍摄的红外照片&#xff0c;利用TSDK中…

无人机自由飞行测试台 FFT GYRO 600

产品简介 无人机在研制过程中需要不断地进行飞行测试&#xff0c;而测试的过程不是万无一失的&#xff0c;飞行过程中发生任何错误都有可能会导致无人机的损毁或破坏&#xff0c;更严重地甚至会造成外界伤害。 基于此我们推出了无人机的三旋转自由度(3-DOF)飞行平台测试系统&…

序列化框架的选择- hession2、kyro、protostuff

序列化框架的选择 前言Hessian 2KryoProtostuff性能对比其他比较 前言 当涉及到序列化框架时&#xff0c;Hessian 2、Kryo 和 Protostuff 是三个常见的选择。它们在性能、跨语言支持、序列化大小和使用灵活性等方面存在一些差异。hession2、kyro、protostuff都是第三方开源的序…

Java NIO中Buffer方法详解(含代码示例)

目录 概念及方法 容量&#xff08;Capacity&#xff09;&#xff1a; 位置&#xff08;Position&#xff09;&#xff1a; 上界&#xff08;Limit&#xff09;&#xff1a; 标记&#xff08;Mark&#xff09;&#xff1a; 清空&#xff08;Clear&#xff09;&#xff1a;…

C# 特性(Attribute)总结

目录 特性是什么&#xff1f; 如何使用特性&#xff1f; &#xff08;1&#xff09;.Net 框架预定义特性 &#xff08;2&#xff09;自定义特性 为什么要使用特性&#xff1f; 特性的应用 特性实现枚举展示描述信息 特性是什么&#xff1f; 特性&#xff08;Attribute&…

超好看的UI云开发壁纸小程序源码

正文: 本壁纸表情包头像小程序采用&#xff08;dcloud云开发&#xff09;所以无需服务器与域名&#xff0c;本次版本集合了前两个版本所有的功能并有以下的更新。 更改界面UI样式&#xff0c;修复了路径控制BUG。新增任务中心、首页栏目增加动态壁纸搜索(支持关键词搜索全网动…

导向滤波 Guided Filter 的 CUDA GPU版本

Guided Filter Using CUDA GitHub Repo : Plumess/Guided-Filter-Using-CUDA: A GPU version implementation of Guided Filter, using CUDA C/C, calculates 1080P images in 10ms on 4090 (github.com) 这是导向滤波/引导滤波的一种GPU实现&#xff0c;经测试&#xff0c;在…

有没有关于python的壁纸_初学Python——01(想要好看的壁纸吗?)

#把win10锁屏页面的图片批量导出图片到E&#xff1a;\win10壁纸 import os import shutil pathrC:\Users\Administrator\AppData\Local\Packages\Microsoft.Windows.ContentDeliveryManager_cw5n1h2txyewy\LocalState\Assets to_pathrE:\Win10壁纸 #创建文件夹 isExistso…