Updated driving code for new motors