Robot Motion And Control 2009 door