Added main function (NAVIGATE.cpp), Testing to come.