需求

设置飞机的一些坐标位置(经纬度高度),插值得到更多的坐标位置,然后飞机按照这些坐标集合形成的航线飞行,飞机的朝向、俯仰角以及飞机转弯时的翻转角根据坐标集合计算得出,而不需要手动设置heading、pitch、roll。

坐标插值

不知道为什么,可能是飞行速度变化太大,我用Cesium自带的插值,计算出的航线很奇怪

// 如下代码插值计算出的航线有问题
property.setInterpolationOptions({
interpolationDegree : 5,
interpolationAlgorithm : Cesium.LagrangePolynomialApproximation
});

自己写的插值计算,效果等同于Cesium自带的线性插值:

/**
* 重新采样this.DronePositions
*/
DetectsDrones.prototype.sameple = function () {
for (let i = 0; i < 3; i++) {
this.samepleOnce();
}
} /**
* 重新采样this.DronePositions
*/
DetectsDrones.prototype.samepleOnce = function () {
for (let i = 0; i < this.DronePositions.length - 1; i += 2) {
let pos1 = this.DronePositions[i];
let pos2 = this.DronePositions[i + 1];
let time1 = dayjs(pos1.time, 'YYYY-MM-DD HH:mm:ss');
let time2 = dayjs(pos2.time, 'YYYY-MM-DD HH:mm:ss');
let time = time1.add(time2.diff(time1) / 2.0, 'millisecond');
let lng = (pos1.targetPosition.lng + pos2.targetPosition.lng) / 2.0;
let lat = (pos1.targetPosition.lat + pos2.targetPosition.lat) / 2.0;
let height = (pos1.targetPosition.height + pos2.targetPosition.height) / 2.0;
let heading = (pos1.targetPosition.heading + pos2.targetPosition.heading) / 2.0;
let pitch = (pos1.targetPosition.pitch + pos2.targetPosition.pitch) / 2.0;
let roll = (pos1.targetPosition.roll + pos2.targetPosition.roll) / 2.0;
let pos = {
time: time.format('YYYY-MM-DD HH:mm:ss.SSS'),
targetPosition: {
lng: lng,
lat: lat,
height: height,
heading: heading,
pitch: pitch,
roll: roll,
}
}
this.DronePositions.splice(i + 1, 0, pos);
}
}

根据航线坐标集合计算heading、pitch、roll

从网上抄的计算heading和pitch的方法(参考博客:https://blog.csdn.net/u010447508/article/details/105562542?_refluxos=a10):

/**
* 根据两个坐标点,获取Heading(朝向)
* @param { Cesium.Cartesian3 } pointA
* @param { Cesium.Cartesian3 } pointB
* @returns
*/
function getHeading(pointA, pointB) {
//建立以点A为原点,X轴为east,Y轴为north,Z轴朝上的坐标系
const transform = Cesium.Transforms.eastNorthUpToFixedFrame(pointA);
//向量AB
const positionvector = Cesium.Cartesian3.subtract(pointB, pointA, new Cesium.Cartesian3());
//因transform是将A为原点的eastNorthUp坐标系中的点转换到世界坐标系的矩阵
//AB为世界坐标中的向量
//因此将AB向量转换为A原点坐标系中的向量,需乘以transform的逆矩阵。
const vector = Cesium.Matrix4.multiplyByPointAsVector(
Cesium.Matrix4.inverse(transform, new Cesium.Matrix4()),
positionvector,
new Cesium.Cartesian3()
);
//归一化
const direction = Cesium.Cartesian3.normalize(vector, new Cesium.Cartesian3());
//heading
let heading = Math.atan2(direction.y, direction.x) - Cesium.Math.PI_OVER_TWO;
heading = Cesium.Math.TWO_PI - Cesium.Math.zeroToTwoPi(heading);
return Cesium.Math.toDegrees(heading);
} /**
* 根据两个坐标点,获取Pitch(仰角)
* @param { Cesium.Cartesian3 } pointA
* @param { Cesium.Cartesian3 } pointB
* @returns
*/
function getPitch(pointA, pointB) {
let transfrom = Cesium.Transforms.eastNorthUpToFixedFrame(pointA);
const vector = Cesium.Cartesian3.subtract(pointB, pointA, new Cesium.Cartesian3());
let direction = Cesium.Matrix4.multiplyByPointAsVector(Cesium.Matrix4.inverse(transfrom, transfrom), vector, vector);
Cesium.Cartesian3.normalize(direction, direction);
//因为direction已归一化,斜边长度等于1,所以余弦函数等于direction.z
let pitch = Cesium.Math.PI_OVER_TWO - Cesium.Math.acosClamped(direction.z);
return Cesium.Math.toDegrees(pitch);
}

根据航线坐标集合计算heading、pitch、roll:

代码中this.DronePositions是无人机群的坐标集合,坐标放在targetPosition属性中

/**
* 计算无人机群的heading
*/
DetectsDrones.prototype.calcHeading = function () {
// 清空原有heading
this.DronePositions.map(pos => {
pos.targetPosition.heading = undefined;
}); for (let i = 0; i < this.DronePositions.length - 1; i++) {
let pos1 = this.DronePositions[i];
let pos2 = this.DronePositions[i + 1];
let heading = -90 + getHeading(Cesium.Cartesian3.fromDegrees(pos1.targetPosition.lng, pos1.targetPosition.lat), Cesium.Cartesian3.fromDegrees(pos2.targetPosition.lng, pos2.targetPosition.lat));
if (!pos1.targetPosition.heading) {
pos1.targetPosition.heading = heading;
}
pos2.targetPosition.heading = heading;
} let lastPos = this.DronePositions[this.DronePositions.length - 1]; let heading = -90 + getHeading(Cesium.Cartesian3.fromDegrees(lastPos.targetPosition.lng, lastPos.targetPosition.lat), Cesium.Cartesian3.fromDegrees(this.quli.targetPosition.lng, this.quli.targetPosition.lat));
this.quli.targetPosition.heading = heading; heading = -90 + getHeading(Cesium.Cartesian3.fromDegrees(lastPos.targetPosition.lng, lastPos.targetPosition.lat), Cesium.Cartesian3.fromDegrees(this.jiluo.targetPosition.lng, this.jiluo.targetPosition.lat));
this.jiluo.targetPosition.heading = heading;
} /**
* 计算无人机群的pitch
*/
DetectsDrones.prototype.calcPitch = function () {
// 清空原有pitch
this.DronePositions.map(pos => {
pos.targetPosition.pitch = undefined;
}); for (let i = 0; i < this.DronePositions.length - 1; i++) {
let pos1 = this.DronePositions[i];
let pos2 = this.DronePositions[i + 1];
let pitch = getPitch(Cesium.Cartesian3.fromDegrees(pos1.targetPosition.lng, pos1.targetPosition.lat, pos1.targetPosition.height), Cesium.Cartesian3.fromDegrees(pos2.targetPosition.lng, pos2.targetPosition.lat, pos2.targetPosition.height));
if (!pos1.targetPosition.pitch) {
pos1.targetPosition.pitch = pitch;
}
pos2.targetPosition.pitch = pitch;
}
} /**
* 计算无人机群的roll(不支持转弯大于90度)
*/
DetectsDrones.prototype.calcRoll = function () {
// 清空原有roll
this.DronePositions.map(pos => {
pos.targetPosition.roll = undefined;
}); for (let i = 1; i < this.DronePositions.length - 1; i++) {
let pos1 = this.DronePositions[i];
let pos2 = this.DronePositions[i + 1];
let deltaHeading = pos2.targetPosition.heading - pos1.targetPosition.heading;
pos2.targetPosition.roll = deltaHeading / 1.5;
}
}

效果

遇到的问题

  1. 插值计算的问题,就是设置的坐标集合,是拆线,最好把它插值成平滑曲线,但是Cesium自带的插值,有时间参数,而我想仅仅通过经纬度集合来插值。
  2. 我写的计算roll的方法有问题,不支持转弯大于90度的情况,花了一些时间,没搞定。转弯小于90度,凑合用,测试了几组数据没问题,但仍不确定有没有BUG。

    抛砖引玉,有没有高手给个提示,插值问题怎么解决?roll的正确的通用的计算方法?

Cesium 根据飞机航线计算飞机的Heading(偏航角)、Pitch(俯仰角)、Roll(翻滚角)的更多相关文章

  1. 在智能手机上跟踪ADS-B系统的飞机航线信息

    飞机飞行的中断可能会给航空公司造成数十亿美员的损失,但即便如此大多数现代商业航班仍旧依赖于存有严重安全问题的空中交通管制系统.到2020年,这些系统将会被升级为一个被称之为NextGen的系统,该系统 ...

  2. [知了堂学习笔记]_用JS制作《飞机大作战》游戏_第4讲(创建敌方飞机、敌方飞机发射子弹、玩家子弹击中敌方小飞机,小飞机死亡)

    一.创建敌方飞机 1.思考创建思路: 创建敌方飞机思路与创建玩家飞机思路一样: (1)思考敌方飞机具备什么属性: 敌方飞机的图片.坐标.飞行速度.状态(是否被击中) 设置小飞机被击中时消失时间.飞机可 ...

  3. 用JS制作《飞机大作战》游戏_第4讲(创建敌方飞机、敌方飞机发射子弹、玩家子弹击中敌方小飞机,小飞机死亡)-陈远波

    一.创建敌方飞机 1.思考创建思路: 创建敌方飞机思路与创建玩家飞机思路一样: (1)思考敌方飞机具备什么属性: 敌方飞机的图片.坐标.飞行速度.状态(是否被击中) 设置小飞机被击中时消失时间.飞机可 ...

  4. 飞行姿态角度表示: heading pitch roll

    //创建初始化摄像机视图 var initialPosition=new Cesium.Cartesian3.fromDegrees(-73.998114468289017509, 40.674512 ...

  5. Supermap/Cesium 开发心得----定位

    SuperMap的WebGL是基于开源JS库Cesium做的修改而形成的产品,理论上用起来大同小异,如果在有不一样的地方再看,基本上还是与Cesium的接口名称和结构是一样的. 定位方法有基于Cesi ...

  6. Cesium入门-3-官方完整实例

    实例核心代码 //资源访问令牌 Cesium token Cesium.Ion.defaultAccessToken='eyJhbGciOiJIUzI1NiIsInR5cCI6IkpXVCJ9.eyJ ...

  7. 谈一谈 MPU6050 姿态融合(转)

    姿态角(Euler角)pitch yaw roll飞行器的姿态角并不是指哪个角度,是三个角度的统称.它们是:俯仰.滚转.偏航.你可以想象是飞机围绕XYZ三个轴分别转动形成的夹角. 地面坐标系(eart ...

  8. CVPR2020论文介绍: 3D 目标检测高效算法

    CVPR2020论文介绍: 3D 目标检测高效算法 CVPR 2020: Structure Aware Single-Stage 3D Object Detection from Point Clo ...

  9. 机载LIDAR技术及其应用

    1 机载LIDAR的系统组成及原理 1.1 机载 LIDAR 技术的发展历程 LIDAR 技术和机载激光扫描技术的发展源自 1970 年,美国航空航天局(NASA)支持研制成功第一台对地观测 LIDA ...

  10. MPU9250调试

    MPU9250 芯片概述 MPU9250芯片是一个9轴姿态传感芯片,其中包含了3轴加速度传感器.3轴角速度传感器以及三轴磁力计. 其本质上是MPU6050芯片+AK8963. 可以获取传感芯片的加速度 ...

随机推荐

  1. win32--GetFileAttributes

    DWORD d = GetFileAttributes(path.c_str()); 根据返回的十进制,对比文件属性,来检索指定文件或目录的文件系统属性. 也可以使用 if ((d & FIL ...

  2. 了解企业架构EA(Enterprise Architecture)

    一.企业架构简介 企业架构:Enterprise Architecture,EA,或企业体系结构,是在信息系统架构设计与实践基础上发展起来的一个特殊领域. 但是企业架构现在还没有一个公认的定义,综合现 ...

  3. Redis服务端事件处理流程分析

    一.事件处理 1.1 什么是事件 Redis 为什么运行得比较快? 原因之一就是它的服务端处理程序用了事件驱动的处理方式. 那什么叫事件处理?就是把处理程序当成一个一个的事件处理.比如我前面文章:服务 ...

  4. 在Hexo中引入本地图片的实现

    实现步骤 第一步:修改项目根目录下的_config.yml文件参数post_asset_folder值为true. # 开始使用本地静态资源 post_asset_folder: true 第二步:安 ...

  5. 苹果工程师对iOS线程开发的那点事津津乐道

    pthread,Thread总结 pthread: 通用的多线程API 使用方法 // 1. 创建线程: 定义一个pthread_t类型变量 pthread_t thread; // 2. 开启线程: ...

  6. Java 多线程------解决 实现Runnabel接口方式线程的线程安全问题 方式二:同步方法 +总结

    方式二:同步方法* 如果操作共享数据的代码完整的声明在一个方法中,我们不妨将此方法声明同步的 1 package bytezero.threadsynchronization; 2 3 4 5 /** ...

  7. mybatis查询大批量数据的几种方式

    问题背景 公司里有很多需要跑批数据的场景,这些数据几十万到几千万不等,目前我们采用的是分页查询,但是分页查询有个深度分页问题,上百万的数据就会查询的很慢 常规解决方案 全量查询 分页查询 流式查询 游 ...

  8. 摆脱鼠标系列 - vscode 上一个编辑器 下一个编辑器 Ctrl + h Ctrl + l

    摆脱鼠标系列 - vscode 上一个编辑器 下一个编辑器 Ctrl + H Ctrl + L 为什么 根据 hjkl h是左边的原则 h 左移一位 b 左移一个单词 H 移动到句首 0 是行首 I是 ...

  9. Linux高级IO

    readv.writev API: #include <sys/uio.h> ssize_t readv(int fd, const struct iovec* vector, int c ...

  10. yum总纲

    yum总纲 yum源搭建 首先本文档讲解两种搭建方式,第一有网络环境和第二种无网络环境. 第一种:有网络环境 首先 进入系统执行:以下命令,获取网络源 wget -O /etc/yum.repos.d ...