CN105973270B - 一种陀螺定向仪角动量检测及补偿方法 - Google Patents
一种陀螺定向仪角动量检测及补偿方法 Download PDFInfo
- Publication number
- CN105973270B CN105973270B CN201610532457.6A CN201610532457A CN105973270B CN 105973270 B CN105973270 B CN 105973270B CN 201610532457 A CN201610532457 A CN 201610532457A CN 105973270 B CN105973270 B CN 105973270B
- Authority
- CN
- China
- Prior art keywords
- speed
- gyro
- angular momentum
- gyro machine
- hall element
- 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
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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
- G01C19/02—Rotary gyroscopes
- G01C19/34—Rotary gyroscopes for indicating a direction in the horizontal plane, e.g. directional gyroscopes
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Manufacturing & Machinery (AREA)
- Control Of Electric Motors In General (AREA)
- Control Of Motors That Do Not Use Commutators (AREA)
- Gyroscopes (AREA)
Abstract
本发明属于测量和定位定向技术领域,特别涉及一种陀螺定向仪角动量检测及补偿方法。本发明包括陀螺电机内部的定子上以120°间隔有3个霍尔元件1,在转轴的一周均匀分布着K个磁钢2,用来检测陀螺电机转速;当霍尔片上的电流恒定不变时,电机转速的变化导致垂直于电流方向的磁场强度发生变化,不同的磁场强度会使得霍尔元件的输出电压不同;当每个磁钢经过霍尔传感器时,霍尔元件便输出一个脉冲。本发明由霍尔元件能够精确的测量陀螺仪转子的实时转速,通过实时的转子速度与预期转子的速度差及速度差的变化率为输入,保证陀螺转子的速度能够得到相应的补偿,有效抑制陀螺转子的转速波动,达到提高陀螺寻北装置的寻北精度。
Description
技术领域
本发明属于测量和定位定向技术领域,特别涉及一种陀螺定向仪角动量检测及补偿方法。
背景技术
陀螺电机是为定向仪提供动量矩并使之具有陀螺效应的重要元件和敏感元件,转速的大小变化直接影响陀螺电机的角动量,影响寻北定向精度,是影响磁悬浮定向仪精度的重要因素。很多因素会导致无刷直流电机转速波动,引入寻北测量误差,包括电机自身结构引起的齿槽转矩影响、控制电流的非理想方波变化、电源的稳定性,都会导致电磁转矩的随机波动,从而引起转速的随机波动。
发明内容
本发明的目的在于提供一种在对陀螺定向仪进行测量补偿验证的基础上,通过对测量数据的分析提高稳速精度的陀螺定向仪角动量检测及补偿方法。
本发明的目的是这样实现的:
(1)陀螺电机内部的定子上以120°间隔有3个霍尔元件1,在转轴的一周均匀分布着K个磁钢2,用来检测陀螺电机转速;当霍尔片上的电流恒定不变时,电机转速的变化导致垂直于电流方向的磁场强度发生变化,不同的磁场强度会使得霍尔元件的输出电压不同;当每个磁钢经过霍尔传感器时,霍尔元件便输出一个脉冲,采用M/T法对霍尔元件输出的脉冲信号进行测量,得到陀螺电机转速;由霍尔元件输出电压的大小确定当前的陀螺电机转速;得到精确的陀螺电机转速的误差Δn,然后进行速度补偿控制,
即陀螺电机的角动量补偿;
(2)利用实时转速,得到实施转速误差Δn,实时补偿陀螺角动量,采用模糊控制和PID控制相结合的控制方法来对角动量进行补偿,模糊控制器为三维模糊控制器,输入分别为转速误差,转速变化率,转速误差变化的变化率,输出为PID控制器的参数变化率detkp,detki,detkd;
(3)将补偿后的角动量进行寻北;陀螺定向仪有陀螺电机、测角装置、力矩器和磁悬浮支撑组成
H:陀螺角动量,H=Jω=2πf=2πpn/60,n:转速;ωie:地球漂移角速率15.041(°h);φ:地理纬度;α北:陀螺电机轴与北向夹角;I:力反馈电流;KT:陀螺力矩系数;
(4)当陀螺电机的转速得到补偿后送入测角装置,补偿由于转速误差所带来的定向误差;
本发明的有益效果在于:
本发明由霍尔元件能够精确的测量陀螺仪转子的实时转速,通过实时的转子速度与预期转子的速度差及速度差的变化率为输入,通过模糊PID控制方法,使得力矩器做出相应的动作,保证陀螺转子的速度能够得到相应的补偿,即补偿陀螺转子的角动量,使得陀螺转子能维持稳定的高速转动,有效抑制陀螺转子的转速波动,达到提高陀螺寻北装置的寻北精度。
附图说明
图1为本发明专利陀螺电机结构图。
图2为霍尔元件实测转速结构图。
图3为本发明专利定向仪陀螺运动模型图。
图4为本发明流程图。
具体实施方式
下面结合附图对本发明做进一步描述。
本发明公开了一种陀螺定向仪陀螺角动量检测及补偿方法,能够完成陀螺电机转速测量并实现对电机转速引起陀螺角动量的补偿,从而实现陀螺角动量稳,提高了陀螺定向仪精度。利用陀螺电机内部的霍尔元件测量陀螺电机转速,利用测得的实时转速对陀螺角动量进行实时补偿,角动量参与定向寻北计算,补偿由于转速误差所带来的定向误差。本发明能够完成陀螺电机转速测量,能满足陀螺定向仪快速高精度定向的需求。本发明通过确定一种陀螺定向仪陀螺电机转速检测及补偿方法,能够完成陀螺电机转速测量并实现对电机转速引起陀螺角动量的补偿,从而实现陀螺角动量稳定。利用陀螺电机内部的霍尔元件测量陀螺电机转速。利用M/T算法进行电压信号到实时转速的转换。采用模糊控制和PID控制相结合的控制方法来对角动量进行补偿,模糊控制器设计为三维模糊控制器。将补偿后的角动量进行寻北,由寻北公式可知,当角动量波动较小时,寻北角度精度才更高,补偿由于转速误差所带来的定向误差。
陀螺定向仪寻北原理公式可知寻北定向精度与转速n相关。转速恒定则陀螺角动量稳定。
通过对磁悬浮定向仪进行原理性叙述,确定磁悬浮定向仪中陀螺电机转速是引起定向误差的一个误差源,同时它又是磁悬浮定向仪满足环境适应性的主要创新点,通过对磁悬浮分系统的理论分析,确定其检测、控制及误差补偿策略,控制精度对磁悬浮定向仪系统的精度影响,进行具有针对性的检测控制及补偿研究。
下面结合附图对本发明进一步说明。Step1:陀螺电机内部的定子上以120°间隔有3个霍尔元件1,在转轴的一周均匀分布着K个磁钢2,用来检测陀螺电机转速。当霍尔片上的电流恒定不变时,电机转速的变化导致垂直于电流方向的磁场强度发生变化,不同的磁场强度会使得霍尔元件的输出电压不同。当每个磁钢经过霍尔传感器时,霍尔元件便输出一个脉冲,这里采用M/T法对霍尔元件输出的脉冲信号进行测量,得到陀螺电机转速。由霍尔元件输出电压的大小便可以知道当前的陀螺电机转速。从而得到精确的陀螺电机转速的误差Δn,然后进行速度补偿控制,即陀螺电机的角动量补偿。
Step2:利用实时转速,得到实施转速误差Δn,实时补偿陀螺角动量,这里采用模糊控制和PID控制相结合的控制方法来对角动量进行补偿,模糊控制器设计为三维模糊控制器,输入分别为转速误差,转速变化率,转速误差变化的变化率,输出为PID控制器的参数变化率detkp,detki,detkd,这种设计能够使得转速补偿更为精确和快速。
Step3:将补偿后的角动量进行寻北。陀螺定向仪有陀螺电机3、测角装置4、力矩器5和磁悬浮支撑6组成。由寻北公式可知,当角动量波动较小时,寻北角度精度才更高。
注:H:陀螺角动量,H=Jω=2πf=2πpn/60,n:转速;ωie:地球漂移角速率15.041(°h);φ:地理纬度;α北:陀螺电机轴与北向夹角;I:力反馈电流;KT:陀螺力矩系数。
Step4:当陀螺电机的转速得到补偿后送入测角装置,补偿由于转速误差所带来的定向误差。
当转速得到补偿的时候,detn变小,detH变小,alpa的变化更小,及寻北稳定精度得到提高。
Claims (1)
1.一种陀螺定向仪角动量检测及补偿方法,其特征在于,包括如下步骤:
步骤1:陀螺电机内部的定子上以120°间隔有3个霍尔元件(1),在转轴的一周均匀分布着K个磁钢(2),用来检测陀螺电机转速;当霍尔元件上的电流恒定不变时,电机转速的变化导致垂直于电流方向的磁场强度发生变化,不同的磁场强度会使得霍尔元件的输出电压不同;当每个磁钢经过霍尔元件时,霍尔元件便输出一个脉冲,采用M/T法对霍尔元件输出的脉冲信号进行测量,得到陀螺电机转速;由霍尔元件输出电压的大小确定当前的陀螺电机转速;得到精确的陀螺电机转速的误差Δn,然后进行速度补偿控制,
即陀螺电机的角动量补偿;
步骤2:利用实时转速,得到实时转速误差Δn,实时补偿陀螺角动量,采用模糊控制和PID控制相结合的控制方法来对角动量进行补偿,模糊控制器为三维模糊控制器,输入分别为转速误差,转速变化率,转速误差变化的变化率,输出为PID控制器的参数变化率detkp,detki,detkd;
步骤3:将补偿后的角动量进行寻北;陀螺定向仪由陀螺电机、测角装置、力矩器和磁悬浮支撑组成
α=arc(sin(KTI定子I转子)Hωiecosφ)
H:陀螺角动量,H=Jω=J2πf=J 2πpn/60,n:转速;ωie:地球漂移角速率15.041°/h;φ:地理纬度;α:陀螺电机轴与北向夹角;I定子:力矩器定子电流;I转子:力矩器转子电流;KT:陀螺力矩系数;
步骤4:当陀螺电机的转速得到补偿后送入测角装置,补偿由于转速误差所带来的定向误差;α:计算的陀螺电机轴与北向夹角;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610532457.6A CN105973270B (zh) | 2016-07-07 | 2016-07-07 | 一种陀螺定向仪角动量检测及补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610532457.6A CN105973270B (zh) | 2016-07-07 | 2016-07-07 | 一种陀螺定向仪角动量检测及补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105973270A CN105973270A (zh) | 2016-09-28 |
CN105973270B true CN105973270B (zh) | 2019-06-11 |
Family
ID=56955140
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610532457.6A Active CN105973270B (zh) | 2016-07-07 | 2016-07-07 | 一种陀螺定向仪角动量检测及补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105973270B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107592056A (zh) * | 2017-05-27 | 2018-01-16 | 湖北三江航天万峰科技发展有限公司 | 用于磁悬浮定向仪的陀螺电机转速检测电路及补偿系统 |
CN110501516B (zh) * | 2018-05-16 | 2022-02-08 | 中国航天科工飞航技术研究院(中国航天海鹰机电技术研究院) | 用于超高速直线电机的组合测速系统和方法 |
CN110108265B (zh) * | 2019-04-25 | 2022-11-18 | 长安大学 | 一种自主获取地理纬度并自动寻北的陀螺测量仪器 |
CN111181467B (zh) * | 2020-01-15 | 2021-09-24 | 武汉理工大学 | 一种基于三维模糊控制的伺服电机转速调节方法及系统 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN201076760Y (zh) * | 2007-09-21 | 2008-06-25 | 深圳市艾特航模有限公司 | 采用微型陀螺仪控制系统的微型直升机 |
CN101382427A (zh) * | 2008-09-19 | 2009-03-11 | 哈尔滨工程大学 | 磁电复合式航向指示器及复合式航向指示方法 |
CN201620878U (zh) * | 2010-01-19 | 2010-11-03 | 王铁群 | 陀螺方位定向仪 |
CN102510164A (zh) * | 2011-11-30 | 2012-06-20 | 深圳市配天电机技术有限公司 | 一种陀螺稳定装置及具有该稳定装置的船 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2934677B1 (fr) * | 2008-07-29 | 2011-05-27 | Thales Sa | Dispositif d'actionneur gyroscopique a suspension magnetique |
-
2016
- 2016-07-07 CN CN201610532457.6A patent/CN105973270B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN201076760Y (zh) * | 2007-09-21 | 2008-06-25 | 深圳市艾特航模有限公司 | 采用微型陀螺仪控制系统的微型直升机 |
CN101382427A (zh) * | 2008-09-19 | 2009-03-11 | 哈尔滨工程大学 | 磁电复合式航向指示器及复合式航向指示方法 |
CN201620878U (zh) * | 2010-01-19 | 2010-11-03 | 王铁群 | 陀螺方位定向仪 |
CN102510164A (zh) * | 2011-11-30 | 2012-06-20 | 深圳市配天电机技术有限公司 | 一种陀螺稳定装置及具有该稳定装置的船 |
Non-Patent Citations (3)
Title |
---|
GAT高精度磁悬浮陀螺全站仪寻北关键技术及其应用研究;石震;《测绘学报》;20140430;第43卷(第4期);第436页 |
The Design of Compensating System about the Incline Pedestal of Magnetic Suspension Gyroscope;Huang Xian-xiang 等;《2010 International Conference on Computer Application and System Modeling》;20101231;第V4-669至V4-673页 |
永磁同步电机用线性霍尔位置检测的误差补偿;刘刚 等;《电机与控制学报》;20140831;第18卷(第8期);第36-42页 |
Also Published As
Publication number | Publication date |
---|---|
CN105973270A (zh) | 2016-09-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105973270B (zh) | 一种陀螺定向仪角动量检测及补偿方法 | |
CN105136170B (zh) | 一种悬浮转子类陀螺漂移误差高精度在线补偿方法 | |
CN101188393A (zh) | 基于n个霍尔传感器的磁悬浮飞轮电机的低速高精度控制系统 | |
CN101285690B (zh) | 光纤陀螺磁场-温度灵敏度测试方法 | |
CN105915139A (zh) | 一种矢量控制永磁同步伺服电机初始磁极位置搜索方法 | |
CN109067274A (zh) | 基于干扰补偿的永磁同步电机调速的积分滑模控制方法 | |
RU2324897C1 (ru) | Азимутальная ориентация платформы трехосного гиростабилизатора по углу прецессии гироблока | |
CN201163190Y (zh) | 一种陀螺罗盘伺服控制装置 | |
CN110231027A (zh) | 一种基于多传感器数据融合的定位系统及定位方法 | |
CN104065319B (zh) | 永磁同步电机零位初始角的标定方法 | |
CN107702731B (zh) | 一种对未知参数陀螺仪的测试方法 | |
CN103941756B (zh) | 微推力测量系统振动的非接触式主动控制方法 | |
CN103983259B (zh) | 基于摆式陀螺最大进动速度粗寻北原理的全方位寻北方法 | |
CN110307789A (zh) | 一种基于磁悬浮的浮子周向角位移可控装置 | |
CN103278657A (zh) | 动态指向式旋转导向钻井工具中稳定平台的转速测量机构 | |
WO2019084807A1 (zh) | 电机的机械位置获取方法和装置 | |
CN102645213B (zh) | 一种用于光纤陀螺寻北仪的锁紧定位机构 | |
CN103063205A (zh) | 一种用于寻北系统中四位置寻北测量的转位方法及机构 | |
CN110108276A (zh) | 一种利用磁悬浮陀螺精密测定地理纬度的方法 | |
CN106843293A (zh) | 一种用于高速滚转载体的陀螺稳定平台漂移抑制方法 | |
CN109039201A (zh) | 一种从旋转位置矢量中提取连续的转子位置信息的方法 | |
Sun et al. | Design of two-wheel self-balanced electric vehicle based on MEMS | |
CN106301131A (zh) | 一种永磁同步电机功角的测量方法 | |
CN103994759B (zh) | 一种摆式陀螺寻北仪快速限幅方法 | |
CN201885717U (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |