Replacement of the library MsTimer2 by Servo