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 re正则表达式模块(Regular Expression)
Jul 16 Python
Python字符串格式化
Jun 15 Python
Python操作mysql数据库实现增删查改功能的方法
Jan 15 Python
Python函数定义及传参方式详解(4种)
Mar 18 Python
深入浅析Python中的迭代器
Jun 04 Python
python绘制评估优化算法性能的测试函数
Jun 25 Python
Python 微信爬虫完整实例【单线程与多线程】
Jul 06 Python
python子线程退出及线程退出控制的代码
Oct 16 Python
pytorch GAN伪造手写体mnist数据集方式
Jan 10 Python
Python HTMLTestRunner测试报告view按钮失效解决方案
May 25 Python
Django Session和Cookie分别实现记住用户登录状态操作
Jul 02 Python
Python中的With语句的使用及原理
Jul 29 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获取MAC地址的函数代码
2011/09/11 PHP
使用PHP curl模拟浏览器抓取网站信息
2013/10/28 PHP
php ci框架中加载css和js文件失败的原因及解决方法
2014/07/29 PHP
递归实现php数组转xml的代码分享
2015/05/14 PHP
php通过淘宝API查询IP地址归属等信息
2015/12/25 PHP
PHP正则+Snoopy抓取框架实现的抓取淘宝店信誉功能实例
2017/05/17 PHP
jQuery 处理网页内容的实现代码
2010/02/15 Javascript
分享一个asp.net pager分页控件
2012/01/04 Javascript
jquery简单实现滚动条下拉DIV固定在头部不动
2013/11/25 Javascript
Jquery节点遍历next与nextAll方法使用示例
2014/07/22 Javascript
JavaScript数组常用操作技巧汇总
2014/11/17 Javascript
Javascript的闭包详解
2014/12/26 Javascript
javascript性能优化之DOM交互操作实例分析
2015/12/12 Javascript
js获取隐藏元素宽高的实现方法
2016/05/19 Javascript
使用JavaScript获取Request中参数的值方法
2016/09/27 Javascript
使用JavaScript获取URL中的参数(两种方法)
2016/11/16 Javascript
Vue-Router实现页面正在加载特效方法示例
2017/02/12 Javascript
使用JS在浏览器中判断当前网络连接状态的几种方法
2017/05/05 Javascript
react.js 父子组件数据绑定实时通讯的示例代码
2017/09/25 Javascript
详解vue + vuex + directives实现权限按钮的思路
2017/10/24 Javascript
webpack4 升级迁移的实现
2018/09/12 Javascript
通过实践编写优雅的JavaScript代码
2019/05/30 Javascript
微信小程序实现上拉加载功能示例【加载更多数据/触底加载/点击加载更多数据】
2020/05/29 Javascript
Js on及addEventListener原理用法区别解析
2020/07/11 Javascript
微信小程序实现自定义动画弹框/提示框的方法实例
2020/11/06 Javascript
python求列表交集的方法汇总
2014/11/10 Python
利用Python中unittest实现简单的单元测试实例详解
2017/01/09 Python
python实现感知器算法(批处理)
2019/01/18 Python
python SQLAlchemy 中的Engine详解
2019/07/04 Python
生物科学专业职业规划书范文
2014/02/11 职场文书
竞选演讲稿范文大全
2014/05/12 职场文书
2014年教师节寄语
2014/08/11 职场文书
班干部竞选演讲稿(精选5篇)
2019/09/24 职场文书
读后感怎么写?书写读后感的基本技巧!
2019/12/10 职场文书
浅谈PHP7中的一些小技巧
2021/05/29 PHP