python画轨迹图（没有旋转信息）

一般画轨迹图可以直接使用evo工具画，这里只有时间戳、平移数据，并没有旋转数据，因此使用python简略画一个轨迹示意图：

注：pose_result.txt 每一维构造为[time, tx, ty, tz]

>>> import numpy as np
>>> pose = np.loadtxt("pose_result.txt")
>>> for i in range(pose.shape()-1):
           pose[i+1,1:]=pose[i,1:]+pose[i+1,1:]
>>> from mpl_toolkits import mplot3d
>>> import matplotlib.pyplot as plt
>>> fig = plt.figure()
>>> ax = plt.axes(projection='3d')
>>> ax.plot3D(pose[:,1], pose[:,2],pose[:,3], 'gray')
[<mpl_toolkits.mplot3d.art3d.Line3D object at 0x7f7873045f90>]
>>> ax.set_title('3D line plot')
Text(0.5, 0.92, '3D line plot')
>>> plt.show()