The disclosure of Japanese Patent Application No. 2017-229229 filed on Nov. 29, 2017, including the specification, drawings and abstract, is incorporated herein by reference in its entirety.
The invention relates generally to vehicle steering systems. More particularly, the invention relates to a vehicle steering system that effects automatic steering control for automatic steering angle control and manual steering control (i.e., assist control) for manual steering angle control with a shared electric motor.
Japanese Patent Application Publication No. 2004-256076 (JP 2004-256076 A) discloses a vehicle steering system that effects automatic steering control for automatic steering angle control and manual steering control for manual steering angle control with a shared actuator (i.e., a shared electric motor). In JP 2004-256076 A, a steering torque to be applied to a steering shaft from the actuator (which will hereinafter be referred to as a “target actuator torque Tt”) is represented by Eq. (a):
Tt=Kasst·Tasst+Kauto·Tauto (a)
In Eq. (a), Tasst denotes a target assist torque, Tauto denotes a target steering torque for the automatic steering control (which will hereinafter be referred to as a “target automatic steering torque”), and Kasst and Kauto each denote a weighting factor. The actuator is controlled such that the actuator produces a torque corresponding to the target actuator torque Tt.
During the manual steering control, Kauto is 0, so that Tt=Kasst·Tasst. During the manual steering control, the factor Kasst is set at 1, so that Tt=Tasst. The automatic steering control involves calculating the target actuator torque Tt in accordance with Eq. (a). When no steering operation is performed by a driver during the automatic steering control, the steering torque is 0 and thus the target assist torque Tasst is 0 except at the start and end of the automatic steering control. During the automatic steering control, the factor Kauto is set at 1, so that Tt=Tauto when no steering operation is performed by the driver during the automatic steering control.
In JP 2004-256076 A, detecting a steering intervention during the automatic steering control starts transition control to make a transition from the automatic steering control to the manual steering control. The transition control involves reducing the factor Kauto by a predetermined value K1 and increasing the factor Kasst by a predetermined value K2 each time a predetermined period of time elapses. When the factor Kauto falls below 0, the factor Kauto is fixed at 0. When the factor Kasst exceeds 1, the factor Kasst is fixed at 1. The target actuator torque Tt is calculated using the updated factors Kauto and Kasst. The actuator is controlled such that the actuator produces a torque corresponding to the target actuator torque Tt calculated. Thus, the transition control is terminated when the factor Kauto is 0 and the factor Kasst is 1.
During the transition control described in JP 2004-256076 A, the factor Kauto gradually decreases with respect to time, and the factor Kasst gradually increases with respect to time. The transition control is terminated when the factor Kauto is 0 and the factor Kasst is 1. This suppresses variations in the target actuator torque Tt and thus reduces a sense of incongruity felt by the driver in deactivating the automatic steering control. In JP 2004-256076 A, however, the time between the start and end of the transition control (which will hereinafter be referred to as a “transition control time”) is kept constant at all times. The driver is thus unable to change the transition control time by performing a steering operation. This may make it impossible to quickly perform switching from the automatic steering control to the manual steering control in the event of an emergency, for example.
An object of the invention is to provide a vehicle steering system that is able to change a transition control time in response to a steering operation performed by a driver.
An aspect of the invention provides a vehicle steering system including an electric motor, a setter, an estimator, an automatic steering controller, a manual steering controller, and an automatic steering deactivator. The electric motor provides a steering force to a steering operation mechanism of a vehicle. The setter sets an angle control target torque to cause an angle difference between a target steering angle and an actual steering angle to approach zero. The estimator estimates a road load torque received from a road by an object to be driven by the electric motor. The automatic steering controller sets a target automatic steering torque in accordance with the angle control target torque set by the setter and the road load torque estimated by the estimator. The automatic steering controller controls the electric motor in accordance with the target automatic steering torque so as to exercise automatic steering control. The manual steering controller controls the electric motor in accordance with a target assist torque responsive to a steering torque so as to exercise manual steering control. The automatic steering deactivator makes switching from the automatic steering control to the manual steering control in accordance with a steering operation performed by a driver during the automatic steering control exercised by the automatic steering controller. The automatic steering deactivator includes a transition controller. The transition controller exercises transition control when a transition control start requirement is satisfied. The transition control start requirement includes at least a requirement that an absolute value of the steering torque be equal to or greater than a first predetermined value. The transition controller includes a first controller, a second controller, and a third controller. At a time when the transition control start requirement is satisfied, the first controller saves the angle control target torque set by the setter. The angle control target torque is saved in the form of a transition control start angle control target torque. The second controller calculates a transition control target automatic steering torque in accordance with the transition control start angle control target torque and the road load torque estimated by the estimator. The second controller assigns weights to the transition control target automatic steering torque and the target assist torque using an absolute value of a value responsive to the angle difference so as to calculate a target motor torque. The second controller controls the electric motor in accordance with the target motor torque. When the absolute value of the value responsive to the angle difference is equal to or greater than a second predetermined value, the third controller terminates the transition control so as to make switching from the automatic steering control to the manual steering control.
The foregoing and further features and advantages of the invention will become apparent from the following description of example embodiments with reference to the accompanying drawings, wherein like numerals are used to represent like elements and wherein:
Embodiments of the invention will be described in detail below with reference to the accompanying drawings.
The electric power steering system 1 includes a steering wheel 2, a steering operation mechanism 4, and a steering assist mechanism 5. The steering wheel 2 is a steering member to steer a vehicle. The steering operation mechanism 4 steers steered wheels 3 in response to rotation of the steering wheel 2. The steering assist mechanism 5 assists a driver in steering the vehicle. The steering wheel 2 and the steering operation mechanism 4 are mechanically coupled to each other through a steering shaft 6 and an intermediate shaft 7.
The steering shaft 6 includes: an input shaft 8 coupled to the steering wheel 2; and an output shaft 9 coupled to the intermediate shaft 7. The input shaft 8 and the output shaft 9 are coupled to each other through a torsion bar 10 such that the input shaft 8 and the output shaft 9 are rotatable relative to each other. A torque sensor 12 is disposed adjacent to the torsion bar 10. In accordance with the amount of relative rotational displacement between the input shaft 8 and the output shaft 9, the torque sensor 12 detects a steering torque (torsion bar torque) Td applied to the steering wheel 2. In this embodiment, the steering torque Td detected by the torque sensor 12 includes a torque to steer the vehicle to the left and a torque to steer the vehicle to the right. The torque sensor 12 outputs a positive value upon detecting the torque to steer the vehicle to the left. The torque sensor 12 outputs a negative value upon detecting the torque to steer the vehicle to the right. The greater the absolute value of the positive or negative value, the greater the magnitude of the steering torque Td.
The steering operation mechanism 4 is a rack and pinion mechanism including a pinion shaft 13 and a rack shaft 14 that serves as a steering operation shaft. Each of the steered wheels 3 is coupled to an associated one of the ends of the rack shaft 14 through a tie rod 15 and a steering knuckle arm (not illustrated). The pinion shaft 13 is coupled to the intermediate shaft 7. The pinion shaft 13 rotates in response to a steering operation performed on the steering wheel 2. A pinion 16 is coupled to an end of the pinion shaft 13.
The rack shaft 14 extends linearly in the right-left direction of the vehicle. An axially intermediate portion of the rack shaft 14 is provided with a rack 17 in mesh with the pinion 16. The pinion 16 and the rack 17 convert rotation of the pinion shaft 13 into axial movement of the rack shaft 14. The axial movement of the rack shaft 14 steers the steered wheels 3.
A steering operation performed on the steering wheel 2 rotates the steering wheel 2. The rotation of the steering wheel 2 is transmitted to the pinion shaft 13 through the steering shaft 6 and the intermediate shaft 7 so as to rotate the pinion shaft 13. The rotation of the pinion shaft 13 is converted into axial movement of the rack shaft 14 through the pinion 16 and the rack 17. The axial movement of the rack shaft 14 steers the steered wheels 3. The steering assist mechanism 5 includes an electric motor 18 and a speed reducer 19. The electric motor 18 produces a steering assist force (i.e., an assist torque). The speed reducer 19 amplifies a torque output from the electric motor 18 and transmits the torque to the steering operation mechanism 4. The speed reducer 19 is a worm gear mechanism including a worm gear 20 and a worm wheel 21 in mesh with the worm gear 20. The speed reducer 19 is housed in a gear housing 22 serving as a transmission mechanism housing.
The worm gear 20 is rotated by the electric motor 18. The worm wheel 21 is coupled to the output shaft 9 such that the worm wheel 21 is rotatable together with the output shaft 9. The worm wheel 21 is rotated by the worm gear 20. The rotation of the worm gear 20 caused by the electric motor 18 rotates the worm wheel 21. The rotation of the worm wheel 21 applies a motor torque to the steering shaft 6 and rotates the steering shaft 6 (i.e., the output shaft 9). The rotation of the steering shaft 6 is transmitted to the pinion shaft 13 through the intermediate shaft 7 so as to rotate the pinion shaft 13. The rotation of the pinion shaft 13 is converted into axial movement of the rack shaft 14. The axial movement of the rack shaft 14 steers the steered wheels 3. In other words, rotating the worm gear 20 by the electric motor 18 makes it possible to assist the driver in steering the vehicle and steer the steered wheels 3 by the electric motor 18. The electric motor 18 is provided with a rotation angle sensor 23 to detect the rotation angle of a rotor of the electric motor 18.
Torques to be applied to the output shaft 9 (i.e., an object to be driven by the electric motor 18) include a motor torque produced by the electric motor 18, and a disturbance torque Tlc other than the motor torque. The disturbance torque Tlc includes the steering torque Td and a road load torque (road reaction torque) Trl. The steering torque Td is a torque applied to the output shaft 9 (i.e., the object to be driven by the electric motor 18) from the steering wheel 2 in accordance with, for example, a force applied to the steering wheel 2 by the driver and a force resulting from steering inertia.
The road load torque Trl is a torque applied to the output shaft 9 (i.e., the object to be driven by the electric motor 18) from a road through the steered wheels 3 and the rack shaft 14 in accordance with, for example, a self-aligning torque produced by tire(s), a force produced by a suspension or wheel alignment, and/or a frictional force on the rack and pinion mechanism. The road load torque Trl transmitted to the output shaft 9 from a road is divided by a reduction ratio N of the speed reducer 19 so as to provide a road load torque Trlc. The road load torque Trlc is represented by the following equation:
Trlc=Trl/N.
The vehicle is equipped with: a vehicle speed sensor 24 to detect a vehicle speed V; a charge-coupled device (CCD) camera 25 to capture an image of a road in front of the vehicle traveling forward; a global positioning system (GPS) 26 to detect the position of the vehicle; and a radar 27 to detect a road shape and/or an obstacle. The vehicle is further equipped with: a geographic information memory 28 storing geographic information; and an automatic steering mode switch 29 to activate and deactivate an automatic steering mode.
The CCD camera 25, the GPS 26, the radar 27, the geographic information memory 28, and the automatic steering mode switch 29 are connected to an upper electronic control unit (ECU) 201. The upper ECU 201 exercises automatic assist control and automatic driving control. In accordance with the information obtained by the CCD camera 25, the GPS 26, and the radar 27 and the geographic information stored in the geographic information memory 28, the upper ECU 201 carries out operations, such as surrounding environment identification, vehicle position estimation, and route planning, so as to make decisions on steering and a control target value for a driving actuator. The upper ECU 201 provides an instruction for activation and deactivation of the automatic steering mode in accordance with an input signal from the automatic steering mode switch 29.
In this embodiment, the upper ECU 201 sets a target steering angle θcmda for automatic steering, and generates a mode changing signal (i.e., an automatic steering mode activating signal or an automatic steering mode deactivating signal) responsive to an operation performed on the automatic steering mode switch 29. As used herein, the term “automatic steering control” refers to, for example, “lane keep” control to cause the vehicle to travel along a target path. The lane keep control is a kind of driving assist control. The target steering angle θcmda is a target value for a steering angle to cause the vehicle to automatically travel along a target path. The process of setting the target steering angle θcmda is well known, and thus detailed description thereof will be omitted. As used herein, the term “steering angle” refers to a rotation angle of the output shaft 9.
The target steering angle θcmda set by the upper ECU 201 and the mode changing signal generated by the upper ECU 201 are provided to a motor control electronic control unit (ECU) 202 through a vehicle-mounted network. The motor control ECU 202 receives the steering torque Td detected by the torque sensor 12, a signal output from the rotation angle sensor 23, and the vehicle speed V detected by the vehicle speed sensor 24. In accordance with the signals received and the information provided from the upper ECU 201, the motor control ECU 202 controls the electric motor 18.
Upon receiving the automatic steering mode activating signal from the upper ECU 201, the motor control ECU 202 controls the electric motor 18 in an automatic control mode that involves the automatic steering control. Upon receiving the automatic steering mode deactivating signal from the upper ECU 201, the motor control ECU 202 deactivates the automatic steering control so as to control the electric motor 18 in a manual steering mode (i.e., an assist control mode) that involves manual steering control (i.e., assist control). As used herein, the term “manual steering mode” refers to a control mode that involves causing the electric motor 18 to produce a steering assist force (i.e., an assist torque) to assist the driver in steering the vehicle in accordance with the steering torque Td detected by the torque sensor 12 and the vehicle speed V detected by the vehicle speed sensor 24.
In addition to changing the control mode in accordance with the mode changing signal from the upper ECU 201, the motor control ECU 202 includes the function of changing the control mode from the automatic steering mode to the manual steering mode in the event of an intervening operation resulting from a steering operation performed by the driver during the automatic steering mode. This function may be referred to as an “override function”.
The motor control ECU 202 includes a microcomputer 40, a driving circuit (inverter circuit) 31, and a current detecting circuit 32. The driving circuit 31 is controlled by the microcomputer 40 so as to supply power to the electric motor 18. The current detecting circuit 32 detects a current flowing through the electric motor 18. The current flowing through the electric motor 18 will hereinafter be referred to as a “motor current I”. The microcomputer 40 includes a central processing unit (CPU) and memories, such as a read-only memory (ROM), a random-access memory (RAM), and a nonvolatile memory. The microcomputer 40 executes a predetermined program and thus functions as a plurality of functional processing units. The functional processing units include an assist controller 41, an angle controller 42, a road load estimator 43, a torque subtracter 44, a steering wheel operating condition determiner 45, a target motor torque setter 46, a target motor current calculator 47, a current difference calculator 48, a PI controller 49, a pulse width modulation (PWM) controller 50, a rotation angle calculator 51, and a reduction ratio divider 52.
The rotation angle calculator 51 calculates a rotor rotation angle θm of the electric motor 18 in accordance with a signal output from the rotation angle sensor 23. The reduction ratio divider 52 divides the rotor rotation angle θm, calculated by the rotation angle calculator 51, by the reduction ratio N. The reduction ratio divider 52 thus converts the rotor rotation angle θm into a rotation angle (actual steering angle) θ of the output shaft 9. The assist controller 41 sets a target assist torque Tm, mc that is an assist torque target value (i.e., a motor torque target value during the manual steering mode). The assist controller 41 sets the target assist torque Tm, mc in accordance with the steering torque Td detected by the torque sensor 12 and the vehicle speed V detected by the vehicle speed sensor 24.
The target assist torque Tm, mc assumes a positive value when the steering torque Td assumes a positive value, and assumes a negative value when the steering torque Td assumes a negative value. The target assist torque Tm, mc is set such that the absolute value of the target assist torque Tm, mc increases as the absolute value of the steering torque Td increases. The target assist torque Tm, mc is set such that the absolute value of the target assist torque Tm, mc decreases as the vehicle speed V detected by the vehicle speed sensor 24 increases.
The angle controller 42 sets an angle control target torque Tm, ac necessary for angle control (i.e., steering angle control) in accordance with the target steering angle θcmda provided from the upper ECU 201 and the actual steering angle θ calculated by the reduction ratio divider 52. The angle controller 42 will be described in more detail below. The road load estimator 43 estimates the road load torque Trlc in accordance with the steering torque Td detected by the torque sensor 12, the actual steering angle θ calculated by the reduction ratio divider 52, and a target motor torque Tm set by the target motor torque setter 46. The road load estimator 43 will be described in more detail below.
The torque subtracter 44 subtracts the road load torque Trlc, estimated by the road load estimator 43, from the angle control target torque Tm, ac set by the angle controller 42. The torque subtracter 44 thus calculates a target automatic steering torque Tm, ad. The target automatic steering torque Tm, ad is a motor torque target value during the automatic steering mode. In accordance with the steering torque Td detected by the torque sensor 12 and the actual steering angle θ calculated by the reduction ratio divider 52, the steering wheel operating condition determiner 45 determines whether a steering wheel operating condition is a “hands-on” condition in which the driver is gripping the steering wheel 2 or a “hands-off” condition in which the driver is not gripping the steering wheel 2. The steering wheel operating condition determiner 45 outputs a hands-on/hands-off determining signal indicative of the result of the determination made by the steering wheel operating condition determiner 45. In one example, the steering wheel operating condition determiner disclosed in Japanese Patent Application Publication No. 2017-114324 (JP 2017-114324 A) may be used as the steering wheel operating condition determiner 45. Any other known device that is able to determine whether the steering wheel operating condition is the hands-on condition or the hands-off condition may be used as the steering wheel operating condition determiner 45.
The target motor torque setter (mode changing controller) 46 receives: the target assist torque Tm, mc set by the assist controller 41; the angle control target torque Tm, ac set by the angle controller 42; a target steering angle θcmd (see
The target motor current calculator 47 divides the target motor torque Tm, set by the target motor torque setter 46, by a torque constant Kt of the electric motor 18. The target motor current calculator 47 thus calculates a target motor current Icmd. The current difference calculator 48 calculates a current difference ΔI between the target motor current Icmd calculated by the target motor current calculator 47 and the motor current I detected by the current detecting circuit 32. The current difference ΔI is represented by the following equation: ΔI=Icmd−I.
The PI controller 49 performs a PI calculation (i.e., a proportional-plus-integral calculation) on the current difference ΔI calculated by the current difference calculator 48. The PI controller 49 thus generates a driving command value to cause the motor current I flowing through the electric motor 18 to approach the target motor current Icmd. The PWM controller 50 generates a PWM control signal for a duty ratio responsive to the driving command value, and supplies the PWM control signal to the driving circuit 31. In response to this signal, the driving circuit 31 supplies power responsive to the driving command value to the electric motor 18.
The angle controller 42, the road load estimator 43, and the target motor torque setter 46 will be described in detail below.
The low-pass filter 61 low-pass filters the target steering angle θcmda received from the upper ECU 201 and thus provides a low-pass filtered target steering angle θcmd. The low-pass filtered target steering angle θcmd is provided to the target steering angle changer 62 and the target motor torque setter 46. The target steering angle changer 62 includes a first input terminal P1 and a second input terminal P2. The first input terminal P1 receives the low-pass filtered target steering angle θcmd. The second input terminal P2 receives a return control target steering angle θcmd, rc from the target motor torque setter 46 when the target motor torque setter 46 (or more specifically, an automatic steering deactivating controller 46A) exercises return control (see
The return control will be described below. The target steering angle changer 62 selects and outputs one of the target steering angle θcmd received by the first input terminal P1 and the return control target steering angle θcmd, rc received by the second input terminal P2. Under normal conditions, the target steering angle changer 62 selects the target steering angle θcmd received by the first input terminal P1. The target steering angle changer 62 is controlled by the target motor torque setter 46.
The feedback controller 63 is provided to cause the actual steering angle θ, calculated by the reduction ratio divider 52 (see
The PD controller 63B performs a PD calculation (i.e., a proportional-plus-derivative calculation) on the angle difference Δθ calculated by the angle difference calculator 63A. The PD controller 63B thus calculates a feedback control torque Tfb. The feedback control torque Tfb is provided to the torque adder 65. The feedforward controller 64 is provided to compensate for a response delay, resulting from the inertia of the electric power steering system 1, so as to improve control responsiveness. The feedforward controller 64 includes an angular acceleration calculator 64A and an inertia multiplier 64B. The angular acceleration calculator 64A performs second-order differentiation on the low-pass filtered target steering angle θcmd so as to calculate a target angular acceleration d2θcmd/dt2. The inertia multiplier 64B multiplies the target angular acceleration d2θcmd/dt2, calculated by the angular acceleration calculator 64A, by an inertia J of the electric power steering system 1. The inertia multiplier 64B thus calculates a feedforward torque Tff. The feedforward torque Tff is represented by the following equation: Tff=J·d2θcmd/dt2. In one example, the inertia J is obtained from a physical model of the electric power steering system 1. The feedforward torque Tff is provided to the torque adder 65 in the form of an inertia compensation value.
The torque adder 65 adds the feedforward torque Tff to the feedback control torque Tfb so as to calculate an angle control target steering torque (Tfb+Tff). This provides an angle control target steering torque (i.e., a target torque for the output shaft 9) that compensates for the inertia. Providing such an angle control target steering torque enables high-accuracy motor control (steering angle control).
The angle control target steering torque (Tfb+Tff) is provided to the reduction ratio divider 66. The reduction ratio divider 66 divides the angle control target steering torque (Tfb+Tff) by the reduction ratio N so as to calculate the angle control target torque Tm, ac (i.e., a target torque for the electric motor 18). The angle control target torque Tm, ac is provided to the target motor torque setter 46 (see
The disturbance torque estimator 72 estimates a nonlinear torque produced in the form of a disturbance in a plant (i.e., an object to be controlled or an object to be driven by the electric motor 18). The nonlinear torque is a disturbance torque that is a torque applied to the object to be driven by the electric motor 18 other than the motor torque. The disturbance torque estimator 72 estimates the disturbance torque (disturbance load) Tlc, the steering angle θ, and a steering angle differential value (angular velocity) dθ/dt in accordance with the target steering torque N·Tm (i.e., a target value for the plant) and the actual steering angle θ (i.e., an output from the plant). The estimated values of the disturbance torque Tlc, the steering angle θ, and the steering angle differential value (angular velocity) dθ/dt may hereinafter be respectively denoted by {circumflex over (T)}lc, {circumflex over (θ)}, and d{circumflex over (θ)}/dt.
The subtracter 73 subtracts the steering torque Td, detected by the torque sensor 12, from the disturbance torque Tlc estimated by the disturbance torque estimator 72. The subtracter 73 thus calculates the road load torque Trl to be transmitted to the output shaft 9 (or more specifically, the speed reducer 19). The road load torque Trl is represented by the following equation: Trl=Tlc−Td. The reduction ratio divider 74 divides the road load torque Trl (which has been calculated by the subtracter 73 and is to be transmitted to the output shaft 9) by the reduction ratio N. The reduction ratio divider 74 thus calculates the road load torque Trlc to be transmitted to the shaft of the electric motor 18 through the speed reducer 19. The road load torque Trlc calculated by the reduction ratio divider 74 is provided to the torque subtracter 44 (see
The disturbance torque estimator 72 will be described in detail. The disturbance torque estimator 72 is a disturbance observer to estimate the disturbance torque Tlc, the steering angle θ, and the angular velocity dθ/dt using a physical model of the electric power steering system 1.
The physical model 101 includes a plant 102 that includes the output shaft 9 and the worm wheel 21 secured to the output shaft 9. The plant 102 is an object to be driven by the electric motor 18. The plant 102 receives the steering torque Td from the steering wheel 2 through the torsion bar 10 and receives the road load torque Trl from the steered wheels 3. The plant 102 further receives the target steering torque N·Tm through the worm gear 20.
An equation of motion for the inertia of the physical model 101 is represented as Eq. (1), where J denotes the inertia of the plant 102:
J{umlaut over (θ)}=N·Tm+Tlc
Tlc=Td+Tr1 (1)
d2θ/dt2 denotes an acceleration of the plant 102. N denotes the reduction ratio of the speed reducer 19, and Tlc denotes a disturbance torque that is a torque applied to the plant 102 other than a motor torque. In this embodiment, the disturbance torque Tlc is assumed to mainly include the steering torque Td and the road load torque Trl. In one example, an equation of state for the physical model 101 illustrated in
In Eq. (2), x denotes a state variable vector, u1 denotes a known input vector, u2 denotes an unknown input vector, y denotes an output vector (measured value), A denotes a system matrix, B1 denotes a first input matrix, B2 denotes a second input matrix, C denotes an output matrix, and D denotes a direct matrix.
The equation of state is extended to a system including an unknown input vector u1 in the form of a single state. In one example, an equation of state for the extended system (i.e., an extended equation of state) is represented as Eq. (3):
In Eq. (3), Xe denotes a state variable vector for the extended system and is represented by Eq. (4):
In Eq. (3), Ae denotes a system matrix for the extended system, Be denotes a known input matrix for the extended system, and Ce denotes an output matrix for the extended system. From the extended equation of state, i.e., Eq. (3), a disturbance observer (i.e., an extended state observer) is created. The disturbance observer is represented by Eq. (5):
In Eq. (5), {circumflex over (X)}e denotes an estimated value of Xe, L denotes an observer gain, and ŷ denotes an estimated value of y. {circumflex over (X)}e is represented by Eq. (6):
In Eq. (6), {circumflex over (θ)} denotes an estimated value of θ, and {circumflex over (T)}lc denotes an estimated value of Tlc. The disturbance torque estimator 72 calculates the state variable vector {circumflex over (X)}e in accordance with Eq. (6).
The target steering torque N·Tm calculated by the reduction ratio multiplier 71 (see
The system matrix multiplier 86 multiplies the state variable vector {circumflex over (X)}e by the system matrix Ae. The output matrix multiplier 82 multiplies the state variable vector {circumflex over (X)}e by the output matrix Ce. The first adder 83 subtracts the output (Ce·{circumflex over (X)}e), provided from the output matrix multiplier 82, from the output vector (measured value) y that is the actual steering angle θ calculated by the reduction ratio divider 52 (see
The input matrix multiplier 85 multiplies the input vector u1, output from the input vector receiver 81, by the input matrix Be. The second adder 87 adds up the output (Be·u1) from the input matrix multiplier 85, the output (Ae·{circumflex over (X)}e) from the system matrix multiplier 86, and the output from the gain multiplier 84. The output from the gain multiplier 84 is represented by L(y−ŷ). The second adder 87 thus calculates a state variable vector differential value d{circumflex over (X)}e/dt. The integrator 88 integrates the output (d{circumflex over (X)}e/dt) from the second adder 87 so as to calculate the state variable vector {circumflex over (X)}e. The state variable vector outputter 89 outputs the disturbance torque estimated value Tlc, the steering angle estimated value {circumflex over (θ)}, and the angular velocity estimated value d
Unlike the extended state observer described above, a typical disturbance observer includes a reverse model of a plant and a low-pass filter. An equation of motion for the plant in this case is represented as Eq. (7):
J{umlaut over (θ)}=N·Tm+Tlc (7)
Accordingly, the reverse model of the plant is represented by Eq. (8):
Tlc=J{umlaut over (θ)}−N·Tm (8)
An input to a typical disturbance observer includes J·d2θ/dt2 and Tm and uses a second-order differential value of the actual steering angle θ, so that the input is significantly influenced by noise in the rotation angle sensor 23. In contrast, the extended state observer described in this embodiment estimates a disturbance torque in an integral mode in accordance with the difference (y−ŷ) between the actual steering angle θ and the steering angle estimated value {circumflex over (θ)} estimated from a motor torque input, thus reducing differentiation-induced noise influence.
The target motor torque setter 46 will be described in detail below. When the control mode is the manual steering mode, the target assist torque Tm, mc, set by the assist controller 41, is set to be the target motor torque Tm by the target motor torque setter 46. When the control mode is the automatic steering mode, the target automatic steering torque Tm, ad, calculated by the torque subtracter 44, is set to be the target motor torque Tm by the target motor torque setter 46. The target automatic steering torque Tm, ad is represented by the following equation: Tm, ad=Tm, ac−Trlc.
The target motor torque setter 46 includes the automatic steering deactivating controller 46A (see
Upon determining in step S1 that the transition control start requirement is not satisfied (i.e., when the answer is NO in step S1), the automatic steering deactivating controller 46A performs step S1 again. Upon determining in step S1 that the transition control start requirement is satisfied (i.e., when the answer is YES in step S1), the automatic steering deactivating controller 46A starts the transition control. Specifically, the automatic steering deactivating controller 46A advances the process to step S2. In step S2, the angle control target torque Tm, ac (i.e., an output from the angle controller 42) obtained when the transition control start requirement is determined to be satisfied is saved to a memory in the form of a transition control start angle control target torque Tm, aco by the automatic steering deactivating controller 46A. As used herein, the term “transition control start angle control target torque Tm, aco” refers to an angle control target torque at the start of the transition control. In step S2, the angle difference Δθ obtained when the transition control start requirement is determined to be satisfied is saved to the memory in the form of a transition control start angle difference Δθo by the automatic steering deactivating controller 46A. As used herein, the term “transition control start angle difference Δθo” refers to an angle difference at the start of the transition control.
In step S3, the automatic steering deactivating controller 46A sets a transition control target motor torque Tm in accordance with Eq. (9):
Tm={1−(|Δθtc|/w)}·(Tm,aco−Trlc)+(|Δθtc|/w)·Tm,mc (9)
where Δθtc=Δθ−Δθo
The electric motor 18 is thus controlled such that the electric motor 18 produces a motor torque equal to the transition control target motor torque Tm set in accordance with Eq. (9).
In Eq. (9), w (where w>0) denotes a preset transition angle width. Δθtc denotes a difference between the present angle difference Δθ and the transition control start angle difference Δθo saved to the memory in step S2. The difference Δθtc is an example of a “value Δθx responsive to the angle difference Δθ”. Tm, aco denotes the transition control start angle control target torque saved to the memory in step S2. Trlc denotes the present road load torque estimated by the road load estimator 43. Tm, mc denotes the present target assist torque set by the assist controller 41.
Using Eq. (9), weights are assigned to (Tm, aco−Trlc) and Tm, mc in accordance with the ratio of |Δθtc| to the transition angle width w so as to set the target motor torque Tm. The ratio of |Δθtc| to the transition angle width w is represented by |Δθtc|/w. As the absolute value |Δθtc| increases, the weight {1−(|Δθtc|/w)} assigned to (Tm, aco−Trlc) decreases, and the weight (|Δθtc|/w) assigned to Tm, mc increases. In other words, as the angle difference Δθ increases relative to the transition control start angle difference Δθo, the weight assigned to (Tm, aco−Trlc) decreases, and the weight assigned to Tm, mc increases. Consequently, the control mode is gradually changed to the manual steering mode.
The present embodiment involves using, instead of the target automatic steering torque (Tm, ac−Trlc), the target automatic steering torque (Tm, aco−Trlc) in the first term in the right side of Eq. (9). In other words, the present embodiment involves using the transition control start angle control target torque Tm, aco instead of the angle control target torque Tm, ac output from the angle controller 42. The reasons for this are described below. A steering operation (i.e., a steering intervention) performed by the driver during automatic steering so as to deactivate automatic steering increases the angle difference Δθ. The increase in the angle difference Δθ increases the absolute value of the angle control target torque Tm, ac set by the angle controller 42. The increase in the absolute value of the angle control target torque Tm, ac results in an increase in steering reaction force when the driver performs the steering intervention. The increase in steering reaction force makes it difficult for the driver to perform the steering intervention. To solve this problem, the present embodiment involves using, instead of the angle control target torque Tm, ac set by the angle controller 42, the transition control start angle control target torque Tm, aco. This prevents an excessive increase in steering reaction force.
In step S4, the automatic steering deactivating controller 46A determines whether a transition control stop requirement is satisfied. The transition control stop requirement is that one of first and second requirements described below be satisfied.
The first requirement is that the absolute value |Δθ| of the angle difference Δθ be smaller than a value ε·|Δθo|. The value c·|Δθo| is obtained by multiplying the absolute value |Δθo| of the transition control start angle difference Δθo by a predetermined value ε (where 0<ε<1). The second requirement is that the sign (Δθ) of the angle difference Δθ is different from the sign (Δθo) of the transition control start angle difference Δθo. The second requirement means that the direction of the steering torque Td is a direction in which the absolute value of the angle difference Δθ decreases (i.e., a direction in which the actual steering angle θ approaches the target steering angle).
Upon determining that the transition control stop requirement is not satisfied (i.e., when the answer is NO in step S4), the automatic steering deactivating controller 46A determines in step S5 whether the result of the determination made by the steering wheel operating condition determiner 45 indicates the hands-off condition in which the driver is not gripping the steering wheel 2. When the result of the determination made by the steering wheel operating condition determiner 45 indicates the hands-on condition in which the driver is gripping the steering wheel 2 (i.e., when the answer is NO in step S5), the automatic steering deactivating controller 46A determines in step S6 whether the absolute value |Δθtc| of the angle difference Δθ is equal to or greater than the transition angle width w. Upon determining that the absolute value |Δθtc| of the angle difference Δθtc is smaller than the transition angle width w (i.e., when the answer is NO in step S6), the automatic steering deactivating controller 46A returns the process to step S3. The automatic steering deactivating controller 46A thus performs step S3 and the subsequent steps again.
Upon determining in step S6 that the absolute value |Δθtc| of the angle difference Δθ is equal to or greater than the transition angle width w (i.e., when the answer is YES in step S6), the automatic steering deactivating controller 46A terminates the transition control and changes the control mode to the manual steering mode in step S7. The automatic steering deactivating controller 46A then terminates the process for changing the control mode during the automatic steering mode. Upon determining in step S4 that the transition control stop requirement is satisfied (i.e., when the answer is YES in step S4), the automatic steering deactivating controller 46A stops the transition control so as to return the control mode to the automatic steering mode in step S8. The automatic steering deactivating controller 46A then returns the process to step S1.
Upon determining in step S5 that the result of the determination made by the steering wheel operating condition determiner 45 indicates the hands-off condition in which the driver is not gripping the steering wheel 2 (i.e., when the answer is YES in step S5), the automatic steering deactivating controller 46A advances the process to step S9. In step S9, the automatic steering deactivating controller 46A saves the angle difference Δθ at this point to the memory in the form of a return control start angle difference Δθhod, and saves the time at this point to the memory in the form of a return control start time thod.
As used herein, the term “return control start angle difference Δθhod” refers to an angle difference at the start of the return control. As used herein, the term “return control start time thod” refers to a time at the start of the return control. The automatic steering deactivating controller 46A then starts the return control to cause the actual steering angle θ to gradually approach the target steering angle θcmd.
In step S10, the automatic steering deactivating controller 46A calculates a return control target steering angle θcmd, rc so as to provide the return control target steering angle θcmd, rc to the second input terminal P2 of the target steering angle changer 62 (see
Specifically, the automatic steering deactivating controller 46A calculates the return control target steering angle θcmd, rc in accordance with Eq. (10):
θcmd,rc=θcmd+Δθrc
Δθrc=Δθhod−γ·sign(Δθ)·(t−thod) (10)
In Eq. (10), Δθhod denotes the return control start angle difference Δθ saved to the memory in step S9, γ denotes a predetermined value (where γ>0), sign(Δθ) denotes the sign of the angle difference, t denotes the present time, and thod denotes the return control start time saved to the memory in step S9.
In step S11, the automatic steering deactivating controller 46A determines whether the result of the determination made by the steering wheel operating condition determiner 45 indicates the hands-off condition in which the driver is not gripping the steering wheel 2. When the result of the determination made by the steering wheel operating condition determiner 45 indicates the hands-off condition (i.e., when the answer is YES in step S11), the automatic steering deactivating controller 46A determines in step S12 whether the absolute value |Δθ rc| of Δθ rc calculated using Eq. (10) is smaller than a predetermined value δ (where δ>0). Upon determining that the absolute value |Δθ rc| of Δθ rc is equal to or greater than the predetermined value δ (i.e., when the answer is NO in step S12), the automatic steering deactivating controller 46A returns the process to step S10. The automatic steering deactivating controller 46A thus performs step S10 and the subsequent steps again.
Upon determining in step S12 that the absolute value |Δθ rc| of Δθ rc is smaller than the predetermined value δ (i.e., when the answer is YES in step S12), the automatic steering deactivating controller 46A stops the return control in step S13. Specifically, the automatic steering deactivating controller 46A controls the target steering angle changer 62 such that the target steering angle changer 62 selects and outputs the target steering angle θcmd input to the first input terminal P1. The automatic steering deactivating controller 46A returns the control mode to the automatic steering mode in step S14 and then returns the process to step S1.
Upon determining in step S11 that the result of the determination made by the steering wheel operating condition determiner 45 indicates the hands-on condition (i.e., when the answer is NO in step S11), the automatic steering deactivating controller 46A stops the return control in step S15 and then returns the process to step S3. Specifically, the automatic steering deactivating controller 46A controls the target steering angle changer 62 such that the target steering angle changer 62 selects and outputs the target steering angle θcmd input to the first input terminal P1, and then returns the process to step S3.
Referring now to
The return control then involves: calculating Δθ rc using Eq. (10); calculating the return control target steering angle θcmd, rc using Δθ rc; calculating the target automatic steering torque Tm, ad (i.e., an output from the torque subtracter 44) using the return control target steering angle θcmd, rc; and controlling the electric motor 18 in accordance with the target automatic steering torque Tm, ad. In this example, the sign (Δθ) is greater than zero, so that the value of the second term in the right side of Eq. (10), i.e., {γ·sign(Δθ)·(t−thod)}, gradually increases with the lapse of time. γ denotes the rate of change of {γ·sign(Δθ)·(t−thod)} with respect to time. Accordingly, as indicated by the straight line Lc in
In the above-described embodiment, the transition control is terminated when the absolute value |Δθtc| of the difference Δθtc between the angle difference Δθ and the transition control start angle difference Δθo is equal to or greater than the transition angle width w. The driver is thus able to change a transition control time (i.e., the time between the start and end of the transition control) by performing a steering operation. Specifically, the greater the steering force applied to the steering wheel 2 by the driver, the shorter the time required for the absolute value |Δθtc| to reach the transition angle width w, resulting in a reduction in the transition control time. Consequently, the driver is able to quickly deactivate the automatic steering mode in the event of an emergency, for example.
The above-described embodiment suppresses an increase in steering reaction force during the transition control. This makes it easy for the driver to perform a steering intervention. After the transition control has started and before the absolute value |Δθtc| becomes equal to or greater than the transition angle width w, the above-described embodiment involves stopping the transition control so as to automatically return the control mode to the automatic steering mode when the absolute value |Δθ| of the angle difference Δθ is smaller than the value ε·|Δθo| or the sign of Δθ is different from the sign of Δθo. For example, suppose that after the start of the transition control, a steering operation is performed by the driver such that the vehicle travels along a target path. In such a case, this embodiment enables the control mode to automatically return to the automatic steering mode.
When the steering wheel operating condition is the hands-off condition in which the driver is not gripping the steering wheel 2 during the transition control, the above-described embodiment involves performing the return control so as to automatically steer the vehicle such that the actual steering angle θ gradually approaches the target steering angle θcmd. Although the embodiment of the invention has been described thus far, the invention may be embodied in many other forms. As indicated by Eq. (9), step S3 of
The process illustrated in
Number | Date | Country | Kind |
---|---|---|---|
2017-229229 | Nov 2017 | JP | national |