Implementation of subsonic algorithm in pitotMach