Update ServoObject.cpp