python 画3维轨迹图并进行比较的实例


Posted in Python onDecember 06, 2019

一. 数据的格式

首先我们需要x,y,z三个数据进行画图。从本实验用到的数据集KITTI 00.txt中举例:

1.000000e+00 9.043680e-12 2.326809e-11 5.551115e-17 9.043683e-12 1.000000e+00 2.392370e-10 3.330669e-16 2.326810e-11 2.392370e-10 9.999999e-01 -4.440892e-16

一组有12个数据,相当于T={R,t},R是3×3的矩阵,t是3×1的矩阵。我们需要的是t的数据。

有些groundtruth是8个数据,第一个是时间戳,在三个是x,y,z,后面四个是是四元数的数据。

代码如下:

# import necessary module
from mpl_toolkits.mplot3d import axes3d
import matplotlib.pyplot as plt
import numpy as np

# load data from file
# you can replace this using with open
data1 = np.loadtxt("./dataset/poses/00.txt")

first_2000 = data1[:, 3]
second_2000 = data1[:, 7]
third_2000 = data1[:, 11]
data2 = np.loadtxt("../temp/kittiseq00_imu.txt")
first_1000 = data2[:, 1]
second_1000 = data2[:, 2]
third_1000 = data2[:, 3]
# print to check data
#print first_2000
#print second_2000
#print third_2000

# new a figure and set it into 3d
fig = plt.figure()
ax = fig.gca(projection='3d')

# set figure information
ax.set_title("3D_Curve")
ax.set_xlabel("x")
ax.set_ylabel("y")
ax.set_zlabel("z")

# draw the figure, the color is r = read
figure1 = ax.plot(first_2000, second_2000, third_2000, c='r')
figure2 = ax.plot(first_1000, second_1000, third_1000, c='b')
plt.show()

效果图(电脑比较垃圾,后面的轨迹跟踪的时候提取的特征点太少):

python 画3维轨迹图并进行比较的实例

以上这篇python 画3维轨迹图并进行比较的实例就是小编分享给大家的全部内容了,希望能给大家一个参考,也希望大家多多支持三水点靠木。

Python 相关文章推荐
Python 文件重命名工具代码
Jul 26 Python
Python实现购物车功能的方法分析
Nov 10 Python
python如何把嵌套列表转变成普通列表
Mar 20 Python
django连接mysql配置方法总结(推荐)
Aug 18 Python
python2与python3共存问题的解决方法
Sep 18 Python
Python OpenCV调用摄像头检测人脸并截图
Aug 20 Python
python处理document文档保留原样式
Sep 23 Python
matplotlib实现显示伪彩色图像及色度条
Dec 07 Python
彻底搞懂 python 中文乱码问题(深入分析)
Feb 28 Python
Python如何在循环内使用list.remove()
Jun 01 Python
Python爬虫防封ip的一些技巧
Aug 06 Python
python wsgiref源码解析
Feb 06 Python
解决pyshp UnicodeDecodeError的问题
Dec 06 #Python
python创建ArcGIS shape文件的实现
Dec 06 #Python
使用pyshp包进行shapefile文件修改的例子
Dec 06 #Python
利用pyshp包给shapefile文件添加字段的实例
Dec 06 #Python
详解Python在使用JSON时需要注意的编码问题
Dec 06 #Python
用python求一重积分和二重积分的例子
Dec 06 #Python
解决Numpy中sum函数求和结果维度的问题
Dec 06 #Python
You might like
PHP计算近1年的所有月份
2017/03/13 PHP
javascript IFrame 强制刷新代码
2009/07/23 Javascript
JQuery实现绚丽的横向下拉菜单
2013/12/19 Javascript
js中哈希表的几种用法总结
2014/01/28 Javascript
用C/C++来实现 Node.js 的模块(一)
2014/09/24 Javascript
浅谈js中的闭包
2015/03/16 Javascript
js控制网页前进和后退的方法
2015/06/08 Javascript
JS打字效果的动态菜单代码分享
2015/08/21 Javascript
Bootstrap每天必学之导航条(二)
2016/03/01 Javascript
JavaScript中判断数据类型的方法总结
2016/05/24 Javascript
Mac下使用charles遇到的问题以及解决办法
2017/01/10 Javascript
JS操作xml对象转换为Json对象示例
2017/03/25 Javascript
vue 监听某个div垂直滚动条下拉到底部的方法
2018/09/15 Javascript
JavaScript Blob对象原理及用法详解
2020/10/14 Javascript
如何在Vue项目中添加接口监听遮罩
2021/01/25 Vue.js
django模板语法学习之include示例详解
2017/12/17 Python
Django中Forms的使用代码解析
2018/02/10 Python
使用python获取csv文本的某行或某列数据的实例
2018/04/03 Python
朴素贝叶斯分类算法原理与Python实现与使用方法案例
2018/06/26 Python
python设置值及NaN值处理方法
2018/07/03 Python
Python Scapy随心所欲研究TCP协议栈
2018/11/20 Python
Python进程间通信Queue消息队列用法分析
2019/05/22 Python
Python的log日志功能及设置方法
2019/07/11 Python
python numpy中cumsum的用法详解
2019/10/17 Python
基于Python检测动态物体颜色过程解析
2019/12/04 Python
基于python实现坦克大战游戏
2020/10/27 Python
input file上传文件样式支持html5的浏览器解决方案
2012/11/14 HTML / CSS
印度低票价航空公司:GoAir
2017/10/11 全球购物
阿玛尼美妆加拿大官方商城:Giorgio Armani Beauty加拿大
2017/10/24 全球购物
生物制药毕业生自荐信
2013/10/16 职场文书
业务员岗位职责
2013/11/16 职场文书
剪彩仪式主持词
2014/03/19 职场文书
《少年王冕》教学反思
2014/04/11 职场文书
档案保密承诺书
2014/06/03 职场文书
《秦兵马俑》教学反思
2016/02/24 职场文书
教你怎么用python实现字符串转日期
2021/05/24 Python