Robot Motion and Control 2011 (Lecture Notes in