Code for autonomous quadrucopter flying-spaghetti-pi FSP