Debugged ardrone_control and added LED animation