CN101158581A - 陀螺罗盘多位置自主定向寻北装置 - Google Patents
陀螺罗盘多位置自主定向寻北装置 Download PDFInfo
- Publication number
- CN101158581A CN101158581A CNA2007100562988A CN200710056298A CN101158581A CN 101158581 A CN101158581 A CN 101158581A CN A2007100562988 A CNA2007100562988 A CN A2007100562988A CN 200710056298 A CN200710056298 A CN 200710056298A CN 101158581 A CN101158581 A CN 101158581A
- Authority
- CN
- China
- Prior art keywords
- north
- scrambler
- output
- data
- module
- 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.)
- Granted
Links
Images
Landscapes
- Navigation (AREA)
Abstract
本发明涉及一种陀螺罗盘多位置自主定向寻北装置,其采用的技术方案是:转台处于定位位置时,控制器计算预先给定的转台定位位置与编码器输出角度值之间的误差,根据该误差值计算正确的控制量,输出调宽波以驱动电机,使转台转动到下一个定位位置;检测编码器零位与真北之间夹角的装置在一周范围内多个定位位置上接收陀螺的北向分量数据和编码器输出的角度值,拟合出北向分量与编码器角度值相应转位之间的曲线关系,精确地计算出编码器零位与真北之间的夹角。本发明寻北时间短,寻北精度高。
Description
技术领域
本发明涉及一种陀螺罗盘寻北装置,特别涉及一种陀螺罗盘多位置自主定向寻北装置。
背景技术
惯性寻北技术是惯性技术领域的重要组成部分,随着精确测量技术的发展,寻北定位也出现了诸多方法如:惯性法、天文观测法、大地测量法、卫星定位法、参照物法等多种高精度寻北方法。但是,在坑道、水下等复杂地形和复杂天候以及战争环境等特殊条件下,天文观测法,大地测量法、卫星定位法和参照物法都会受到不同程度的条件制约,或者精度低,或者根本无法实施。只有惯性法才能不受自然条件或环境的干扰,独立完成寻北任务,而且具有连续工作时间长、精度高等特点。因此,对惯性寻北方法的研究有它独特的应用价值。
近年来,随着导航技术的发展,低成本、快速、高精度陀螺寻北装置以它独特的优点在许多领域得到了广泛的应用,除了在航空、航天、航海导航及武器制导等方面具有非常重要的应用外,在其他如遂道施工、矿山开采、大地测量、资源勘测等民用工程领域中也越来越显示出广阔的应用前景。因此,开展陀螺寻北装置的研究在军事、民用领域都有重要的意义。
陀螺罗盘,是一种能自动寻找并跟踪当地地理子午面的导航仪器。陀螺罗盘是利用地球自转角速度和重力场的综合效应,使二自由度陀螺仪的自转轴自动寻找真北,这里的真北实际上就是地球自转角速度北向分量所确定的方向。它是以陀螺仪为敏感器指示真北的设备,它工作不依靠任何外部条件,也不需要其它航向仪表进行校正,自主性强是它的最大特点,因此而成为航海导航的主要设备。
发明内容
本发明要解决的技术问题是提供一种能够对转台进行快速、精确的分度定位控制,寻北时间短、寻北精度高的陀螺罗盘多位置自主定向寻北装置。
本发明的陀螺罗盘多位置自主定向寻北装置包括编码器,控制器,驱动器,电机,检测编码器零位与真北之间夹角的装置;当转台处于定位位置时,控制器采集编码器输出的位置数据,计算预先给定的转台定位位置与编码器输出角度值之间的误差,根据该误差值计算正确的控制量,输出调宽波;控制器输出的调宽波通过驱动器驱动电机,使转台转动到下一个定位位置;检测编码器零位与真北之间夹角的装置在一周范围内多个定位位置上接收陀螺的北向分量数据和编码器输出的角度值,拟合出北向分量与编码器角度值相应转位之间的曲线关系,计算出编码器零位与真北之间的夹角。
所述的控制器采用数字信号处理器。
作为控制器的数字信号处理器包括:
给定转台定位位置的模块;
采集编码器数据的模块;
计算给定的转台定位位置与编码器数据之间误差的模块;
根据给定的转台定位位置及给定的转台定位位置与编码器数据之间误差计算输出控制量的模块;
输出调宽波的模块。
由于转台转动到每一个定位位置时,控制器都会根据预先给定的转台定位位置与编码器输出数据之间的误差值计算正确的控制量,输出调宽波以驱动电机,使其带动转台转动到下一个定位位置,因而转台可以准确地停在每一个定位位置,从而使检测编码器零位与真北之间夹角的装置能够根据转台在一周范围内的多个定位位置上陀螺输出的北向分量数据和编码器输出的角度值,精确地计算出编码器零位与真北之间的夹角,寻北时间短,寻北精度高。
所述的检测编码器零位与真北之间夹角的装置包括A/D转换器,处理器,异步串行通讯芯片;当转台停在定位位置时,陀螺敏感当地地球自转角速度并输出北向分量,该北向分量通过A/D转换器转换为数字量;处理器接收并记录A/D转换器输出的北向分量数据和编码器输出的角度值,根据转台在一周范围内的多个定位位置上接收的陀螺北向分量数据和编码器输出的角度值,拟合出北向分量与编码器角度值相应转位之间的曲线关系,计算出编码器零位与真北之间的夹角。
所述的检测编码器零位与真北之间夹角的装置还可以包括低通滤波器;陀螺输出的北向分量先由低通滤波器去除噪声滤波后传输给A/D转换器,进一步提高了陀螺罗盘的寻北精度。
所述的处理器采用数字信号处理器。
作为处理器的数字信号处理器包括:
采集编码器输出数据的模块;
采集陀螺输出的北向分量数据的模块;
陀螺数据平滑滤波模块;
拟合出北向分量与编码器数据相应转位之间曲线关系的模块;
计算寻北角度的模块;
输出寻北角度的模块。
本发明可实现转台在一个周期内离散单点间隔测量,将两路正交的陀螺信号和编码器角度值输入处理器,旋转一周测量完毕后经过算法对所有的测量数据进行数据处理,输出地球正北方向与编码器零位的夹角,具有自主定向、定向时间短、精度高、轻便、成本低等优点,可广泛应用于矿山、建筑、铁路、森林及航天等行业。
下面结合附图和具体实施方式对本发明作进一步详细说明。
附图说明
图1为本发明结构示意图。图中1为编码器,2控制器,3驱动器,4电机,5检测编码器零位与真北之间夹角的装置,6低通滤波器,7为A/D转换器,8处理器,9异步串行通讯芯片。
图2为控制器内部程序流程图。
图3为处理器内部程序流程图。
具体实施方式
如图1所示,本发明的陀螺罗盘多位置自主定向寻北装置包括编码器1,控制器2,驱动器3,电机4,低通滤波器6,A/D转换器7,处理器8,异步串行通讯芯片9;编码器1安装在电机4输出轴上。动调陀螺垂直安装在转台上,其敏感轴与转台台面平行,转台由电机4带动转动。编码器1输出直接接到控制器2的并口,控制器2的PWM输出与驱动器3的输入连接,驱动器3的输出接到电机4电源正负极。首先,电机4转到起始位置,给定转台的各定位位置数据;转台每转到一个定位位置时,控制器2采集编码器1输出的位置数据,计算预先给定的转台定位位置与编码器1输出角度值之间的误差,根据该误差值计算正确的控制量,并按正确的控制量输出调宽波。控制器2输出的调宽波通过驱动器3驱动电机4,使转台转动到下一个定位位置;陀螺的电压输出通过低通滤波器6与A/D转换器7的输入连接,A/D转换器7的输出接到处理器8的并口;编码器1的串口同时通过异步串行通讯芯片9接到处理器8的并口。转台处于各定位位置时,陀螺敏感当地地球自转角速度并输出北向分量,该北向分量先由低通滤波器6去除噪声滤波后传输给A/D转换器7,然后由A/D转换器7将北向分量转换为数字量。处理器8接收并记录A/D转换器7输出的北向分量数据和编码器1输出的角度值,根据转台在一周范围内的多个定位位置上A/D转换器7输出的北向分量数据和编码器1输出的角度值,拟合出北向分量与编码器1角度值相应转位之间的正弦曲线关系,通过最小二乘估计方法计算出编码器1零位与真北之间的夹角。编码器1零位与真北之间的夹角值通过显示驱动器在数码管显示器上显示。
转台在一周范围内的定位位置可以是120个。
所述的控制器2采用数字信号处理器8,其内部程序包括下列步骤:
a、初始化;
b、电机4转到起始位置时,给定转台定位位置;
c、采集编码器1角度数据;
d、计算给定的转台定位位置与编码器1角度数据之间的误差;
e、根据给定的转台定位位置及给定的转台定位位置与编码器1角度数据之间的误差计算输出控制量;
f、根据控制量输出调宽波。
g、返回到步骤c。
所述的处理器8采用数字信号处理器8,其内部程序包括下列步骤:
a、开始;
b、初始化;
c、采集编码器1输出的角度数据;
d、采集陀螺输出的北向分量数据;
e、对陀螺输出的北向分量数据平滑滤波;
f、判断是否一周内所有定位位置数据都采集完,若是这转步骤g;否则返回步骤c;
g、采用最小二乘估计方法拟合出北向分量与编码器1数据相应转位之间正旋曲线关系;
h、计算寻北角度;
i、输出寻北角度;
j、结束。
所述的控制器2采用TMS320F2407,驱动器3采用L6203,电机4采用直流力矩电机4J75LYX011,低通滤波器6采用AD8628,A/D转换器7采用AD7667,处理器8采用TMS320VC33,异步串行通讯芯片9采用ST16C554,显示驱动器采用HD7221。
本发明实现了旋转转台的均匀多位置分度定位,对电机4的伺服控制采用分段PID调节,对每个点进行实时校正,以保证从启动到停止的快速稳定,不对陀螺产生冲击,并实现精确定位,使每个位置的定位误差不超过6′,准确地定位于均匀分布离散的位置测量点,有效地保证了陀螺每次转动一个位置后进行稳定测量的时间,是测量的稳定性和角度计算准确性的基础。
为了实现正弦曲线的最优拟合,提高寻北精度,必须对采集数据的有效处理方法,合理利用采集数据,使数据的整体拟合误差和最小,本发明采用了最小二乘方法对所采集的陀螺敏感到的地球自转北向分量数据进行拟合处理,并将拟合后的值与采集值比较,去除野值点和干扰点后进行二次改进最小二乘拟合,以提高正弦曲线的拟合精确度,保证了最终的寻北精度。
Claims (9)
1.一种陀螺罗盘多位置自主定向寻北装置,其特征在于包括编码器(1),控制器(2),驱动器(3),电机(4),检测编码器零位与真北之间夹角的装置(5);当转台处于定位位置时,控制器(2)采集编码器(1)输出的位置数据,计算预先给定的转台定位位置与编码器(1)输出角度值之间的误差,根据该误差值计算正确的控制量,输出调宽波;控制器(2)输出的调宽波通过驱动器(3)驱动电机(4),使转台转动到下一个定位位置;检测编码器零位与真北之间夹角的装置(5)在一周范围内多个定位位置上接收陀螺的北向分量数据和编码器(1)输出的角度值,拟合出北向分量与编码器(1)角度值相应转位之间的曲线关系,计算出编码器(1)零位与真北之间的夹角。
2.根据权利要求1所述的陀螺罗盘多位置自主定向寻北装置,其特征在于所述的控制器(2)采用数字信号处理器。
3.根据权利要求2所述的陀螺罗盘多位置自主定向寻北装置,其特征在于所述的数字信号处理器包括:
给定转台定位位置的模块;
采集编码器(1)数据的模块;
计算给定的转台定位位置与编码器(1)数据之间误差的模块;
根据给定的转台定位位置及给定的转台定位位置与编码器(1)数据之间误差计算输出控制量的模块;
输出调宽波的模块。
4.根据权利要求3所述的陀螺罗盘多位置自主定向寻北装置,其特征在于所述的控制器(2)采用TMS320F2407,驱动器(3)采用L6203,电机(4)采用直流力矩电机J75LYX011。
5.根据权利要求1所述的陀螺罗盘多位置自主定向寻北装置,其特征在于所述的检测编码器零位与真北之间夹角的装置(5)包括A/D转换器(7),处理器(8),异步串行通讯芯片(9);当转台停在定位位置时,陀螺敏感当地地球自转角速度并输出北向分量,该北向分量通过A/D转换器(7)转换为数字量;处理器(8)接收并记录A/D转换器(7)输出的北向分量数据和编码器(1)输出的角度值,根据转台在一周范围内的多个定位位置上接收的陀螺北向分量数据和编码器(1)输出的角度值,拟合出北向分量与编码器(1)角度值相应转位之间的曲线关系,计算出编码器(1)零位与真北之间的夹角。
6.根据权利要求5所述的陀螺罗盘多位置自主定向寻北装置,其特征在于所述的检测编码器零位与真北之间夹角的装置(5)还可以包括低通滤波器(6);陀螺输出的北向分量先由低通滤波器(6)去除噪声滤波后传输给A/D转换器(7)。
7.根据权利要求5或6任意一项权利要求所述的陀螺罗盘多位置自主定向寻北装置,其特征在于所述的处理器(8)采用数字信号处理器。
8.根据权利要求6所述的陀螺罗盘多位置自主定向寻北装置,其特征在于数字信号处理器包括:
采集编码器(1)输出数据的模块;
采集陀螺输出的北向分量数据的模块;
陀螺数据平滑滤波模块;
拟合出北向分量与编码器(1)数据相应转位之间曲线关系的模块;
计算寻北角度的模块;
输出寻北角度的模块。
9.根据权利要求8所述的陀螺罗盘多位置自主定向寻北装置,其特征在于所述的低通滤波器(6)采用AD8628,A/D转换器(7)采用AD7667,处理器(8)采用TMS320VC33,异步串行通讯芯片(9)采用ST16C554。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200710056298A CN100575876C (zh) | 2007-11-12 | 2007-11-12 | 陀螺罗盘多位置自主定向寻北装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200710056298A CN100575876C (zh) | 2007-11-12 | 2007-11-12 | 陀螺罗盘多位置自主定向寻北装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101158581A true CN101158581A (zh) | 2008-04-09 |
CN100575876C CN100575876C (zh) | 2009-12-30 |
Family
ID=39306747
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN200710056298A Expired - Fee Related CN100575876C (zh) | 2007-11-12 | 2007-11-12 | 陀螺罗盘多位置自主定向寻北装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN100575876C (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103487053A (zh) * | 2012-06-07 | 2014-01-01 | 中国人民解放军第二炮兵工程大学 | 一种任意二位置捷联寻北方法 |
CN103776434A (zh) * | 2012-10-23 | 2014-05-07 | 于中权 | 新型陀螺寻北仪和寻北方法 |
CN103825527A (zh) * | 2014-03-07 | 2014-05-28 | 东莞易步机器人有限公司 | 电机编码器定位方法及系统 |
CN104501791A (zh) * | 2014-12-18 | 2015-04-08 | 武真真 | 一种新型寻北仪 |
CN109470275A (zh) * | 2018-12-17 | 2019-03-15 | 中国科学院光电技术研究所 | 一种机动布站的光电经纬仪高精度自主定向方法 |
CN111207784A (zh) * | 2019-11-25 | 2020-05-29 | 中国航空工业集团公司洛阳电光设备研究所 | 一种零位可重写编码器及配套电写零系统 |
CN111307134A (zh) * | 2020-04-27 | 2020-06-19 | 武汉海达数云技术有限公司 | 电子罗盘标定方法、装置、系统和计算机可读存储介质 |
CN114237080A (zh) * | 2021-10-27 | 2022-03-25 | 中船九江精达科技股份有限公司 | 一种用于摇摆环境下的力矩电机旋转定位控制方法 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102506848B (zh) * | 2011-12-07 | 2014-03-26 | 浙江大学 | 一种基于四位置寻北法的光纤陀螺寻北仪转位机构 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1023620C (zh) * | 1990-05-23 | 1994-01-26 | 航空航天部第一设计研究院十五所 | 陀螺寻北仪 |
CN1105447A (zh) * | 1994-01-12 | 1995-07-19 | 中国有色金属工业23冶第三工程公司 | 具有光电测时信号转换装置的陀螺经纬仪自动定向系统 |
CN2411465Y (zh) * | 2000-03-01 | 2000-12-20 | 中国科学院长春光学精密机械与物理研究所 | 高精度光电自动寻北陀螺自准直经纬仪 |
-
2007
- 2007-11-12 CN CN200710056298A patent/CN100575876C/zh not_active Expired - Fee Related
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103487053A (zh) * | 2012-06-07 | 2014-01-01 | 中国人民解放军第二炮兵工程大学 | 一种任意二位置捷联寻北方法 |
CN103487053B (zh) * | 2012-06-07 | 2016-11-09 | 中国人民解放军第二炮兵工程大学 | 一种任意二位置捷联寻北方法 |
CN103776434A (zh) * | 2012-10-23 | 2014-05-07 | 于中权 | 新型陀螺寻北仪和寻北方法 |
CN103776434B (zh) * | 2012-10-23 | 2017-10-20 | 于中权 | 新型陀螺寻北仪和寻北方法 |
CN103825527A (zh) * | 2014-03-07 | 2014-05-28 | 东莞易步机器人有限公司 | 电机编码器定位方法及系统 |
CN104501791A (zh) * | 2014-12-18 | 2015-04-08 | 武真真 | 一种新型寻北仪 |
CN109470275A (zh) * | 2018-12-17 | 2019-03-15 | 中国科学院光电技术研究所 | 一种机动布站的光电经纬仪高精度自主定向方法 |
CN111207784A (zh) * | 2019-11-25 | 2020-05-29 | 中国航空工业集团公司洛阳电光设备研究所 | 一种零位可重写编码器及配套电写零系统 |
CN111307134A (zh) * | 2020-04-27 | 2020-06-19 | 武汉海达数云技术有限公司 | 电子罗盘标定方法、装置、系统和计算机可读存储介质 |
CN114237080A (zh) * | 2021-10-27 | 2022-03-25 | 中船九江精达科技股份有限公司 | 一种用于摇摆环境下的力矩电机旋转定位控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN100575876C (zh) | 2009-12-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN100575876C (zh) | 陀螺罗盘多位置自主定向寻北装置 | |
CN105352495B (zh) | 加速度与光流传感器数据融合无人机水平速度控制方法 | |
CN101608920B (zh) | 一种组合式空间位姿精密动态测量装置及方法 | |
CN103900571B (zh) | 一种基于惯性坐标系旋转型捷联惯导系统的载体姿态测量方法 | |
CN202351708U (zh) | 一种新型飞行器导航测控系统 | |
CN102901977B (zh) | 一种飞行器的初始姿态角的确定方法 | |
CN103712622B (zh) | 基于惯性测量单元旋转的陀螺漂移估计补偿方法及装置 | |
CN102207386A (zh) | 基于方位效应误差补偿的寻北方法 | |
CN109282804B (zh) | 一种单轴光纤陀螺寻北算法 | |
CN114148536B (zh) | 一种用于光电吊舱的线位移补偿控制方法 | |
CN105387858B (zh) | 一种游艇智能导航系统及工作方法 | |
CN105588565B (zh) | 一种基于冗余配置的捷联惯导系统双轴旋转调制方法 | |
CN105737812B (zh) | 一种单轴激光寻北仪的多位置自寻北方法 | |
CN103983474A (zh) | 一种水质采样多旋翼飞行器 | |
CN112378399A (zh) | 基于捷联惯导和数字全站仪的煤矿巷道掘进机器人精确定位定向方法 | |
CN201163190Y (zh) | 一种陀螺罗盘伺服控制装置 | |
CN104266647A (zh) | 一种基于转位寻北技术的抗扰动快速寻北仪及其寻北方法 | |
CN101929862A (zh) | 基于卡尔曼滤波的惯性导航系统初始姿态确定方法 | |
CN105136163A (zh) | 一种基于双位置特征的磁悬浮陀螺寻北数据粗差剔除方法 | |
CN100498227C (zh) | 一种在线实时消除捷联惯性导航系统陀螺常值漂移的方法 | |
CN101187558A (zh) | 寻北装置 | |
CN105300407A (zh) | 一种用于单轴调制激光陀螺惯导系统的海上动态启动方法 | |
CN113639744B (zh) | 一种用于仿生机器鱼的导航定位方法和系统 | |
CN105203133B (zh) | 一种带旋转机构的惯性导航系统用测角装置快速寻零方法 | |
CN201133818Y (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 | ||
C17 | Cessation of patent right | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20091230 Termination date: 20111112 |