KF-gins输出结果绘图

VIPKF-gins输出结果绘图
KF-gins输出结果绘图
开通可读全文 ·1.1k 人阅读
最低0.47元/天 解锁文章

使用truth.nav或者编译之后得到的KF_GINS_Navresult.nav文件都可以,通过查看readme_cn,得知每一列的物理意义,如下图:

在这里插入图片描述
第二列为时间,第6~8列为该时刻下的速度,使用这四列信息就可以画出来
需要用到两个公式:
加速度计算公式a=(v2-v1)/(t2-t1)
位移公式x=v0 * t + 1/2 * a * t^2

将初始点规定为(0,0,0),使用上两个公式就可以计算出相邻两行数据的位移,再加上上一时刻的位置就是当前的位置,这样子就可以得到许多的位置信息,在平面上画出即可.

import numpy as np
import pyqtgraph as pg
from pyqtgraph.Qt import QtCore, QtGui
import pyqtgraph.opengl as gl
from PyQt5.Qt import QApplication
from pyqtgraph.opengl.GLGraphicsItem import GLGraphicsItem
from OpenGL.GL import *

with open("dataset/ADIS16460/truth.nav") as f:
# with open("dataset/KF_GINS_Navresult.nav") as f:
# with open("dataset/KF_GINS_Navresult.nav") as f:
    files = f.readlines()

time = []
vx =  []
vy = []
vz = []
for  file in files:
   t =  float(file.split()[1])
   v_x = float(file.split()[5])
   v_y =  float(file.split()[6])
   v_z =  float(file
VIP 武汉大学KF-GINS开源代码学习1---insPropagation 本着“干中学”的原则,学习了武汉大学的KF-GINS代码,一边学习代码编程的思路,一边学习C++的知识点和一些常见库文件中的函数,编程的思路应该是从后往前,编写代码是从前往后。首先从insPropagation开始写起吧,前面的内容后续再补充了。 开通可读全文·1.1k 阅读·16 点赞·22 收藏 阅读全文

相关推荐

GNSS-INS组合导航:KF-GINS(一)

KF-GINS松组合程序介绍

cxy0711的博客 7772

KF-GINS开源组合导航库:从源码结构到EKF融合实战解析

本文深入解析了开源组合导航库KF-GINS,从其清晰的源码结构入手,详细拆解了惯性导航机械编排与扩展卡尔曼滤波(EKF)融合的核心实现。文章通过模块化解读与实战指南,帮助开发者理解GNSS/INS组合导航原理,并掌握基于该库进行二次开发和算法调试的方法。

u5v6w7的博客 493

武汉大学KF-GINS开源代码学习2--gnssUpdate

matlab一行就能就解决,C++需要三行,学习如何定义。//MATLABresize:直接指定新的行数和列数来调整对象的大小。resizelike:将对象的大小调整为另一个参考对象的大小,更方便在需要根据已有对象的尺寸进行调整时使用。

人生导航家的博客 2036

KF-GINS简易绘图工具实战指南

合并可见图层:保留非隐藏内容,生成新图层;拼合组内图层:将子图层压平为单一图层;智能归并:自动识别命名相似的图层(如 sensor_*),推荐批量操作。UI 面板支持拖拽调整顺序、快捷键修改 z-index,并通过颜色编码标识状态,提升协作认知一致性。graph TDA[根图层] --> B[背景层]A --> C[传感器布局组]C --> C1[IMU模块]C --> C2[GPS天线]C --> C3[惯导基准框]A --> D[算法流程图层]

weixin_30205153的博客 331

阿里天池新闻推荐实战:多路召回策略解析与优化

本文深入解析阿里天池新闻推荐项目中的多路召回策略,包括ItemCF、UserCF、YouTubeDNN等五种召回模型的协同应用与优化技巧。通过实战案例展示如何提升推荐系统效果,特别针对冷启动问题提出创新解决方案,帮助开发者构建高效的新闻推荐系统。

weixin_26918763的博客 418

从URDF到Gazebo:一个完整的ROS2机械臂仿真与运动控制实战指南

本文提供了一个完整的ROS2机械臂仿真与运动控制实战指南。详细讲解了从URDF建模、ROS2 Control配置到Gazebo物理仿真的全流程,重点介绍了如何利用MoveIt2快速搭建高级运动规划系统,并解决实际部署中的常见问题,帮助开发者高效、安全地进行机器人算法验证与开发。

red88的博客 580

DRAM架构演进与HBM技术在高性能计算中的应用

DRAM(动态随机存取存储器)是现代计算系统中关键的内存技术,其架构优化直接影响数据供给能力。随着AI训练和科学计算等数据密集型负载的普及,传统DDR架构面临带宽墙、能效比和访问粒度等挑战。HBM(高带宽内存)通过3D堆叠技术(如TSV硅通孔)和异构集成(如PIM存内计算)显著提升了带宽和能效比。这些技术在高性能计算、AI推理和大模型训练等场景中展现出巨大潜力,例如HBM3的带宽可达819GB/s,能效比低至0.95pJ/b。未来,DRAM技术将继续向更高密度、更低功耗和更智能的内存计算方向发展。

weixin_35757191的博客 401

Fofa API高阶玩法:用Python批量获取漏洞资产(含OA系统扫描实战)

本文详细介绍了如何利用Python结合Fofa API实现自动化漏洞资产收集的高阶实战技巧。通过构建健壮的客户端、设计精准查询语法、实现多线程批量采集,并以OA系统漏洞扫描为例,演示了从资产发现、过滤验证到报告生成的全流程,旨在提升安全运维与应急响应的效率。

weixin_28607671的博客 505

SigmaStar(星宸科技)SSC33X系列

目前,SSC33X系列已经量产了接近两年,SDK成熟稳定,功耗表现良好,图像效果出色,广泛应用在AI枪机、AI球机、AI云台机、多目摄像机、停车场闸机、人脸门禁、人脸锁、门铃猫眼等产品上。

Comake Online的博客 1万+

kubeadm init 运行时kebelet启动失败问题

解决k8s kubeadm init时遇到的kubelet问题

ZDPZN的博客 6075

YoloV8优化:感受野注意力卷积运算(RFAConv),效果秒杀CBAM和CA等 | 即插即用系列

感受野注意力卷积运算(RFAConv),解决卷积块注意力模块(CBAM)和协调注意力模块(CA)只关注空间特征,不能完全解决卷积核参数共享的问题

①答疑群聊服务;②YOLO大模型知识问答系统;③计算机视觉论文生成智能体; 4269

ImportError: DLL load failed while importing _pydantic_core: 找不到指定的程序对应解决方案

本文主要介绍了ImportError: DLL load failed while importing _pydantic_core: 找不到指定的程序对应解决方案,希望能对使用Python的同学们有所帮助。 文章目录 1. 问题描述 2. 解决方案

weixin_43178406的博客 19万+

jdk-8u144-linux-x64.tar.gz.

该资源为搭建Linux系统Java环境用,资源的后缀为tar.gz格式的压缩包

迈瑞BS系列全自动生化分析仪LIS协议接口手册(内含HL7和ASTM)

迈瑞BS系列全自动生化分析仪LIS协议接口手册,内含HL7和ASTM)

LinePhone3.2.7(android端最新版本) sip客户端

SIP客户端For android:LinePhone3.2.7(最新版本),官网地址:http://www.linphone.org/

Probability and Statistics - 4th edition

Probability and Statistics - 4th edition

上一篇: opencv变换底色
下一篇: tftp发送接受文件
六点零六
博客等级 码龄6年 67粉丝 55原创
评论
成就一亿技术人!
拼手气红包6.0元
还能输入1000个字符
 
 条评论被折叠 查看
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付:10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值
⌂ 换网址