Electric Truck Steer-by-Wire System and Network Uncertainty Control Method Therefor
20220289269 · 2022-09-15
Assignee
Inventors
- Wanzhong ZHAO (Nanjing, CN)
- Zhongkai LUAN (Nanjing, CN)
- Xiaochuan ZHOU (Nanjing, CN)
- Chunyan WANG (Nanjing, CN)
Cpc classification
B62D5/0481
PERFORMING OPERATIONS; TRANSPORTING
B62D5/001
PERFORMING OPERATIONS; TRANSPORTING
International classification
Abstract
An electric truck steer-by-wire system and a net-work uncertainty control method therefor. Said system comprises: a master control electric power module (14), a slave control electric power module (18), a road-sensing motor module (4), a steering wheel (1), an upper steering column (3), a lower steering column(10), a rack and pinion steering mechanism (12), wheels (13), a first steering angle sensor (2), a second steering angle sensor (11),a steering domain controller (8), and a vehicle-mounted CAN network (9). By means of the design of the master and slave controllers and actuating mechanisms, the system combines the advantages of steering angle tracking, torque tracking and current tracking, there-by satisfying the steering response requirements and power requirements of the electric truck, and further enhancing the robustness and fault-tolerant performance of the system under a random network time lag.
Claims
1. An electric truck steer-by-wire system, composed of a master control electric power module, a slave control electric power module, a road sensing motor module, a steering wheel, an upper steering column, a lower steering column, a rack-pinion steering gear, wheels, a first steering angle sensor, a second steering angle sensor, a steering domain controller and a vehicle-mounted CAN network; wherein the steering wheel is connected with a torque input end of the upper steering column by a spline, the first steering angle sensor is mounted between the steering wheel and the upper steering column, and the road sensing motor module is mounted at a lower end of the upper steering column; no mechanical connection exists between the upper steering column and the lower steering column, a gap exists between the upper steering column and the lower steering column in a vertical direction, the second steering angle sensor is mounted at an input end of the lower steering column, an output end of the lower steering column is connected with the rack-pinion steering gear, the master control electric power module and the slave control electric power module are mounted on a rack of the rack-pinion steering gear, and an end of the rack is connected with the wheels; the road sensing motor module consists of a road sensing controller, a first motor and a first deceleration mechanism; an output of the first motor is connected with an input of the first deceleration mechanism, and a torque is transmitted to the upper steering column after deceleration and torque is increased by the first deceleration mechanism; the road sensing controller controls the rotating speed of the first motor; the road sensing controller simulates a pavement steering torque according to an objective steering torque signal from the steering domain controller; the first steering angle sensor transmits a driver steering angle demand to the steering domain controller by the vehicle-mounted CAN network; the steering domain controller converts the driver steering angle demand into the objective steering torque signal and transmits the objective steering torque signal to the master control electric power module by the vehicle-mounted CAN network; the master control electric power module consists of a master controller, a second motor and a second deceleration mechanism; an output end of the second motor is connected with an input of the second deceleration mechanism, and a torque is transmitted to the rack-pinion steering gear after deceleration and torque is increased by the second deceleration mechanism; the master controller calculates an objective current according to a steering torque demand from the steering domain controller, then distributes the current, and further transmits the objective current to the slave control electric power module; the slave control electric power module consists of a slave controller, a third motor and a third deceleration mechanism; an output of the third motor is connected with an input of the third deceleration mechanism, and a torque is transmitted to the rack-pinion steering gear after deceleration and torque is increased by the third deceleration mechanism; and the master controller dynamically compares the first steering angle sensor with the second steering angle sensor according to the steering domain controller and the vehicle-mounted CAN network, so as to realize the tracking of a driving intention.
2. The electric truck steer-by-wire system according to claim 1, wherein the first motor, the second motor and the third motor all are permanent magnet synchronous motors.
3. The electric truck steer-by-wire system according to claim 1, wherein the first deceleration mechanism, the second deceleration mechanism and the third deceleration mechanism all are worm-gear deceleration mechanisms.
4. The electric truck steer-by-wire system according to claim 1, wherein the slave controller consists of a current acquisition circuit, so as to realize the acquisition of a present current signal of the third motor.
5. A network uncertainty control method for an electric truck steer-by-wire system, comprising the following steps: step 1): establishing an electric truck trajectory tracking linear error dynamic model with random network time lag; step 2): establishing an evaluation system of the trajectory tracking performance and dynamic model stability with random network time lag, and constructing an adaptive prediction model; and step 3): constructing a time-varying matrix polytope random network time lag uncertainty term representation method and proposing an adaptive model predictive control algorithm for a polytope time lag uncertain system.
6. The network uncertainty control method for the electric truck steer-by-wire system according to claim 5, wherein step 1) specifically comprises: 11) establishing an electric truck trajectory tracking linear error dynamic model containing random network time lag, as follows:
13. performing augmentation on a system model: establishing a new state quantity based on the state quantity and the control quantity of the electric truck trajectory tracking linear error dynamic model with random network time lag established in step 11), as follows:
7. The network uncertainty control method for the electric truck steer-by-wire system according to claim 5, wherein step 2) specifically consists of: 21) establishing a relationship between a prediction time domain and a control time domain, wherein the relationship between the control time domain and the prediction time domain is as follows:
N.sub.p=ƒ.sub.N.sub.
Y(k)=ψξ(k)+ΘΔu(k) when the prediction time domain N.sub.p and the control time domain N.sub.c change adaptively according to working conditions, coefficient matrices of the state quantity and the control quantity in the prediction model also change accordingly, where Y(k) is a prediction output at time k, ξ(k) is a state vector at time k, Δu(k) is a control increment vector at time k, ψ and Θ are respectively coefficient matrices of the state quantity and the control quantity, and the expressions are as follows:
8. The network uncertainty control method for the electric truck steer-by-wire system according to claim 5, wherein step 3) specifically comprises: 31) receiving an upper layer trajectory signal input and setting a corresponding filter of a steering domain controller to a high level; 32) establishing a time lag augmented system model: establishing a generalized state vector of the system with random network time lag as follows:
ξ.sub.τ.sub.
Description
BRIEF DESCRIPTION OF FIGURES
[0066]
[0067]
[0068]
[0069]
[0070] In order to facilitate the understanding for someone skilled in the art, the disclosure is further described in detail with an embodiment and accompanying drawings below. The content mentioned in the implementation is not the limitation to the disclosure.
[0071] Referring to
[0072] The steering wheel 1 is connected with a torque input of the upper steering column 3 by a spline. The first steering angle sensor 2 is mounted between the steering wheel 1 and the upper steering column 3. The road sensing motor module 4 is mounted at a lower end of the upper steering column 3. No mechanical connection exists between the upper steering column 3 and the lower steering column 10. A gap exists between the upper steering column and the lower steering column in a vertical direction. The second steering angle sensor 11 is mounted at an input of the lower steering column 10. An output of the lower steering column 10 is connected with the rack-pinion steering gear 12. The master control electric power module 14 and the slave control electric power module 18 are mounted on a rack of the rack-pinion steering gear 12. An end of the rack is connected with the wheels 13, so as to realize the electric truck steer-by-wire operation with a large front axle load.
[0073] The road sensing motor module 4 includes a road sensing controller 5, a first motor 6 and a first deceleration mechanism 7. An output of the first motor 6 is connected with an input of the first deceleration mechanism 7. A torque is transmitted to the upper steering column 3 after deceleration and torque is increased by the first deceleration mechanism 7. The road sensing controller 5 controls the rotating speed of the first motor 6. The road sensing controller 5 simulates a pavement steering torque according to an objective steering torque signal transmitted by the steering domain controller 8. The first steering angle sensor 2 transmits a driver steering angle demand to the steering domain controller 8 by the vehicle-mounted CAN network 9. The steering domain controller 8 converts the driver steering angle demand into the objective steering torque signal and transmits the objective steering torque signal to the master control electric power module 14 by the vehicle-mounted CAN network 9. The road sensing controller 5 supplies power to the first motor 6 and the first steering angle sensor 2.
[0074] The master control electric power module 14 includes a master controller 15, a second motor 16 and a second deceleration mechanism 17. An output of the second motor 16 is connected with an input of the second deceleration mechanism 17. A torque is transmitted to the rack-pinion steering gear 12 after deceleration and torque is increased by the second deceleration mechanism 17. The master controller 15 calculates an objective current according to the steering torque demand from the steering domain controller 8, and then distributes the current, and further transmits the objective current to the slave control electric power module 18. The master controller 15 supplies power to the second motor 16 and the second steering angle sensor 11.
[0075] The slave control electric power module 18 includes a slave controller 19, a third motor 20 and a third deceleration mechanism 21. An output end of the third motor 20 is connected with an input of the third deceleration mechanism 21. A torque is transmitted to the rack-pinion steering gear 12 after deceleration and torque is increased by the third deceleration mechanism 21. The slave controller includes a current acquisition circuit, so as to realize the acquisition of a present current signal from the third motor 20. The slave controller 19 supplies power to the third motor 20.
[0076] The master controller 15 dynamically compares the first steering angle sensor 2 with the second steering angle sensor 11 according to the steering domain controller 8 and the vehicle-mounted CAN network 9, so as to realize the tracking of a driving intention.
[0077] The first motor, the second motor and the third motor all are permanent magnet synchronous motors.
[0078] The first deceleration mechanism, the second deceleration mechanism and the third deceleration mechanism all are worm-gear deceleration mechanisms.
[0079] The disclosure provides a network uncertain control method for an electric truck steer-by-wire system, which, based on the above system, includes the following steps:
[0080] step 1): establishing an electric truck trajectory tracking linear error dynamic model with random network time lag;
[0081] step 2): establishing a trajectory tracking performance evaluation system and dynamic model stability evaluation system with random network time lag, and constructing an adaptive prediction model; and
[0082] step 3): constructing a time-varying matrix polytope random network time lag uncertainty term representation method and proposing an adaptive model predictive control algorithm for a polytope time lag uncertain system.
[0083] Step 1) specifically includes:
[0084] 11) establishing an electric truck trajectory tracking linear error dynamic model with random network time lag, as follows (using a ground fixed coordinate system OXY):
[0085] where u.sub.f is a control quantity of a front wheel steering angle with random network time lag, x and y are respectively a longitudinal displacement and a transverse displacement of a vehicle, {dot over (x)} and {dot over (y)} are respectively a longitudinal speed and a transverse speed of the vehicle, φ and {dot over (φ)} are respectively a yaw angle and a yaw rate of the vehicle; X.sub.r=[{dot over (y)}.sub.r {dot over (x)}.sub.r φ.sub.r {dot over (φ)}.sub.r y.sub.r x.sub.r].sup.T is a state quantity at a reference point, and u.sub.fr is a reference control quantity;
[0086] 12) performing discretization of the continuous model:
[0087] performing discretization on the electric truck trajectory tracking linear error dynamic model with a ground fixed coordinate system OXY, as follows:
[0088] where T.sub.s is a sampling time, L.sup.−1 is inverse Laplace transform, and s is a Laplace operator; and
[0089] 13) performing augmentation on a system model:
[0090] establishing a new state quantity based on the state quantity and the control quantity of the electric truck trajectory tracking linear error dynamic model with random network time lag, established in step 11), as follows:
[0091] to obtain a state space expression of a discrete ideal trajectory tracking system, as follows:
[0092] Referring to
[0093] 21) establishing a relationship between a prediction time domain and a control time domain, wherein
[0094] at each sampling time, different values of the prediction time domain and the control time domain change the dimensions of a prediction equation coefficient matrix, thus affecting the solution direction of rolling optimization; the relationship between the value of the control time domain and the prediction time domain is as follows:
[0095] where N.sub.p is a prediction time domain, N.sub.c is a control time domain, round(.Math.) is a rounding function, n is an undetermined coefficient, and n={1,2 . . . N.sub.p};
[0096] 22) establishing an adaptive prediction time domain function, wherein
[0097] the values of the prediction time domain and the control time domain are dynamically determined by comprehensively considering environmental parameters such as a road curvature, working condition parameters such as a vehicle speed and network conditions, and an adaptive prediction time domain function is accordingly proposed as follows:
N.sub.p=ƒ.sub.N.sub.
[0098] where V.sub.xk, C.sub.k and τ.sub.k are respectively longitudinal speed of the vehicle, a trajectory curvature and a network delay obtained by a time stamp at time k, k.sub.i and b.sub.i are undetermined coefficients, and i=1, 2, 3, obtained by offline optimization;
[0099] 23) establishing a parameter offline optimization model, wherein
[0100] the parameter offline optimization model is as follows:
[0101] the values of the prediction time domain and the control time domain are obtained by adjusting the undetermined coefficients in multiple iterations, so as to obtain a set of undetermined coefficients that minimize the calculation time and tracking error, where k.sub.1 and k.sub.2 are weight factors, and s.sub.1 and s.sub.2 are scale factors used to convert two objectives into the same order of magnitude; an objective function ƒ.sub.Time(.Math.) is a CPU calculation time required for a rolling optimization, and an objective function ƒ.sub.Error(.Math.) is an average trajectory tracking error in a whole process; the constraint is that the CPU calculation time required for a rolling optimization process does not exceed the sampling time;
[0102] 24) updating the prediction model, wherein
[0103] after an undermined parameter is obtained by solving by offline optimization, a system prediction equation expression is obtained as follows:
Y(k)=ψξ(k)+ΘΔu(k)
[0104] when the prediction time domain N.sub.p and the control time domain N.sub.c change according to working conditions, coefficient matrices of the state quantity and the control quantity in the prediction model also change adaptively, where Y(k) is a prediction output at time k, ξ(k) is a state vector at time k, Δu(k) is a control increment vector at time k, ψ and Θ are respectively coefficient matrices of the state quantity and the control quantity, and the expressions are as follows:
and
[0105] 25) determining a next sampling time:
[0106] if a next time still exists in an instruction generated by a counting module of a steering domain controller, returning to step 22), otherwise ending the whole solution process.
[0107] Referring to
[0108] 31) receiving an upper trajectory signal input and setting a corresponding filter of a steering domain controller to a high level;
[0109] 32) establishing a time lag augmented system model:
[0110] establishing a generalized state vector of the system under with random network time lag as follows:
ξ.sub.τ.sub.
[0111] establishing a discrete system state equation considering random network time lag as follows:
[0112] 33) establishing a time lag uncertainty coefficient linear representation method and a random network time lag polytope model, wherein
[0113] Δ.sub.i,k is an uncertainty coefficient caused by random network delay as follows:
[0114] wherein ΔΓ.sub.i is an integral upper limit, which is an actual action time length of a control signal Δu(k−i) in a corresponding interval, and τ.sub.k-i is a total delay length of signals transmitted at time (k−i)T.sub.s; and
[0115] establishing a random network time lag uncertainty coefficient matrix, which is capable of being expressed by a polytope model as follows:
[0116] wherein η.sub.i,h(k) is a time-varying coefficient of polyhedron vertices related to network time lag k, which satisfies a relationship as follows:
[0117] all signals act in a sampling cycle; v∈[0,1) represents a time length where predictive control should account for the effective control signal transmitted at time (k−1) T.sub.s with control quantity at time k;
[0118] 34) establishing an adaptive model predictive control algorithm for an uncertain system:
[0119] establishing a trajectory tracking dynamic optimization index based on the dynamic model as follows:
[0120] where N.sub.p is a prediction time domain, N.sub.c is a control time domain, Q and R are weight matrices, ρ is a relaxation factor weight coefficient, and ε is a relaxation factor; and
[0121] establishing a dynamic optimization model of a driverless vehicle trajectory tracking controller with network time lag in each control cycle as follows:
[0122] wherein ΔU is a control incremental constraint, y.sub.hc is a hard constraint output, y.sub.sc is a soft constraint output, the range of the soft constraint can be adjusted by the relaxation factor ε, and e is a tracking error in the prediction time domain; and
[0123] 35) determining a next sampling time:
[0124] if a next time still exists in an instruction generated by a counting module of the steering domain controller, returning to step 33), otherwise ending a whole solution process.
[0125] There exist many specific applications of this disclosure, and the above example is only a preferred implementation of the disclosure. It should be noted that, for those of ordinary skill in the art, without deviating from the principle of the disclosure, several improvements can be made, and these improvements should also be regarded as the protection scope of this disclosure.