Algorithm and complete arduino script for use on an Arduino Based Quadcopter. (Made for a science fair in grade 10)