python讀寫自定義格式的pcd文件的示例代碼
lio-sam中pose是按照x y z i roll pitch yaw time 存儲的,需要用python讀取或者保存。
讀pcd
from lidar_mapping.tools import py3pcd
import numpy as np
from scipy.spatial.transform import Rotation as R
def read_transformations(filename: str):
pc = py3pcd.PointCloud.from_path(filename)
data = pc.pc_data.view(
np.dtype([
("x", np.float32),
("y", np.float32),
("z", np.float32),
("intensity", np.float32),
("roll", np.float32),
("pitch", np.float32),
("yaw", np.float32),
("time", np.float64)
])
).reshape(-1, 1)
return data寫pcd
import numpy as np
from lidar_mapping.tools import py3pcd
# 創(chuàng)建一個包含點云數(shù)據(jù)的numpy array
point_cloud = np.array([
[1.0, 2.0, 3.0, 0.5, 0.1, 0.2, 0.3, 1234567890.1],
[4.0, 5.0, 6.0, 0.6, 0.4, 0.5, 0.6, 1234567900.24]],
dtype=np.dtype([
("x", np.float32),
("y", np.float32),
("z", np.float32),
("intensity", np.float32),
("roll", np.float32),
("pitch", np.float32),
("yaw", np.float32),
("time", np.float64)
])
)
pcl_data = py3pcd.PointCloud.from_array(point_cloud)
pcl_data.save_pcd('point_cloud.pcd', compression='binary')到此這篇關(guān)于python讀寫自定義格式的pcd文件的文章就介紹到這了,更多相關(guān)python讀寫pcd文件內(nèi)容請搜索腳本之家以前的文章或繼續(xù)瀏覽下面的相關(guān)文章希望大家以后多多支持腳本之家!
相關(guān)文章
matplotlib實現(xiàn)熱成像圖colorbar和極坐標(biāo)圖的方法
今天小編就為大家分享一篇matplotlib實現(xiàn)熱成像圖colorbar和極坐標(biāo)圖的方法,具有很好的參考價值,希望對大家有所幫助。一起跟隨小編過來看看吧2018-12-12
將圖片文件嵌入到wxpython代碼中的實現(xiàn)方法
前面一篇文章中提到的那個程序,GUI中包含了一張圖片。在編譯成exe文件發(fā)布時,無法直接生成一個單獨的exe文件。因此需要直接把圖片寫入到代碼中2014-08-08
python的簡單web框架flask快速實現(xiàn)詳解
這篇文章主要為大家介紹了python的簡單web框架flask快速實現(xiàn)詳解,有需要的朋友可以借鑒參考下,希望能夠有所幫助,祝大家多多進步,早日升職加薪2023-02-02
Python NameError變量未定義異常的原因及處理方法
在Python編程的世界中,錯誤和異常是我們不可避免會遇到的朋友,其中,NameError 是初學(xué)者最容易碰到的一種異常類型之一,今天,讓我們深入探討NameError的本質(zhì),學(xué)習(xí)如何識別、理解和解決這類問題,需要的朋友可以參考下2026-06-06
python3通過udp實現(xiàn)組播數(shù)據(jù)的發(fā)送和接收操作
這篇文章主要介紹了python3通過udp實現(xiàn)組播數(shù)據(jù)的發(fā)送和接收操作,具有很好的參考價值,希望對大家有所幫助。一起跟隨小編過來看看吧2020-05-05
python實現(xiàn)數(shù)獨游戲 java簡單實現(xiàn)數(shù)獨游戲
這篇文章主要為大家詳細(xì)介紹了python實現(xiàn)數(shù)獨游戲和java實現(xiàn)數(shù)獨游戲的相關(guān)代碼,比較兩種語言實現(xiàn)數(shù)獨游戲的區(qū)別2018-03-03

