Skip to content

严恭敏老师 捷联惯导算法与组合导航原理 上的matlab仿真程序

License

Notifications You must be signed in to change notification settings

ZhangZh3ng/inertial_navigation_basic

Folders and files

NameName
Last commit message
Last commit date

Latest commit

 

History

9 Commits
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 

Repository files navigation

Inertial navigation basic

这个仓库的主要内容是基本惯导解算程序。包含严恭敏老师 捷联惯导算法与组合导航原理 上的matlab示例程序,以及我自己写的姿态解算和对准等程序


#1. 遵循“先解释,后执行”的原则,注释总是写在对应程序的前面(或上方)。

#2. 注意:在matlab程序中表示同时具有上标和下标的变量时

​ 书上的程序案例按照“上标在前,下标在后”的原则,

​ 我们实验室习惯上按照 “下标在前,上标在后”的原则。

因此,书中对于 "从b系到n系的过渡矩阵" Cbn 的写法为Cnb。出于习惯原因我选择后者,因此程序中这些变量的名称与书中有差异,这种差异存在最初几个版本之中。

#3. 总是按照如下规则来表示位置、速度变量:

​ pos : [纬度, 经度, 高度] 单位为rad, rad, m

​ vn : [vE, vN, vU] 单位为m/s

另外,若无特殊说明,表示角度变量的单位总是rad,其他物理量的单位总是相应的国际单位。

#4. 以**_ref**结尾的量,注释中称其为“参考值”,“标准值”。二者均表示“真实”、“没有误差”之意。其中,本人更愿把实测数据中的高精度参考称为“参考值”,把仿真程序生成的绝对准确的结果称为“标准值”或“真实值”。不过,真的写到程序里时也没区分那么细。

#5.

#6. 除非变量名k不得不另作它用,则脚标均用小写k表示; k_init 特指初值数据或计算中第一个时刻数据的编号

#7. 变量名 imuError特指惯性器件误差。如需设置多种imu误差,应记为imuError_1,imuError_phins...

#8. 从程序的准确性和可读性角度来看,在计算/定义/赋值时,加上相应的单位都是值得的。但考虑到大多数变量的单位都是国际单位,出于简洁性考虑,在不引起歧义的前提下,省略国际单位


一些缩写的含义: ref: reference msr: measurement stg: storage err: error prev: previous opt: optimal crt: current init: initial num: number calc: calculate Lp: loop of .. idx: index simData: simulation data fig: figure info: information ts: time of step

导航专用缩写:

avp: attitude velocity attitude pos: positon att: attitude vn: ground velocity acc: accelerometer gyr: gyroscope ang: angle imu.fb: specific force in b frame imu.wb: angular velocity in b frame imu.tb: angular increment imu.vb: velocity increment navinfo: navigation information


更新时间:2020年12月5日

About

严恭敏老师 捷联惯导算法与组合导航原理 上的matlab仿真程序

Resources

License

Stars

Watchers

Forks

Releases

No releases published

Packages

No packages published

Languages