This is a National Stage of International Application No. PCT/JP2014/052495 filed Feb. 4, 2014, claiming priority based on Japanese Patent Application No. 2013-078517 filed Apr. 4, 2013 and Japanese Patent Application No. 2013-084511 filed Apr. 15, 2013, the contents of all of which are incorporated herein by reference in their entirety.
The present invention relates to an electric power steering apparatus that has functions of an automatic steering control (parking support mode) and a manual steering control and provides a steering system of a vehicle with an assist force generated by a motor, and in particular to an electric power steering apparatus capable of further improving safety by switching so as to give priority to a steering by a driver in the case that a steering direction of the automatic control is different from a direction of the steering wheel steering by the driver when the driver steers a steering wheel during the automatic steering control, and improving steering performance by assigning a gradual variation gain to a motor velocity command value in the automatic steering control and concurrently providing a limiter capable of changing (variable) a limit value.
An electric power steering apparatus which provides a steering mechanism of a vehicle with a steering assist torque (an assist torque) by means of a rotational torque of a motor, applies a driving force of the motor as the steering 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 (EPS) performs a feedback control of a motor current. The feedback control adjusts a voltage supplied to the motor so that a difference between a steering assist command value (a current command value) and a detected motor current value becomes small, and the adjustment of the voltage applied to the motor is generally performed by an adjustment of duty command values of a PWM (Pulse Width Modulation) control.
A general configuration of the conventional electric power steering apparatus will be described with reference to
In such an electric power steering apparatus, the control unit 100 has a configuration such as disclosed in Japanese Published Unexamined Patent Application No. 2002-369565 A.
As shown in
The control unit 100 comprises a torque system control unit 110 indicated by a dashed line that performs a control by using the steering torque Th and a motor system control unit 120 indicated by a dashed-dotted line that performs a control relating to driving of the motor 20. The torque system control unit 110 comprises an assist amount calculating section 111, a differential control section 112, a yaw rate convergence control section 113, a robust stabilization compensating section 114 and an SAT (Self Aligning Torque) estimation feedback section 115, addition sections 116A and 116B, and a subtraction section 116C. Further, the motor system control unit 120 comprises a compensating section 121, a disturbance estimating section 122, a motor angular velocity calculating section 123, a motor angular acceleration calculating section 124, a motor characteristic compensating section 125, and addition sections 126A and 126B.
The steering torque Th is inputted into the assist amount calculating section 111, the differential control section 112, the yaw rate convergence control section 113 and the SAT estimation feedback section 115, and all of them input the vehicle velocity Vel as a parameter. The assist amount calculating section 111 calculates an assist torque amount based on the steering torque Th. The yaw rate convergence control section 113 inputs the steering torque Th and a motor angular velocity ω, and brakes a movement that the steering wheel whirls to improve the convergence of yaw of the vehicle. Further, the differential control section 112 enhances control responsibility in the vicinity of a neutral point of the steering and realizes a smooth steering. Moreover, the SAT estimation feedback section 115 inputs the steering torque Th, a signal obtained in the addition section 116A by adding the output of the differential control section 112 to the output of the assist amount calculating section 111, the motor angular velocity ω calculated by the motor angular velocity calculating section 123 and a motor angular acceleration α from the motor angular acceleration calculating section 124 to estimate an SAT, performs signal processing by using a feedback filter with respect to the estimated SAT, and provides the steering wheel with suitable road information as a reaction force.
Further, a signal that is obtained in the addition section 116B by adding the output of the yaw rate convergence control section 113 to a signal obtained in the addition section 116A by adding the output of the differential control section 112 to the output of the assist amount calculating section 111, is inputted into the robust stabilization compensating section 114 as an assist amount AQ. For example, the robust stabilization compensating section 114 is a compensating section disclosed in Japanese Published Unexamined Patent Application No. H8-290778 A, removes peak values in a resonance frequency of a resonance system comprised of an inertia element and a spring element that are included in the detected torque, and compensates a phase shift of the resonance frequency that disturbs the responsibility and the stability of the control system. By subtracting the output of the SAT estimation feedback section 115 from the output of the robust stabilization compensating section 114 in the subtraction section 116C, an assist amount Ia capable of transmitting the road information to the steering wheel as the reaction force, is obtained.
Moreover, the motor angular velocity calculating section 123 calculates the motor angular velocity ω based on the motor inter-terminal voltage Vm and the motor current value i, and the motor angular velocity ω is inputted into the motor angular acceleration calculating section 124, the yaw rate convergence control section 113 and the SAT estimation feedback section 115. The motor angular acceleration calculating section 124 calculates the motor angular acceleration α based on the inputted motor angular velocity ω, and the calculated motor angular acceleration α is inputted into the motor characteristic compensating section 125. In the addition sections 126A, the assist amount Ia obtained by subtracting the output of the SAT estimation feedback section 115 from the output of the robust stabilization compensating section 114, is added to the output Ic of the motor characteristic compensating section 125, and then this added signal is inputted into the compensating section 121 comprised of a differential compensating section or the like as a current command value Ir. A signal that is obtained by adding the output of the disturbance estimating section 122 in the addition section 126B to a current command value Ira obtained by compensating the current command value Ir by means of the compensating section 121, is inputted into the motor driving section 21 and the disturbance estimating section 122. The disturbance estimating section 122 is an apparatus disclosed in Japanese Published Unexamined Patent Application No. H8-310417 A, is capable of maintaining a desired motor control characteristic in an output reference of the control system based on a signal obtained by adding the output of the disturbance estimating section 122 to the current command value Ira compensated by the compensating section 121 that is the control target of the motor output and the motor current value i, and does not lose the stability of the control system.
In such an electric power steering apparatus, recently, vehicles equipped with a parking support function (parking assist) that switch between the automatic steering control and the manual steering control appear. In a vehicle equipped with the parking support function, a target steering angle is set based on data from a camera (image), a distance sensor or the like, and the automatic steering control which makes an actual steering angle follow up the target steering angle, is performed.
In an electric power steering apparatus having conventionally well-known functions of the automatic steering control (parking support mode) and the manual steering control, a back parking and a parallel parking are performed automatically by controlling an actuator (a motor) base on a pre-stored relation between a moving distance of the vehicle and a turning angle.
Then, a conventional steering control apparatus calculates a motor current command value so as to make an actual steering angle coincide with the target steering angle set dependent on the vehicle and realizes the automatic steering control. For example, in an automatic steering device disclosed in Japanese Patent No. 4057955 B2 (Patent Document 1), when switching from a steering angle control to a torque assist control, an uncomfortable feeling in control switching is reduced by changing a fade shift time depending on an assist torque amount. Further, in an automatic steering device disclosed in Japanese Patent No. 4110040 B2 (Patent Document 2), a target steering angle is corrected so as to be capable of reaching a target position in the case that a steering torque is large.
During the automatic steering control of an electric power steering apparatus that performs an automatic steering which makes an actual steering angle follow up a target steering angle, in the case of determining that the driver steered the steering wheel, it is preferred to terminate the automatic control and smoothly switch to the assist control of the manual steering control.
Although the automatic steering control performs a control so as to make the actual steering angle coincide with the target steering angle, in the case that the driver operates the steering mechanism to apply the steering torque, the actual steering angle departs from the target steering angle. Therefore, the automatic steering control outputs a motor current command value in a direction opposite to the steering torque so as to make the actual steering angle coincide with the target steering angle and oppose against the steering torque.
On the other hand, since the assist control outputs so as to assist the steering torque, the assist control outputs a motor current command value in the same direction as the steering torque. Therefore, in switching from the automatic steering control in the case that the steering torque is applied to the manual steering control, since respective outputs become opposite directions, the automatic steering control is gradually switched to the manual steering control by a fade processing after the steering torque is applied by the driver and a temporary assist in a direction opposite to the steering torque by the automatic steering control is performed. That is to say, an assist in the same direction as the steering torque is performed. This becomes a feeling of being caught in switching from the automatic steering control to the manual steering control for the driver, i.e. becomes the uncomfortable feeling.
In the case that the automatic steering is realized in the electric power steering apparatus (EPS), a configuration that has the steering angle control of the automatic steering control and the assist control (a torque control) of the manual steering control separately and switches between these outputs, is commonly used. A position and velocity control having excellent performances in a responsibility and a disturbance suppressibility is used in the steering angle control, the position control is comprised of a P (Proportional) control, and the velocity control is comprised of a PI (Proportional and Integral) control or the like. When switching abruptly by a switch or the like in switching of outputs, since the current command value varies rapidly and the steering wheel behavior becomes unnatural, the uncomfortable feeling is given to the driver. Therefore, a method that suppresses a rapid variation in the current command value by multiplying a steering angle control command value and an assist control command value by a gradual variation gain to gradually switch, is used.
However, in this method, since the steering angle control command value is limited by the gradual variation gain in switching and outputted as the current command value, with respect to the steering angle control command value, the current command value becomes small as much as the amount limited. Due to this limit, since an actual velocity of the motor becomes slow with respect to the motor velocity command value, a deviation occurs between the motor velocity command value and the actual velocity and an integral value of the I-control within the velocity control accumulates, hence a larger steering angle control command value is outputted from the velocity control. As a result of this, in a state that the gradual variation gain gradually becomes large, since the limit by the gradual variation gain is eased, the steering angle control command value becomes an excessive value as the gradual variation gain becomes large, the steering wheel excessively responds to the motor velocity command value, consequently the uncomfortable feeling is given to the driver.
As a technique for being multiplied by the gradual variation gain, for example, there is a steering control apparatus disclosed in Japanese Patent No. 3912279 B2 (Patent Document 3). In the apparatus of Patent Document 3, a method that controls so as to gradually increase the steering angle velocity at the start of the steering angle control to reduce the uncomfortable feeling given to the driver that is caused by a steering wheel's rapid variation at the start of the steering angle control, is proposed.
However, in the method of Patent Document 3, when the gradual variation starts, since the gradual variation continues to increase until reaching an upper limit value, there is a problem that the integral value of the I control excessively accumulates.
The present invention has been developed in view of the above-described circumstances, and the first object of the present invention is to provide a high-performance electric power steering apparatus that is capable of smoothly switching the steering when the driver steers the steering wheel during the automatic steering control so as not to give the uncomfortable feeling to the driver. Further, the second object of the present invention is to provide a high-performance electric power steering apparatus that is capable of performing an automatic control that the driver and fellow passengers do not feel surprise and a discomfort feeling by the suppressing steering behavior and the vehicle behavior that have a rapid variation at the start of the steering by the automatic steering control in a vehicle having the automatic steering control (the parking support mode) and the manual steering control.
The present invention relates to an electric power steering apparatus that calculates a first motor current command value based on a steering torque and a vehicle velocity, performs an assist control of a steering system by driving a motor based on said first motor current command value, and has a function for switching between an automatic steering control and a manual steering control, the above-described object of the present invention is achieved by that comprising: a target steering angle correcting section that outputs a target steering angle correction value to said steering torque; a correction output section that corrects a target steering angle with said target steering angle correction value to output a corrected target steering angle; a steering angle control section that calculates a second motor current command value based on said corrected target steering angle from said correction output section, an actual steering angle and a motor angular velocity of said motor; and a switching section that inputs said first motor current command value and said second motor current command value to switch, wherein said switching section is switched depending on a switching command of said automatic steering control and said manual steering control, and said motor is drive-controlled based on said second motor current command value in said automatic steering control.
Further, the present invention relates to an electric power steering apparatus that performs an assist control of a steering system by driving a motor based on a motor current command value, and has a function for switching between an automatic steering control and a manual steering control, the above-described object of the present invention is achieved by that comprising: a torque control section that calculates a first current command value in said manual steering control based on a steering torque and a vehicle velocity; a steering angle control section that calculates a second current command value in said automatic steering control so as to bring an actual steering angle close to a target steering angle set based on a moving target position of a vehicle; a gain adjusting section that generates a steering angle control gradual variation gain and an assist control gradual variation gain in said automatic steering control; and an output section that multiplies said first current command value by said assist control gradual variation gain, multiplies said second current command value by said steering angle control gradual variation gain, performs an addition of said respective multiplication results and makes a result of said addition as said motor current command value.
According to an electric power steering apparatus (the first embodiment) of the present invention, although the steering angle control of the steering wheel is performed in the automatic steering control such as the parking support, the automatic running or the like, when the steering torque is applied by the driver, the target steering angle is corrected so as to become the same direction as a direction that the steering torque is applied, and the steering angle control is performed so as to coincide with that target steering angle. Thereby, in the case of adding together outputs of the steering angle control with respect to the corrected target steering angle and the assist control by the steering torque with a certain ratio each other, it is possible to make the direction of the output of the automatic steering control coincide with the direction of the output of the manual steering control, since the control outputs become hard to interfere with each other, it is possible to reduce the uncomfortable feeling given to the driver that occurs in switching. This also leads to improvement of safety with respect to the driver.
Further, in the present invention, with respect to a rapid target steering angle, since the smoothing of the rapid target steering angle is performed to control, the driver does not feel an uneasy feeling even in the automatic operation.
According to an electric power steering apparatus (the second embodiment) of the present invention, the motor velocity command value calculated within a steering angle control section is gradually varied by being multiplied by the gradual variation gain, upper and lower limit values of that output are limited by a limiter and the limit value of the limiter is changed (varied) depending on the gradual variation gain. Therefore, the steering angle control command value is limited in switching of the manual steering control (the assist control) and the automatic steering control (the steering angle control), it can be prevented that the integral value of the I-control within the velocity control excessively accumulates. As a result of this, it is possible to suppress an unintended steering wheel behavior, and it is possible to reduce the uncomfortable feeling given to the driver.
In the accompanying drawings:
Although the steering angle control of the steering wheel is performed in the automatic steering control such as the parking support, the automatic running or the like, when the steering torque is applied by the steering wheel operation of the driver, the target steering angle is corrected so as to become the same direction as a direction that the steering torque is applied, and the steering angle control is performed so as to coincide with that target steering angle. Thereby, in the case of adding together outputs of the steering angle control with respect to the corrected target steering angle and the assist control by the steering torque with a certain ratio each other, it is possible to make the output direction of the automatic steering control coincide with the output direction of the manual steering control, and the control outputs become hard to interfere with each other. As a result of this, it is possible to reduce the uncomfortable feeling given to the driver that occurs in switching the steering mode.
Hereinafter, embodiments of the present invention will be described in detail with reference to the accompanying drawings.
The vehicle side ECU 130 comprises a switching command section 131 that outputs a switching command SW of the automatic steering control or the manual steering control based on a button, a switch or the like indicating the intention of a driver and a target steering angle generating section 132 that generates a target steering angle θt based on a signal from a camera (image), a distance sensor or the like. Further, an actual steering angle θr detected by a steering angle sensor 152 provided on the column shaft (the steering shaft), is inputted into a steering angle control section 200 within the EPS side ECU 140 through the vehicle side ECU 130. The steering angle sensor 152 may be a steering angle estimation value based on the column shaft (including an intermediate shaft, a pinion shaft), the displacement of rack of the rack and pinion or a wheel velocity.
The switching command section 131 outputs the switching command SW based on a signal that identifies entering the automatic steering control, for example, based on the button or the switch indicating the intention of the driver that is provided on a dashboard or on the periphery of the steering wheel, or a vehicle state signal represented by a parking mode or the like provided on the shift, and then the switching command SW is inputted into a switching section 142 within the EPS side ECU 140. Further, the target steering angle generating section 132 generates the target steering angle θt based on data from the camera (image), the distance sensor or the like by means of a publicly-known method, and inputs the generated target steering angle θt into the steering angle control section 200 within the EPS side ECU 140.
The EPS side ECU 140 comprises a torque control section 141 that outputs a motor current command value Itref calculated as previously described based on the steering torque Th and the vehicle velocity Vel, a target steering angle correcting section 230 that inputs the steering torque Th and has a dead band for performing a target steering angle correction, a correction output section 145 that corrects the target steering angle θt with a target steering angle correction value θha to output, the steering angle control section 200 that calculates a motor current command value Imref for performing the steering angle automatic control based on a corrected target steering angle θt0 from the correction output section 145, the actual steering angle θr and the motor angular velocity ω and outputs the calculated motor current command value Imref, the switching section 142 that switches between the motor current command values Itref and Imref depending on the switching command SW, a current control/drive section 143 that drive-controls the motor 150 based on the motor current command value (Itref or Imref) from the switching section 142, and a motor angular velocity calculating section 144 that calculates the motor angular velocity ω based on the motor rotation angle θs from the rotation angle sensor 151. The switching section 142 switches between a torque control mode (the manual steering control) by the torque control section 141 and the automatic steering control by the steering angle control section 200 based on the switching command SW from the switching command section 131 of the vehicle side ECU 130, in the manual steering control, outputs the motor current command value Itref, and in the automatic steering control, outputs the motor current command value Imref. Further, the current control/drive section 143 comprises a PI current control section, a PWM control section, an inverter and so on.
Although the target steering angle correcting section 230 outputs the target steering angle correction value θha in a rapid steering performed in a case such as occurrence of abnormality, in particular in the case of a large steering torque, as shown in
In addition, a characteristic of
The steering angle control section 200 has a configuration shown in
The rate limiter 211 performs a smoothing with respect to the correction target steering angle θt0 and outputs the smoothed the correction target steering angle θt0 when the correction target steering angle θt0 changes rapidly, for example, has a configuration shown in
In such a configuration, an entire operation example of the present invention will be described with reference to a flowchart shown in
When the operation of the steering system starts, the torque control by the torque control section 141 is carried out (Step S1), and the motor 150 is driven by using the motor current command value Itref and by means of the current control/drive section 143 (Step S2). The above operations are repeatedly performed until the switching command SW is outputted from the switching command section 131 (Step S3).
When becoming the automatic steering control and the switching command SW is outputted from the switching command section 131, the target steering angle θt is inputted from the target steering angle generating section 132 (Step S4), the actual steering angle θr is inputted from the steering angle sensor 152 (Step S5), the steering torque Th is inputted from the torque sensor 154 (Step S6), a correction by the steering torque Th is performed with respect to the target steering angle θt in the addition section 145 as the correction output section (Step S7), and the correction target steering angle θt0 is inputted (Step S8). Furthermore, the motor angular velocity ω is inputted from the motor angular velocity calculating section 144 (Step S9), and the motor current command value Imref is generated by the steering angle control section 200 (Step S100). Moreover, the target steering angle θt, the actual steering angle θr, the steering torque Th and the motor angular velocity ω can be inputted in an arbitrary order.
Thereafter, the switching section 142 is switched by the switching command SW from the switching command section 131 (Step S10), the motor 150 is driven by using the motor current command value Imref from the steering angle control section 200 and by means of the current control/drive section 143 (Step S11), and a return to the above Step S3 is made. The drive control based on the motor current command value Imref is repeatedly performed until the switching command SW is changed from the switching command section 131.
Next, an operation example of the steering angle control section 200 will be described with reference to a flowchart shown in
The correction target steering angle θt0 from the addition section 145 is inputted into the rate limiter 211 (Step S110), with respect to the correction target steering angle θt0, the rate limiting operation described as above is performed in the rate limiter 211 (Step S111) and further an LPF processing is performed in the LPF 212 (Step S112), and the target steering angle θta that passed through these processes is inputted into the subtraction section 213A. Further, the actual steering angle Or is inputted from the steering angle sensor 152 (Step S113), the subtraction of “θta−θr” is performed in the subtraction section 213A (Step S114), and the angle deviation θd being the subtraction result obtained in the subtraction section 213A is multiplied by the gain Kpp in the proportional gain section 214 and addition-inputted into the subtraction section 213B (Step S115). The motor angular velocity ω is subtraction-inputted into the subtraction section 213B (Step S116), and the velocity deviation Df between the angular velocity ωe that is multiplied by the gain Kpp and the motor angular velocity ω is obtained (Step S117).
The velocity deviation Df obtained in the subtraction section 213B is integrated by the integral section 216A, multiplied by the gain Kvi in the integral gain section 216B and addition-inputted into the subtraction section 213C (Step S120). Further, the velocity deviation Df obtained in the subtraction section 213B is multiplied by the proportional gain Kvp in the proportional gain section 216C and subtraction-inputted into the subtraction section 213C (Step S121), the subtraction is performed in the subtraction section 213C, and the motor current command value Ib is outputted (Step S122). The motor current command value Ib is limited by the upper and lower limit values in the limiter 217 (Step S123) and outputted as the motor current command value Ifref (Step S124).
In switching from the automatic steering control to the manual steering control, the automatic steering control tries to modify a steering angle difference due to the manual steering control. This appears at the steering wheel as the feeling of being caught. In order to reduce this, a phase compensation (a phase-lead compensation) is performed with respect to the target steering angle correction value θta.
In addition, except the phase compensation, compensations such as LPF, differential, integral and proportional items may be applied to the target steering angle correction value.
In order to enable the automatic control that the driver and the fellow passengers do not feel surprise and the discomfort feeling by suppressing the steering behavior and the vehicle behavior that have a rapid variation at the start of the steering by the automatic steering control, the present invention multiplies the motor velocity command value within the steering angle control section by a steering angle control gradual variation gain and provides a limiter that limits the upper and lower limit values with respect to the motor velocity command value after being multiplied by the gradual variation gain. It is possible for this limiter to change the limit value depending on the steering angle control gradual variation gain, and the motor velocity command value is limited depending on the steering angle control gradual variation gain by decreasing the limit value in the case that the steering angle control gradual variation gain is less than a threshold and increasing the limit value in the case that the steering angle control gradual variation gain is equal to or more than the threshold. Since changing of the limit value of the limiter is also gradually performed, the driver does not feel the discomfort feeling.
The EPS side ECU 140 comprises the previously-mentioned torque control section 141, the steering angle control section 200A that calculates a current command value Imref1 for performing the automatic steering control based on the target steering angle θt, the actual steering angle Or and the motor angular velocity ω and outputs the calculated current command value Imref1, the gain adjusting section 148 that outputs an assist control gradual variation gain GC1 for gradually varying a current command value Itref1 used for the assist control by the multiplication section 145 and a steering angle control gradual variation gain GC2 for gradually varying the current command value Imref1 from the steering angle control section 200A by the multiplication section 146 when the automatic steering control becomes “ON” according to a control switching command SW, the addition section 147 that adds a gradually-varied current command value Itref2 from the multiplication section 145 and a gradually-varied current command value Imref2 from the multiplication section 146 and outputs the motor current command value Iref, the previously-mentioned current control/drive section 143 and the previously-mentioned motor angular velocity calculating section 144.
Since a correlation exists between the assist control gradual variation gain GC1 and the steering angle control gradual variation gain GC2, when the steering angle control gradual variation gain GC2 varies in an increasing direction, the assist control gradual variation gain GC1 varies in a decreasing direction. Further, an output section is comprised of the multiplication sections 145 and 146 and the addition section 147.
The steering angle control section 200A has a configuration shown in
In such a configuration, an entire operation example of the present invention will be described with reference to a flowchart shown in
When the operation of the steering system (the automatic steering control “OFF”) starts, the torque control by the torque control section 141 is carried out (Step S20), and the motor 150 is driven by using the current command value Itref1 (=Itref2) and by means of the current control/drive section 143 (Step S21). The above operations are repeatedly performed until the control switching command SW is outputted from the switching command section 131 and the automatic steering control becomes “ON” (Step S22).
When the control switching command SW is outputted and the automatic steering control becomes “ON”, and the control switching command SW is outputted from the switching command section 131, the target steering angle θt is inputted from the target steering angle generating section 132 (Step S23), the actual steering angle θr is inputted from the steering angle sensor 152 (Step S24), the motor angular velocity ω is inputted from the motor angular velocity calculating section 144 (Step S25), and the assist control gradual variation gain GC1 and the steering angle control gradual variation gain GC2 are set by the gain adjusting section 148 (Step S26). Moreover, the target steering angle θt, the actual steering angle θr and the motor angular velocity ω can be inputted in an arbitrary order.
Thereafter, the current command value Itref1 is calculated and outputted from the steering angle control section 200A, and the current command value Itref1 is calculated and outputted from the torque control section 141 (Step S27), the gradual variation is performed by the steering angle control gradual variation gain GC2 and the assist control gradual variation gain GC1 that are set (Step S200). That is, in the multiplication section 145, the current command value Itref1 is multiplied by the assist control gradual variation gain GC1 and the current command value Itref2 is outputted. Further, in the multiplication section 146, the current command value Imref1 is multiplied by the steering angle control gradual variation gain GC2 and the current command value Imref2 is outputted. The current command values Imref2 and Itref2 that the gradual variation processing is performed in this way are added in the addition section 147 to generate the motor current command value Iref (Step S30), the motor 150 is driven by the current control/drive section 143 (Step S31), and a return to the above Step S22 is made.
In addition, in the velocity control section 260, a velocity deviation Df (=ωmb−ω) between the motor velocity command value ωmb and the motor angular velocity ω is calculated by the subtraction section 261, the velocity deviation Df is inputted into the integral section 262 to be integrated and multiplied by the gain Kvi, and the calculated current command value Ir1 is addition-inputted into the subtraction section 264. The motor angular velocity ω is inputted into the gain section 263, and the current command value Ir2 obtained by multiplying the motor angular velocity ω by the gain Kvp is subtraction-inputted into the subtraction section 264. In the subtraction section 264, a deviation (=Ir1−Ir2) of the current command values Ir1 and Ir2 is calculated and outputted from the velocity control section 260 as the current command value Imref1.
Next, an example of the gradual variation processing of the steering angle control section 200A will be described with reference to a flowchart shown in
When the automatic steering control becomes “ON” in accordance with the control switching command SW, firstly, the motor velocity command value ωm for the steering angle control is gradually increased by the steering angle control gradual variation gain GC2 (Step S201), and the motor velocity command value ωmb is limited by a first limit value in the limiter 252 (Step S202). The above operations are repeatedly performed until the steering angle control gradual variation gain GC2 becomes equal to or more than a first threshold (Step S203), when the steering angle control gradual variation gain GC2 becomes equal to or more than the first threshold, the first limit value of the limiter 252 is gradually changed up to a second limit value (>the first limit value) (Step S204), and then the motor velocity command value ωmb is limited by the second limit value (Step S205).
The automatic steering control becomes “ON” at a time point t1, the steering angle control gradual variation gain GC2 that increases as shown in
Thereafter, when the automatic steering becomes “OFF” at a time point t4, the steering angle control gradual variation gain GC2 that decreases as shown in
In the example of
In addition, although the gradual variation of the gradual variation gain and the limit value is linearly performed as described above, may be non-linearly performed. Further, although the steering angle control gradual variation gain and the gradual variation gain used in the motor velocity command value are identical as described above, maybe different characteristics independently. With respect to the steering angle control gradual variation gain and the assist control gradual variation gain, it is also possible to arbitrarily change gradual variation time and gradual variation timing.
Moreover, although the velocity control is a control object as described above, it is effective for a control method having a configuration that the input such as a requested steering angle or the like is accumulated and used in the output of the current command value or the like, when that configuration is incorporated into the position control and the velocity control, it is effective for any other configuration.
Number | Date | Country | Kind |
---|---|---|---|
2013-078517 | Apr 2013 | JP | national |
2013-084511 | Apr 2013 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2014/052495 | 2/4/2014 | WO | 00 |
Publishing Document | Publishing Date | Country | Kind |
---|---|---|---|
WO2014/162769 | 10/9/2014 | WO | A |
Number | Name | Date | Kind |
---|---|---|---|
20030050748 | Iwazaki | Mar 2003 | A1 |
20060069481 | Kubota | Mar 2006 | A1 |
20060089770 | Ito | Apr 2006 | A1 |
20060090952 | Ito | May 2006 | A1 |
20100001680 | Sasaki | Jan 2010 | A1 |
20100198462 | Shinoda | Aug 2010 | A1 |
20140163822 | Strecker | Jun 2014 | A1 |
20150217801 | Takeda | Aug 2015 | A1 |
Number | Date | Country |
---|---|---|
08-310417 | Nov 1996 | JP |
2001-039325 | Feb 2001 | JP |
2002-120745 | Apr 2002 | JP |
2002-369565 | Dec 2002 | JP |
2004-017881 | Jan 2004 | JP |
2004-042769 | Feb 2004 | JP |
2004-256076 | Sep 2004 | JP |
2006-123663 | May 2006 | JP |
3912279 | May 2007 | JP |
4057955 | Mar 2008 | JP |
4110040 | Jul 2008 | JP |
2010-100091 | May 2010 | JP |
Entry |
---|
International Search Report of PCT/JP2014/052495 dated Apr. 28, 2014. |
Number | Date | Country | |
---|---|---|---|
20150191199 A1 | Jul 2015 | US |