bbx_ls = [] for line in lines: obj = Object3d(line) center = np.array(obj.t) center[2]=center[2]+obj.h # ry=obj.ry heading_angle =-obj.ry - np.pi / 2 R = rotz((heading_angle)) # only boundingbox range = (obj.l, obj.w, obj.h) # all vertical range = (obj.l, obj.w, 10) # print(center,obj.ry,range) bbx = o3d.geometry.OrientedBoundingBox(center, R, range) bbx_ls.append(bbx) # o3d.visualization.draw_geometries([pcd, origin] + bbx_ls) for box in bbx_ls: cropped_cloud = pcd.crop(box) # if set colors # colors = [[0, 255, 0] for i in np.arange(len(cropped_cloud.points))] # cropped_cloud.colors = o3d.utility.Vector3dVector(colors) points = np.array(cropped_cloud.points) print(points.shape) o3d.visualization.draw_geometries([cropped_cloud,box])根据上述截取的部分代码,加代码,提取出目标区域点云数据的x,y,z坐标,不管x和y坐标,只要z坐标,将点汇聚到z轴上,画出直方图,统计高度,每隔0.1米进行划分,横坐标为高度,纵坐标为点的数量。
时间: 2024-01-03 15:03:50 浏览: 151
bbx_data.rar_java mail_javamail_mail_实用 java
可以按照以下方式补充代码:
```
# 声明一个列表,存储所有点的z坐标
z_list = []
for box in bbx_ls:
cropped_cloud = pcd.crop(box)
points = np.array(cropped_cloud.points)
# 将所有点的z坐标加入列表
z_list.extend(points[:, 2])
# 统计直方图
hist, bin_edges = np.histogram(z_list, bins=np.arange(0, max(z_list) + 0.1, 0.1))
# 画出直方图
plt.bar(bin_edges[:-1], hist, width=0.1)
plt.xlabel("Height (m)")
plt.ylabel("Number of points")
plt.show()
```
这段代码会将所有目标区域点云数据中的点的z坐标加入一个列表中,然后使用 `numpy` 库的 `histogram` 函数统计直方图,步长为0.1米,最大高度为所有点中的最大z坐标。最后使用 `matplotlib` 库画出直方图。
阅读全文