CN110027593A - A kind of full-automatic unmanned driving's rail vehicle safe-guard system - Google Patents
A kind of full-automatic unmanned driving's rail vehicle safe-guard system Download PDFInfo
- Publication number
- CN110027593A CN110027593A CN201910291790.6A CN201910291790A CN110027593A CN 110027593 A CN110027593 A CN 110027593A CN 201910291790 A CN201910291790 A CN 201910291790A CN 110027593 A CN110027593 A CN 110027593A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- safe
- controller
- guard system
- driving
- 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
Links
- HDDSHPAODJUKPD-UHFFFAOYSA-N fenbendazole Chemical compound C1=C2NC(NC(=O)OC)=NC2=CC=C1SC1=CC=CC=C1 HDDSHPAODJUKPD-UHFFFAOYSA-N 0.000 title claims abstract description 35
- 238000012544 monitoring process Methods 0.000 claims abstract description 28
- 238000000034 method Methods 0.000 claims abstract description 13
- 238000012423 maintenance Methods 0.000 claims abstract description 10
- 238000010276 construction Methods 0.000 claims abstract description 4
- 238000012372 quality testing Methods 0.000 claims abstract description 4
- 238000004891 communication Methods 0.000 claims description 27
- 238000005259 measurement Methods 0.000 claims description 25
- 230000004888 barrier function Effects 0.000 claims description 18
- 238000001514 detection method Methods 0.000 claims description 15
- 238000004364 calculation method Methods 0.000 claims description 9
- 230000005540 biological transmission Effects 0.000 claims description 3
- 230000008878 coupling Effects 0.000 claims description 3
- 238000010168 coupling process Methods 0.000 claims description 3
- 238000005859 coupling reaction Methods 0.000 claims description 3
- 238000012360 testing method Methods 0.000 claims description 2
- 230000008569 process Effects 0.000 abstract description 6
- 238000012545 processing Methods 0.000 description 9
- 230000009466 transformation Effects 0.000 description 6
- 238000004422 calculation algorithm Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 5
- 230000007613 environmental effect Effects 0.000 description 4
- 238000007493 shaping process Methods 0.000 description 4
- 230000008859 change Effects 0.000 description 3
- 238000001914 filtration Methods 0.000 description 3
- 230000009467 reduction Effects 0.000 description 3
- 230000003321 amplification Effects 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000003199 nucleic acid amplification method Methods 0.000 description 2
- 238000012795 verification Methods 0.000 description 2
- 240000007594 Oryza sativa Species 0.000 description 1
- 235000007164 Oryza sativa Nutrition 0.000 description 1
- 230000001186 cumulative effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 238000007667 floating Methods 0.000 description 1
- 238000003709 image segmentation Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000035772 mutation Effects 0.000 description 1
- 230000002035 prolonged effect Effects 0.000 description 1
- 238000004064 recycling Methods 0.000 description 1
- 235000009566 rice Nutrition 0.000 description 1
- 238000011426 transformation method Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B61—RAILWAYS
- B61C—LOCOMOTIVES; MOTOR RAILCARS
- B61C17/00—Arrangement or disposition of parts; Details or accessories not otherwise provided for; Use of control gear and control systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B61—RAILWAYS
- B61L—GUIDING RAILWAY TRAFFIC; ENSURING THE SAFETY OF RAILWAY TRAFFIC
- B61L23/00—Control, warning or like safety means along the route or between vehicles or trains
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Train Traffic Observation, Control, And Security (AREA)
- Electric Propulsion And Braking For Vehicles (AREA)
Abstract
The invention discloses a kind of full-automatic unmanned driving's rail vehicle safe-guard systems, including Mini-railway vehicle, the controller that driving vehicle is advanced is equipped in vehicle, including normally travel, monitoring remote video, vehicle trouble, to lose control of one's vehicle and travel to five safe-guard systems of obstacle quality testing, the accurate construction numerical map of target track is loaded under in controller, after encoder and electronic beacon positioning, current vehicle present position and local environment can be accurately positioned in controller, and carries out reasonable speed control according to local environment；When controller detects critical failure, parking maintenance alarm is carried out；When controller detects that vehicle is in uncontrollable state, motor power is cut off by force by heavy current breaker.Compared with prior art, the present invention realizes the unmanned track maintenance vehicle safe driving of overlength distance.Ensure that in operation process, uncontrollable failure and safety accident do not occur for unmanned rail vehicle.
Description
Technical field
The present invention relates to railway, track remote service field more particularly to a kind of full-automatic unmanned driving's rail vehicle peaces
Full safeguards system.
Background technique
The detection of the railroad flaws such as existing railway, subway is completed by artificial walking or large-scale manned automatic maintenance vehicle.
Artificial walking monitoring efficiency is lower, and erroneous detection easily occurs；Large-scale person-carrying vehicle security level is high (manned equipment), and figure is huge
Greatly, not easy to use.There are no (tens or even hundreds of kilometer) unmanned detection systems over long distances for railway track traffic system at present
The application of system.The unmanned security level that can reduce detection vehicle, and its efficiency for executing operation is much higher than artificial detection.This
The vehicle driving safety safeguards system of Patent design can guarantee that unmanned railcar is executing overlength distance automatic job times
When business, uncontrollable failure and and accident do not occur.
Summary of the invention
The object of the invention is that providing a kind of solve the above problems.
To achieve the goals above, the technical solution adopted by the present invention is that: a kind of full-automatic unmanned driving's rail vehicle peace
Full safeguards system, including Mini-railway vehicle, are equipped with the controller that driving vehicle is advanced in vehicle, including normally travel, long-range
Video monitoring, to lose control of one's vehicle and is travelled to five safe-guard systems of obstacle quality testing at vehicle trouble,
1) normally travel safe-guard system,
A. a measurement wheel is added on vehicle, which is equipped with the high precision position for calculating vehicle movement distance
Encoder；
B. position is fixed on target track, and Ground Electronic label used for positioning, number and absolute position one are installed
One is corresponding, and the high accuracy positioning electronic beacon reader to match with Ground Electronic label is added on vehicle, utilizes track
The own calibration system of unit of operation calibrates the encoder on vehicle, so that it is determined that the absolute position of vehicle；
C. in controller under be loaded with the accurate construction numerical map of target track, pass through encoder and electronic beacon positioning
Afterwards, current vehicle present position and local environment can be accurately positioned in controller, and carries out reasonable speed according to local environment
Control；
2) monitoring remote video safe-guard system
One and monitoring camera are respectively loaded before and after vehicle, monitoring camera is connect with controller, and monitoring camera is logical
Video cloud is crossed by camera real-time data transmission to remote monitoring end；
3) vehicle trouble states safe-guard system
Vehicle considers the security control of fault condition, when controller detects critical failure, carries out parking maintenance alarm；
4) safe-guard system to lose control of one's vehicle
It is provided with a heavy current breaker in the power output end of motor, when controller detects that vehicle is in uncontrollable
When state, motor power is cut off by force by heavy current breaker, to ensure safety traffic；
5) it travels to detection of obstacles safe-guard system
One one-line scanning laser radar is respectively housed in vehicle front and back ends, being able to detect in driving direction may be with vehicle
The barrier to collide detects barrier alarm, parking.
Preferably, being co-axially mounted, being measured using shaft coupling between high precision position encoder and measurement wheel in step a
Wheel is standard cylindrical wheel body, is pressed in orbital plane using spring, and measurement wheel follows vehicle movement, drives encoder rotation, compiles
Pulse signal is sent to controller when code device rotation, controller is according to pulse count calculation vehicle movement distance.
Preferably, the measurement accuracy of high precision position encoder is better than 1mm.
Preferably, in step c, the interior all ramps containing in target track operation interval of numerical map of precisely constructing,
Bend, turnout, website and positioning electronic beacon accurate location information, and contain corresponding speed limit data.
Preferably, vehicle is before normal operation, and vehicle is arranged in target track in location information according to the map in step c
On operation interval, vehicle can only travel in the section, alarm of then stopping beyond driving range.
Preferably, reasonable method for control speed, controller can be obtained by encoder and electronic beacon in step c
Pick-up accurate location data, and the data of middle target track operation area according to the map, by the dynamics calculation of vehicle, certainly
Vehicle is determined in the maximum safe velocity on each bend, ramp and turnout, sets the reasonable speed of vehicle.
It is the high-precision encoder communication failure that will test, electronic map data failure, fixed preferably, in step 3)
Position beacon communication failure, laser radar communication failure, remote control terminal communication failure, driving motor communication failure, driving motor
Performance fault, battery system communication failure, battery system internal fault, braking system faults are considered as critical failure, stop
Alarm.
Preferably, if motor being capable of automatic braking after wherein detecting motor and controller communication failure.
Preferably, sending warning message to remote monitoring end if detecting the light alerting system system failure in step 3)
And continue to execute operation, if parking maintenance is determined by remote monitoring end operator.
Preferably, in step 4), the uncontrollable state include not according to setting speed traveling, hypervelocity, brake fade,
Controller crashes, motor driver crashes.
Compared with the prior art, the advantages of the present invention are as follows:
1. solving the unmanned track of overlength distance overhauls vehicle safe driving.
2. ensuring that in operation process, uncontrollable failure and safety accident do not occur for unmanned rail vehicle.
3. comprehensively, multilevel security control and pretreatment.
Detailed description of the invention
Fig. 1 is overall structure functional block diagram of the invention；
Fig. 2 is the functional block diagram of normal form safe-guard system of the present invention；
Fig. 3 is the functional block diagram of vehicle driving monitoring system of the present invention；
Fig. 4 is the functional block diagram of vehicle trouble states of the present invention；
Fig. 5 is the functional block diagram of state to lose control of one's vehicle of the invention.
Specific embodiment
The invention will be further described below.
Embodiment 1: referring to Fig. 1, a kind of full-automatic unmanned driving's rail vehicle safe-guard system, including Mini-railway vehicle
, the controller that driving vehicle is advanced is equipped in vehicle, controller uses High performance industrial PLC, including normally travel, long-range view
Frequency monitoring, to lose control of one's vehicle and is travelled to five safe-guard systems of obstacle quality testing at vehicle trouble,
(1) normally travel safe-guard system, referring to fig. 2
A measurement wheel is added on vehicle, which is equipped with high precision position encoder, and high precision position is compiled
The measurement accuracy of code device is better than 1mm, and detection precision is high.It is coaxial using shaft coupling between high precision position encoder and measurement wheel
Installation, measurement wheel is standard cylindrical wheel body (different with rail wheel), is pressed in orbital plane using spring, and measurement wheel follows
Vehicle movement drives encoder rotation, pulse signal is sent to controller when encoder rotates, to controller when encoder rotates
Pulse signal (1mm sends a pulse) is sent, controller is according to pulse count calculation vehicle movement distance；In this system application
In, carrier of the railcar as railroad flaws vision measurement system needs to provide driving pulse to vision measurement system, and vision is surveyed
It measures the every 1mm of system requirements and one pulse is provided, the measurement accuracy of high precision position encoder need to be better than 1mm.
Track unit of operation fixes position (every 1Km) on its target track and is equipped with Ground Electronic mark used for positioning
Label, number are corresponded with absolute position, and the high accuracy positioning electricity to match with Ground Electronic label is added on vehicle
Sub- beacon reader calibrates the encoder on vehicle using the calibration system that track unit of operation has by oneself, so that it is determined that
The absolute position of vehicle.Since the measurement wheel that is installed on vehicle is there may be skidding, crossing turnout the factors such as to takeoff, cause to measure
Wheel can generate cumulative errors when prolonged exercise, therefore the absolute position of vehicle is determined by the way of electronic beacon,
To realize the precise positioning of vehicle.
Electronic beacon has Multiple Type (each track operator, such as Chengdu subway, Beijing Metro etc., the mark used
Quasi- and product is variant, and the high accuracy positioning electronic beacon of use is matched according to concrete model.
Electronic beacon is divided into two equipment of reader (antenna) and label, and label is placed on the fixation position of target track,
Reader (antenna) is installed on vehicle.Absolute position: i.e. using track one end as starting point, electronic beacon is relative to track starting point
Absolute distance.
When vehicle is by above label, the signal of label can be received, so that it is determined that the absolute position of vehicle.
The accurate construction numerical map of target track is loaded under in controller, which contains target track operation interval
Interior all ramps, bend, turnout, website and positioning electronic beacon accurate location information, and contain corresponding speed limit data,
The accurate location data of vehicle is obtained by encoder and electronic beacon, controller can be obtained by encoder and electronic beacon
The accurate location data of vehicle, and the data of middle target track operation area according to the map, pass through the dynamics calculation of vehicle, determine
Vehicle sets the reasonable speed of vehicle in the maximum safe velocity on each bend, ramp and turnout；Enable in rail vehicle
Speed and turnout is adjusted flexibly according to target track environment complicated and changeable, substantially increase flexibility and full-automatic unmanned drives
The safety sailed.
Vehicle is before normal operation, and operation interval of the vehicle on target track, vehicle is arranged in location information according to the map
It can only be travelled in the section, alarm of then stopping beyond driving range.
(2) monitoring remote video safe-guard system, referring to Fig. 3
One and monitoring camera are respectively loaded before and after vehicle, monitoring camera is electrically connected with the controller, monitoring camera
By video clouds such as Haikang prestige views by camera real-time data transmission to remote monitoring end, the operator of remote monitoring end can root
It according to video information, observes whether direction of travel has barrier or people, is decided whether to stop vehicle according to the experience of operator,
To cope with emergency, it is ensured that safety accident does not occur.Recycling maintenance is carried out after carrying out parking alarm.
(3) vehicle trouble states safe-guard system, referring to fig. 4
Vehicle considers the security control of fault condition, when controller detects critical failure, carries out parking maintenance alarm.
High-precision encoder communication failure, electronic map data failure, localizer beacon communication failure, laser radar communication event
Barrier, remote control terminal communication failure, driving motor communication failure, driving motor performance fault, battery system communication failure, battery
Internal system failure, braking system faults.It is considered as critical failure when detecting the above failure, carries out parking alarm.
If motor being capable of automatic braking after wherein detecting motor and controller communication failure.The power of automatic braking is led
Drawing motor is customed product, is controlled by software program, and the function of braking, power traction motor tool are immediately performed after open close letter
There is a high-power braking resistor, when executing braking, driving motor is converted to generator mode, converts vehicle movement energy to
Electric energy is consumed by braking resistor, to realize automatic braking.
Warning message is sent to remote monitoring end if detecting the light alerting system system failure and continues to execute operation.Whether
Parking maintenance is determined by remote monitoring end operator.
(4) safe-guard system to lose control of one's vehicle, referring to Fig. 5
To lose control of one's vehicle, refer to vehicle due to certain uncertainty, cause not according to setting speed traveling, hypervelocity, system
The special circumstances such as dynamic failure, controller are crashed, motor driver crashes.Under these uncontrollable states, safety safeguards system
A heavy current breaker is set, can by force be cut off motor power, and alarm of stopping, to ensure safety traffic.
The mode for carrying out detection judgement to critical failure and to lose control of one's vehicle is as follows:
High-precision encoder communication failure:
By RS232 connection between master controller PLC and high-precision encoder processing module, custom protocol is used
CRC16 verification.If PLC does not receive data or continuous 10 times receive wrong check-up data in 10ms, that is, think failure.
Electronic map data failure:
Electronic map data is stored in two pieces of independent regions Flash, is compared such as inconsistent i.e. failure；
Electronic map respectively classifies (turnout, ramp, bend, electronic beacon) according to distance from closely arranging to remote sequence,
Such as occur out-of-order being failure；
All kinds of map datums include CRC16 verification, and there are check errors, that is, failures when such as reading.
Localizer beacon communication failure:
Electronic beacon reader is connect with PLC by tcp, such as tcp disconnecting, electronic beacon initialization unsuccessfully i.e. event
Barrier；
Vehicle driving does not obtain bootstrap information within the scope of positive and negative 10 meters of the set distance of electronic beacon on the electronic map
That is failure.
Laser radar communication failure:
Laser radar and PLC are connected using UDP, and radar just persistently sends data after powering on, as PLC 10ms does not receive number
According to i.e. failure；
Laser radar has a calibration face, and distance by radar demarcates the distance in face and relative angle determines, such as continuously receives 5
Frame wrong data (the corresponding measurement distance of angle differs 10cm with calibration distance) judges radar fault.
Remote control terminal communication failure:
Once remote control terminal begins to be in continuous communication with each other with PLC successful connection, 5S does not receive data i.e. failure；
Dynamic communications failure:
Motor is connect with PLC by CAN bus, and data are persistently sent, and 100ms does not receive data i.e. failure.Driving motor
Performance fault:
Motor driver continues to send internal state (error code) to PLC, and PLC receives error code i.e. failure.Battery system
Communication failure:
Battery is connect with PLC by CAN bus, and data are persistently sent, and 100ms does not receive data i.e. failure.Battery system
Internal fault:
Battery last sends internal state (error code) to PLC, and PLC receives error code i.e. failure.
Braking system faults:
After PLC sends braking instruction, such as detects speed reduction of speed and be expected not being inconsistent to judge braking system faults.
(5) it travels to detection of obstacles safe-guard system
Vehicle is respectively equipped with an one-line scanning laser radar in front and back ends, and horizontal scan angle resolution ratio is 0.18 °,
Lower scanning resolution is capable of providing more environmental informations, and more dense environmental scanning point cloud chart is conducive to the calculation in later period
Method processing.The system the max speed is 60Km/h, and braking distance is less than or equal to 35 meters, can provide twice of braking distance or more
Early warning range, it is safer, therefore it is suitable that scanning distance, which is 100 meters,.Being able to detect in driving direction by special algorithm can
The barrier that can be collided with vehicle detects barrier alarm, parking.
A kind of single line laser radar survey barrier method for full-automatic unmanned rail vehicle, method and step is as follows,
A. laser radar is connect with controller by Ethernet, sends data frame to controller using udp protocol；, with
The frequency usage udp protocol of 100Hz sends data frame to controller, and every frame data contain 2000 groups of data, every 0.18 ° one
Group, every group of data contain three reflection point distance, angle and reflected signal strength data；
B. controller carries out intensive repeated data filtering to every frame data and shapingization is handled；
The characteristics of laser radar scanning, closer point is more intensive, cause point on straight line from closely to long-range it is close to
Sparse process makes intensive point rarefaction if filtered without intensive repeated data, will lead to close place and becomes in Hough
Change that middle contribution margin is excessive, remote point contributes straight line too small.
Since controller is Embedded PLC, Floating-point Computation capability efficiency is poor, and laser radar data amount is larger, therefore
Data are carried out to calculate shapingization processing, are converted into integer calculations (including the equal shapingization processing of sin and cos)；(floating number amplification
It is rounded and whether does not need)
Controller in data sin and cos carry out shaping processing, Sin and cos is replaced using shaping inquiring arithmetic
Generation.Inquiring arithmetic, establish 3600 points shaping array (sin and each one of cos) (amplification 65535 times -- new modification,
Increase computational accuracy), for array indexing from 0~3599 i.e. 0 ° to 359.9 °, resolution ratio is 0.1 °, and indexing corresponding magnitude value indicates
Sin ((index value/10.0) °) or cos ((index value/10.0) °) be for example: sin (90 °)=1, then sin_talbe [900]=
Int (1.0f*65535)=65535.
C. image segmentation is carried out according to the feature of track and rail walls
(the characteristics of rail traffic: route is fixed, and track and tunnel wall or guardrail are directly substantially parallel, and wall locations away from
From at least 1.5 meters of orbit centre.I.e. in the polar equation parameter (ρ, θ) of wall straight line, at least more than 1.5 meters, θ value connects ρ value
Nearly 90 ° -- direction of advance is 0 °, according to this condition, can only consider the data of range in rail walls frame)
For one frame data of laser radar in actual measurement tunnel, more than 1000 data points, in order to improve calculating speed, according to rail
The characteristics of road traffic, is split processing to point cloud chart picture.Since track and rail walls angle are smaller, rail walls straight line to be sought
The parameter (ρ, θ) of equation, θ value is close to 90 degree (with orbital direction angle)；Its ρ value at least more than 1.5 meters (rail walls and tracks
The distance at center).It according to this feature, divides the image into, carrying out Hough transformation is only considered in two rail walls frames up and down
Data.
D. Descartes's rectangular co-ordinate is then converted the data by coordinates transformation method；In order to calculate unification (shaping
Various algorithms), polar data is converted into cartesian cartesian coordinate system, laser radar initial data uses polar coordinates table
Show；For its origin at polar coordinate system origin (laser radar rotating shaft center point), x-axis direction is vertical with orbital direction, y-axis direction with
Orbital direction is parallel.
Polar equation are as follows:
Wherein (δ, α) is any point on straight line, and ρ, θ are straight line parameter, and formula (1) is converted are as follows:
Since laser radar data is polar coordinate representation (distance, angle), carrying out Hough transformation according to (2) formula can be very big
Reduction calculation amount.
E. the light angle for determining that laser radar is overlapped with cartesian coordinate system y-axis is calibrated, and is demarcated；
In order to determine that light angle that laser radar is overlapped with cartesian coordinate system y-axis, system are equipped with one on vehicle
The alignment surface of a standard is as shown in figure 3, have an alignment surface apart from 50~100cm of laser radar in detection measurement, the school
Quasi- face width is greater than 10cm, and for calibrating laser radar setting angle and radar data accuracy, alignment surface is vertical with orbital plane,
And the angle and distance at two edge and origin line can be surveyed, and remember that this two lines are lubber-line 1 and lubber-line 2, calibration
When, the angle being overlapped by measuring laser radar scanning line with this two lubber-lines can calculate laser radar and be overlapped with y-axis
Light angle.
All initial data of laser radar, first carry out light angle adjustment before algorithm process.That is direction of advance and y-axis weight
The light angle of conjunction is 0 °, is incremented by along clockwise direction, if do not demarcated, will be unable to determine accurate orbital direction；
The rail walls of some section tracks two sides only have that side is substantially parallel with track (such as turnout), other side differential seat angle compared with
Greatly, according to the laser radar angle of calibration determine use which side rail walls as refer to (usually with Calibration Base Line --- y-axis put down
The preferable side of row degree)
F. start angle and angle at the end are calculated according to vehicle-mounted alignment surface, and determines laser radar driving direction corresponding angles
Degree；
Machining guarantees alignment surface at a distance from installation center point and relative angle, mark timing acquisition laser radar are practical
Scan data, it is the longer apart from measuring point of a mutation other than alignment surface that the laser radar data of alignment surface, which is straight line,
The corresponding angle in the sudden change region at two edges is exactly collimation angle (start angle and angle at the end), is determined according to collimation angle
Laser radar driving direction corresponding angle；
G. after the corresponding angle for determining laser radar driving direction, data within the scope of effective angle are intercepted；
H. Hough transformation is carried out to image data in effective range and obtains two optimal straight line parameter (vertical rails of straightness
Each one of the positive and negative axis of the axis in road direction), it is therefore an objective to obtain the rail walls of track two sides or the scanning curve of guardrail；It selects
Two optimal straight lines of straightness: just half using Hough transformation removal straight line gradient less than 5 °, and in the same coordinate system X-axis
The repetition straight line of axis or negative semiaxis.
Due to remoter apart from laser radar, the distance between adjacent two light is bigger, i.e., for the reflection of rail walls
For point, closer to the place of laser radar, point cloud is more intensive, and about remote place point cloud is more sparse.Not carrying out processing to cloud makes
It when detecting straight line with Hough transformation, is interfered vulnerable near point point off density cloud, rail walls detection straight line is easy to produce shake.Therefore to point
Cloud atlas carries out secondary sparse variation and eliminates this influence.
Lidar measurement data unit be centimetre, direct measurement data is rounded up to as unit of rice, can be obtained
Sparse graph.
Primary sparse point cloud chart is eliminated along the point dot interlace that laser radar fixed setting is connected, secondary sparse cloud can be obtained.
As previously mentioned, radar range finding it is remoter point its sparse degree it is bigger, therefore when carrying out Hough transformation, picture point is used to measure distance
It votes as weighting parameters, can be obtained stable rail walls curve.
It using two sides rail walls as track reference direction, crosses point (- 1.4 meters, 0), point (1.4 meters, 0) each standardized item is parallel to
The curve of orbital plane, direction of advance in this two curves be detection of obstacles range.
I. sliding mean filter processing is carried out by window of 10 frames to two straight line parameters, calculated using orbit centre as origin
Liang Tiao obstacle recognition area straight line parameter；
J. whether detection detection of obstacles range has laser reflection point, judges whether there is barrier, and feed back to controller.
After detecting reflection point, barrier sliding-window filtering is carried out to reflectance data, it is further with 500ms filtering processing
Judge whether it is effective barrier, then carry out alarm warning if effective barrier, then system discriminates whether controllably braking
In range, when being judged as effective barrier and not braking in range controllably, i.e., when obstacle distance is less than 30 meters, carry out urgent
Parking, when be judged as effective barrier controllably braking range in, carry out the parking of vehicle reduction of speed.
Preferably, laser radar uses single line laser radar, and horizontal scan angle resolution ratio is 0.18 °, measurement
Distance is 100 meters.0.18 ° is horizontal angular resolution, and lower scanning resolution is capable of providing more environmental informations, closeer
The environmental scanning point cloud chart of collection, is conducive to the algorithm process in later period.100 meters of measurement distances, the system the max speed are 60Km/h,
Braking distance is less than or equal to 35 meters, can provide twice of braking distance or more of early warning range, safer.Laser radar scanning face
Away from 25~50cm of orbital plane, laser radar mounting surface, levelness is better than 0.2 °, keeps light substantially parallel with orbital plane.Angle mistake
Greatly, it will lead to laser radar and shine directly into closer ground or overhead.
The single line laser radar of this patent design surveys barrier algorithm, is the pith of vehicle driving safety safeguards system, energy
Enough guarantee unmanned railcar in the process of moving, accurately detects the barrier that can be collided with vehicle, and taken
The measure guarantee of effect does not crash.
A kind of full-automatic unmanned driving's rail vehicle safe-guard system provided by the present invention is carried out above detailed
It introduces, used herein a specific example illustrates the principle and implementation of the invention, the explanation of above embodiments
It is merely used to help understand method and its core concept of the invention；At the same time, for those skilled in the art, according to this
The thought of invention, there will be changes in the specific implementation manner and application range, will be to change and improvement of the invention
It is possible, the conception and scope without exceeding accessory claim defined, in conclusion the content of the present specification should not be understood
For limitation of the present invention.
Claims (10)
1. a kind of full-automatic unmanned driving's rail vehicle safe-guard system, including Mini-railway vehicle, vehicle is interior to be equipped with driving
Vehicle advance controller, it is characterised in that: including normally travel, monitoring remote video, vehicle trouble, to lose control of one's vehicle and traveling
To five safe-guard systems of obstacle quality testing,
1) normally travel safe-guard system,
A. a measurement wheel is added on vehicle, which is equipped with the high precision position coding for calculating vehicle movement distance
Device；
B. position being fixed on target track, Ground Electronic label used for positioning being installed, number is a pair of with absolute position one
It answers, the high accuracy positioning electronic beacon reader to match with Ground Electronic label is added on vehicle, utilizes track operation
The own calibration system of unit calibrates the encoder on vehicle, so that it is determined that the absolute position of vehicle；
C. in controller under be loaded with the accurate construction numerical map of target track, after encoder and electronic beacon positioning,
Current vehicle present position and local environment can be accurately positioned in controller, and carries out reasonable speed control according to local environment
System；
2) monitoring remote video safe-guard system
One and monitoring camera are respectively loaded before and after vehicle, monitoring camera is connect with controller, and monitoring camera passes through view
Frequency cloud is by camera real-time data transmission to remote monitoring end；
3) vehicle trouble states safe-guard system
Vehicle considers the security control of fault condition, when controller detects critical failure, carries out parking maintenance alarm；
4) safe-guard system to lose control of one's vehicle
It is provided with a heavy current breaker in the power output end of motor, when controller detects that vehicle is in uncontrollable state
When, motor power is cut off by force by heavy current breaker, to ensure safety traffic；
5) it travels to detection of obstacles safe-guard system
One one-line scanning laser radar is respectively housed in vehicle front and back ends, being able to detect in driving direction may send out with vehicle
The barrier of raw collision detects barrier alarm, parking.
2. a kind of full-automatic unmanned driving's rail vehicle safe-guard system according to claim 1, it is characterised in that: step
In rapid a, it is co-axially mounted between high precision position encoder and measurement wheel using shaft coupling, measurement wheel is standard cylindrical wheel body,
It is pressed in orbital plane using spring, measurement wheel follows vehicle movement, drives encoder rotation, sends out when encoder rotates to controller
Pulse signal is sent, controller is according to pulse count calculation vehicle movement distance.
3. a kind of full-automatic unmanned driving's rail vehicle safe-guard system according to claim 2, it is characterised in that: high
The measurement accuracy of precision position encoder is better than 1mm.
4. a kind of full-automatic unmanned driving's rail vehicle safe-guard system according to claim 1, it is characterised in that: step
In rapid c, contain all ramps, bend, turnout, website and the positioning in target track operation interval in numerical map of precisely constructing
The accurate location information of electronic beacon, and contain corresponding speed limit data.
5. a kind of full-automatic unmanned driving's rail vehicle safe-guard system according to claim 1, it is characterised in that: step
In rapid c, vehicle is before normal operation, and operation interval of the vehicle on target track is arranged in location information according to the map, and vehicle is only
It can be travelled in the section, alarm of then stopping beyond driving range.
6. a kind of full-automatic unmanned driving's rail vehicle safe-guard system according to claim 1, it is characterised in that: step
In rapid c, reasonable method for control speed, controller can obtain vehicle by encoder and electronic beacon and accurately position number
According to, and according to the map in target track operation area data, by the dynamics calculation of vehicle, determine vehicle each bend,
The maximum safe velocity in ramp and turnout sets the reasonable speed of vehicle.
7. a kind of full-automatic unmanned driving's rail vehicle safe-guard system according to claim 1, it is characterised in that: step
It is rapid 3) in, high-precision encoder communication failure, electronic map data failure, the localizer beacon communication failure, laser that will test
Radar communication failure, remote control terminal communication failure, driving motor communication failure, driving motor performance fault, battery system are logical
News failure, battery system internal fault, braking system faults are considered as critical failure, carry out parking alarm.
8. a kind of full-automatic unmanned driving's rail vehicle safe-guard system according to claim 7, it is characterised in that: its
If after detecting motor and controller communication failure in, motor being capable of automatic braking.
9. a kind of full-automatic unmanned driving's rail vehicle safe-guard system according to claim 1, it is characterised in that: step
It is rapid 3) in, sent if detecting the light alerting system system failure to remote monitoring end and warning message and continue to execute operation, if
Parking maintenance is determined by remote monitoring end operator.
10. a kind of full-automatic unmanned driving's rail vehicle safe-guard system according to claim 1, it is characterised in that:
In step 4), the uncontrollable state includes not driving according to setting speed traveling, hypervelocity, brake fade, controller crash, motor
Dynamic device crashes.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910291790.6A CN110027593A (en) | 2019-04-12 | 2019-04-12 | A kind of full-automatic unmanned driving's rail vehicle safe-guard system |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910291790.6A CN110027593A (en) | 2019-04-12 | 2019-04-12 | A kind of full-automatic unmanned driving's rail vehicle safe-guard system |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN110027593A true CN110027593A (en) | 2019-07-19 |
Family
ID=67238088
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201910291790.6A Pending CN110027593A (en) | 2019-04-12 | 2019-04-12 | A kind of full-automatic unmanned driving's rail vehicle safe-guard system |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110027593A (en) |
Cited By (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110615007A (en) * | 2019-10-17 | 2019-12-27 | 华东交通大学 | Intelligent skin for unmanned self-adaptive control of rail transit vehicle |
| CN110989556A (en) * | 2019-12-12 | 2020-04-10 | 交控科技股份有限公司 | Fault diagnosis method and system for vehicle-mounted equipment |
| CN111537968A (en) * | 2020-05-12 | 2020-08-14 | 江铃汽车股份有限公司 | Angle radar calibration method and system |
| CN112906501A (en) * | 2021-01-29 | 2021-06-04 | 上海伽易信息技术有限公司 | Non-equilibrium subway train positioning beacon abnormity detection method based on self-adaptive oversampling |
| CN113285980A (en) * | 2021-04-16 | 2021-08-20 | 国家能源集团煤焦化有限责任公司 | Coke oven vehicle control method and control system |
| CN113479771A (en) * | 2021-01-26 | 2021-10-08 | 山东新沙单轨运输装备有限公司 | Monorail crane positioning method and system |
| CN113551922A (en) * | 2021-07-21 | 2021-10-26 | 重庆航天职业技术学院 | Automobile interlink collision testing device |
| CN114803861A (en) * | 2022-04-18 | 2022-07-29 | 中国矿业大学 | High-precision positioning system and positioning method for coal mine underground single-rail crane |
| CN116572999A (en) * | 2023-05-23 | 2023-08-11 | 成都花海田园科技有限公司 | Intelligent sightseeing system and sightseeing device thereof |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2000172337A (en) * | 1998-12-07 | 2000-06-23 | Mitsubishi Electric Corp | Autonomous mobile robot |
| CN101357642A (en) * | 2008-09-03 | 2009-02-04 | 中国科学院上海技术物理研究所 | High speed railway vehicle mounted automatic obstacle avoidance system and method |
| CN201506269U (en) * | 2009-04-14 | 2010-06-16 | 美国锐哲有限公司 | Electric vehicle motor control circuit with dual protection function |
| CN201741039U (en) * | 2010-08-31 | 2011-02-09 | 东南大学 | Lane position automatic tracking device |
| CN106537900A (en) * | 2014-02-17 | 2017-03-22 | 通用电气公司 | Video system and method for data communication |
| CN207760672U (en) * | 2017-12-25 | 2018-08-24 | 中铁第四勘察设计院集团有限公司 | Both wired quick repetition measurement measured vehicle |
| CN109318940A (en) * | 2017-07-31 | 2019-02-12 | 比亚迪股份有限公司 | Train automatic Pilot method, apparatus and system |
-
2019
- 2019-04-12 CN CN201910291790.6A patent/CN110027593A/en active Pending
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2000172337A (en) * | 1998-12-07 | 2000-06-23 | Mitsubishi Electric Corp | Autonomous mobile robot |
| CN101357642A (en) * | 2008-09-03 | 2009-02-04 | 中国科学院上海技术物理研究所 | High speed railway vehicle mounted automatic obstacle avoidance system and method |
| CN201506269U (en) * | 2009-04-14 | 2010-06-16 | 美国锐哲有限公司 | Electric vehicle motor control circuit with dual protection function |
| CN201741039U (en) * | 2010-08-31 | 2011-02-09 | 东南大学 | Lane position automatic tracking device |
| CN106537900A (en) * | 2014-02-17 | 2017-03-22 | 通用电气公司 | Video system and method for data communication |
| CN109318940A (en) * | 2017-07-31 | 2019-02-12 | 比亚迪股份有限公司 | Train automatic Pilot method, apparatus and system |
| CN207760672U (en) * | 2017-12-25 | 2018-08-24 | 中铁第四勘察设计院集团有限公司 | Both wired quick repetition measurement measured vehicle |
Cited By (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110615007A (en) * | 2019-10-17 | 2019-12-27 | 华东交通大学 | Intelligent skin for unmanned self-adaptive control of rail transit vehicle |
| CN110989556A (en) * | 2019-12-12 | 2020-04-10 | 交控科技股份有限公司 | Fault diagnosis method and system for vehicle-mounted equipment |
| CN111537968A (en) * | 2020-05-12 | 2020-08-14 | 江铃汽车股份有限公司 | Angle radar calibration method and system |
| CN113479771A (en) * | 2021-01-26 | 2021-10-08 | 山东新沙单轨运输装备有限公司 | Monorail crane positioning method and system |
| CN112906501A (en) * | 2021-01-29 | 2021-06-04 | 上海伽易信息技术有限公司 | Non-equilibrium subway train positioning beacon abnormity detection method based on self-adaptive oversampling |
| CN113285980A (en) * | 2021-04-16 | 2021-08-20 | 国家能源集团煤焦化有限责任公司 | Coke oven vehicle control method and control system |
| CN113551922A (en) * | 2021-07-21 | 2021-10-26 | 重庆航天职业技术学院 | Automobile interlink collision testing device |
| CN114803861A (en) * | 2022-04-18 | 2022-07-29 | 中国矿业大学 | High-precision positioning system and positioning method for coal mine underground single-rail crane |
| CN114803861B (en) * | 2022-04-18 | 2023-01-24 | 中国矿业大学 | High-precision positioning system and positioning method for coal mine underground single-rail crane |
| CN116572999A (en) * | 2023-05-23 | 2023-08-11 | 成都花海田园科技有限公司 | Intelligent sightseeing system and sightseeing device thereof |
| CN116572999B (en) * | 2023-05-23 | 2024-01-26 | 成都花海田园科技有限公司 | Intelligent sightseeing system and sightseeing device thereof |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110027593A (en) | A kind of full-automatic unmanned driving's rail vehicle safe-guard system | |
| CN109933075A (en) | A kind of single line laser radar survey barrier method for full-automatic unmanned rail vehicle | |
| CN111114593B (en) | Subway train autonomous positioning device, system and method based on multivariate information fusion | |
| CN105015521B (en) | A kind of automatic stop device of oversize vehicle based on magnetic nail | |
| CN113340325B (en) | System, method and medium for verifying vehicle-road cooperative roadside perception fusion precision | |
| CN110264783A (en) | Vehicle collision avoidance early warning system and method based on bus or train route collaboration | |
| CN103129586B (en) | Based on locomotive position monitoring and safety control and the control method thereof of track circuit | |
| CN110615017A (en) | Rail transit automatic detection system and method | |
| CN103612649A (en) | Method and device for accurately positioning trains on basis of laser Doppler velocity measurement | |
| CN102139704A (en) | High-accuracy train positioning system based on radio frequency technology and positioning method thereof | |
| CN105905134A (en) | Rail transit vehicle accurate speed measuring system and method | |
| CN103303309B (en) | Rear-end collision anti-collision warning method and system | |
| CN105810012A (en) | Method and device of vehicle collision warning based on vehicle-borne terminal | |
| CN103714603A (en) | Bus passenger flow statistics system based on infrared distance measuring sensor | |
| CN106114357A (en) | Device and method for preventing scratching during turning of vehicle | |
| CN102914290A (en) | Metro gauge detecting system and detecting method thereof | |
| CN103625507A (en) | Train tracking approaching early warning method for high speed railway and system thereof | |
| CN114132358B (en) | Multi-platform intelligent track comprehensive detection system | |
| CN111717244A (en) | Train automatic driving sensing method and system | |
| CN110133697A (en) | A kind of high-precision localization method of GPS based on RSU detection technique | |
| CN113276911A (en) | Suspension type monorail vehicle section train position detection method and system | |
| CN113793509B (en) | Road condition analysis method, device, equipment and medium based on motion sensor | |
| CN113703023A (en) | Real-time positioning method and system for railway vehicle based on environmental image recognition and correction | |
| CN202038325U (en) | High-precision train positioning system based on radio frequency technology | |
| CA3146823A1 (en) | Vechicle location determining system and method |
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 | ||
| RJ01 | Rejection of invention patent application after publication | ||
| RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190719 |