Frustrado por no poder hacer que funcionen los servos PDI-6221MG, y ya que los compré para obtener más fuerza, he pensado en poner los dos MG996R en la base del brazo (lo que sería el hombro) y en lo que sería el codo pondría dos MG90S y asi obtener el doble de fuerza para mover todo el brazo.
Suponiendo que solucionaría un problema, he probado los servos desmontados pero a la hora de añadir más servos al código que me proporciono IgnoranteAbsoluto, no me responden los servos que añado, adjunto video del problema y el montaje donde al final intercambio la conexión de un MG996R por un PDI-6221MG para que se aprecie que no funciona.