Dann mach doch erstmal Tests mit deiner VarSpeedServo.h und dem LinearServo allein. Wenn das geht, mit einem zusätzlichen "Standardservo" und bei Bedarf mit mehr Servos.
Macht es einen Unterschied, wenn die Servos sich gleichzeitig oder nacheinander bewegen?
Der kleinstmögliche Test der den Fehler zeigt, ist immer der beste.
Und die Tests natürlich mit den Servos auf dem Tisch, oder wie sollen wir die Mechanik deines 3D-Drucks bewerten?
Wenn dir jemand helfen soll, wäre ein Link auf die verwendete Bibliothek nicht verkehrt.
Diese oder eine Version von github ?