CN103278161B - 一种惯性方位保持*** - Google Patents
一种惯性方位保持*** Download PDFInfo
- Publication number
- CN103278161B CN103278161B CN201310179820.7A CN201310179820A CN103278161B CN 103278161 B CN103278161 B CN 103278161B CN 201310179820 A CN201310179820 A CN 201310179820A CN 103278161 B CN103278161 B CN 103278161B
- Authority
- CN
- China
- Prior art keywords
- angle
- gyro
- solver
- pitching
- axis
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Landscapes
- Navigation (AREA)
Abstract
本发明提供一种惯性方位保持***,包括固定在载体上的旋转变压器、加表传感器和倾角传感器,还包括一只陀螺、一只加速度计、一个方位环、一个纵摇环、角度采集器、AD采集器Ⅰ、解算器、两个DA补偿器、水平电机和方位电机,纵摇环内固定一个平台,陀螺和加速度计固定在该平台上;AD采集器Ⅰ采集加速度计检测的陀螺的加速度信号输出到解算器,角度采集器采集旋转变压器、加表传感器和倾角传感器检测出的旋变读角ψxb、俯仰角θ和横滚角γ三个角度信号输出到解算器进行解算,解算器进行解算后输出信号驱动纵摇环旋转俯仰角和方位环旋转方位角,使得陀螺的旋转轴线仍然始终指向地理北向。该***具有体积小、成本低、维修性好的特点。
Description
技术领域
本发明涉及平台式惯性导航***,具体涉及一种惯性方位保持***。
背景技术
现有的平台式惯性导航***主要有三只环体或者两只环体两种结构,无论采用哪种结构式,都要采用3只挠性陀螺、3只加速度计或者2只挠性陀螺、2只加速度计,组成跟踪地理坐标系的平台***,利用陀螺的进动性,对陀螺进行施距控制,使陀螺的旋转轴的轴线始终保持在当地地理坐标系O-XoYoZo的OXoYo水平面,同时使得陀螺的旋转轴的轴线始终指向地理北向,这种***存在平台框架结构大、成本高、维修性差的缺陷。
发明内容
针对现有技术存在的上述不足,本发明的目的是采用一种惯性方位保持***,以解决平台框架结构大,成本高,维修性差的问题。
为了实现上述发明目的,本发明采用了如下技术方案:
一种惯性方位保持***,包括一个方位环、一个纵摇环、解算器、DA补偿器Ⅰ、DA补偿器Ⅱ、水平电机、方位电机、子***Ⅰ和子***Ⅱ;
子***Ⅰ包括一只陀螺、一只加速度计和AD采集器Ⅰ,加速度计检测陀螺的加速度信号并将该信号输入AD采集器Ⅰ,AD采集器Ⅰ转化后的数字信号Ⅰ输入解算器;
子***Ⅱ包括角度采集器和固定在载体上的角度传感器组件,角度传感器组件包括旋转变压器、加表传感器和倾角传感器,旋转变压器检测载体纵轴在水平面的投影与地理子午线之间的旋变读角ψxb,加表传感器检测载体纵轴与纵向水平轴之间的俯仰角θ,倾角传感器检测载体纵向对称面与纵向铅垂面之间的横滚角γ,将旋变读角ψxb、俯仰角θ和横滚角γ输入角度采集器,角度采集器分别转换后,再将转换后的数字信号Ⅱ输入解算器;
解算器根据输入的数字信号Ⅰ和数字信号Ⅱ进行解算,然后将解算后的数字信号Ⅲ输入DA补偿器Ⅱ,DA补偿器Ⅱ产生驱动水平电机的电流,水平电机驱动纵摇环旋转;
解算器根据输入的数字信号Ⅱ进行解算,然后将解算后的数字信号Ⅳ输入DA补偿器Ⅰ,DA补偿器Ⅰ产生驱动方位电机的电流,方位电机驱动方位环旋转;
纵摇环内固定一个平台Ⅰ,陀螺和加速度计固定在所述平台Ⅰ上。
相比现有技术,本发明具有如下有益效果:
1、减少了传感器数量:陀螺由两只减为一只,加速度计由两只减为一只,降低了成本;
2、减少了平台的环体:原来为三环设计:方位环、纵摇环和横摇环,现在为两环设计:方位环和纵摇环,降低成本,减小了体积,减少了加工时间和装配时间;
3、由于减少了传感器数量,通过误差补偿的办法,不需要进行水平陀螺的控制,减少了控制所需的硬件,简化了结构设计和硬件设计;
4、整个***便于维修。
附图说明
图1是一种惯性方位保持***的结构示意图;
图2是导航坐标系;
图3是旋变角度与方位角不一致的坐标示意图。
具体实施方式
图1是一种惯性方位保持***的结构示意图,该***包括一个方位环3、一个纵摇环7、解算器11、DA补偿器Ⅰ10、DA补偿器Ⅱ6、水平电机5、方位电机9、子***Ⅰ和子***Ⅱ。
子***Ⅰ包括一只陀螺4、一只加速度计2、AD采集器Ⅰ12,加速度计检测到的陀螺的加速度信号并将该信号输入AD采集器Ⅰ,AD采集器Ⅰ转化后输出数字信号Ⅰ到解算器。
子***Ⅱ包括角度采集器13和固定在载体上的角度传感器组件1,角度传感器组件1包括旋转变压器、加表传感器和倾角传感器,旋转变压器检测载体纵轴在水平面的投影与地理子午线之间的旋变读角ψxb,加表传感器检测载体纵轴与纵向水平轴之间的俯仰角θ,倾角传感器检测载体纵向对称面与纵向铅垂面之间的横滚角γ,其中的载体为飞行器、船舶、车辆、钻探机或钻井机。将旋变读角ψxb、俯仰角θ、横滚角γ输入角度采集器,角度采集器分别转换后,然后将转换后的数字信号Ⅱ输入解算器。
解算器根据输入的数字信号Ⅰ和数字信号Ⅱ解算出俯仰角后,输出与俯仰角相应的数字信号Ⅲ到DA补偿器Ⅱ,DA补偿器Ⅱ产生驱动水平电机的电流,水平电机驱动纵摇环旋转俯仰角,使得陀螺的旋转轴的轴线始终保持在当地地理坐标系O-XoYoZo的OXoYo水平面。
解算器根据输入的数字信号Ⅱ解算出方位角后,输出与方位角相应的数字信号Ⅳ到DA补偿器Ⅰ,DA补偿器Ⅰ产生驱动方位电机的电流,方位电机驱动方位环旋转方位角,使得陀螺的旋转轴的轴线始终指向地理北向。
纵摇环内固定一个平台Ⅰ15,陀螺、加速度计固定在所述平台Ⅰ上。
安装加速度计和陀螺时,要保证加速度计的敏感轴的轴线14与陀螺的旋转轴的轴线8在同一条直线上,该直线与平台Ⅰ的平面平行并且与纵摇环的纵摇轴的轴线垂直相交,以提高***的定位精度。
方位环的方位轴的轴线16与纵摇环的纵摇轴的轴线17垂直相交,以提高***的定位精度。
采用图1所示的惯性方位保持***,如果不进行方位角的修正,将产生方位角误差,如图2和图3所示,该误差为***误差,该误差大到足以造成该***不能实际投入使用,由于存在这样的问题,这也就是为什么至今没有由一只陀螺和一只加速度计组成的双轴***或者三轴的主要原因。通过误差修正的方式来解决该问题,为此,建立该***的误差修正公式,其分析和推导过程如下:
建立导航坐标系,如图2所示,地理坐标系:O-XoYoZo,坐标系的原点在载体的质量中心,Xo、Yo、Zo轴分别从原点出发指向东、北和天向,Xo、Yo、Zo轴构成右手坐标系;载体坐标系:O-XbYbZb,该坐标系与载体固联,坐标的原点在载体的质量中心,Xb指向载体运动方向的右侧并垂直于运动方向,Yb指向载体的运动方向,Zb轴向上,Xb、Yb、Zb轴构成右手坐标系。
各角度及正方向定义:
方位角:载体纵轴在水平面的投影与地理子午线之间的夹角,用ψ表示,规定以地理北向为起点,偏东为正,定义域为0~360°;
俯仰角:载体纵轴与纵向水平轴之间的夹角,用θ表示,规定以纵向水平轴为起点,抬头为正,低头为负,定义域-90°~+90°;
横滚角:载体纵向对称面与纵向铅垂面之间的夹角,用γ表示,规定从铅垂面算起,右倾向下为正,左倾向下为负,定义域-180°~+180°;
设角度采集器分别通过旋转变压器、加表传感器和倾角传感器采集到对应的角度为旋变读角ψxb、俯仰角θ、横滚角γ。
导航坐标系按以下次序旋转,如图2和图3所示:
没有误差的方位角为ψ,而旋转变压器输出旋变读角ψxb,但其固定载体上不会随着陀螺调平而调平,那么在载体倾斜、横滚的时候,旋变读角ψxb和方位角ψ不一致,直接用旋变读角ψxb代替方位角就出现了方位角误差,这就是产生方位角误差的直接原因。
导航的旋转矩阵:
假设:有误差的俯仰角为θ′、有误差的横滚角为γ′,0刻度线为惯性方位保持***原始基线,0刻度线与载体运动方向一致;将O-XbYbZb反转回到O-X0Y0Z0,按照反转法原理,采用ψxb,θ′,γ′来构造旋转矩阵,三次旋转的过程为:
(a)O-XbYbZb绕Zb转-ψxb,使Yb与旋变0刻度线重合,变为O-X1Y1Z1;
(b)O-X1Y1Z1绕X1转-θ′,使Y1与Yn轴重合,变为O-X2Y2Z2;
(c)O-X2Y2Z2绕Y2转-γ′,使坐标系完全变为O-X0Y0Z0;
旋转矩阵分别为:
由于:
其中ψxb,θ和γ(其为旋转变压器、加表传感器和倾角传感器测量得)已知,ψ,θ′,γ′未知,可以求得:
由此可知,方位角ψ是ψxb、θ、γ的函数:
ψ=f(ψxb,θ,γ)(7)
具体地,方位角ψ是ψxb、θ、γ的反正切函数:
ψ=atan(ψxb,θ,γ)(8)
反求(6)式可以得:
方位角ψ按照上述计算式进行修正计算。
因此,角度采集器分别通过旋转变压器、加表传感器和倾角传感器采集到对应的旋变读角ψxb、俯仰角θ、横滚角γ的三个角度信号,该三个角度信号输入解算器,解算器按照公式(9)进行修正计算得到方位角ψ并产生与方位角ψ相应的数字信号Ⅳ,该数字信号Ⅳ输入DA补偿器Ⅰ产生驱动方位电机的电流,方位电机驱动方位环旋转方位角ψ,使得陀螺的旋转轴的轴线始终指向地理北向,这样就修正了***产生的方位角误差。
在图1的惯性方位保持***中,陀螺和加速度计固定在纵摇环的平台Ⅰ上的固定方式为螺栓固定或者铆接固定等常规的固定方式;水平电机的旋转轴和方位电机的旋转轴分别与纵摇环的纵摇轴和方位环的方位轴联结并传递旋转运动和动力,其联结方式为常规联结方式。旋转变压器、加表传感器和倾角传感器为常规的角度传感器。角度采集器为常规的获取角度信号的控制电路,AD采集器Ⅰ为常规的将模拟信号转换为数字信号的转换电路和控制电路,解算器为常规的单片机***或者计算机***,DA补偿器Ⅰ和DA补偿器Ⅱ为常规的将数字信号转换为电信号的转换电路和控制电路。
由此可知,采用图1所示的惯性方位保持***,陀螺和加速度计的数量均只有一只,不但降低了成本,还不需要进行水平陀螺的控制,减少了控制所需的硬件,简化了结构设计和硬件设计,又进一步降低了成本;减少了平台的环体,原来为三环结构:方位环、纵摇环和横摇环,现在为两环结构:方位环和纵摇环,降低成本,减小了体积,减少了加工时间和装配时间;整个***也便于维修。
陀螺最好采用挠性陀螺,以获得更为准确的定位精度。
Claims (4)
1.一种惯性方位保持***,其特征在于:所述惯性方位保持***包括一个方位环、一个纵摇环、解算器、DA补偿器Ⅰ、DA补偿器Ⅱ、水平电机、方位电机、子***Ⅰ和子***Ⅱ;
子***Ⅰ包括一只陀螺、一只加速度计和AD采集器Ⅰ,加速度计检测陀螺的加速度信号并将该信号输入AD采集器Ⅰ,AD采集器Ⅰ转化后的数字信号Ⅰ输入解算器;
子***Ⅱ包括角度采集器和固定在载体上的角度传感器组件,角度传感器组件包括旋转变压器、加表传感器和倾角传感器,旋转变压器检测载体纵轴在水平面的投影与地理子午线之间的旋变读角ψxb,加表传感器检测载体纵轴与纵向水平轴之间的俯仰角θ,倾角传感器检测载体纵向对称面与纵向铅垂面之间的横滚角γ,将旋变读角ψxb、俯仰角θ和横滚角γ输入角度采集器,角度采集器分别转换后,再将转换后的数字信号Ⅱ输入解算器;
解算器根据输入的数字信号Ⅰ和数字信号Ⅱ进行解算,然后将解算后的数字信号Ⅲ输入DA补偿器Ⅱ,DA补偿器Ⅱ产生驱动水平电机的电流,水平电机驱动纵摇环旋转;
解算器根据输入的数字信号Ⅱ进行解算,然后将解算后的数字信号Ⅳ输入DA补偿器Ⅰ,DA补偿器Ⅰ产生驱动方位电机的电流,方位电机驱动方位环旋转;
纵摇环内固定一个平台Ⅰ,陀螺和加速度计固定在所述平台Ⅰ上。
2.如权利要求1所述的一种惯性方位保持***,其特征在于:方位环的方位轴的轴线与纵摇环的纵摇轴的轴线垂直相交。
3.如权利要求1所述的一种惯性方位保持***,其特征在于:加速度计的敏感轴的轴线与陀螺的旋转轴的轴线在同一条直线上,该直线与平台Ⅰ的平面平行并且与纵摇环的纵摇轴的轴线垂直相交。
4.如权利要求1、2或3所述的一种惯性方位保持***,其特征在于:所述陀螺采用挠性陀螺。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310179820.7A CN103278161B (zh) | 2013-05-15 | 2013-05-15 | 一种惯性方位保持*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310179820.7A CN103278161B (zh) | 2013-05-15 | 2013-05-15 | 一种惯性方位保持*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103278161A CN103278161A (zh) | 2013-09-04 |
CN103278161B true CN103278161B (zh) | 2015-11-18 |
Family
ID=49060749
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310179820.7A Expired - Fee Related CN103278161B (zh) | 2013-05-15 | 2013-05-15 | 一种惯性方位保持*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103278161B (zh) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101417711A (zh) * | 2008-11-10 | 2009-04-29 | 北京航空航天大学 | 两轴平衡环架的扰动补偿装置 |
CN102230801A (zh) * | 2011-03-30 | 2011-11-02 | 北京航空航天大学 | 一种轻量型航空遥感三轴惯性稳定平台*** |
CN102278989A (zh) * | 2011-07-29 | 2011-12-14 | 北京航空航天大学 | 一种多功能航空遥感三轴惯性稳定平台*** |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
NL1006599C2 (nl) * | 1997-07-16 | 1999-01-19 | Hollandse Signaalapparaten Bv | Stelsel voor het stabiliseren van een op een beweegbaar platform geplaatst object. |
-
2013
- 2013-05-15 CN CN201310179820.7A patent/CN103278161B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101417711A (zh) * | 2008-11-10 | 2009-04-29 | 北京航空航天大学 | 两轴平衡环架的扰动补偿装置 |
CN102230801A (zh) * | 2011-03-30 | 2011-11-02 | 北京航空航天大学 | 一种轻量型航空遥感三轴惯性稳定平台*** |
CN102278989A (zh) * | 2011-07-29 | 2011-12-14 | 北京航空航天大学 | 一种多功能航空遥感三轴惯性稳定平台*** |
Non-Patent Citations (2)
Title |
---|
方位保持仪姿态误差补偿技术;李磊磊等;《北京理工大学学报》;20041230;第24卷(第12期);第1902-1905页 * |
自动惯性方位测量***及其用途;James A Shearer;《国外导弹技术》;19821227(第12期);第47-55页 * |
Also Published As
Publication number | Publication date |
---|---|
CN103278161A (zh) | 2013-09-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102749079B (zh) | 一种光纤捷联惯导双轴旋转调制方法及双轴旋转机构 | |
CN101900559B (zh) | 一种捷联惯性导航***双轴旋转调制方法 | |
CN103256930B (zh) | 一种惯性方位保持*** | |
CN103245360A (zh) | 晃动基座下的舰载机旋转式捷联惯导***自对准方法 | |
CN103822624B (zh) | 一种单轴激光陀螺寻北仪及其寻北方法 | |
CN103344226B (zh) | 一种基于mems旋转技术的寻北***及方法 | |
CN102087110B (zh) | 微型水下运动体自主姿态检测装置及方法 | |
CN102207386A (zh) | 基于方位效应误差补偿的寻北方法 | |
CN116734887B (zh) | 基于速度误差修正模型的极地双惯导协同标定方法 | |
CN102768043B (zh) | 一种无外观测量的调制型捷联***组合姿态确定方法 | |
CN104964688B (zh) | 基于捷联惯性导航的采煤机防爆定位装置及其校准方法 | |
CN106052682A (zh) | 一种混合式惯性导航***及导航方法 | |
CN109269526B (zh) | 基于阻尼网络的旋转式格网惯导水平阻尼方法 | |
CN105841698A (zh) | 一种无需调零的auv舵角精确实时测量*** | |
CN104121926A (zh) | 双轴旋转惯导***转轴与敏感轴间安装误差角的标校方法 | |
CN102003967A (zh) | 基于罗经原理的旋转式船用捷联惯导方位对准方法 | |
CN106767925A (zh) | 带双轴转位机构的惯导***三位置参数辨识对准方法 | |
CN106767806A (zh) | 一种用于混合式惯性导航***的物理平台 | |
CN116481564B (zh) | 基于Psi角误差修正模型的极地双惯导协同标定方法 | |
CN102519425A (zh) | 单自由度船用激光测距仪稳定平台及控制方法 | |
CN103743378A (zh) | 一种管道检测器姿态检测*** | |
CN102538789B (zh) | 一种双轴连续旋转调制式惯性导航***的旋转方法 | |
CN107830873B (zh) | 一种基于单轴水平旋转惯导与里程计组合的高精度车辆定位定向方法 | |
CN103900566A (zh) | 一种消除地球自转角速度对旋转调制型捷联惯导***精度影响的方法 | |
CN106123917A (zh) | 考虑外杆臂效应的捷联惯导***罗经对准方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20151118 Termination date: 20210515 |