[ardrone2] Sonar implementation