DEVICE AND METHOD FOR OPTIMAL LANE KEEPING ASSISTANCE, ARTICULATED VEHICLE, COMPUTER PROGRAM, AND COMPUTER READABLE MEDIUM STORING COMPUTER PROGRAM
20220324445 · 2022-10-13
Assignee
Inventors
Cpc classification
B60W2050/0008
PERFORMING OPERATIONS; TRANSPORTING
B62D6/005
PERFORMING OPERATIONS; TRANSPORTING
B60W50/0098
PERFORMING OPERATIONS; TRANSPORTING
B62D15/021
PERFORMING OPERATIONS; TRANSPORTING
B60W10/20
PERFORMING OPERATIONS; TRANSPORTING
B62D13/005
PERFORMING OPERATIONS; TRANSPORTING
International classification
B60W10/20
PERFORMING OPERATIONS; TRANSPORTING
B60W50/00
PERFORMING OPERATIONS; TRANSPORTING
B62D13/00
PERFORMING OPERATIONS; TRANSPORTING
B62D15/02
PERFORMING OPERATIONS; TRANSPORTING
Abstract
An optimal lane keeping assistance device of an articulated vehicle (100), in which a tractor (200) and a trailer (300) are connected via a fifth wheel coupling (400), includes a first sensor (520,540) which detects a tractor state variable, a second sensor (560) which detects a fifth wheel coupling (400) state variable, and an electric control unit (500) incorporating a microcomputer. The electric control unit (500) calculates a control variable (Uc) according to a target lateral displacement value (Yd), an output signal of the first sensor (520, 540), and an output signal of the second sensor (560), taking into account a feedback gain of an optimal control rule, to calculate a target steering angle (δf) of the tractor (200) according to the calculated control variable (Uc) and the output signal of the first sensor (520,540), and to assist steering of the tractor (200) based on the calculated target steering angle (δf).
Claims
1-15. (canceled)
16. An optimal lane keeping assistance device for an articulated vehicle, in which a tractor and a trailer are connected via a fifth wheel coupling, comprising: a first sensor which detects a state variable of the tractor; a second sensor which detects a state variable of the fifth wheel coupling; and an electric control unit which incorporates a microcomputer; wherein the electric control unit is configured to calculate a control variable according to a target lateral displacement value and output signals from the first sensor and the second sensor taking into account a feedback gain of optimal control rule, to calculate a target steering angle of the tractor according to the calculated control variable and the output signal from the first sensor, and to assist steering of the tractor based on the calculated target steering angle, and wherein the state variable of the tractor consists of a lateral displacement value, a yaw angle, and a yaw rate.
17. An optimal lane keeping assistance device according to claim 16, wherein the electric control unit is configured to assist the steering of the tractor based on the calculated target steering angle, taking into account a driver model of a first order lag system.
18. An optimal lane keeping assistance device according to claim 16, wherein the electric control unit is configured to assist the steering of the tractor by sending the calculated target steering angle to an electric control unit of an electric power steering device.
19. An optimal lane keeping assistance device according to claim 16, wherein the state variable of the fifth wheel coupling includes a connecting angular velocity and a connecting angle.
20. An optimal lane keeping assistance device according to claim 16, wherein the articulated vehicle is a full trailer vehicle or a semi-trailer vehicle.
21. An optimal lane keeping assistance method for an articulated vehicle, in which a tractor and a trailer are connected via a fifth wheel coupling, the articulated vehicle including: a first sensor which detects a state variable of the tractor; a second sensor which detects a state variable of the fifth wheel coupling; and an electric control unit which incorporates a microcomputer, wherein the electric control unit performs the following steps: calculating a control variable according to a target lateral displacement value and output signals from the first sensor and the second sensor taking into account a feedback gain of optimal control rule; calculating a target steering angle of the tractor according to the calculated control variable and the signal output from the first sensor; assisting steering of the tractor based on the calculated target steering angle, wherein the state variable of the tractor consists of a lateral displacement value, a yaw angle, a yaw rate.
22. An optimal lane keeping assistance method according to claim 21, wherein the step of assisting the steering of the tractor assist the steering of the tractor based on the calculated target steering angle, taking into account a driver model of a first order lag system.
23. An optimal lane keeping assistance method according to claim 21, wherein the step of assisting the steering of the tractor assists the steering of the tractor by sending the calculated target steering angle to an electric control unit of an electric power steering device.
24. An optimal lane keeping assistance method according to claim 21, wherein the state variable of the fifth wheel coupling includes a connecting angular velocity and a connecting angle.
25. An optimal lane keeping assistance method according to claim 21, wherein the articulated vehicle is a full trailer vehicle or a semi-trailer vehicle.
26. An articulated vehicle comprising the optimal lane keeping assistance device according to claim 16.
27. A computer program including a program code which executes the steps of the optimal lane keeping assistance method according to claim 21, when the computer program is executed on a computer.
28. A computer readable medium storing a computer program including a program code which executes the steps of the optimal lane keeping assistance method according to claim 21, when the computer program is executed on a computer.
Description
BRIEF DESCRIPTION OF DRAWINGS
[0010]
[0011]
[0012]
[0013]
[0014]
[0015]
[0016]
[0017]
[0018]
DESCRIPTION OF EMBODIMENTS
[0019] Hereinafter, embodiments implementing the present invention will be described in detail with reference to the attached drawings.
[0020] The tractor 200 includes a front wheel 220 capable of steering by an electric power steering device, and a rear wheel 240 driven by a diesel engine or the like. Here, as the rear wheel 240, a double tire in which two tires are arranged in parallel can be used. Furthermore, on the rear side of the trailer 300, rear double-tire wheels 320 on two axles are attached. The fifth wheel coupling 400 includes a coupler fixed to an upper surface of the mar of the tractor 200 and a king pin fixed to a lower surface of the front of the trailer 300. In a state in which the king pin of the trailer 300 is detachably connected to the coupler of the tractor 200, the fifth wheel coupling 400 is allowed to rotate around a rotation shaft extending in the vertical direction with respect to the tractor 200.
[0021] As illustrated in
[0022] The processor 500A is hardware that executes an instruction set (data transfer, operation, processing, control, management, and the like) described in an application program, and includes an arithmetic unit, registers for storing instructions and data, peripheral circuits, and the like. The non-volatile memory 500B includes, for example, a flash ROM (read-only memory), which is capable of storing data even when power supply is shut off, and the non-volatile memory 500B stores therein an application program (computer program) for implementing the optimal lane keeping assistance device. The volatile memory 500C includes a dynamic RAM (random access memory) or the like that loses data when the power supply is shut off, and provides a storage area for temporarily storing data in the calculation process of the processor 500A.
[0023] The input-output circuit 500D includes an A/D converter, a D/A converter, a D/D converter, and the like, and provides an input-output function of analog signals and digital signals to/from external devices. The communication circuit 500E includes, for example, a CAN (controller area network) transceiver or the like, and provides a function of connecting to an in-vehicle network. The internal bus 500F is a path for exchanging data between devices, and includes: an address bus for transferring an address; a data bus for transferring data; and a control bus which exchanges: a timing at which input and output are performed in the address bus and the data bus; and control information.
[0024] To a predetermined location of the tractor 200, a lateral displacement sensor 520 for detecting lateral displacement value y [m], a yaw rate sensor 540 for detecting yaw rate r [rad/s], are respectively attached. Here, the lateral displacement sensor 520 is formed, for example, of a stereo camera that captures the front situation of the tractor 200, and detects the displacement (deviation) from a reference point which is the center of the lane (traffic lane) at the forward gazing distance Lp [m] of the tractor 200. In addition, a connecting angle sensor 560 for detecting a connecting angle θ [rad] of the trailer 300 with respect to the longitudinal axis of the tractor 200 is attached to a predetermined position of the fifth wheel coupling 400 fixed to the upper surface of the rear of the tractor 200. The lateral displacement sensor 520 and the yaw rate sensor 540 are mentioned as an example of the first sensor which detects the state variable of tractor 200, and the connecting angle sensor 560 is an example of the second sensor which detects the state variable of the fifth wheel coupling 400.
[0025] The processor 500A of the electric control unit 500 receives output signals of the lateral displacement sensor 520, the yaw rate sensor 540, and the connecting angle sensor 560 via the input-output circuit 500D and the internal bus 500F. The processor 500A of the electric control unit 500 executes the application program stored in the non-volatile memory 500B, so that a target steering angle δ.sub.f [rad] is transmitted to an electric control unit 620 of an electric power steering device 600 according to a target lateral displacement value Y.sub.d [m] and each output signal of: the lateral displacement sensor 520; the yaw rate sensor 540; and the connecting angle sensor 560, to assist steering of the tractor 200. The target lateral displacement value Y.sub.d is given, for example, by a known function of the optimal lane keeping assistance device.
[0026] Here, an outline of the optimum lane keeping assistance process executed by the processor 500A of the electric control unit 500 according to the application program will be described. The processor 500A of the electric control unit 500 integrates the output signal of the yaw rate sensor 540 to calculate the yaw angle Ψ [rad] of the tractor 200, and to calculate a connecting angular velocity ω [rad/s] based on the temporal variable of the output signal of the connecting angle sensor 560. Thus, the processor 500A of the electronic control device 500 is an example of the first sensor detecting the state variable of the tractor 200 and the second sensor detecting the state variable of the fifth wheel coupling 400. The yaw angle Ψ of the tractor 200 and the connecting angular velocity ω of the fifth wheel coupling 400 may be directly detected using a known sensor.
[0027] The processor 500A of the electric control unit 500 calculates a control variable u.sub.c[m] according to the target lateral displacement value Y.sub.d, the state variable of the tractor 200 and the state variable of the fifth wheel coupling 400 taking into account the feedback gain F of the optimal control rule. Furthermore, the processor 500A of the electric control unit 500 calculates the target steering angle δ.sub.f of the tractor 200 according to the calculated control variable u.sub.c and the state variable of the tractor 200. Then, the processor 500A of the electric control unit 500 outputs the target steering angle δ.sub.f to the electric control unit 620 of the electric power steering device 600, thereby assisting the steering of the tractor 200 so as to be the target lateral displacement value Y.sub.d.
[0028] Here, prior to describing the specific optimum lane keeping assistance process, the theoretical development of how to calculate the target steering angle δ.sub.f and how to obtain the optimal control rule will be described. First, an analysis model of the articulated vehicle 100, which is a semi-trailer vehicle, will be discussed.
[0029] As a parameter of the tractor 200 in the analysis model of the articulated vehicle 100, assume that the distance between gravitational center and the front wheel 220 is a [m], the distance between the gravitational center and the fifth wheel coupling 400 is a.sub.1 [m], the distance between the gravitational center and the rear wheel 240 is b [m], a wheelbase is l.sub.1(a.sub.1+b) [m], mass is m [kg], yaw moment of inertia is I.sub.z [kgm.sup.2], cornering power of the front wheel 240 is C.sub.f [N/rad], cornering power of the rear wheel 240 is C.sub.r [N/rad], lateral velocity of the gravitational center is v [m/s], the front wheel steering angle is δ.sub.f [rad], and yaw rate is r [rad/s]. In addition, as a parameter of the trailer 300 in the analysis model of the articulated vehicle 100, assume that the distance between gravitational center and the fifth wheel coupling 400 is c [m], the mass is m.sub.1 [kg], the yaw moment of inertia is I.sub.1 [kgm.sup.2], and cornering power is C.sub.1 [N/rad]. Furthermore, as a parameter of the fifth wheel coupling 400 in the analysis model of the articulated vehicle 100, assume that the connecting angular velocity is ω [rad/s], the connecting angle is θ [rad], and a longitudinal velocity of the articulated vehicle 100 in the analysis model of the articulated vehicle 100 is u [m/s]. Then, a state equation representing the motion of the articulated vehicle 100 may be expressed as follows:
where x is a state variable, M.sup.−1 is an inverse mass matrix, A.sub.0 is an attenuation matrix, and B.sub.0 is an external force matrix.
[0030] A model representing the driver's steering may be expressed as follows by applying the forward gazing model to the above equation:
[0031] where T.sub.s is a time constant [s] of the driver model, G is a steering gain, and e is an error [m] representing a deviation from the target lateral displacement value Y.sub.d.
[0032] Since the equation of motion described above is a differential equation of a continuous-time system, the processor 500A of the electric control unit 500 cannot calculate the equation. For this reason, the equation of motion should be transformed into an equation of a discrete-time system. A system matrix of discrete-time system Ad and a control matrix in discreate-time system Bd give the following difference equation:
where T [s] is a sampling time, A=M.sup.−1A.sub.0 is system matrix in continuous time system, B=M.sup.−1B.sub.0 is control matrix in continuous time system, C is an observation matrix, and I is an identity matrix.
[0033] By applying the difference equation obtained in this manner to the driver model, it is possible to obtain a discrete-time equation for calculating the target steering angle δ.sub.f as shown in the following equation.
[0034] In a system represented by the above difference equation, when the feedback gain is F, a control variable u.sub.C which represents an optimal control rule, is defined by the following equation.
u.sub.c=Y.sub.d−Fx(k) [Math.5]
[0035] The feedback gain F can be determined by obtaining a disturbance variance matrix Q and an observed noise variance matrix R which minimize the following equation.
[0036] Here, the feedback gain F is expressed as follows:
F=(R+B.sub.d.sup.TPB.sub.d).sup.−1B.sub.d.sup.TPA.sub.d [Math.7]
[0037] Here, in the above equation representing the feedback gain F, P is a solution for the Riccati equation represented as follows:
P=Q+A.sub.dPA.sub.d−A.sub.dPB.sub.d(R+B.sup.TPB)B.sup.TPA.sub.d [Math.8]
[0038]
[0039] Then, by subtracting (y+L.sub.pΨ) from the control variable u.sub.c(Y.sub.d−Fx(k)), an error e (Y.sub.d−Fx(k)−y−L.sub.pΨ) representing the deviation from the target lateral displacement value Y.sub.d is obtained. The obtained error e is multiplied by a constant (G/(T.sub.s+1)) obtained by dividing the steering gain G by the value obtained by adding 1 to the time constant T.sub.s of the driver model, taking into consideration the driver model of a first order lag system, so that the target steering angle δ.sub.f of the tractor 200 is obtained. The target steering angle δ.sub.f is taken into consideration when applying the optimal control rule and is transmit to the electric control unit 620 of the electric power steering device 600 to assist the steering of the tractor 200. Accordingly, the tractor 200 can be steered to travel in the center of a lane located in front of the articulated vehicle 100 to thereby suppress lane departure.
[0040]
[0041] In step 1 (abbreviated as “S1” in
[0042] In step 2, the processor 500A of the electric control unit 500 sequentially integrates the yaw rate r read from the yaw rate sensor 540 to calculate the yaw angle Ψ of the tractor 200, and calculates the connecting angular velocity ω of the fifth wheel coupling 400 based on temporal changes of the connecting angle θ read from the connecting angle sensor 560. In a case in which a sensor capable of directly detecting the yaw angle Ψ and the connecting angular velocity ω is provided, the process in step 2 can be omitted by reading the yaw angle Ψ and the connecting angular velocity ω in step 1.
[0043] In step 3, the processor 500A of the electric control unit 500 calculates the control variable u.sub.c through the following process. That is, the processor 500A of the electric control unit 500 calculates Fx(k) by multiplying the lateral displacement value y, the yaw angle Ψ, the yaw rate r, the connecting angular velocity ω and the connecting angle θ as the state variable x(k) by the feedback gain F of the optimal control rule. Then, the processor 500A of the electric control unit 500 calculates the control variable u.sub.c=Y.sub.d−Fx(k) by subtracting Fx(k) from the target lateral displacement value Y.sub.d.
[0044] In step 4, the processor 500A of the electric control unit 500 calculates an error e indicating a deviation from the target lateral displacement value Y.sub.d through the following process. That is, the processor 500A of the electric control unit 500 multiplies the yaw angle Ψ by the forward gazing distance L to calculate L.sub.pΨ, and adds the calculated value (L.sub.pΨ) to the lateral displacement value y to calculate (y+L.sub.pΨ). Then, the processor 500A of the electric control unit 500 subtracts (y+L.sub.pΨ) from the control variable u.sub.c(Y.sub.d−Fx(k)) to calculate an error e=u.sub.c−(y+L.sub.pΨ)=Y.sub.d−Fx(k)−y−L.sub.pΨ.
[0045] In step 5, the processor 500A of the electric control unit 500 calculates the target steering angle δ.sub.f in consideration of the characteristics of the driver by multiplying the error e by the constant (G/(T.sub.s+1)) of the driver model of the first order lag system.
[0046] In step 6, the processor 500A of the electric control unit 500 transmits the target steering angle δ.sub.f to the electric control unit 620 of the electric power steering device 600 through the communication circuit 500E. In this way, the electric control unit 620, that has received the target steering angle δ.sub.f, of the electric power steering device 600 performs feedback control of an actuator of the electric power steering device 600 so that an actual steering angle detected by a steering angle sensor (not shown) approaches the target steering angle δ.sub.f.
[0047] Therefore, in consideration of the feedback gain F of the optimal control rule, the front wheel 220 of the tractor 200 is steered based on the state variables of the tractor 200 and the fifth wheel coupling 400, and thus, for example, even if an abnormality such as a puncture occurs in one of the tires of the articulated vehicle 100, deviation of the tractor 200 from the lane ahead is avoided. Hereinafter, simulation results which verify such an effect are shown.
[0048]
[0049]
[0050]
[0051] The reason the stability of the articulated vehicle 100 is improved in this way is that, as a result of analyzing a system eigenvalue, a characteristic root is near an imaginary axis in the prior art; however, in the technique proposed in the present embodiment, the characteristic roots are not around the imaginary axis.
[0052] Regarding the above embodiment, as illustrated in
[0053] The application program can be distributed in the market by being stored in a computer-readable recording medium, for example, an SD card or a USB memory. Furthermore, the application program can be stored in storage at a node connected to the Internet etc. and can be distributed from this node. In this case, storage of the node is taken as an example of a computer-readable storage medium.
[0054] One skilled in the art would readily understand that a new embodiment can be made by omitting a part of the technical idea of the various embodiments, freely combining parts of the technical idea of the various embodiments, and substituting a part of the technical idea of the various embodiments.
REFERENCE SIGNS LIST
[0055] 100 articulated vehicle [0056] 200 tractor [0057] 300 trailer [0058] 400 fifth wheel coupling [0059] 500 electric control unit [0060] 520 lateral displacement sensor (first sensor) [0061] 540 yaw rate sensor (first sensor) [0062] 560 connecting angle sensor (second sensor) [0063] 600 electric power steering device [0064] 620 electric control unit