Added in adjustments to the motion system as well as a temporary test to check it works