Finished the first version of the code. It flew and worked okay. But after a while of the drone and it was heading towards water. So I had to perform an emergency landing. The drone was not happy with this landing and I broke one of the beams. The drone has since been repaired but I have to work a bit more on the code. Problems is mostly with the AR.Drone documentation which is horrible at best. Code is now on github