Update slowservo.c