Added multi_pi function to the quadrotor class. Added the ability to take off and hover to the quadrotor.