编程语言
首页 > 编程语言> > python 使用open3d 显示pcd点云

python 使用open3d 显示pcd点云

作者:互联网

需求

代码

#! /usr/bin/env python
# -*- coding: utf-8 -*-#
# -------------------------------------------------------------------------------
# Name:         Open3dShowPcd
# Author:       yunhgu
# Date:         2021/12/22 9:07
# Description: 
# -------------------------------------------------------------------------------
from pathlib import Path

import numpy as np
import open3d as o3d
from traceback import format_exc


class PtVis:
    def __init__(self, name='空格进入下一帧 Z退回上一帧', width=1024, height=768, pcd_files_path=""):
        self.pcd_files_path = pcd_files_path
        self.pcd_files_list = []
        self.index = 0
        self.pcd = None
        self.vis = None
        self.init_pcd_files_list()
        self.init_open3d(name, width, height)

    def init_open3d(self, name, width, height):
        self.vis = o3d.visualization.VisualizerWithKeyCallback()
        self.vis.create_window(window_name=name, width=width, height=height)
        opt = self.vis.get_render_option()
        opt.background_color = np.asarray([0, 0, 0])
        opt.point_size = 2
        self.vis.register_key_callback(90, lambda temp: self.last())
        self.vis.register_key_callback(32, lambda temp: self.next())

    def show_pcd(self):
        # 初始化显示pcd第一帧
        self.pcd = o3d.io.read_point_cloud(self.pcd_files_list[self.index])
        self.vis.add_geometry(self.pcd)
        self.vis.run()

    def next(self):
        if 0 <= self.index < len(self.pcd_files_list) - 1:
            self.index += 1
        self.update(self.index)

    def last(self):
        if 0 < self.index <= len(self.pcd_files_list) - 1:
            self.index -= 1
        self.update(self.index)

    def init_pcd_files_list(self):
        for file in Path(self.pcd_files_path).rglob("*.pcd"):
            self.pcd_files_list.append(str(file))
        self.pcd_files_list = sorted(self.pcd_files_list, key=lambda p: int(Path(p).stem))

    def update(self, index):
        pcd = o3d.io.read_point_cloud(self.pcd_files_list[index])
        self.vis.clear_geometries()  # 清空vis点云
        self.vis.add_geometry(pcd)  # 增加vis中的点云
        self.vis.poll_events()
        self.vis.update_renderer()

    def close(self):
        self.vis.destroy_window()


if __name__ == '__main__':
    pt = None
    try:
        pcd_file_path = input("请输入要展示的pcd文件夹:").strip("\"")
        pt = PtVis(pcd_files_path=pcd_file_path)
        print(f"{pcd_file_path}共有PCD个数:{len(pt.pcd_files_list)}")
        pt.show_pcd()
    except Exception as e:
        print(f"运行出错请联系开发人员:{format_exc}{e}")
    finally:
        pt.close()

展示示例

image

标签:files,name,python,self,height,vis,open3d,点云,pcd
来源: https://www.cnblogs.com/yunhgu/p/15740431.html