Testing functions added, as well as a new motorcontrol function