CN111123831B - 一种双轴伺服控制系统中消除内轴陀螺耦合漂移方法 - Google Patents

一种双轴伺服控制系统中消除内轴陀螺耦合漂移方法 Download PDF

Info

Publication number
CN111123831B
CN111123831B CN201911235764.8A CN201911235764A CN111123831B CN 111123831 B CN111123831 B CN 111123831B CN 201911235764 A CN201911235764 A CN 201911235764A CN 111123831 B CN111123831 B CN 111123831B
Authority
CN
China
Prior art keywords
axis
speed
servo control
control system
speeds
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
Application number
CN201911235764.8A
Other languages
English (en)
Other versions
CN111123831A (zh
Inventor
周璇
耿亚光
冯莎
崔雪兵
秦科娜
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hebei Hanguang Heavy Industry Ltd
Original Assignee
Hebei Hanguang Heavy Industry Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Hebei Hanguang Heavy Industry Ltd filed Critical Hebei Hanguang Heavy Industry Ltd
Priority to CN201911235764.8A priority Critical patent/CN111123831B/zh
Publication of CN111123831A publication Critical patent/CN111123831A/zh
Application granted granted Critical
Publication of CN111123831B publication Critical patent/CN111123831B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/401—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for measuring, e.g. calibration and initialisation, measuring workpiece for machining purposes
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/34—Director, elements to supervisory
    • G05B2219/34242—For measurement only

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Gyroscopes (AREA)

Abstract

本发明公开了一种双轴伺服控制系统中消除内轴陀螺耦合漂移方法，涉及伺服控制技术领域，能够在处于不具备标定转台设备的情况下，对俯仰轴陀螺的耦合数据进行准确测量。包括如下步骤：设置针对双轴伺服控制系统的测试条件。针对双轴伺服控制系统进行测试，并进行如下记录：方位轴分别以+5°/s、‑5°/s、+10°/s、‑10°/s的速度运动，运动速度稳定后，分别记录与以上四个速度对应的俯仰轴的输出速度平均值，分别为x1、x2、x3、x4；消除共模噪声。求解耦合系数K：K＝((x3‑x4)‑(x1‑x2))/10。双轴伺服控制系统中的俯仰轴速度输出为ω2、方位轴速度输出为ω1；以ω3为去耦后的俯仰轴速度输出，即ω3＝ω2‑Kω1。

Description

一种双轴伺服控制系统中消除内轴陀螺耦合漂移方法
技术领域
本发明涉及伺服控制技术领域，具体涉及一种双轴伺服控制系统中消除内轴陀螺耦合漂移方法。
背景技术
对于潜艇上的搜索光电桅杆稳定平台，该稳定平台方位为外环，俯仰为内环。该平台是以惯性器件陀螺为基准的稳定平台，因此陀螺的输出稳定性对平台的精度起决定性作用。但是由于安装等原因，方位轴、俯仰轴陀螺无法做到完全正交，方位轴运动时，俯仰陀螺就会耦合到方位轴的速度，从而产生漂移。由于设计之初时充分考虑了正交性，所以安装造成的陀螺耦合漂移速度较小，对于精度要求不高的场合，无需测量并消除陀螺由于耦合带来的漂移速度。对于高精度稳定平台，则需要测量安装在内环陀螺的耦合速度并消除掉。
传统方式是陀螺自身通过二轴标校转台进行单独标定，将耦合控制在可接受的范围；或者陀螺安装于产品后，将产品固定在二轴标校转台上，产品方位框架固定，标定转台进行方位摇摆，测量俯仰陀螺输出，边测量边调整俯仰陀螺的安装支架，直至俯仰陀螺输出达到可接受的范围。这两种方式适用于具备标校转台设备的试验室，不适用于不具备标定转台设备的安装或者维修现场的情况。
因此目前亟需一种能够在处于不具备标定转台设备的情况下，对内环陀螺即俯仰轴陀螺的耦合数据的准确测量方法。
发明内容
有鉴于此，本发明提供了一种双轴伺服控制系统中消除内轴陀螺耦合漂移方法，能够在处于不具备标定转台设备情况下，对俯仰轴陀螺的耦合数据进行准确测量。
为达到上述目的，本发明的技术方案包括如下步骤：
1)设置针对双轴伺服控制系统的测试条件：设置俯仰轴为陀螺闭环状态，且方位轴和俯仰轴静止时，俯仰轴漂移速度不超过2°/s。
2)针对双轴伺服控制系统进行测试，并进行如下记录：方位轴分别以+5°/s、-5°/s、+10°/s、-10°/s的速度运动，运动速度稳定后，分别记录与以上四个速度对应的俯仰轴的输出速度平均值，分别为x1、x2、x3、x4；其中x1对应方位轴以+5°/s的速度稳定运动时，俯仰轴输出的速度均值；x2对应方位轴以-5°/s的速度稳定运动时，俯仰轴输出的速度均值；x3对应方位轴以+10°/s的速度稳定运动时，俯仰轴输出的速度均值；x4分别对应方位轴以-10°/s的速度稳定运动时，俯仰轴输出的速度均值。
3)消除共模噪声：采用x1-x2以及x3-x4消除俯仰轴输出的速度中共有的噪声部分。
其中x1-x2对应的方位轴速度为10°/s；x3-x4对应的方位轴速度为20°/s。
4)求解耦合系数K：K＝((x3-x4)-(x1-x2))/10。
5)双轴伺服控制系统中的俯仰轴速度输出为ω2、方位轴速度输出为ω1；以ω3为去耦后的俯仰轴速度输出，即ω3＝ω2-Kω1。
有益效果：
本发明提供的一种双轴伺服控制系统中消除内轴陀螺耦合漂移方法，用于在不具备标定转台设备的安装或者维修现场的情况下，当安装精度无法满足内、外环完全正交时，可通过数据记录的方式，记录方位外轴运动时俯仰内轴的耦合速度，通过大量的数据记录，然后进行数据分析处理，计算出耦合系数，在俯仰轴陀螺输出数据中减去耦合系数与方位轴陀螺输出速度的乘积。本方法简单易行，适用于任何二维陀螺稳定平台。
附图说明
图1为本发明提供的一种双轴伺服控制系统中消除内轴陀螺耦合漂移方法流程图。
具体实施方式
下面结合附图并举实施例，对本发明进行详细描述。
本发明提供了一种双轴伺服控制系统中消除内轴陀螺耦合漂移方法，其流程如图1所示的，包括如下步骤
1)设置针对双轴伺服控制系统的测试条件：设置俯仰轴为陀螺闭环状态，且方位轴和俯仰轴静止时，俯仰轴漂移速度不超过2°/s。
2)针对双轴伺服控制系统进行测试，并进行如下记录：方位轴分别以+5°/s、-5°/s、+10°/s、-10°/s的速度运动，运动速度稳定后，分别记录俯仰轴陀螺与以上四个速度对应的输出，将俯仰轴输出的四个速度进行记录，记录后的数据进行求平均，记为x1、x2、x3、x4；其中x1对应方位轴以+5°/s的速度稳定运动时，俯仰轴输出的速度均值；x2对应方位轴以-5°/s的速度稳定运动时，俯仰轴输出的速度均值；x3对应方位轴以+10°/s的速度稳定运动时，俯仰轴输出的速度均值；x4分别对应方位轴以-10°/s的速度稳定运动时，俯仰轴输出的速度均值。
3)消除共模噪声：采用x1-x2以及x3-x4消除俯仰轴输出的速度中共有的噪声部分。
其中x1-x2对应的方位轴速度为10°/s；x3-x4对应的方位轴速度为20°/s。
共模噪声是指信号中出现的对地的不期望信号，这里取增量的方式来表式速度的目的就是消除每对速度中共有的噪声部分。
4)求解耦合系数K：K＝((x3-x4)-(x1-x2))/10。
5)双轴伺服控制系统中的俯仰轴速度输出为ω2、方位轴速度输出为ω1；以ω3为去耦后的俯仰轴速度输出，即ω3＝ω2-Kω1。
综上所述，以上仅为本发明的较佳实施例而已，并非用于限定本发明的保护范围。凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (1)

1.一种双轴伺服控制系统中消除内轴陀螺耦合漂移方法，其特征在于，包括如下步骤：
1)设置针对双轴伺服控制系统的测试条件：设置俯仰轴为陀螺闭环状态，且方位轴和俯仰轴静止时，俯仰轴漂移速度不超过2°/s；
2)针对所述双轴伺服控制系统进行测试，并进行如下记录：方位轴分别以+5°/s、-5°/s、+10°/s、-10°/s的速度运动，运动速度稳定后，分别记录与以上四个速度对应的俯仰轴的输出速度平均值，分别为x1、x2、x3、x4；其中x1对应方位轴以+5°/s的速度稳定运动时，俯仰轴输出的速度均值；x2对应方位轴以-5°/s的速度稳定运动时，俯仰轴输出的速度均值；x3对应方位轴以+10°/s的速度稳定运动时，俯仰轴输出的速度均值；x4分别对应方位轴以-10°/s的速度稳定运动时，俯仰轴输出的速度均值；
3)消除共模噪声：采用x1-x2以及x3-x4消除俯仰轴输出的速度中共有的噪声部分；
其中x1-x2对应的方位轴速度为10°/s；x3-x4对应的方位轴速度为20°/s；
4)求解耦合系数K：K＝((x3-x4)-(x1-x2))/10；
5)所述双轴伺服控制系统中的俯仰轴速度输出为ω2、方位轴速度输出为ω1；以ω3为去耦后的俯仰轴速度输出，即ω3＝ω2-Kω1。
CN201911235764.8A 2019-12-05 2019-12-05 一种双轴伺服控制系统中消除内轴陀螺耦合漂移方法 Active CN111123831B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911235764.8A CN111123831B (zh) 2019-12-05 2019-12-05 一种双轴伺服控制系统中消除内轴陀螺耦合漂移方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911235764.8A CN111123831B (zh) 2019-12-05 2019-12-05 一种双轴伺服控制系统中消除内轴陀螺耦合漂移方法

Publications (2)

Publication Number Publication Date
CN111123831A CN111123831A (zh) 2020-05-08
CN111123831B true CN111123831B (zh) 2022-12-02

Family

ID=70496155

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911235764.8A Active CN111123831B (zh) 2019-12-05 2019-12-05 一种双轴伺服控制系统中消除内轴陀螺耦合漂移方法

Country Status (1)

Country Link
CN (1) CN111123831B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112378558B (zh) * 2020-09-22 2022-01-21 河北汉光重工有限责任公司 一种测量伺服平台偏心力矩的方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2013144508A1 (fr) * 2012-03-30 2013-10-03 Parrot Procede de pilotage d'un drone a voilure tournante a rotors multiples avec estimation et compensation du vent lateral et du biais des accelerometres.
CN104635746A (zh) * 2013-11-14 2015-05-20 北京环境特性研究所 一种两轴四框架光电吊舱的伺服控制方法及系统
CN106441366A (zh) * 2016-10-18 2017-02-22 中国航空工业集团公司洛阳电光设备研究所 一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法
CN108375997A (zh) * 2018-02-15 2018-08-07 西安应用光学研究所 一种用于车载光电观瞄系统的两轴伺服控制系统正交性补偿方法
CN208384428U (zh) * 2018-07-02 2019-01-15 扬州曙光光电自控有限责任公司 基于反向位移补偿的稳定转台系统

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2013144508A1 (fr) * 2012-03-30 2013-10-03 Parrot Procede de pilotage d'un drone a voilure tournante a rotors multiples avec estimation et compensation du vent lateral et du biais des accelerometres.
CN104635746A (zh) * 2013-11-14 2015-05-20 北京环境特性研究所 一种两轴四框架光电吊舱的伺服控制方法及系统
CN106441366A (zh) * 2016-10-18 2017-02-22 中国航空工业集团公司洛阳电光设备研究所 一种两轴四框光电吊舱自动陀螺漂移补偿的实现方法
CN108375997A (zh) * 2018-02-15 2018-08-07 西安应用光学研究所 一种用于车载光电观瞄系统的两轴伺服控制系统正交性补偿方法
CN208384428U (zh) * 2018-07-02 2019-01-15 扬州曙光光电自控有限责任公司 基于反向位移补偿的稳定转台系统

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
一种陀螺稳定平台瞄准线漂移的惯性补偿方法;薛媛元等;《应用光学》;20160315(第02期);全文 *
大俯仰角度的两轴两框架平台稳定技术;李红光等;《应用光学》;20151115(第06期);全文 *
相控阵雷达导引头捷联去耦数字平台设计;孙彪;《电子设计工程》;20120705(第13期);全文 *

Also Published As

Publication number Publication date
CN111123831A (zh) 2020-05-08

Similar Documents

Publication Publication Date Title
KR101988786B1 (ko) 관성 항법 장치의 초기 정렬 방법
CN106052595B (zh) 基于激光陀螺捷联惯导的三轴转台轴线垂直度检测方法
CN109459054B (zh) 一种基于自准直跟踪的动基座姿态校准方法
CN104344836B (zh) 一种基于姿态观测的冗余惯导系统光纤陀螺系统级标定方法
CN101169323A (zh) 在室内用旋转靶标测量电视经纬仪动态测角精度的方法
WO2020164206A1 (zh) 一种旋转加速度计重力梯度仪标定方法
CN107843270A (zh) 一种光纤陀螺输入轴失准角温度模型建模方法
CN110895149B (zh) 局部基准传递对准精度内场测试系统及测试方法
CN111089576A (zh) 光纤陀螺实际输出值确定方法、光纤陀螺阀值测试方法
CN111123831B (zh) 一种双轴伺服控制系统中消除内轴陀螺耦合漂移方法
CN110849294B (zh) 一种基于光纤陀螺的转台非正交度测试方法
CN109974750B (zh) 一种基于模糊逻辑系统的环形激光器温度建模及补偿方法
CN111551164A (zh) 速率偏频激光陀螺寻北仪航向效应误差的补偿方法
CN109781145B (zh) 激光导引头mems陀螺的筛选测试系统及方法
CN103162712B (zh) 圆光栅测角偏差处理及轴系歪斜补偿方法
CN111488001A (zh) 一种快反镜复合稳定平台控制系统及其设计方法
CN102636184A (zh) 无角运动环境下基于离心机的挠性陀螺比力敏感项标定方法
CN110954131B (zh) 一种光纤陀螺输入轴失准角标定工装
CN104792339B (zh) 光纤陀螺测斜仪的校准方法
CN113390439A (zh) 一种双轴旋转捷联惯导系统旋转调制和自标定一体式方法
CN104006828A (zh) 一种惯性器件轴系误差标定方法
CN102183263A (zh) 一种光纤陀螺常值漂移的标定方法
CN104266660A (zh) 高精度光谱测速导航仪地面测试验证方法及系统
CN101750064A (zh) 一种提高捷联惯导温度误差补偿精度的方法及装置
CN110940357A (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
PE01 Entry into force of the registration of the contract for pledge of patent right

Denomination of invention: A method for eliminating coupling drift of inner axis gyroscope in a dual axis servo control system

Granted publication date: 20221202

Pledgee: China Construction Bank Corporation Handan Guangming Branch

Pledgor: HEBEI HANGUANG HEAVY INDUSTRY Ltd.

Registration number: Y2024980042869