Finished coding the remaining Start and Test functions, calibration
functions still need to be coded
Built motor compensation function