Relevant Code for CMU Quadrotor Project