[go: up one dir, main page]

CN111003577A - Inertial navigation system integrating shaft encoder positioning and infrared sensor positioning - Google Patents

Inertial navigation system integrating shaft encoder positioning and infrared sensor positioning Download PDF

Info

Publication number
CN111003577A
CN111003577A CN201911165039.8A CN201911165039A CN111003577A CN 111003577 A CN111003577 A CN 111003577A CN 201911165039 A CN201911165039 A CN 201911165039A CN 111003577 A CN111003577 A CN 111003577A
Authority
CN
China
Prior art keywords
conveyor
positioning
shaft encoder
controller
inertial navigation
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.)
Pending
Application number
CN201911165039.8A
Other languages
Chinese (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.)
Construction Consulting Branch Of China Online Shanghai Electric Power Co
Shanghai Jiangjun Information Consultation Co ltd
State Grid Shanghai Electric Power Co Ltd
Original Assignee
Construction Consulting Branch Of China Online Shanghai Electric Power Co
Shanghai Electric Power Cable Engineering Co ltd
Shanghai Jiangjun Information Consultation Co ltd
Shanghai Lianti Information Technology Co Ltd
State Grid Shanghai Electric Power Co 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 Construction Consulting Branch Of China Online Shanghai Electric Power Co, Shanghai Electric Power Cable Engineering Co ltd, Shanghai Jiangjun Information Consultation Co ltd, Shanghai Lianti Information Technology Co Ltd, State Grid Shanghai Electric Power Co Ltd filed Critical Construction Consulting Branch Of China Online Shanghai Electric Power Co
Priority to CN201911165039.8A priority Critical patent/CN111003577A/en
Publication of CN111003577A publication Critical patent/CN111003577A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65HHANDLING THIN OR FILAMENTARY MATERIAL, e.g. SHEETS, WEBS, CABLES
    • B65H51/00Forwarding filamentary material
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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/165Navigation; 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 combined with non-inertial navigation instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D21/00Measuring or testing not otherwise provided for
    • G01D21/02Measuring two or more variables by means not covered by a single other subclass

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Conveyors (AREA)

Abstract

本发明公开了一种融合轴编码器定位和红外传感器定位的惯性导航系统,包括地面层、线缆轨道层和工作面层;所述地面层包括监控主机、监控平台、参数化平台、三维监控平台、工作面视频监控平台、第一数据库服务器、第二数据库服务器和视频解码服务器;所述线缆轨道层包括线缆控制器和与其相连的人机交互界面;所述工作面层包括输送机传感子系统、液压支架传感子系统、输送机控制液压阀组、支架控制液压阀组、输送机机载控制器和支架控制器。本发明的融合轴编码器定位和红外传感器定位的惯性导航系统,将轴编码器定位和红外传感器定位融合使用,增加定位的可靠性与稳定性,节约成本,减少返工,线缆敷设时,减少设备停车次数,更重要是确保安装进行时的安全,提高了项目管理工作的质量以及安全性。

Figure 201911165039

The invention discloses an inertial navigation system integrating shaft encoder positioning and infrared sensor positioning, comprising a ground layer, a cable track layer and a working surface layer; the ground layer includes a monitoring host, a monitoring platform, a parameterization platform, and a three-dimensional monitoring platform, working face video monitoring platform, first database server, second database server and video decoding server; the cable track layer includes a cable controller and a human-machine interface connected to it; the working face layer includes a conveyor Sensing Subsystem, Hydraulic Rack Sensing Subsystem, Conveyor Control Hydraulic Valve Group, Rack Control Hydraulic Valve Group, Conveyor On-Board Controller and Rack Controller. The inertial navigation system that integrates the positioning of the shaft encoder and the positioning of the infrared sensor of the present invention integrates the positioning of the shaft encoder and the positioning of the infrared sensor to increase the reliability and stability of the positioning, save the cost, reduce the rework, and reduce the cable laying time. The number of equipment stops, and more importantly, to ensure the safety of the installation, improve the quality and safety of the project management work.

Figure 201911165039

Description

Inertial navigation system integrating shaft encoder positioning and infrared sensor positioning
Technical Field
The invention relates to an inertial navigation system integrating shaft encoder positioning and infrared sensor positioning.
Background
The cable laying in the tunnel is an important component in power grid construction, and how to improve the cable laying efficiency and improve the laying quality through scientific and technological innovation is a main task of current research.
Referring to fig. 1, in laying a cable in a tunnel, a cable drum 11 on which the cable 1 is wound is disposed on a ground 10, a conveyor 2 is disposed above a cable track 21, which is an advancing track of the cable, and a hydraulic bracket is disposed behind the conveyor 2. After the hydraulic support is supported, enough working space and safety protection can be provided for a conveyor and operators. Since the overall dimensions of the conveyor 2, the cable track 21 and the hydraulic support need to be closely matched, they need to cooperate during the cable laying process. The conveyor 2 moves horizontally along the work surface 20, and since the conveyor 2 is located on the cable track 21, the conveyor 2 pulls the cable 1 to move. From the above description, it can be seen that the whole conveying process, the conveyor is the core equipment of the system, and the operation condition of the conveyor determines the action of the support and the effect of cable laying.
At present, an inertial measurement module is not installed on a conveyor in cable laying research at home and abroad. The inertial measurement sensor can acquire absolute position information of a mounting point of the conveyor body, the absolute position information comprises acceleration, speed and displacement of a certain point of the conveyor body relative to an inertial coordinate system of a fully mechanized mining face, and angular speed and angular displacement (which are functions of time) of the body relative to three space coordinate axes of the coordinate system of the conveyor body, and then motion parameter information of any point of the body can be acquired according to a rigid body kinematics model of the conveyor, so that the absolute position information can be positioned during working.
Disclosure of Invention
The invention aims to overcome the defects of the prior art and provides an inertial navigation system integrating shaft encoder positioning and infrared sensor positioning, which integrates shaft encoder positioning and infrared sensor positioning for use, has high stability, saves cost, reduces rework, reduces accompanying equipment during cable laying, more importantly ensures safety during installation and improves quality and safety of project management work.
The technical scheme for realizing the purpose is as follows: the utility model provides an inertia navigation who fuses axle encoder location and infrared sensor location, includes ground layer, cable track layer and working face layer, wherein:
the ground layer comprises a monitoring host, a monitoring platform, a parameterized platform, a three-dimensional monitoring platform, a working face video monitoring platform, a first database server, a second database server and a video decoding server, wherein the first database server is communicated with the monitoring platform, the parameterized platform and the three-dimensional monitoring platform are respectively communicated with the second database server, and the working face video monitoring platform is communicated with the video decoding server; the first database server, the second database server and the video decoding server are respectively arranged in the monitoring host;
the cable track layer comprises a cable controller and a human-computer interaction interface connected with the cable controller, and is responsible for transmission, storage and network communication of sensing data;
the working surface layer comprises a conveyor sensing subsystem, a hydraulic support sensing subsystem, a conveyor control hydraulic valve group, a support control hydraulic valve group, a conveyor onboard controller and a support controller, wherein the conveyor sensing subsystem is communicated with the conveyor onboard controller through a conveyor input and output module, and the conveyor control hydraulic valve group is connected with the conveyor input and output module; the hydraulic support sensing subsystem is communicated with the support controller through a support input and output module, and the support control hydraulic valve bank is connected with the support input and output module;
the system comprises a conveyor sensing subsystem and a hydraulic support sensing subsystem, wherein the conveyor sensing subsystem and the hydraulic support sensing subsystem jointly form a physical sensing system, the conveyor sensing subsystem comprises an infrared emitter arranged on a conveyor and a shaft encoder arranged at a traction part of the conveyor, the hydraulic support sensing subsystem comprises an infrared receiving sensor arranged on a hydraulic support, and the infrared emitter and the infrared receiving sensor form a fusion interface;
the monitoring host is respectively communicated with the cable controller, the bracket controller and the conveyor onboard controller.
The inertial navigation system integrating shaft encoder positioning and infrared sensor positioning is characterized in that a sensor for sensing the working state information of the conveyor is mounted on the body of the conveyor, and the working state information of the conveyor comprises kinematic parameters and traction cutting load parameters in the operation process of the conveyor; the kinematic parameters comprise acceleration, speed and displacement during the operation of the conveyor; the load parameters of the traction cutting comprise traction cutting current and traction cutting motor temperature.
When the conveyor moves horizontally along a cable track, an infrared emitter on the conveyor emits an infrared signal, infrared receiving sensors on more than one hydraulic support in the infrared signal range receive the infrared signal, the hydraulic support with the strongest received infrared signal is used as the hydraulic support opposite to the conveyor, and at the moment, a support controller of the hydraulic support uploads an acquired support number to the monitoring host through a bus network; meanwhile, the conveyor onboard controller uploads the sensing data of the conveyor inertial navigation computing system and the shaft encoder to the monitoring host through a communication network under the tunnel, and the monitoring host fuses the support number and the sensing data to finally determine the position of the conveyor.
The inertial navigation system integrating shaft encoder positioning and infrared sensor positioning is characterized in that the sensing data necessary for determining the position of the conveyor comprise the acceleration of a mounting point of the conveyor along a coordinate system of the conveyor body, the rotating angular speed of the conveyor coordinate system around a platform system, the walking speed of the conveyor recorded by a shaft encoder of a traction part of the conveyor and the signal intensity of an infrared sensor on the conveyor.
According to the inertial navigation system integrating shaft encoder positioning and infrared sensor positioning, when the position of the conveyor is determined, only sensing data necessary for positioning are selected, and the rest sensing data are used for monitoring the running state of the conveyor and do not participate in positioning calculation.
In the inertial navigation system combining shaft encoder positioning and infrared sensor positioning, the conveyor receives a command from the on-board controller of the conveyor according to the change of the traction force, so that the traveling speed of the conveyor and the working position of the traction part are changed.
The inertial navigation system integrating shaft encoder positioning and infrared sensor positioning is characterized in that the monitoring host sends out a control command to adjust the running state of the conveyor;
determining abnormal state data points of the conveyor according to different abnormal states of the conveyor, and setting the level of the abnormal state of the conveyor as an alarm level and a shutdown level according to different feedback strengths of the inertial navigation system on the abnormal state of the conveyor;
when the conveyor is in an abnormal state, the monitoring host sends a control command to the conveyor onboard controller, and the conveyor onboard controller sends a corresponding command to the conveyor for regulation.
The inertial navigation system fusing shaft encoder positioning and infrared sensor positioning is used by fusing shaft encoder positioning and infrared sensor positioning, and the processing mode can increase the reliability and stability of positioning and overcome the problem of unreliable positioning by singly using one positioning mode. Compared with the prior art, the invention has the following advantages:
(1) the stability is high: aiming at the limitation of the existing conveyor positioning method, the invention adds a conveyor positioning means based on inertial navigation on the basis of the existing method, establishes a model for fusing several positioning technologies together, and enhances the accuracy, reliability and stability of the system.
(2) The management quality and the safety are improved: reduce and do over again, during the cable laying, reduce and accompany and stop equipment, more importantly guarantees the safety when the installation goes on, has improved the quality and the security of project management work.
(3) The cost is saved: the reliable application of the system not only saves the personnel cost, but also improves the labor productivity
Drawings
FIG. 1 is a diagrammatic illustration of the operation of a conveyor during cable laying in a tunnel;
FIG. 2 is a block diagram of an inertial navigation system incorporating shaft encoder positioning and infrared sensor positioning in accordance with the present invention.
Detailed Description
In order that those skilled in the art will better understand the technical solution of the present invention, the following detailed description is given with reference to the accompanying drawings:
referring to fig. 1 and 2, in a preferred embodiment of the present invention, an inertial navigation system with integrated shaft encoder positioning and infrared sensor positioning includes a ground layer 100, a cable track layer 200, and a working layer 300.
The ground layer 100 comprises a monitoring host 101, a monitoring platform 102, a parameterization platform 103, a three-dimensional monitoring platform 104, a working face video monitoring platform 105, a first database server 106, a second database server 107 and a video decoding server 108, wherein the first database server 106 is communicated with the monitoring platform 2, the parameterization platform 103 and the three-dimensional monitoring platform 104 are respectively communicated with the second database server 107, and the working face video monitoring platform 5 is communicated with the video decoding server 108; the first database server 106, the second database server 107 and the video decoding server 108 are respectively installed in the monitoring host 101.
The cable track layer 200 comprises a cable controller 201 and a human-computer interaction interface 202 connected with the cable controller, and the cable track layer 200 is responsible for transmission, storage and network communication of sensing data.
The working face layer 300 includes a conveyor sensing subsystem 301, a hydraulic support sensing subsystem 302, a conveyor control hydraulic valve block 303, a support control hydraulic valve block 304, a conveyor onboard controller 305, and a support controller 306. The conveyor sensing subsystem 1 is communicated with a conveyor on-board controller 5 through a conveyor input and output module 7, and a conveyor control hydraulic valve bank 303 is connected with a conveyor input and output module 307; the hydraulic support sensing subsystem 302 communicates with the support controller 306 via the support input output module 8, and the support control hydraulic valve bank 304 is connected to the support input output module 8.
The conveyor sensing subsystem 301 and the hydraulic support sensing subsystem 302 jointly form a physical sensing system, each subsystem is composed of a plurality of physical sensing units, and the physical sensing units are matched with each other to jointly provide sensing data for the system. The conveyor sensing subsystem 301 comprises an infrared emitter arranged on the conveyor and a shaft encoder arranged at the traction part of the conveyor, the hydraulic support sensing subsystem comprises a plurality of infrared receiving sensors arranged on a plurality of hydraulic supports, and each hydraulic support is provided with one infrared receiving sensor. The infrared emitter and the infrared receiving sensor form a fusion interface;
the monitoring host 101 communicates with the cable controller 201, the rack controller 306, and the conveyor onboard controller 305, respectively.
A sensor for sensing the working state information of the conveyor 2 is arranged on the body of the conveyor, and the working state information of the conveyor comprises kinematic parameters and traction cutting load parameters in the running process of the conveyor; kinematic parameters include acceleration, velocity and displacement during operation of the conveyor; the traction cutting load parameters comprise traction cutting current and traction cutting motor temperature. These sensory data are generally considered normal, accurate and undistorted.
According to the inertial navigation system integrating shaft encoder positioning and infrared sensor positioning, the two positioning modes are integrated, the sensing data acquired from the two sensing systems are fused, the acquired sensing data are processed on the monitoring host computer in a centralized mode, and in order to complete the fusion of the sensing information, the working state data information of each key device must be acquired in real time. Therefore, physical sensing systems of key devices need to be established. The physical sensing system is divided into a conveyor sensing subsystem and a hydraulic support sensing subsystem, each subsystem is composed of a plurality of physical sensing units, and the physical sensing units are matched with each other to provide sensing data for the system.
A conveyor sensing subsystem 301 and a hydraulic support sensing subsystem 302 are fused, and fused interfaces are an infrared emitter installed on a conveyor and an infrared receiving sensor installed on a hydraulic support respectively. Referring to fig. 1, when the conveyor 2 moves horizontally along the cable track 21, the infrared emitter located on the conveyor 2 emits an infrared signal (emits a signal at a certain scattering angle), the infrared receiving sensor on more than one hydraulic support receives the infrared signal within the infrared signal range, the hydraulic support with the strongest received infrared signal is used as the hydraulic support opposite to the conveyor, and at this time, the support controller of the hydraulic support uploads the acquired support number to the monitoring host 101 through the bus network; meanwhile, the conveyor onboard controller 305 uploads the sensing data of the conveyor inertial navigation computing system and the shaft encoder to the monitoring host 101 through a communication network under the tunnel, and the monitoring host 101 fuses the support number and the sensing data to finally determine the position of the conveyor. The sensing data necessary to determine the position of the conveyor includes the acceleration of the mounting point of the body along the coordinate system of the body of the conveyor, the rotational angular velocity of the coordinate system of the body about the platform system, the walking speed of the conveyor recorded by the shaft encoder of the tractor part of the conveyor, and the signal strength of the infrared sensor on the conveyor.
When the position of the conveyor is determined, only the sensing data necessary for positioning are selected, and the rest sensing data are used for monitoring the running state of the conveyor and do not participate in positioning calculation.
The inertial navigation system integrating shaft encoder positioning and infrared sensor positioning of the present invention changes its own traveling speed and the operating position of the traction part by receiving a command from the on-conveyor controller 305 of the conveyor 2 according to the change of traction force. The monitoring host 101 sends out a control command to adjust the running state of the conveyor 2; determining abnormal state data points of the conveyor according to different abnormal states of the conveyor, and setting the level of the abnormal state of the conveyor as an alarm level and a shutdown level according to different feedback strengths of the inertial navigation system on the abnormal state of the conveyor; when the conveyor is in an abnormal state, the monitoring host sends a control command to the on-board conveyor controller 305, and the on-board conveyor controller 305 sends a corresponding command to the conveyor 2 for adjustment.
According to the inertial navigation system integrating shaft encoder positioning and infrared sensor positioning, as the working environment of the conveyor is quite severe, the vibration and impact of the conveyor body can cause distortion of sensing data, and if the error information is directly recorded, the automatic control effect of the conveyor can be adversely affected. This requires an effective mechanism to be established that can automatically identify which sensor data is normal and reject the distorted sensor data. The standard negative selection algorithm is composed of three main steps, which are respectively: data encoding, detector generation, and abnormal data detection. The data is encoded by binary coding or real number coding. The detector generation process is generally a process of randomly generating a series of candidate detectors and then generating a mature detector, which is a negative selection process that eliminates all detectors that have undergone an immune self-reaction. And finally, abnormal data detection is carried out, the fitness between the new sample data and the elements of the set of the maturity detector is calculated by the algorithm by utilizing a fitness matching function, and the abnormal data is rejected by the inertial navigation system if the fitness meets the requirement.
According to the inertial navigation system integrating shaft encoder positioning and infrared sensor positioning, the system can read, store and transmit data of each sensor at regular intervals. In the previous research, due to the limitation of objective conditions such as storage space and transmission rate of equipment, the acquisition frequency is set to be as low as possible, so that many conventional data are lost, the navigation and positioning precision of the conveyor is difficult to ensure (an inertial navigation subsystem needs higher sampling precision to ensure the navigation and calculation precision), meanwhile, the real-time monitoring of the running state of the conveyor cannot be really realized, and some key data information can be lost. Therefore, the invention stores the normal state point data with higher sampling frequency.
In summary, the inertial navigation system fusing shaft encoder positioning and infrared sensor positioning uses the shaft encoder positioning and the infrared sensor positioning in a fusing manner, and the processing mode can increase the reliability and stability of positioning and overcome the problem of unreliable positioning by using one positioning mode alone. Stability is high, practices thrift the cost, reduces and reworks, and during cable laying, the reduction accompanies and stops equipment, and more important is the safety when guaranteeing the installation and going on, has improved the quality and the security of project management work.
It should be understood by those skilled in the art that the above embodiments are only for illustrating the present invention and are not to be used as a limitation of the present invention, and that changes and modifications to the above described embodiments are within the scope of the claims of the present invention as long as they are within the spirit and scope of the present invention.

Claims (7)

1.一种融合轴编码器定位和红外传感器定位的惯性导航系统,其特征在于,包括地面层、线缆轨道层和工作面层,其中:1. an inertial navigation system of fusion shaft encoder positioning and infrared sensor positioning, is characterized in that, comprises ground layer, cable track layer and working surface layer, wherein: 所述地面层包括监控主机、监控平台、参数化平台、三维监控平台、工作面视频监控平台、第一数据库服务器、第二数据库服务器和视频解码服务器,所述第一数据库服务器与监控平台通讯,所述参数化平台和三维监控平台分别与所述第二数据库服务器通讯,所述工作面视频监控平台和视频解码服务器通讯;所述第一数据库服务器、第二数据库服务器和视频解码服务器分别装设在所述监控主机内;The ground layer includes a monitoring host, a monitoring platform, a parameterization platform, a three-dimensional monitoring platform, a working face video monitoring platform, a first database server, a second database server and a video decoding server, and the first database server communicates with the monitoring platform, The parameterization platform and the three-dimensional monitoring platform communicate with the second database server respectively, and the working face video monitoring platform communicates with the video decoding server; the first database server, the second database server and the video decoding server are respectively installed in the monitoring host; 所述线缆轨道层包括线缆控制器和与其相连的人机交互界面,所述线缆轨道层负责传感数据的传送、存储以及网络通讯;The cable track layer includes a cable controller and a man-machine interface connected thereto, and the cable track layer is responsible for the transmission, storage and network communication of sensing data; 所述工作面层包括输送机传感子系统、液压支架传感子系统、输送机控制液压阀组、支架控制液压阀组、输送机机载控制器和支架控制器,所述输送机传感子系统通过输送机输入输出模块与所述输送机机载控制器通讯,所述输送机控制液压阀组与所述输送机输入输出模块相连;所述液压支架传感子系统通过支架输入输出模块与所述支架控制器通讯,所述支架控制液压阀组与所述支架输入输出模块相连;The working surface layer includes a conveyor sensing subsystem, a hydraulic support sensing subsystem, a conveyor control hydraulic valve group, a support control hydraulic valve group, a conveyor on-board controller and a support controller. The subsystem communicates with the onboard controller of the conveyor through the conveyor input and output module, and the conveyor control hydraulic valve group is connected with the conveyor input and output module; the hydraulic support sensing subsystem passes through the support input and output module. communicating with the support controller, and the support control hydraulic valve group is connected with the support input and output module; 所述输送机传感子系统和液压支架传感子系统共同组成物理传感体系,所述输送机传感子系统包括设置在输送机上的红外线发射器和设置在输送机牵引部的轴编码器,所述液压支架传感子系统包括设置在液压支架上的红外线接收传感器,红外线发射器和红外线接收传感器组成融合接口;The conveyor sensing subsystem and the hydraulic support sensing subsystem together form a physical sensing system, and the conveyor sensing subsystem includes an infrared transmitter set on the conveyor and a shaft encoder set on the traction part of the conveyor , the hydraulic support sensing subsystem includes an infrared receiving sensor arranged on the hydraulic support, and the infrared transmitter and the infrared receiving sensor form a fusion interface; 所述监控主机分别与所述线缆控制器、支架控制器和输送机机载控制器通讯。The monitoring host communicates with the cable controller, the rack controller and the conveyor onboard controller, respectively. 2.根据权利要求1所述的一种融合轴编码器定位和红外传感器定位的惯性导航系统,其特征在于,所述输送机的机身上安装了感知自身工作状态信息的传感器,所述自身工作状态信息包括输送机运行过程中的运动学参数以及牵引截割负载参数;所述运动学参数包括输送机的运行过程中的加速度、速度和位移;所述牵引截割负载参数包括牵引截割电流和牵引截割电机温度。2. the inertial navigation system of a kind of fusion shaft encoder positioning and infrared sensor positioning according to claim 1, it is characterized in that, the sensor that perceives own working state information is installed on the body of described conveyor, described self The working state information includes kinematic parameters and traction cutting load parameters during the operation of the conveyor; the kinematic parameters include acceleration, speed and displacement during the operation of the conveyor; the traction cutting load parameters include traction cutting. Current and traction cutting motor temperature. 3.根据权利要求1所述的一种融合轴编码器定位和红外传感器定位的惯性导航系统,其特征在于,当输送机沿线缆轨道水平运动时,位于输送机上的红外线发射器发射红外信号,在红外信号范围内有多于一架的液压支架上的红外线接收传感器接收到红外信号,将接收到的红外信号最强的液压支架作为输送机正对的液压支架,此时该液压支架的支架控制器将获取的支架号通过总线网络上传至所述监控主机;同时输送机机载控制器通过隧道下的通讯网络将输送机惯性导航算系统和轴编码器的传感数据上传至所述监控主机,所述监控主机将支架号和传感数据进行融合,最终确定输送机的位置。3. the inertial navigation system of a kind of fusion shaft encoder positioning and infrared sensor positioning according to claim 1, is characterized in that, when the conveyor moves horizontally along the cable track, the infrared transmitter located on the conveyor emits infrared signals , within the infrared signal range, the infrared receiving sensors on more than one hydraulic support receive the infrared signal, and the hydraulic support with the strongest received infrared signal is used as the hydraulic support facing the conveyor. At this time, the hydraulic support of the hydraulic support The bracket controller uploads the acquired bracket number to the monitoring host through the bus network; at the same time, the conveyor on-board controller uploads the sensor data of the conveyor inertial navigation calculation system and the shaft encoder to the monitoring host through the communication network under the tunnel. A monitoring host, which fuses the rack number and sensor data to finally determine the position of the conveyor. 4.根据权利要求3所述的一种融合轴编码器定位和红外传感器定位的惯性导航系统,其特征在于,确定输送机的位置所必须的传感数据包括机身安装点沿输送机机身坐标系的加速度、机身坐标系绕平台系的转动角速度、输送机牵引部的轴编码器记录的输送机的行走速度和输送机上的红外传感器的信号强度。4. the inertial navigation system of a kind of fusion shaft encoder positioning and infrared sensor positioning according to claim 3, is characterized in that, the necessary sensing data to determine the position of the conveyor comprises the fuselage installation point along the conveyor fuselage The acceleration of the coordinate system, the rotational angular velocity of the fuselage coordinate system around the platform system, the running speed of the conveyor recorded by the shaft encoder of the conveyor traction part, and the signal strength of the infrared sensor on the conveyor. 5.根据权利要求4所述的一种融合轴编码器定位和红外传感器定位的惯性导航系统,其特征在于,确定输送机的位置时,只选取定位必须的传感数据,剩余的传感数据用来对输送机的运行状态进行监测,不参与定位计算。5. the inertial navigation system of a kind of fusion shaft encoder positioning and infrared sensor positioning according to claim 4, is characterized in that, when determining the position of the conveyor, only selects the necessary sensing data for positioning, and the remaining sensing data It is used to monitor the running state of the conveyor and does not participate in the positioning calculation. 6.根据权利要求1所述的一种融合轴编码器定位和红外传感器定位的惯性导航系统,其特征在于,根据牵引力的变化,输送机接受来自输送机机载控制器的命令而改变自身的行走速度以及牵引部的工作位置。6. the inertial navigation system of a kind of fusion shaft encoder positioning and infrared sensor positioning according to claim 1 is characterized in that, according to the change of traction force, the conveyor receives the command from the conveyor onboard controller and changes its own Travel speed and the working position of the traction part. 7.根据权利要求1所述的一种融合轴编码器定位和红外传感器定位的惯性导航系统,其特征在于,所述监控主机发出控制命令来调节输送机的运行状态;7. the inertial navigation system of a kind of fusion shaft encoder positioning and infrared sensor positioning according to claim 1, is characterized in that, described monitoring host sends out control commands to adjust the running state of conveyor; 根据输送机不同的异常状态确定输送机的异常状态数据点,根据惯性导航系统对输送机异常状态反馈强弱的不同,将输送机的异常状态的级别设置为警报和停机两级;Determine the abnormal state data points of the conveyor according to the different abnormal states of the conveyor, and set the level of the abnormal state of the conveyor to two levels of alarm and shutdown according to the difference in the feedback of the abnormal state of the conveyor by the inertial navigation system; 当输送机出现异常状态时,所述监控主机发出控制命令给输送机机载控制器,所述输送机机载控制器发送相应的命令给所述输送机进行调节。When the conveyor is in an abnormal state, the monitoring host sends a control command to the conveyor on-board controller, and the conveyor on-board controller sends corresponding commands to the conveyor for adjustment.
CN201911165039.8A 2019-11-25 2019-11-25 Inertial navigation system integrating shaft encoder positioning and infrared sensor positioning Pending CN111003577A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911165039.8A CN111003577A (en) 2019-11-25 2019-11-25 Inertial navigation system integrating shaft encoder positioning and infrared sensor positioning

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911165039.8A CN111003577A (en) 2019-11-25 2019-11-25 Inertial navigation system integrating shaft encoder positioning and infrared sensor positioning

Publications (1)

Publication Number Publication Date
CN111003577A true CN111003577A (en) 2020-04-14

Family

ID=70112737

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911165039.8A Pending CN111003577A (en) 2019-11-25 2019-11-25 Inertial navigation system integrating shaft encoder positioning and infrared sensor positioning

Country Status (1)

Country Link
CN (1) CN111003577A (en)

Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5464282A (en) * 1977-10-31 1979-05-23 Komatsu Ltd Guide cable laying method of driverless car
JPH01117613A (en) * 1987-10-29 1989-05-10 Toshiba Corp Robot apparatus for cable-laying work
CN102482863A (en) * 2010-01-26 2012-05-30 胡斯华纳有限公司 Laying machine
CN102639793A (en) * 2009-10-21 2012-08-15 卡特彼勒公司 Cable tracking system and method for mobile machines
CN103410512A (en) * 2013-08-15 2013-11-27 中国矿业大学 Geological environment information-fused absolute positioning device and method for coal cutter
CN103457203A (en) * 2013-09-06 2013-12-18 沈阳师范大学 Comprehensive robot cabling method based on internet of things
CN104990549A (en) * 2015-06-15 2015-10-21 中国矿业大学 Method and device for relatively locating coal cutter and hydraulic supports
US20170317479A1 (en) * 2016-05-02 2017-11-02 Lg Electronics Inc. Wire installation apparatus and control method thereof
CN206707709U (en) * 2017-05-15 2017-12-05 湖南科技大学 A kind of coal-winning machine feed control device
CN107910806A (en) * 2017-09-20 2018-04-13 国网辽宁省电力有限公司检修分公司 A kind of cable tunnel inspection robot and air navigation aid
CN208515591U (en) * 2018-05-25 2019-02-19 广州供电局有限公司 The passage equipment of cable tunnel
CN109683629A (en) * 2019-01-09 2019-04-26 燕山大学 Unmanned plane electric stringing system based on integrated navigation and computer vision
CN110080766A (en) * 2019-04-30 2019-08-02 中国矿业大学 Fully-mechanized mining working coal petrography identification device and method
CN209402076U (en) * 2018-02-07 2019-09-17 河南德祥电力安装有限公司 Cable laying engineering truck with sensor positioning function

Patent Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5464282A (en) * 1977-10-31 1979-05-23 Komatsu Ltd Guide cable laying method of driverless car
JPH01117613A (en) * 1987-10-29 1989-05-10 Toshiba Corp Robot apparatus for cable-laying work
CN102639793A (en) * 2009-10-21 2012-08-15 卡特彼勒公司 Cable tracking system and method for mobile machines
CN102482863A (en) * 2010-01-26 2012-05-30 胡斯华纳有限公司 Laying machine
CN103410512A (en) * 2013-08-15 2013-11-27 中国矿业大学 Geological environment information-fused absolute positioning device and method for coal cutter
CN103457203A (en) * 2013-09-06 2013-12-18 沈阳师范大学 Comprehensive robot cabling method based on internet of things
CN104990549A (en) * 2015-06-15 2015-10-21 中国矿业大学 Method and device for relatively locating coal cutter and hydraulic supports
US20170317479A1 (en) * 2016-05-02 2017-11-02 Lg Electronics Inc. Wire installation apparatus and control method thereof
CN206707709U (en) * 2017-05-15 2017-12-05 湖南科技大学 A kind of coal-winning machine feed control device
CN107910806A (en) * 2017-09-20 2018-04-13 国网辽宁省电力有限公司检修分公司 A kind of cable tunnel inspection robot and air navigation aid
CN209402076U (en) * 2018-02-07 2019-09-17 河南德祥电力安装有限公司 Cable laying engineering truck with sensor positioning function
CN208515591U (en) * 2018-05-25 2019-02-19 广州供电局有限公司 The passage equipment of cable tunnel
CN109683629A (en) * 2019-01-09 2019-04-26 燕山大学 Unmanned plane electric stringing system based on integrated navigation and computer vision
CN110080766A (en) * 2019-04-30 2019-08-02 中国矿业大学 Fully-mechanized mining working coal petrography identification device and method

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
冯帅: "采煤机-液压支架相对位置融合校正系统关键技术研究", 《中国优秀硕士学位论文全文数据库工程科技I辑》 *

Similar Documents

Publication Publication Date Title
US7443124B2 (en) Method and device for operating a machine, such as a multiaxial industrial robot
CN117901124B (en) Method and system for intelligently identifying car coupler of car dumper based on unhooking robot
CN110409550A (en) A fully automatic operation underground mining scraper
CN102826456B (en) Heavy construction equipment encoder spatial location, Intelligent collision avoidance system
CN111634636B (en) Full-automatic material taking control system of bucket wheel machine
CN113593284B (en) Method and device for planning path of vehicle in mine roadway and electronic equipment
EP4428632A1 (en) Autonomous driving control system and vehicle
CN106740906A (en) The unmanned vehicle control syetem of mine locomotive and its control method
CN112223273A (en) Industrial robot visual detection and obstacle avoidance system
CN206475876U (en) The unmanned vehicle control syetem of mine locomotive
CN115164884B (en) Unmanned aerial vehicle flight state on-line monitoring system
CN105974924A (en) AGV trolley self-adaptive navigation method and system
CN119412053B (en) Intelligent mining control method for unmanned working face of thin coal seam
CN115564396A (en) Roadbed intelligent operation system integrating 5G communication technology
CN209683619U (en) The control system and automatic driving vehicle of automatic driving vehicle
CN111003577A (en) Inertial navigation system integrating shaft encoder positioning and infrared sensor positioning
CN105353348A (en) System and method for positioning moving target under coal mine
CN201816610U (en) Real-time track data acquiring and processing device
CN109856751A (en) Deep-sea cable laying drum type cable laying machine and its laying method
CN110989580A (en) A positioning control system of a conveyor for laying cables in a tunnel
CN109318945B (en) Train control method, device and system
CN120397751A (en) Bucket wheel machine anti-collision system and anti-collision method
CN202766129U (en) Space location intelligent anti-collision system of large construction device coder
JP2016130110A (en) Condition monitoring device, condition monitoring system, and train train
CN208037763U (en) Elevator position detector

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
TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20201217

Address after: 200122, 1122 deep road, Pudong New Area, Shanghai

Applicant after: STATE GRID SHANGHAI MUNICIPAL ELECTRIC POWER Co.

Applicant after: Construction Consulting Branch of China Online Shanghai Electric Power Co.

Applicant after: SHANGHAI JIANGJUN INFORMATION CONSULTATION Co.,Ltd.

Applicant after: Shanghai Lianti Information Technology Co.,Ltd.

Address before: 200122, 1122 deep road, Pudong New Area, Shanghai

Applicant before: STATE GRID SHANGHAI MUNICIPAL ELECTRIC POWER Co.

Applicant before: Construction Consulting Branch of China Online Shanghai Electric Power Co.

Applicant before: SHANGHAI ELECTRIC POWER CABLE ENGINEERING Co.,Ltd.

Applicant before: SHANGHAI JIANGJUN INFORMATION CONSULTATION Co.,Ltd.

Applicant before: Shanghai Lianti Information Technology Co.,Ltd.

RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20200414