The present invention relates to a control unit of an electric power steering apparatus that drives a motor on the basis of a current command value, and assists and controls a steering system, and in particular to a control unit of an electric power steering apparatus that improves stability without deteriorating responsiveness on steering of a steering system.
An electric power steering apparatus (EPS) which assists and controls a steering system of a vehicle by means of a rotational torque of a motor, applies a driving force of the motor as a steering assist torque (an assist torque) to a steering shaft or a rack shaft by means of a transmission mechanism such as gears or a belt through a reduction mechanism. In order to accurately generate the steering assist torque, such a conventional electric power steering apparatus performs feedback control of a motor current. The feedback control adjusts a voltage supplied to the motor so that a difference between a current command value and a detected motor current value becomes small, and the adjustment of the voltage supplied to the motor is generally performed by an adjustment of a duty ratio of pulse width modulation (PWM) control.
A general configuration of the conventional electric power steering apparatus will be described with reference to
Moreover, the steering angle sensor 14 is not essential, it does not need to be provided, and it is possible to obtain the steering angle from a rotation sensor such as a resolver connected to the motor 20.
A controller area network (CAN) 100 exchanging various information of a vehicle is connected to the control unit 30, and it is possible to receive the vehicle speed V from the CAN 100. Further, it is also possible to connect a non-CAN 101 exchanging a communication, analog/digital signals, a radio wave or the like except with the CAN 100 to the control unit 30.
The control unit 30 mainly comprises an MCU (including a CPU, an MPU and so on), and general functions performed by programs within the MCU are shown in
Functions and operations of the control unit 30 will be described with reference to
A compensation signal CM from a compensation signal generating section 34 is added to the adding section 32A, and a characteristic compensation of the steering system is performed by the addition of the compensation signal CM so as to improve a convergence, an inertia characteristic and so on. The compensation signal generating section 34 adds a self-aligning torque (SAT) 34-3 and an inertia 34-2 at an adding section 34-4, further adds the result of addition performed at the adding section 34-4 with a convergence 34-1 at an adding section 34-5, and then outputs the result of addition performed at the adding section 34-5 as the compensation signal CM.
In such an electric power steering apparatus (EPS), since stability and responsiveness of an operation are contrary characteristics, compatibility of both characteristics becomes a problem. In particular, in the case of considering developing the EPS to a driving support apparatus, it is desired to stabilize a vibration mode of a two-inertia system consisting of steering wheel inertia and motor inertia which are constituting the EPS, and suppress a vibration without deteriorating responsiveness.
There is, for example, a control apparatus described in the publication of Japanese Patent No. 3493806 B2 (Patent Document 1) as such an apparatus improving the stability of the vibration mode. The control apparatus described in Patent Document 1 improves stability and responsiveness of a control system by comprising a stability compensator that operates so as to counteract a peak of a resonance frequency of a resonance system consisting of an inertia element and a spring element which constitute an EPS. The stability compensator performs pole-and-zero cancellation in order to counteract the peak of the resonance frequency.
A control unit described in the publication of Japanese Patent No. 3385763 B2 (Patent Document 2) improves stability when a steering wheel is located at the center (stability at the on-center). In the vicinity of the on-center, that is, in the case that a vehicle travels straight, quick steering is not performed, and there are time that correction of a current command value is not performed sufficiently, so that the control unit detects the straight traveling state of the vehicle, and improves the stability in the vicinity of the on-center by adding a correction value to the current command value in the straight traveling state.
However, since the apparatus disclosed in Patent Document 1 suppresses the peak of the resonance frequency even if there is discordance at a corner frequency of an actual control target by setting a damping factor by which damping works sufficiently to a characteristic of a control target of an approximation model, there is a possibility that a little deterioration occurs in the responsiveness. Further, since the apparatus does not distinguish control in the vicinity of the on-center from one elsewhere, there is a possibility that a little instability occurs in the stability in the vicinity of the on-center.
Since the unit disclosed in Patent Document 2 mainly aims to improve the stability in the vicinity of the on-center, responsiveness in a vehicle state including a state at the on-center is not described, and is not clear.
The present invention has been developed in view of the above-described circumstances, and an object of the present invention is to provide a control unit of an electric power steering apparatus that stabilizes a vibration mode of a two-inertia system consisting of steering wheel inertia and motor inertia without deteriorating responsiveness.
The present invention relates to 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, the above-described object of the present invention is achieved by that comprising: 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.
The above-described object of the present invention is more effectively achieved by that wherein the response control section inputs a difference between the first compensation signal and the second compensation signal; or wherein a first response control section that inputs the first compensation signal and a second response control section that inputs the second compensation signal are comprised as the response control section, and wherein a difference between an output of the first response control section and an output of the second response control section is used for adjustment of the current command value; or wherein the feedback control section arranges a pole of a characteristic of a vibration mode where steering wheel inertia and motor inertia that constitute the electric power steering apparatus are relatively displaced in a steering stabilization frequency domain, wherein the response control section performs pole-and-zero cancellation so as to cancel the characteristic of the vibration mode, and wherein the feedforward control section enables stability and responsiveness of the characteristic of the vibration mode at on-center to be set independently; or wherein the steering stabilization frequency domain ranges in about 20 Hz and over; or wherein the feedback control section performs pole arrangement with respect to the characteristic of the vibration mode by raising a resonance ratio of a two-inertia system consisting of the steering wheel inertia and the motor inertia; or wherein the resonance ratio is more than or equal to about 2; or wherein the feedback control section provides the pole with damping by a phase advance characteristic; or wherein a damping factor of the characteristic of the vibration mode becomes more than or equal to a predetermined value by the pole-and-zero cancellation performed by the response control section; or wherein the predetermined value is about 0.6; or wherein the feedforward control section performs phase compensation; or wherein the control unit comprises a phase compensation control section that performs phase compensation with respect to the current command value before the response control section adjusts the current command value; or wherein the input angle information is a steering wheel angle, and the output angle information is a steering angle.
The control unit of the electric power steering apparatus of the present invention enables improvement of stability without deteriorating responsiveness by setting a characteristic obtained by combining a pole movement and pole-and-zero cancellation to a characteristic of a two-inertia system consisting of the steering wheel inertia and the motor inertia, and enhancing degree of freedom in setting a characteristic in the vicinity of the on-center.
In the accompanying drawings:
The present invention aims to improve stability without deteriorating responsiveness on steering of a steering system.
From
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
As shown in
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.
First, the power assist control will be described.
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
From
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.
Since a transfer characteristic Pn(s) of the integrated mode corresponds to a mode where infinity is set on the torsion bar rigidity Ktor, it becomes the following expression 2.
In the case that A(s) is a characteristic difference (a multiplicative representation) between the P(s) and the Pn(s), the P(s) is expressed by the following expression 3, and a transfer characteristic of the relative mode becomes the following expression 4.
In the above expression 4, KtorBSTG 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.
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.
With respect to the disturbance sensitivity, a desirable function of the disturbance sensitivity is as shown in
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.
Next, the on-center control will be described.
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.
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.
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.
Moreover, it is possible to transform the configuration of the steering system shown in
Hereinafter, an embodiment of the present invention will be described with reference to the accompanying drawings.
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
Each section will be described in detail.
First, the feedback control section 60 will be described.
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.
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.
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.
Since H−1/H in the expression 10 is a monotone increasing function of the H as shown in
The adjustment of the Jh is performed by means of the state feedback as shown in
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 JSTG by adjusting the feedback gain ka.
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
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.
Next, the response control section 50 will be described.
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 C1(s) expressed by the following expression 12 in order to perform the pole-and-zero cancellation.
a1 is a parameter for adjustment, and the a1 and the BSTG 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.
Finally, the feedforward control section 40 will be described.
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.
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
A closed-loop characteristic in
In the case of Cs1(s)=Kd·s (Kd 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.
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
Kdd is an adjustment gain. Since the feedforward control section 40 affects the responsiveness, introducing the Kdd enables the stability and the responsiveness to be set independently.
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
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.
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.
In the above configuration, an operating example of the first embodiment will be described with reference to a flowchart shown in
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.
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).
The feedforward control section 40 calculates the compensation signal Cs1 by transforming the steering wheel angle θd using the phase compensation characteristic C3(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.
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.
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).
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).
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 a1 and the BSTG in the expression 12 so that the damping factor of the characteristic of the relative mode becomes a desired value.
Next, a second embodiment of the present invention will be described.
The first embodiment is configured on the basis of the configuration of the steering system shown in
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
An operating example of the second embodiment will be described with reference to a flowchart shown in
When the operation is started, the same operations as the steps S10 to S30 in the operating example of the first embodiment are performed.
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).
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).
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).
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).
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).
Next, a third embodiment of the present invention will be described.
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.
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.
A characteristic (a phase advance characteristic) CLEAD(s) that the phase advance compensating section 650 has, is expressed by the following expression 19.
ωL, and ωH are phase advance compensation parameters.
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 CLEAD(s) becomes the maximum with a frequency of the arranged pole. Since the frequency ωMAX where the amount of the phase advance becomes the maximum is calculated in accordance with the following expression 20, the ωL and the ωH of the characteristic CLEAD(s) are designed so that the ωMAX agrees with the frequency of the pole arranged by the feedback of the motor angular acceleration.
ωMAX=√{square root over (ωLωH)} [Expression 20]
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 CLEAD(s) expressed by the expression 19, and outputs the result of the phase advance compensation as the compensation signal Cs2.
Next, a fourth embodiment of the present invention will be described.
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.
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.
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.
Number | Date | Country | Kind |
---|---|---|---|
2015-145208 | Jul 2015 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2016/071236 | 7/20/2016 | WO | 00 |