New Version of Quadrotor control code, No vicon control just manual control. Gear Switch up kills the motor.