1. Field of the Invention
The present invention relates to a steering angular velocity computing device and method for computing steering angular velocity to be used in body control systems of automobiles or vessels.
2. Background Art
As a method for computing steering angular velocity as used in body control systems of automobiles or vessels, a method of moving averages has heretofore been known in which steering angular velocity is computed by the amount of change of the steering angle during a predetermined period of time. Also known is a steering angular velocity computing method in which steering angular velocity is computed by diving the amount of change of the steering angle during an interval between the moment at which steering angle made a change and the moment at which the steering angle next changed by the interval and maintaining the steering angular velocity during that interval.
These conventional methods of computing steering angular velocity are disclosed in Japanese Laid-Open Patent Application No. 2000-85609, for example.
A steering angular velocity computing device of the present invention has a steering angle detector, a timer and a steering angular velocity computing unit. The steering angle detector detects a change in a steering angle and the timer measures a required time from a time at the steering angle made a change until a time at the steering angle next changed. The steering angular velocity computing unit computes, after the detector has detected a change in the steering angle, the steering angular velocity by dividing an amount of change in the steering angle by the required time corresponding to the amount of change and produces it as an output. When the steering angular velocity is being reduced, the steering angular velocity computing unit produces a steering angular velocity output for a first extended output period longer than the required time. With this structure, the steering angular velocity is outputted with good accuracy when the steering angular velocity is being reduced.
In
Magnetic steering angle detector 16 (hereinafter referred to as “detector 16”) is provided beneath magnet 15 and opposite to magnet 15. A magnetic steering angle sensor such as an anisotropic magnetic resistance element (AMR), for example, can be employed as detector 16. Detector 16 detects a rotating state of rotating body 14 in association with a change in the steering angle and outputs a stepwise steering angle signal 18 (hereinafter referred to as “signal 18”). Furthermore, signal 18 is inputted to operating unit 17 composed of a microcomputer and the like. So, operating unit 17 computes angle of rotation and outputs steering angular velocity signal 19 (hereinafter referred to as “signal 19”). Timer 20 for timing sends information on the measured time to operating unit 17. Also, timer 20 starts timing from zero each time the measured time is reset to zero.
Now, a description of the action of device 10 having the above structure will be given in the following.
In
Detector 16 is disposed at a position opposed to magnet 15. Accordingly, when body 13 is rotated, the direction of magnetic force that penetrates detector 16 changes and detector 16 detects a change in the steering angle. Detector 16 outputs the detected change of the steering angle in the form of stepwise signal 18. In other words, a change in the steering angle corresponds to a change in signal 18. Timer 20 measures the time required from a time at signal 18 first changed to a time at signal 18 next changed. Signal 18 and the required time are input to operating unit 17, computed, and signal 19 is outputted from operating unit 17.
Next, a description will be given on the method of computing steering angular velocity.
In
Subsequently, device 10 determines whether or not signal 18 has changed (step S2). If signal 18 has changed, the amount of change Xn in the steering angle is divided by time Tn and velocity Vn=TRUNC(Xn/Tn) is computed (S3). Here, the “TRUNC” function is defined as a function in which a decimal is cut off. That is, velocity Vn is always an integer. Also, time Tn here represents the required time corresponding to the amount of change Xn in the steering angle. Velocity Vn that is a computed result is outputted from operating unit 17 as signal 19.
Next, time Tn is substituted for reference time Tn−1 that is required time for change of immediately preceding signal 18. At the same time, velocity Vn is substituted for reference velocity Vn−1 that is immediately preceding steering angular velocity (step S4). Subsequently, time Tn is reset to zero, timing by timer 20 resumes, and the step returns to step S2. And, timer 20 measures the required time Tn+1 until occurrence of next change in the steering angle, and next steering angular velocity Vn+1=TRUNC(Xn+1/Tn+1) is computed by dividing the amount of change of the steering angle Xn+1 in the next change of the steering angle by next required time Tn+1. Step 2 and subsequent steps are repeated in sequence in this way.
On the other hand, when there is no detecting a change in signal 18 in step S2, determination is made as to whether time Tn exceeds extended output period (hereinafter referred to as “period”) Te=T1+Te2=Tn−1×A+Tc×Y (step 6). Here, period Te is a sum of first extended output period (hereinafter referred to as “period”) Te1=Tn−1×A obtained by multiplying reference time Tn−1 by time coefficient A and second extended output period (hereinafter referred to as “period”) Te2=Tc×Y obtained by multiplying constant extended period Tc by the number of making extension Y.
And, if time Tn exceeds period Te, the number of making extension Y in which time Tn exceeded period Te is counted up (step 7). Subsequently, velocity Vn is substituted with reduced steering angular velocity Vn−1×BY obtained by multiplying reference velocity Vn−1 by the y-th power of velocity coefficient B and dropping a decimal, and is outputted as output 19 (step S8). Here, velocity Vn is always an integer. That is, each time the number of making extension Y increases, the rate of reduction of the reduced steering angular velocity decreases exponentially. Subsequently, the step proceeds to step S2, and step S2 and subsequent steps are repeated again.
Also, in step S6, if time Tn does not exceed period Te, the step returns to step S2 again, and step S2 and subsequent steps are repeated. As output signal 19, the value of velocity Vn is outputted.
That is, if no change in the steering angle is detected even when reference time Tn−1 has elapsed, the time during which velocity Vn is outputted is extended for extended output period Te. Extended output period Te is first extended for first extended output period Te1. Furthermore, if no change in the steering angle is yet detected, the time during which velocity Vn is outputted is extended for second extended output period Te2 obtained by multiplying constant period Tc by the number of making extension Y. Also, each time extended output period Te is extended, velocity Vn is reduced. Accordingly, the output of velocity Vn is gradually reduced even when it is not possible to detect, in the event no change in the steering angle is detected, whether steering angle change has come to a complete standstill or a steering angle change is undergoing at an extremely low velocity. And, finally, the output of velocity Vn smoothly comes to a steering angular velocity standstill.
In
In
On the other hand, time coefficient A is not applied to velocity 23, and no change in the steering angle is detected during reference time Tn−1. As a result, a part is produced during reduction of the steering angular velocity in which velocity 23 is zero as shown in
Also, because of being at a steering angular velocity standstill, it is not possible to detect whether steering angle change has come to a complete standstill or a steering angle change is undergoing at an extremely low velocity. As a result, it is not possible to know actual steering angular velocity with good accuracy.
By extending the apparent length of measuring time by means of time coefficient A as set forth above, no standstill(0 deg/s) of the steering angular velocity occurs during reduction of the steering angular velocity, and continuous velocity 22 can be outputted. Furthermore, it is possible to output accurate velocity 22 that follows actual steering angular velocity.
On the other hand,
Steering angular velocity 25 (hereinafter referred to as “velocity 25”) represents steering angular velocity signal 19 after a change in the steering angle came to a standstill. First value of steering angular velocity 26 (hereinafter referred to as “velocity 26”) represents velocity 25 when steering angle change is at a standstill. Second value of steering angular velocity 27 (hereinafter referred to as “velocity 27”) represents velocity 25 at period Te1 after the steering angle change came to a standstill. Third value of steering angular velocity 28 (hereinafter referred to as “velocity 28”) represents velocity 25 at period Te=Te1+Te2=Tn−1×A+Tc×Y, Y being equal to unity, after steering angle change came to a standstill. Period 29 is constant extended period Tc and is a period in which steering angular velocity 25 in respective periods is maintained and outputted.
In
Velocity 26 as computed last time a change in the steering angle was detected is outputted after computation of velocity Vn only during the period extended to period Te1=Tn−1×A. As an example, assuming A=5/4, velocity 26 is outputted after time has been extended by 25%. However, as no subsequent change in the steering angle is detected, when steering angular velocity is computed as is, the steering angular velocity becomes zero. This is because the amount of change in the steering angle is zero. At this time, however, it is not possible to determine whether steering angle change has come to a complete standstill or a steering angle change is undergoing at an extremely low velocity. Accordingly, in the event no change in the steering angle is detected after last detection of a change in the steering angle and, in addition, after period Te1 has elapsed, velocity 27 is outputted which is reduced steering angular velocity obtained by multiplying earlier-mentioned velocity 26 by velocity coefficient B and dropping a decimal. For example, by using a velocity coefficient of B=3/4=0.75, the steering angular velocity is reduced by 25%.
Furthermore, in the event no steering angle change is detected after the output time of velocity 27 has exceeded period 29, velocity 28 is outputted which is reduced steering angular velocity obtained by further multiplying velocity 27 by velocity coefficient B and dropping a decimal. Thus, when no change in the steering angle is detected, extended output period Te is extended in sequence by constant extended period Tc. And, velocity 25 is reduced for each period of constant extended period Tc thus approaching a state of a steering angular velocity standstill (0 deg/s) with time.
Also, when a change in the steering angle is detected again during the course of gradual reduction of velocity 25 by using velocity coefficient B, as velocity 25 increases rapidly, velocity 25 is outputted in response to actual change in the steering angle.
Also,
In
Also, time coefficient A and velocity coefficient B are set in a manner selectable depending on the last steering angular velocity. For velocity 32 and 33, time coefficient A=5/4, velocity coefficient B=3/4, and constant extended period Tc=24 ms are applied. Also, the required time for the last change in the steering angle is 50 ms for velocity 32 and 101 ms for velocity 33.
Based on the above-mentioned conditions, velocity 32 and velocity 33 come to states of steering angular velocity standstill after elapsed time of 183 ms and 198 ms, respectively, or in nearly the same time.
By the way, time coefficient A, velocity coefficient B and constant extended period Tc are not limited to the above-mentioned values. Optimum coefficients may be used at any time depending on the change of the actual steering angular velocity. Furthermore, these coefficients may be properly selected according to the characteristics of body control systems of automobiles and vessels of which a description is omitted.
Also, a decimal of detected value of steering angular velocity Vn is dropped so that it becomes an integer. However, velocity Vn is not limited to integers. For example, if there is a margin in the signal processing power, velocity Vn may be in units of 0.1 or 0.01. The resolution for outputting velocity Vn in a step-wise manner may be appropriately chosen depending on the characteristics of detector 16, operating unit 17 and body control system.
Number | Date | Country | Kind |
---|---|---|---|
2004-021070 | Jan 2004 | JP | national |
Number | Date | Country | |
---|---|---|---|
Parent | 11042149 | Jan 2005 | US |
Child | 11980383 | Oct 2007 | US |