Fixed bug in controller, no IR distance feedback