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

This reverts commit 7e6c29a47f8fe7a8f9bec02fafb79b97c8e3027c.
back to normal