Files
Point-LIO_ROS2/Log/plot_rtk.py
2024-01-18 08:54:06 -05:00

39 lines
998 B
Python
Executable File

import numpy as np
import matplotlib.pyplot as plt
a_grdt=np.loadtxt('pos_rtk.txt')
a_out=np.loadtxt('mat_out.txt')
#######for normal#######
fig, axs = plt.subplots(3,1)
lab_grdt = ['', 'gt-x', 'gt-y', 'gt-z']
lab_out = ['', 'out-x', 'out-y', 'out-z']
plot_ind = range(7,10)
time=a_out[:,0]
time1 = a_grdt[:,0]
axs[0].set_title('East [m]')
axs[1].set_title('North [m]')
axs[2].set_title('Up [m]')
for i in range(1,4):
axs[i-1].plot(time1, a_grdt[:,i],'.-', label=lab_grdt[i])
axs[i-1].plot(time, a_out[:,i+3],'.-', label=lab_out[i])
for j in range(1,4):
axs[j-1].grid()
axs[j-1].legend()
plt.grid()
#######for normal#######
fig, axs = plt.subplots(2,1)
axs[0].set_title('clock drift')
lab_1 = ['dt-g', 'dt-r', 'dt-e', 'dt-c']
for i in range(3):
#if i==1:
axs[0].plot(time, a_out[:,i+13],'.-', label=lab_1[i])
axs[0].plot(time, a_out[:,19],'.-', label=lab_1[3])
for i in range(1):
#axs[i].set_xlim(386,389)
axs[i].grid()
axs[i].legend()
plt.grid()
plt.show()