The present invention relates to improvements of a control unit of an electric power steering apparatus which controls an assist amount of steering based on a steering torque and a vehicle speed, and more particularly to a control unit of an electric power steering apparatus, which has a steering angle usage function used for an operation, a compensation and the like of a steering assist command value and includes an algorithm function to estimate an absolute steering angle.
An electric power steering apparatus for energizing (assisting) a steering apparatus of an automobile or a vehicle with an assist load by a rotational force of a motor assists the driving force of the motor to a steering shaft or a rack shaft with the assist load through a transmission mechanism such as gears or a belt via a reduction machine. Such conventional electric power steering apparatus performs a feed-back control of a motor current in order to precisely generate an assist torque (steering auxiliary torque). The feed-back control adjusts a motor applying voltage so that a difference between a current command value and a detected motor current value may become small, and the adjustment of the motor applying voltage is generally performed by adjusting a duty ratio of a PWM (Pulse Width Modulation) control.
Here, a general configuration of an electric power steering apparatus shown in
The control unit 30 is mainly composed of a CPU (MPU (Micro Processor Unit) and MCU (Micro Controller Unit) are also included), wherein a general function performed by a program inside the CPU is shown in
When the function and operation of the control unit 30 are described based on
The steering assist command value calculating section 32 determines the steering assist command value I which is a control target value of the current supplied to the motor 20 based on the inputted steering torque TA and vehicle speed V. The steering assist command value I is inputted to a differential compensating section 34 of a feed-forward system for enhancing response speed, as well as inputted to a subtracting section 30A, and a deviation (I−i) of the subtracting section 30A is inputted to an integral calculating section 36 for improving the characteristics of a feed-back system, as well as inputted to a proportional calculating section 35. Along with the output of the differential compensating section 34, the outputs of the proportional calculating section 35 and the integral calculating section 36, and the output of the steering angle usage function section 100 are also inputted to an adding section 30B for adding, a current control value E which is an added result in the adding section 30B is inputted to a motor driving circuit 37 as a motor driving signal, and then the motor 20 is driven. Current i of the motor 20 is detected by a motor current detecting circuit 38, and then is feed-backed to the subtracting section 30A.
In such an electric power steering apparatus, in order to perform appropriate assist control, it is necessary to detect or estimate an absolute steering angle of an absolute value. Therefore, in Japanese Patent Application Laid-open No. 2003-276635 A (Patent Document 1), a relative steering angle is calculated using an angle signal of a motor, straight driving determination is performed using each wheel speed and steering torque, the relative steering angle of a handle when the vehicle is determined to be straight driving is estimated as a neutral point, and then an absolute steering angle is calculated from the estimated neutral point. Namely, in Patent Document 1, it will be described that the invention thereof includes a motor rotation angle detecting means for detecting a rotation angle of a motor, a neutral-point position detecting means for detecting a neutral-point position of a steering mechanism based on the rotational speed of wheels of a vehicle, and an absolute steering angle detecting means for detecting an absolute steering angle of the steering mechanism based on the neutral-point position detected by the neutral-point position detecting means and the rotation angle detected by the motor rotation angle detecting means.
However, in the electric power steering apparatus disclosed in the above-mentioned Patent Document 1, since the absolute steering angle detecting means is provided and wheel speed difference is used for determination of straight driving, a wheel speed sensor is essential and thus there is a problem that the apparatus cannot be applied to the vehicles without the wheel speed sensors.
The present invention is made from the above circumstances, and an object of the present invention is to provide a control unit of an electric power steering apparatus, which can estimate a neutral point (neutral position) with a high precision and also calculate an absolute angle without a new signal from outside by calculating a relative steering angle of a handle, a steering angular speed, or a motor angular speed from a motor angle sensor.
The present invention relates to a control unit of an electric power steering apparatus for driving a motor via a current control section with a current command value calculated by a torque control section, and giving an assist torque to a steering mechanism by driving the motor, and the above object of the present invention is achieved by providing a motor angle sensor for detecting a motor angle, a torque sensor for detecting a steering torque applied to a steering shaft, a relative steering angle detecting section for detecting a relative steering angle θr of a steering from an output of the motor angle sensor, a steering angular speed detecting section for detecting an angular speed of the motor, a vehicle speed determining section for determining a vehicle speed, a neutral point calculating section for determining whether or not a vehicle is being driven straightly based on the steering angular speed, the steering torque and the vehicle speed, and calculating by considering that the relative steering angle θr when the straight driving continues for not less than a predetermined time is a neutral point, and an absolute steering angle calculating section for calculating an absolute steering angle with a difference between the neutral point obtained by the neutral point calculating section and the relative steering angle θr.
The above object of the present invention is achieved more effectively by the neutral point calculating section setting a reliability coefficient which increases according to the vehicle speed and a straight driving duration if the straight driving duration becomes a first threshold or more under conditions of determining the straight driving of the vehicle to set a value “D·(θr−θk-1)” obtained by multiplying the deviation “θr−θk-1” between the neutral point angle θk-1 corrected last time and the relative steering angle θr by the reliability coefficient D is added to the neutral point angle θk-1 corrected last time as a new neutral point angle θk; or by setting an estimated value reliability coefficient obtained by integrating the reliability coefficient D to decrease the reliability coefficient D to thereby reduce a corrected displacement of the neutral point angle θk when the estimated value reliability coefficient becomes a second threshold or more; or by performing the straight driving determination by adding a wheel rotational speed thereto.
In the accompanying drawings:
In the present invention, a neutral point is estimated based on a relative steering angle obtained by calculating a relative steering angle of a handle in consideration of a gear ratio of a reduction section with a motor angle obtained from a motor angle sensor. Additionally, in the present invention, a vehicle speed, a steering torque and a steering angular speed are used for determination of the straight driving, wherein it is determined to be the straight driving now when conditions that can be determined to be the straight driving are satisfied and its state continues for predetermined time, and the neutral point is estimated based on the relative steering angle at that time. Highly precise and early neutral point estimation is made possible by further setting a straight-driving reliability coefficient and performing the estimation according to the reliability coefficient, and an absolute steering angle is also calculated by differentiating the relative steering angle from the obtained neutral point. A steering angle usage function, such as a handle return control, is precisely operated from the evaluated absolute steering angle and the estimated value reliability coefficient evaluated from the reliability coefficient.
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
The relative steering angle detecting section 101 detects a relative steering angle θr of a steering in consideration of a gear ratio based on the motor angle θs, and the steering angular speed detecting section 102 differentiates the motor angle θs to then detect a steering angular speed ω in consideration of the gear ratio. The steering angular speed ω detected by the steering angular speed detecting section 102 is inputted to the straight driving determining section 200, and a straight driving determination signal Ni calculated by the straight driving determining section 200 is inputted to an absolute steering angle calculating section 104. Meanwhile, the steering angular speed ω may be the motor angular speed as it is.
After an ignition key is turned-on and the output of the motor angle θs is started from the motor angle sensor 110, the relative steering angle detecting section 102 integrates the motor angle θs to thereby detect the relative steering angle θr of a handle in consideration of the gear ratio, and the steering angular speed detecting section 102 detects the steering angular speed ω. The absolute steering angle calculating section 104 detects an absolute steering angle θa and an estimated value reliability coefficient Di based on the relative steering angle θr and the straight driving determination signal Ni. A steering angle usage function section 100 for inputting the absolute steering angle θa and the estimated value reliability coefficient Di performs a handle return control using a steering angle, a steering angle adjusting function to a vehicle behavior, or the like.
The straight driving determining section 200 has a function to determine that the vehicle is being straightly driven when the steering angular speed ω and a steering torque Tr are thresholds or less determined to be neutral, and the state of the vehicle speed V or more on which a self-aligning torque (SAT) acts continues for a certain time period (t) or more.
The absolute steering angle calculating section 104 calculates the absolute steering angle by performing the estimation of a neutral point angle and the calculating of the following Equation-1.
absolute steering angle=relative steering angle−estimated neutral point angle [Equation-1]
The absolute steering angle θa calculated by the absolute steering angle calculating section 104 is used in the steering angle usage function section 100, while the estimated value reliability coefficient Di has the following meaning. Namely, since the absolute steering angle θa in the present invention is estimated from a vehicle information, the reliabilities for precision between the estimation initial stage and the sufficient estimation completion are different. Depending on the functions to use the absolute steering angle θa, it may be safer to reduce the effects of the functions before the sufficient estimation is performed. For such functions, the reliability coefficient of an estimated value is given and the control according thereto can be performed. For example, in the output of the handle return control, it is made small when the estimated value reliability coefficient Di is low, and it is made large when it is high.
Details of the straight driving determining section 200 will be described with reference to
In
Next, the values of the steering torque T, the motor angular speed ω and the vehicle speed V are compared with a reference value Tth, a reference value ωth and a reference value Vth at comparing sections 210, 211 and 212 respectively, and the determination of the straight driving of the vehicle is performed base on an AND-condition of the each value comparison result, and then a straight driving signal St is outputted when it is determined to be the straight driving.
The steering torque T through the low pass filter 201 is inputted to the comparing section 210, and the comparing section 210 outputs the result of having compared the steering torque T with the reference value Tth set in a setting section 213. That is, the vehicle is being driven straightly in many cases when the steering torque T is smaller than the reference value Tth, and a logical value “1” is outputted, for example. The motor angular speed ω is inputted to the comparing section 211 through the low pass filter 202, and the comparing section 211 outputs the result of having compared the motor angular speed ω with the reference value ωth set in a setting section 214. That is, the vehicle is being driven straightly in many cases when the motor angular speed ω is smaller than the reference value ωth, and a logical value “1” is outputted. The vehicle speed V through the low pass filter 203 is inputted to the comparing section 212, and the comparing section 212 outputs the result of having compared the vehicle speed V with the reference value Vth set in a setting section 215. That is, the vehicle is being driven straightly in many cases when the vehicle speed V is larger than the reference value Vth, and a logical value “1” is outputted.
Subsequently, the AND-conditions of the full output of the comparing sections 210 to 212 are taken in an AND-circuit 220, and the resulting straight driving signal St comprehensively determined is outputted. That is, when all the output of the comparing sections 210 to 212 is a logical value “1”, the vehicle is determined to be the straight driving and the straight driving signal St of a logical value “1” is outputted, and other than that, the vehicle is determined not to be the straight driving and the straight driving signal St of a logical value “0” is outputted.
The straight driving signal St is inputted to a comparing section 221, and the comparing section 221 determines whether or not the vehicle continues the straight driving, and thereby outputs a straight driving continuation signal Sc when the logical value “1” of the straight driving signal St continues for a continuation determination time t0 or more set in a setting section 222. The straight driving continuation signal Sc is inputted to a neutral angle correcting means 240.
Next, the neutral point angle correcting means 240 will be described with reference to
First, the relative steering angle θr outputted from the low pass filter 204 via the relative steering angle detecting section 101, the vehicle speed V outputted from the low pass filter 203, and the straight driving continuation signal Sc from the comparing section 221 are inputted to the neutral point angle correcting means 240. However, it is necessary to perform a neutral angle correction under the condition that the vehicle is being driven straightly. Hence, a switch 241 for imposing the condition is disposed between the low pass filter 204 and a subtracting section 244, and a switch 242 is disposed between the low pass filter 203 and a Dv-table 243. The switches 241 and 242 are then closed only while the straight driving continuation signal Sc exists.
Estimation of a neutral point steering angle is performed based on the following Equation-2, and the neutral point angle correcting means 240 performs the following Equation-2.
θk=(θrθk-1)·D+θk-1 [Equation-2]
Next, a neutral point angle correction will be described with reference to
The vehicle speed V inputted via the switch 242 is inputted to the Dv-table 243. The Dv-table 243 is composed of a reliability basic coefficient Dv which increases as the vehicle speed V increases, and fundamentally, a reliability coefficient D increases as the reliability basic coefficient Dv increases. Here, an example of the Dv-table will be shown in
If the vehicle speed V is inputted to the Dv-table 243, the reliability basic coefficient Dv is outputted according to the function of
The relative steering angle θr inputted to the neutral point angle correcting means 240 is inputted to a subtracting section 244, and the neutral point angle θk-1 outputted from a delay element 247 and estimated last time is also inputted to the subtracting section 244. As a result, the output of the subtracting section 244 will result in a deviation (θr−θk-1). The deviation from the subtracting section 244 is multiplied with the reliability coefficient D from the limiter 251 in the multiplying section 245, and then the multiplied value “D·(θr−θk-1)” is outputted from the multiplying section 245. Subsequently, “D·(θr−θk-1)” outputted from the multiplying section 245 is inputted to the adding section 246 to thereby be added to the neutral point angle θk-1 outputted from the delay element 247 and estimated last time, and a value “D·(θr−θk-1)+θk-1” is then outputted as the calculated result. This output value will result in an estimated new neutral point angle θk, which is expressed with the following Equation-3.
θk=D·(θr−θk-1)+θk-1 [Equation-3]
This neutral point angle θk will result in an output of the neutral point angle correcting means 240.
An integration by the calculation “D·(θr−θk-1)” is performed only when the straight driving continuation signal Sc exists, namely, only for the straight driving duration. Meanwhile, if the straight driving continuation signal Sc is lost, the duration time t is reset to “0”. Meanwhile, if the straight driving continuation signal Sc is lost, the neutral point angle θk as the calculated result is memorized in a memory means such as RAM, which is used as an off-set initial value θk-1 when the straight driving continuation signal Sc is outputted again next time to be started the calculating by the neutral point angle correcting means 240.
As mentioned above, the straight driving determining section 200 calculates by considering the relative steering angle θr when the vehicle is determined to be the straight driving as a neutral point, and as the calculation method of the neutral point angle, the deviation “(θr−θk-1)” detected by the neutral angle θk-1 amended last time and a newly obtained relative steering angle θr is multiplied with the reliability coefficient D(V, t), and thereby the value “D·(θr−θk-1)” is obtained. The neutral point angle θk-1 corrected last time is added to the value D, and a new neutral point angle θk is calculated according to the Equation-3.
The reliability coefficient D(V, t) is calculated by integrating the vehicle speed reliability Dv depending on the vehicle speed V by the duration time, if the straight driving duration (t) becomes the threshold or more. Since the relative steering angle falling under the conditions during high speed driving is considered to be a reliable value, the reliability coefficient D becomes large by setting the vehicle speed reliability Dv high, and also the reliability coefficient D increases as the duration longer, and the relative steering angle is immediately reflected to the neutral point angle.
Additionally, since the initial value at the start of the estimation has the possibility of incorrect estimation, an estimated value reliability coefficient Dest obtained by integrating the reliability coefficient D is set as the reliability of the estimated value so that the function using the steering angle may not function before the estimation continues for a certain time period or more. If the estimated value reliability coefficient Dest becomes the threshold or more, the precision of the neutral point is determined to be improved, and then the reliability coefficient D is made smaller at a certain rate so that the neutral point angle may not change sharply. In addition, the estimated value reliability coefficient Dest is outputted outside a module for the operating conditions and gains of the function which uses the absolute steering angle.
The above-mentioned operation is performed according to the flow chart shown in
Namely, the relative steering angle θr, the steering angular speed ω, the steering torque T and the vehicle speed V are obtained as described above (Step S1), and whether or not the vehicle speed V is larger than the vehicle speed threshold Vth is determined (Step S2), and then if the vehicle speed V is the vehicle speed threshold Vth or less, a neutral point position and an estimated value reliability is decided, and then the straight driving reliability is reset while holding the last time value (Step S8). In the above-mentioned Step S2, when the vehicle speed V is larger than the vehicle speed threshold Vth, whether or not an absolute value |T| of the steering torque T is smaller than the threshold Tth is determined (Step S3), and then, when the absolute value |T| of the steering torque T equal to the threshold Tth or more, the program proceeds to the above-mentioned Step S8, or when the absolute value |T| of the steering torque is smaller than the threshold Tth, whether or not an absolute value |ω| of the steering angular speed ω is smaller than a threshold ωth is further determined (Step S4). Subsequently, when the absolute value |ω| of the steering angular speed ω is the threshold ωth or more, the program proceeds to the above-mentioned Step S8, or when the absolute value |ω| of the steering angular speed ω is smaller than the threshold ωth, a timer counts up (Step S5), and then whether or not count time t becomes a threshold th or more (Step S6). When the count time t of the timer is smaller than the threshold th, the program proceeds to the above-mentioned Step S8, whereas when the count time t of the timer becomes the threshold th or more, update of the integration of the straight driving reliability, the neutral position and estimated value reliability is performed (Step S7). Subsequently, the neutral point position and the estimated value reliability are outputted, and the program ends (Step S10).
Next, other embodiments of the present invention will be described.
In a case that a wheel rotational speed can be used, a higher-precision estimation can be performed by adding the wheel rotational speed to a straight driving determination condition of the above-mentioned estimation method. The determination conditions with the wheel rotational speed are as follows. Since the speed difference between the right wheels and the left ones is “0” in the state of an ideal straight driving, the right-and-left wheel speed can be determined under the same conditions. However, since the wheel speed difference greatly differs in a value depending on the vehicle speed, the threshold with respect to the wheel speed difference is not provided, but the following relational expression based on a turning radius is used.
ψ1: left rear wheel speed, ψr: right rear wheel speed.
In the above Equation-4, the steering angle θ, the left rear wheel speed ψi and the right rear wheel speed ψr are expressed with the following Equation-5 by making k1 into a constant.
tan θ=k1·(Ψi−Ψr)/(Ψi+Ψr) [Equation-5]
Since the vehicle is then considered to be the straight driving when the steering angle θ is small, whether or not the value of a right-hand side of the above Equation-5 is the threshold or less is determined, but if “tan” of a trigonometric function or a division occurs, the calculating in CPU or MPU is difficult. For this reason, in the present invention, the Equation-5 is changed into the following Equation-6 by making k2 into a constant.
0≦k2/k1·|Ψi+Ψr|−|Ψi−Ψr| [Equation-6]
From the above Equation-6, if the value of a right-hand side is zero or more, the vehicle is determined to be the straight driving.
An example of a control unit in using the right-and-left wheel rotational speed is shown in
Thus, when the right-and-left wheel rotational speed is used, the absolute steering angle can be more precisely estimated.
In the control unit of the electric power steering apparatus according to the present invention, highly precise estimation of the neutral point can be performed by using the steering angular speed for the straight driving determination, and further using the torque sensor and the vehicle speed sensor, as well as using an algorithm for the calculating of the absolute steering angle. Additionally, by adding the wheel rotational speed when the straight driving determination is performed, earlier and assured estimation can be performed.
Number | Date | Country | Kind |
---|---|---|---|
2005-299703 | Oct 2005 | JP | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/JP2006/320790 | 10/12/2006 | WO | 00 | 4/14/2008 |