CN110244731B - Active tracking control method for three-section marshalling virtual rail train - Google Patents
Active tracking control method for three-section marshalling virtual rail train Download PDFInfo
- Publication number
- CN110244731B CN110244731B CN201910530460.8A CN201910530460A CN110244731B CN 110244731 B CN110244731 B CN 110244731B CN 201910530460 A CN201910530460 A CN 201910530460A CN 110244731 B CN110244731 B CN 110244731B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- carriage
- car
- train
- central axis
- 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.)
- Expired - Fee Related
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
Abstract
The invention provides an active tracking control method for a three-section marshalling virtual rail train, and belongs to the technical field of intelligent vehicle control. The method specifically comprises the following steps: (1) the virtual rail train main controller reads the virtual rail information through the head train and the tail train cameras and judges whether the train is separated from the track; (2) calculating the steering angles of the axles of the head car and the tail car required for the tracking operation of the car according to the offset of the car relative to the track; (3) determining the turning radius and the instant speed center of the head vehicle and the tail vehicle according to the vehicle size parameters and the turning angles of the shafts of the head vehicle and the tail vehicle, and calculating to obtain the instant speed center of the middle vehicle; (4) calculating the steering angle of each axle wheel of the intermediate vehicle according to the vehicle size parameters, the turning radius of the head vehicle and the tail vehicle and the speed instant center of the intermediate vehicle; (5) and the virtual rail train tracking controller controls each steering motor according to the target steering angle of each axle wheel to realize the tracking operation of the vehicle.
Description
Technical Field
The invention belongs to the technical field of intelligent vehicle control, and particularly relates to a control method for controlling tracking operation of a virtual rail train.
Background
The virtual rail train system is used as a brand-new non-wheel-rail contact guiding transportation system in a public road right operation environment, has the advantages of short construction period, low investment cost, flexible operation organization, energy conservation, environmental protection and the like, can meet the increasing diversified outgoing demands of people, and has wide market prospect.
Although the main aim of vehicle tracking operation is initially realized by the existing virtual rail train, the tracking operation still has problems, such as low control precision, operation key node control required by a driver, and the like. Although a vehicle active tracking control method is disclosed in patent application No. CN201710174916.2, the method is only suitable for a common intelligent vehicle, and is not suitable for a virtual rail train with a long and large vehicle body connected in a multi-section hinged manner.
Disclosure of Invention
The invention aims to provide an active tracking control method for a three-section marshalling virtual rail train, which can effectively solve the technical problem of tracking operation of a long and large train body and a plurality of sections of marshalling vehicles.
The purpose of the invention is realized by the following technical scheme: an active tracking control method for a three-section marshalling virtual rail train specifically comprises the following steps:
acquiring position information of a current vehicle relative to a virtual track through a camera at the head end of a virtual track train;
step two, preliminarily calculating to obtain shaft rotation angles of a first train and a tail train required by a train regression track according to the position information of the current train relative to the virtual track by using a shortest path principle; the vehicle tracking control point is arranged at the middle point of the central axis of the vehicle, and the steering angles of front axles and rear axles of the first vehicle and the rear vehicle are equal and opposite; the instantaneous center M of the speed of the first vehicle is obtained by the steering angle of each axle wheel of the first vehicle and the tail vehicle and the Ackerman steering geometry principle1Instantaneous center of speed M of the stern car3;
Step three, the hinging force between all carriages of the whole train of the virtual rail train is minimum, and the two adjacent carriages are arranged at the hinging point G1The speed directions of the two carriages are the same, and the speed instant center M of the virtual rail train intermediate car carriage is obtained based on the principle2The speed instant center is at the front hinge point G passing through the middle car compartment1Instantaneous center of sum velocity M1Straight line G of1M1And through the rear hinge point G of the middle car carriage2Instantaneous center of sum velocity M3Straight line G of2M3On the intersection point; then, the central axis of the first vehicle and G1M1Angle alpha of1Comprises the following steps:
in the formula: r1Indicating the turning radius of the front axle of the head, l indicating the distance from the front axle to the rear axle of the car, lRIndicating the distance from the rear axle of the car to the rear end of the car, and subscript R indicating the rear of the car; from the central axis of the first vehicle to G1M1Angle alpha of1Deriving a straight line G1M1The included angle between the central axis of the middle vehicle carriage and the central axis of the middle vehicle carriage is beta1=α1-ψ1Wherein ψ1The included angle between the central axis of the first carriage and the central axis of the middle carriage is measured by a sensor; obtaining the central axis and the straight line G of the carriage of the trailer in the same way2M2Angle alpha of2:
In the formula: r6Indicating the turning radius of the rear axle of the tail car; from a straight line G2M2Included angle alpha with central axis of carriage of tail car2Straight line G is obtained by calculation2M2The included angle between the central axis of the middle vehicle carriage and the central axis of the middle vehicle carriage is beta2=α2+ψ2Wherein ψ2The included angle between the central axis of the carriage of the tail car and the central axis of the carriage of the middle car is set; from the above two angles beta1,β2Calculate to obtainLine G1M1And G2M2Angle xi ═ beta1-β2(ii) a Deriving the line segment R from the included angleM2G1And RM2G2Is expressed as:
wherein lFThe distance from the front axle of the carriage to the front end of the carriage is shown, and the subscript F shows the front of the carriage; adopting positive and negative decision coefficient S of steering angle2And judging the positive and negative of the rotation angle of each wheel of the middle carriage, wherein the expression is as follows:
wherein R isM2G1Representing line segment M2G1Subscript M2G1 denotes line segment M2G1(ii) a Obtaining the center turning radius R of the front axle of the compartment of the intermediate vehicle according to the positive and negative judgment coefficients3:
According to the turning radius R of the center of the front axle3Further deducing and obtaining the steering angle of the front axle of the compartment of the intermediate vehicle
The turning radius R of the rear axle of the middle vehicle compartment is derived in the same way4:
According to the turning radius R of the rear axle of the compartment of the intermediate vehicle4Deducing and obtaining the steering angle of the rear axle of the carriage of the intermediate car
And step four, transmitting the steering angles of all the axles of the carriage obtained by deduction calculation to a steering motor controller of all the axles according to a virtual rail train tracking controller arranged in the first train, and controlling the steering of all the axles by the steering motor controller to enable the virtual rail train to return to the track so as to finish a tracking control target.
Drawings
FIG. 1 is a flow chart of a method of the present invention;
FIG. 2 is a schematic view of the steering geometry of each train section of the virtual rail train of the present invention;
FIG. 3 is a graph showing the tracking effect of Matlab according to the present invention;
Detailed Description
The following describes embodiments of the present invention in detail with reference to the drawings.
A method for controlling active tracking of a virtual rail train, comprising the following specific steps as shown in fig. 1.
And (1) obtaining the road condition in front of the current operation of the virtual rail train. First, a virtual track on a road is identified by using a central axis of a vehicle as a reference through sensors such as cameras mounted on a front vehicle and a rear vehicle of the vehicle, and the offset of the central axis of the vehicle relative to the virtual track is acquired. If the offset is less than a certain value, the current tracking operation of the vehicle is considered, and the following steps are not needed. If the offset is larger than a certain value, the vehicle is considered to be deviated from the track, and tracking control is required, and the offset is introduced into the following step as a control input quantity of the vehicle.
And (2) acquiring the offset of the vehicle relative to the virtual track, and calculating the steering angles of the first vehicle and the tail vehicle on each axle wheel, which are required by the vehicle to return to the track. When the vehicle deviates from the track, the vehicle main controller transmits the deviation amount of the central axis of the vehicle relative to the virtual track to the vehicle tracking controller, and the vehicle tracking controller calculates the steering angles of the axles of the head vehicle and the tail vehicle, which are required by the vehicle to return to the target virtual track. In order to minimize the time for the vehicle to return to the track, the wheels of the front axle and the wheels of the rear axle of the head vehicle and the tail vehicle participate in steering, and the steering angles of the front axle wheels and the rear axle wheels of each vehicle are in the same direction, as shown in fig. 2.
And (3) firstly, calculating the steering angles of the first vehicle and the tail vehicle required by the vehicles to return to the track. According to the displacement deviation e calculated by the vehicle main controllerdAnd angular deviation eθAnd calculating to obtain the steering angle gamma of the front shafts of the first vehicle and the tail vehicle:
γ=kded+kθeθ (1)
wherein k isdAnd kθIs the corresponding steering coefficient. Turning radius R of front axle of head1And the turning radius R of the rear axle of the tail car6Respectively as follows:
wherein, γ1The steering angle, gamma, of the front axle of the first vehicle6The steering angle of the rear axle of the tail car. The steering angle of the front axle and the rear axle of the front car and the rear axle of the rear car are in the same direction, so that the steering angle of the front car and the rear axle of the front car is-gamma1The steering angle of the front axle of the tail-vehicle is-gamma6. Assuming that the steering angles of the wheels of each axle of the vehicle are the same, the intersection point of each axle of the vehicle and the central axis of the carriage is AiAnd i is 1 to 6 each of the axles from the front axle to the rear axle, the intersection points a may be usediWheel generationEach wheel on the axle is shown. Deducing to obtain the speed instant center M of the head vehicle according to the steering angle of the front axles and the rear axles of the head vehicle and the rear vehicles obtained by calculation1Instantaneous center of speed M of the stern car3. If the speed directions of the hinged points of the vehicles are the same, the speed instant center M of the intermediate vehicle can be further obtained2. This point is through the hinge point G1Instantaneous center of sum velocity M1Straight line G of1M1And through hinge point G2Instantaneous center of sum velocity M3Straight line G of2M3At the point of intersection. The turning radius R of the rear axle of the first vehicle can be known from the Ackerman turning geometric relation2And the turning radius R of the front axle of the tail car5Respectively with the turning radius R of the front axle of the first vehicle1And the turning radius R of the rear axle of the tail car6Are equal.
And (4) further calculating the steering angle of each axle of the intermediate vehicle. Firstly, calculating the central axis and the straight line G of the first vehicle1M1Angle alpha of1. Assuming that the size parameters of all the vehicles of the virtual rail train are the same, calculating to obtain the central axis of the first vehicle and the straight line G according to a triangle geometric formula1M1Angle alpha of1Comprises the following steps:
wherein R is1Is the steering radius of the front axle of the first vehicle, l is the distance from the front axle to the rear axle of the carriage, lRThe subscript R indicates the rear of the car, which is the distance from the car rear axle to the car rear end. According to the central axis of the first vehicle and the straight line G1M1Angle alpha of1Further derivation yields line G1M1Included angle beta with central axis of the intermediate vehicle1=α1-ψ1Wherein ψ1The included angle between the central axis of the first carriage and the central axis of the middle carriage is measured by a sensor. The central axis and the straight line G of the tail car are derived in the same way2M2Angle alpha of2:
In the formula, R6The turning radius of the rear axle of the tail car. According to the central axis and the straight line G of the tail car2M2Angle alpha of2Deriving a straight line G2M2The included angle between the central axis of the intermediate vehicle is beta2=α2+ψ2Wherein ψ2The included angle between the central axis of the carriage of the tail car and the central axis of the carriage of the middle car. According to the above-mentioned two angles beta1,β2To obtain a straight line G1M1And G2M2Angle xi ═ beta1-β2。
According to the straight line G1M1And G2M2The included angle xi is derived to obtain a line segment RM2G1And RM2G2Is expressed as:
in the formula IFIndicating the distance from the front axle of the car to the front end of the car, and subscript F indicates the front of the car.
Since the steering angle of each axle of the vehicle is divided into positive and negative, the positive and negative of the steering angle need to be determined by calculation, and the calculation process is as follows. Firstly, calculating a positive and negative judgment coefficient S of the front axle angle of the intermediate vehicle2:
In the formula, RM2G1Representing line segment M2G1Length of (2), subscript M2G1Representing line segment M2G1. Determining coefficient S according to positive and negative rotation angles2Deriving the length R of the center turning radius of the front axle of the intermediate vehicle based on the triangle geometry theorem3:
The steering angle of the rear axle of the intermediate vehicle can be obtained in the same manner. Turning radius R of rear axle of intermediate vehicle4Comprises the following steps:
and (5) processing the steering angles of the axles obtained by the calculation into control signals through a tracking controller, and respectively transmitting the control signals to the steering motor controllers of the axles to enable the steering motors to drive the wheels to rotate, thereby completing the whole control process. The control effect is shown in fig. 3. The control method can enable the virtual rail train to realize a rapid and accurate tracking operation target, and enable the vehicle to rapidly return to the rail when the vehicle deviates from the rail due to interference, and has higher engineering application value.
Claims (1)
1. An active tracking control method for a three-section marshalling virtual rail train comprises the following steps:
acquiring position information of a current vehicle relative to a virtual track through a camera at the head end of a virtual track train;
step two, preliminarily calculating to obtain shaft rotation angles of a first train and a tail train required by a train regression track according to the position information of the current train relative to the virtual track by using a shortest path principle; the vehicle tracking control point is arranged at the middle point of the central axis of the vehicle, and the steering angles of front axles and rear axles of the first vehicle and the tail vehicle are equal and opposite; the instantaneous center M of the speed of the first vehicle is obtained by the steering angle of each axle wheel of the first vehicle and the tail vehicle and the Ackerman steering geometry principle1Instantaneous center of speed M of the stern car3;
Step three, the hinge force between each carriage of the whole train of the virtual rail train is set to be minimum, and the two adjacent carriages are arranged at the hinge point G1The speed directions of the two carriages are the same, and the speed instant center M of the virtual rail train intermediate car carriage is obtained based on the principle2Said instantaneous center of velocity M2At the front hinge point G of the middle car carriage1Instantaneous center of sum velocity M1Straight line G of1M1And through the rear hinge point G of the middle car carriage2Instantaneous center of sum velocity M3Straight line G of2M3On the intersection point; then, the central axis of the first vehicle and G1M1Angle alpha of1Comprises the following steps:
in the formula: r1Indicating the turning radius of the front axle of the head, l indicating the distance from the front axle to the rear axle of the car, lRIndicating the distance from the rear axle of the car to the rear end of the car, and subscript R indicating the rear of the car; from the central axis of the first vehicle to G1M1Angle alpha of1Deriving a straight line G1M1The included angle between the central axis of the middle vehicle carriage and the central axis of the middle vehicle carriage is beta1=α1-ψ1Wherein ψ1The included angle between the central axis of the first carriage and the central axis of the middle carriage is measured by a sensor; obtaining the central axis and the straight line G of the carriage of the trailer in the same way2M2Angle alpha of2:
In the formula: r6Indicating the turning radius of the rear axle of the tail car; from a straight line G2M2Included angle alpha with central axis of carriage of tail car2Straight line G is obtained by calculation2M2The included angle between the central axis of the middle vehicle carriage and the central axis of the middle vehicle carriage is beta2=α2+ψ2Wherein ψ2The included angle between the central axis of the carriage of the tail car and the central axis of the carriage of the middle car is set; from the above two angles beta1,β2Calculating to obtain a straight line G1M1And G2M2Angle xi ═ beta1-β2(ii) a Deriving R from the angleM2G1And RM2G2Is expressed as:
wherein lFThe distance from the front axle of the carriage to the front end of the carriage is shown, and the subscript F shows the front of the carriage; adopting positive and negative decision coefficient S of steering angle2Judging the positive and negative of the corner of each wheel of the compartment of the intermediate vehicle, wherein the expression is as follows:
wherein R isM2G1Representing line segment M2G1Subscript M2G1 denotes line segment M2G1(ii) a Obtaining the center turning radius R of the front axle of the compartment of the intermediate vehicle according to the positive and negative judgment coefficients3:
According to the turning radius R of the center of the front axle3Further deducing and obtaining the steering angle of the front axle of the compartment of the intermediate vehicle
The turning radius R of the rear axle of the middle vehicle compartment is derived in the same way4:
According to the turning radius R of the rear axle of the compartment of the intermediate vehicle4Deducing and obtaining the steering angle of the rear axle of the carriage of the intermediate car
And step four, transmitting the steering angles of all the axles of the carriage obtained by deduction calculation to a steering motor controller of all the axles according to a virtual rail train tracking controller arranged in the first train, and controlling the steering of all the axles by the steering motor controller to enable the virtual rail train to return to the track so as to finish a tracking control target.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910530460.8A CN110244731B (en) | 2019-06-19 | 2019-06-19 | Active tracking control method for three-section marshalling virtual rail train |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910530460.8A CN110244731B (en) | 2019-06-19 | 2019-06-19 | Active tracking control method for three-section marshalling virtual rail train |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110244731A CN110244731A (en) | 2019-09-17 |
CN110244731B true CN110244731B (en) | 2021-06-08 |
Family
ID=67887958
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910530460.8A Expired - Fee Related CN110244731B (en) | 2019-06-19 | 2019-06-19 | Active tracking control method for three-section marshalling virtual rail train |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110244731B (en) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112849222A (en) * | 2019-11-28 | 2021-05-28 | 中车株洲电力机车研究所有限公司 | Steering control method and device for following shaft |
CN111547111B (en) * | 2020-05-22 | 2021-04-13 | 西南交通大学 | Autonomous guiding control method for virtual rail train |
CN111976726B (en) * | 2020-08-26 | 2022-01-18 | 中南大学 | Steering auxiliary system of intelligent rail vehicle and control method thereof |
CN111976751B (en) * | 2020-08-26 | 2021-08-03 | 中南大学 | Steering auxiliary system based on intelligent rail train transverse acceleration and control method |
CN114590333B (en) * | 2020-12-03 | 2023-07-14 | 宇通客车股份有限公司 | Automatic driving multisection trailer and pose determining method thereof |
CN113734245B (en) * | 2021-09-24 | 2024-03-12 | 中车南京浦镇车辆有限公司 | Method and device for controlling tracking of rotary shaft type rubber wheel low-floor virtual rail train |
CN113895516B (en) * | 2021-10-14 | 2022-11-01 | 浙江吉利控股集团有限公司 | Steering control method of articulated vehicle, articulated vehicle and computer storage medium |
CN115817199B (en) * | 2022-11-30 | 2023-09-26 | 同济大学 | Traction guiding cooperative control method and system for virtual rail train |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0580995A1 (en) * | 1992-07-24 | 1994-02-02 | Linke-Hofmann-Busch GmbH | Track guided vehicle system consisting of at least two vehicles with stored running gears with single wheelsets |
CN102343912A (en) * | 2011-06-20 | 2012-02-08 | 中南大学 | Method for estimating state during running process of automobile |
CN106347457A (en) * | 2016-10-19 | 2017-01-25 | 中车株洲电力机车研究所有限公司 | Following control method and system of train track and train |
WO2017194353A1 (en) * | 2016-05-11 | 2017-11-16 | MüLLER CHRISTOPH | Method and system for guiding mechanically coupled or freely following train and vehicle combinations without a mechanical rail |
CN109533021A (en) * | 2019-01-08 | 2019-03-29 | 吉林大学 | A kind of multi-axle steering control system suitable for commercial vehicle |
-
2019
- 2019-06-19 CN CN201910530460.8A patent/CN110244731B/en not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0580995A1 (en) * | 1992-07-24 | 1994-02-02 | Linke-Hofmann-Busch GmbH | Track guided vehicle system consisting of at least two vehicles with stored running gears with single wheelsets |
CN102343912A (en) * | 2011-06-20 | 2012-02-08 | 中南大学 | Method for estimating state during running process of automobile |
WO2017194353A1 (en) * | 2016-05-11 | 2017-11-16 | MüLLER CHRISTOPH | Method and system for guiding mechanically coupled or freely following train and vehicle combinations without a mechanical rail |
CN106347457A (en) * | 2016-10-19 | 2017-01-25 | 中车株洲电力机车研究所有限公司 | Following control method and system of train track and train |
CN107963125A (en) * | 2016-10-19 | 2018-04-27 | 中车株洲电力机车研究所有限公司 | A kind of train track follow-up control method, system and train |
CN109533021A (en) * | 2019-01-08 | 2019-03-29 | 吉林大学 | A kind of multi-axle steering control system suitable for commercial vehicle |
Also Published As
Publication number | Publication date |
---|---|
CN110244731A (en) | 2019-09-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110244731B (en) | Active tracking control method for three-section marshalling virtual rail train | |
US10647348B2 (en) | Vehicle, single-wheelset/double-wheelset trackless train, and tracking and steering control method therefor | |
EP2517943B1 (en) | Active steering control device and method for railroad vehicle | |
WO2018072649A1 (en) | Following control method for train track, system and train | |
CN107963126B (en) | Large-curvature automatic driving steering control method for multi-axle steering vehicle | |
CN105197010A (en) | Auxiliary parking system and auxiliary parking control method | |
CN110077418B (en) | Differential auxiliary steering and shared control system modeling method considering driver characteristics | |
US6345218B1 (en) | Vehicle steering control system based on vehicle body side slip angle | |
CN112793677A (en) | Gate type virtual rail train and steering tracking control method thereof | |
CN111532283B (en) | Model prediction control-based path tracking method for semi-trailer train | |
CN106218708A (en) | Vehicular steering control apparatus | |
US6289273B1 (en) | Measuring and control system for the tranverse regulation of successive vehicles and method for this purpose | |
CN109292018B (en) | Four-wheel steering track tracking control method based on coaxial wheel leg structure | |
CN104417603B (en) | Steering control apparatus and method | |
CN105291733B (en) | The method and control equipment of the angle between longitudinal axis for determining the vehicle combination being made of vehicle section | |
CN111661048B (en) | Multi-articulated vehicle and track following control method and system thereof | |
KR100885892B1 (en) | All-Wheel steering control method for articulated vehicles | |
JP2008526621A (en) | Method for controlling vehicle rear wheel orientation | |
JP4264399B2 (en) | Automated guided vehicle | |
CN112026749B (en) | Stability control method for wire-controlled steering system | |
JP3740786B2 (en) | Steering assist device | |
US6571178B1 (en) | Method for curve recognition and axle alignment in rail vehicles | |
CN111547111A (en) | Autonomous guiding control method for virtual rail train | |
Yuan et al. | Development and validation of an automatic steering control system for rubber-tire transit revenue service | |
CN113147897B (en) | Method and system for controlling superposition of automobile and train tracks |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210608 |
|
CF01 | Termination of patent right due to non-payment of annual fee |