Problemas ¿Largo de Programa?

Muchas Gracias,
Voy a subir el Zip y tomaré el concejo de los comentarios.

Auque logre seguir adelante, cambiándome a otra función
quedé intrigado porqué con dos Serial.Print se muere el programa. Inicialmente me había pasado algo similar, pero pensé que era mi inexperiencia y que en alguna parte había quedado en un loop infinito. Luego de eso me puse más serio y lo hice bien ordenadito: un skecth para el mini SO, un Skecth para la funciones auxiliares y asi...
... Y bueno apareció el problema: No me es razonable que por repetir la función muchas veces se cuelgue, llegue a pensar que se "atora" el puerto con la avalancha de caracteres... pero tampoco me convenzo.

Nota: efectivamante Test_PI_Com_02.ino es el principal
Igual les dejo la inquietud, por si alguien descubre el misterio

Saludos José Miguel.
Nota: Ahora voy por el giroscopio (como varios por aqui) con el fin de hacer un navegador para un avión RC.
voy pasito a pasito:

  • mini SO y COM OK
  • PID OK
  • Gyro en proceso

próximo pasos

  • Gyro + PID + Servo
  • Prueba de vuelo nivelado sin RC