Updated Code

Fixed robotFunctions.h for 180 servo
Updated move function for multiple encoders