Add a range measurement as prior

[ChengyaoLi]

Use measured transform from imu to gps as a prior in the map builder