Started writing SecondOrderPilot