CN113670340B - 基于x/y信号相位差辨识的半球谐振陀螺驻波方位角测量方法及系统 - Google Patents
基于x/y信号相位差辨识的半球谐振陀螺驻波方位角测量方法及系统 Download PDFInfo
- Publication number
- CN113670340B CN113670340B CN202111068201.1A CN202111068201A CN113670340B CN 113670340 B CN113670340 B CN 113670340B CN 202111068201 A CN202111068201 A CN 202111068201A CN 113670340 B CN113670340 B CN 113670340B
- Authority
- CN
- China
- Prior art keywords
- phase difference
- standing wave
- identification
- signal
- azimuth angle
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 30
- 238000005259 measurement Methods 0.000 claims abstract description 25
- 230000014509 gene expression Effects 0.000 claims description 13
- 239000011159 matrix material Substances 0.000 claims description 13
- 238000000691 measurement method Methods 0.000 claims description 7
- 230000005284 excitation Effects 0.000 claims description 5
- 238000001514 detection method Methods 0.000 abstract description 7
- 238000004088 simulation Methods 0.000 abstract description 4
- 238000004364 calculation method Methods 0.000 description 3
- 230000009191 jumping Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000005070 sampling Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 238000012804 iterative process Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
Abstract
Description
技术领域
本发明属于惯性技术领域,具体涉及一种基于X/Y信号相位差辨识的半球谐振陀螺驻波方位角测量方法及系统。
背景技术
半球谐振陀螺是在传统的机械转子式陀螺和光学陀螺的基础上发展起来的新一代高精度陀螺,是主流高精度惯性器件之一,已广泛应用在航空、航天、航海等领域。半球谐振陀螺工作原理是当存在外界角度输入时谐振子振动驻波由于科氏力的作用产生进动,并且进动角度与输入角度成正比。通过X/Y两路信号实时检测驻波位置,可以测量出外界输入角度及角速度。理想中X/Y两路信号为同相位振动信号,但由于两路检测信号参数不匹配以及温度等环境因素对电路参数的影响等导致两路信号存在相位差。通过传统的测角方法测量驻波进动角存在误差,降低陀螺测角精度。
综上所述,为了解决由于半球谐振陀螺X/Y两路检测信号存在相位差引起陀螺驻波方位角检测误差的问题,提出一种半球谐振陀螺X/Y信号存在相位差时的驻波方位角测量方法是非常有意义的。
发明内容
本发明的目的是为解决由于半球谐振陀螺X/Y两路检测信号存在相位差引起陀螺驻波方位角检测误差的问题,而提出基于X/Y信号相位差辨识的半球谐振陀螺驻波方位角测量方法及系统。
本发明为解决上述技术问题所采取的技术方案是:
一种基于X/Y信号相位差辨识的半球谐振陀螺驻波方位角测量方法,所述方法具体包括以下步骤:
步骤1、将半球谐振陀螺安装并固定在转台上,且半球谐振陀螺的敏感轴与转台的旋转轴重合;
步骤2、对半球谐振子进行参数激励,使谐振子的振动幅值稳定;
步骤3、使转台匀速旋转,并采集半球谐振陀螺X、Y两路振动信号和转台角度θr;
步骤4、利用锁相环生成参考信号Vrc和Vrs,并利用生成的参考信号分别对X、Y两路振动信号进行解调,得到解调后的信号Cx、Sx、Cy和Sy;
再对信号Cx、Sx、Cy和Sy进行二次组合,得到组合后的信号Q、S和R;
进一步地,所述步骤3中,采集的半球谐振陀螺X、Y两路振动信号的表达式为:
x=acos2θcos(wt+h1)-qsin2θsin(wt+h1)
y=asin2θcos(wt+h2)+qcos2θsin(wt+h2)
其中,x代表X路振动信号,y代表Y路振动信号,a代表主波波腹,θ代表主波波腹轴与X轴夹角,w代表振动频率,h1代表X轴振动相位与参考相位的差,t代表时间,q代表正交波波腹,h2代表Y轴振动相位与参考相位的差。
进一步地,所述参考信号Vrc和Vrs的表达式为:
Vrc=2cos(wt+h)
Vrs=2sin(wt+h)
其中,h代表参考信号初相。
进一步地,所述解调后的信号Cx、Sx、Cy和Sy的表达式为:
进一步地,所述组合后的信号Q、S和R的表达式为:
进一步地,所述步骤5中,建立的测角方程为:
步骤S2、计算当前时刻的值函数:
其中,r(0)代表初始时刻的值函数,θr(0)代表初始时刻的转台转角;
步骤S3、计算值函数当前时刻的雅可比矩阵:
其中,Jr(0)代表初始时刻的雅可比矩阵;
步骤S4、计算辨识参数当前时刻的增量
步骤S5、对下一时刻的辨识参数进行更新:
步骤S6、不断重复迭代步骤S2至步骤S5的过程,在迭代过程中,当前次迭代所利用的相位差和进动系数是前一次迭代获得的相位差和进动系数;
直至没有信号Q、S和R输入时停止迭代,并转至步骤S7;
一种基于X/Y信号相位差辨识的半球谐振陀螺驻波方位角测量系统,所述系统用于执行一种基于X/Y信号相位差辨识的半球谐振陀螺驻波方位角测量方法。
附图说明
图1为本发明方法的流程图;
图3为驻波方位角位置误差曲线图。
具体实施方式
具体实施方式一、结合图1说明本实施方式。本实施方式所述的一种基于X/Y信号相位差辨识的半球谐振陀螺驻波方位角测量方法,所述方法具体包括以下步骤:
步骤1、将半球谐振陀螺安装并固定在转台上,且半球谐振陀螺的敏感轴与转台的旋转轴重合;
步骤2、对半球谐振子进行参数激励,使谐振子的振动幅值稳定;
步骤3、使转台匀速旋转,并采集半球谐振陀螺X、Y两路振动信号和转台角度θr;
步骤4、利用锁相环生成参考信号Vrc和Vrs,并利用生成的参考信号分别对X、Y两路振动信号进行解调,得到解调后的信号Cx、Sx、Cy和Sy;
再对信号Cx、Sx、Cy和Sy进行二次组合,得到组合后的信号Q、S和R;
具体实施方式二、本实施方式与具体实施方式一不同的是:所述步骤3中,采集的半球谐振陀螺X、Y两路振动信号的表达式为:
x=acos2θcos(wt+h1)-qsin2θsin(wt+h1)
y=asin2θcos(wt+h2)+qcos2θsin(wt+h2)
其中,x代表X路振动信号,y代表Y路振动信号,a代表主波波腹,θ代表主波波腹轴与X轴夹角,w代表振动频率,h1代表X轴振动相位与参考相位的差,t代表时间,q代表正交波波腹,h2代表Y轴振动相位与参考相位的差。
本实施方式中的X轴与Y轴为空间直角坐标系下的X轴与Y轴。
其它步骤及参数与具体实施方式一相同。
具体实施方式三、本实施方式与具体实施方式一或二之一不同的是:所述参考信号Vrc和Vrs的表达式为:
Vrc=2cos(wt+h)
Vrs=2sin(wt+h)
其中,h代表参考信号初相。
其它步骤及参数与具体实施方式一或二相同。
具体实施方式四、本实施方式与具体实施方式一至三之一不同的是:所述解调后的信号Cx、Sx、Cy和Sy的表达式为:
其它步骤及参数与具体实施方式一至三之一相同。
具体实施方式五、本实施方式与具体实施方式一至四之一不同的是:所述组合后的信号Q、S和R的表达式为:
其它步骤及参数与具体实施方式一至四之一相同。
具体实施方式六、本实施方式与具体实施方式一至五之一不同的是:所述步骤5中,建立的测角方程为:
通过本实施方式建立的测角方程,可以精确描述振型的真实进动角。
其它步骤及参数与具体实施方式一至五之一相同。
步骤S2、计算当前时刻的值函数:
其中,r(0)代表初始时刻的值函数,θr(0)代表初始时刻的转台转角;
步骤S3、计算值函数当前时刻的雅可比矩阵:
其中,Jr(0)代表初始时刻的雅可比矩阵;
步骤S4、计算辨识参数当前时刻的增量
步骤S5、对下一时刻的辨识参数进行更新:
步骤S6、不断重复迭代步骤S2至步骤S5的过程,在迭代过程中,当前次迭代所利用的相位差和进动系数是前一次迭代获得的相位差和进动系数;
直至没有信号Q、S和R输入时停止迭代,并转至步骤S7;
其它步骤及参数与具体实施方式一至六之一相同。
其它步骤及参数与具体实施方式一至七之一相同。
由于通常两路振动信号的相位差小于10°且半球谐振陀螺进动因子c≈0.277,所以将相位差估计初值设置为0,将进动系数估计初值设置为0.3。
其它步骤及参数与具体实施方式一至八之一相同。
具体实施方式十、本实施方式的一种基于X/Y信号相位差辨识的半球谐振陀螺驻波方位角测量系统,所述系统用于执行具体实施方式一至具体实施方式九之一所述的一种基于X/Y信号相位差辨识的半球谐振陀螺驻波方位角测量方法。
以仿真实验为例实施本发明的过程如下:
步骤1、将半球谐振陀螺安装并固定在转台上,使陀螺敏感轴与转台的旋转轴重合;
步骤2、对半球谐振子进行参数激励(激励电极施加的信号,如信号的幅值、频率、相位),使得谐振子的振动信号幅值稳定;
步骤3、使转台以Ωr=100°/s的速度匀速旋转,设定采样频率为fs=1000Hz,采样时间为t=200s,采集陀螺X/Y两路振动信号,同时采集转台角度θr。设置X/Y两路振动信号相位差1°;
步骤4,利用锁相环生成的参考信号Vrc、Vrs分别对所述的振动信号进行解调,得到信号Cx、Sx、Cy、Sy再进行二次组合,得到Q、S、R信号;
辨识具体步骤如下:
S1:计算当前时刻的值函数
其中,θr为转台转角。
S2:计算值函数当前时刻的雅可比矩阵:
S3:计算辨识参数当前时刻的增量
S4:对下一时刻的辨识参数进行更新:
S5:判断是否还有信号Q、S、R输入,若有则跳到S1,若无则跳到步骤S6;
计算得到估计驻波方位角θest与真实驻波方位角θreal之间的位置误差,绘制的位置误差曲线如图3所示;
由图3的曲线可知,位置误差范围始终处在[-0.003°,0.0001°],证明本发明方法可以测量较高精度驻波方位角。
本发明的上述算例仅为详细地说明本发明的计算模型和计算流程,而并非是对本发明的实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动,这里无法对所有的实施方式予以穷举,凡是属于本发明的技术方案所引伸出的显而易见的变化或变动仍处于本发明的保护范围之列。
Claims (9)
1.基于X/Y信号相位差辨识的半球谐振陀螺驻波方位角测量方法,其特征在于,所述方法具体包括以下步骤:
步骤1、将半球谐振陀螺安装并固定在转台上,且半球谐振陀螺的敏感轴与转台的旋转轴重合;
步骤2、对半球谐振子进行参数激励,使谐振子的振动幅值稳定;
步骤3、使转台匀速旋转,并采集半球谐振陀螺X、Y两路振动信号和转台角度θr;
步骤4、利用锁相环生成参考信号Vrc和Vrs,并利用生成的参考信号分别对X、Y两路振动信号进行解调,得到解调后的信号Cx、Sx、Cy和Sy;
再对信号Cx、Sx、Cy和Sy进行二次组合,得到组合后的信号Q、S和R;
建立的测角方程为:
2.根据权利要求1所述的基于X/Y信号相位差辨识的半球谐振陀螺驻波方位角测量方法,其特征在于,所述步骤3中,采集的半球谐振陀螺X、Y两路振动信号的表达式为:
x=a cos2θcos(wt+h1)-q sin2θsin(wt+h1)
y=a sin2θcos(wt+h2)+q cos2θsin(wt+h2)
其中,x代表X路振动信号,y代表Y路振动信号,a代表主波波腹,θ代表主波波腹轴与X轴夹角,w代表振动频率,t代表时间,q代表正交波波腹。
3.根据权利要求2所述的基于X/Y信号相位差辨识的半球谐振陀螺驻波方位角测量方法,其特征在于,所述参考信号Vrc和Vrs的表达式为:
Vrc=2cos(wt+h)
Vrs=2sin(wt+h)。
步骤S2、计算初始时刻的值函数:
其中,r(0)代表初始时刻的值函数,θr(0)代表初始时刻的转台转角;
步骤S3、计算值函数初始时刻的雅可比矩阵:
其中,Jr(0)代表初始时刻的雅可比矩阵;
步骤S4、计算辨识参数初始时刻的增量
步骤S5、对下一时刻的辨识参数进行更新:
步骤S6、不断重复迭代步骤S2至步骤S5的过程,在迭代过程中,当前次迭代所利用的相位差和进动系数是前一次迭代获得的相位差和进动系数;
直至没有信号Q、S和R输入时停止迭代,并转至步骤S7;
9.基于X/Y信号相位差辨识的半球谐振陀螺驻波方位角测量系统,所述系统用于执行权利要求1至权利要求8之一所述的基于X/Y信号相位差辨识的半球谐振陀螺驻波方位角测量方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111068201.1A CN113670340B (zh) | 2021-09-13 | 2021-09-13 | 基于x/y信号相位差辨识的半球谐振陀螺驻波方位角测量方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111068201.1A CN113670340B (zh) | 2021-09-13 | 2021-09-13 | 基于x/y信号相位差辨识的半球谐振陀螺驻波方位角测量方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113670340A CN113670340A (zh) | 2021-11-19 |
CN113670340B true CN113670340B (zh) | 2022-05-27 |
Family
ID=78549287
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111068201.1A Active CN113670340B (zh) | 2021-09-13 | 2021-09-13 | 基于x/y信号相位差辨识的半球谐振陀螺驻波方位角测量方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113670340B (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113899365B (zh) * | 2021-11-22 | 2022-09-09 | 哈尔滨工业大学 | 基于半球谐振陀螺检测通路非对称性参数辨识的驻波方位角测量方法 |
CN114370886B (zh) * | 2021-11-23 | 2024-01-02 | 上海航天控制技术研究所 | 基于虚拟转动的全角模式振动陀螺测量误差自标定方法 |
CN114440852B (zh) * | 2022-03-15 | 2022-10-28 | 哈尔滨工业大学 | 一种半球谐振陀螺x/y通路驱动增益不对称性误差辨识方法 |
CN114440851B (zh) * | 2022-03-15 | 2023-06-13 | 哈尔滨工业大学 | 平板电极式半球谐振陀螺静态安装误差及参数辨识方法、存储介质及设备 |
CN114780903B (zh) * | 2022-05-05 | 2023-02-07 | 哈尔滨工业大学 | 一种半球谐振陀螺x/y通路驱动增益不对称性及电极非正交误差辨识方法 |
CN115077564B (zh) * | 2022-06-15 | 2023-05-12 | 哈尔滨工业大学 | 一种半球谐振陀螺检测通道不平衡误差辨识及补偿方法 |
CN114964197B (zh) * | 2022-07-29 | 2022-10-28 | 中国船舶重工集团公司第七0七研究所 | 一种谐振陀螺相位基准自补偿系统及补偿方法 |
CN115876178B (zh) * | 2022-12-19 | 2023-09-29 | 哈尔滨工业大学 | 平板电极式半球谐振陀螺的检测与驱动切换的控制方法 |
CN117330044A (zh) * | 2023-11-27 | 2024-01-02 | 四川图林科技有限责任公司 | 一种半球谐振陀螺的半球谐振子驻波输出电信号解调方法 |
CN117664186B (zh) * | 2024-02-01 | 2024-05-10 | 中国船舶集团有限公司第七〇七研究所 | 一种半球谐振陀螺驻波角度校准方法 |
CN117968653B (zh) * | 2024-03-28 | 2024-07-09 | 中国船舶集团有限公司第七〇七研究所 | 基于闭合回路的谐振陀螺角度计算方法及系统 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110865580A (zh) * | 2019-11-27 | 2020-03-06 | 中国船舶重工集团公司第七0七研究所 | 基于时分复用的半球谐振陀螺全差分控制系统及控制方法 |
CN112506040A (zh) * | 2020-11-16 | 2021-03-16 | 哈尔滨工程大学 | 一种全角半球谐振陀螺单通道控制系统及方法 |
CN112595302A (zh) * | 2020-12-09 | 2021-04-02 | 华中光电技术研究所(中国船舶重工集团公司第七一七研究所) | 一种基于Costas环的全数字半球谐振陀螺频率跟踪回路 |
CN113252019A (zh) * | 2021-05-13 | 2021-08-13 | 哈尔滨工业大学 | 一种前向放大系数不一致时的半球谐振陀螺振型角获取方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9989363B2 (en) * | 2014-01-14 | 2018-06-05 | Mitsubishi Electric Corporation | Hemispherical resonator gyro |
-
2021
- 2021-09-13 CN CN202111068201.1A patent/CN113670340B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110865580A (zh) * | 2019-11-27 | 2020-03-06 | 中国船舶重工集团公司第七0七研究所 | 基于时分复用的半球谐振陀螺全差分控制系统及控制方法 |
CN112506040A (zh) * | 2020-11-16 | 2021-03-16 | 哈尔滨工程大学 | 一种全角半球谐振陀螺单通道控制系统及方法 |
CN112595302A (zh) * | 2020-12-09 | 2021-04-02 | 华中光电技术研究所(中国船舶重工集团公司第七一七研究所) | 一种基于Costas环的全数字半球谐振陀螺频率跟踪回路 |
CN113252019A (zh) * | 2021-05-13 | 2021-08-13 | 哈尔滨工业大学 | 一种前向放大系数不一致时的半球谐振陀螺振型角获取方法 |
Non-Patent Citations (2)
Title |
---|
半球谐振陀螺控制及补偿技术;伊国兴等;《宇航学报》;20200630;第41卷(第6期);全文 * |
基于最小均方算法的半球谐振子特征参数辨识方法;郜中星等;《中国惯性技术学报》;20210215;第29卷(第1期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN113670340A (zh) | 2021-11-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113670340B (zh) | 基于x/y信号相位差辨识的半球谐振陀螺驻波方位角测量方法及系统 | |
CN113899365B (zh) | 基于半球谐振陀螺检测通路非对称性参数辨识的驻波方位角测量方法 | |
CN111896026B (zh) | 固态谐振陀螺自校准方法及系统 | |
CN111578923B (zh) | 一种谐振式陀螺闭环控制方法与系统 | |
CN113252019B (zh) | 一种前向放大系数不一致时的半球谐振陀螺振型角获取方法 | |
CN113551660B (zh) | 一种电极角度存在误差时的半球谐振陀螺振型角获取方法 | |
US9482553B2 (en) | Calibration systems and methods for gyroscopes | |
Wang et al. | Estimation of information sharing error by dynamic deformation between inertial navigation systems | |
WO2011091083A1 (en) | Apparatus and methodology for calibration of a gyroscope and a compass included in a handheld device | |
US5893054A (en) | Amplitude detection and automatic gain control of a sparsely sampled sinusoid by computation including a hilbert transform | |
CN111578966B (zh) | 一种基于lms算法的半球谐振子特征参数辨识方法 | |
CN113447047B (zh) | 速率积分陀螺检测电极误差辨识方法、装置、系统及介质 | |
CN114440852B (zh) | 一种半球谐振陀螺x/y通路驱动增益不对称性误差辨识方法 | |
CN101655371A (zh) | 一种基于变阻尼系数的惯性导航系统方位信号阻尼方法 | |
CN114858184B (zh) | 一种半球谐振子参数辨识方法 | |
CN116086485A (zh) | 半球谐振陀螺误差力补偿方法和装置 | |
CN115638780B (zh) | 一种谐振陀螺振动位移提取方法、控制系统及谐振陀螺 | |
CN116929322A (zh) | 一种全角模式半球谐振陀螺精确控制方法及系统 | |
CN110702110A (zh) | 一种基于无迹卡尔曼滤波的舰船升沉运动测量方法 | |
CN114780903B (zh) | 一种半球谐振陀螺x/y通路驱动增益不对称性及电极非正交误差辨识方法 | |
CN116412837A (zh) | 半球谐振陀螺力平衡模式校准电信号的生成方法 | |
CN117490729B (zh) | 一种半球谐振陀螺仪的正交漂移误差检测方法 | |
CN117110643A (zh) | 速率积分半球谐振陀螺角速率输出方法 | |
JP2001083224A (ja) | 磁界測定方法および装置 | |
CN109443333A (zh) | 一种陀螺阵列反馈加权融合方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |