Pequeño refactoring y test

Hola,
os hago un pull request por si queréis integrar algunas modificaciones que he hecho en mi fork a partir de vuestro código.

En general son pequeños cambios de refactoring. Tampoco mucha cosa, porque vuestro código en general está bastante acabado.
He añadido también un modo de test (se activa con un #define) que comprueba que los sensores funcionan. Es un poco rudimentario, pero creo que puede ser útil para comprobar el estado de la SCK rápidamente.

Hasta pronto,
Miguel