python 畫3維軌跡圖并進行比較的實例
更新時間：2019年12月06日 16:59:46 作者：pj_find
今天小編就為大家分享一篇python 畫3維軌跡圖并進行比較的實例，具有很好的參考價值，希望對大家有所幫助。一起跟隨小編過來看看吧
一. 數(shù)據(jù)的格式
首先我們需要x,y,z三個數(shù)據(jù)進行畫圖。從本實驗用到的數(shù)據(jù)集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個數(shù)據(jù)，相當于T={R，t}，R是3×3的矩陣，t是3×1的矩陣。我們需要的是t的數(shù)據(jù)。
有些groundtruth是8個數(shù)據(jù)，第一個是時間戳，在三個是x,y,z，后面四個是是四元數(shù)的數(shù)據(jù)。
代碼如下：
# 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維軌跡圖并進行比較的實例就是小編分享給大家的全部內(nèi)容了，希望能給大家一個參考，也希望大家多多支持腳本之家。
相關(guān)文章
python安裝CLIP包出現(xiàn)錯誤:安裝.git報錯問題及解決
這篇文章主要介紹了python安裝CLIP包出現(xiàn)錯誤:安裝.git報錯問題及解決,具有很好的參考價值,希望對大家有所幫助,如有錯誤或未考慮完全的地方,望不吝賜教2024-06-06
python在一個范圍內(nèi)取隨機數(shù)的簡單實例
在本篇內(nèi)容里小編給大家分享了關(guān)于python在一個范圍內(nèi)取隨機數(shù)的簡單實例內(nèi)容，有需要的朋友們可以學(xué)習(xí)下。2020-08-08
在本篇文章里小編給大家整理的是一篇關(guān)于python爬蟲請求頭如何設(shè)置內(nèi)容，需要的朋友們可以學(xué)習(xí)下。2020-07-07
Python中的bytearray是一個可變序列，通常用于存儲二進制數(shù)據(jù),它允許在不創(chuàng)建新的對象的情況下就地修改數(shù)據(jù)，非常適用于處理字節(jié)數(shù)據(jù),本文將深入學(xué)習(xí)bytearray對象的使用，包括創(chuàng)建、修改、切片和常見應(yīng)用場景2023-12-12
這篇文章將詳細講解如何使用OpenCV繪制各類幾何圖形，包括cv2.line()、v2.circle()、cv2.rectangle()、cv2.ellipse()、cv2.polylines()、cv2.putText()函數(shù)。需要的可以參考一下2022-01-01
Python?中設(shè)置請求的最大重試次數(shù)示例代碼
本篇文章介紹了為什么我們會收到錯誤消息，指出超出了最大重試次數(shù)，以及我們?nèi)绾卧?Python?中為請求設(shè)置?max_retries，本文通過示例代碼給大家介紹的非常詳細，需要的朋友參考下吧2023-06-06
今天小編就為大家分享一篇解決Pandas的DataFrame輸出截斷和省略的問題，具有很好的參考價值，希望對大家有所幫助。一起跟隨小編過來看看吧2019-02-02
Python中動態(tài)創(chuàng)建類實例的方法
在Java中我們可以通過反射來根據(jù)類名創(chuàng)建類實例,那么在Python我們怎么實現(xiàn)類似功能呢？其實在Python有一個builtin函數(shù)import，我們可以使用這個函數(shù)來在運行時動態(tài)加載一些模塊2017-03-03
這篇文章主要介紹了Python 處理文件的幾種方式，文中通過示例代碼介紹的非常詳細，對大家的學(xué)習(xí)或者工作具有一定的參考學(xué)習(xí)價值，需要的朋友們下面隨著小編來一起學(xué)習(xí)學(xué)習(xí)吧2021-08-08
python?PyAutoGUI實現(xiàn)自動化鼠標鍵盤等常用操作
這篇文章主要介紹了python?PyAutoGUI實現(xiàn)自動化鼠標鍵盤等常用操作使用實例，有需要的朋友可以借鑒參考下，希望能夠有所幫助，祝大家多多進步，早日升職加薪2023-12-12