planeslam.geometry.util uitl.py does not have quat_to_rot_mat function
planeslam.geometry.util uitl.py does not have quat_to_rot_mat function