平台式惯导系统

12
3.8*总结: 修正回路工作过程
加速度计 输出
有害加速度 补偿
一次 积分
M2
计算地理坐标系相对 惯性空间的旋转角速度
AX
陀螺力矩器
GZ
YP
GX
平台转动 力矩电机
陀螺进动
M3 XP
GY AY
VN
dt
ANB
VN0
1
VN R
dt
(t )
0
CE 1
M1
Lecture 6 -- Basic types of INS
6
3.2 平台稳定回路
当惯导平台跟踪当地地理坐标系时需要有稳定回路和修正回路
M2
AX
GZ
YP
GX
M3 XP
GY AY
稳定回路的机制：
当平台绕外框架轴旋转 (由于 干扰影响) 陀螺仪 Gy 进动并有输出
Gy 的输出被送到电机 M2 M2 驱动平台转回原来位置
M1
outer ring outer ring axis
Platform Inertial Navigation System
平台式惯导系统
Lecture 6 -- Basic types of INS
1
Outline
惯导系统的分类 基于当地地理坐标系的INS -- 稳定与修正 基于惯性坐标系的INS – 重力补偿 框架系统
Lecture 6 -- Basic types of INS
ZP
XP
ZP
A
XP
B
Lecture 6 -- Basic types of INS
15
4.2 基于惯性系的导航: 缺点
缺点
对于地球表面的导航：
为了获取载体相对地球的位 置和速度，需要进行变换
ZP
XP
ZP
A
XP
B
重力加速度 g 相对平台的方向在不断改变，因此沿着三个加 速度计敏感轴方向的 g 的分量也不断在变，必须实时计算.
2
1.0 惯导系统的任务
platform
a x X Acc. a x V x
Sx
ay
ay
Vy
Y Acc.
Sy
vehicle
导航过程中, 平台必须模拟坐标系 XY, 这是借助 于陀螺仪实现的.
所有惯导系统都需要解决的两个问题：
利用陀螺仪建立信号测量基准.
对加速度计的输出进行积分，获取速度和位置.
11
3.7 方位修正回路
M2
AX
GZ
YP
C
AEB
e
sin
C
tan/ R
VREtges
in
0
1
VE dt
V E R cos
dt (t)
GX
VE0
M3 XP
GY AY
VN dt
ANB
VN0
1
VN R
dt
(t )
0
CE 1
M1
Lecture 6 -- Basic types of INS
Lecture 6 -- Basic types of INS
7
3.3 坐标变换器
M2
当载体旋转
M1
AX
GZ
YP
GX
M3 XP
GY AY
outer ring outer ring axis
AX
GZ
YP
GX
?
XP
GY AY
需增加坐标变换器实现切换
M2 M1
Lecture 6 -- Basic types of INS
Lecture 6 -- Basic types of INS
9
3.5 东向修正回路
M2
t
VN(t)VN00(ANAN)B dt
AX
(t)0R 1 0tVN(t)dt
GZ
YP
GX
CE
VN R
M3 XP
GY AY
VN dt
ANB
VN0
1
VN R
dt
(t )
0
CE 1
M1
Lecture 6 -- Basic types of INS
4
Outline
惯导系统的分类 基于当地地理坐标系的INS -- 稳定与修正 基于惯性坐标系的INS – 重力补偿 框架系统
Lecture 6 -- Basic types of INS
5
3.1 惯性平台 – 立体示意图
放大、校正
内环
电机
传感
传感 外环
电机
台体 台体轴
电机
Lecture 6 -- Basic types of INS
13
Outline
惯导系统的分类 基于当地地理坐标系的INS -- 稳定与修正 基于惯性坐标系的INS – 重力补偿 框架系统
Lecture 6 -- Basic types of INS
14
4.1 基于惯性系的导航
选取惯性坐标系为导航坐标系 ： 平台相对惯性空间稳定
优点 平台只需要稳定 加速度计的输出中不含有 害加速度
8
3.4 平台修正（跟踪）
e
N
VN
R
E
VE
地理坐标系相对惯性空间的旋转
E
VN R
N
VE R
e
c
os
VREtgesin
为了使平台跟踪地理坐标系，应使 其以同样角速度相对惯性空间旋转。
控制电流施加到陀螺仪上, 使它们产生相应的进动。
陀螺仪的进动通过电机被 传递给平台, 使得平台跟踪 地理坐标系 (平台的修正)
10
3.6 北向修正回路
M2
AX
GZ
YP
e cos
AEB
VE dt
CN
CNVRE ecos
1/ R
0
1
V E R cos dt (t)
GX
VE0
M3 XP
GY AY
VN dt
ANB
VN0
1
VN R
dt
(t )
0
CE 1
M1
Lecture 6 -- Basic types of INS
Lecture 6 -- Basic types of INS
16
4.3 重力加速度的分量
当载体从 A 移动到 B,
重力加速度 g 的分量
gx
g
x Rh
gy
g
y Rh
gz
g
R Rh
ZP
x源自文库
ZP
A
XP
gx
XP
B
g
gz
g 的大小也和载体距地面的高度有关
g
g0
R2 (R h)2
Lecture 6 -- Basic types of INS
17
4.3 重力加速度的分量
则
gx
g0
R2x (Rh)3
gy
g0
R2y (Rh)3
gz
g0
R3 (Rh)3
并假设 h << R
gx
g0
x R
gy
g0
y R
gz
g0
2z R
g0
g 的分量取决于载体的位置 x, y 和 z
Lecture 6 -- Basic types of INS
18
4.4 测量和计算
fX(t)
xg0
x R
fY
(t)
yg0
y R
fZ(t) z g02Rzg0
t
x(t)x00VX(t)dt
t
y(t)y0 0VY(t)dt
t
Lecture 6 -- Basic types of INS
3
2.0*惯导系统的分类
依据对导航坐标系的选取和实现方式
平台式 INS
捷联式
选取惯性坐标系为导航坐标系 选取地球坐标系为导航坐标系 选取地理坐标系为导航坐标系 自由或游动方位的水平坐标系
同上
力学编排
Lecture 6 -- Basic types of INS