Added lap timing to task 1 code

[mgupta27]

Added lap timing to task 1 code

Key Changes

• Added logic to time how long the drone takes to fly one lap
• When the lap time is calculated, the drone calculates if it has time to run another lap
• Added logging for when the drone starts a lap, and when the drone finishes a lap

Testing

• I tested it on the simulator
  • Tested the case where the drone can't fly another lap and forces RTL
  • Tested the case where the drone flies the maximum number of laps

[Trotyl15]

LGTM!