最新国产好看的视频,伊人天堂AV在线,国产Aaaaaa视频,蜜臀视频在线观看一区,人妻av色图,密臀久久久精品影片,青青视频免费观看毛片,久草在线观看视,国产三级精品色情在线

python讀寫自定義格式的pcd文件的示例代碼

 更新時(shí)間:2023年07月06日 10:48:27   作者:heroacool  
這篇文章主要介紹了python讀寫自定義格式的pcd文件,本文通過(guò)實(shí)例代碼給大家介紹的非常詳細(xì),對(duì)大家的學(xué)習(xí)或工作具有一定的參考借鑒價(jià)值,需要的朋友可以參考下

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)文章

最新評(píng)論

清水县| 灯塔市| 左云县| 涞源县| 田阳县| 永川市| 合水县| 陕西省| 永川市| 睢宁县| 大连市| 铜梁县| 汪清县| 府谷县| 平和县| 赤壁市| 察雅县| 盘锦市| 辉县市| 突泉县| 光泽县| 松桃| 高邮市| 恩施市| 临朐县| 调兵山市| 团风县| 乐安县| 剑河县| 祁门县| 吉水县| 勐海县| 商丘市| 永嘉县| 固阳县| 寿宁县| 思南县| 洞口县| 漠河县| 福海县| 宁明县|