Control unit of electric power steering apparatus
10604181 ยท 2020-03-31
Assignee
Inventors
Cpc classification
B62D6/06
PERFORMING OPERATIONS; TRANSPORTING
B62D6/008
PERFORMING OPERATIONS; TRANSPORTING
B62D5/0463
PERFORMING OPERATIONS; TRANSPORTING
International classification
B62D6/06
PERFORMING OPERATIONS; TRANSPORTING
B62D6/02
PERFORMING OPERATIONS; TRANSPORTING
Abstract
A control unit of an electric power steering apparatus including a feedforward control section, that inputs input angle information and calculates a first compensation signal compensating the current command value, a feedback control section, that inputs output angle information and calculates a second compensation signal compensating the current command value, and a response control section that adjusts the current command value based on the first compensation signal and the second compensation signal.
Claims
1. A control unit of an electric power steering apparatus that drives a motor based on a current command value, and assists and controls a steering system, comprising: an electronic control unit (ECU) configured to implement: a feedforward control section that inputs a steering wheel angle and calculates a first compensation signal compensating said current command value; a feedback control section that inputs a steering angle and calculates a second compensation signal compensating said current command value; and a response control section that adjusts said current command value based on said first compensation signal and said second compensation signal; wherein said feedback control section arranges a pole of a characteristic of a vibration mode where steering wheel inertia and motor inertia that constitute said electric power steering apparatus are relatively displaced in a steering stabilization frequency domain; and wherein said response control section performs pole-and-zero cancellation so as to cancel said characteristic of said vibration mode.
2. The control unit of the electric power steering apparatus according to claim 1, wherein said response control section inputs a difference between said first compensation signal and said second compensation signal.
3. The control unit of the electric power steering apparatus according to claim 1, wherein a first response control section that inputs said first compensation signal and a second response control section that inputs said second compensation signal are comprised as said response control section; and wherein a difference between an output of said first response control section and an output of said second response control section is used for adjustment of said current command value.
4. The control unit of the electric power steering apparatus according to claim 3, wherein said feedback control section performs pole arrangement with respect to said characteristic of said vibration mode by raising a resonance ratio of a two-inertia system consisting of said steering wheel inertia and said motor inertia.
5. The control unit of the electric power steering apparatus according to claim 3, wherein said feedback control section provides said pole with damping by a phase advance characteristic.
6. The control unit of the electric power steering apparatus according to claim 3, wherein a damping factor of said characteristic of said vibration mode becomes more than or equal to a predetermined value by said pole-and-zero cancellation performed by said response control section.
7. The control unit of the electric power steering apparatus according to claim 3, wherein said feedforward control section enables stability and responsiveness of said characteristic of said vibration mode at on-center to be set independently.
8. The control unit of the electric power steering apparatus according to claim 3, wherein said control unit further comprises a phase compensation control section that performs phase compensation with respect to said current command value before said response control section adjusts said current command value.
9. The control unit of the electric power steering apparatus according to claim 1, wherein said steering stabilization frequency domain ranges in about 20 Hz and over.
10. The control unit of the electric power steering apparatus according to claim 1, wherein said feedback control section performs pole arrangement with respect to said characteristic of said vibration mode by raising a resonance ratio of a two-inertia system consisting of said steering wheel inertia and said motor inertia.
11. The control unit of the electric power steering apparatus according to claim 10, wherein said resonance ratio is more than or equal to about 2.
12. The control unit of the electric power steering apparatus according to claim 1, wherein said feedback control section provides said pole with damping by a phase advance characteristic.
13. The control unit of the electric power steering apparatus according to claim 1, wherein a damping factor of said characteristic of said vibration mode becomes more than or equal to a predetermined value by said pole-and-zero cancellation performed by said response control section.
14. The control unit of the electric power steering apparatus according to claim 13, wherein said predetermined value is about 0.6.
15. The control unit of the electric power steering apparatus according to claim 1, wherein said feedforward control section enables stability and responsiveness of said characteristic of said vibration mode at on-center to be set independently.
16. The control unit of the electric power steering apparatus according to claim 15, wherein said feedforward control section performs phase compensation.
17. The control unit of the electric power steering apparatus according to claim 1, wherein said control unit further comprises a phase compensation control section that performs phase compensation with respect to said current command value before said response control section adjusts said current command value.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) In the accompanying drawings:
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
(13)
(14)
(15)
(16)
(17)
(18)
(19)
MODE FOR CARRYING OUT THE INVENTION
(20) The present invention aims to improve stability without deteriorating responsiveness on steering of a steering system.
(21)
(22) From
(23) Accordingly, utilizing the steering angle (the output angle information) and using a control section that inputs the steering angle (the output angle information) and the steering wheel angle (the input angle information), makes the above two functions compatible. A block diagram, corresponding to
(24) As shown in
(25) A current command value compensated on the basis of a compensation signal calculated by the feedforward control section 40 using the steering wheel angle d and a compensation signal calculated by the feedback control section 60 using the steering angle g fed back, is inputted into the response control section 50. Therefore, in the case of designing these three control sections, since a change of a power assist gain (a gain used for a steering torque at a current command value calculating section) has a significant influence on stability, the design is performed by dividing controls into a control in a region where power assist (assist control) is performed (hereinafter referred to a power assist control) and a control in the vicinity of the on-center where the power assist is not performed (hereinafter referred to an on-center control). The response control section 50 and the feedback control section 60 are designed to perform the power assist control, and the feedforward control section 40 is designed to perform the on-center control.
(26) First, the power assist control will be described.
(27) An EPS has a structure of a two-inertia system of connecting the steering wheel inertia and the motor inertia by a spring element of a torsion bar, and the structure is modeled as shown in
(28) From
(29)
(30) Since the above expression 1 includes a vibration mode where two kinds of inertia (the steering wheel inertia and the motor inertia) are changed integrally (hereinafter referred to an integrated mode) and a vibration mode where the two kinds of inertia are relatively displaced (hereinafter referred to a relative mode), the transfer characteristic P(s) is divided into the integrated mode and the relative mode.
(31) Since a transfer characteristic P.sub.n(s) of the integrated mode corresponds to a mode where infinity is set on the torsion bar rigidity K.sub.tor, it becomes the following expression 2.
(32)
(33) In the case that A(s) is a characteristic difference (a multiplicative representation) between the P(s) and the P.sub.n(s), the P(s) is expressed by the following expression 3, and a transfer characteristic of the relative mode becomes the following expression 4.
(34)
In the above expression 4, K.sub.torB.sub.STG is sufficiently smaller than other terms in a frequency band where the characteristic should be made stabilized, and can be ignored, so that the expression 4 can be approximated by the following expression 5.
(35)
(36) Since a natural frequency of the transfer characteristic 1+(s) of the relative mode generally exists in a control band of a control unit, a pole movement is necessary for stabilization. Further, the present invention performs the stabilization by using an internal model, and it is necessary to suppress an influence on disturbance sensitivity of the control unit which uses the internal model as much as possible in the control band.
(37) With respect to the disturbance sensitivity, a desirable function of the disturbance sensitivity is as shown in
(38) In the present invention, the feedback control section 60 performs the first action, and the response control section 50 performs the second action. The third action is performed by a phase compensation control section. The feedback control section 60 arranges a pole of a characteristic of the relative mode in the steering stabilization frequency domain, and the response control section 50 performs the pole-and-zero cancellation so as to cancel the characteristic of the relative mode. The phase compensation control section performs phase compensation for further stabilization.
(39) Next, the on-center control will be described.
(40) In the case of steering very slowly in the vicinity of the on-center, stick-slip can occur in an EPS. The stick-slip is a discontinuous motion occurring in driving at a slow speed in the case that a difference between static friction and dynamic friction is large and rigidity on a driving side is low. Though the difference between the static friction and the dynamic friction is basically controlled in the EPS so as not to cause a problem, a cogging torque of a motor can cause the stick-slip. Even if the stick-slip phenomenon has a very small value as a torque ripple, it becomes a factor impairing steering performance because of changing stepwise. The present invention prevents the stick-slip by enhancing dynamic rigidity of the two-inertia system.
(41) As described above, since the stick-slip occurs in the case of steering very slowly in the vicinity of the on-center, the power assist is not almost performed, and the power assist control does not function. Therefore, a control section performing the on-center control is necessary to arrange parallel to a characteristic of the power assist. In this control section arranged in parallel, a stationary gain needs to be 0 so that a stationary gain of the whole control unit agrees with the power assist gain. That is, the control section needs to be a control section having a differential characteristic. The present invention comprises the feedforward control section 40 as this control section. The feedforward control section 40 is designed so as to satisfy the above condition, and is designed as a phase compensator so as to set the stability and the responsiveness independently.
(42) Thus, the present invention can improve the stability without deteriorating the responsiveness by stabilizing the characteristic of the relative mode by the pole movement and the pole-and-zero cancellation in the region where the power assist is performed, and by making the stability and the responsiveness possible to set independently by the phase compensation and suppressing the stick-slip in the vicinity of the on-center where the power assist is not performed.
(43) Moreover, it is possible to transform the configuration of the steering system shown in
(44) Hereinafter, an embodiment of the present invention will be described with reference to the accompanying drawings.
(45)
(46) A data transforming section 70 calculates the steering wheel angle d by means of a motor angle m and the steering torque Ts. The feedforward control section 40 performs the on-center control by the phase compensation using the steering wheel angle d, and outputs a compensation signal Cs1. The feedback control section 60 performs the first action of arranging the pole of the characteristic of the relative mode in the steering stabilization frequency domain by using the motor angle m, and outputs a compensation signal Cs2. Though the feedback control section 60 inputs the steering angle g in
(47) Each section will be described in detail.
(48) First, the feedback control section 60 will be described.
(49) The feedback control section 60 makes a characteristic (a pole arrangement) being easy to stabilize of the characteristic (1+(s)) of the relative mode by raising a resonance ratio of the two-inertia system.
(50) The resonance ratio of the two-inertia system is a ratio of a resonance frequency to an anti-resonance frequency, and in the case of ignoring the damping factor of the two-inertia system, an anti-resonance frequency a, a resonance frequency r and a resonance ratio H are expressed by the following expression 6, expression 7 and expression 8 respectively.
(51)
(52) A damping factor of the transfer characteristic of the relative mode expressed by the expression 5 can be expressed by a function of the resonance ratio H expressed as the following expression 10 in accordance with the following expression 9 obtained by transforming the expression 5 and the expression 8.
(53)
(54) Since H1/H in the expression 10 is a monotone increasing function of the H as shown in
(55) The adjustment of the J.sub.h is performed by means of the state feedback as shown in
(56)
Therefore, by multiplying a motor angular acceleration m obtained by second-order-differentiating the motor angle m by the feedback gain ka and feeding back the multiplication result to the motor torque Tm additionally, a transfer characteristic after the addition can be compensated as a characteristic obtained by subtracting the feedback gain ka from the motor inertia. That is, it is possible to adjust the J.sub.STG by adjusting the feedback gain ka.
(57) The feedback control section 60 comprises the second order differential section 610 and the gain section 620 that are enclosed with the broken line in
(58) Moreover, the feedback control section 60 performs the pole arrangement by using the state feedback, however, since various controllers effective in the pole arrangement of the two-inertia system have been proposed, it is possible to use them. Further, it is possible to feed back data other than the motor angle m.
(59) Next, the response control section 50 will be described.
(60) The response control section 50 performs the pole-and-zero cancellation with respect to the characteristic (the pole) obtained by performing the pole arrangement. Since the characteristic which should be cancelled is the transfer characteristic 1+(s) of the relative mode expressed by the expression 5, the response control section 50 has, for example, the characteristic C.sub.1(s) expressed by the following expression 12 in order to perform the pole-and-zero cancellation.
(61)
a.sub.1 is a parameter for adjustment, and the a.sub.1 and the B.sub.STG are adjusted so that the damping factor of the characteristic of the relative mode becomes a desired value. An appropriate damping factor for stabilization is more than or equal to about 0.6.
(62) Finally, the feedforward control section 40 will be described.
(63) The feedforward control section 40 needs to have a characteristic where the stationary gain is 0 and which becomes a differential characteristic, as described above, in order to prevent the stick-slip.
(64) Since a steering torque is small in the vicinity of the on-center and a torque fed back to a steering wheel side can be ignored, the block diagram expressing the model shown in
(65) A closed-loop characteristic in
(66)
In the case of C.sub.s1(s)=K.sub.d.Math.s (K.sub.d is an adjustment gain), since the STG(s) is expressed by the following expression 14, the above expression 13 is transformed into the following expression 15, so that the damping is improved, however, the responsiveness is also changed.
(67)
(68) Therefore, since there is no degree of freedom of designing the stability and the responsiveness independently if the above expression 15 is as it is, providing the feedforward control section 40 enables the stability and the responsiveness to be set independently as shown in
(69)
K.sub.dd is an adjustment gain. Since the feedforward control section 40 affects the responsiveness, introducing the K.sub.dd enables the stability and the responsiveness to be set independently.
(70) Since the steering wheel angle d is inputted into the feedforward control section 40, the data transforming section 70 is provided at the front stage of the feedforward control section 40, the data transforming section 70 calculates the steering wheel angle d by using the steering torque Ts and the motor angle m in accordance with the following expression 18 derived from the relation that the g(s) is proportional to the m and the configuration shown in
(71)
g is a proportionality constant. The data transforming section 70 may not input the motor angle m, but may input the steering angle g (=m/g), and the feedforward control section 40 may directly input the steering wheel angle d detected by a sensor or the like not through the data transforming section 70.
(72) Moreover, it is possible to set the stability and the responsiveness independently by using a characteristic other than the phase compensation characteristic as the characteristic of the feedforward control section 40.
(73) In the above configuration, an operating example of the first embodiment will be described with reference to a flowchart shown in
(74) When the operation is started, a vehicle speed V, the steering torque Ts and the motor angle m are inputted (Step S10), the vehicle speed V is inputted into the current command value calculating section 31, the steering torque Ts is inputted into the current command value calculating section 31 and the data transforming section 70, and the motor angle m is inputted into the data transforming section 70 and the feedback control section 60.
(75) The data transforming section 70 calculates the steering wheel angle d by using the inputted steering torque Ts and motor angle m in accordance with the expression 18, and outputs the steering wheel angle d to the feedforward control section 40 (Step S20).
(76) The feedforward control section 40 calculates the compensation signal Cs1 by transforming the steering wheel angle d using the phase compensation characteristic C.sub.3(s) expressed by the expression 16, and outputs the compensation signal Cs1 to the subtracting section 345 (Step S30). Moreover, preadjusted values are set on the Kd and the Kdd in the expression 16 so as to obtain desired damping and responsiveness.
(77) In the feedback control section 60, the motor angle m is inputted into the second order differential section 610, where the motor angular acceleration am is calculated, and the motor angular acceleration am is inputted into the gain section 620. The gain section 620 multiplies the motor angular acceleration am by the feedback gain ka, and outputs the multiplication result as the compensation signal Cs2 to the subtracting section 345 (Step S40). Moreover, a preadjusted value is set on the feedback gain ka so that the resonance ratio H becomes a desired value.
(78) The compensation signal Cs2 is subtracted from the compensation signal Cs1 at the subtracting section 345, and the subtraction result is inputted as a compensation signal Cs3 into an adding section 348 (Step S50).
(79) The current command value Iref1 that the current command value calculating section 31 has calculated by the vehicle speed V and the steering torque Ts, is added to the compensation signal Cs3 at the adding section 348, and the addition result is inputted as the current command value Irefa into the response control section 50 (Step S60).
(80) The response control section 50 transforms the current command value Irefa in accordance with the expression 12, and outputs the transformation result as the current command value Irefb (Step S70). Moreover, preadjusted values are set on the a.sub.1 and the B.sub.STG in the expression 12 so that the damping factor of the characteristic of the relative mode becomes a desired value.
(81) Next, a second embodiment of the present invention will be described.
(82) The first embodiment is configured on the basis of the configuration of the steering system shown in
(83) The response control section 51 inputs a current command value Irefc generated by compensating the current command value Iref1 by the compensation signal Cs1 outputted from the feedforward control section 40, and outputs a current command value Irefd calculated by the pole-and-zero cancellation. The response control section 52 inputs the compensation signal Cs2 outputted from the feedback control section 60, and outputs a compensation signal Cs4. The current command value Irefd is compensated at the subtracting section 347 by the compensation signal Cs4, and the compensation result is outputted as a current command value Irefe. The current command value Irefe is inputted into the current limiting section 33 shown in
(84) An operating example of the second embodiment will be described with reference to a flowchart shown in
(85) When the operation is started, the same operations as the steps S10 to S30 in the operating example of the first embodiment are performed.
(86) The compensation signal Cs1 outputted from the feedforward control section 40 and the current command value Iref1 are added at the adding section 348, and the addition result is inputted as the current command value Irefc into the response control section 51 (Step S31).
(87) The response control section 51 transforms the current command value Irefc in accordance with the expression 12, and outputs the transformation result as the current command value Irefd to the subtracting section 347 (Step S32).
(88) In the feedback control section 60, the same operation as the step S40 in the operating example of the first embodiment is performed, and the compensation signal Cs2 is outputted to the response control section 52 (Step S40).
(89) The response control section 52 transforms the compensation signal Cs2 in accordance with the expression 12, and outputs the transformation result as the compensation signal Cs4 to the subtracting section 347 (Step S41).
(90) The compensation signal Cs4 is subtracted from the current command value Irefd at the subtracting section 347, and the subtraction result is outputted as the current command value Irefe (Step S42).
(91) Next, a third embodiment of the present invention will be described.
(92) The feedback control section 60 in the first embodiment feeds back the motor angular acceleration multiplied by the feedback gain adjusted so as to raise the resonance ratio of the two-inertia system in order to make the characteristic (the pole arrangement) being easy to stabilize of the characteristic of the relative mode. However, a characteristic of a current control section can affect the effect obtained by this feedback. Here, the current control section indicates an area from the input of the current command value Irefb to the output of a motor current driving the motor 20.
(93) Though it is possible to enhance the damping factor of the characteristic of the relative mode by the feedback of the motor angular acceleration, at the same time, a feedback causing reduction of the damping factor operates by delay in the current control section, and the effect of the feedback of the motor angular acceleration can be reduced. For the influence of the delay in the current control section, the present embodiment provides damping by adding a phase advance characteristic, and enhances the damping factor.
(94)
(95) A characteristic (a phase advance characteristic) C.sub.LEAD(s) that the phase advance compensating section 650 has, is expressed by the following expression 19.
(96)
.sub.L, and .sub.H are phase advance compensation parameters.
(97) It is possible to efficiently provide the damping for a pole after the arrangement by matching a frequency where an amount of phase advance obtained by the characteristic C.sub.LEAD(s) becomes the maximum with a frequency of the arranged pole. Since the frequency .sub.MAX where the amount of the phase advance becomes the maximum is calculated in accordance with the following expression 20, the .sub.L and the .sub.H of the characteristic C.sub.LEAD(s) are designed so that the .sub.MAX agrees with the frequency of the pole arranged by the feedback of the motor angular acceleration.
.sub.MAX={square root over (.sub.L.sub.H)}[Expression 20]
(98) In the feedback control section 61 of the third embodiment, the motor angular acceleration am that is multiplied by the feedback gain ka by the same operations as the second order differential section 610 and the gain section 620 in the feedback control section 60 of the first embodiment, is inputted into the phase advance compensating section 650, the phase advance compensating section 650 performs phase advance compensation by the characteristic C.sub.LEAD(s) expressed by the expression 19, and outputs the result of the phase advance compensation as the compensation signal Cs2.
(99) Next, a fourth embodiment of the present invention will be described.
(100)
(101) The phase compensation control section 80 performs the third action, that is, an action for further stabilization with respect to the characteristic obtained by performing the pole-and-zero cancellation in order to improve the robust stability. Specifically, performing phase compensation enables the stabilization. As a phase compensation characteristic, it is possible to use, for example, a characteristic of a phase compensating section shown in the publication of Japanese Patent No. 3922010 B2.
(102) In the fourth embodiment, the current command value Iref1 which the current command value calculating section 31 outputs is inputted into the phase compensation control section 80, the phase compensation control section 80 performs the phase compensation with respect to the current command value Iref1, and outputs the result of the phase compensation as a current command value Ireff to the adding section 348.
(103) Moreover, it is possible to use a phase compensation characteristic other than the characteristic described in the publication of Japanese Patent No. 3922010 B2 as a phase compensation characteristic.
EXPLANATION OF REFERENCE NUMERALS
(104) 1 steering wheel 2 column shaft (steering shaft, handle shaft) 10 torque sensor 12 vehicle speed sensor 20 motor 30 control unit (ECU) 31 current command value calculating section 40 feedforward control section 50, 51, 52 response control section 60, 61 feedback control section 70 data transforming section 80 phase compensation control section 610 second order differential section 620 gain section 650 phase advance compensating section