Added navigation_test for moving to fixed points in room