一段关于GPS的算法，有用请参考，可根据需要自己修改。