A Robust Algorithm for Measurement on MSK Signal