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 23 Python
Python内置函数bin() oct()等实现进制转换
Dec 30 Python
Linux 发邮件磁盘空间监控(python)
Apr 23 Python
python模块之re正则表达式详解
Feb 03 Python
Python使用文件锁实现进程间同步功能【基于fcntl模块】
Oct 16 Python
python 2.7.14安装图文教程
Apr 08 Python
Python爬虫PyQuery库基本用法入门教程
Aug 04 Python
Python 3.6 中使用pdfminer解析pdf文件的实现
Sep 25 Python
Python完全识别验证码自动登录实例详解
Nov 24 Python
python取均匀不重复的随机数方式
Nov 27 Python
使用Python判断一个文件是否被占用的方法教程
Dec 16 Python
python爬取抖音视频的实例分析
Jan 19 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时间戳格式化显示友好的时间函数分享
2014/10/21 PHP
php函数与传递参数实例分析
2014/11/15 PHP
PHP中用mysqli面向对象打开连接关闭mysql数据库的方法
2016/11/05 PHP
jQuery结合HTML5制作的爱心树表白动画
2015/02/01 Javascript
jQuery寻找n以内完全数的方法
2015/06/24 Javascript
js实现选中页面文字将其分享到新浪微博
2015/11/05 Javascript
JavaScript 数组的深度复制解析
2016/11/02 Javascript
jQuery学习笔记——jqGrid的使用记录(实现分页、搜索功能)
2016/11/09 Javascript
String字符串截取的四种方式总结
2016/11/28 Javascript
在javaScript中检测数据类型的几种方式小结
2017/03/04 Javascript
详解Vue中watch的高级用法
2018/05/02 Javascript
JS实现的A*寻路算法详解
2018/12/14 Javascript
详解关于webpack多入口热加载很慢的原因
2019/04/24 Javascript
微信小程序按钮点击跳转页面详解
2019/05/06 Javascript
我要点爆”微信小程序云开发之项目建立与我的页面功能实现
2019/05/26 Javascript
python抓取网页中的图片示例
2014/02/28 Python
python单例模式实例分析
2015/04/08 Python
Python合并字典键值并去除重复元素的实例
2016/12/18 Python
python编写分类决策树的代码
2017/12/21 Python
python3.5 tkinter实现页面跳转
2018/01/30 Python
Python决策树和随机森林算法实例详解
2018/01/30 Python
用python实现对比两张图片的不同
2018/02/05 Python
浅析Python数据处理
2018/05/02 Python
深入了解python中元类的相关知识
2019/08/29 Python
使用virtualenv创建Python环境及PyQT5环境配置的方法
2019/09/10 Python
基于TensorFlow中自定义梯度的2种方式
2020/02/04 Python
Django User 模块之 AbstractUser 扩展详解
2020/03/11 Python
Proenza Schouler官方网站:纽约女装和配饰品牌
2019/01/03 全球购物
小学生开学第一课活动方案
2014/03/27 职场文书
民族精神月活动总结
2014/08/28 职场文书
活动总结结尾怎么写
2014/08/30 职场文书
大学生个人总结范文
2015/02/15 职场文书
建党伟业观后感
2015/06/01 职场文书
文艺有韵味的诗句(生命类、亲情类...)
2019/07/11 职场文书
JavaScript 原型与原型链详情
2021/11/02 Javascript
Vue Element plus使用方法梳理
2022/12/24 Vue.js