CN112977548B - Train positioning system and method combining instant positioning and map construction - Google Patents

Train positioning system and method combining instant positioning and map construction Download PDF

Info

Publication number
CN112977548B
CN112977548B CN202110006356.6A CN202110006356A CN112977548B CN 112977548 B CN112977548 B CN 112977548B CN 202110006356 A CN202110006356 A CN 202110006356A CN 112977548 B CN112977548 B CN 112977548B
Authority
CN
China
Prior art keywords
positioning
train
beacon
speed
mileage
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
Application number
CN202110006356.6A
Other languages
Chinese (zh)
Other versions
CN112977548A (en
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.)
Unittec Co Ltd
Original Assignee
Unittec 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 Unittec Co Ltd filed Critical Unittec Co Ltd
Priority to CN202110006356.6A priority Critical patent/CN112977548B/en
Publication of CN112977548A publication Critical patent/CN112977548A/en
Application granted granted Critical
Publication of CN112977548B publication Critical patent/CN112977548B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B61RAILWAYS
    • B61LGUIDING RAILWAY TRAFFIC; ENSURING THE SAFETY OF RAILWAY TRAFFIC
    • B61L25/00Recording or indicating positions or identities of vehicles or trains or setting of track apparatus
    • B61L25/02Indicating or recording positions or identities of vehicles or trains
    • B61L25/021Measuring and recording of train speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B61RAILWAYS
    • B61LGUIDING RAILWAY TRAFFIC; ENSURING THE SAFETY OF RAILWAY TRAFFIC
    • B61L25/00Recording or indicating positions or identities of vehicles or trains or setting of track apparatus
    • B61L25/02Indicating or recording positions or identities of vehicles or trains
    • B61L25/026Relative localisation, e.g. using odometer
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B61RAILWAYS
    • B61LGUIDING RAILWAY TRAFFIC; ENSURING THE SAFETY OF RAILWAY TRAFFIC
    • B61L25/00Recording or indicating positions or identities of vehicles or trains or setting of track apparatus
    • B61L25/02Indicating or recording positions or identities of vehicles or trains
    • B61L25/028Determination of vehicle position and orientation within a train consist, e.g. serialisation

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Electric Propulsion And Braking For Vehicles (AREA)
  • Navigation (AREA)

Abstract

The invention discloses a train positioning system combining instant positioning and map construction, which comprises a beacon database, a vehicle-mounted controller and a positioning correction module, wherein the beacon database comprises the following components: beacon data are stored in the beacon database; the vehicle-mounted controller is provided with a beacon identification module and a speed acquisition module, and sends train mileage data, train section positioning information and real-time train speed to a positioning correction module; the positioning correction module comprises an environment sensing sensor and a vehicle-mounted data processor, the vehicle-mounted data processor acquires the position of the train by utilizing an SLAM technology according to environment information, and the positioning correction is realized by combining data provided by a vehicle-mounted controller. The invention also provides a train positioning method, which adopts the train positioning system to position. The invention not only realizes the improvement of the positioning precision of the train, but also does not rely on satellite signals for positioning, has wider application scenes, does not need to newly add beacons and trackside equipment, and has lower maintenance cost.

Description

Train positioning system and method combining instant positioning and map construction
Technical Field
The invention belongs to the technical field of rail transit, and particularly relates to a train positioning technology.
Background
In the technical field of rail transit, positioning data of trains are needed. The conventional train positioning technology obtains the current position information of the train through a beacon installed on a track or a combination of a GPS and an inertial sensor, and the current mainstream method is train positioning through a passive or active beacon.
For the existing track traffic line positioned by using the beacons, the number of the beacons needs to be increased and even the beacons need to be laid again for further improving the positioning accuracy, the transformation cost is high, and the construction and maintenance difficulty is high; although the positioning mode of the combination of the GPS and the inertial sensor does not need to increase a huge amount of construction, the positioning mode has certain limitations, for example, the GPS is difficult to provide accurate positioning in a tunnel environment, the positioning accuracy is not high due to accumulated errors caused by the characteristics of the inertial sensor, and the positioning error may be within plus or minus 5 meters or even lower, which means that the positioning reliability of the beacon is not as high as that of the GPS and the inertial sensor.
Disclosure of Invention
The invention aims to solve the technical problem of providing a train positioning system combining instant positioning and map construction, which does not need to increase the installation number of beacons on the basis of the existing beacon positioning and improves the train positioning precision.
In order to solve the technical problem, the invention adopts the following technical scheme: a train positioning system that combines instant positioning with mapping, comprising:
a beacon database: beacon data are stored in the beacon database and comprise a beacon serial number, the position of the beacon and mileage data corresponding to each beacon serial number;
the vehicle-mounted controller: the vehicle-mounted controller is provided with a beacon identification module which can identify a beacon installed on a track and acquire a serial number of the current beacon, and a speed acquisition module which can acquire the real-time speed of the current train, acquires the mileage corresponding to the beacon and the train section positioning by accessing a beacon database, and sends train mileage data, train section positioning information and the real-time speed of the train to the positioning correction module;
a positioning correction module: the positioning correction module comprises an environment sensing sensor and a vehicle-mounted data processor, wherein the environment sensing sensor is arranged at the head of the train and used for acquiring environment information in the running direction of the train, and the vehicle-mounted data processor acquires the position of the train by utilizing an SLAM technology according to the environment information and realizes positioning correction by combining data provided by a vehicle-mounted controller.
Preferably, the environmental perception sensor comprises a lidar and/or a high speed camera.
Preferably, the environment information includes a rail surface, a tunnel wall and a trackside device.
The invention also provides a train positioning method, which adopts the train positioning system to position and comprises the following steps:
s1, starting train positioning from the identification of a first beacon by a beacon identification module, and continuously acquiring the current speed of a train by a speed acquisition module and sending the current speed to a positioning correction module;
s2: when a beacon is identified, acquiring a serial number corresponding to the beacon, acquiring the mileage and section positioning of the current train by inquiring a beacon database, and sending the mileage data and section positioning information of the train to a positioning correction module;
s3, the positioning correction module takes the position of the current beacon as the original point of the current local feature map, continuously acquires three-dimensional space environment information in front of the train head through an environment perception sensor, extracts features with discrimination and constructs an initial local feature map;
s4: updating a local feature map by utilizing an SLAM according to the acquired latest frame feature;
s5: according to the space position of the latest frame of features on the local feature map, local positioning of the train on the local feature map is obtained;
s6: the set of the positions of the train on the local feature map represents a running path, and the mileage of the train starting to run from the last beacon is calculated according to the original point position and the running path;
s7, calculating the average speed of the train according to the results of two SLAM positioning and the adjacent time interval, comparing the average speed with the train speed sent by the vehicle-mounted controller, and calculating a speed error; if the speed error exceeds the set threshold value for a plurality of times continuously, the SLAM positioning is considered to be invalid; when no SLAM positioning result exists in a plurality of continuous time periods, the SLAM positioning is considered to be invalid;
s8: when SLAM positioning fails, calculating the mileage of train operation according to the product of the train speed and the time interval of the acquired speed, and calculating the positioning position of a train section according to the mileage data acquired when the previous beacon passes and the mileage of train operation, wherein the section positioning is used as a correction positioning result output by a positioning correction module;
s9, when the SLAM is not invalid, calculating the positioning position of a train section according to the mileage acquired in the step S6 and the mileage data acquired when the train passes through the previous beacon, wherein the positioning of the train section is used as a correction positioning result output by a positioning correction module;
s10: when the beacon identification module identifies a new beacon, the train mileage and section positioning data acquired by beacon positioning are used as new positioning initial values to be transmitted to the positioning correction module; the positioning correction module reconstructs a new local feature map and outputs a corrected positioning result, so that continuous positioning output between two adjacent beacons identified by the beacon identification module is realized.
The technical scheme adopted by the invention combines the instant positioning and map building (SLAM for short) technology to position the train on the basis of the existing beacon positioning technology, and has the following beneficial effects:
for the rail transit line using beacon positioning, the beacon and the trackside equipment do not need to be newly added, so that the positioning precision of the train is improved, the upgrading cost is greatly reduced compared with the method for re-distributing the beacon, and the subsequent maintenance cost is lower; meanwhile, the technical scheme does not depend on satellite signals for positioning, is wide in applicable scene, and can effectively improve positioning accuracy for lines with more tunnels.
The method combines the traditional beacon positioning technology and the SLAM technology, improves the positioning accuracy by using the SLAM as an auxiliary, has practical significance for upgrading and transforming the old line, adopts a brand new system without abandoning the original equipment, and simultaneously utilizes the advantage of high maturity and reliability of the traditional beacon positioning technology.
The following detailed description of the present invention will be provided in conjunction with the accompanying drawings.
Drawings
The invention is further described with reference to the following figures and detailed description:
FIG. 1 is a system schematic of the train positioning system of the present invention;
fig. 2 is a process flow chart of the train positioning method of the present invention.
Detailed Description
The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. The following description of at least one exemplary embodiment is merely illustrative in nature and is in no way intended to limit the invention, its application, or uses. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
Example one
As shown in fig. 1, a train positioning system includes:
a beacon database: and storing mileage data corresponding to all beacon serial numbers, and accessing a beacon database to obtain mileage and train section positioning positions corresponding to beacons.
The vehicle-mounted controller: the train speed acquisition system comprises a beacon identification module and a speed acquisition module, wherein the beacon identification module can identify beacons installed on a track and acquire the serial number of the current beacon, and the speed acquisition module can acquire the real-time speed of the current train.
A positioning correction module: the environment-friendly train head environment monitoring system comprises an environment sensing sensor and a vehicle-mounted data processor which are arranged on a train head. The environment perception sensor can acquire environment information in the running direction of the train, and the environment information comprises characteristic reference objects such as a rail surface in front of a train head, a tunnel wall, trackside equipment and the like; and the vehicle-mounted data processor acquires the position of the train by utilizing an SLAM technology according to the data provided by the environment perception sensor, and realizes positioning correction by combining the data provided by the vehicle-mounted controller.
The beacon database and the onboard controllers described above may also be referred to in particular in the prior art.
In this embodiment, the environmental perception sensor is a multi-line lidar. Of course, a high-speed camera with a frame rate of more than 100 frames/second may be used, or a combination of a lidar and a camera or other sensor may be used.
Example two
As shown in fig. 2, a train positioning method is specifically implemented by the following steps:
s201: a speed acquisition module of the vehicle-mounted controller continuously acquires the current speed of the train and sends the current speed to a positioning correction module; an environment sensing sensor in the positioning correction module acquires surrounding environment information in front of a train, wherein the acquired surrounding environment information is laser point cloud in front of a train head; the location is started by identifying the first beacon.
S202: when the beacon identification module of the vehicle-mounted controller identifies a beacon, the beacon database is inquired according to the identified beacon serial number to obtain the mileage and the section positioning of the current train (the section positioning is the result obtained according to the beacon positioning), and the data is sent to the positioning correction module.
S203: a data processor of the positioning correction module records the acquired train mileage and section positioning information, and takes the position of the current beacon as the origin of the current local feature map; the method comprises the following steps that an environment perception sensor continuously obtains three-dimensional space environment information in front of a train head, and a data processor extracts characteristic values with discrimination, such as planes, angular points and straight lines; and constructing an initial local feature map according to the feature value of the first frame.
S204: and matching the feature value of the latest frame with the local feature map, and updating the local feature map. Further, in the present embodiment, the matching rule is based on an Iterative Closest Point (ICP) algorithm. Of course, the matching algorithm may also be a Normal Distribution Transform (NDT) algorithm, or other existing matching algorithms.
S205: and acquiring the local positioning of the train on the local feature map according to the space position of the latest frame of feature on the local feature map (the local positioning is the SLAM positioning result).
S206: and the set of the positions of the train on the local feature map represents a running path, and the mileage of the train starting to run from the last beacon is calculated according to the origin position and the running path of the local feature map.
S207: calculating the average speed of the train according to the spatial positions of the characteristics of the front frame and the rear frame on the local characteristic map and the time interval of the two adjacent frames, comparing the average speed with the speed of the train sent by the vehicle-mounted controller, and calculating a speed error; SLAM location is considered invalid if the speed error exceeds a set threshold for a number of consecutive times, or if the local feature map does not add new features for a number of consecutive time periods when the train is not stationary.
S208: when SLAM positioning fails, calculating the mileage of train operation according to the product of the train speed and the time interval of the acquired speed, and calculating the positioning position of a train section according to the mileage data acquired when the previous beacon passes and the mileage of train operation, wherein the section positioning is a correction positioning result output by a positioning correction module; and clearing the local feature map and the path of the train on the local feature map, and initializing SLAM positioning.
S209: when the SLAM is not disabled, the train section location position is calculated based on the mileage acquired in step S206 and the mileage data acquired when the previous beacon passes, and the section location is a corrected location result output by the location correction module.
S210: when the beacon identification module identifies a new beacon, the train mileage and section positioning data acquired by beacon positioning are used as new positioning initial values to be transmitted to the positioning correction module; and the positioning correction module reconstructs a new local feature map according to the steps S203-S209 and outputs a positioning correction result. Continuous positioning output between two adjacent beacons is realized when the beacon identification module identifies.
The invention combines the instant positioning and map building (SLAM for short) technology to position the train on the basis of the existing beacon positioning technology, does not need to newly add beacons and trackside equipment for the rail transit line using the beacon positioning, not only realizes the improvement of the positioning precision of the train, but also greatly reduces the upgrade cost relative to the re-arrangement of the beacons, and has lower subsequent maintenance cost; meanwhile, the technical scheme does not rely on satellite signals for positioning, is wide in applicable scene, and can effectively improve positioning accuracy for lines with more tunnels.
Because the traditional beacon positioning and SLAM technology is combined, the SLAM is used as an assistant to improve the positioning accuracy, the method has practical significance for upgrading and reconstructing the old line, the original equipment is not required to be abandoned, a brand new system is adopted, and the advantages of maturity and high reliability of the traditional beacon positioning technology are utilized.
While the invention has been described with reference to specific embodiments, it will be understood by those skilled in the art that the invention is not limited thereto, and may be embodied in other forms without departing from the spirit or essential characteristics thereof. Any modification which does not depart from the functional and structural principles of the present invention is intended to be included within the scope of the claims.

Claims (3)

1. A train positioning method adopts a train positioning system for positioning, and the train positioning system comprises: a beacon database: beacon data are stored in the beacon database and comprise a beacon serial number, the position of the beacon and mileage data corresponding to each beacon serial number;
the vehicle-mounted controller: the vehicle-mounted controller is provided with a beacon identification module which can identify a beacon installed on a track and acquire a serial number of the current beacon, and a speed acquisition module which can acquire the real-time speed of the current train, acquires the mileage and train section positioning corresponding to the beacon by accessing a beacon database, and sends train mileage data, train section positioning information and the real-time speed of the train to a positioning correction module;
a positioning correction module: the positioning correction module comprises an environment sensing sensor and a vehicle-mounted data processor, wherein the environment sensing sensor is arranged at the head of the train and used for acquiring environment information in the running direction of the train, and the vehicle-mounted data processor acquires the position of the train by utilizing an SLAM technology according to the environment information and realizes positioning correction by combining data provided by a vehicle-mounted controller;
the train positioning method comprises the following steps:
s1, starting train positioning from the identification of a first beacon by a beacon identification module, and continuously acquiring the current speed of a train by a speed acquisition module and sending the current speed to a positioning correction module;
s2: when a beacon is identified, acquiring a serial number corresponding to the beacon, acquiring the mileage and section positioning of the current train by inquiring a beacon database, and sending the mileage data and section positioning information of the train to a positioning correction module;
s3, the positioning correction module takes the position of the current beacon as the original point of the current local feature map, continuously acquires three-dimensional space environment information in front of the train head through an environment perception sensor, extracts features with discrimination and constructs an initial local feature map;
s4: updating a local feature map by utilizing an SLAM according to the acquired latest frame feature;
s5: according to the space position of the latest frame of features on the local feature map, local positioning of the train on the local feature map is obtained;
s6: the set of the positions of the train on the local feature map represents a running path, and the mileage of the train starting to run from the last beacon is calculated according to the original point position and the running path;
s7, calculating the average speed of the train according to the results of two SLAM positioning and the adjacent time interval, comparing the average speed with the train speed sent by the vehicle-mounted controller, and calculating a speed error; if the speed error exceeds the set threshold value for a plurality of times continuously, the SLAM positioning is considered to be invalid; when no SLAM positioning result exists in a plurality of continuous time periods, the SLAM positioning is considered to be invalid;
s8: when SLAM positioning fails, calculating the mileage of train operation according to the product of the train speed and the time interval of the acquired speed, and calculating the positioning position of a train section according to the mileage data acquired when the previous beacon passes and the mileage of train operation, wherein the section positioning is used as a correction positioning result output by a positioning correction module;
s9, when the SLAM is not invalid, calculating the positioning position of a train section according to the mileage acquired in the step S6 and the mileage data acquired when the train passes through the previous beacon, wherein the section positioning is used as a correction positioning result output by a positioning correction module;
s10: when the beacon identification module identifies a new beacon, the train mileage and section positioning data acquired by beacon positioning are used as new positioning initial values to be transmitted to the positioning correction module; and the positioning correction module reconstructs a new local feature map and outputs a corrected positioning result.
2. The train positioning method according to claim 1, characterized in that: the environmental perception sensor includes a lidar and/or a high speed camera.
3. The train positioning method according to claim 2, characterized in that: the environment information includes a rail face, a tunnel wall, and trackside equipment.
CN202110006356.6A 2021-01-05 2021-01-05 Train positioning system and method combining instant positioning and map construction Active CN112977548B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110006356.6A CN112977548B (en) 2021-01-05 2021-01-05 Train positioning system and method combining instant positioning and map construction

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110006356.6A CN112977548B (en) 2021-01-05 2021-01-05 Train positioning system and method combining instant positioning and map construction

Publications (2)

Publication Number Publication Date
CN112977548A CN112977548A (en) 2021-06-18
CN112977548B true CN112977548B (en) 2023-01-06

Family

ID=76345288

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110006356.6A Active CN112977548B (en) 2021-01-05 2021-01-05 Train positioning system and method combining instant positioning and map construction

Country Status (1)

Country Link
CN (1) CN112977548B (en)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2022076707A1 (en) * 2020-10-07 2022-04-14 Washington Metro Area Transit Authority AKA WMATA Resource navigation system and methods
CN113548094B (en) * 2021-07-28 2023-08-18 通号城市轨道交通技术有限公司 Train positioning and coupling method and system based on multiple sensors
CN115071785B (en) * 2022-06-28 2022-12-23 广州地铁设计研究院股份有限公司 Online updating method for urban rail transit signals
CN115320670A (en) * 2022-08-04 2022-11-11 卡斯柯信号有限公司 Train positioning method based on dynamic map

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101357643A (en) * 2008-08-21 2009-02-04 北京交通大学 Accurate train positioning method and system realized by digital trail map and GPS
AU2009243415A1 (en) * 2008-11-28 2010-06-17 Technological Resources Pty. Limited Rail Vehicle Tracking System and Method
CN106447789A (en) * 2016-11-29 2017-02-22 湖南中车时代通信信号有限公司 Method and system of line data and GIS combination of train operation monitoring system
CN110281983A (en) * 2019-06-28 2019-09-27 清华大学 A kind of accurate shutdown system of track train of view-based access control model scene Recognition
CN111224710A (en) * 2020-01-09 2020-06-02 北京交通大学 Virtual transponder capturing method and system based on satellite space distribution inspection

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111775975A (en) * 2020-07-09 2020-10-16 中国恩菲工程技术有限公司 Mine car positioning control system and method

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101357643A (en) * 2008-08-21 2009-02-04 北京交通大学 Accurate train positioning method and system realized by digital trail map and GPS
AU2009243415A1 (en) * 2008-11-28 2010-06-17 Technological Resources Pty. Limited Rail Vehicle Tracking System and Method
CN106447789A (en) * 2016-11-29 2017-02-22 湖南中车时代通信信号有限公司 Method and system of line data and GIS combination of train operation monitoring system
CN110281983A (en) * 2019-06-28 2019-09-27 清华大学 A kind of accurate shutdown system of track train of view-based access control model scene Recognition
CN111224710A (en) * 2020-01-09 2020-06-02 北京交通大学 Virtual transponder capturing method and system based on satellite space distribution inspection

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
地铁智能巡检车高精度自主定位技术研究;路通;《中国优秀硕士论文全文数据库》;20200115(第01期);第2.1-2.3节,第4.1、4.2节 *

Also Published As

Publication number Publication date
CN112977548A (en) 2021-06-18

Similar Documents

Publication Publication Date Title
CN112977548B (en) Train positioning system and method combining instant positioning and map construction
CN109484435B (en) Train positioning method and device suitable for intelligent rail transit detection system
CN111856541B (en) Fixed line vehicle track monitoring system and method
CN112650220B (en) Automatic vehicle driving method, vehicle-mounted controller and system
WO2023274229A1 (en) Vehicle trajectory deviation correction method and apparatus, and electronic device
WO2018152899A1 (en) Safe and reliable method, device, and system for real-time speed measurement and continuous positioning
CN110758476B (en) Train positioning method and system
CN110136469B (en) Method and device for compensating driving data of bus
JP2014522495A (en) Apparatus for measuring the speed and position of a vehicle moving along a guiding track, and corresponding method and computer program product
CN112009522B (en) Train control system and method for mountain track
CN110631589B (en) Method for correcting positioning track in real time
CN110789585B (en) Method and system for capturing train virtual transponder
CN105096590A (en) Traffic information generation method and device
CN115856872A (en) Vehicle motion track continuous tracking method
CN109975851A (en) A kind of train line fault point accurate positioning method and system
CN114396958B (en) Lane positioning method and system based on multiple lanes and multiple sensors and vehicle
CN114044027A (en) Method for realizing train positioning on two-dimensional electronic map
CN112085034A (en) Rail transit train positioning method and system based on machine vision
CN113375661A (en) Positioning navigation method and system of unmanned system
CN113888713B (en) Method for recovering road surface missing points by vehicle-mounted laser point cloud data
CN114537481B (en) Mobile closed train operation control method based on grating array
CN116416588A (en) Lane line prediction method, lane line prediction device, electronic equipment and storage medium
CN114608589A (en) Multi-sensor information fusion method and system
CN114241447A (en) Real-time obstacle detection method based on vehicle-mounted equipment
CN109752017B (en) Travel route track generation system for unmanned low-speed vehicle

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