Fixed speed bug for wall avoidance