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 improving performances and suppressing a steering wheel vibration occurring during the automatic steering control by performing a steering angle control that carries out an automatic steering which makes an actual steering angle follow up a target steering angle with a high accuracy and without using any particular parts while suppressing the vibration.
An electric power steering apparatus (EPS) 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 on the basis of 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 a 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-290778A, removes a peak value 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 ω on the basis of 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 α on the basis of the inputted motor angular velocity ω, and the calculated motor angular acceleration a is inputted into the motor characteristic compensating section 125 and the SAT estimation feedback section 115. 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 on the basis of 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 on the basis of 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, aback 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 control device disclosed in Japanese Patent No.3917008 B2 (Patent Document 1), in a steering angle control, a velocity PI (proportional and integral) control is performed with respect to a deviation between a target steering angle and a steering angle (an actual steering angle), and that arithmetic result is used in a steering angle follow-up control.
However, in conventional automatic steering control, in the case of performing the steering angle control in the vehicle, since disturbances and load status largely vary due to a running vehicle velocity, changes in frictions and a road surface reaction force and so on, the steering angle control must be a control configuration having resistance properties against these. However, in the velocity PI-control, for example, in the case that the road surface reaction force changes, since the response of the actual steering angle changes due to the change in the road surface reaction force, there is a possibility that the actual steering angle is unable to follow up the target steering angle with a high accuracy and the vehicle deviates from the target steering angle. Further, also in the case that the target steering angle changes at a high speed, although the actual steering angle is controlled by motor assist so as to follow up the target steering angle, in the device of Patent Document 1, since a spring-inertial system of the steering wheel is not considered, in this case, there is a possibility that vibrations occur due to the spring-inertial system of the steering wheel and a driver feels that as an uncomfortable feeling.
Further, in the electric power steering apparatus, in order to detect the steering torque of the driver, a torsion bar is arranged at the column shaft, the steering torque of the driver is detected by the torque sensor utilizing an operation that a torsion angle is proportional to a torque being applied to the torsion bar, and the assist control is performed. However, vibrations caused by a spring mass system of the torsion bar and the steering wheel sometimes occur during the automatic steering control which makes the actual steering angle follow up the target steering angle.
As techniques for suppressing a motor assist change during the automatic steering control, for example, there is a steering control device disclosed in Japanese Patent No.5068327 B2 (Patent Document 2). In the device of Patent Document 2, a motor assist control is performed by the sum of respective command values of the automatic steering control and the assist control, and the correction is performed by an inertial torque change obtained by extracting changes caused by an inertial torque from the torque so as to enable the driver to easily perform the steering operation during the automatic steering control.
However, in the steering control device of Patent Document 2, since the inertial torque is extracted by a low pass filter (LPF) and the assist torque uses phases after the occurrence of the inertial torque, a delay occurs.
During the automatic steering control of the electric power steering apparatus that performs the automatic steering which makes the actual steering angle follow up the 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 without giving the uncomfortable feeling to the driver.
The present invention has been developed in view of the above-described circumstances, and the first object of the present invention is to provide an electric power steering apparatus that realizes vibration suppression of response characteristics and has a control performance having resistance properties against the disturbances such as the frictions and the road surface change by using a velocity I-P control (a proportional-lead type PI-control) in a vehicle having functions of the automatic steering control and the manual steering control. Further, the second object of the present invention is to provide a high-performance electric power steering apparatus that is capable of adjusting a resonance frequency and a damping ratio by the control so as not to give the uncomfortable feeling to the driver by calculating a compensation value from the steering torque and a torque differential by another means different from the ordinary assist control and adding the calculated compensation value to the current command value to drive the motor.
The present invention relates to an electric power steering apparatus that calculates a first motor current command value on the basis of a steering torque and a vehicle velocity, performs an assist control of a steering system by driving a motor on the basis of 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 steering angle control section that calculates a second motor current command value in said automatic steering control so as to bring an actual steering angle close to a target steering angle; and a switching section that inputs said first motor current command value and said second motor current command value and switches between said first motor current command value and said second motor current command value depending on a switching signal, wherein said steering angle control section comprises a rate limiter that performs smoothing with respect to said target steering angle, and outputs as said second motor current command value on the basis of a first deviation between an output of said rate limiter and said actual steering angle and a motor angular velocity.
Further, the above-described object of the present invention is achieved by that comprising: a steering angle control section that calculates a second motor current command value on the basis of said steering torque, a target steering angle, 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 steering angle control section comprises a position control section that outputs a motor velocity command depending on a deviation angle between said target steering angle and said actual steering angle; a velocity control section that inputs said motor velocity command and said motor angular velocity to perform a velocity control; a steering wheel damping control section that inputs said steering torque to perform a steering wheel damping control; and an output section that processes a third motor current command value from said velocity control section and a fourth motor current command value from said steering wheel damping control section to output said second motor current command value, wherein said switching section is switched depending on a switching command of said automatic steering control and saidmanual steering control, said motor is drive-controlled on the basis of said second motor current command value in said automatic steering control.
According to an electric power steering apparatus of the present invention, since the automatic steering control is performed by using the velocity I-P control (the proportional-lead type PI-control) in a vehicle having functions of the automatic steering control (the parking support function) and the manual steering control, it is possible to realize the vibration suppression of the response characteristics and realize the control performance having the resistance properties against the disturbances such as the road surface change and suppressing dispersion in manufacturing. Further, according to the present invention, since the spring-inertial vibration component of the steering wheel system is removed from the change in the target steering angle not only by the vibration suppression performance of the I-P control but also by a rate limiter and an LPF (Low Pass Filter), it is possible to realize smoother behavior.
Further, it is possible to further improve the responsibility of the steering angle by adding a feedforward system.
Furthermore, according to the electric power steering apparatus of the present invention, since the steering angle control is performed by a steering angle command value to become driving with the driver's hands free during the automatic steering control, a torque control on the basis of a steering wheel torque is not performed. By detecting a torque value generated by the inertia of the steering wheel during the automatic steering control and adding the detected torque value to the steering angle command value as the compensation value, it is possible to suppress the steering wheel vibration. That is, since the present invention provides a steering wheel damping control section, performs an addition processing of velocity components that are calculated by a proportional section and a differential gain section and corrects the motor current command value with the addition result, it is possible to realize the steering wheel damping with a high responsibility and without a phase delay.
In the accompanying drawings:
In the present invention, an electric power steering apparatus of a vehicle having functions of the automatic steering control and the manual steering control, performs the automatic steering control which makes the actual steering angle follow up the target steering angle with a high accuracy and without using any particular parts. That is to say, the present invention realizes the vibration suppression of the response characteristics and has a control configuration having the resistance properties against the disturbances such as the frictions and the road surface change by using the velocity I-P control (the proportional-lead type PI-control).
Further, the present invention achieves smoother behavior by removing the spring-inertial vibration component of the steering wheel (handle) system from the change in the target steering angle not only by the vibration suppression performance of the I-P control but also by a rate limiter for preventing that the current command value changes rapidly and a filter for reducing the steering wheel vibration. Moreover, it is possible to further improve the responsibility of the steering angle by adding a feedforward system to the velocity I-P control.
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 on the basis of 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 on the basis of 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 handle 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 on the basis of 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 on the basis of a signal that identifies entering the automatic steering control, for example, on the basis of 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 on the basis of 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 on the basis of a steering torque Th from a torque sensor 154 of a torsion bar and a motor angular velocity ω, the steering angle control section 200 that calculates a motor current command value Imref for performing the automatic steering control on the basis of the target steering angle θt, 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 from the switching command section 131 and outputs a motor current command values Iref, a current control/drive section 143 that drive-controls the motor 150 on the basis of the motor current command value Iref (Itref or Imref) from the switching section 142, and a motor angular velocity calculating section 144 that calculates the motor angular velocity ω on the basis of 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 on the basis of 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 as the motor current command value Iref, and in the automatic steering control, outputs the motor current command value Imref as the motor current command value Iref. Further, the current control/drive section 143 comprises a PI current control section, a PWM control section, an inverter and so on.
The steering angle control section 200 has a configuration shown in
The actual steering angle θr is subtraction-inputted into the subtraction section 202, an angle deviation θb between the actual steering angle θr and the target steering angle θta that the smoothing and the high-frequency removing are performed is obtained in the subtraction section 202, the angle deviation θb is multiplied by a gain Kpp in a position control section 240 and then addition-inputted into a subtraction section 251 within a velocity control (velocity I-P control) section 250 as a motor velocity command value com. The motor angular velocity ω from the motor angular velocity calculating section 144 is subtraction-inputted into the subtraction section 251, the calculated velocity deviation Df is multiplied by a gain Kv and integrated in an integral section 252 and then addition-inputted into a subtraction section 254. Further, the motor angular velocity ω is inputted into a proportional section 253 within the velocity control section 250, the motor angular velocity multiplied by a gain Kvp is subtraction-inputted into the subtraction section 254, and a deviation being a subtraction result of the subtraction section 254 is inputted into a limiter 204 as a motor current command value Is. The motor current command value Is that the upper and lower limit values are limited by the limiter 204 is outputted as the motor current command value Imref.
In addition, a current command value calculating section comprises the position control section 240 and the velocity control section 250.
The rate limiter 210 performs a smoothing with respect to the target steering angle θt and outputs the smoothed the target steering angle θt when the target steering angle θt changes rapidly, for example, has a configuration shown in
Further, in the case that the difference with the input (the target steering angle) θt is within the range of the upper limit and the lower limit of the variation amount setting section 212, since the variation amount θt2 (=the difference θt1) is outputted and added to the past value, the result output θt3 coincides with the input (the target steering angle) θt. As these results, even if the target steering angle θt changes rapidly, it is possible to smoothly vary the target steering angle θt changing rapidly, a rapid current variation (i.e. a rapid steering) is prevented, and a function that reduces an uneasy feeling relating to the automatic operation of the driver is fulfilled.
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 (the manual steering mode) 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 then the switching command SW is outputted from the switching command section 131, the target steering angle θt is inputted into the steering angle control section 200 from the target steering angle generating section 132 (Step S4), the actual steering angle θr is inputted into the steering angle control section 200 from the steering angle sensor 152 (Step S5), the motor angular velocity ω is inputted into the steering angle control section 200 from the motor angular velocity calculating section 144 (Step S8), 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 and the motor angular velocity ω can be inputted in an arbitrary order.
Thereafter, the switching section 142 is switched to the automatic steering control by the switching command SW from the switching command section 131 (Step S10), and 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).
Operations of the automatic steering control like this will be described in detail with reference to a flowchart shown in
At first, the rate limiter 210 inputs the target steering angle θt (Step S110) and performs the rate limiting processing described as above that makes the rapid variation smooth with respect to the target steering angle θt (Step S111), in order to remove the steering wheel vibration, an LPF processing (the high-frequency removing) is performed by the LPF with respect to the target steering angle θt3 that the rate limiting processing is performed, and the target steering angle θta is outputted (Step S112). Next, the actual steering angle θr is inputted (Step S113), the subtraction section 202 subtracts the actual steering angle θr from the target steering angle θta (Step S130), the deviation θb (=θta - era) being the subtraction result is inputted into the position control section 240 to perform a position control, and the motor velocity command value ωm obtained by the position control is inputted into the subtraction section 251 within the velocity control section 250 (Step S131). Furthermore, the motor angular velocity ω is inputted into the subtraction section 251 and the proportional section 253 (Step S132), and the velocity control section 250 performs the velocity I-P control and outputs the deviation obtained in the subtraction section 254 as the motor current command value Is (Step S133). A limit processing is performed by the limiter 204 with respect to the motor current command value Is (Step S136), and the motor current command value Imref that the upper and lower limit values are limited is outputted (Step S137).
In addition, although the gain section 232 is provided at a post-stage of the differential section 231 as mentioned above, the gain section 232 may be provided at a pre-stage of the differential section 231.
Although the steering angle control of the steering wheel is performed during the automatic steering control such as parking support, automatic running or the like, since the steering angle control is performed by the steering angle command value to become driving with the driver's hands free during the automatic steering control, the torque control on the basis of the steering wheel torque is not performed. By detecting the torque value generated by the inertia of the steering wheel system during the automatic steering control and adding the detected torque value to the steering angle command value as the compensation value, it is possible to suppress the steering wheel vibration.
Motion equations that hold among a steering inertia, a torsion bar lower (the motor, the column shaft and son on) inertia and the torsion bar become the following Expression 1. Where a load torque applied to the steering during the automatic steering control is set to “0”.
J
h{umlaut over (θ)}h=−Ct({dot over (θ)}h−{dot over (θ)})−Kt(θh−θ) [Expression 1]
J{umlaut over (θ)}=C
t({dot over (θ)}h−{dot over (θ)})+Kt(θh−θ)+T
A transfer function of a torsion angle Δθ(=θ−θh) with respect to the drive torque T becomes the following Expression 2.
The torsion angle Δθ responds to the drive torque T with the resonance frequency coa and the damping ratio ξa during the automatic steering control. Since these characteristics are determined depending on design values, in the case that the damping ratio ξa is small, since the torsion angle Δθ causes vibrations with bad convergence, a vibration continuation time of the steering becomes long during the automatic steering control, and this becomes an unfavorable behavior to the driver.
Since the steering torque T detected by the torque sensor is proportional to the torsion angle Δθ of the torsion bar, when components of a proportional compensation and a differential compensation of the detected steering torque T are fed back to the drive torque, the following Expression 4 holds.
T=T′+T
c
=T′−(KpΔθ+KdΔθ) [Equation 4]
The drive torque T′ including a compensation torque is represented by the above Expression 4, and a transfer function of the torsion angle Δθ with respect to the drive torque T′ becomes the following Expression 5.
From the above Expression 5, a resonance frequency ωa′ and a damping ratio ξ′ of a system including the compensation torque are represented by the following Expression 6.
It is clear fromthe resonance frequency ωa′ and the damping ratio ξa′ that applying the compensation torque by a proportional compensation gain Kp and a differential compensation gain Kd is equivalent to adjusting the damping ratio and the resonance frequency. Therefore, by adding signals of the torque and the torque differential to the automatic steering control as a compensation system, it becomes possible to adjust the resonance frequency and the damping ratio in preferable vibrations to the driver without adjusting mechanical characteristics.
The steering angle control section 200A has a configuration shown in
Further, the steering torque Th from the torque sensor 154 is inputted into the torque control section 141 and inputted into a steering wheel damping control section 260 within the steering angle control section 200A to be proportional-differential-controlled, a motor current command value Ih (a fourth motor current command value described in the claim) corrected by proportional-differential is inputted into the addition section 205 and added to the motor current command value Is from the velocity control 250, and a motor current command value Ib being the addition result of the addition section 205 is limited by the upper and lower limit values in the limiter 204 and outputted as the motor current command value Imref. In addition, an output section comprises the addition section 205 and the limiter 204.
The steering wheel damping control section 260 comprises a gain section 261 that multiplies the steering torque Th by a gain Kcp, a differential section 262 that differentiates the steering torque Th, a gain section 263 that multiplies a steering torque Ths differentiated in the differential section 262 by a gain Kcd, and an addition section 264 that adds an output of the gain section 261 and an output of the gain section 263 and outputs the motor current command value Ih.
In addition, a relationship between the steering torque Th being an input of the steering wheel damping control section 260 and the motor current command value Ih being an output of the steering wheel damping control section 260 becomes again frequency characteristic (A) and a phase frequency characteristic (B) such as 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 S30), 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 S31). The above operations are repeatedly performed until the switching command SW is outputted from the switching command section 131 (Step S32).
When becoming the automatic steering control and the switching command SW is outputted fromthe switching command section 131, the target steering angle θt is inputted from the target steering angle generating section 132 (Step S33), the actual steering angle θr is inputted from the steering angle sensor 152 (Step S34), the steering torque Th is inputted from the torque sensor 154 (Step S35), the motor angular velocity ω is inputted from the motor angular velocity calculating section 144 (Step S36), and the motor current command value Imref is generated by the steering angle control section 200A (Step S200). 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 S40), the motor 150 is driven by using the motor current command value Imref from the steering angle control section 200A and by means of the current control/drive section 143 (Step S41), and a return to the above Step S32 is made. The drive control by 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 200A will be described with reference to a flowchart shown in
At first, the target steering angle θt is inputted (Step S201), the actual steering angle θr is inputted (Step S202), a subtraction of “θt−θr” is performed in the subtraction section 202 and the deviation angle ee is calculated (Step S203). The calculated deviation angle ee is inputted into the gain section 241 within the position control section 240 and multiplied by the gain Kpp, the motor velocity command value ωm is calculated (Step S204), and the motor velocity command value ωm is addition-inputted into the subtraction section 251 within the velocity control section 250. The motor angular velocity ω is subtraction-inputted into the subtraction section 251 (Step S205), the velocity deviation Df (=ωom−ω) between the motor velocity command value ωm and the motor angular velocity ω is calculated by the subtraction section 251 (Step S206), the velocity deviation Df is inputted into the proportional integral section 252 to be multiplied by the gain Kvi and integrated (Step S207), and a calculated current command value I1 is addition-inputted into the subtraction section 254. The motor angular velocity ω is inputted into the gain section 253, and a current command value I2 multiplied by the gain Kvp is subtraction-inputted into the subtraction section 254 (Step S208). A deviation (=I1−I2) between the current command value I1 and the current command value I2 is calculated by the subtraction section 254, and outputted as the motor current command value Is from the velocity control section 250 (Step S210).
The steering torque Th is inputted into the gain section 261 and the differential section 262 within the steering wheel damping control section 260 (Step S211), multiplied by the gain Kcp in the gain section 261 and inputted into the addition section 264 (Step S212). The steering torque Th inputted into the differential section 262 is differentiated, the differentiated velocity command value Ths is multiplied by the gain Kcd in the gain section 263 (Step S213), and the addition section 264 adds a calculated motor current command value I4 to a motor current command value I3 from the gain section 261 to calculate the motor current command value Ih (Step S214). The motor current command value Is from the velocity control section 250 and the motor current command value Ih from the steering wheel damping control section 260 are inputted into the addition section 205, the motor current command value Ib is calculated in the addition section 205 (Step S215), the calculated motor current command value Ib is limited by the upper and lower limit values in the limiter 204 (Step S220) and outputted as the motor current command value Ifref (Step S221).
Although the steering wheel damping control section is configured by the torque (gain) and the proportional-differential as described above, as shown in
Further, the compensation gain may be positive or negative, and it is possible to appropriately adjust the resonance frequency and the damping ratio up and down.
Moreover, in the case of switching the steering mode by the switching section 142, it is also possible to gradually change by using a fade gain. Further, in the above embodiments, although the I-P control is used in the velocity control section, an I-PD control, a modern control, a robust control or the like may be used in the velocity control section.
Number | Date | Country | Kind |
---|---|---|---|
2013-046178 | Mar 2013 | JP | national |
2013-059901 | Mar 2013 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2014/052459 | 2/3/2014 | WO | 00 |