for i in np.arange(len(radar_lines)): radar_line=radar_lines[i] pcd_line=pcd_lines[i] pcd_obj = Object3d(pcd_line) center = np.array(pcd_obj.t) center[2] = center[2]+pcd_obj.h # ry=obj.ry heading_angle = -pcd_obj.ry - np.pi / 2 R = rotz((heading_angle)) # only boundingbox range = (pcd_obj.l, pcd_obj.w, pcd_obj.h) # all vertical range = (pcd_obj.l, pcd_obj.w, 10) # print(center,obj.ry,range) bbx = o3d.geometry.OrientedBoundingBox(center, R, range) cropped_cloud = pcd.crop(bbx) # if set colors # colors = [[0, 255, 0] for i in np.arange(len(cropped_cloud.points))] # cropped_cloud.colors = o3d.utility.Vector3dVector(colors) o3d.visualization.draw_geometries([cropped_cloud, bbx]) print(pcd_obj.h) radar_obj = Object2d(radar_line) center = [radar_obj.box2d[0], radar_obj.box2d[1]] w = radar_obj.box2d[2] h = radar_obj.box2d[3] angle = radar_obj.angle # rect = cv2.minAreaRect(cnt) box = cv2.boxPoints((center, (w, h), angle)) print(box) box = np.int0(box) cv2.drawContours(im, [box], 0, (0, 0, 255), 2) mask = np.zeros_like(im) # 使用旋转框的角点绘制多边形掩膜 cv2.drawContours(mask, [box], 0, (255, 255, 255), -1) # 使用掩膜提取旋转框内的像素 masked_image = cv2.bitwise_and(im, mask) cv2.imshow("2d bbx", masked_image) cv2.waitKey(0) cv2.destroyAllWindows()