Debugging ardrone_control.py and ardrone_follow.py