Go home and follow route now working
Main program updated to reflect test