Turning the motors around, adding pen lift servo control