Changed to new controller with speed. Bit buggy, should work on better version