added tests for altitude and drive forward