Added a node based on Roger navigation_states one to move straight