[johnyNapalm]

W przerwaniu blokujące funkcje print? Nic dziwnego, że uC cały czas siedzi w przerwaniu.
Mam też  wątpliwości co do  "Timer1.initialize(1000000); " Na pewno argument może być liczbą 32-bit?

Jak ustawiłem Timer1.initialize na 1000 to wydawało mi się że za szybko sczytywał prędkość.
Czy ustawienie go na 1000 rozwiąże w jakimś stopniu problem?

To jak w inny sposób mógłbym pomierzyć prędkość oraz co sekundę wgrać rzucane informacje na plik? 
Oczywiście nie proszę o gotowe rozwiązanie ale chociaż o jakąś poradę jaką funkcję powinienem użyć.