个人导航系统四子样算法,仿真程序源代码,捷联惯导