3陀螺稳定平台
MPU6050在小型稳定平台中的应用
MPU6050在小型稳定平台中的应用作者:邵添羿来源:《中国科技博览》2017年第19期中图分类号:TH74 文献标识码:A 文章编号:1009-914X(2017)19-0070-011 绪论陀螺稳定平台能够隔离载体的运动干扰,调整姿态和位置变化,精确保持动态姿态基准,在现代武器系统中得到了广泛应用。
小型惯性稳定平台用于在载车的行驶过程中提供稳定的惯性平台,以放置光电、跟踪等对于姿态稳定有要求的各种设备。
由于车载平台安装在运动的车辆上,车辆在行驶中的晃动、颠簸、转向等机动动作均会引起平台的运动,对于特定的车载设备,要求在车辆行驶中设备的姿态始终保持稳定,因此对平台的稳定控制提出了相应的要求。
2 平台的稳定控制原理平台的稳定控制系统能隔离载体运动,当车辆行进时,可以隔离载体运动对平台的干扰,使平台及其搭载的设备相对惯性空间保持恒定的姿态。
常见的双轴稳定平台如图1所示。
图1中,方位环和基座用轴承相联,俯仰环安装在方位环内,俯仰环上安装有单自由度陀螺Gx和Gz,Gx陀螺控制俯仰环轴,Gz陀螺控制方位环轴,Ma和Mf分别为方位轴电机和俯仰轴电机。
平台的稳定控制策略采用间接控制,惯性姿态传感器安装在载车上,平台的稳定控制使用车载INS/GPS输出的载体姿态角信息,载体的姿态角为UAV相对大地坐标系的姿态角。
3 惯性敏感器惯性敏感器即陀螺仪和加速度计,采用InvenSense公司MPU-6050,是全球首款整合型6轴运动处理组件,相较于多组件姿态测量方案,免除了组合陀螺仪与加速度计之间轴向安装误差的问题,减少了系统体积。
MPU-6050整合了3轴陀螺仪、3轴加速度计,以I2C总线接口向外输出完整的能够输出方向余弦、四元数、欧拉角的融合数据。
利用内置的运动处理资料库,可处理运动感测的复杂数据,降低了运动处理运算对操作系统的负荷,并为应用开发提供架构花的API。
MPU-6050的角速度测量范围最大可达±2000°/s,可准确追踪快速与慢速动作。
3-惯性导航
测绘与国土信息工程系
空间上的惯性导航
测绘与国土信息工程系
惯导系统工作原理的数学描述
惯导系统工作原理的数学描述如下: 设一飞行器以一定的加速度a 运动,其初始速度 为V(t0)。其速度可以表示为:
v(tk ) v(t0 ) a(t )dt
t0
tk
飞行器的瞬时位置可表示为:
r (tk ) r (t0 ) v(t )dt
dV d 2 s a 2 dt dt
V V0 adt
0
t
t
S S0 Vdt S0 V0t
0
t
0 0
t
adt 2
式中
a ——表示运动体加速度; V ——表示运动体速度; S ——表示运动体移动距离。
测绘与国土信息工程系
平面惯性导航原理
通过一次积分运算(载体初始速度己知)便得到载体相对导航坐标 系的即时速度信息;再通过一次积分运算(载体初始位置已知)得 到载体相对导航坐标系的即时位置信息。对于地表附近的运动 载体,例如飞机,如果选取当地地理坐标系作为导航坐标系, 则上述速度信息的水平分量就是飞机的地速 ,上述的位置信息 将换算为飞机所在处的经度 、纬度L以及高度h。
h vu
式中,RM、RN分别表示地球子午圈、卯酉圈的曲率半径 ,初始位置 0
L0 h0 应事先给出并输入惯导系统 。
测绘与国土信息工程系
惯性导航系统组成部分
一个完整的惯性导航系统应包括以下几个主要部分:
1. 加速度计。用于测量飞机运动的加速度,一般应由三个加速度 计完成三个方向的测量。 2. 稳定平台。为加速度计提供一个准确的安装基准和测量基准, 以保证不管飞机作什么样的机动飞行,三个加速度计的空间指 向是不变的。 3. 导航计算机。用于进行诸如图中的积分、相加、乘除和三角函 数等数学计算。同时,为保证平台始终水平和指北,要随飞机 运动和地球自转,不断计算出修正平台位置的指令信号。还要 计算并补偿有害加速度等。
3.5 陀螺稳定平台
M s = Kα p = M d
式中 K 为稳定回路的总放大系数, αp 为平台绕稳定轴相对惯性空间 的偏差角。
改写上式可得到平台绕稳定轴的稳态误差角
αp =
Md K
由此可见,为了使平台具有足够高的精度,即稳态误差角很小,稳定 回路应具有足够大的放大系数。
2、空间稳定状态
要是平台绕稳定轴以指令角速度 ω c 相对惯性空间主动跟踪空间某 一变化的基准(如跟踪水平面或子午面) ,则应给陀螺内环轴上的力 其大小与指令角速度 ω c 成比例。该电流使 矩器输入一个指令电流 I c , 力矩器产生一个沿陀螺内环轴方向的指令力矩 M c ,在 M c 的作用下, 陀螺绕外环轴进动。因为此时平台基座没有运动,所以陀螺绕外环轴 相对平台的角速度就等于陀螺在 M c 作用下绕外环轴相对惯性空间的
2.3 由二自由度积分陀螺组成的单轴系统
平台可随平台稳定轴相对基座转动。平台上装有一个双自由度陀 螺,外环轴与稳定轴平行,在外环轴上装有信号器,内环轴上装有力 矩器。信号器、放大器和稳定电机组成稳定回路。
图 二自由度陀螺单轴平台原理
1、几何稳定状态
当干扰力矩 M d 沿稳定轴作用到平台上时,将引起平台以角速度
M g = M c = Kt I c
式中 K t 为力矩器传递系数。 陀螺进动时产生的陀螺力矩为
p M g = Hωc = Hα
则
p = α
Kt Ic H Kt Ic dt H
α p = α0 + ∫
式中 α 0 为 t=0 时刻平台相对惯性参考系的初始偏角。 由此可见,在指令电流的作用下,平台相对惯性参考系的转角 α p 与指令电流的积分成正比。 故可以利用力矩器的输入电流 I c 来控制平 台的转动,使平台按照所需要的规律相对惯性空间转动。如果令指令 力矩
稳定平台关键技术综述
稳定平台关键技术综述0引言从科索沃战争、伊拉克战争到最近的利比亚战争,局部战争成为主要的作战模式。
与以往的区域攻击不同,现代局部战争的主要特点是快速反应、精确打击。
为应对未来局部战争,做到敢打必胜,改进与研制武器装备,提高部队作战能力成为首要任务。
在我军车载陆战装备中,战术导弹、坦克、火炮等武器系统近些年来有了很大发展,射击范围和精度都有了很大提高。
但与外军先进装备相比,行进间射击精度尚有较大差距,甚至大多装配的武器系统还无法实现行进间射击。
行进间射击作为提高部队作战效率,增强武器装备自我防护能力的重要指标,已成为未来陆战装备的主要发展方向,同时这也使得对武器系统的改进与研制迫在眉睫。
瞄准线稳定技术是实现行进间射击、提高行进间射击精度的主要环节。
它采用稳定平台对车体的航向、纵摇和横滚运动进行有效的隔离,使瞄准线在惯性坐标系下保持稳定。
为提高陆战装备快速反应与精确打击能力,急需提高稳定瞄准的快速性、精确性、自适应性,因此本课题的研究具有重要意义。
1稳定平台国内外研究现状在光电稳定平台中,陀螺稳定平台迄今得到了广泛的应用,它是采用一个环架系统作为光电传感器的光学平台,在平台上放置陀螺来测量平台的运动,陀螺敏感姿态角的变化经过放大以后驱动环架的力矩电机,通过力矩电机驱动平台使光电传感器保持稳定。
在国外起初应用于手持式望远镜和瞄准具中,并在八十年代装备部队,现已广泛应用于地基、车载、舰载、机载、弹载、天基等各种观测、摄像系统中。
1996年,美国的航空红外制造商前视红外系统公司以电子新闻采集市场为目标推出了一种双传感器系统,它包括一个用于低照度的高分辨率红外摄像机和用于白天的标准广播摄像机,这两台摄像机一起被安装在一个紧凑的三轴陀螺稳定的万向架中,能够提供50rad μ的图像稳定精度,意大利的Caselle-Torinese 公司生产的11072Caselle-Torinese 光轴稳定平台的旋转范围可以做到高低方位均为︒︒360~0,最大旋转速度为︒60/s ,稳定精度为0.4mrad 。
惯性导航系统原理_三轴陀螺稳定平台(4)
0 0 1
ωωiirrffxy
ωiaaz
环架角速度
sinθr sinθ f sinθa + sinθr sinθ f cosθa
0 0
cosθr sinθ f sinθa
cosθr
sinθ f
cos
θa
ωωiibbbbyx
0
T3 0
0
ωibbz
基座角速度
2010.05.21
10
5.2.1角速度耦合关系分析
=
−ωωiffixffxcsoisnθθaa
+
ωr iry
cosθ
f
+
ωr iry
cosθ
f
sin θ a cosθa
ωiaaz
ωa iaz
ωωiiaaaaxy
=
ωf ifx
cosθa
−ωiffx sin θa
+
ωf ify
+
ωf ify
sin θ a cosθa
ωiaaz
f
+
ωb ibx
sin
θr
sinθ f
+
ωb ibz
cosθr sinθ f
ωωiiffffyx
=
ωiffz
ωr iry
ωr irx
cosθ f
+ θ&f
+
ωr irz
sinθ
f
−ωirry sinθ f
+
ωr irz
cosθ
f
2010.05.21
ωωiirrrrxy
=
ωibbx
0
sinθ f
陀螺的结构名称
陀螺的结构名称陀螺的结构名称陀螺是一种旋转体,旋转时呈现出稳定性和惯性的特点,可以被用于许多领域,如导航、陀螺仪等。
陀螺的结构名称根据不同的特点和分类,可分为以下几类。
1.基于自由度的分类基于自由度的分类方式,包括一维陀螺、二维陀螺和三维陀螺。
一维陀螺仅具有一个旋转自由度,常常被用于仪器和玩具中。
它的结构相对简单,由一个旋转轴和转轮组成。
二维陀螺是具有两个旋转自由度的陀螺,它的结构更加复杂,包括转轮、支撑轮、绞盘、编码器等部分。
它被广泛应用于导航系统、慣性導航系統等领域。
三维陀螺具有三个旋转自由度,主要应用于导航和稳定平台系统等领域。
它的结构相对复杂,由转轮、三组稳定环组成。
稳定环的作用是使转轮保持垂直方向稳定,提高了陀螺的稳定性和精度。
2.基于工作原理的分类基于工作原理的分类方式,包括空气悬浮式陀螺、机械支撑陀螺和电磁悬浮式陀螺。
空气悬浮式陀螺采用气浮支撑,旋转轴是通过气体泵产生气体层,使转轮悬浮在空中,并可以对转轮进行控制。
其优点是结构简单、寿命长、精度高。
机械支撑陀螺采用机械支撑方式,它的结构复杂,包括编码器、测量装置、多个轴承及其支撑装置等。
机械支撑陀螺可以达到非常高的精度和灵敏度,是导航等领域常用的陀螺之一。
电磁悬浮式陀螺采用电磁力控制转轮的位置和姿态,以实现转轮的稳定性和精度。
其优点是噪声小、寿命长,精度高。
3.基于应用的分类基于应用的分类方式,包括导航陀螺、稳定平台陀螺和陀螺仪。
导航陀螺被广泛应用于导航系统、陀螺罗盘、地震学和空间测量等领域,主要用于测量移动运动、姿态角和地球自转的角速度等。
稳定平台陀螺目的是使平台水平,确保安装在平台上的仪器在运动时保持姿态稳定。
稳定平台陀螺具有高精度、高可靠性等优点,可以用于地震学、航空航天和军事等领域。
陀螺仪是一种利用陀螺效应测量转速和角速度的仪器,被广泛应用于航空航天、导弹、火箭等领域。
陀螺仪结构相对简单,由转轮、电磁元件、控制电路等构成。
综上所述,陀螺的结构名称根据不同的特点和分类,可以分为一维陀螺、二维陀螺和三维陀螺,空气悬浮式陀螺、机械支撑陀螺和电磁悬浮式陀螺,以及导航陀螺、稳定平台陀螺和陀螺仪。
第4章陀螺稳定平台
iibbbbyx
ibbz
a ia
Cbaibb
a ba
cosa sina
0
s in a c os a
0
0 0
iibbbbyx
0 0
iibbbbxy
c os a c os a
b iby
b ibx
s in a s in a
1 ibbz a
b ibz
a
其中 a
是陀螺感测到
ωB反映了系统对输入响应的快慢 1、干扰信号一般为小于5Hz的低频信号, ωB应远大于5Hz, 才能抑制干扰 2、噪声也会形成干扰,频率一般在50-5000Hz, ωB不能 太宽,以免引入噪声干扰 3、修正指令信号的频率
平台对基座角振荡的隔离度
当基座作角振荡时,干扰力矩会引起平台同频率的角振
荡,定义平台角振荡的幅值与基座角振荡的幅值之比为稳定
第四章 陀螺稳定平台
陀螺稳定平台包括 1、惯性平台 2、陀螺稳定装置
陀螺稳定平台的基本功能: 1、稳定功能
抑制外界扰动 2、跟踪功能
按指定的姿态运动
陀螺稳定平台的稳定作用之一是能自动产生卸荷力矩 对消干扰力矩。卸荷力矩分为两类 1、陀螺力矩 2、伺服力矩
陀螺稳定平台的主要类型 1、直接式陀螺稳定平台--干扰力矩由陀螺力矩对消 2、间接式陀螺稳定平台--干扰力矩由伺服力矩对消 3、指示式陀螺稳定平台--干扰力矩由伺服力矩对消 4、动力式陀螺稳定平台--干扰力矩由伺服力矩和陀螺 力矩对消 5、指示-动力式陀螺稳定平台--干扰力矩由伺服力矩和 陀螺力矩对消
0
f ifz
0
f ify
f ify
f ifz
tan f
a iay
第4章 陀螺稳定平台
0 1 0
sin r ibx b 0 iby b cos r ibz
b
b b 0 ibx cos r ibz sin r b iby r r 0 b sin b cos r ibz r ibx
cos a sin a 0 sin a cos a 0 1 0 f 0 , C a 0 0 1 0 cos
f f
Cb
a
sin
sin f cos f 0
系统的框图
ω
cm dx
+ Y f (s) +
υ
cmd
+ Y(s) +
Md 1 Js υ
+
可得
(s)
Y (s) Js cmd ( s ) Y (s) Js
1 Js M d (s) Y (s) Js
1
1
令 则
G (s)
1 Js
(s)
Y ( s )G ( s ) 1 Y ( s )G ( s )
cmd ( s )
其中 f 是陀螺感测到 iax 后俯仰环伺服回路控制俯仰环旋转 a f 的作用是对消 iax 即 的角速度,
a
ifx iax f 0
f a
ify iay cos f
f a
ifz iaz sin f
f a
G (s) 1 Y ( s )G ( s )
M d (s)
传递函数
(s)
(s) cmd ( s )
三轴陀螺仪稳定器原理
三轴陀螺仪稳定器原理三轴陀螺仪稳定器是常用的一种姿态控制器,用于控制无人机、飞行器、航模等飞行器的飞行姿态。
它基于陀螺仪的测量数据,通过PID控制算法来实现对飞行器姿态的稳定控制。
下面将分别从三个方面介绍三轴陀螺仪稳定器的原理,包括陀螺仪原理、PID控制原理以及三轴陀螺仪稳定器的工作原理。
一、陀螺仪原理陀螺仪是一种基于角动量守恒定律的转动仪器,它能够测量物体的转动角速度。
常见的三轴陀螺仪由三个互相垂直的旋转轴组成,分别对应物体在三个方向上的转动角速度。
当物体绕主轴转动时,主轴转动的惯性会抵消外力的作用,使主轴保持一个相对稳定的方向,这种稳定的方向就可以用来测量物体的转动角速度。
简单来说,陀螺仪就是利用旋转物体的惯性来测量转动角速度的一种传感器。
二、PID控制原理PID控制是一种基于反馈控制的控制方法,它通常用于控制系统的稳定性和精度。
PID控制器通过不断调节输出信号的比例(P)、积分(I)和微分(D)三个参数,来实现对控制对象的精确控制。
简单来说,PID控制器就是通过不断调整控制参数,使系统输出和目标值之间的误差最小化,从而实现对系统的精确控制。
三、三轴陀螺仪稳定器的工作原理三轴陀螺仪稳定器的工作原理就是在陀螺仪的基础上,通过PID控制算法来控制飞行器的姿态稳定。
具体流程如下:1.陀螺仪测量角速度。
2.通过微处理器将陀螺仪的测量数据转化为姿态角度。
3.将目标姿态角度和实际姿态角度之间的误差进行计算。
4.通过PID控制算法计算出控制输出信号。
5.控制输出信号经过PWM驱动电机,控制飞行器的转动。
6.通过循环调整PID控制器的参数,控制输出信号的精确性和稳定性。
通过以上的过程,三轴陀螺仪稳定器就能够实现对飞行器姿态的稳定控制。
当飞行器发生偏差时,陀螺仪能够测量到角速度,PID控制算法能够计算出正确的输出信号,从而实现对飞行器的调整和稳定。
陀螺稳定平台
陀螺稳定平台(gyroscope-stabilized platform)是利用陀螺仪特性保持平台台体方位稳定的装置。
简称陀螺平台、惯性平台。
用来测量运动载体姿态,并为测量载体线加速度建立参考坐标系,或用于稳定载体上的某些设备。
它是导弹、航天器、飞机和舰船等的惯性制导系统和惯性导航系统的主要装置。
分类和组成:按结构形式可分为框架陀螺平台和浮球平台两种。
①框架陀螺平台。
按其稳定的轴数,又分为单轴、双轴和三轴陀螺稳定平台(图1)。
它主要由平台台体、框架系统(即内框架、外框架和基座)、稳定系统(由平台台体上的陀螺仪、伺服放大器和框架轴上的力矩电机等构成,又称稳定回路、伺服回路)和初始对准系统(包括平台台体上的对准敏感元件、变换放大器和稳定系统)等组成。
陀螺稳定平台使用何种陀螺仪作为稳定敏感元件,就称为何种陀螺平台,如气浮陀螺平台、液浮陀螺平台、挠性陀螺平台和静电陀螺平台等。
②浮球平台。
又称高级惯性参考球平台。
主要由浮球(即内球)、球壳(即外球)、信号传输系统、姿态读出系统、加矩系统、温控系统、自动校准与对准系统和计算机接口装置等组成(图2)。
工作原理:三轴陀螺稳定平台有3条稳定系统通道,2条初始对准系统水平对准通道和1条方位对准通道。
其工作状态:一是陀螺平台不受载体运动和干扰力矩的影响,能使平台台体相对惯性空间保持方位稳定;二是在指令电流控制作用下,使平台台体按给定规律转动而跟踪某一参考坐标系进行稳定。
利用外部参考基准或平台台体上的对准敏感元件,可以实现初始对准。
三轴陀螺稳定平台应用较广泛。
浮球平台的浮球内装3个陀螺仪、3个加速度计和电子组件,浮球与球壳之间充以低粘性的碳氢液体,通常用电动涡轮液压泵提供连续流动悬浮液,将浮球悬浮在球壳中。
在球壳上安装有倍增器、倍减器、姿态读出器(激励带式感应传感器)、加速度计读出器、温控器与计算机接口装置等。
浮球中的陀螺仪、加速度计和姿态传感器信号传输系统,采用混频和多路传输,经电刷送到直流线路并在外电子组件中处理,然后由载波编码,通过接口送到计算机中。
惯性导航系统原理_陀螺稳定平台工作原理
第四章 陀螺稳定平台工作原理
o o o o o o
4.1 各类稳定平台简介 4.1.1 直接式陀螺稳定平台 4.1.2 间接式陀螺稳定平台 4.1.3 动力式陀螺稳定平台 4.1.4指示式陀螺稳定平台 4.1.5 用速率陀螺仪构成的稳定平台
2010-05
4
4.1 各类稳定平台简介
陀螺稳定平台的稳定作用之一是平台能自动产生卸荷力矩对消干扰力矩. 卸荷力矩由两类不同的力矩组成:
&×H M dy = β
Mg
Mdy
& β
& Mg = H ×β
ห้องสมุดไป่ตู้
2010-05
7
以框架组件为分析对象,框架组件的总动量矩为
b b HG = H b + [ I ](ωib + ω b bG )
zb β
z
0 I x +0 = H sin β H cos β 0
2010-05 6
该陀螺稳定系统,倾倒力矩的对消过程为:
在倾倒力矩Mdy (假设沿列车向前,即图中穿入纸面方向)作用下,
& 向左,即x 负方向, 陀螺发生进动,引起的进度角速度 β b
Up zb
& β
Mdy
yb
Forward
此进动角速度引起陀螺力矩 & M = H ×β
g
Mg方向沿列车后向,即图中穿出纸 面方向,因此陀螺力矩对倾倒力矩直 xb Right 接起到了对消作用.
&) M b ω y I x (ωx − β x −ωx H sin β + I yω y = M dy H cos β + I zωz M zb 0
三轴振动陀螺仪的原理
三轴振动陀螺仪的原理三轴振动陀螺仪是现代惯性导航系统的核心组成部分之一。
它是一种基于陀螺效应测量旋转角速度和方向的仪器。
本文将介绍三轴振动陀螺仪的原理、构成、工作流程和应用场景。
一、三轴振动陀螺仪的原理1. 陀螺效应陀螺效应是指将陀螺仪转动时,在转速不变的情况下,它的转轴方向会发生偏转的现象。
这是由于旋转的陀螺仪具有巨大的角动量,很难改变其转轴方向,导致其转轴始终维持在原方向上。
2. 三轴振动陀螺仪的结构三轴振动陀螺仪是由三个陀螺仪组成,分别位于 X、Y、Z 三个方向上。
每个陀螺仪都可以测量其所在方向的角速度,通过将三个方向的角速度向量叠加,可以得到物体的总角速度向量。
3. 工作原理在工作时,三轴振动陀螺仪会被安装在测量对象上,并转动以保持其方向。
当测量对象开始旋转时,陀螺仪所在方向会随着旋转而发生偏转,导致在该方向上出现一个陀螺效应。
这时陀螺仪会测量出沿该方向的角速度,从而获得旋转的信息。
二、三轴振动陀螺仪的构成三轴振动陀螺仪包括三个陀螺仪,一个信号处理器、一个控制器和一个电源。
每个陀螺仪都是由一个转子和一个固定部分组成。
转子是由一个旋转的圆盘和一个陀螺轴组成,可以自由旋转。
而固定部分则包括一个支架、一个针轴和一个检测器。
当转子旋转时,陀螺效应会使其转轴和原先的方向有一个角度偏差,这时检测器会感应到转轴的偏移量,并输出相应的信号。
信号处理器则可以处理接收到的信号,并把它们转化为物体的角速度。
控制器可以决定如何使用这些数据,例如通过滤波器消除杂波或对角速度进行积分以计算出物体的角度。
三、三轴振动陀螺仪的工作流程三轴振动陀螺仪的工作流程可以简单地分为三个步骤:感知旋转、转换角速度和积分计算角度。
1. 感知旋转当三轴振动陀螺仪被安装在物体上时,它可以感知到该物体的旋转。
对于每个陀螺仪,当它随物体旋转时,它所在方向的陀螺效应会导致转轴偏离其原先的方向,并产生一个瞬时信号。
2. 转换角速度信号处理器会接收陀螺仪输出的信号,并将其转换为物体的角速度。
§3.7平台式惯导的基本原理
(2) 内环坐标系 OX Y pi piZpi (下标 pi 表示 pitch) ,简称 pi 系,与内环 固联, Zpi 轴为平台方位轴(同 Zp 轴) , X pi 轴沿平台内环轴(俯仰(纵 摇)轴)指向平台右侧, Ypi 与 X pi 、 Zpi 垂直构成右手直角坐标系。
(3) 外环坐标系 OXrYrZr (下标 pi 表示 roll),简称 r 系,与外环固连, X r 轴沿平台内环轴指向平台右侧 (同 X pi 轴) ,Yr 轴沿平台外环轴(横 滚(横摇)轴)指向平台前方, Zr 与 Xr 、Yr 垂直构成右手直角坐标系。 由于外环平面与内环平面不一定垂直,Zr 轴与方位轴指向并不始终一 致。
基座
外环
内环轴摩擦 内环 方位轴摩擦
刚性约束
刚性约束
刚性约束
方位环(台体)
2 惯性导航系统实现的基本思路 从加速度计的原理可知,加速度计的输出是沿加速度计敏感轴方
向的比力,比力中含有载体绝对加速度信息。如果在载体上能得到三
个敏感轴互相正交的加速度计输出信号同时又能获知各加速度计敏
感轴的准确指向的话,就可以完全掌握载体的运动加速度,结合载体
动,通过计算得到载体的姿态角,也就确定出了加速度计敏感轴的指
向。再通过坐标变换,将加速度计输出的比力信号转换到一导航计算
比较方便的导航坐标系上,进行导航计算。这种系统就是捷联式惯导
系统。该系统由于没有平台实体,结构简单、体积小、维护方便;但
惯性元件直接装在载体上,工作环境恶劣,对元件要求很高。同时,
导航系统要求其三轴平台相对惯性空间稳定,即平台工作于几何稳定 状态;有的惯性导航系统要求其三轴平台在保持稳定的同时还要跟踪 某个导航坐标系,即平台工作于空间积分状态。三轴平台可以看成是 由三个单轴陀螺稳定平台组合而成,单轴平台的工作原理、系统的基 本组成和传递函数、系统的性能指标等内容都适用于三轴平台。但三 轴平台不是三个单轴平台简单的叠加,三轴平台由于其结构和工作原 理方面的特点,在实现平台的稳定和修正两种工作状态时,有许多特 殊问题。如陀螺仪信号的合理分配,基座转动角速度到平台的耦合与 隔离,三轴平台的环架锁定等。
三轴陀螺稳定平台控制系统设计与实现
同等精度的情况下,陀 测量时会引入附加相
结构小型化困难
好,体积尺寸较小的不同型号陀螺可供选择。
陀螺实际安装的时候,需要十分注意陀螺的安装方式,一定要保证各陀螺敏感轴与各自 框架轴线的水平,并且相互 之间保持垂直,以免造成陀螺敏感轴方向上的误差和各轴系之间的祸合效应。本系统方位和俯仰轴系的陀螺均安转在方 位内 框上,有效避免了外框尺寸过大,从而保证负载框具有较小的转动惯量。同时,每个框架都有一个独立的直流力矩 电机直接驱动,这种驱动方式省去了减速机构,有效地消除了齿轮间隙误差问题。由于其祸合刚度高,增大了系统的机
中图分类号:U “. 6 1 文献标识码:A
D s n n ra a o ocnrlyt orh e x e g ad l t n fot ss mf tr 一 i i e i i s o e e as gr s b i d l fr yo t i e Pao m al s t
Y N uL Q A GP , I i
( e c l i e f t ao,ot a U i rt N i 209, h a 砒s hn t oA o t nSu e n v s a n l06C i r a t su n mi hs t ei n g , y j n ) A s a : nv w o t e u e so i li d r csadsbin Pc 翻so h h r io bt c I i f er i n f s an i b e n t i i t a rt e h qr t m e o g s a t u t n a l go l z i f i 一 ci g P sn e Po e Cigi c ss m a r 一 is i c P f ss mc t n o t re y w s ege. a d ht l c u a e t , t e st l d lo y e ee g n e gr ads dB e oe r t d ye n h a a i a r t e x b z t m nr i h a t o i n s o t ds P csoa Vgi c hae t m cai lt c rcnt tnm icm o n se i ad n e eg r e f T u d e e r e e n c s t eo sti , a o n t e co n h i o s n n a d, h h a r u u i o u n P e sl n t sf a adh d a r i i e i dc . e i r c一o i h o o t sbidP dr w ow e t r n a w e az o r n ue T d t a es ao er f e t i r r e a nw e t lt o r dh sb u n i l nt y h a l t e am a z 1b s
陀螺稳定平台实验报告
一、实验目的1. 了解陀螺稳定平台的基本原理和组成;2. 掌握陀螺稳定平台的操作方法;3. 通过实验验证陀螺稳定平台在隔离载体扰动和跟踪目标方面的作用;4. 分析陀螺稳定平台在实际应用中的性能表现。
二、实验原理陀螺稳定平台是一种利用陀螺仪特性保持平台台体方位稳定的装置。
它主要由惯性平台、陀螺仪、控制器和执行机构等组成。
当载体发生运动时,陀螺仪能够测量出载体的角速度和角加速度,并将这些信息传递给控制器,控制器根据陀螺仪的输出信号控制执行机构,使平台台体保持稳定。
三、实验设备1. 陀螺稳定平台;2. 激光测距仪;3. 数字示波器;4. 数据采集卡;5. 计算机;6. 相关实验软件。
四、实验步骤1. 将陀螺稳定平台安装好,连接好相关设备;2. 启动计算机,打开实验软件;3. 将激光测距仪放置在实验场地,调整好位置;4. 打开实验软件,设置实验参数;5. 控制陀螺稳定平台在指定路径上运动;6. 通过激光测距仪测量陀螺稳定平台在运动过程中的实际位置;7. 将实验数据记录在实验报告中。
五、实验结果与分析1. 实验结果通过实验,我们得到了陀螺稳定平台在运动过程中的实际位置数据。
将实验数据与激光测距仪测量的实际位置进行比较,可以得出陀螺稳定平台在隔离载体扰动和跟踪目标方面的性能表现。
2. 分析(1)陀螺稳定平台在运动过程中,能够有效地隔离载体扰动,使平台台体保持稳定。
这表明陀螺稳定平台在实际应用中具有良好的稳定性。
(2)陀螺稳定平台在跟踪目标方面表现出较高的精度。
通过实验数据可以看出,陀螺稳定平台在跟踪目标过程中,实际位置与激光测距仪测量的实际位置基本一致。
(3)陀螺稳定平台的性能表现与实验参数设置有关。
在实际应用中,应根据具体情况调整实验参数,以获得最佳的实验效果。
六、结论本次实验验证了陀螺稳定平台在隔离载体扰动和跟踪目标方面的作用。
实验结果表明,陀螺稳定平台在实际应用中具有良好的稳定性和跟踪精度。
通过对实验数据的分析,我们可以得出以下结论:1. 陀螺稳定平台是一种有效的隔离载体扰动和跟踪目标的装置;2. 陀螺稳定平台的性能表现与实验参数设置有关;3. 陀螺稳定平台在实际应用中具有良好的应用前景。
3陀螺稳定平台
T1称为环架系统的几何关系阵,平台通过该矩阵将环架角速 度传递给台体 T3称为基座角运动的几何约束耦合阵,平台通过该矩阵将基 座角运动传递给台体
当
ωa ia
=
0
即
T1ωiAA + T3ωibb = 0
则
ωA iA
=
−T1−1T3ωibb
环架角速度
ωiAA
=
ωωiifrrfyx
ωiaaz
21
修正回路指令角速度到平台输出角速度处理流程
ωiaaz 0
0
Wa
u
A gz
Hale Waihona Puke ωiaazωiaaz
若 KGx = KGy = KGz = KG
Wr = Wf = Wa = W
Wr ⋅ KG = 1
23
则
ωωiiaaaayx
=
ωcmdx
T1WIT2K
GI
ωcmdy
=
ωcmdx
T1T2
ωcmdy
ωiaaz
ωcmdz
ωcmdz
16
定义
1、基座坐标系b:与基座相
连
2、横滚环坐标系r:与横滚环
相连,yr轴沿横滚环轴,与yb 轴指向相同,r系相对b系只能
绕yb旋转,产生横滚角θr。
3、俯仰环坐标系f:与俯仰环
相连,xf轴沿俯仰环轴,与xr 轴指向相同,f系相对r系只能
绕xr旋转,产生俯仰角θf。
4、方位环坐标系a:与方位环相连,za轴沿方位环轴,与zf轴
10
11
12
3.3.2修正回路工作原理(工作在空间积分状态)
Y
13
修正回路工作原理
14
§3.3 陀螺稳定平台
§3.3 陀螺稳定平台1、问题的提出如果能测量出沿直角坐标系三个轴的线运动和绕三个坐标轴的角运动,就可以确定出物体的运动状态。
飞机、舰船以及各种战略战术武器都用惯性导航、惯性制导系统测量出运载体的位置、速度及姿态等运动情况。
如测量线运动用加速度计,测量角运动用陀螺仪。
下图就是由三个二自由度陀螺和三个单轴加速度计组成的全姿态惯性测量组合(IMU)。
三个二自由度陀螺仪分别检测或稳定三个轴的角运动,三个单轴加速度计检测沿三个轴的加速度(线运动)。
一个二自由度陀螺相当于两个单自由度的陀螺,所以也有用两个二自由度陀螺仪代替三个单自由度陀螺仪的,多余的一根陀螺仪测量轴,可以用锁定回路进行锁定。
图 全姿态惯性测量组合示意图根据IMU选择的坐标系,就构成了各种不同方案的惯性导航系统。
平台式惯性导航系统把IMU稳定在导航坐标系里,与运动的载体相隔离,而捷联式方案是把IMU固定在载体上。
平台式惯导系统的做法:为了把IMU与载体相隔离,所以用一套框架系统把IMU支承起来(跟付科模型类似)。
使IMU成为在载体上不受载体运动与载体相隔离,所以用一套框架系统把IMU支承起来。
使IMU成为在载体上不受载体运动影响的—个物理平台。
图 三轴稳定平台的结构示意图在上图中A即是由陀螺和加速度计组成的测量部件IMU,是平台台体,平台用垂直的一个内环B支承起来,平台与内环间可以作360度的相对转动。
内环支承在水平的外环C中,内环连同平台可绕水平的X轴相对外环转动。
外环水平地支承在载体上,内外环及平台一起p可以绕水平的Y轴相对于载体转动。
在惯性平台稳定工作时,实际的p平台与载体的相对运动情况正好相反,载体无论绕方位轴转动还是横滚、俯仰,平台始终稳定跟踪某一导航坐标系。
平台三个支承轴的转角就可测量出载体的航向和水平姿态角。
把平台的外框轴沿载体的纵向轴安装,如图在船上的安装,则垂直的Z轴测航向,p X轴测纵摇,pY测横摇。
各支承轴上装上测角传感器就测量出了载体的航向和水平p姿态信号。
导航原理_陀螺稳定平台
相对惯性空间以该指令角速度旋转。 工作原理
cmd
ω
Tcmd
Mcmd
双自由度陀螺构成单轴稳定平台的原理 利用双自由 度陀螺构成单 轴稳定平台, 稳定轴可选为 与内环轴平行 或与外环轴平 行。 也可利用双自 x 由度陀螺构成 双轴稳定平台。
xr
M cmd
T
z
s
H
Md
y
稳定回路工作原理(稳定轴与外环轴平行)
地球上的定位参数
地球定位中两类坐标系
1,地球直角坐标系
(X,Y,Z) 2,地球球面坐标系 (经度、纬度、高度 )
两类坐标参数的转换
极坐标和直角坐标的转换
式中e为旋转椭球扁率或称椭圆度对应的曲率为与纬度有关的计算用rm与经度有关的计算用rn414101467729211511地球周围空间的物体质量为m都受到地球的万有引力mg的作用该力指向地心同时维持质量m跟随地球旋转需要有外力提供向心力fc向心力实质上是万有引力的一个分量重力mg是万有引力的另一个分量根据平行四边形法则有mgmgfcggac式中向心加速度sin0000059sin0052884cos0000059cos0026373根据万有引力定律地球表面一点的重力加速度的近似值为式中k为单位质量的万有引力系数m为地球质量r为地球半径
参考椭球的赤道平面是圆平面,所以参考
椭球可以用赤道平面半径(即长半径)Re 和极轴半径(即短半径)Rp来描述,或用 长半径Re和椭圆度(扁率)e来描述。
e ( Re R p ) / Re
直到目前为止,各国选用的参考椭球已有十余种,但
大部分参考椭球都仅在局部地区测量大地水准面的基 础上确定的,因而仅适用于某些局部地区。
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
C
a f
=
− sin θa
cos θa
0
0
0 1
ωiaa
=
C
ω a f
f if
+ ωfaa
ωωiiaaaayx
=
cos θa − sin θa
ωiaaz
0
sin θa cos θa
0
0 0
ωωiiffffyx
+
0
0
=
ωωiiffffxy
cos θa cos θa
+
ωf ify
−
ωf ifx
利用陀螺来控制被控对象的角运动。控制角运动包含
两个含义:
一是隔离运载体的角运动对被控对象的角运动的影响;
二是能使被控对象按指令要求的规律旋转,指向始终跟踪变动着的方向。 Nhomakorabea2
陀螺稳定平台:以陀螺为敏感元件,能隔离基座的 角运动并能使被控对象按指令旋转的机电控制系统 称为陀螺稳定平台。
陀螺稳定平台包括:
sin sin
θa θa
1
ωiffz
θa
ωf ifz
+ θa
19
采用三个环架轴的角速度
ωr iry
、ωiffx
、ωiaaz
来表示,并简化可得
ωωiiaaaayx
=
cos θa − sin θa
ωiaaz 0
cos θf sin θa cos θf cos θa
0
0 0
ωωiifrrfyx
−
ωb ibz
+ θr
sin
θr
ωirrz
sin θr 0 cos θr ωibbz 0
ωibbx
sin θr
+
ωb ibz
cos θr
俯仰环的角速度
1 0
0
Crf = 0 cosθ f
sin θ
f
0 − sinθ f cosθ f
18
ωiff
=
C
ω f r
r ir
+ ωrff
ωωiiffffyx
也可利用双自由度陀螺构成双轴稳定平台。
根据陀螺稳定平台的功能,惯性平台的 工作状态有两种:
几何稳定状态:平台不受基座运动和干 扰力矩影响,相对惯性空间保持方位稳定的工 作状态。
9
空间积分状态:平台在指令角速度作用下, 相对惯性空间以给定规律转动的工作状态。 3.3.1稳定回路工作原理(工作在几何稳定状态)
第3章 陀螺稳定平台
3.1 概述 3.2 陀螺稳定平台的构成方式 3.3 双自由度陀螺构成单轴稳定平台的原理 3.4* 三轴陀螺稳定平台 3.5 本章小节
1
3.1 概述
陀螺具有定轴性和进动性。
定轴性是指转子轴具有相对惯性空间指向保持不变的 能力。
进动性是指按照要求的规律相对惯性空间旋转的能力。
1、惯性平台(精度高,三轴) 2、陀螺稳定装置(精度低,一般少于三轴)
陀螺稳定平台的稳定作用是能自动产生卸荷力矩对 消干扰力矩。卸荷力矩分为两类
1、陀螺力矩
3
2、伺服力矩
陀螺稳定平台的主要类型 1、直接式陀螺稳定平台--干扰力矩由陀螺力矩对消 2、间接式陀螺稳定平台--干扰力矩由伺服力矩对消 3、指示式陀螺稳定平台--干扰力矩由伺服力矩对消 4、动力式陀螺稳定平台--干扰力矩由伺服力矩和陀 螺力矩对消(过渡过程中起作用) 5、指示-动力式陀螺稳定平台--干扰力矩由伺服力矩 和陀螺力矩对消(过渡过程中起作用,但作用很小)
二是跟踪功能,即能跟踪指令,按要求的角速度旋 转,确保平台的坐标轴指向要求的方位。
5
3.2 陀螺稳定平台的构成方式
可由单自由度陀螺构成,也可由双自由度陀螺构成
一个单自由度陀螺可以构成单轴陀螺稳定平台,稳 定轴是单自由度陀螺的敏感轴(输入轴),即转子 缺少转动自由度的那个轴。
一个双自由度陀螺可以构成双轴陀螺稳定平台,稳 定轴是双自由度陀螺的内框架轴和外框架轴。
4
陀螺稳定平台的基本功能: 一是稳定功能,即对外界干扰起对消作用。如基座
角运动是一种外界干扰,在稳定平台与基座的轴承 连接处将引起摩擦力矩作用在平台上,或由于几何 约束关系台体被强制带动跟随基座一起旋转,稳定 平台能自动产生卸荷力矩对消摩擦力矩,同时能产 生适当的反旋转对消被基座带动的强制旋转;
16
定义
1、基座坐标系b:与基座相
连
2、横滚环坐标系r:与横滚环
相连,yr轴沿横滚环轴,与yb 轴指向相同,r系相对b系只能
绕yb旋转,产生横滚角θr。
3、俯仰环坐标系f:与俯仰环
相连,xf轴沿俯仰环轴,与xr 轴指向相同,f系相对r系只能
绕xr旋转,产生俯仰角θf。
4、方位环坐标系a:与方位环相连,za轴沿方位环轴,与zf轴
指向相同,a系相对f系只能绕zf旋转,产生方位角θa。
5、环架坐标系A:xA、yA、zA轴分别为xf、 yr、za ,即相应 轴上力矩电机产生力矩的方向,它一般不是正交坐标系,只有
当俯仰角等于零时才为正交坐标系。从环架轴上拾取的角度信
号分别为俯仰角、横滚角和方位角。
6、平台坐标系:由三个陀螺仪的敏感轴构成。
17
角速度耦合分析 横滚环的角速度
cos θr 0 − sin θr
C
r b
=
0
1
0
sin θr 0 cos θr
ωirr
=
C
ω r b
b ib
+ ωbrr
ωωiirrrryx
=
cos θr
0
0 1
−
sin 0
θr
ωωiibbbbyx
+
0
θr
=
ωibbx
cos θr ωb
iby
10
11
12
3.3.2修正回路工作原理(工作在空间积分状态)
Y
13
修正回路工作原理
14
单轴陀螺稳定平台小节
15
3.4* 三轴陀螺稳定平台
r为横滚环, f为俯仰环, a为方位环, Mr、Mf、 Ma分别为 安装在相 应环架上 的电机, Gx、Gy、 Gz为敏感 轴相互正 交的3个陀 螺。这三 个敏感轴 就是平台 坐标系的 坐标轴。
=
1 0
ωiffz
0
0
cos θr − sin θr
0 sin
θ
r
ωωiirrrryx
+
θ0f
=
ωirry
ωr irx
+ θf
cos θf
+
ωr irz
sin
θf
cos
θr
ωirrz
0
ωirrz cos θf
−
ωr iry
sin
θf
方位环的角速度
cos θa sin θa 0
三轴陀螺稳定平台可以由三个单自由度陀螺组成,
也可由两个双自由度陀螺组成。
6
基于单自由度陀螺的平台 基于二自由度陀螺的平台 7
双自由度陀螺构成的单轴惯性平台
组成:陀螺、力矩器、信号器、放大器、电机、 平台台体。
8
3.3 双自由度陀螺构成单轴稳定平台的原理 利用双自由度陀螺构成单轴稳定平台,
稳定轴可选为与内环轴平行或与外环轴平行。