Device and method for optimal lane keeping assistance, articulated vehicle, computer program, and computer readable medium storing computer program
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).
1. 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 using a target lateral displacement value and subtracting 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 includes a lateral displacement value, a yaw angle, and a yaw rate.
2. The optimal lane keeping assistance device according to claim 1 , 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.
3. The optimal lane keeping assistance device according to claim 1 , 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.
4. The optimal lane keeping assistance device according to claim 1 , wherein the state variable of the fifth wheel coupling includes a connecting angular velocity and a connecting angle.
5. The optimal lane keeping assistance device according to claim 1 , wherein the articulated vehicle is a full trailer vehicle or a semi-trailer vehicle.
6. 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 using a target lateral displacement value and subtracting 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 includes a lateral displacement value, a yaw angle, a yaw rate.
7. The optimal lane keeping assistance method according to claim 6 , 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.
8. The optimal lane keeping assistance method according to claim 6 , 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.
9. The optimal lane keeping assistance method according to claim 6 , wherein the state variable of the fifth wheel coupling includes a connecting angular velocity and a connecting angle.
10. The optimal lane keeping assistance method according to claim 6 , wherein the articulated vehicle is a full trailer vehicle or a semi-trailer vehicle.
11. An articulated vehicle comprising the optimal lane keeping assistance device according to claim 1 .
12. A non-transitory 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 6 , when the computer program is executed on a computer.