Update navigation.cc

added test stuff