Add navigation driver tests

Added navigation driver tests