Oh joy! Finally finished that algorithm. Quite the learning experience! It's the final addition for Drone 1.0.