Adding blocking smooth move to servo;