(pose)
| 18 | from dufomap import dufomap |
| 19 | from dufomap.utils import pcdpy3 |
| 20 | def inv_pose_matrix(pose): |
| 21 | inv_pose = np.eye(4) |
| 22 | inv_pose[:3, :3] = pose[:3, :3].T |
| 23 | inv_pose[:3, 3] = -pose[:3, :3].T.dot(pose[:3, 3]) |
| 24 | return inv_pose |
| 25 | |
| 26 | MIN_AXIS_RANGE = 0.2 # HARD CODED: remove ego vehicle points |
| 27 | MAX_AXIS_RANGE = 50 # HARD CODED: remove far away points |
nothing calls this directly
no outgoing calls
no test coverage detected