Sectional coordinated steering and tracking control method for trains on laterally indeterminate virtual track

Through the single-input single-output tracking control algorithm and tire side bias force minimization control designed by diagonal advantage matrix, the problem of insufficient coordination of suspension wheel steering angles in virtual track trains is solved, and the reasonable stress and curve of the vehicle system is realized Through performance improvement.

CN115048714BActive Publication Date: 2024-11-26TONGJI UNIV
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202210472401.1
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-04-29
Publication Date
2024-11-26
Estimated Expiration
2042-04-29

AI Technical Summary

Technical Problem

In the prior art, the multi-wheel coordinated steering control method of virtual rail trains fails to effectively coordinate the steering angle of each suspension wheel, resulting in large internal force and large tire force of the system, and lack of divisional coordination for the transverse ultra-static fixed force architecture. Steering tracking control strategy.

Method used

The single input single output tracking control algorithm is designed using diagonal advantage matrix, and the decoupling control of the non-virtualized suspension and the vehicle body and the tire side biasing force minimization control of the virtualized suspension can realize the division coordinated steering of the vehicle system. Track control.

Benefits of technology

The hinge acceptance force of the vehicle system is reduced, the curve passability is improved, the algorithm structure is simplified, the robustness is improved, and the approximate static and constant stress state of the vehicle system is realized.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115048714B_ABST
    Figure CN115048714B_ABST
Patent Text Reader

Abstract

The present invention relates to a method for coordinated steering tracking control of a virtual track train with a laterally indeterminate force, including a first tracking control sub-method embedded in a tracking controller and a second tracking control sub-method embedded in a steering coordination controller; the first tracking control sub-method uses a diagonal dominance matrix to design a single-input single-output tracking control algorithm to achieve tracking; the second tracking control sub-method uses the minimization of the tire cornering force of the virtualized suspension as a control target to achieve tracking. Compared with the prior art, the present invention has the advantages of making the force of the vehicle system more reasonable, improving the curve passing performance of the vehicle system, having a simple algorithm structure, and having strong robustness.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of virtual track trains, and in particular to a method for controlling partial coordinated steering and tracking of a laterally hyperstatically stressed virtual track train. Background Art

[0002] The virtual rail transit system is a vehicle train system that adopts the urban rail transit operation and management model. It has the advantages of large capacity and high running stability of traditional trams, as well as strong adaptability of buses and BRTs and low road construction costs. Among them, multi-wheel coordinated steering control technology is the core technology to enable each vehicle body module to effectively follow the existing line. However, multi-wheel coordinated steering control technology is subject to the type of vehicle structure. Especially for virtual rail trains with laterally indeterminate force structures, their tracking control methods are particularly critical, which directly affects the vehicle's dynamic performance and curve passing performance.

[0003] At present, there have been some studies on the path following control of virtual rail trains with various structures. For example, Chinese patent CN107963125A discloses a virtual rail train trajectory following control method, system and train using a six-axle three-section structure. Chinese patent CN105235758A discloses a rubber-wheeled low-floor intelligent rail train with a three-module five-axle structure and a power-distributed trajectory following. Chinese patent CN110244731A discloses an active tracking control method for a three-section virtual rail train. Chinese patent CN109501830A discloses a trolleybus using a four-module six-axle structure and its steering control articulated system. The various vehicle structures mentioned in the above patents have a common feature, that is, lateral hyperstatic force. This means that the above various vehicle systems will have a common problem: if the steering angles of each suspension wheel cannot be well coordinated, there will be a large internal force inside the system, which is mainly manifested in that the articulated system installed between adjacent car bodies is subjected to a large lateral force, and the tire force is also large. However, there is currently no coordinated steering and tracking control strategy for virtual track trains. Summary of the invention

[0004] The purpose of the present invention is to overcome the defects of the above-mentioned prior art and to provide a method for coordinated steering and tracking control of a laterally over-statically-determined virtual track train, which makes the force on the vehicle system more reasonable, improves the curve negotiating performance of the vehicle system, has a simple algorithm structure and strong robustness.

[0005] The purpose of the present invention can be achieved by the following technical solutions:

[0006] A method for controlling the partial coordinated steering and tracking of a laterally hyperstatically stressed virtual track train, the method comprising a first tracking control sub-method embedded in a tracking controller and a second tracking control sub-method embedded in a steering coordination controller;

[0007] The first tracking control sub-method adopts a diagonal advantage matrix to design a single-input single-output tracking control algorithm to achieve tracking;

[0008] The second tracking control sub-method achieves tracking by minimizing the tire cornering force of the virtualized suspension as a control target.

[0009] Preferably, the first tracking control sub-method is specifically:

[0010] Step 1: Establish the lateral dynamics or kinematic differential equation of the lateral statically determinate vehicle system composed of the non-virtualized suspension and the vehicle body, and convert it into a system transfer function matrix;

[0011] Step 2: Set up the sub-band feedforward compensator based on the system transfer function matrix and decouple it into a diagonal advantage matrix;

[0012] Step 3: Set up a single-input single-output tracking control algorithm based on the diagonal dominance matrix.

[0013] More preferably, the tracking controller is used for decoupling control of a laterally statically determinate vehicle system consisting of a non-virtualized suspension and a vehicle body to achieve tracking travel of the train.

[0014] More preferably, the non-virtualized suspension is selected according to the diagonal dominance of the vehicle system transfer function matrix, and the number of the non-virtualized suspension is equal to the sum of the number of yaw and lateral freedom of the virtual track train body n f .

[0015] More preferably, the steering coordination controller is used to minimize the tire cornering force of the virtualized suspension to optimize the stress state of the train.

[0016] More preferably, the virtualized suspension is selected according to the diagonal dominance of the vehicle system transfer function matrix, and the number n is v Equal to the number of virtual track train suspensions n and the sum of the number of yaw and lateral freedom of the vehicle body n f The difference, that is, n v =nn f .

[0017] More preferably, the vehicle system transfer function matrix is ​​obtained by Laplace transformation from the vehicle lateral motion differential equation.

[0018] More preferably, the segment coordinated steering tracking control method further comprises:

[0019] Sort the diagonal dominance of the vehicle system transfer function matrix from small to large, and select the first n f The suspension corresponding to the position of the diagonal dominance is a non-virtualized suspension, and the remaining n v The suspension is a virtualized suspension.

[0020] More preferably, step 1 of the first tracking control sub-method is specifically:

[0021] The lateral kinematic differential equation of the laterally statically determinate vehicle system consisting of a non-virtualized suspension and a vehicle body is established and converted into a system transfer function matrix through Laplace transform, where the lateral kinematic differential equation includes the lateral displacement and yaw degrees of freedom of each vehicle body.

[0022] Preferably, the second tracking control sub-method is specifically:

[0023] Taking the minimization of the tire cornering force of the virtual suspension as the control target, the calculation method of the wheel steering angle is as follows:

[0024]

[0025] Among them, δ is the wheel steering angle of the virtual suspension, β is the sideslip angle of the center of mass of the vehicle body to which the virtual suspension belongs, l is the longitudinal distance between the center of mass of the vehicle body to which the virtual suspension belongs and the virtual suspension. If the virtual suspension is in front of the center of mass of the vehicle body, l is positive, otherwise it is negative, u is the longitudinal velocity of the vehicle body to which the virtual suspension belongs, and ψ is the yaw angle of the vehicle body to which the virtual suspension belongs.

[0026] Compared with the prior art, the present invention has the following beneficial effects:

[0027] 1. Make the force on the vehicle system more reasonable: The partial coordinated steering tracking control method in the present invention comprehensively considers the tracking performance and dynamic performance of the vehicle, and minimizes the tire cornering force of the virtual suspension by reasonably coordinating the wheel steering angles of the virtualized suspension and the non-virtualized suspension, so that the laterally over-determined vehicle system is approximately equivalent to a statically determinate system, thereby reducing the stress on the hinge.

[0028] 2. Improve the curve passing performance of the vehicle system: The partial coordinated steering tracking control method in the present invention can effectively reduce the stress on the joints, and at the same time realize the decoupling control of the vehicle system. Therefore, when the vehicle passes through curves (especially small radius curves), the motion interference between adjacent vehicle bodies is greatly reduced, which will be beneficial for the vehicle to pass through the curved path.

[0029] 3. The algorithm has a simple structure and strong robustness: The algorithm structure of the coordinated steering tracking control method in the present invention is relatively simple. Through system decoupling, the multi-input and multi-output control system is converted into multiple single-input and single-output systems, which reduces the complexity of the algorithm, reduces the interconnection between each single variable control system, and improves the robustness of the control system. BRIEF DESCRIPTION OF THE DRAWINGS

[0030] Figure 1 It is a flow chart of the division coordinated steering tracking control method of the present invention;

[0031] Figure 2 Schematic diagram of the structure of a three-module six-axle virtual track train in an embodiment of the present invention;

[0032] Figure 3 Schematic diagram of the decoupling control principle in an embodiment of the present invention. DETAILED DESCRIPTION

[0033] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present invention.

[0034] A partial coordinated steering tracking control method applicable to a type of laterally indeterminate virtual track train, such as Figure 1 As shown:

[0035] The tracking control process is divided into two subtasks: 1) decoupling control of the lateral statically determinate vehicle system composed of the non-virtualized suspension and the vehicle body to achieve the tracking of the train; 2) minimizing the tire cornering force of the virtualized suspension to optimize the force state of the train;

[0036] Therefore, the partial coordinated steering tracking control method in this embodiment includes a first tracking control sub-method embedded in the tracking controller and a second tracking control sub-method embedded in the steering coordination controller; the first tracking control sub-method adopts a diagonal dominance matrix to design a single-input single-output tracking control algorithm to achieve tracking; the second tracking control sub-method takes minimizing the tire cornering force of the virtualized suspension as the control target to achieve tracking;

[0037] The non-virtualized suspension is selected based on the diagonal dominance of the vehicle system transfer function matrix, and its number is equal to the sum of the yaw and lateral freedom degrees of the virtual track train body n f ;

[0038] The virtual suspension is selected based on the diagonal dominance of the vehicle system transfer function matrix, and its number nv Equal to the number of virtual track train suspensions n and the sum of the number of yaw and lateral freedom of the vehicle body n f The difference, that is, n v =nn f ;

[0039] The vehicle system transfer function matrix is ​​obtained by Laplace transforming the vehicle lateral differential equation.

[0040] The diagonal dominance of the vehicle system transfer function matrix is ​​calculated using the diagonal dominance theory. The diagonal dominance of the vehicle system transfer function matrix needs to be sorted from small to large, and the first n f The suspension corresponding to the position of the diagonal dominance is a non-virtualized suspension, and the remaining n v The suspension is a virtualized suspension.

[0041] In this embodiment, the vehicle system dynamics equation is:

[0042]

[0043] in:

[0044]

[0045]

[0046] Where, m is the vehicle mass, I z is the yaw inertia of the vehicle body, K is the equivalent cornering stiffness of the tires on each axle, and is the hinge lateral force, K h is the lateral stiffness of the articulated joint. δ1~δ6 are the equivalent rotation angles of the wheels on each axle, u1~u n is the longitudinal velocity of each vehicle body, is the lateral velocity of each vehicle body, β1~β3 are the sideslip angles of the center of mass of each vehicle body is the yaw angular velocity of each vehicle body, l is half of the wheelbase, and L is the longitudinal distance between the articulation center and its adjacent axis.

[0047] The system transfer function matrix converted by Laplace transform is:

[0048]

[0049] in:

[0050]

[0051]

[0052]

[0053] The system output and output vector matching the system transfer function matrix are:

[0054]

[0055] Among them, y1~y6 are the lateral positions of the centers of each suspension.

[0056] Through the diagonal dominance theory, the dominance of each axis ND1~ND6 can be calculated. Figure 2 The vehicle structure diagram shown is easy to judge. In this embodiment, n=6, n f =4,n v =2.

[0057] Substituting conventional engineering application parameters into all the above equations, it can be calculated that within the conventional speed and frequency range, ND3, ND5 < ND1, ND2, ND4, ND6 generally holds true. Therefore, suspensions 3 and 5 are selected as virtualized suspensions, and suspensions 1, 2, 4, and 6 are selected as non-virtualized suspensions.

[0058] Subtask 1) Taking the lateral statically determinate vehicle system composed of the non-virtualized suspension and the vehicle body as the control subject, the decoupling control in the first tracking control sub-method includes the following steps:

[0059] Step 1: Establish the lateral dynamics or kinematics differential equation of the lateral statically determinate vehicle system composed of the non-virtualized suspension and the vehicle body, and convert it into the system transfer function matrix through Laplace transformation. The dynamics or kinematics differential equation includes the lateral translation and yaw degrees of freedom of each vehicle body;

[0060] Using the same modeling method as above, the system transfer function matrix can be obtained:

[0061]

[0062] The system output and output vector matching the system transfer function matrix are:

[0063]

[0064] Step 2: Design a frequency-band feedforward compensator for the system transfer function matrix described in step 1 to decouple it into a diagonal (dominant) system;

[0065] The feedforward compensator considering high and low frequencies is:

[0066]

[0067] in, It is W -1 (s) is the column coefficient matrix, M h and M l is an arbitrary real constant diagonal matrix. Tj is the time constant.

[0068] The transfer function matrix of the compensated system is:

[0069] G(s)=W′(s)K phl (s)

[0070] Step 3: Design a single-input single-output tracking control algorithm for the compensated system transfer function matrix with diagonal advantage described in Step 2. It can be an existing mature control algorithm or a new control algorithm designed by yourself. The input and output of the controller are determined according to the requirements of the control algorithm.

[0071] This embodiment takes the PI control algorithm as an example, and its structure can be expressed as:

[0072]

[0073] Among them, k cP1 ~k cP4 and k cI1 ~k cI4 are the PI controller parameters.

[0074] The second tracking control sub-method is specifically as follows:

[0075] Taking the minimization of the tire cornering force of the virtual suspension as the control target, the calculation method of the wheel steering angle is as follows:

[0076]

[0077] Among them, δ is the wheel steering angle of the virtual suspension, β is the sideslip angle of the center of mass of the vehicle body to which the virtual suspension belongs, l is the longitudinal distance between the center of mass of the vehicle body to which the virtual suspension belongs and the virtual suspension. If the virtual suspension is in front of the center of mass of the vehicle body, l is positive, otherwise it is negative, u is the longitudinal velocity of the vehicle body to which the virtual suspension belongs, and ψ is the yaw angle of the vehicle body to which the virtual suspension belongs.

[0078] The subtask 2) in this embodiment takes the minimization of the tire cornering force of the virtualized suspension as the control target, and the calculation method of the suspension wheel steering angles 3 and 5 is as follows:

[0079]

[0080] The above is only a specific embodiment of the present invention, but the protection scope of the present invention is not limited thereto. Any technician familiar with the technical field can easily think of various equivalent modifications or replacements within the technical scope disclosed by the present invention, and these modifications or replacements should be included in the protection scope of the present invention. Therefore, the protection scope of the present invention shall be based on the protection scope of the claims.

Claims

1. A method for coordinated steering and tracking control of a laterally indeterminate virtual track train, characterized in that: The described division coordinated steering tracking control method includes a first tracking control sub-method embedded in the tracking controller and a second tracking control sub-method embedded in the steering coordination controller; The first tracking control sub-method adopts a diagonal advantage matrix to design a single-input single-output tracking control algorithm to achieve tracking; The second tracking control sub-method achieves tracking by minimizing the tire cornering force of the virtualized suspension as a control target; The first tracking control sub-method is specifically as follows: Step 1: Establish the lateral dynamics or kinematic differential equation of the lateral statically determinate vehicle system composed of the non-virtualized suspension and the vehicle body, and convert it into a system transfer function matrix; Step 2: Set up the sub-band feedforward compensator based on the system transfer function matrix and decouple it into a diagonal advantage matrix; Step 3: Set up a single-input single-output tracking control algorithm based on the diagonal advantage matrix; The tracking controller is used for decoupling control of a lateral statically determinate force vehicle system composed of a non-virtualized suspension and a vehicle body to achieve tracking travel of the train; The steering coordination controller is used to minimize the tire cornering force of the virtualized suspension to optimize the stress state of the train; The second tracking control sub-method is specifically as follows: Taking the minimization of the tire cornering force of the virtual suspension as the control target, the calculation method of the wheel steering angle is as follows: Wherein, δ is the wheel steering angle of the virtual suspension, β is the side slip angle of the center of mass of the vehicle body to which the virtual suspension belongs, l is the longitudinal distance between the center of mass of the vehicle body to which the virtual suspension belongs and the virtual suspension, if the virtual suspension is in front of the center of mass of the vehicle body, then l is positive, otherwise it is negative, u is the longitudinal velocity of the vehicle body to which the virtual suspension belongs, ψ is the yaw angle of the vehicle body to which the virtual suspension belongs; The segment coordinated steering tracking control method further includes: Sort the diagonal dominance of the vehicle system transfer function matrix from small to large, and select the first n f The suspension corresponding to the position of the diagonal dominance is a non-virtualized suspension, and the remaining n v The suspension is a virtualized suspension.

2. The method for controlling the partial coordinated steering and tracking of a laterally indeterminate virtual track train according to claim 1 is characterized in that: The non-virtualized suspension is selected according to the diagonal dominance of the vehicle system transfer function matrix, and its number is equal to the sum of the number of yaw and lateral freedom degrees of the virtual track train body n f .

3. The method for controlling the partial coordinated steering and tracking of a laterally indeterminate virtual track train according to claim 1 is characterized in that: The virtualized suspension is selected according to the diagonal dominance of the vehicle system transfer function matrix, and its number n v Equal to the number of virtual track train suspensions n and the sum of the number of yaw and lateral freedom of the vehicle body n f The difference, that is, n v =nn f .

4. The method for controlling the partial coordinated steering and tracking of a laterally indeterminate virtual track train according to claim 1 is characterized in that: The vehicle system transfer function matrix is ​​obtained from the vehicle lateral dynamics or kinematics differential equation through Laplace transformation.

5. The method for controlling the partial coordinated steering and tracking of a laterally indeterminate virtual track train according to claim 1, characterized in that: Step 1 of the first tracking control sub-method is specifically: The lateral dynamics or kinematics differential equation of the laterally statically determinate vehicle system composed of a non-virtualized suspension and a vehicle body is established and converted into a system transfer function matrix through Laplace transform, wherein the lateral dynamics or kinematics differential equation includes the lateral displacement and yaw degrees of freedom of each vehicle body.