Buenas, te comento que he probado tu sketch en un arduino UNO con dos servos 9g y funcionaron correctamente, inclusive le agregué unas lineas mas para que cargue otros ángulos y funciono correctamente en todos los casos. Saludos