Test program for first challenge using the DifferentialPilot