CN110081879A - 一种通过陀螺仪和磁场传感器精确检测回转的方法 - Google Patents
一种通过陀螺仪和磁场传感器精确检测回转的方法 Download PDFInfo
- Publication number
- CN110081879A CN110081879A CN201910359029.1A CN201910359029A CN110081879A CN 110081879 A CN110081879 A CN 110081879A CN 201910359029 A CN201910359029 A CN 201910359029A CN 110081879 A CN110081879 A CN 110081879A
- Authority
- CN
- China
- Prior art keywords
- magnetic field
- gyroscope
- field sensor
- angle
- derrick crane
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B7/00—Measuring arrangements characterised by the use of electric or magnetic techniques
- G01B7/30—Measuring arrangements characterised by the use of electric or magnetic techniques for measuring angles or tapers; for testing the alignment of axes
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
- G01B21/22—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring angles or tapers; for testing the alignment of axes
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
- G01C21/08—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/18—Stabilised platforms, e.g. by gyroscope
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
- Y02A90/30—Assessment of water resources
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental & Geological Engineering (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Measuring Magnetic Variables (AREA)
- Gyroscopes (AREA)
Abstract
本发明涉及塔式起重机检测技术领域，具体来说是一种通过陀螺仪和磁场传感器精确检测回转的方法，在塔式起重机内同时设置有与塔式起重机相固定的陀螺仪和磁场传感器，陀螺仪和磁场传感器分别与处理器信号相连，所述的处理器用于对陀螺仪和磁场传感器的监测数据进行采样，并通过陀螺仪的检测数据对磁场传感器的检测数据进行校正，从而得到塔式起重机的回转角度。本发明同现有技术相比，其优点在于：本发明使用磁场传感器与陀螺仪数据互相校正的方式，避免了单一陀螺仪存在静态漂移单一地磁传感器容易受到环境干扰的问题，可以输出较为稳定的指向角，且无需对现有工程机械做任何修改，于塔式起重机内安装检测设备，便于安装维护，机械使用寿命长。
Description
技术领域
本发明涉及塔式起重机检测技术领域，具体来说是一种通过陀螺仪和磁场传感器精确检测回转的方法。
背景技术
现有塔式起重机系统中检测吊臂回转的方式是在旋转节的齿轮处安装额外的编码器或电位器，以机械接触的方式读取包括吊臂在内的整个塔式起重机的顶部的旋转信号。此方式需要对结构进行一定改装并布线，布置较为复杂且对于安全性也有不利影响。因此，需要设计一种新型的通过陀螺仪和磁场传感器精确检测回转的方法。
发明内容
本发明的目的在于解决现有技术的不足，提供一种通过陀螺仪和磁场传感器精确检测回转的方法，于塔式起重机内安装检测设备，将陀螺仪和磁场传感器的数据进行联合处理，进行塔式起重机的回转检测。
为了实现上述目的，设计一种通过陀螺仪和磁场传感器精确检测回转的方法，包括塔式起重机，在塔式起重机内同时设置有与塔式起重机相固定的陀螺仪和磁场传感器，陀螺仪和磁场传感器分别与处理器信号相连，所述的处理器用于对陀螺仪和磁场传感器的监测数据进行采样，并通过陀螺仪的检测数据对磁场传感器的检测数据进行校正，从而得到塔式起重机的回转角度。
本发明还具有如下优选的技术方案：
通过陀螺仪的检测数据对磁场传感器的检测数据进行校正的方法具体如下：
步骤a.首先，在塔式起重机运作前进行首次采样获得磁场传感器的初始输出角度。
步骤b.而后运行塔式起重机，进行采样以检测塔式起重机的回转角度，并通过处理器判断陀螺仪输出的旋转角速度是否为零以及磁场传感器的输出角度有无变动；若陀螺仪输出的旋转角速度不为零而磁场传感器的输出角度无变动，则令θg＝Ωg*△t，θc＝θcl+θg；若陀螺仪输出的旋转角速度为零而磁场传感器的输出角度有变动，则令θc＝θcl-(θd-θdl)；若陀螺仪输出的旋转角速度不为零且磁场传感器的输出角度有变动，则直接进入步骤c。
步骤c.通过处理器计算最终输出角度值为θf＝θfl+θd-θdl+θc。
式中，△t为本次采样与前次采样之间的时间间隔，θg为△tn期间陀螺仪所旋转的角度，Ωg为本次采样时陀螺仪输出的旋转角速度，θc为本次采样时的综合角度校正值，θcl为前次采样时的综合角度校正值，θd为本次采样时磁场传感器输出的角度值，θdl为前次采样时磁场传感器输出的角度值，θf为本次采样的最终输出角度值，θfl为前次采样的最终输出角度值，其中，θcl、θc、θfl的初值均为零。
所述的陀螺仪和磁场传感器固定于塔式起重机的驾驶舱内。
本发明同现有技术相比，其优点在于：本发明使用磁场传感器与陀螺仪数据互相校正的方式，避免了单一陀螺仪存在静态漂移单一地磁传感器容易受到环境干扰的问题，可以输出较为稳定的指向角，且无需对现有工程机械做任何修改，于塔式起重机内安装检测设备，便于安装维护，机械使用寿命长。
附图说明
图1是本发明的流程示意图。
具体实施方式
下面结合附图对本发明作进一步说明，这种方法的原理对本专业的人来说是非常清楚的。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。
位于地球表面的磁场传感器可以检测到无处不在的地磁场，由于地磁场具备确切的方向(由磁北极指向磁南极)，因此该磁场在传感器所在平行于地面的平面上的投影向量即可用于检测塔式起重机的回转。但地磁由于强度较弱，容易受到干扰，因此本实施方式引入了一个额外的陀螺仪，对磁场数据进行联合校正，用以消除干扰。
优选地，多次采样之间的时间间隔可以设置为相同，即处理器每隔设定的时间，即读取依次陀螺仪和磁场传感器的数据，并通过该数据实施计算塔式起重机的回转角度，时间间隔可以设置为0.01s、0.1s、1s或其他间隔，由于时间间隔较小，所以当前采样时陀螺仪输出的旋转角速度即相当于两次采样之间的平均旋转角速度，从而可以以此计算陀螺仪的回转角度，而由于陀螺仪和磁场传感器固定于塔式起重机的内侧，只有当塔式起重机旋转时两者才会旋转，所以陀螺仪和磁场传感器测得的本身的回转角度能够用于表征塔式起重机的回转角度。
参见图1，通过陀螺仪的检测数据对磁场传感器的检测数据进行校正的方法具体如下：
步骤a.首先，在塔式起重机运作前进行首次采样获得磁场传感器的初始输出角度。
步骤b.而后运行塔式起重机，进行采样以检测塔式起重机的回转角度，并通过处理器判断陀螺仪输出的旋转角速度是否为零以及磁场传感器的输出角度有无变动；若陀螺仪输出的旋转角速度不为零而磁场传感器的输出角度无变动，则令θg＝Ωg*△t，θc＝θcl+θg；若陀螺仪输出的旋转角速度为零而磁场传感器的输出角度有变动，则令θc＝θcl-(θd-θdl)，即地磁有输出而陀螺仪无输出时，此时判定为地磁干扰，因此地磁的变化量将用于调整偏移量校正值θc，而不用于带入结果。；若陀螺仪输出的旋转角速度不为零且磁场传感器的输出角度有变动，则直接进入步骤c。
步骤c.通过处理器计算最终输出角度值为θf＝θfl+θd-θdl+θc。
式中，△t为本次采样与前次采样之间的时间间隔，θg为△tn期间陀螺仪所旋转的角度，Ωg为本次采样时陀螺仪输出的旋转角速度，θc为本次采样时的综合角度校正值，θcl为前次采样时的综合角度校正值，θd为本次采样时磁场传感器输出的角度值，θdl为前次采样时磁场传感器输出的角度值，θf为本次采样的最终输出角度值，θfl为前次采样的最终输出角度值，其中，θcl、θc、θfl的初值均为零。
由此，通过陀螺仪的检测数据对磁场传感器的数据进行校正，获得准确的塔式起重机回转角度，且无须将传感器设置于塔式起重机外部，无须复杂的排线，便于安装与拆卸。
Claims (3)
1.一种通过陀螺仪和磁场传感器精确检测回转的方法，包括塔式起重机，其特征在于在塔式起重机内同时设置有与塔式起重机相固定的陀螺仪和磁场传感器，陀螺仪和磁场传感器分别与处理器信号相连，所述的处理器用于对陀螺仪和磁场传感器的监测数据进行采样，并通过陀螺仪的检测数据对磁场传感器的检测数据进行校正，从而得到塔式起重机的回转角度。
2.如权利要求1所述的一种通过陀螺仪和磁场传感器精确检测回转的方法，其特征在于通过陀螺仪的检测数据对磁场传感器的检测数据进行校正的方法具体如下：
步骤a.首先，在塔式起重机运作前进行首次采样获得磁场传感器的初始输出角度；
步骤b.而后运行塔式起重机，进行采样以检测塔式起重机的回转角度，并通过处理器判断陀螺仪输出的旋转角速度是否为零以及磁场传感器的输出角度有无变动；
若陀螺仪输出的旋转角速度不为零而磁场传感器的输出角度无变动，则令θg＝Ωg*△t，θc＝θcl+θg；
若陀螺仪输出的旋转角速度为零而磁场传感器的输出角度有变动，则令θc＝θcl-(θd-θdl)；
若陀螺仪输出的旋转角速度不为零且磁场传感器的输出角度有变动，则直接进入步骤c；
步骤c.通过处理器计算最终输出角度值为θf＝θfl+θd-θdl+θc；
式中，△t为本次采样与前次采样之间的时间间隔，θg为△tn期间陀螺仪所旋转的角度，Ωg为本次采样时陀螺仪输出的旋转角速度，θc为本次采样时的综合角度校正值，θcl为前次采样时的综合角度校正值，θd为本次采样时磁场传感器输出的角度值，θdl为前次采样时磁场传感器输出的角度值，θf为本次采样的最终输出角度值，θfl为前次采样的最终输出角度值，其中，θcl、θc、θfl的初值均为零。
3.如权利要求1所述的一种通过陀螺仪和磁场传感器精确检测回转的方法，其特征在于所述的陀螺仪和磁场传感器固定于塔式起重机的驾驶舱内。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910359029.1A CN110081879B (zh) | 2019-04-30 | 2019-04-30 | 一种通过陀螺仪和磁场传感器精确检测回转的方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910359029.1A CN110081879B (zh) | 2019-04-30 | 2019-04-30 | 一种通过陀螺仪和磁场传感器精确检测回转的方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110081879A true CN110081879A (zh) | 2019-08-02 |
| CN110081879B CN110081879B (zh) | 2023-05-26 |
Family
ID=67417925
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201910359029.1A Active CN110081879B (zh) | 2019-04-30 | 2019-04-30 | 一种通过陀螺仪和磁场传感器精确检测回转的方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110081879B (zh) |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2011112500A (ja) * | 2009-11-26 | 2011-06-09 | Fujitsu Ltd | センサ補正プログラム、センサ補正装置およびセンサ補正方法 |
| US20130200882A1 (en) * | 2012-02-03 | 2013-08-08 | Research In Motion Limited | Methods and devices for detecting magnetic interference affecting the operation of a magnetometer |
| US20140202229A1 (en) * | 2013-01-23 | 2014-07-24 | Michael E. Stanley | Systems and method for gyroscope calibration |
| US20180080768A1 (en) * | 2016-02-01 | 2018-03-22 | Limited Liability Company "Topcon Positioning Systems" | A method and device for calibration of a three-axis magnetometer |
| CN107830871A (zh) * | 2017-10-12 | 2018-03-23 | 歌尔科技有限公司 | 一种补偿陀螺仪角速度数据的方法、装置、陀螺仪和系统 |
-
2019
- 2019-04-30 CN CN201910359029.1A patent/CN110081879B/zh active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2011112500A (ja) * | 2009-11-26 | 2011-06-09 | Fujitsu Ltd | センサ補正プログラム、センサ補正装置およびセンサ補正方法 |
| US20130200882A1 (en) * | 2012-02-03 | 2013-08-08 | Research In Motion Limited | Methods and devices for detecting magnetic interference affecting the operation of a magnetometer |
| US20140202229A1 (en) * | 2013-01-23 | 2014-07-24 | Michael E. Stanley | Systems and method for gyroscope calibration |
| US20180080768A1 (en) * | 2016-02-01 | 2018-03-22 | Limited Liability Company "Topcon Positioning Systems" | A method and device for calibration of a three-axis magnetometer |
| CN107830871A (zh) * | 2017-10-12 | 2018-03-23 | 歌尔科技有限公司 | 一种补偿陀螺仪角速度数据的方法、装置、陀螺仪和系统 |
Non-Patent Citations (1)
| Title |
|---|
| 王立超: ""基于MEMS技术的吊钩运动姿态传感器研究"", 《中国优秀硕士学位论文全文数据库工程科技II辑》 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN110081879B (zh) | 2023-05-26 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| EP3312382B1 (en) | Device for measuring gravitational acceleration during state of spinning and extraction method | |
| US4472884A (en) | Borehole azimuth determination using magnetic field sensor | |
| JP2012506548A (ja) | 電子コンパスおよび電子コンパスの零点誤差を求める方法 | |
| EP2796832A1 (en) | Distance meter | |
| GB2449538A (en) | Calibrated electronic compass | |
| US8782913B2 (en) | Method of determining heading by turning an inertial device | |
| NO342653B1 (no) | Fluidstrømningssensor | |
| CN107390155A (zh) | 一种磁传感器校准装置和方法 | |
| KR101402667B1 (ko) | 굴삭기 선회각 계측 시스템 | |
| JP4593347B2 (ja) | 回転飛翔体 | |
| CN110081879A (zh) | 一种通过陀螺仪和磁场传感器精确检测回转的方法 | |
| CN107607114B (zh) | 一种数字陀螺稳定平台在线频率特性软测试方法 | |
| KR101638856B1 (ko) | 디지털 수도미터의 보안장치 | |
| JP2001083224A (ja) | 磁界測定方法および装置 | |
| JPH08178653A (ja) | 埋設管路位置計測システム | |
| CN105675019B (zh) | 一种悬浮类陀螺旋转-偏转复合调制误差补偿方法 | |
| CN203870123U (zh) | 磁转速传感器自检装置及其系统 | |
| CN106917621A (zh) | 小孔径单陀螺水平井旋转定向测斜装置及方法 | |
| CN207703151U (zh) | 一种地质类磁传动位移检测装置 | |
| CN204287510U (zh) | 一种地下旋转测量数据的方位校正装置 | |
| JPH06307864A (ja) | 傾斜角測定装置 | |
| JP2609976B2 (ja) | 方位計 | |
| KR100620895B1 (ko) | 회전 컴파스 장치를 이용한 외부간섭 자기장 검출방법 | |
| CN107192368A (zh) | 一种三点构面定轴的旋转角度测量方法 | |
| JPH0666567A (ja) | 乗物用方位計 |
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 |