added parking lot tests for basic waypoint nav.
updated waypoint tests