(depth, u_u0, v_v0, f, invalid_value=0)
| 21 | return u_u0, v_v0 |
| 22 | |
| 23 | def depth_to_pcd(depth, u_u0, v_v0, f, invalid_value=0): |
| 24 | mask_invalid = depth <= invalid_value |
| 25 | depth[mask_invalid] = 0.0 |
| 26 | x = u_u0 / f * depth |
| 27 | y = v_v0 / f * depth |
| 28 | z = depth |
| 29 | pcd = np.stack([x, y, z], axis=2) |
| 30 | return pcd, ~mask_invalid |
| 31 | |
| 32 | def pcd_to_sparsetensor(pcd, mask_valid, voxel_size=0.01, num_points=100000): |
| 33 | pcd_valid = pcd[mask_valid] |
no outgoing calls
no test coverage detected