Вместо моей инициализации UART_init() надо вписать твою инициализацию порта
Serial.begin(115200);

Из цикла видимо не выходит потому, что CalcedWaveLength==0