Si lo que pretendes es que al reiniciar los motores vuelvan a su última posición te está faltando hacer justamente eso.
Te falta mover los motores a las posiciones indicadas por currentPos[ ] .
Ten presente que slowMove() no te va a funcionar para este primer movimiento porque el valor de to va a coincidir irremediablemente con currentPos[ ] y como has puesto en los comentarios del código: "Nada que hacer si ya está ahí."
Saludos