fixed bug with GPS/INS mode(Forget to change constant m_poseSource)