Fixed robot stupid behavior when dragged on wall