使用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
7772



被折叠的 条评论
为什么被折叠?



