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

最新推荐文章于 2024-09-20 22:20:30 发布

原创最新推荐文章于 2024-09-20 22:20:30 发布 · 1.4k 阅读

3 ·

CC 4.0 BY-SA版权

文章标签：

#python #numpy #开发语言

Python 专栏收录该内容

11 篇文章

订阅专栏

本文介绍了一种使用Python从包含时间戳和平移数据的文件中绘制3D轨迹图的方法。通过累积平移数据并利用matplotlib库创建3D图表，直观展示物体运动轨迹。

部署运行你感兴趣的模型镜像

一般画轨迹图可以直接使用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()

您可能感兴趣的与本文相关的镜像