Updated the AZ Motor control a bit, potential bug discovered before the final tests.