使用open3D将4x4矩阵显示出来

可以使用Open3D中的create_mesh_coordinate_frame函数将4x4矩阵作为位姿矩阵，显示为3D坐标系。

以下是一个示例代码：

import open3d as o3d
import numpy as np

# 定义4x4矩阵
mat = np.eye(4)

# 将矩阵转换为Open3D的PoseGraph格式
pose_graph = o3d.registration.PoseGraph()
pose_graph.nodes.append(o3d.registration.PoseGraphNode(mat))

# 创建坐标系网格模型
coord_frame = o3d.geometry.TriangleMesh.create_coordinate_frame(size=0.5, origin=[0, 0, 0])
coord_frame_pose = pose_graph.nodes[0].pose
coord_frame.transform(coord_frame_pose)

# 显示坐标系
o3d.visualization.draw_geometries([coord_frame])

在这个示例代码中，我们首先定义了一个4x4单位矩阵，然后将其转换成Open3D的PoseGraph格式。接下来，我们使用`create_coordinate_frame`函数创建了一个3D坐标系的网格模型，并使用该位姿矩阵将其变换到正确的位置。最后，我们使用`draw_geometries`函数将坐标系显示出来。

您可以根据需要修改矩阵的值，来显示不同的位姿。