Fixed robot getting stuck