HFR calculation more stable now and works OK under simulation, need to test it today under real conditions