quick uggly change to swap toponav_map frame for odom frame. For some tests only. Will revert in next commit