Fix drive problem, can now adjust speed