Shearer positioning method based on non-holonomic constraints
At present, the shearer positioning method is based on the combination of the inertial navigation system and odometer. The method directly uses the output of the odometer to correct the shearer forward speed calculated by the inertial navigation system. However, the capability of suppressing the err...
Main Authors: | , , , , , |
---|---|
Format: | Article |
Language: | zho |
Published: |
Editorial Department of Industry and Mine Automation
2022-08-01
|
Series: | Gong-kuang zidonghua |
Subjects: | |
Online Access: | http://www.gkzdh.cn/article/doi/10.13272/j.issn.1671-251x.2022020006 |
_version_ | 1827988576876363776 |
---|---|
author | SONG Danyang YANG Jinheng TAO Xinya LU Chungui TIAN Muqin SONG Jiancheng |
author_facet | SONG Danyang YANG Jinheng TAO Xinya LU Chungui TIAN Muqin SONG Jiancheng |
author_sort | SONG Danyang |
collection | DOAJ |
description | At present, the shearer positioning method is based on the combination of the inertial navigation system and odometer. The method directly uses the output of the odometer to correct the shearer forward speed calculated by the inertial navigation system. However, the capability of suppressing the error divergence of the inertial navigation system is very limited. The shearer in the process of movement meets the characteristics of the non-holonomic constraints. When the shearer does not jump and sideslip, the lateral velocity and vertical velocity at the connection between the traction gear and the crawler are zero. Based on this characteristic, a new shearer positioning method based on non-holonomic constraints is proposed on the basis of the combination of the inertial navigation system and odometer. The output of the inertial measurement unit arranged in the middle of the shearer's body is mechanically arranged, so as to obtain the attitude, speed and position information of the shearer. The output of the odometer installed on the traction gear of the shearer is used to calculate the instantaneous velocity of the shearer. The Kalman filtering state equation is established by using a mechanical arrangement result of the inertial navigation system and an error propagation model. The non-integrity constraint is introduced at the joint of a traction gear and a crawler of the shearer. The Kalman filtering observation equation is established by using the difference between the velocity projected at the joint by the inertial navigation system and the velocity output by the mileometer as an observation vector. The output of the inertial navigation system is modified by using the results of the Kalman filtering algorithm as error feedback. Then the optimal estimation of the attitude, speed and position of the shearer is obtained. The experimental results show that compared with the traditional combined positioning method of inertial navigation system and odometer, the positioning error does not diverge with time after the non-holonomic constraint is added. The positioning method has good tracking performance on the actual trajectory. The positioning errors of the shearer in the forward, lateral and vertical directions are reduced by 66%, 62% and 67% respectively. |
first_indexed | 2024-04-10T00:05:42Z |
format | Article |
id | doaj.art-8872d02f360e4850b7b9efb325f97468 |
institution | Directory Open Access Journal |
issn | 1671-251X |
language | zho |
last_indexed | 2024-04-10T00:05:42Z |
publishDate | 2022-08-01 |
publisher | Editorial Department of Industry and Mine Automation |
record_format | Article |
series | Gong-kuang zidonghua |
spelling | doaj.art-8872d02f360e4850b7b9efb325f974682023-03-17T01:01:44ZzhoEditorial Department of Industry and Mine AutomationGong-kuang zidonghua1671-251X2022-08-01487525710.13272/j.issn.1671-251x.2022020006Shearer positioning method based on non-holonomic constraintsSONG Danyang0YANG Jinheng1TAO Xinya2LU Chungui3TIAN Muqin4SONG Jiancheng5National and Provincial Joint Engineering Laboratory of Mining Intelligent Electrical Apparatus Technology, Taiyuan University of Technology, Taiyuan 030024, ChinaNational and Provincial Joint Engineering Laboratory of Mining Intelligent Electrical Apparatus Technology, Taiyuan University of Technology, Taiyuan 030024, ChinaSchool of Electronic Information Engineering, Taiyuan University of Science and Technology, Taiyuan 030024, ChinaNational and Provincial Joint Engineering Laboratory of Mining Intelligent Electrical Apparatus Technology, Taiyuan University of Technology, Taiyuan 030024, ChinaNational and Provincial Joint Engineering Laboratory of Mining Intelligent Electrical Apparatus Technology, Taiyuan University of Technology, Taiyuan 030024, ChinaNational and Provincial Joint Engineering Laboratory of Mining Intelligent Electrical Apparatus Technology, Taiyuan University of Technology, Taiyuan 030024, ChinaAt present, the shearer positioning method is based on the combination of the inertial navigation system and odometer. The method directly uses the output of the odometer to correct the shearer forward speed calculated by the inertial navigation system. However, the capability of suppressing the error divergence of the inertial navigation system is very limited. The shearer in the process of movement meets the characteristics of the non-holonomic constraints. When the shearer does not jump and sideslip, the lateral velocity and vertical velocity at the connection between the traction gear and the crawler are zero. Based on this characteristic, a new shearer positioning method based on non-holonomic constraints is proposed on the basis of the combination of the inertial navigation system and odometer. The output of the inertial measurement unit arranged in the middle of the shearer's body is mechanically arranged, so as to obtain the attitude, speed and position information of the shearer. The output of the odometer installed on the traction gear of the shearer is used to calculate the instantaneous velocity of the shearer. The Kalman filtering state equation is established by using a mechanical arrangement result of the inertial navigation system and an error propagation model. The non-integrity constraint is introduced at the joint of a traction gear and a crawler of the shearer. The Kalman filtering observation equation is established by using the difference between the velocity projected at the joint by the inertial navigation system and the velocity output by the mileometer as an observation vector. The output of the inertial navigation system is modified by using the results of the Kalman filtering algorithm as error feedback. Then the optimal estimation of the attitude, speed and position of the shearer is obtained. The experimental results show that compared with the traditional combined positioning method of inertial navigation system and odometer, the positioning error does not diverge with time after the non-holonomic constraint is added. The positioning method has good tracking performance on the actual trajectory. The positioning errors of the shearer in the forward, lateral and vertical directions are reduced by 66%, 62% and 67% respectively.http://www.gkzdh.cn/article/doi/10.13272/j.issn.1671-251x.2022020006shearer positioninginertial navigation systemodometernon-holonomic constraintskalman filtering |
spellingShingle | SONG Danyang YANG Jinheng TAO Xinya LU Chungui TIAN Muqin SONG Jiancheng Shearer positioning method based on non-holonomic constraints Gong-kuang zidonghua shearer positioning inertial navigation system odometer non-holonomic constraints kalman filtering |
title | Shearer positioning method based on non-holonomic constraints |
title_full | Shearer positioning method based on non-holonomic constraints |
title_fullStr | Shearer positioning method based on non-holonomic constraints |
title_full_unstemmed | Shearer positioning method based on non-holonomic constraints |
title_short | Shearer positioning method based on non-holonomic constraints |
title_sort | shearer positioning method based on non holonomic constraints |
topic | shearer positioning inertial navigation system odometer non-holonomic constraints kalman filtering |
url | http://www.gkzdh.cn/article/doi/10.13272/j.issn.1671-251x.2022020006 |
work_keys_str_mv | AT songdanyang shearerpositioningmethodbasedonnonholonomicconstraints AT yangjinheng shearerpositioningmethodbasedonnonholonomicconstraints AT taoxinya shearerpositioningmethodbasedonnonholonomicconstraints AT luchungui shearerpositioningmethodbasedonnonholonomicconstraints AT tianmuqin shearerpositioningmethodbasedonnonholonomicconstraints AT songjiancheng shearerpositioningmethodbasedonnonholonomicconstraints |