Memorizar posiciones de servomotores

Hola.

Estos días estoy llevando a cabo un proyecto para clase. Se trata de un brazo que se mueve utilizando cuatro servomotores 9G. Me gustaría hacer un código que me permitiera mover el brazo mediante unos potenciómetros, almacenar la posición de los cuatro servomotores varias veces y después hacer que el brazo reproduzca ese movimiento hasta que le mande parar.

He visto y probado el siguiente código pero no me ha funcionado:
Código
(Es demasiado grande para copiarlo aquí).
Vídeo de ejemplo

El caso es que no funciona de ninguna manera, ni siquiera puedo controlar los servos mediante los potenciómetros.

Me puse a hacer un código poco a poco, pues esto que os comento es una función añadida que me gustaría incorporar al brazo. El código que tengo ahora mismo es una simple lectura de los potenciómetros, unos map para convertir su valor en grados y la escritura de ese valor en los servos. He probado con el tema de la EEPROM, pero no veo muy claro el tema de ir cambiando de byte y que lea el que quiero exactamente.

A ver si me podéis echar una mano, un saludo!

MiniRobot_1_3_EN.ino (11 KB)

Echa un vistazo a este post, a ver si te sirve de ayuda la experiencia de jopapa.

POr lo que se ve en el código, tienes un botón en el pin 6 que cumple funciones diversas si lo presionas una vez o dos veces.
Intenta probando hasta leer esto en el monitor serie

Serial.print("Record Step: "); Serial.println(arrayStep);

He encontrado una solución, mañana voy a probarlo mejor y os informo de como fue por si a alguien le interesase.

Muchas gracias por la ayuda, un saludo!