[Rozwiązano] Problem z działaniem programu mierzącego odległość przy pomocy czujnika HC-SR04

Witam. Mam problem z programem napisanym w arduinio z wykorzystaniem płytki seeed xiao nrf52840, czujnika odległości HC-SR04.
Płytka ma łączyć się z telefonem przez wbudowany moduł bluetooth. Napisałem program z wykorzystaniem biblioteki arduinoble.h, na podstawie przykładów z tej biblioteki. Kiedy program jest prosty i ma wyłączać lub włączać LED po odbiorze danych wysłanych z aplikacji nie ma problemu. Tak samo ze sterowaniem silnika serwo zasilanego z osobnej przetwornicy.
Problem pojawia się gdy próbuje odczytać odległość przy użyciu wyżej wymienionego czujnika. W tym wypadku przy próbie połączenia wyskakuje informacja o zbyt długim upływie czasu. Czujnik w tym czasie działa i pokazuje poprawną odległość i wysyła ją do serial monitora.
Czy ktoś wie czemu nie mogę nawiązać połączenia, lub w jaki sposób zmodyfikować program abym mógł się połączyć z płytką.
Poniżej załączam swój program.

Nie rzucaj się tak od razu na głęboką wodę, zacznij od prostszych rzeczy jak choćby wklejenie kodu w znaczniki C++ by można go było przeczytać.
Zmierz sobie czas trwania impulsu używając millis() lub micros() z podziałem na etapy pomiaru przez switch case.
A wklejony kod wygląda tak:

Okazało się, że ta biblioteka nie lubi się zbytnio z funkcją pulsein, która działa zaporowo. Po prostu zrobiłem zliczanie czasu za pomocą micros() i wszystko działa jak należy. Dzięki za pomoc.