python讀寫自定義格式的pcd文件的示例代碼
lio-sam中pose是按照x y z i roll pitch yaw time 存儲(chǔ)的,需要用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)建一個(gè)包含點(diǎn)云數(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)容請(qǐng)搜索腳本之家以前的文章或繼續(xù)瀏覽下面的相關(guān)文章希望大家以后多多支持腳本之家!
相關(guān)文章
matplotlib實(shí)現(xiàn)熱成像圖colorbar和極坐標(biāo)圖的方法
今天小編就為大家分享一篇matplotlib實(shí)現(xiàn)熱成像圖colorbar和極坐標(biāo)圖的方法,具有很好的參考價(jià)值,希望對(duì)大家有所幫助。一起跟隨小編過(guò)來(lái)看看吧2018-12-12
將圖片文件嵌入到wxpython代碼中的實(shí)現(xiàn)方法
前面一篇文章中提到的那個(gè)程序,GUI中包含了一張圖片。在編譯成exe文件發(fā)布時(shí),無(wú)法直接生成一個(gè)單獨(dú)的exe文件。因此需要直接把圖片寫入到代碼中2014-08-08
python的簡(jiǎn)單web框架flask快速實(shí)現(xiàn)詳解
這篇文章主要為大家介紹了python的簡(jiǎn)單web框架flask快速實(shí)現(xiàn)詳解,有需要的朋友可以借鑒參考下,希望能夠有所幫助,祝大家多多進(jìn)步,早日升職加薪2023-02-02
Python NameError變量未定義異常的原因及處理方法
在Python編程的世界中,錯(cuò)誤和異常是我們不可避免會(huì)遇到的朋友,其中,NameError 是初學(xué)者最容易碰到的一種異常類型之一,今天,讓我們深入探討NameError的本質(zhì),學(xué)習(xí)如何識(shí)別、理解和解決這類問(wèn)題,需要的朋友可以參考下2026-06-06
Python模擬實(shí)現(xiàn)全功能貸款計(jì)算器
在個(gè)人理財(cái)中,貸款計(jì)算器是一款非常實(shí)用的工具,本文將教你如何使用Python編寫一個(gè)全功能的貸款計(jì)算器,感興趣的小伙伴可以跟隨小編一起學(xué)習(xí)一下2023-12-12
python3通過(guò)udp實(shí)現(xiàn)組播數(shù)據(jù)的發(fā)送和接收操作
這篇文章主要介紹了python3通過(guò)udp實(shí)現(xiàn)組播數(shù)據(jù)的發(fā)送和接收操作,具有很好的參考價(jià)值,希望對(duì)大家有所幫助。一起跟隨小編過(guò)來(lái)看看吧2020-05-05
python實(shí)現(xiàn)數(shù)獨(dú)游戲 java簡(jiǎn)單實(shí)現(xiàn)數(shù)獨(dú)游戲
這篇文章主要為大家詳細(xì)介紹了python實(shí)現(xiàn)數(shù)獨(dú)游戲和java實(shí)現(xiàn)數(shù)獨(dú)游戲的相關(guān)代碼,比較兩種語(yǔ)言實(shí)現(xiàn)數(shù)獨(dú)游戲的區(qū)別2018-03-03

