Normalization helper function.
(x)
| 191 | return m |
| 192 | |
| 193 | def normalize(x): |
| 194 | """Normalization helper function.""" |
| 195 | return x / np.linalg.norm(x) |
| 196 | |
| 197 | def pad_poses(p): |
| 198 | """Pad [..., 3, 4] pose matrices with a homogeneous bottom row [0,0,0,1].""" |