Add very simple point to point navigation progoram for JAUS move_base testing