The disclosure of Japanese Patent Application No. 2018-086452 filed on Apr. 27, 2018 and No. 2018-182677 filed on Sep. 27, 2018 including the specification, drawings and abstract, is incorporated herein by reference in its entirety.
The present invention relates to a control device for an electric motor for steering angle control.
In automatic drive and drive assist in which an electric power steering (EPS) system, a steer-by-wire system, a rear wheel steering system, etc. is used, the steered angle of steered wheels is controlled by an electric motor. In this type of motor control, angle feedback control in which motor torque of the electric motor is controlled in accordance with the difference between a target steered angle and the actual steered angle is used. PID control is commonly used as the angle feedback control. Specifically, target torque is computed by multiplying a term of the difference between the target steered angle and the actual steered angle, an integral term of the difference, and a differential term of the difference by a proportional gain, an integral gain, and a differential gain, respectively, and thereafter adding such terms. Then, the electric motor is controlled such that the motor torque becomes equal to the target torque. (See Japanese Patent Application Publication No. 2004-256076 (JP 2004-256076 A) and WO 2014/162769.)
Since the PID control discussed earlier uses a linear control algorithm, the precision of angle control is lowered or fluctuated by fluctuations in non-linear disturbance torque such as road surface load torque (disturbance torque on the rack shaft side), friction torque of the steering system, and steering torque (disturbance torque on the steering side).
It is an object of the present invention to provide a motor control device that can suppress the effect of disturbance torque on the angle control performance and that can perform high-precision angle control.
An aspect of the present invention provides a motor control device that performs drive control on an electric motor for steering angle control, the motor control device including: a manual steering command value generation unit that generates a manual steering command value using steering torque; an integrated angle command value computation unit that computes an integrated angle command value by adding the manual steering command value to an automatic steering command value; and a control unit that performs angle control on the electric motor on the basis of the integrated angle command value, in which the control unit includes a basic torque command value computation unit that computes a basic torque command value on the basis of the integrated angle command value, a disturbance torque estimation unit that estimates disturbance torque other than motor torque that is generated by the electric motor and acts on an object to be driven by the electric motor, and a disturbance torque compensation unit that corrects the basic torque command value in accordance with the disturbance torque.
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:
An embodiment of the present invention will be described in detail below with reference to the accompanying drawings.
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 so as to be rotatable relative to each other via a torsion bar 10. A torque sensor 12 is disposed in the vicinity of the torsion bar 10. The torque sensor 12 detects steering torque (torsion bar torque) Td provided to the steering wheel 2 on the basis of the amount of relative rotational displacement between the input shaft 8 and the output shaft 9. In the embodiment, the steering torque Td that is detected by the torque sensor 12 is detected as a positive value when the vehicle is steered to the left, and as a negative value when the vehicle is steered to the right, for example. The magnitude of the steering torque Td is larger as the absolute value of the positive or negative value is larger.
The steering operation mechanism 4 is composed of a rack-and-pinion mechanism that includes a pinion shaft 13 and a rack shaft 14 that serves as a steered shaft. The steered wheels 3 are coupled to end portions of the rack shaft 14 via tie rods 15 and knuckle arms (not illustrated). The pinion shaft 13 is coupled to the intermediate shaft 7. The pinion shaft 13 is rotated in conjunction with a steering operation of the steering wheel 2. A pinion 16 is coupled to the distal end of the pinion shaft 13.
The rack shaft 14 extends linearly along the right-left direction of the vehicle. A rack 17 meshed with the pinion 16 is formed at an intermediate portion of the rack shaft 14 in the axial direction. The pinion 16 and the rack 17 convert rotation of the pinion shaft 13 into movement of the rack shaft 14 in the axial direction. The steered wheels 3 can be steered by moving the rack shaft 14 in the axial direction.
When the steering wheel 2 is operated (rotated), rotation of the steering wheel 2 is transferred to the pinion shaft 13 via the steering shaft 6 and the intermediate shaft 7. The pinion 16 and the rack 17 convert rotation of the pinion shaft 13 into movement of the rack shaft 14 in the axial direction. Consequently, the steered wheels 3 are steered. The steering assist mechanism 5 includes an electric motor 18 and a speed reducer 19. The electric motor 18 generates a steering assist force (assist torque). The speed reducer 19 amplifies output torque of the electric motor 18 and transfers the amplified output torque to the steering operation mechanism 4. The speed reducer 19 is composed of a worm gear mechanism that includes a worm gear 20 and a worm wheel 21 meshed with the worm gear 20. The speed reducer 19 is housed in a gear housing 22 that serves as a transfer mechanism housing. In the following description, the speed reduction ratio (gear ratio) of the speed reducer 19 is occasionally represented by N. The speed reduction ratio N is defined as a ratio ωwg/ωww of an angular velocity ωwg of the worm gear 20 to an angular velocity www of the worm wheel 21.
The worm gear 20 is rotationally driven by the electric motor 18. The worm wheel 21 is coupled so as to be rotatable together with the output shaft 9. When the worm gear 20 is rotationally driven by the electric motor 18, the worm wheel 21 is rotationally driven to provide motor torque to the steering shaft 6 and rotate the steering shaft 6 (output shaft 9). Rotation of the steering shaft 6 is transferred to the pinion shaft 13 via the intermediate shaft 7. Rotation of the pinion shaft 13 is converted into movement of the rack shaft 14 in the axial direction. Consequently, the steered wheels 3 are steered. That is, the worm gear 20 is rotationally driven by the electric motor 18 to enable steering assist by the electric motor 18 and steering of the steered wheels 3. The electric motor 18 is provided with a rotational angle sensor 23 configured to detect the rotational angle of a rotor of the electric motor 18.
Torque applied to the output shaft 9 (an example of an object to be driven by the electric motor 18) includes motor torque applied by the electric motor 18 and disturbance torque other than the motor torque. Disturbance torque Tlc other than the motor torque includes the steering torque Td, road surface load torque (road surface reaction force torque) Trl, friction torque Tf, etc. The steering torque Td is torque applied from the steering wheel 2 to the output shaft 9 by a force applied to the steering wheel 2 by the driver, a force generated by the steering inertia, etc.
The road surface load torque Trl is torque applied from the side of the steered wheels 3 to the output shaft 9 via the rack shaft 14 by self-aligning torque generated in the tires, a force generated by suspensions or tire wheel alignment, a friction force of the rack-and-pinion mechanism, etc. The vehicle includes, as mounted thereon, a Charge Coupled Device (CCD) camera 25, a Global Positioning System (GPS) 26, a radar 27, and a map information memory 28. The CCD camera 25 photographs a road ahead in the advancing direction of the vehicle. The GPS 26 detects the position of the vehicle. The radar 27 detects the shape of the road and an obstacle. The map information memory 28 stores map information.
The CCD camera 25, the GPS 26, the radar 27, and the map information memory 28 are connected to a higher-level Electronic Control Unit (ECU) 201 configured to perform drive assist control and automatic drive control. The higher-level ECU 201 recognizes the surrounding environment, estimates the vehicle position, makes route planning, etc. on the basis of information obtained through the CCD camera 25, the GPS 26, and the radar 27 and the map information, and determines control target values for steering and drive actuators.
In the embodiment, the higher-level ECU 201 sets an automatic steering command value θadac for automatic steering. In the embodiment, automatic steering control is control for causing the vehicle to travel along a target track, for example. The automatic steering command value θadac is a target value for a steering angle for causing the vehicle to automatically travel along the target track. A process of setting such an automatic steering command value θadac is well known, and therefore is not described in detail herein.
The automatic steering command value θadac that is set by the higher-level ECU 201 is provided to a motor control ECU 202 via an in-vehicle network. The steering torque Td that is detected by the torque sensor 12 and an output signal from the rotational angle sensor 23 are input to the motor control ECU 202. The motor control ECU 202 controls the electric motor 18 on the basis of such input signals and information provided from the higher-level ECU 201.
The motor control ECU 202 includes a microcomputer 40, a drive circuit (inverter circuit) 31, and a current detection circuit 32. The drive circuit 31 is controlled by the microcomputer 40, and supplies electric power to the electric motor 18. The current detection circuit 32 detects a current (hereinafter referred to as a “motor current I”) that flows through the electric motor 18.
The microcomputer 40 includes a central processing unit (CPU) and a memory (such as a read-only memory (ROM), a random-access memory (RAM), or a non-volatile memory). The microcomputer 40 executes a predetermined program to function as a plurality of function processing units. The plurality of function processing units includes a manual steering command value generation unit 41, an integrated angle command value computation unit 42, and a control unit 43. The manual steering command value generation unit 41 is provided to set a steering angle (to be more exact, a rotational angle θ of the output shaft 9) that matches a steering wheel operation as a manual steering command value θmdac in the case where the driver operates the steering wheel 2. The manual steering command value generation unit 41 generates the manual steering command value θmdac using the steering torque Td that is detected by the torque sensor 12.
The integrated angle command value computation unit 42 computes an integrated angle command value θacmd by adding the manual steering command value θmdac to the automatic steering command value θadac that is set by the higher-level ECU 201.
The control unit 43 performs angle control on the electric motor 18 on the basis of the integrated angle command value θacmd. More specifically, the control unit 43 performs drive control on the drive circuit 31 such that the steering angle θ (rotational angle θ of the output shaft 9) approximates the integrated angle command value θacmd.
The control unit 43 includes an angle control unit 44 and a torque control unit (current control unit) 45. The angle control unit 44 computes a motor torque command value Tm that is a target value for the motor torque of the electric motor 18, on the basis of the integrated angle command value θacmd. The torque control unit 45 drives the drive circuit 31 such that the motor torque of the electric motor 18 approximates the motor torque command value Tm.
The manual steering command value generation unit 41 includes an assist torque command value setting unit 51 and a command value setting unit 52. The assist torque command value setting unit 51 sets an assist torque command value Tac that is a target value for assist torque that is necessary for a manual operation. The assist torque command value setting unit 51 sets the assist torque command value Tac on the basis of the steering torque Td that is detected by the torque sensor 12. An example of the assist torque command value Tac that is set with respect to the steering torque Td is indicated in
The assist torque command value Tac has a positive value when the electric motor 18 should generate a steering assist force for steering the vehicle to the left, and a negative value when the electric motor 18 should generate a steering assist force for steering the vehicle to the right. The assist torque command value Tac is positive when the steering torque Td has a positive value, and is negative when the steering torque Td has a negative value. The assist torque command value Tac is set such that the absolute value thereof becomes larger as the absolute value of the steering torque Td becomes larger.
The assist torque command value setting unit 51 may compute the assist torque command value Tac by multiplying the steering torque Td by a constant set in advance. In the embodiment, the command value setting unit 52 sets the manual steering command value θmdac using a reference EPS model.
The reference EPS model is a single inertia model that includes a lower column. The lower column corresponds to the output shaft 9 and the worm wheel 21. In
T
rl
=−k·θc−c(dθc/dt) (1)
In the embodiment, the spring constant k and the viscous damping coefficient c are set to predetermined values obtained in advance through an experiment, analysis, etc. The equation of motion of the reference EPS model is represented by the following formula (2).
Jc·d
2
θc/dt
2
=T
d
+N·T
m
−k·θc—c(dec/dt) (2)
The command value setting unit 52 solves the differential equation of the formula (2) by substituting the steering torque Td that is detected by the torque sensor 12, into Td, and substituting the assist torque command value Tac that is set by the assist torque command value setting unit 51, into N·Tm. Consequently, the rotational angle θc of the lower column is computed. Then, the command value setting unit 52 sets the obtained rotational angle θc of the lower column as the manual steering command value θmdac.
The speed reduction ratio multiplication unit 68 multiplies the motor torque command value Tm that is computed by the first speed reduction ratio division unit 67, by the speed reduction ratio N of the speed reducer 19. Consequently, the motor torque command value Tm is converted into a steering torque command value Tcmd (=N·Tm) that acts on the output shaft 9 (worm wheel 21). The rotational angle computation unit 69 computes the rotor rotational angle θm of the electric motor 18 on the basis of the output signal from the rotational angle sensor 23. The second speed reduction ratio division unit 70 divides the rotor rotational angle θm that is computed by the rotational angle computation unit 69, by the speed reduction ratio N. Consequently, the rotor rotational angle θm is converted into a rotational angle (actual steering angle) θ of the output shaft 9.
The low-pass filter 61 performs a low-pass filter process on the integrated angle command value θacmd. An integrated angle command value θcmd after the low-pass filter process is provided to the feedback control unit 62 and the feedforward control unit 63. The feedback control unit 62 is provided to approximate an estimated steering angle value {circumflex over (θ)} that is computed by the disturbance torque estimation unit 64, to the integrated angle command value θcmd after the low-pass filter process. The feedback control unit 62 includes an angle deviation computation unit 62A and a PD control unit 62B. The angle deviation computation unit 62A computes a deviation Δθ(=θcmd−{circumflex over (θ)}) between the integrated angle command value θcmd and the estimated steering angle value {circumflex over (θ)}. The angle deviation computation unit 62A may compute a deviation (θcmd−θ) between the integrated angle command value θcmd and the actual steering angle θ that is computed by the second speed reduction ratio division unit 70, as an angle deviation 40.
The PD control unit 62B performs PD computation (proportional-differential computation) on the angle deviation 40 that is computed by the angle deviation computation unit 62A. Consequently, feedback control torque Tfb is computed. The feedback control torque Tfb is provided to the torque addition unit 65. The feedforward control unit 63 is provided to improve the response of control by compensating for a delay in the response due to the inertia of the electric power steering system 1. The feedforward control unit 63 includes an angular acceleration computation unit 63A and an inertia multiplication unit 63B. The angular acceleration computation unit 63A calculates a second-order differential of the integrated angle command value θcmd. Consequently, a target angle acceleration d2θcmd/dt2 is computed.
The inertia multiplication unit 63B multiplies the target angle acceleration d2θcmd/dt2 that is computed by the angular acceleration computation unit 63A, by the inertia J of the electric power steering system 1. Consequently, feedforward control torque Tff (=J·d2θcmd/dt2) is computed. The inertia J is calculated from a physical model (see
The torque addition unit 65 adds the feedforward control torque Tff to the feedback control torque Tfb. Consequently, a basic torque command value (Tfb+Tff) is computed. The disturbance torque estimation unit 64 is provided to estimate non-linear torque (disturbance torque: torque other than the motor torque) generated as disturbance for a plant (object to be controlled by the electric motor 18). The disturbance torque estimation unit 64 estimates the disturbance torque (disturbance load) Tlc, the steering angle θ, and a steering angle differential value (angular velocity) dθ/dt on the basis of the steering torque command value Tcmd (=N·Tm) that is input to the plant, and the actual steering angle θ that is output from the plant. Estimated values of the disturbance torque Tlc, the steering angle θ, and the steering angle differential value (angular velocity) dθ/dt are represented as {circumflex over (T)}lc, {circumflex over (θ)}, and d{circumflex over (θ)}/dt, respectively. The disturbance torque estimation unit 64 will be discussed in detail later.
The estimated disturbance torque value {circumflex over (T)}lc that is computed by the disturbance torque estimation unit 64, is provided to the disturbance torque compensation unit 66 as a disturbance torque compensation value. The estimated steering angle value −{circumflex over (θ)} that is computed by the disturbance torque estimation unit 64, is provided to the angle deviation computation unit 62A. The disturbance torque compensation unit 66 subtracts the estimated disturbance torque value {circumflex over (T)}lc from the basic torque command value (Tfb+Tff). Consequently, the steering torque command value Tcmd (=Tfb+Tff−{circumflex over (T)}lc) is computed. Consequently, the steering torque command value Tcmd (torque command value for the output shaft 9) that has been compensated for the disturbance torque is obtained.
The steering torque command value Tcmd is provided to the first speed reduction ratio division unit 67. The first speed reduction ratio division unit 67 divides the steering torque command value Tcmd by the speed reduction ratio N. Consequently, the motor torque command value Tm is computed. The motor torque command value Tm is provided to the torque control unit 45 (see
The physical model 101 includes a plant (an example of an object to be driven by the motor) 102 that includes the output shaft 9 and the worm wheel 21 that is fixed to the output shaft 9. The plant 102 is provided with the steering torque Td from the steering wheel 2 via the torsion bar 10, and the road surface load torque Trl from the side of the steered wheels 3. Further, the plant 102 is provided with the steering torque command value Tcmd (=N·Tm) via the worm gear 20, and with the friction torque Tf through friction between the worm wheel 21 and the worm gear 20.
When the inertia of the plant 102 is defined as J, the equation of motion for the inertia of the physical model 101 is represented by the following formula (3).
J{umlaut over (θ)}=N·Tm+Tlc (3)
Tlc=Td+Trl+Tf
d2θ/dt2 is the angular acceleration of the plant 102. N is the speed reduction ratio of the speed reducer 19. Tlc indicates the disturbance torque other than the motor torque that is provided to the plant 102. In the embodiment, the disturbance torque Tlc is indicated as the sum of the steering torque Td, the road surface load torque Trl, and the friction torque Tf. In reality, however, the disturbance torque Tlc includes torque other than such torques.
The equation of state for the physical model 101 in
In the formula (4), x is a state variable vector. In the formula (4), u1 is a known input vector. In the formula (4), u2 is an unknown input vector. In the formula (4), y is an output vector (measurement value). In the formula (4), A is a system matrix. In the formula (4), B1 is a first input matrix. In the formula (4), B2 is a second input matrix. In the formula (4), C is an output matrix. In the formula (4), D is a direct matrix.
The above equation of state is extended to a system that includes the unknown input vector u2 as one state. The equation of state for the extended system (extended equation of state) is represented by the following formula (5).
In the formula (5), xe is a state variable vector for the extended system, and is represented by the following formula (6).
In the formula (5), Ae is a system matrix for the extended system. In the formula (5), Be is a known input matrix for the extended system. In the formula (5), Ce is an output matrix for the extended system.
A disturbance observer (extended state observer) represented by the following equation (7) is constructed from the extended equation of state of the formula (5).
In the formula (7), {circumflex over (x)}e represents an estimated value of xe. L is an observer gain. ŷ represents an estimated value of y. {circumflex over (x)}e is represented by the following formula (8).
In the formula (8),
The disturbance torque estimation unit 64 computes the state variable vector {circumflex over (x)}e on the basis of the equation of the formula (7).
The output from the integration unit 88 is the state variable vector {circumflex over (x)}e (see the formula (8)). When the computation is started, an initial value of the state variable vector {circumflex over (x)}e is provided. The initial value of the state variable vector {circumflex over (x)}e is zero, for example. The system matrix multiplication unit 86 multiplies the state variable vector {circumflex over (x)}e by the system matrix Ae. The output matrix multiplication unit 82 multiplies the state variable vector {circumflex over (x)}e by the output matrix Ce.
The first addition unit 83 subtracts the output (Ce·{circumflex over (x)}e) of the output matrix multiplication unit 82 from the output vector (measurement value) y that is the actual steering angle θ that is computed by the second speed reduction ratio division unit 70 (see
The input matrix multiplication unit 85 multiplies the input vector u1 that is output from the input vector input unit 81, by the input matrix Be. The second addition unit 87 adds the output (Be·u1) from the input matrix multiplication unit 85, the output (Ae·{circumflex over (x)}e) from the system matrix multiplication unit 86, and the output (L(y−ŷŷ)) from the gain multiplication unit 84. Consequently, a differential value d{circumflex over (x)}e/dt of the state variable vector is computed. The integration unit 88 integrates the output (d{circumflex over (x)}e/dt) from the second addition unit 87. Consequently, the state variable vector {circumflex over (x)}e is computed. The state variable vector output unit 89 computes the estimated disturbance torque value {circumflex over (T)}lc, the estimated steering angle value {circumflex over (θ)}, and the estimated angular velocity value d{circumflex over (θ)}/dt on the basis of the state variable vector {circumflex over (x)}e.
A common disturbance observer is composed of an inverse model of a plant and a low-pass filter, unlike the extended state observer discussed earlier. The equation of motion of the plant is represented by the formula (3) as discussed earlier. Thus, the inverse model of the plant is as indicated by the following formula (9).
Tlc=J{umlaut over (θ)}−N·Tm (9)
An input to the common disturbance observer is J·d2θ/dt2 and N·Tm and uses a second-order differential value of the actual steering angle θ, and therefore is significantly affected by noise of the rotational angle sensor 23. With the extended state observer according to the embodiment discussed earlier, in contrast, disturbance torque is estimated through integration, and therefore the effect of noise due to differentiation can be reduced.
A common disturbance observer composed of an inverse model of a plant and a low-pass filter may also be used as the disturbance torque estimation unit 64.
The motor current command value computation unit 91 divides the motor torque command value Tm that is computed by the angle control unit 44 (see
The PI control unit 93 performs proportional-integral (PI) computation on the current deviation ΔI that is computed by the current deviation computation unit 92. Consequently, a drive command value for bringing the motor current I, which flows through the electric motor 18, to the motor current command value Icmd is generated. The PWM control unit 94 generates a PWM control signal with a duty ratio corresponding to the drive command value, and supplies the generated PWM control signal to the drive circuit 31. Consequently, electric power corresponding to the drive command value is supplied to the electric motor 18.
A simulation was performed to find out how the integrated angle command value θacmd was varied when the steering wheel 2 was operated by the driver while automatic steering control was performed. Specifically, a simulation was performed for a case where the steering torque Td such as that indicated by a polygonal line B in
The steering torque Td such as that indicated by the line B in
In the embodiment discussed earlier, the manual steering command value θmdac is added to the automatic steering command value θadac to compute the integrated angle command value θacmd. The electric motor 18 is controlled on the basis of the integrated angle command value θacmd. Consequently, coordinated control in which steering control is performed mainly through automatic steering control while enabling manual steering can be achieved without switching between manual steering control and automatic steering control. In addition, a seamless transition can be made between manual steering control and automatic steering control, and thus a sense of discomfort is not provided to the driver when manual steering is performed.
In the embodiment discussed earlier, the basic torque command value (Tfb+Tff) is computed on the basis of the integrated angle command value θacmd. The basic torque command value (Tfb+Tff) is corrected in accordance with the estimated disturbance torque value {circumflex over (T)}lc that is computed by the disturbance torque estimation unit 64. As a result, the effect of the disturbance torque on the angle control performance is suppressed. Consequently, it is possible to achieve high-precision angle control. Consequently, in addition, it is possible to eliminate the effect of the angle control unit 44 on the steering feel when manual steering is performed during automatic steering control, and thus design of the steering feel is facilitated. Specifically, a steering feel that matches design values of the spring constant k and the viscous damping coefficient c can be obtained, and thus design of the steering feel is facilitated.
k={circumflex over (T)}
lc/θ (11)
The viscous damping coefficient c in the formula (2) discussed earlier is set in advance as in the embodiment discussed earlier.
The command value setting unit 52 solves the differential equation of the formula (2) by using k that is computed using the formula (11) and c that is set in advance as k and c, respectively, in the formula (2) discussed earlier. Consequently, θc is computed, and the obtained θc is set as the manual steering command value θmdac.
In the manual steering command value generation unit 41A according to the first modification, the spring constant k is computed using the estimated disturbance torque value Tlc that is computed by the disturbance torque estimation unit 64. Consequently, a steering feel that matches the actual road surface load is obtained.
A manual steering command value generation unit 41B includes the spring constant computation unit 53 and a damping coefficient computation unit 54 in addition to the assist torque command value setting unit 51 and the command value setting unit 52. The spring constant computation unit 53 computes the spring constant k on the basis of the formula (11) as with the spring constant computation unit 53 according to the first modification. The damping coefficient computation unit 54 computes the viscous damping coefficient c on the basis of the estimated disturbance torque value Tlc that is computed by the disturbance torque estimation unit 64 (see
c={circumflex over (T)}/(dθ/dt) (12)
The command value setting unit 52 computes θc by solving the differential equation of the formula (2) by using k that is computed using the formula (11) and c that is computed using the formula (12) as k and c, respectively, in the formula (2) discussed earlier, and sets the obtained θc as the manual steering command value θmdac. In the manual steering command value generation unit 41B according to the second modification, the spring constant k and the viscous damping coefficient c are computed using the estimated disturbance torque value Tlc that is computed by the disturbance torque estimation unit 64. Consequently, a steering feel that matches the actual road surface load is obtained.
A motor control ECU 202A in
Specifically, the weight assignment unit 46 first sets a weight Wad on the basis of the manual steering command value θmdac. Next, the weight assignment unit 46 multiplies the automatic steering command value θadac that is input from the higher-level ECU 201, by the weight Wad. Then, the weight assignment unit 46 provides the product Wad·θadac to the integrated angle command value computation unit 42 as an automatic steering command value θadac′ after the weight assignment process.
The integrated angle command value computation unit 42 adds the automatic steering command value θadac′ after the weight assignment process by the weight assignment unit 46 to the manual steering command value θmdac that is generated by the manual steering command value generation unit 41. Consequently, the integrated angle command value θacmd is computed. The weight Wad that is set by the weight assignment unit 46 will be described. An example of the weight Wad that is set with respect to the manual steering command value θmdac is illustrated in
The weight Wad may be set so as to be gradually decreased linearly along with an increase in the absolute value of the manual steering command value θmdac and gradually increased linearly along with a reduction in the absolute value of the manual steering command value θmdac when the absolute value of the manual steering command value θmdac is in the range of 0 to E. In the motor control ECU 202A, the automatic steering command value θadac that is input from the higher-level ECU 201, is provided, as it is, to the integrated angle command value computation unit 42 when the manual steering command value θmdac is zero. In this case, the electric motor 18 is controlled on the basis of only the automatic steering command value θadac, and thus the steering mode is the automatic steering mode.
When the absolute value of the manual steering command value θmdac is equal to or more than the predetermined value E, on the other hand, the automatic steering command value θadac is zero. In this case, the electric motor 18 is controlled on the basis of only the manual steering command value θmdac, and thus the steering mode is the manual steering mode. That is, the motor control ECU 202A makes it possible to set the steering mode to the automatic steering mode, in which the electric motor 18 is controlled on the basis of only the automatic steering command value θadac, and the manual steering mode, in which the electric motor 18 is controlled on the basis of only the manual steering command value θmdac. Switching between the automatic steering mode and the manual steering mode is made on the basis of the manual steering command value θmdac that is calculated using the steering torque Td. Consequently, switching between the steering modes can be made by a steering operation by the driver.
In addition, the absolute value of the automatic steering command value θadac is gradually decreased to zero when the steering mode is switched from the automatic steering mode to the manual steering mode, and the absolute value of the automatic steering command value θadac is gradually increased from zero when the steering mode is switched from the manual steering mode to the automatic steering mode. Therefore, the motor control ECU 202A makes it possible to smoothly switch between the automatic steering mode and the manual steering mode.
In the first modification, a weight assignment process is performed on the automatic steering command value θadac in accordance with the manual steering command value θmdac. However, the present invention is not limited thereto. For example, a weight assignment process may be performed on the automatic steering command value Badac in accordance with the steering torque Td. Specifically, a similar effect to that of the first modification can be achieved by inputting the steering torque Td that is detected by the torque sensor 12, to the weight assignment unit 46 and setting the weight Wad on the basis of a graph which is similar to that in
The first weight assignment unit 47 is an example of a “third weight assignment unit according to the present invention”. The second weight assignment unit 48 is an example of a “fourth weight assignment unit according to the present invention”. The first mode switch 111 outputs a normal steering mode setting signal S1 for setting the steering mode to a normal steering mode when turned on by the driver. In the normal steering mode, the electric motor 18 is controlled on the basis of the manual steering command value θmdac and the automatic steering command value θadac, as with the motor control ECU 202 in
The second mode switch 112 outputs an automatic steering mode setting signal S2 for setting the steering mode to the automatic steering mode when turned on by the driver. The third mode switch 113 outputs a manual steering mode setting signal S3 for setting the steering mode to the manual steering mode when turned on by the driver. The mode setting signals S1, S2, and S3 are provided to the first and second weight assignment units 47 and 48.
The first weight assignment unit 47 performs a first weight assignment process on the automatic steering command value θadac that is input from the higher-level ECU 201, in accordance with the input mode setting signal. Specifically, when any of the mode setting signals S1, S2, and S3 is input, the first weight assignment unit 47 first sets a first weight Wad in accordance with the current steering mode and the input mode setting signal. Next, the first weight assignment unit 47 multiplies the automatic steering command value θadac that is input from the higher-level ECU 201, by the first weight Wad. Then, the first weight assignment unit 47 provides the product Wad·θadac to the integrated angle command value computation unit 42 as an automatic steering command value θadac′ after the first weight assignment process.
The second weight assignment unit 48 is provided between the manual steering command value generation unit 41 and the integrated angle command value computation unit 42. The second weight assignment unit 48 performs a second weight assignment process on the manual steering command value θmdac that is generated by the manual steering command value generation unit 41, in accordance with the input mode setting signal. Specifically, when any of the mode setting signals S1, S2, and S3 is input, the second weight assignment unit 48 first sets a second weight Wmd in accordance with the current steering mode and the input mode setting signal. Next, the second weight assignment unit 48 multiplies the manual steering command value θmdac that is input from the manual steering command value generation unit 41, by the second weight Wmd. Then, the second weight assignment unit 48 provides the product Wmd·θmdac to the integrated angle command value computation unit 42 as a manual steering command value θmdac′ after the second weight assignment process.
The integrated angle command value computation unit 42 computes an integrated angle command value θacmd by adding the automatic steering command value θadac′ after the first weight assignment process and the manual steering command value θmdac′ after the second weight assignment process. In the second modification, the first weight Wad and the second weight Wmd are 1.0 in the case where the steering mode is set to the normal steering mode. In the case where the steering mode is set to the automatic steering mode, the first weight Wad is 1.0, and the second weight Wmd is zero. In the case where the steering mode is set to the manual steering mode, the first weight Wad is zero, and the second weight Wmd is 1.0. That is, the motor control ECU 202B makes it possible to switch the steering mode among the normal steering mode, the automatic steering mode, and the manual steering mode by an operation on the mode switches 111, 112, and 113 by the driver.
An example of the first weight Wad and the second weight Wmd that are set when the steering mode is switched is indicated in
The time T that is required to switch the first weight Wad and the second weight Wmd between zero and 1.0 is set to a predetermined value calculated in advance through an experiment, analysis, etc. The time T that is required to switch the first weight Wad between zero and 1.0 and the time T that is required to switch the second weight Wmd between zero and 1.0 may be set differently. In addition, the first weight Wad and the second weight Wmd may be set so as to be gradually increased and gradually decreased non-linearly, rather than linearly.
In the second modification, an operation of the mode switch 111, 112, 113 which does not cause a change in the steering mode is rendered invalid. In the second modification, in addition, an operation of any of the mode switches 111, 112, and 113 which is performed before the predetermined time T elapses since the mode switch 111, 112, and 113 is operated is rendered invalid.
The automatic steering mode setting signal S2 or the manual steering mode setting signal S3 may be generated in accordance with whether the driver is grasping or has released the steering wheel 2. Specifically, as illustrated by the long dashed double-short dashed line in
The hand on/off determination unit 114 outputs the manual steering mode setting signal S3 when a change is made from a state (release state) in which the driver is not grasping the steering wheel 2 to a state (grasping state) in which the driver is grasping the steering wheel 2. When a change is made from the grasping state to the release state, on the other hand, the hand on/off determination unit 114 outputs the automatic steering mode setting signal S2. In the case where such a hand on/off determination unit 114 is provided, the driver can preferably switch between an operation mode in which switching between the automatic steering mode and the manual steering mode is made on the basis of the hand on/off determination unit 114 and an operation mode in which such switching is made on the basis of the second and third mode switches 112 and 113.
The possibility-to-drive determination unit 115 determines, on the basis of a video of the driver captured by an in-vehicle camera 120 provided in the vehicle, for example, whether or not the driver is prohibited to drive. For example, the possibility-to-drive determination unit 115 determines that the driver is prohibited to drive when it is determined that the driver is highly likely to be dozing. When it is determined that the driver is prohibited to drive, the possibility-to-drive determination unit 115 outputs a drive prohibition signal S4. The drive prohibition signal S4 is provided to the weight assignment unit 49.
The weight assignment unit 49 is provided between the manual steering command value generation unit 41 and the integrated angle command value computation unit 42. The weight assignment unit 49 performs a weight assignment process on the manual steering command value θmdac in accordance with the drive prohibition signal S4 which is provided from the possibility-to-drive determination unit 115. Specifically, the weight assignment unit 49 first sets a weight Wmd when the drive prohibition signal S4 is input. Next, the weight assignment unit 49 multiplies the manual steering command value θmdac that is generated by the manual steering command value generation unit 41, by the weight Wmd. Then, the weight assignment unit 49 provides the product Wmd·θmdac to the integrated angle command value computation unit 42 as a manual steering command value θmdac after the weight assignment process.
The weight Wmd is set in accordance with the characteristics that are indicated by the polygonal line L4 in
In the third modification, a mode switch configured to return the steering mode from the automatic steering mode to the normal steering mode is preferably provided. While an embodiment of the present invention has been described above, the present invention may be implemented in other embodiments. For example, while the command value setting unit 52 (see
For example, the command value setting unit 52 may set the manual steering command value θmdac using a map that stores the relationship between the steering torque Td and the manual steering command value θmdac. More specifically, the command value setting unit 52 may include the map for each combination of the spring constant k and the viscous damping coefficient c, and acquire from the map the manual steering command value θmdac corresponding to the spring constant k and the viscous damping coefficient c that are set in advance or computed and the steering torque Td that is detected by the torque sensor 12. The command value setting unit 52 may be configured to include the map for each vehicle speed or each estimated disturbance torque value Tlc that is computed by the disturbance torque estimation unit 64.
In the embodiment discussed earlier, the angle control unit 44 (see
In the embodiment discussed earlier, the present invention is applied to motor control for an EPS of a column assist type. However, the present invention is also applicable to motor control for EPSs other than the column assist type. The present invention is also applicable to control for electric motors for steered angle control for a steer-by-wire system. Besides, a variety of design changes may be made to the present invention without departing from the scope described in the claims.
Number | Date | Country | Kind |
---|---|---|---|
2018-086452 | Apr 2018 | JP | national |
2018-182677 | Sep 2018 | JP | national |