The present disclosure relates to a control device for a combination vehicle.
Conventionally, there is a combination vehicle in which a trailer is combined with a vehicle serving as a tractor. Steering of the combination vehicle is more difficult than steering of a single vehicle such as an ordinary-sized passenger car. In particular, when the combination vehicle is moved in reverse, the required steering operation is opposite to the steering operation to be performed when a single vehicle without a trailer connected thereto is moved in reverse. When the combination vehicle is moved in reverse, it is necessary to apply brakes, for example, to stabilize the combination of the vehicle and the trailer before a so-called jackknife phenomenon occurs. The jackknife phenomenon refers to a phenomenon in which the connection portion between the vehicle and the trailer bends significantly when the combination vehicle is moved in reverse.
For example, a reverse assist system of Patent Document 1 limits a hitch angle. The hitch angle is an angle between a central axis extending in a longitudinal direction of the vehicle and a central axis extending in a longitudinal direction of the trailer. The reverse assist system calculates a first hitch limit angle based on a desired trailer curvature selected through an operation on a knob. A user of the vehicle can set a second limit angle within the first hitch limit angle. The user of the vehicle can select either the first limit angle or the second limit angle. The reverse assist system causes a display device to display the first limit angle or the second limit angle selected by the user of the vehicle.
In the reverse assist system that limits the hitch angle as in Patent Document 1, the following concerns arise. That is, a response delay occurs in the hitch angle due to physical constraints on the combination vehicle, etc. For example, when the trailer curvature set through the operation on the knob changes suddenly, there is a possibility that the hitch angle cannot respond appropriately to the sudden change in the trailer curvature. This may cause the jackknife phenomenon. There is a demand that the control device for the combination vehicle more appropriately suppress the occurrence of the jackknife phenomenon and therefore achieve more appropriate vehicle behavior.
A control device for a combination vehicle according to one aspect of the present disclosure is configured to control a combination vehicle including a tractor including a steered wheel that is a wheel configured to change a direction of travel of the vehicle, and a trailer towed by the tractor. The control device for the combination vehicle includes a control unit configured to, when a reverse operation of the combination vehicle is performed, assist a reverse operation of the trailer by causing a controlled variable to follow a target value of reverse control that is set through a specific operation by an operator. The control unit is configured to execute a process of limiting the target value and a process of limiting a time rate of change in the target value from a viewpoint of achieving appropriate vehicle behavior.
A control device for a combination vehicle according to a first embodiment will be described.
As shown in
Although the trailer 12 has various shapes and sizes depending on applications, a box-shaped trailer is herein taken as an example. The trailer 12 includes wheels 12R. The wheels 12R include two wheels, namely a right wheel and a left wheel.
The trailer 12 is connected to the rear of the tractor 11 via a ball joint 13. The ball joint 13 includes a hitch ball 14 and a hitch coupler 15. The hitch ball 14 is provided at the rear of the tractor 11 via a hitch member. The hitch coupler 15 is provided at the tip of a tongue 16 that protrudes from the front of the trailer 12. When the hitch coupler 15 is attached to the hitch ball 14, the trailer 12 is connected to the tractor 11 so as to be rotatable about an axis 17. The axis 17 extends in a height direction of the tractor 11.
As shown in
The power steering device 30 is a system for assisting an operator in steering the steering wheel, and includes a motor 30A, a torque sensor 30B, a steering angle sensor 30C, and a steering control device 30D. The operator includes a driver who drives the combination vehicle 10 in the vehicle cabin of the tractor 11.
The motor 30A generates an assist force. The assist force is a force for assisting steering by the steering wheel. The torque of the motor 30A is applied to the steering mechanism of the front wheels 11F via a speed reduction mechanism. The torque sensor 30B detects a steering torque τstr that is a torque applied to the steering wheel. The steering angle sensor 30C detects a steering angle α1 that is a turning angle of the front wheels 11F based on, for example, a rotation angle of the motor 30A. The front wheels 11F and the motor 30A operate in conjunction with each other via the steering mechanism. Therefore, there is a correlation between the rotation angle of the motor 30A and the steering angle α1 of the front wheels 11F. Thus, the steering angle α1 of the front wheel 11F can be determined based on the rotation angle of the motor 30A.
The steering control device 30D executes assist control when the reverse assist function of the combination vehicle 10 is off. That is, the steering control device 30D controls energization of the motor 30A based on the steering torque τstr detected by the torque sensor 30B to cause the motor 30A to generate an assist force according to the steering torque τstr.
The steering control device 30D executes steering control on the front wheels 11F when the reverse assist function of the combination vehicle 10 is on. That is, when the reverse assist function of the combination vehicle 10 is on, the steering control device 30D controls the steering angle α1 of the front wheels 11F by controlling the rotation angle of the motor 30A based on a target steering angle α1* generated by the reverse assist device 40. The target steering angle α1* is a target value of the steering angle α1 of the front wheel 11F. The steering control device 30D controls the operation of the motor 30A by executing feedback control on the steering angle α1 of the front wheels 11F detected by the steering angle sensor 30C so that the steering angle α1 agrees with the target steering angle α1*.
The reverse assist device 40 assists the reverse operation of the combination vehicle 10 when the reverse assist function of the combination vehicle 10 is on. The reverse assist device 40 calculates the target steering angle α1* of the front wheels 11F based on a reverse direction or a reverse route of the combination vehicle 10 specified by the operator and the steering angle α1 of the front wheels 11F detected by the steering angle sensor 30C. The target steering angle α1* is a target value of the steering angle α1 of the front wheels 11F required for the combination vehicle 10 to move in the reverse direction or along the reverse route of the combination vehicle 10 specified by the operator. When the reverse assist function of the combination vehicle 10 is off, the reverse assist device 40 does not calculate the target steering angle α1*.
Next, the reverse assist device 40 will be described in detail.
As shown in
The input device 41 includes a dial 41A as an operation member. The dial 41A is provided, for example, on a center console in the vehicle cabin. The dial 41A is operated by the operator when specifying the reverse direction or the reverse route of the combination vehicle 10. The reverse direction or the reverse route includes, for example, a reverse left turn, a reverse right turn, and a straight reverse movement. When the combination vehicle 10 is turned to the left in reverse, the dial 41A is operated counterclockwise with respect to a reference position corresponding to a straight route. When the combination vehicle 10 is turned to the right in reverse, the dial 41A is operated clockwise with respect to the reference position. When the combination vehicle 10 is moved straight in reverse, the dial 41A is maintained at the reference position. The input device 41 generates an electric signal S1 according to the operation amount or the operation position of the dial 41A with respect to the reference position.
The control device 42 includes a processing circuit including any one of the following three components A1, A2, A3.
The control device 42 executes the reverse assist control for the combination vehicle 10. The control device 42 starts executing the reverse assist control when the operator performs an operation to start the reverse assist control. The control device 42 stops executing the reverse assist control when the operator performs an operation to end the reverse assist control. The operator performs the operations to start and end the reverse assist control via the display device 20. When the assist start button 21A displayed on the screen 21 of the display device 20 is touched, the control device 42 starts executing the reverse assist control. When the assist end button 21B displayed on the screen 21 of the display device 20 is touched, the control device 42 ends the execution of the reverse assist control.
During the execution of the reverse assist control, the control device 42 controls the reverse route of the combination vehicle 10 via the power steering device 30 so that the combination vehicle 10 moves in the reverse direction or along the reverse route of the combination vehicle 10 specified by the operator.
The control device 42 includes a setting unit 42A and a control unit 42B. The setting unit 42A sets a target virtual steering angle α2* of the trailer 12 based on the electric signal S1 generated by the input device 41, that is, the operation amount or the operation position of the dial 41A with respect to the reference position. The target virtual steering angle α2* is a target value of a virtual steering angle α2 of the trailer 12. The virtual steering angle α2 refers to an apparent steering angle when the trailer 12 is virtually separated from the tractor 11 and regarded as a single vehicle including virtual front wheels. The setting unit 42A calculates the target virtual steering angle α2* corresponding to the operation amount or the operation position of the dial 41A, for example, using a map that defines the relationship between the operation amount or the operation position of the dial 41A and the target virtual steering angle α2* of the trailer 12. The operator can specify the target virtual steering angle α2* according to a desired reverse route for reversing the trailer 12 by operating the dial 41A.
The control unit 42B acquires the target virtual steering angle α2* set by the setting unit 42A, a hitch angle β detected by an in-vehicle hitch angle sensor 51, a vehicle speed V detected by an in-vehicle vehicle speed sensor 52, and the steering angle α1 detected by the steering angle sensor 30C. The hitch angle β refers to an angle between a central axis extending in a longitudinal direction of the tractor 11 and a central axis extending in a longitudinal direction of the trailer 12. The hitch angle β is also referred to as a bending angle of the trailer 12.
The control unit 42B calculates the target steering angle α1* of the front wheels 11F of the tractor 11 based on the target virtual steering angle α2* set by the setting unit 42A and the hitch angle β, the vehicle speed V, and the steering angle α1 detected by the sensors. The control unit 42B calculates the target steering angle α1* of the front wheels 11F so that the virtual steering angle α2 of the trailer 12 converges to the target virtual steering angle α2*. That is, the control unit 42B calculates the target steering angle α1* of the front wheels 11F by executing feedback control on the virtual steering angle α2 of the trailer 12 so that the virtual steering angle α2 agrees with the target virtual steering angle α2*. The control unit 42B may calculate the target steering angle α1* using, for example, nonlinear model predictive control (NMPC).
Next, a kinematic model indicating the behavior of the combination vehicle 10 moving in a plane will be described.
As shown in
In the kinematic model of
As shown in
The virtual steering angle α2 of the trailer 12 is represented by the following expression 1. The expression 1 is an equation of motion for the virtual steering angle α2.
where “β” is the hitch angle, “l1” is the wheelbase of the tractor 11, “h1” is the distance between the rear wheel 11R of the tractor 11 and the hitch point C1, “α1” is the steering angle of the front wheel 11F of the tractor 11, and “a tan” is an abbreviation of “arctan” and represents an arctangent function.
The control device 42 has a function of suppressing the occurrence of a jackknife phenomenon. The jackknife phenomenon refers to a phenomenon in which the connection portion between the tractor 11 and the trailer 12 bends significantly when the combination vehicle 10 is moved in reverse.
The control unit 42B starts executing a jackknife suppression process, for example, when the operator performs an operation to start the reverse assist control, that is, when the assist start button 21A displayed on the screen 21 of the display device 20 is touched. The jackknife suppression process is a process for suppressing the occurrence of the jackknife phenomenon. The control unit 42B may start executing the jackknife suppression process when the shift range of a transmission mounted on the tractor 11 is switched to a reverse position. The control unit 42B executes the jackknife suppression process according to a program stored in the storage device of the control unit 42B that is not shown.
As shown in a flowchart of
The control unit 42B calculates the target virtual steering angle α2*, for example, based on the electric signal S1 generated by the input device 41, that is, the operation amount or the operation position of the dial 41A with respect to the reference position. The control unit 42B calculates the target virtual steering angle α2* corresponding to the operation amount or the operation position of the dial 41A, for example, using the map that defines the relationship between the operation amount or the operation position of the dial 41A and the target virtual steering angle α2*.
The control unit 42B calculates a jackknife hitch angle βjk (step S102). The jackknife hitch angle βjk is a boundary value of the hitch angle β as to whether the jackknife phenomenon occurs. The jackknife hitch angle βjk is physically defined as a hitch angle β when the value of a hitch angle velocity β(⋅) that is a time rate of change in the hitch angle β is “0” at a maximum steering angle α1mx of the front wheel 11F of the tractor 11. The symbol “⋅” represents a time derivative. The maximum steering angle α1mx is the maximum value of the steering angle α1 of the front wheel 11F of the tractor 11 that can be taken physically.
The equation of motion for the hitch angle velocity β(⋅) is represented by the following expression 2.
where “l1” is the wheelbase of the tractor 11, “l2” is the virtual wheelbase of the trailer 12, “VB1” is the velocity vector of the rear wheel 11R of the tractor 11, “h1” is the distance between the rear wheel 11R of the tractor 11 and the hitch point C1, and “α1” is the steering angle of the front wheel 11F of the tractor 11.
The control unit 42B substitutes the maximum steering angle α1mx for the steering angle α1 and substitutes “0” for the hitch angle velocity β(⋅) in the expression 2. Then, the control unit 42B obtains the jackknife hitch angle βjk by solving the expression 2 for the hitch angle β.
The control unit 42B calculates an angle limit value α2mx for the target virtual steering angle α2* based on the jackknife hitch angle βjk calculated in step S102 (step S103). The control unit 42B calculates the angle limit value α2mx using the following expression 3. The expression 3 is obtained by substituting the jackknife hitch angle βjk for the hitch angle β and substituting the maximum steering angle α1mx for the steering angle α1 in the above expression 1 that is the equation of motion for the virtual steering angle α2.
where “βjk” is the jackknife hitch angle, “l1” is the wheelbase of the tractor 11, “h1” is the distance between the rear wheel 11R of the tractor 11 and the hitch point C1, and “α1mx” is the maximum steering angle of the front wheel 11F of the tractor 11.
Next, the control unit 42B determines whether the absolute value of the target virtual steering angle α2* is smaller than the absolute value of the angle limit value α2mx (step S104).
When the absolute value of the target virtual steering angle α2* calculated in step S101 is not smaller than the absolute value of the angle limit value α2mx (NO in step S104), the control unit 42B advances the process to step S105.
In step S105, the control unit 42B limits the target virtual steering angle α2* calculated in step S101 to the angle limit value α2mx. The control unit 42B holds the target virtual steering angle α2* limited to the angle limit value α2m as a final target virtual steering angle α2* to be used for controlling the behavior of the combination vehicle 10.
When the absolute value of the target virtual steering angle α2* calculated in step S101 is smaller than the absolute value of the angle limit value α2mx (YES in step S104), the target virtual steering angle α2* calculated in step S101 is held as the final target virtual steering angle α2* to be used for controlling the behavior of the combination vehicle 10.
Next, the control unit 42B calculates a velocity limit value α2mx(⋅) for a target virtual steering angle velocity α2*(⋅) (step S106). The target virtual steering angle velocity α2*(⋅) is a time rate of change in the target virtual steering angle α2*. The target virtual steering angle velocity α2*(⋅) is obtained by differentiating the target virtual steering angle α2* in terms of time.
A virtual steering angle velocity α2(⋅) is represented by the following expression 4. The expression 4 is an equation of motion for the virtual steering angle velocity α2(⋅).
where “β(⋅)” is the hitch angle velocity. The hitch angle velocity β(⋅) can be calculated using the above expression 2. The symbol “α1” is the steering angle of the front wheel 11F of the tractor 11, “l1” is the wheelbase of the tractor 11, “h1” is the distance between the rear wheel 11R of the tractor 11 and the hitch point C1, and “α1(⋅)” is the steering angle velocity of the front wheel 11F of the tractor 11.
The velocity limit value α2mx(⋅) for the target virtual steering angle velocity α2*(⋅) is obtained by substituting a maximum steering speed α1mx(⋅) of the front wheel 11F for the steering angle velocity α1(⋅) in the second term on the right side of the expression 4.
When the value of the steering angle α1 does not change, the second term on the right side of the expression 4 may be calculated as “0”. The situation in which the value of the steering angle α1 does not change includes, for example, a case where the front wheel 11F is kept at a limit position of its physical movable range, or a case where the value of the steering angle α1 that corresponds to a straightforward state of the combination vehicle 10 is “0”.
Next, the control unit 42B determines whether the absolute value of the target virtual steering angle velocity α2*( ) is smaller than the absolute value of the velocity limit value α2mx(⋅) (step S107).
When the absolute value of the target virtual steering angle velocity α2*(⋅) is not smaller than the absolute value of the velocity limit value α2mx(⋅) (NO in step S107), the control unit 42B advances the process to step S108.
In step S108, the control unit 42B limits the target virtual steering angle velocity α2*(⋅) that is based on the target virtual steering angle α2* calculated in step S101 to the velocity limit value α2mx(⋅). The control unit 42B holds the target virtual steering angle velocity α2*(⋅) limited to the velocity limit value α2mx(⋅) as a final target virtual steering angle velocity α2*(⋅) to be used for controlling the behavior of the combination vehicle 10.
When the absolute value of the target virtual steering angle velocity α2*(⋅) is smaller than the absolute value of the velocity limit value α2mx(⋅) (YES in step S107), the control unit 42B holds the target virtual steering angle velocity α2*(⋅) that is based on the target virtual steering angle α2* calculated in step S101 as the final target virtual steering angle velocity α2*(⋅) to be used for controlling the behavior of the combination vehicle 10.
The control unit 42B controls the behavior of the combination vehicle 10 using the final target virtual steering angle α2* and the final target virtual steering angle velocity α2*(⋅) that are control target values (step S109).
Next, an example of the behavior of the target virtual steering angle α2* that is the control target value will be described.
First, a comparative example in which the target virtual steering angle α2* and the target virtual steering angle velocity α2*(⋅) are not limited will be discussed. In the comparative example, when a target virtual steering angle α2* exceeding the absolute value of the angle limit value α2mx is set through the operation on the dial 41A, the target virtual steering angle α2* changes, for example, as follows.
As indicated by a characteristic line L1 in a graph of
Next, the present embodiment in which the target virtual steering angle α2* and the target virtual steering angle velocity α2*(⋅) are limited will be discussed. In the present embodiment, when a target virtual steering angle α2* exceeding the absolute value of the angle limit value α2mx is set through the operation on the dial 41A, the target virtual steering angle α2* changes as follows.
As indicated by a characteristic line L2 in the graph of
Next, functions of the first embodiment will be described.
For example, the combination vehicle 10 turns to the right in reverse and then turns to the left in reverse. The turning radius of the reverse right turn is the same as the turning radius of the reverse left turn. When turning, a target steering angle α1* exceeding the maximum steering angle α1mx that is the limit value of the physical movable range of the front wheel 11F of the tractor 11 is set through the operation on the dial 41A.
As shown in
After the combination vehicle 10 finishes the reverse right turn, the combination vehicle 10 then starts the reverse left turn (time t11). The steering angle α1 starts to increase again in the positive direction from the constant positive value smaller than the absolute value of the maximum steering angle α1mx. This is caused by, for example, a response delay in the steering angle α1 due to physical constraints on the combination vehicle 10. After the steering angle α1 reaches the maximum steering angle α1mx, the steering angle α1 then decreases in the negative direction and is kept at a constant negative value.
In the comparative example in which the target virtual steering angle velocity α2*(⋅) is not limited, the virtual steering angle α2 changes as follows.
As shown in
After the combination vehicle 10 finishes the reverse right turn, the combination vehicle 10 then starts the reverse left turn (time t11). The virtual steering angle α2 gradually decreases in the negative direction from the positive target virtual steering angle α2*. After the virtual steering angle α2 exceeds the negative target virtual steering angle α2* in the negative direction, the virtual steering angle α2 then reverses in the positive direction and eventually reaches the negative target virtual steering angle α2*. After the virtual steering angle α2 reaches the negative target virtual steering angle α2*, the virtual steering angle α2 is kept at the negative target virtual steering angle α2*.
As shown in
In the first embodiment in which the target virtual steering angle velocity α2*(⋅) is limited, the steering angle α1 and the virtual steering angle α2 change as follows. The preconditions such as the turning direction of the combination vehicle 10 and the amount of operation on the dial 41A are the same as those in the comparative example. That is, the combination vehicle 10 turns to the right in reverse and then turns to the left in reverse. The turning radius of the reverse right turn is the same as the turning radius of the reverse left turn. When turning, a target steering angle α1* exceeding the maximum steering angle α1mx that is the limit value of the physical movable range of the front wheel 11F of the tractor 11 is set through the operation on the dial 41A.
As shown in
After the combination vehicle 10 finishes the reverse right turn, the combination vehicle 10 then starts the reverse left turn (time t11). The virtual steering angle α2 gradually decreases in the negative direction from the positive target virtual steering angle α2*, and eventually reaches the negative target virtual steering angle α2*. Unlike the comparative example shown in
The first embodiment has the following effects.
The control device 42 calculates the angle limit value α2mx by substituting the value of the jackknife hitch angle βjk and the value of the maximum steering angle α1mx into the equation of motion for the virtual steering angle α2. The angle limit value α2mx is the limit value for the target virtual steering angle α2*. The equation of motion for the virtual steering angle α2 is the above expression 1. The angle limit value α2mx is obtained by substituting the value of the jackknife hitch angle βjk for the hitch angle β and the value of the maximum steering angle α1mx for the steering angle α1 in the expression 1.
The control device 42 calculates the velocity limit value α2mx(⋅) by substituting the value of the hitch angle velocity β(⋅) and the value of the maximum steering angle velocity α1mx(⋅) into the equation of motion for the virtual steering angle velocity α2(⋅). The velocity limit value α2mx(⋅) is the limit value for the target virtual steering angle velocity α2*(⋅). The equation of motion for the virtual steering angle velocity α2(⋅) is the above expression 4. The velocity limit value α2mx(⋅) is obtained by substituting the value of the hitch angle velocity β(⋅) obtained from the expression 2 for the hitch angle velocity β(⋅) in the expression 4 and substituting the value of the maximum steering speed α1mx(⋅) for the steering angle velocity α1(⋅).
Next, a second embodiment of the control device for the combination vehicle will be described. The present embodiment basically has the same configuration as the first embodiment shown in
The control device 42 includes the setting unit 42A and the control unit 42B.
The setting unit 42A sets a target hitch angle β* of the trailer 12 based on the electric signal S1 generated by the input device 41, that is, the operation amount or the operation position of the dial 41A with respect to the reference position. The target hitch angle β* is a target value of the hitch angle β of the trailer 12. The setting unit 42A calculates the target hitch angle β* corresponding to the operation amount or the operation position of the dial 41A, for example, using a map that defines the relationship between the operation amount or the operation position of the dial 41A and the target hitch angle β* of the trailer 12. The operator can specify the target hitch angle β* according to a desired reverse route for reversing the trailer 12 by operating the dial 41A.
The control unit 42B acquires the target hitch angle β* set by the setting unit 42A, the hitch angle β detected by the hitch angle sensor 51, the vehicle speed V detected by the vehicle speed sensor 52, and the steering angle α1 detected by the steering angle sensor 30C.
The control unit 42B calculates the target steering angle α1* of the front wheels 11F of the tractor 11 based on the target hitch angle β set by the setting unit 42A and the hitch angle β, the vehicle speed V, and the steering angle α1 detected by the sensors. The control unit 42B calculates the target steering angle α1* of the front wheels 11F so that the hitch angle β of the trailer 12 converges to the target hitch angle β*. That is, the control unit 42B calculates the target steering angle α1* of the front wheels 11F by executing feedback control on the hitch angle β of the trailer 12 so that the hitch angle β agrees with the target hitch angle β*.
Next, the procedure of the jackknife suppression process will be described.
As shown in a flowchart of
The control unit 42B calculates the target hitch angle β*, for example, based on the electric signal S1 generated by the input device 41, that is, the operation amount or the operation position of the dial 41A with respect to the reference position. The control unit 42B calculates the target hitch angle β* corresponding to the operation amount or the operation position of the dial 41A, for example, using a map that defines the relationship between the operation amount or the operation position of the dial 41A and the target hitch angle β*.
The control unit 42B calculates the jackknife hitch angle βjk (step S202). The jackknife hitch angle βjk is a boundary value of the hitch angle β as to whether the jackknife phenomenon occurs. The jackknife hitch angle βjk is physically defined as a hitch angle β when the value of the hitch angle velocity β(⋅) that is the time rate of change in the hitch angle β is “0” at the maximum steering angle α1mx of the front wheel 11F of the tractor 11. The symbol “.” represents a time derivative. The maximum steering angle α1mx is the maximum value of the steering angle α1 of the front wheel 11F of the tractor 11 that can be taken physically.
The equation of motion for the hitch angle velocity β(⋅) is represented by the above expression 2. The control unit 42B substitutes the maximum steering angle α1mx for the steering angle α1 and substitutes “0” for the hitch angle velocity β(⋅) in the expression 2. Then, the control unit 42B obtains the jackknife hitch angle βjk by solving the expression 2 for the hitch angle β.
The control unit 42B calculates an angle limit value βmx for the target hitch angle β* based on the jackknife hitch angle βjk calculated in step S202 (step S203). The angle limit value βmx includes an upper limit value +βjk that is a positive angle limit value, and a lower limit value −βjk that is a negative angle limit value. That is, the jackknife hitch angle βjk is set as the angle limit value βmx.
Next, the control unit 42B determines whether the absolute value of the target hitch angle β* is smaller than the absolute value of the angle limit value βmx (step S204).
When the absolute value of the target hitch angle β* calculated in step S201 is not smaller than the absolute value of the angle limit value βmx (NO in step S204), the control unit 42B advances the process to step S205.
In step S205, the control unit 42B limits the target hitch angle β calculated in step S201 to the angle limit value βmx. The control unit 42B holds the target hitch angle β* limited to the angle limit value βmx as a final target hitch angle β* to be used for controlling the behavior of the combination vehicle 10.
When the absolute value of the target hitch angle β* calculated in step S201 is smaller than the absolute value of the angle limit value βmx (YES in step S204), the value of the target hitch angle β* calculated in step S201 is held as the final target hitch angle β* to be used for controlling the behavior of the combination vehicle 10.
Next, the control unit 42B calculates a velocity limit value βmx(⋅) for a target hitch angle velocity β*(⋅) (step S206). The target hitch angle velocity β*(⋅) is a time rate of change in the target hitch angle β*.
The equation of motion for the hitch angle velocity β(⋅) is represented by the above expression 2. From the viewpoint of limiting the hitch angle velocity β(⋅) to reduce the steering speed of the front wheel 11F of the tractor 11, the value of “tan α1” in the second term on the right side of the expression 2 including the steering angle α1 is limited. There is a correlation between the hitch angle velocity β(⋅) and the steering speed of the front wheel 11F.
When “α1>0”, “tan(α1′)” at the next time has the relationship shown in the following expression 5.
where “α1mx” is the maximum steering angle of the front wheel 11F of the tractor 11, and “α1mx(⋅)” is the maximum steering angle velocity that is a time rate of change in the maximum steering angle α1mx. The maximum steering angle velocity α1mx(⋅) is obtained by differentiating the maximum steering angle α1mx of the front wheel 11F in terms of time. The symbol “α1mx(⋅)*dt” is the maximum change amount of the steering angle α1 during a unit time dt. The unit time is an infinitesimal time, and is, for example, the calculation cycle of the control unit 42B. The symbol “*” represents multiplication, and “α1+α1mx(⋅)*dt” is the maximum steering angle α1 that may change from the current steering angle α1 during the unit time dt, and is determined by the maximum steering speed α1mx(⋅) of the front wheel 11F.
The second or third term of the expression 5 is used as a constraint on “tan α1”. The third term of the expression 5 is a stronger constraint than the second term. By substituting the second or third term of the expression 5 into the above expression 2, the velocity limit value βmx(⋅) for the target hitch angle velocity β*(⋅) is obtained.
Next, the control unit 42B determines whether the absolute value of the target hitch angle velocity β*(⋅) is smaller than the absolute value of the velocity limit value βmx(⋅) (step S207).
The target hitch angle velocity β*(⋅) is obtained by substituting the value of the target hitch angle β* calculated in step S201 into the above expression 2.
When the absolute value of the target hitch angle velocity β*(⋅) is not smaller than the absolute value of the velocity limit value βmx(⋅) (NO in step S207), the control unit 42B advances the process to step S108.
In step S208, the control unit 42B limits the target hitch angle velocity β*(⋅) that is based on the target hitch angle β* calculated in step S201 to the velocity limit value βmx(⋅). The control unit 42B holds the target hitch angle velocity β*(⋅) limited to the velocity limit value βmx(⋅) as a final target hitch angle velocity β*(⋅) to be used for controlling the behavior of the combination vehicle 10.
When the absolute value of the target hitch angle velocity β*(⋅) is smaller than the absolute value of the velocity limit value βmx(⋅) (YES in step S207), the control unit 42B holds the target hitch angle velocity β*(⋅) that is based on the target hitch angle β* calculated in step S201 as the final target hitch angle velocity β*(⋅) to be used for controlling the behavior of the combination vehicle 10.
The control unit 42B controls the behavior of the combination vehicle 10 using the final target hitch angle β* and the final target hitch angle velocity β*(⋅) that are control target values (step S209).
Next, an example of the behavior of the target hitch angle β* that is the control target value will be described.
A comparative example in which the target hitch angle β* and the target hitch angle velocity β*(⋅) are not limited will be discussed. In the comparative example, when a target hitch angle β* exceeding the absolute value of the angle limit value βmx is set through the operation on the dial 41A, the target hitch angle β* changes, for example, as follows.
As indicated by the characteristic line L1 in the graph of
The present embodiment in which the target hitch angle β* and the target hitch angle velocity β*(⋅) are limited will be discussed. In the present embodiment, when a target hitch angle β* exceeding the absolute value of the angle limit value βmx is set through the operation on the dial 41A, the target hitch angle β* changes as follows.
As indicated by the characteristic line L2 in the graph of
Next, functions of the second embodiment will be described.
For example, the combination vehicle 10 turns to the right in reverse and then turns to the left in reverse. The turning radius of the reverse right turn is the same as the turning radius of the reverse left turn. When turning, a target steering angle α1* exceeding the maximum steering angle α1mx that is the limit value of the physical movable range of the front wheel 11F of the tractor 11 is set through the operation on the dial 41A.
As shown in
After the combination vehicle 10 finishes the reverse right turn, the combination vehicle 10 then starts the reverse left turn (time t11). The steering angle α1 starts to increase again in the positive direction from the constant positive value smaller than the absolute value of the maximum steering angle α1mx. This is caused by, for example, a response delay in the steering angle α1 due to physical constraints on the combination vehicle 10. After the steering angle α1 reaches the maximum steering angle α1mx, the steering angle α1 then decreases in the negative direction and is kept at a constant negative value.
In the comparative example in which the target hitch angle velocity β*(⋅) is not limited, the hitch angle β changes as follows.
As shown in
After the combination vehicle 10 finishes the reverse right turn, the combination vehicle 10 then starts the reverse left turn (time t11). The hitch angle β gradually increases in the positive direction from the negative target hitch angle β*. After the hitch angle β exceeds the positive target hitch angle β* in the positive direction, the hitch angle β then changes in the negative direction and eventually reaches the positive target hitch angle β*. After the hitch angle β reaches the positive target hitch angle β*, the hitch angle β is kept at the positive target hitch angle β*.
As shown in
Next, the present embodiment in which the target hitch angle velocity β*(⋅) is limited will be discussed. In the present embodiment, the steering angle α1 and the hitch angle β change as follows. The preconditions such as the turning direction of the combination vehicle 10 and the amount of operation on the dial 41A are the same as those in the comparative example. That is, the combination vehicle 10 turns to the right in reverse and then turns to the left in reverse. The turning radius of the reverse right turn is the same as the turning radius of the reverse left turn. When turning, a target steering angle α1* exceeding the maximum steering angle α1mx that is the limit value of the physical movable range of the front wheel 11F of the tractor 11 is set through the operation on the dial 41A.
As shown in
After the combination vehicle 10 finishes the reverse right turn, the combination vehicle 10 then starts the reverse left turn (time t11). The hitch angle β gradually increases in the positive direction from the negative target hitch angle β* and eventually reaches the positive target hitch angle β*. Unlike the comparative example shown in
The second embodiment has the following effects.
The control device 42 calculates the jackknife hitch angle βjk by substituting zero for the value of the hitch angle velocity β(⋅) and the maximum steering angle α1mx for the value of the steering angle α1 of the front wheel 11F in the equation of motion for the hitch angle velocity β(⋅) and solving the equation of motion after the substitution in terms of the hitch angle β. The equation of motion for the hitch angle velocity β(⋅) is the above expression 2. The control device 42 sets the jackknife hitch angle βjk as the angle limit value βmx that is the limit value for the target hitch angle β*.
The control device 42 calculates the velocity limit value βmx(⋅) by substituting the value of the maximum steering angle α1mx of the front wheel 11F that can be taken physically or the value of the maximum steering angle α1 of the front wheel 11F that may change from the current steering angle α1 during the unit time dt into the equation of motion for the hitch angle velocity β(⋅). The velocity limit value βmx(⋅) is the limit value for the time rate of change in the target hitch angle β*. The equation of motion for the hitch angle velocity β(⋅) is the above expression 2. By substituting the second or third term of the expression 5 for “tan α1” in the expression 2, the velocity limit value βmx(⋅) is obtained. The substitution of the second term of the expression 5 for “tan α1” in the expression 2 is equivalent to substitution of the maximum steering angle α1 that may change from the current steering angle α1 during the unit time dt (=α1+α1mx(⋅)*dt) for “α1” in the expression 2. The substitution of the third term of the expression 5 for “tan α1” in the expression 2 is equivalent to substitution of the maximum steering angle α1mx of the front wheel 11F that can be taken physically for “α1” in the expression 2.
The first and second embodiments may be modified as follows.
The control device 42 may display the limit value for the control target value on the screen of the display device 20. In the first embodiment, the control device 42 causes the screen of the display device 20 to numerically display the angle limit value α2mx that is the limit value for the target virtual steering angle α2*. In the second embodiment, the control device 42 causes the screen of the display device 20 to numerically display the angle limit value βmx for the target hitch angle β*.
In the first embodiment, the control device 42 may cause the screen of the display device 20 to visually display the range in which the target virtual steering angle α2* is limited. For example, the angle range in which the target virtual steering angle α2* is limited is visually displayed using two straight lines provided at the hitch point C1 as the center therebetween. In the second embodiment, the control device 42 may cause the screen of the display device 20 to display the range in which the target hitch angle β* is limited. For example, the angle range in which the target hitch angle β* is limited is visually displayed using two straight lines provided at the hitch point C1 as the center therebetween.
The control device 42 may cause the screen of the display device 20 to display, for example, a trailer model regarded as a single vehicle including virtual front wheels. The control device 42 shifts the virtual front wheels of the trailer model in response to changes in the virtual steering angle α2.
Number | Date | Country | Kind |
---|---|---|---|
2022-029269 | Feb 2022 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2023/004005 | 2/7/2023 | WO |