added frequency test in pos_est_inav