open3D读取带有 强度/时间戳等其他属性的pcd文件(附代码)

背景

示例代码

numpy库编写脚本读取pcd数据

open3d读取pcd文件(只能获取pcd.points即xyz数据)

open3d读取文件(所有属性x,y,z,intensity,timestamp,ring)


背景

在自动驾驶行业领域中,处理点云文件是最为平常不过了。之前使用open3D读取pcd文件,默认只能获取pcd文件中的points信息,即x,y,z坐标,对于其他属性,比如强度intensity,时间戳timestamp,ring等信息,却没有办法获取。尝试过通过自定义编写代码以numpy方式实现,但发现读取的数据量有缺失,为此发现了新的方法,可以读取pcd中所有属性数据。本文为自己在项目中实践获得,在此做记录,以帮助到遇到同样问题的小伙伴。

示例代码

numpy库编写脚本读取pcd数据

# 假设pcd_file内容格式为FIELD x y z intensity timestamp ring
# width 218537
# height 1
 
with open(pcd_file, 'rb') as f:
     data = f.read()
     data0 = data[data.find(b"DATA binary") + 12:]
     points = np.frombuffer(data0, dtype=np.float32).reshape(-1, 6)# 这里写的6 表示获取6维数据,分别为x,y,z,intensity,timestamp,ring
     o = np.zeros((len(points), 1))
     points = np.hstack((points, o))
     points = points.astype(np.float32)

pypcd类型点云数据

x,y,z = pcd.pc_data['x'],pcd.pc_data['y'],pcd.pc_data['z']
x,y,z = np.reshape(x, (-1, 1)),np.reshape(y, (-1, 1)),np.reshape(z, (-1, 1))
points = np.hstack((x, y, z)) # 转为<np.ndarray>

open3d读取pcd文件(只能获取pcd.points即xyz数据)

import open3d as o3d
def read_pcd(pcd_file_path):  
    pcd = o3d.io.read_point_cloud(pcd_file_path) # <o3d.geometry.PointCloud>
    points = pcd.points # 只能访问到x y z数据
    points_array = np.asarray(points) # 转为<np.ndarray>
    print(f'points_array: {points_array}, len: {len(points_array)}')

★open3d读取文件(所有属性x,y,z,intensity,timestamp,ring)

import open3d as o3d
def read_pcd(pcd_file_path):  
    xyz = o3d.t.io.read_point_cloud(pcd_file_path).point["positions"].numpy()#x y z
    intensity = o3d.t.io.read_point_cloud(pcd_file_path).point["intensity"].numpy() # intensity
    timestamp = o3d.t.io.read_point_cloud(pcd_file_path).point["timestamp"].numpy() # timestamp
    ring = o3d.t.io.read_point_cloud(pcd_file_path).point["ring"].numpy() #ring
    
    points_array = np.hstack((xyz,intensity,timestamp,ring)) # 转为<np.ndarray> ,将所有数据拼接起来,得到(218537,6)维度的数据
    print(f'points_array: {points_array}, len: {len(points_array)}')

LVX是Livox激光雷达的点云数据格式,可以使用Livox官方提供的lvx文件解析SDK进行解析。下面是一个示例代码,可以读取lvx格式点云文件并保存为pcd格式: ```c++ #include <iostream> #include <vector> #include <string> #include <pcl/io/pcd_io.h> #include <pcl/point_types.h> #include "livox_sdk.h" using namespace std; // 回调函数,处理点云数据 void LidarDataHandler(uint8_t handle, LivoxRawPoint *data, uint32_t data_num, void *client_data) { pcl::PointCloud<pcl::PointXYZI>::Ptr cloud(new pcl::PointCloud<pcl::PointXYZI>); for (int i = 0; i < data_num; ++i) { pcl::PointXYZI p; p.x = data[i].x; p.y = data[i].y; p.z = data[i].z; p.intensity = data[i].reflectivity; cloud->push_back(p); } // 保存为pcd格式 pcl::io::savePCDFileASCII(static_cast<char*>(client_data), *cloud); } int main(int argc, char** argv) { if (argc < 3) { std::cerr << "Usage: " << argv[0] << " input_file.lvx output_dir" << std::endl; return 1; } std::string input_file = argv[1]; std::string output_dir = argv[2]; // 初始化SDK if (!Init()) { std::cerr << "Failed to initialize Livox SDK." << std::endl; return 1; } // 打开lvx文件 if (!OpenLvxFile(input_file.c_str())) { std::cerr << "Failed to open lvx file: " << input_file << std::endl; return 1; } // 设置回调函数 SetDataCallback(LidarDataHandler); // 读取点云数据 LivoxEthPacket packet; while (GetLvxFilePacket(&packet)) { HandleEthPacket(&packet); } // 关闭lvx文件 CloseLvxFile(); // 反初始化SDK Uninit(); return 0; } ``` 在命令行中运行该程序,需要指定输入文件和输出目录,例如: ``` ./read_lvx_and_save_pcd input.lvx output_dir/ ``` 其中,`input.lvx`为输入的lvx文件,`output_dir/`为输出的pcd文件目录。程序会将lvx文件中的所有点云数据保存为多个pcd文件文件名为时间戳
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值