ECE 395 Quadcopter Code