Side tilt angle detection device for vehicle
The roll angle detection device addresses inaccuracies in bank angle detection by using a sensor drift correction system to ensure precise bank angle calculation and maintain visibility during vehicle cornering.
Patent Information
- Application Number
- DE102011081253
- Authority / Receiving Office
- DE · DE
- Patent Type
- Patents
- Current Assignee / Owner
- Priority Date
- 2010-09-22
- Filing Date
- 2011-08-19
- Publication Date
- 2024-11-21
- Estimated Expiration
- 2031-08-19
AI Technical Summary
Existing bank angle detection systems for vehicles, such as motorcycles, suffer from inaccuracies due to sensor drift, particularly at high speeds, which reduces the field of vision during cornering by narrowing the illuminated area and affecting the rider's visibility.
A roll angle detection device that includes an angular velocity sensor, a roll speed calculator, a bank angle calculator, a straight-ahead determiner, a drift height calculator, and an angular velocity corrector to accurately remove sensor drift, ensuring precise calculation of the bank angle by determining the vehicle's straight-ahead state and correcting the sensor output.
The system enhances the accuracy of bank angle calculation by removing sensor drift, thereby maintaining a wide field of vision during vehicle cornering and improving rider visibility.
Smart Images

Figure 00000000_0000_ABST
Abstract
Description
BACKGROUND OF THE INVENTION (Subject of the invention)
[0001] The present invention relates to a bank angle detecting device for a vehicle such as a motorcycle or a small planing boat, the device being capable of accurately detecting the bank angle of the vehicle during cornering of the vehicle. (Description of the state of the art)
[0002] US 2008 / 0 112 174 A1 discloses an angular velocity determination device for a motorcycle for determining an angular velocity around a vertical axis. In addition, a further angular velocity is determined around the motorcycle's longitudinal axis. The control unit calculates the motorcycle's bank angle from the determined angular velocities.
[0003] When a motorcycle approaches a curve while traveling on the road surface, the rider corners, with the motorcycle tilting at a certain angle. The standard motorcycle currently commercially available on the market has a headlight fixed to the motorcycle frame structure, and therefore, when the motorcycle tilts laterally, the optical axis of the headlight tilts simultaneously with the tilting or laterally tilting of the motorcycle. Light rays projected from the headlight to an area in front of the motorcycle, which contribute to the rider's visibility during cornering at night, tend to be reduced, resulting in a narrowing of the field of view in the direction of travel of the motorcycle.
[0004] In other words, the area illuminated by the headlight (light distribution) A, as shown in Fig. 14, which illustrates the forward view seen by the motorcyclist when and as long as the motorcycle is traveling straight ahead, represents an area extending to the left and to the right in a direction parallel to the horizontal line H, and in contrast, the area A illuminated by the headlight tilts when the motorcycle, as shown by the arrow P, tilts to the left along a curved track 90, such as in Fig. 15, turns and thus corners, with the body of the motorcycle transversely tilted to the left, compared to the area assumed during straight-ahead travel to the left and down. Consequently, the illumination area A of the headlight is reduced in an area lying within the motorcyclist's forward view and inward of the turning direction (as indicated by a circle inside the dashed line in Fig. 15), ie forwards with respect to the direction of travel of the motorcycle cornering, and in fact the rider's field of vision is restricted by the direction of the cornering to the front.
[0005] As a headlight device designed to solve the problems discussed above, JP 2004-155404 A discloses the headlight device in which a lens and a light-emitting element of the headlight are rotated in a direction opposite to the direction in which the motorcycle body is laterally tilted based on the bank angle of the motorcycle body detected by a bank angle detector.
[0006] According to the headlight device disclosed in the above-mentioned patent publication, a yaw rate sensor such as a gyroscope is used as the bank angle detector, and the bank angle δ can be given by the following formula: δ=sin−1(v⋅R / g) where v represents the motorcycle speed, g represents the acceleration due to gravity and R represents the yaw rate.
[0007] The headlight is therefore rotated by an angle corresponding to the thus determined bank angle δ in a direction opposite to the bank angle δ in order to ensure the illumination area of the headlight, which provides a large field of view.
[0008] However, the yaw rate sensor value R used in the above formula (1) is the sum of the actual yaw rate value plus the amount of sensor drift. The above-mentioned sensor drift amount is the sum of a zero-point error generated due to the electrical characteristics at the time the electrical power is turned on and the amount of time-dependent change in the zero point due to an external factor such as temperature changes. If the sensor drift amount is zero, the bank angle δ of the motorcycle can be accurately calculated using the above formula (1). However, since the sensor drift amount is not zero in practice, the bank angle δ is likely to introduce an error under the influence of such sensor drift.This probable error is generally proportional to the motorcycle speed and the sensor drift height, and therefore the probable error induced by the sensor drift height becomes particularly large where the motorcycle speed is high. SUMMARY OF THE INVENTION
[0009] The present invention has been developed to substantially eliminate the foregoing problems and inconveniences, and is intended to provide a bank angle detecting apparatus for a vehicle in which the sensor drift height is accurately removed to increase the calculated accuracy of the bank angle.
[0010] To achieve the above object of the present invention, there is provided a roll angle detecting device for a ride-on vehicle, which includes an angular velocity sensor for obtaining a detection value including a respective component of a roll velocity, which is an angular velocity about a front-and-rear axis of the vehicle, and a yaw rate, which is an angular velocity about a vertical axis of the vehicle; a roll velocity calculator for calculating a calculated roll velocity based on the detection value of the angular velocity and a traveling speed of the vehicle; a roll angle calculator for calculating a calculated roll angle of the vehicle from the calculated roll velocity;A straight-ahead travel determiner for determining a straight-ahead travel state of the vehicle during vehicle travel based on the calculated roll speed and a value associated with the calculated bank angle; a straight-ahead travel time drift height calculator for calculating a sensor drift height during straight travel of the vehicle from an output of the angular velocity sensor in the case where the straight-ahead travel determiner determines the straight-ahead travel state; and an angular velocity corrector for correcting the output of the angular velocity sensor with the sensor drift height calculated by the straight-ahead travel time drift height calculator.
[0011] It should be noted that the term "value associated with a / the calculated bank angle" mentioned above and below should be understood to include the calculated bank angle and a calculated yaw rate calculated from the calculated bank angle and the vehicle speed.
[0012] According to the design described above, the straight-ahead driving state of the vehicle is determined based on the calculated roll speed and the value associated with the calculated bank angle, such as the calculated yaw rate or the calculated bank angle. In other words, the presence or absence of slalom driving is determined from the calculated roll speed, and the size of the turning radius is determined from the calculated yaw rate or the calculated bank angle. Accordingly, the straight-ahead driving state or the driving state in which the turning radius is large enough to assume that the vehicle is traveling straight can be accurately determined.Furthermore, since the sensor drift amount during straight-line travel is calculated from the angular velocity sensor output, and the angular velocity sensor output is then corrected with the calculated sensor drift amount, the sensor drift amount during vehicle travel can be accurately calculated and removed with a simplified structure, resulting in an increase in the calculated accuracy of the bank angle. In particular, when the angular velocity corrector removes the drift amount from the angular velocity sensor output, a value close to the actual angular velocity can be obtained with the influence of the drift amount removed. Since the bank angle is calculated based on a correction value from which the influence of the drift amount has been removed, instead of the angular velocity sensor output, the calculation accuracy can be increased.
[0013] In the present invention, the angular velocity sensor is preferably arranged to tilt at a predetermined angle around a left and right axis with respect to the forward and backward axes of the vehicle. According to this configuration, the calculation of the roll angle and the removal of sensor drift can be achieved using only one angular velocity sensor, and therefore the structure can be further simplified.
[0014] Also, the straight-ahead travel determiner may be of a type that determines the straight-ahead travel state if a state in which the calculated roll speed is lower than a first predetermined determination value persists for a first predetermined period of time, and a state in which the value associated with the calculated bank angle is lower than a second predetermined determination value persists for a second predetermined period of time. According to this configuration, the vehicle may be determined not to be in a slalom state if the state in which the calculated roll speed is lower than the first predetermined value persists for the first predetermined period of time.The vehicle can also be determined to be in a straight-ahead traveling state or to be in a state of traveling with a sufficiently large turning radius to be recognized as the straight-ahead traveling state if the state in which the value associated with the calculated bank angle, for example, the calculated yaw rate or the calculated bank angle, is less than the second determination value, continues for the second predetermined time period. Furthermore, if the first and second determination values and the first and second predetermined time periods are correctly selected and set, the straight-ahead traveling state can be accurately determined.
[0015] In the present invention, the angular velocity corrector may preferably include a suppression circuit for suppressing a change in the correction amount. Since an abrupt change in the bank angle can be suppressed by the suppression circuit, this design makes it possible to prevent the driver from experiencing discomfort due to an abrupt change in the lamp illumination surface, for example, caused by the abrupt change in the bank angle.
[0016] In the present invention, the bank angle detecting device may further include a process interruption circuit which may interrupt the calculation of the drift height during straight-ahead travel, which is performed by the straight-ahead travel time drift height calculator, in the event that, following the determination of the straight-ahead travel state, the calculated roll speed and the value associated with the calculated bank angle exceed respective predetermined values, but may resume such calculation in the event that they assume respective values lower than the predetermined values.According to this design, even if the vehicle is determined to temporarily deviate from a straight-ahead traveling state due to vibration of the vehicle body due to wind or road surface condition during straight-ahead traveling, if the vehicle is determined to subsequently resume the straight-ahead traveling state, the calculation of the drift height can continue during straight-ahead traveling, and therefore, undetectable cases for calculation, which would occur when the motorcyclist intentionally rocks the motorcycle body considerably, can be reduced, whereby the calculation can be performed safely.
[0017] Where the process interruption circuit is used, it is preferable to use a reset circuit that can cancel the calculation of the drift height during straight-ahead travel, which is performed by the straight-ahead travel-time drift height corrector, in the event that the calculation fails to complete within a predetermined time period following the determination of the straight-ahead travel state. According to this configuration, in the event that the calculation is delayed because, for example, a change in the output of the angular velocity sensor is significant, canceling such a calculation can prevent erroneous calculation of the drift height during an unstable state and prevent useless continuation of the calculation.
[0018] In the present invention, the bank angle detection device may further include a standstill determiner for determining a standstill state of the vehicle and a standstill time drift amount calculator for calculating a sensor drift amount from an output of the angular velocity sensor if the standstill time determiner determines the standstill state. In this case, the angular velocity corrector corrects the output of the angular velocity sensor with the sensor drift amount calculated during the standstill state. According to this configuration, the sensor drift that occurs during the vehicle stop can be removed in addition to straight-line travel.
[0019] In the present invention, the calculated rolling speed input to the standstill determiner is preferably the one from which a change in frequency lower than a predetermined frequency is removed. Although the rolling speed remains at zero during the standstill state, it changes when a driver rides on the vehicle and when a driver rocks the vehicle body while sitting on the vehicle. On the other hand, the sensor drift amount during the standstill state can be regarded as a constant value when viewed at intervals of time in units of several tens of seconds. Even if the rolling speed changes due to an external factor such as a change in temperature, the rate of such change is sufficiently low compared to the change in the rolling speed induced by the movement of a person. Since the low-frequency change such asAccording to this design, if the sensor drift height is removed, a human-induced maneuver during the standstill state can be clearly detected, which allows for an accurate determination of the standstill state.
[0020] A roll angle detection method, which also relates to the present invention, includes a detection step of obtaining a detection value including the roll rate and yaw rate components of the vehicle using an angular rate sensor; a roll rate calculation step of calculating a calculated roll rate, which is an angular rate about a forward and backward axis, based on the detection value detected during the detection step and a traveling speed of the vehicle; a roll angle calculation step of calculating a calculated roll angle of the vehicle from the calculated roll rate;a straight-ahead traveling determination step of determining a straight-ahead traveling state of the vehicle during the vehicle's travel based on the calculated roll speed and a value associated with the calculated bank angle; a straight-ahead traveling time drift amount calculation step of calculating a sensor drift amount during the vehicle's straight travel from an output of the angular velocity sensor in the case where the straight-ahead traveling state is determined in the straight-ahead traveling determination step; and an angular velocity correction step of correcting the output of the angular velocity sensor with the sensor drift amount calculated in the straight-ahead traveling time drift amount calculation step.
[0021] According to the design described above, the straight-ahead driving condition of the vehicle is determined based on the calculated roll speed and the value associated with the calculated bank angle, such as a calculated yaw rate or the calculated bank angle. In other words, the presence or absence of the slalom driving condition is determined from the roll speed, and the size of the turning radius is determined from the calculated yaw rate or the calculated bank angle. Accordingly, the straight-ahead driving condition, or the condition in which the vehicle turns at a sufficiently large turning radius to be considered straight-ahead driving, can be accurately determined.In addition, since the sensor drift height during straight-line driving is calculated from the output of the angular velocity sensor and the output of the angular velocity sensor is corrected with the thus calculated sensor drift height, accurate calculation and removal of the sensor drift height during driving can be achieved with a simplified structure, resulting in an increase in the calculation accuracy of the bank angle. BRIEF DESCRIPTION OF THE DRAWINGS
[0022] In any event, the present invention will be more clearly understood from the following description of its preferred embodiments in conjunction with the accompanying drawings. However, the embodiments and drawings are provided for purposes of illustration and explanation only and in no way limit the scope of the present invention, which is to be determined from the appended claims. In the accompanying drawings, like reference numerals are used to designate like parts throughout the different views, and: Fig. 1 is a side view illustrating a motorcycle equipped with a headlight device equipped with a bank angle detector according to a first preferred embodiment of the present invention; Fig. 2 is a longitudinal section showing the headlight device in an enlarged manner; Fig. 3 is a block diagram showing a schematic structure of the headlight device; Fig. 4 is a block diagram showing a schematic structure of a bank angle detecting device; Fig. 5 is a front view showing the motorcycle tilted sideways; Fig. 6 is a schematic diagram showing the relationship between the motorcycle coordinate system and the sensor mounting coordinate system; Fig. 7 is a flowchart showing the calculation sequence of the calculated bank angle; Fig. Figure 8 is a flowchart illustrating the sequence of removing sensor drift; Fig. 9 is a block diagram showing a schematic structure of the headlight device according to the first embodiment of the present invention and illustrating the relationship between the calculated bank angle and the lamp angle; Fig. 10 is a block diagram showing a schematic structure of the bank angle detecting apparatus according to a second preferred embodiment of the present invention; Fig. 11 is a block diagram showing a schematic structure of a third preferred embodiment of the present invention and illustrating the relationship between the calculated bank angle and the lamp angle; Fig. 12 is a block diagram showing a schematic structure of a fourth preferred embodiment of the present invention and illustrating the relationship between the calculated bank angle and the lamp angle; Fig. Figure 13 is a schematic diagram of the motorcyclist's forward view during cornering, illustrating the illumination range available while the motorcycle is cornering; Fig. Figure 14 is a schematic illustration of the motorcyclist's forward view while the motorcycle is traveling straight ahead, illustrating the illumination area available while the motorcycle is traveling straight ahead; and Fig. 15 is a schematic diagram of the motorcyclist's forward view during cornering, illustrating the illumination area available during cornering of the motorcycle in a prior art headlight device. DETAILED DESCRIPTION OF THE VERSIONS
[0023] Preferred embodiments of the present invention will now be described in detail with reference to the accompanying drawings. In particular, Fig. 1 is a schematic side view of a motorcycle equipped with a headlight device employing a bank angle detecting device of the present invention. As shown therein, the motorcycle 1 is of a configuration in which a front wheel 5 is rotatably mounted on a front fork assembly 4 pivotally supported on a head pipe 3 at a front end portion of a motorcycle frame structure 2, and a rear drive wheel 8 is rotatably mounted on a swingarm 7 pivotally supported on a swingarm bracket 6 at a lower intermediate portion of the motorcycle frame structure 2 such that the rear drive wheel 8 can be driven by a motorcycle engine 9 mounted on a further lower intermediate portion of the motorcycle frame structure 2 forward of the swingarm bracket 6. A rear suspension 15 is mounted between the swingarm 7 and the motorcycle frame structure 2.
[0024] The front fork assembly 4 includes a headlight 12 secured thereto by a bracket 13, the headlight 12 forming part of a headlight assembly 11. However, it should be noted that if the motorcycle is of the fairing type, the headlight 12 may be attached to the motorcycle frame structure via the fairing.
[0025] The above-mentioned headlight 12 is shown schematically in Fig. 2 is shown enlarged in a longitudinal section. In the headlight 12 shown therein, an optical lens 23 is arranged in front of a bulb 22, which is a light-emitting element arranged within a lamp housing 21, and directly opposite it, such that the lens 23 can be rotated together with the bulb 22 about a longitudinal central axis C, thereby forming an illumination range changing mechanism 17.In other words, the lamp housing 21 is attached to an annular rim portion 14 located forward of the lamp housing 21 by means of at least one screw member (not shown). A generally or substantially bowl-shaped reflector 24 surrounding the light-emitting element 22 like a light bulb is also attached to the annular rim portion 14 using at least one hook and at least one screw member (both not shown). The lens 23 is rotatably supported on a rotary mandrel 26 of a lens holder stay 25 provided in the reflector 24. The reflector 24 has a central portion provided with a rotary base 27 in coaxial relationship with the lens 23, and the light bulb 22 is attached to a central portion of the rotary base 27 in line with the longitudinal central axis C by a bulb holder 31.
[0026] The rotating base 27 is rotatably supported by a fixed base 28, which extends generally radially outward from the rotating base 27, and the fixed base 28 is in turn supported by the reflector 24 by a holder 58. The rotating base 27 is connected to an outer peripheral portion of the lens 23 by means of a bracket 38. In this way, the bulb 22 and the lens 23 are made rotatable with respect to the lamp housing 21, the rim 14, and the reflector 24. The reflector 24 has a front portion with a front cover 30 attached thereto. Furthermore, an electrical cable 33 is connected to a lamp socket 37, into which the bulb 32 is inserted.
[0027] The rotary base 27 has an outer peripheral portion formed with a sector-shaped driven gear 32 provided with teeth extending over an angle of substantially 180° around the longitudinal center axis C. On the other hand, the fixed base 28 has an outer peripheral portion to which a driver 18 is attached for driving the rotary base 27 around the longitudinal center axis C. The driver 18 may be in the form of, for example, a DC motor. The driver 18 includes a drive shaft to which a round drive gear 34 is attached.
[0028] In addition, the outer peripheral portion of the fixed base 28 is provided with an encoder 29 at a position spaced from the driver 18 in a circumferential direction of the fixed base 28. The encoder 29 is used to detect the rotation angle of the rotary base 27, that is, the rotation angle of both the lens 23 and the bulb 22. The rotation of the driver 18 is transmitted to the rotary base 27 through the round drive gear 34 and then through the driven gear 32, and thus the lens 23 rotates with the bulb 32. Accordingly, the driver 18 and the illumination area changing mechanism 17 together constitute a light distribution adjusting mechanism 16.
[0029] The value sensor 29 is connected to a circular gear 35 which meshes with the driven gear 32 and is thus rotatable together with the gear 35 to detect the rotation amount (numerical quantity) or the rotation angle of the driver 18 and subsequently to detect the rotation angle of both the lens 23 and the bulb 22. The gear 35 has the same number of teeth as the drive gear 34 and is therefore rotated by the same amount as the drive gear 34.
[0030] The fixed base 28 is provided with a limit switch 36 for detecting overrotation by more than a predetermined angular range through which the rotary base 27 is rotatable about the longitudinal center axis C, and subsequently stopping the driver 18 if the overrotation occurs. Electrical power cables or signal cables for the driver 18, the encoder 29, and the limit switch 36, as well as the electrical cable 33 for the bulb 22, are pulled outward from the lamp housing 21 through a cable entry hole (not shown) defined in the lamp housing 21.
[0031] The arrangement of the lens 23 and the bulb 22 has the standard illumination area characteristic in which, at the zero rotation angle thereof, it can produce such an illumination area (light distribution) A extending left and right in a direction parallel to the horizontal line H. The illumination area characteristic of the above-mentioned type can be imparted if, for example, a light adjusting plate for adjusting the divergence direction of the light rays from the bulb 22 is used and a front or rear surface of the lens 23 is integrally formed with a number of cylindrical lens elements or Fresnel lens elements.
[0032] The structure of the headlight 12 need not necessarily be limited to that shown and described in connection with the preferred embodiment, provided that the area illuminated by the headlight can be varied when a drive signal is applied. For example, the headlight 12 need not necessarily be limited to the type in which the lens 23 is angled as shown and described above, but may be of a type in which the reflector is a reflective plate or a lamp body is angled. Although in the embodiment now being discussed, the lens 23 is in the form of a diverging lens, its use need not necessarily be limited to the diverging lens.
[0033] With reference now to Fig. 3, the headlight device 11 includes, among other things, the aforementioned headlight 12, the driver 18 and the encoder (rotational position detector) 29, both provided in the headlight 12, a bank angle detector 19, and a light distribution controller 20. The motorcycle body has three axes defined therein, which pass through a reference point defined in an angular velocity sensor 55. The three axes include a forward and backward axis C1, a left and right axis C2 perpendicular to the forward and backward axis C1, and a vertical axis C3 perpendicular to the forward and backward axis C1 and the left and right axis C2.
[0034] Specifically, the forward and backward axis C1 extends in a horizontal direction parallel to the longitudinal direction of the motorcycle when the motorcycle body is in a state of straight-ahead travel at a constant speed. The left and right axis C2 extends in a horizontal direction along the width of the motorcycle body when the motorcycle body is in a state of straight-ahead travel at a constant speed. The vertical axis C3 extends in a vertical direction perpendicular to the forward and backward axis C1 and the left and right axis C2 when the motorcycle body is in a state of straight-ahead travel at a constant speed. The axes C1 to C3 intersect each other at the sensor reference point.In addition, since the axes C1 to C3 are set in the angular velocity sensor 55, the axes C1 to C3 have their orientations changing in accordance with the motorcycle body, just as the orientation of the angular velocity sensor 55 changes with the motorcycle body.
[0035] The Fig. 3 is designed and configured such that the angular velocity about the forward and backward axis C1 (best shown in Fig. 6) of the motorcycle body, i.e., a calculated roll speed P, can be detected to output a calculated bank angle δ, and the light distribution controller 20 can be activated in response to the calculated bank angle δ supplied from the bank angle detecting device 19 to control the light distribution adjusting mechanism 16. In any case, however, the details of the bank angle detecting device 19 will be described later.
[0036] The light distribution controller 20 is operable to control the driver 18 of the light distribution adjusting mechanism 16 in response to a feedback signal supplied from the encoder 29, thereby rotating both the bulb 22 and the lens 23 through the illumination range changing mechanism 17. However, it should be noted that the light distribution controller 20 may be designed and configured to control the driver 18 of the light distribution adjusting mechanism 16 in response to an integration signal of a lamp speed command D instead of in response to the feedback signal supplied from the encoder 29.
[0037] The above-mentioned bank angle detecting device 19 is composed of the angular velocity sensor 55 which is arranged to rotate at a predetermined angle θ around the left and right axis C2 (best shown in Fig. 6) with respect to the forward and backward axis C1 (also best illustrated in Fig. 6) of the motorcycle body, a speed sensor 57 for detecting the traveling speed of the motorcycle, and a bank angle calculator 59 operable to determine the calculated bank angle δ of the motorcycle based on the angular velocity ω and the inclination angle θ detected by the angular velocity sensor 55 and the traveling speed v detected by the speed sensor 57.
[0038] The speed sensor 57 and the angular velocity sensor 55 sequentially output their detection values at intervals of a predetermined time. The vehicle speed v can be determined, for example, from the number of revolutions of a motorcycle wheel, from an output value of an acceleration sensor for detecting acceleration in a forward and reverse direction, or from a gear ratio and the number of revolutions of a motorcycle engine.
[0039] The angular velocity sensor 55 is used in the form of, for example, a gyroscope and is operable to detect the angular velocity ω about a sensor axis C4 which, as best shown in Fig. 6, extends through the left and right axes C2, and is tilted by a predetermined inclination angle θ with respect to the forward and backward axes C1 in a plane containing the forward and backward axes C1 and the vertical axis C3. The angular velocity ω detected by the angular velocity sensor 55 includes a component of the calculated roll velocity P, which is the angular velocity about the forward and backward axes C1, and a component of a calculated yaw rate R, which is the angular velocity about the vertical axis C3.
[0040] It should be noted that in the illustrated embodiment now being discussed, with respect to the angular velocity sensor 55 used to detect the angular velocity about the predetermined sensor axis C4, the sensor axis C4 is preferably positioned to incline with respect to both the forward and backward axes C1 and the vertical axis C3, and the shape and posture of the angular velocity sensor 55 can be suitably selected as desired.
[0041] The details of the bank angle detecting device 19 are best shown in Fig. 4. The bank angle calculator 59 includes a roll rate calculator circuit 60 for calculating the calculated roll rate P from an output of the angular rate sensor 55, a calculated yaw rate R, as will be described later, and the traveling speed v of the motorcycle, an angular rate integrating circuit 62 for integrating the calculated roll rate P on a time basis to output the calculated bank angle δ, a feedback circuit 64 for determining the calculated yaw rate R, which is the angular rate about the vertical axis C3 (shown in Fig. 6) of the motorcycle, based on the calculated bank angle δ and the speed v, and then performs a negative feedback thereof to the angular velocity ω, and a drift removal circuit 66 for setting the angular velocity ω to zero when a predetermined straight-ahead traveling condition or a standstill condition is met. The details of the drift removal circuit 66 will be described later.
[0042] The bank angle calculator 59 calculates the calculated bank angle δ by performing time integration of the calculated roll speed P obtained based on the pitch angle θ of the angular speed sensor 55, the angular speed ω detected by the angular speed sensor 55, and the speed v detected by the speed sensor 57.
[0043] The feedback circuit 64 includes a yaw rate calculator 68 for calculating the calculated yaw rate R, which is a value associated with the calculated bank angle, based on the calculated bank angle δ' previously calculated and the speed v, a yaw component calculator 70 for calculating a yaw component of the angular rate sensor 55 by multiplying the calculated yaw rate R by cos θ, and a negative feedback circuit 72 for negatively feeding the value of the yaw component to the angular velocity ω, which is a detection value of the angular rate sensor 55. The negative feedback circuit 72 is used in the form of a subtractor in the embodiment now being discussed.
[0044] In other words, it has been achieved that the calculated bank angle δ can be obtained from the calculated roll rate P, which is corrected at any time with the calculated yaw rate R. For this reason, an accumulation of influences caused by a zero-point shift of the angular rate sensor 55 and an integration error over time are avoided.
[0045] A method for detecting the calculated bank angle δ with the bank angle calculator 59 will now be described in detail, particularly with reference to the Fig. 5 and Fig. 6. Assuming that the turning radius of the motorcycle is expressed by r, the gravitational velocity is expressed by g, and the angular velocity (the yaw rate in the fixed coordinate system) around the vertical axis, which is fixed regardless of the attitude of the motorcycle body, is expressed by R0, the calculated yaw rate R when the motorcycle is turned at the bank angle δ with respect to the vertical axis of the motorcycle body as shown in Fig. 5, is tilted, expressed by the following formula (2): R = R0⋅cos δ
[0046] On the other hand, the centrifugal force f acting on the center of gravity G of the motorcycle is expressed by the following formula (3) if the mass of the motorcycle is expressed by m: f = m⋅v⋅v / r
[0047] In formula (3), the mass m is the sum of the masses of the motorcycle body and the motorcyclist.
[0048] Since R0 can be expressed by v / r, that is, by the following formula (4), inserting formula (4) into formula (3) gives the centrifugal force f expressed by the following formula (5): R0 = v / r f = m ⋅v⋅R0
[0049] In addition, since there is a relationship between the centrifugal force f acting on the motorcycle body and the gravity force m g with the bank angle δ, as expressed by the following formula (6), inserting the formula (5) into the formula (6) results in the following formula (7): tan δ = f / (m⋅g) tan δ =v⋅R0 / g
[0050] The above formula (7), if the bank angle δ is inserted into the above formula (2), can be expressed as follows: tan δ=v⋅R / (g⋅cos δ)
[0051] From the above formula (8), a relationship as expressed by the formula (9) below can be obtained, and accordingly, the calculated bank angle δ can be expressed by the following formula (10): sin δ =v⋅R / g δ=sin−1(v⋅R / g)
[0052] Since the angular velocity sensor 55, as best described in Fig. 6, is arranged inclined by the inclination angle θ with respect to the forward and backward axis C1, the angular velocity ω measured by the angular velocity sensor 55, by the coordinate conversion from the motorcycle body coordinate system (single-dotted line) to the sensor bracket coordinate system (solid line), results in a combination of a roll component P · sin θ, which includes the roll velocity P, with a yaw component R · cos θ, which includes the yaw velocity R, and thus results in the following formula (11): ω = P⋅sin θ + R⋅cos θ
[0053] Since the parameters P and R are not a directly measured value, it should be noted that they are subsequently referred to as the calculated roll rate P and the calculated yaw rate R, respectively.
[0054] Determining the calculated yaw rate R from the above formula (9) and inserting it into the above formula (11) gives the calculated roll rate P, which is expressed by the following formula (12): P = [ω − (g⋅sin δ⋅cos θ) / v] / sin θ
[0055] When the calculated roll speed P is integrated, the calculated bank angle δ is calculated. In other words, the calculated bank angle δ is expressed by the following formula (13), assuming that the previously calculated calculated bank angle is expressed by δ': δ=∫ωgvsin δ'⋅cos θsin θdt
[0056] The Fig. The yaw rate calculator 68 shown in FIG. 4 is operable to calculate the calculated yaw rate R (= g · sin δ' / v) by referring to the calculated bank angle δ' previously measured and the vehicle speed v detected by the speed sensor 57. The aforementioned yaw component calculator 70 is operable to calculate a yaw component R · cos θ detected by the angular velocity sensor 55 by multiplying the calculated yaw rate R by cos θ. The negative feedback circuit 72 is operable to output a roll component P sin θ included in the detection value ω of the angular velocity sensor 55 by subtracting the yaw component R cos θ from the angular velocity ω (= P sin θ + R cos θ) measured by the angular velocity sensor 55.
[0057] The above-mentioned roll rate calculating circuit 60 is operable to calculate the calculated roll rate P (as expressed by the aforementioned formula (12)) by dividing the calculated roll component P · sin θ by sin θ. In other words, the roll rate calculating circuit 60 determines the roll rate component P · sin θ by subtracting the yaw rate component R · cos θ, i.e., (g / v) · sin δ · cos θ, from the angular rate ω detected by the angular rate sensor 55, and then calculates the calculated roll rate P by dividing this thus determined value by sin θ. The roll rate calculating circuit 60 thus calculates the calculated roll rate P based on the angular rate ω supplied from the angular rate sensor 55 and the vehicle speed v input to the yaw rate calculator 68.The angular velocity integrating circuit 62 is operable to calculate the calculated bank angle δ by integrating the calculated roll velocity P (as expressed by the aforementioned formula (13)).
[0058] The above-mentioned drift removing circuit 66 includes a traveling / stopping determiner 65 for determining, based on the speed v, whether the motorcycle is traveling or stopped, a straight-ahead traveling determiner 67 for determining, while the motorcycle is traveling, whether the motorcycle is traveling straight based on the detection value ω of the angular velocity sensor 55, a straight-ahead traveling time drift amount calculator 69 for calculating a sensor drift update amount D1 during the straight traveling of the motorcycle by averaging a signal ω1 in which a calculated sensor drift amount D has been removed from the output ω of the angular velocity sensor 55 if the straight-ahead traveling determiner 67 determines that the motorcycle is traveling straight, and an angular velocity corrector 71 for correcting the output ω of the angular velocity sensor 55 with the sensor drift amount D.
[0059] The above-mentioned straight-ahead traveling determiner 57 is adapted to determine that the motorcycle is traveling straight when a state in which the calculated roll speed P is smaller than a predetermined first determination value J1 continues for a constant time t1, and at the same time, a state in which the calculated yaw rate R is smaller than a predetermined second determination value J2 continues for the constant time t1.
[0060] States of the motorcycle body during its travel can be classified into straight-ahead travel, turning, and slalom travel. In the straight-ahead travel state, neither roll rate nor yaw rate occur, but during the turning state, only yaw rate and no roll rate occur, and during the slalom state, both roll rate and yaw rate occur. Accordingly, if the straight-ahead travel state is detected while the motorcycle is traveling, the calculation of the sensor drift amount D is possible because it is assumed that the input ω of the angular velocity sensor 55 includes only the sensor drift amount D.
[0061] How best in Fig. As shown in Figure 4, the calculated roll speed P is calculated during the calculation of the bank angle δ. If the condition that the calculated roll speed P is sufficiently small continues for a constant length of time, it can be determined that the motorcycle body is traveling straight or turning. If it can also be determined that the yaw rate is zero, the straight-ahead traveling state and the turning state can be distinguished. However, if the motorcycle travels straight while the sensor drift height D exists, the Fig. 4 is calculated as D / cos θ. In other words, the straight-ahead driving state and the turning state cannot be distinguished from each other only by determining whether the calculated yaw rate R is zero or not.
[0062] However, if the calculated yaw rate R is equal to 1 (deg / sec), this means that the turning radius at a driving speed of 30 km / h is approximately 336 meters, and the turning radius at a driving speed of 150 km / h is approximately 1683 meters. This condition should be considered a straight-ahead driving condition without any problems. Accordingly, if the condition where the calculated yaw rate R is sufficiently small persists for a constant period of time, it is determined as if the straight-ahead driving condition is occurring.In the embodiment now being discussed, the straight-ahead determiner 67 determines the straight-ahead traveling state by reference to the calculated roll rate P and the calculated yaw rate R, but it may also be determined by reference to the calculated bank angle δ instead of the calculated yaw rate R, or alternatively, it may be determined by reference to both the calculated yaw rate R and the calculated bank angle δ. The straight-ahead traveling state is thus determined using the calculated roll rate P and a value associated with the calculated bank angle δ (the calculated yaw rate P or the calculated bank angle δ).
[0063] The above-mentioned straight-ahead-time drift amount calculator 69 includes an averaging circuit for averaging a signal ω1 for a predetermined time t3, the signal ω1 corresponding to the output ω of the angular velocity sensor 55 from which the calculated drift amount D has been removed if the straight-ahead traveling state is determined by the straight-ahead traveling determiner 67. The predetermined time t3 is a time during which the averaging process is performed under the straight-ahead traveling state. As described above, since the angular velocity sensor input ω represents the sensor drift amount D during the straight-ahead traveling state, the sensor drift amount D can be calculated from the angular velocity sensor input ω generated at the time of the thus-determined straight-ahead traveling state.In addition, the average value after the averaging process has been performed for the predetermined time length t3 is reflected as a straight-ahead-time sensor drift update amount D1 in consideration of influences caused by noise.
[0064] The drift removing circuit 66 also includes a standstill determiner 73 for determining a standstill state of the motorcycle from the calculated rolling speed P during the motorcycle's stop, and a standstill time drift amount calculator 75 for calculating a sensor drift update amount D2 at the standstill time by averaging the signal ω1 corresponding to the output ω of the angular velocity sensor 55, from which the calculated sensor drift amount D has been removed, if the standstill determiner 73 determines the standstill state. The above-mentioned standstill determiner 73 is configured to determine the standstill state when a state in which the calculated rolling speed P is less than a predetermined third determination value J3 continues for a constant time t2.
[0065] The angular velocity corrector 71 includes a switch 63 capable of being turned on by the straight-ahead determination of the straight-ahead determiner 67 or by the standstill determination of the standstill determiner 73, and is operable to perform a correction based on the straight-ahead time sensor drift update level D1 or the sensor drift update level D2 at the standstill time. The calculated roll speed P input to the standstill determiner 73 is the one from which a change in frequency lower than a predetermined frequency f has been removed by means of a high-pass filter 77. The value of the predetermined frequency f is selected to be, for example, 0.2 Hz and preferably 0.1 Hz. The removal of the low-frequency change discussed above may be achieved by any suitable means other than the high-pass filter 77, or it may be omitted.
[0066] Since the motorcycle body does not turn during stoppage, i.e., no yaw rate is generated, the output ω of the angular velocity sensor 55 corresponds to the sum of the roll rate and the sensor drift heights D during the standstill time. While the roll rate is zero as long as a kickstand remains in contact with a ground surface, it changes when a rider mounts and the motorcycle body is rocked by the rider sitting on the motorcycle body. On the other hand, the sensor drift height can be regarded as a constant value if it is observed at intervals of time in units of several tens of seconds. Although the sensor drift height changes due to an external factor such as a change in temperature, the rate of such change is sufficiently small when compared with a change in roll rate induced by a human action.By utilizing this characteristic, if a high-pass output process is applied to the signal ω1 by the high-pass filter 77 in a manner in which the calculated drift amount D has been removed from the output ω of the angular velocity sensor 55, the rolling velocity component can be extracted. In other words, this means that the motorcycle body remains stationary if the state in which the output of the high-pass filter 77 is sufficiently low continues for a constant time.
[0067] The standstill time drift amount calculator 75 includes an averaging circuit capable of averaging the signal ω1 for a predetermined time t4, where the signal ω1 corresponds to the output ω of the angular velocity sensor 55, from which the calculated drift amount D has been removed if the standstill determiner 73 determines the standstill state. The predetermined time t4 is a time during which the averaging process is executed under the standstill state. In the embodiment now being discussed, the averaging process time t3 during straight-line travel and the averaging process time t4 during standstill are selected as different values from each other, but they may be the same times.
[0068] As described above, since the rolling speed is sufficiently small during the motorcycle body standstill determination, a relationship exists such that the output ω of the angular velocity sensor 55 is the sensor drift amount D. Accordingly, the sensor drift amount D can be calculated from the output ω of the angular velocity sensor 55. In addition, considering the influences caused by noise, the average value averaged for a constant time length t4 is assumed to be a standstill time sensor drift update amount D2.
[0069] The above-mentioned drift removing circuit 66 includes a process interruption circuit 81 operable to interrupt the calculation of the straight-ahead time drift update amount D1 performed by a straight-ahead time drift amount calculator 69 if the calculated roll rate P and the calculated yaw rate R exceed the first and second determination values, J1 and J2, respectively, within the predetermined time length t3 during which the averaging process takes place. Alternatively, an arrangement may be made such that if either the calculated roll rate P or the calculated yaw rate R exceeds the first determination value J1 or the second determination value J2, the calculation is interrupted.The calculation is resumed when the state in which the calculated roll rate P and the calculated yaw rate R are smaller than the first and second determination values, J1 and J2, respectively, within a predetermined time length t5 following the straight-ahead determination continues for the predetermined time length t1. Also, if the calculation of the straight-ahead time drift update amount D1 by the straight-ahead time drift amount calculator 69 is not completed within the predetermined time length t5 following the straight-ahead determination, or if the calculated roll rate P and the calculated yaw rate R exceed sway determination values J4 and J5, respectively, a reset circuit 83 is included to cancel such a calculation process by the drift removing circuit 66.Accordingly, if the calculation is interrupted in the event that such a calculation is delayed, for example, because an output change of the angular velocity sensor 55 is significant, the prevention of erroneous calculation of the drift amount and useless continuation of the calculation during an unstable state can be avoided. In any case, the details of the process taking place in the drift removal circuit 66 will be described later.
[0070] The angular velocity corrector 71 receives a calculated value E1 of the straight-ahead travel time drift update amount D1 or the standstill time drift update amount D2 after completion of the averaging process, and obtains a calculated sensor drift amount D by adding it to a calculated value E0 of the previous cycle by a first adding circuit 85. The sensor drift of the angular velocity sensor 55 can be removed by subtracting the calculated sensor drift amount D from the output ω of the angular velocity sensor 55 by a first subtracting circuit 87. A suppressing circuit 89 for suppressing a change in the correction can be inserted between the first adding circuit 85 and the first subtracting circuit 87.The suppression circuit 89 is used to relax the rate of change of the calculated sensor drift amount D and is operable to set a rate of change sufficient to remove the drift within, for example, a (0.5 x t3) time.
[0071] The bank angle calculator 59 and the light distribution controller 20 are arranged in a Fig. 3 and are arranged, for example, below a motorcycle seat assembly 40. The angular velocity sensor 55, although preferably arranged near the center of gravity G, which is defined as containing the motorcycle body and the motorcyclist, can be arranged at any suitable location, provided sufficient stability can be ensured, and therefore need not necessarily be limited to the vicinity of the center of gravity G.
[0072] As can be easily understood from the above equation (11), influences caused by the yaw component R · cos θ become considerable when the inclination angle θ of the angular velocity sensor 55 is small, ie, approaches zero. Conversely, when the inclination angle θ becomes large, ie, approaches 90°, the influences caused by the roll component P · sin θ become considerable. In view of this, the Fig. 6, the inclination angle θ of the angular velocity sensor 55 is preferably within the range of 30 to 60°, and is more preferably 45°. However, since the optimal angle varies depending on the accuracy (drift height) of the angular velocity sensor 55 and / or the driving characteristics of the motorcycle body, the angle less than 30° and the angle greater than 60° are understood to be within the spirit of the present invention.
[0073] The flow chart showing the sequence of calculation of the previously mentioned calculated bank angle δ is as shown in Fig. 7. Now referring to Fig. 7, following the start of the calculation process of the bank angle δ, an angular velocity detection step S1 takes place to successively detect the angular velocity ω in which the roll component P · sin θ containing the calculated roll velocity P and the yaw component R · cos θ containing the calculated yaw velocity R are combined, at intervals of a predetermined time.
[0074] It should be noted that in the embodiment now being discussed, the roll component P · sin θ and the yaw component R · cos θ are measured using the single angular velocity sensor 55 (best in Fig. 6), which is arranged to tilt with the tilt angle θ, but even if separate sensors are used for the detection of the roll rate and the detection of the yaw rate, the flow chart for calculating the calculated bank angle as in Fig. 7 can also be applied.
[0075] After the angular velocity detection step S1, the traveling speed v of the motorcycle is detected in a speed detection step S2, followed by a step S3 of recording the bank angle of the previous cycle. During the step S3 of recording the bank angle of the previous cycle, a calculated bank angle δ n-A , which at a given time t n previous time t n-Adetermined. In the embodiment now being discussed, the calculated bank angle recorded during a step S7 of storing and outputting the bank angle is recorded, as will be described later.
[0076] The step S3 of recording the bank angle of the previous cycle is followed by a yaw component calculation step S4, in which, using the calculated bank angle δ recorded in the step S3 of recording the bank angle of the previous cycle n-A of the previous cycle the yaw rate R n-A , if the motorcycle is travelling at a speed v at the relevant time t n tilts, is calculated and also the yaw component R n-A· cos δ, which is detected by the angular velocity sensor 55 when the motorcycle turns at this yaw rate R, is calculated. In the embodiment now being discussed, the yaw rate R n-A as g(sin δ n-A ) / v determined.
[0077] A roll velocity extraction step S5 then takes place, in which the yaw component R n-A cos θ of the angular velocity ω n at the relevant time t n is subtracted to determine the roll component P n · sin θ and the rolling speed P n from the rolling component P n · sin θ is extracted. After that, a bank angle calculation step S6 takes place, in which the calculated bank angle δ n of the motorcycle at the relevant time t n by integrating the time period from a predetermined time t0 to the respective time t nsuccessively extracted rolling speeds P is calculated.
[0078] Finally, step S7 of storing and outputting the bank angle takes place, in which the calculated bank angle δ n recorded and output. The recorded calculated bank angle δ n is called the bank angle δ n-A of the previous cycle at step S4 of detecting the bank angle of the previous cycle during the subsequent cycle of calculating the calculated bank angle.
[0079] Now referring to Fig. 8, the process of removing the sensor drift is now described. Fig. 7 shown bank angle detection process and the one in Fig. 8 take place simultaneously. Whether the motorcycle is running or stopped is initially determined by a running-stop determiner 65 based on the speed sensor 57 at a step S10, which is a Fig. 8 is the driving state determination step. This determination is performed based on whether the motorcycle speed is higher or lower than 1 km / h.
[0080] If the motorcycle is determined to be stopped at step S10, a step S21 takes place in which a signal ω1 corresponding to the angular velocity sensor input ω from which the calculated drift height D has been removed is input to the high-pass filter 77 to calculate the calculated rolling speed P from which the low-frequency variation has been removed. The calculation step S21 is followed by a step S22 in which the standstill state is determined. During the standstill state determination step S22, the calculated rolling speed P obtained at step S21 is compared with the third determination value J3. If the calculated rolling speed P is higher than the third determination value J3, the non-standstill state is determined in a step S25.On the other hand, if the calculated rolling speed P is lower than or equal to the third determination value J3, the program flow proceeds to step S23, at which, depending on the state in which the calculated rolling speed P is lower than or equal to the third determination value, a time length longer than the predetermined time t2 continues. If the time length continues longer than the predetermined time t2, step S24 proceeds, at which the standstill state is determined, or otherwise a non-standstill state is determined at step S25. The third determination value J3 is selected as, for example, 2 deg / sec, and the predetermined time length t2 is selected as, for example, 2 seconds.
[0081] If the motorcycle is determined to be in the running state at step S10, a step S11 takes place in which the roll speed P and the yaw rate R are calculated. In this calculation step S11, the calculated yaw rate R and the calculated roll speed P are obtained from the yaw component calculation step S4 and the roll speed extraction step D5, respectively, which are both shown in the flowchart of Fig. 7. Thereafter, at a step S12 in the flow chart of Fig. 8, in which the straight-ahead traveling state is determined, the straight-ahead traveling state is determined by the straight-ahead traveling determiner 67 using the calculated yaw rate R and the calculated roll rate P. More specifically, the calculated roll rate P is compared with the first determination value J1, and the calculated yaw rate R is compared with the second determination value J2.If the calculated roll speed P is lower than or equal to the first determination value J1 and the calculated yaw rate R is also lower than or equal to the second determination value J2, the program flow goes to a step S13, at which it is determined by the straight-ahead determiner 67 whether or not the state in which the calculated roll speed P is lower than or equal to the first determination value J1 and the calculated yaw rate R is lower than or equal to the second determination value J2 continues for a length of time longer than the predetermined time t1. If the state that the calculated roll and yaw rates, P and R, are lower than the first and second determination values, J1 and J2, respectively, continues for a length of time longer than the predetermined time t1, the program flow goes to a step S14, at which it is determined by the straight-ahead determiner 67 whether or not the state in which the calculated roll and yaw rates, P and R, are lower than the first and second determination values, J1 and J2, respectively.J2, continues for a time longer than the predetermined time t1, the straight-ahead traveling state is determined in step S15, or otherwise, the non-straight-ahead traveling state is determined in step S16. The first and second determination values, J1 and J2, are, for example, 2 deg / sec and 1.5 deg / sec, respectively, and the predetermined time t1 is selected to be, for example, 2 seconds.
[0082] If it is determined at step S12 that at least one of the calculated roll speed P and the calculated yaw rate R is greater than the first and second determination values, J1 and J2, step S12 is followed by step S14, where a determination is made as to whether to interrupt the averaging process. Specifically, if it is determined at step S14 that the calculated roll speed P and the calculated yaw rate R are lower than or equal to the corresponding sway determination values, J4 and J5, and a predetermined time length t5 does not continue after the straight-ahead traveling determination, step S17 is performed, where "the straight-ahead traveling and interruption averaging process" is determined.Accordingly, erroneous calculation of the drift height during the unstable state and calculation delay due to unavailability of the sensor drift height are avoided. The above-mentioned rocking determination values, J4 and J5, are, for example, 6 deg / sec and 4.5 deg / sec, respectively, and the predetermined time length t5 is selected to be, for example, 10 seconds. If the time length exceeds the predetermined time t5, or if the calculated roll rate P and the calculated yaw rate R exceed the corresponding rocking determination values, J4 and J5, the non-straight-ahead state is determined in step S16.
[0083] If the non-straight-ahead or non-stationary state is determined at step S16 or step S25, the program flow proceeds to a canceling (resetting) step S30, where a reset occurs. At this step S30, the then-ongoing averaging process is canceled by the reset circuit 83, and the program flow thus returns to the start. On the other hand, if the "straight-ahead and averaging interruption process" is determined at step S17, neither the averaging process nor a reset occurs, and the program flow goes directly to the start.
[0084] If the standstill state is determined at step S24 or the straight-ahead traveling state is determined at step S15, the program flow proceeds to a sensor drift update amount calculation step S31, in which the straight-ahead traveling time drift amount calculator 69 or the standstill time drift amount calculator 75 calculates the sensor drift update amount, respectively. At this step S31, a process of averaging the signal ω1 corresponding to the output ω of the angular velocity sensor 55 takes place, from which the calculated drift amount D is removed.
[0085] In a subsequent step S32, it is determined whether or not the averaging process continues for a predetermined time period t3 and t4. If it is determined in step S32 that the averaging process continues for the predetermined time period t3 or t4, the averaging process stops. In this case, the predetermined time period t3 for the straight-ahead traveling state is selected as, for example, 8 seconds, and the predetermined time period t4 for the stationary state is selected as, for example, 4 seconds. If the straight-ahead traveling state or the stationary state is released within the predetermined time period t3 or t4, respectively, that is, step S32 determines the non-straight-ahead traveling state or the non-stationary state, the averaging process is canceled in step S30, and the calculation of the sensor drift amount does not stop.
[0086] If the averaging process stops, the program flow goes to step S33, where the sensor drift height is extracted. In this step S33, the thus averaged straight-ahead travel time drift update height D1 or the thus averaged standstill time drift update height D2 is extracted and, after being added to the calculated value E0 of the previous cycle by the first adding circuit 85, as best shown in Fig. 4 to obtain the calculated sensor drift amount D, the calculated sensor drift amount D is subtracted from the output ω of the angular velocity sensor 55 by the first subtraction circuit 87 through the suppression circuit 89, thereby removing the sensor drift from the angular velocity sensor 55. After extracting the sensor drift, the straight-ahead traveling state or the standstill state and the averaging process are reset at a step S34, and the program flow thus returns to the start.
[0087] Fig. 9 illustrates a block diagram for controlling a lamp angle based on the calculated bank angle δ calculated by the bank angle detecting device 19 of the present invention. The headlight device 11 of the type described above includes the light distribution controller 20, a lamp speed integrating circuit 74 for determining the lamp angle α by time-integrating a lamp speed command value D output from the light distribution controller 20, a second subtracting circuit 76 for determining a difference between the previously discussed calculated bank angle δ and the lamp angle α, and a feedback line 78 through which an output of the lamp speed integrating circuit 74 is fed back to a negative input of the second subtracting circuit 76.
[0088] The second subtractor circuit 76 is operable to generate the difference (δ - α) between the calculated bank angle δ output by the bank angle detecting device 19 and the lamp angle α output by the lamp speed integrating circuit 74 as a lamp angle control deviation δ1. The light distribution controller 20 is operable to output the lamp speed command D based on an output value of the second subtractor circuit 76. The lamp speed integrating circuit 74 is operable to output the lamp angle α by integrating the lamp speed command D. The feedback line 78 is operable to feed the lamp angle α, which is an output of the lamp speed integrating circuit 74, back to the negative input of the second subtractor circuit 76. The light distribution controller 20 is operable to control the light distribution adjusting mechanism 16.
[0089] By the operation of the light distribution adjusting mechanism 16, both the lens 23 and the bulb 22 are Fig. 3 is rotated in a direction opposite to the direction in which the motorcycle body is transversely tilted, thereby rotating the illumination area (light distribution) A in this opposite direction at a speed equal to the lamp speed command D ( Fig. 9). At this time, the angle of rotation of the bulb 22 and the lens 23 is selected by controlling the rotation of the driver 18 to reach a value within the range of a value equal to the calculated bank angle δ to a value twice the calculated bank angle δ. The light distribution controller 20 causes the driver 18 to stop when the lamp angle α reaches the calculated bank angle δ. Accordingly, the illumination area A is rotated by the angle corresponding to the calculated bank angle δ ( Fig. 9) is rotated in a direction opposite to the direction in which the motorcycle is tilted transversely. Note that the lamp angle α can be determined from the degree of rotation of the driver 18, which is detected by the value sensor 29.
[0090] If the motorcycle, as in Fig. 13, changes its direction of travel in such a way as to turn, for example, to the left as shown by the arrow P along the curved path 90, the illumination area A of the headlight device 11 changes from a state in which the illumination area A changes to the left and to the right along the horizontal line H during the straight travel of the motorcycle, as shown in Fig. 14, extends to a state in which the illumination area A, as shown in Fig. 13, is tilted to the top left. Consequently, in comparison to the case which shows the Fig. 15 and with reference to the Fig. 15 is discussed, much light is directed into an area inward of the turning direction (a region indicated by the dashed circle in Fig. 15) in which the driver's eyes are directed, and therefore a correspondingly large field of vision can be obtained.
[0091] It should be noted, however, that depending on the shape of the illumination area A, it may happen that a light distribution towards the area inward of the turning direction, in which the driver's eyes are directed, is increased by rotating the illumination area A in the direction consistent with, and not opposite to, the direction in which the motorcycle is transversely tilted by an angle corresponding to the size of the calculated transverse tilt angle δ.
[0092] According to the design described above, the determination of the straight-ahead running state can be achieved accurately because the straight-ahead running state of the motorcycle is determined based on not only the calculated yaw rate R, which is calculated from the calculated bank angle δ, but also the calculated roll rate P.In addition, since the sensor drift update height D1 during the straight running of the motorcycle is calculated based on the signal ω1 corresponding to the output ω of the angular velocity sensor 55 from which the calculated drift height D has been removed, and the output ω of the angular velocity sensor 55 is corrected with the sensor drift height D calculated based on the sensor drift update height D1 during the straight running of the motorcycle, accurate calculation and removal of the sensor drift during the running of the motorcycle can be achieved with a simplified structure, and accordingly, the accuracy of the calculation of the bank angle δ can be increased.
[0093] In addition, since the angular velocity sensor 55 is arranged to tilt at a predetermined tilt angle θ around the left and right axis C2 with respect to the forward and backward axis C1 of the motorcycle, it is possible to calculate the bank angle δ and remove the sensor drift with the single angular velocity sensor 55, and therefore the structure can be further simplified.
[0094] In addition, since the straight-ahead traveling determiner 67 determines the straight-ahead traveling state when the state in which the calculated roll speed P is smaller than the predetermined first determination value J1 continues for the constant time length t1 and the state in which the calculated yaw rate R is lower than the predetermined second determination value J2 continues for the constant time length t1, the straight-ahead traveling state can be easily determined if the calculated yaw rate R and the calculated roll speed P, which can be obtained during the process of calculating the calculated bank angle δ, are used in the determination of the straight-ahead traveling state.
[0095] Furthermore, since the angular velocity corrector 71 includes the suppression circuit 89 for suppressing the correction change, it is possible to prevent an abrupt change in the calculated bank angle δ. For example, it is possible to prevent the possibility that the motorcyclist may experience a feeling of discomfort when the area illuminated by the lamp changes abruptly.
[0096] In addition, use is made of the process interrupting circuit 81 for interrupting the calculation of the drift height D1 during the straight-ahead travel of the motorcycle by the straight-ahead travel time drift height calculator 69 if, after the straight-ahead travel determination of the motorcycle, the calculated roll speed P or the calculated yaw rate R exceeds the first determination value J1 or the second determination value J2, respectively, but the calculation can be resumed in the case that the calculated roll speed P or the calculated yaw rate R reaches a value lower than the first determination value J1 or the second determination value J2.Even if a straight-ahead determination state is temporarily deviated due to the motorcycle rocking due to wind and / or road surface conditions during the motorcycle's straight-ahead travel, the calculation of the straight-ahead time drift update amount D1 can be continued accordingly once the straight-ahead travel state is subsequently resumed. Therefore, inappropriate calculation cases, which would occur if the motorcyclist intentionally rocks the motorcycle body considerably, can be reduced, allowing the calculation to be performed reliably.
[0097] Furthermore, the reset circuit 83 is used to cancel the calculation of the straight-ahead time drift amount D1 performed by the straight-ahead time drift amount calculator 69 if the calculation has not been completed within the predetermined time t5 following the determination of the straight-ahead travel of the motorcycle. Accordingly, it is possible to prevent erroneous calculation of the drift amount during the unstable state and useless continuation of the calculation when the calculation is aborted, for example, if the calculation is delayed due to a significant change in the output of the angular velocity sensor 55.
[0098] However, use is made of the standstill determiner 73 for determining the standstill state of the motorcycle from the calculated rolling speed P and the standstill time drift amount calculator 75 for calculating the sensor drift update amount D2 during the standstill state based on the signal ω1 corresponding to the output ω of the angular velocity sensor 55 from which the calculated drift amount D has been removed if the standstill determiner 73 determines the standstill state of the motorcycle. In addition, the angular velocity corrector 71 corrects the output ω of the angular velocity sensor 55 with the calculated drift amount D calculated based on the sensor drift update amount D2 during the standstill state. Accordingly, not only the sensor drift occurring during the straight running of the motorcycle but also the sensor drift occurring during the motorcycle's stop can be removed.
[0099] Furthermore, since the estimated roll velocity input to the stall determiner 73 is calculated from the angular velocity sensor input ω, in which the frequency variation lower than the predetermined frequency has been removed, the roll velocity component during the stall state can be extracted. Since the low-frequency variation is accordingly removed, human-induced tampering during the stall state can be clearly detected, and the stall state can therefore be accurately determined.
[0100] Fig. Fig. 10 illustrates a block diagram showing a schematic structure of the bank angle detecting device 19A designed in accordance with a second preferred embodiment of the present invention. While in the practice of the above-described first embodiment, the calculated bank angle δ is calculated from the single angular velocity sensor 55 arranged to tilt as described above, the Fig. 10 such that a roll rate component sensor 55A and a yaw rate component sensor 55B are arranged such that the calculated bank angle δ can be calculated on the basis of corresponding detection values of these sensors, 55A and 55B.
[0101] The bank angle calculator 59A of the bank angle detecting device 19A according to the second embodiment includes a calibration bank angle detector 86, a first division circuit 88, a third subtraction circuit 92, a second addition circuit 94, an angular velocity integrating circuit 62, and a feedback line 96. The calibration bank angle detector 86 is operable to calculate a motorcycle body bank angle δ1 for calibration purposes with reference to an output ωy of the yaw component sensor 55B, the output ωy being corrected by a yaw component subtraction circuit 87B as described later, and the speed v of the motorcycle measured by the speed sensor 57.The third subtraction circuit 92 is operable to generate a difference (δ1 - δ) between the body roll angle δ1 for calibration and the calculated roll angle δ output from the angular velocity integrating circuit 62, and the first division circuit 88 is operable to divide this difference (δ1 - δ) by a time T. The second addition circuit 94 is operable to add an output of the first subtraction circuit 88 and an output of the roll velocity component sensor 55A to each other to calculate the calculated roll velocity P. In other words, the second addition circuit 94 functions as a roll velocity calculator. The angular velocity integrating circuit 62 is operable to integrate the output of the second addition circuit 94 and then output the calculated roll angle δ.The feedback line 96 is used to feed the output δ of the angular velocity integrating circuit 62 back to a negative input of the third subtracting circuit 92. Accordingly, the value determined from the output of the roll velocity component sensor 55A is corrected to approximate the bank angle δ1 for calibration purposes, which has been detected by the calibration bank angle detector 86.
[0102] The bank angle detecting device 19A also includes a drift removing circuit 66A and a yaw rate calculator 68 similar to those in the previously described first embodiment. The yaw rate calculator 68 calculates the calculated yaw rate R based on the calculated bank angle δ output by the angular rate integrating circuit 62. The drift removing circuit 66A includes a drift height calculating circuit 98, a roll component subtracting circuit 87A, and a yaw component subtracting circuit 87B.The drift amount calculation circuit 98 determines a straight-ahead traveling state or a standstill and then calculates a drift amount, in a manner similar to that in the previously described first embodiment, based on the calculated yaw rate R and the calculated roll rate P output from the second adding circuit 94, to thereby obtain corresponding calculated drift amounts DA and DB of the sensors 55A and 55B. Furthermore, by subtracting the calculated drift amounts DA and DB from the respective outputs of the sensors 55A and 55B with the roll component subtraction circuit 87A and the yaw component subtraction circuit 87B, respectively, the sensor drifts occurring in the roll rate component sensor 55A and the yaw rate component sensor 55B can be removed, and the sensor outputs are thus corrected.
[0103] Fig. 11 illustrates a block diagram showing the headlight device 11A according to a third preferred embodiment of the present invention. According to this third embodiment, the light distribution controller 20 controls the light distribution adjusting mechanism 16 with the calculated roll velocity P used as a lamp speed command D. Based on the angular velocity ω output from the angular velocity sensor 55, the roll velocity calculating circuit 60 generates a calculated roll velocity P, which in turn is output to the angular velocity integrating circuit 62. The angular velocity integrating circuit 62 performs time integration of the calculated roll velocity P to calculate the calculated bank angle δ. The bank angle δ thus obtained is used in any suitable application, such as, for example,a circuit for limiting engine torque due to, for example, an excessive bank angle, as described later.
[0104] According to the first version, which is Fig. 9 and with particular reference to Fig. 9, not only is the adjustment of the control gain of the light distribution controller 20 required to maintain the balance between the following characteristic and the noise resistance, but also the lamp angle α is delayed with respect to the calculated bank angle δ. In contrast, according to the Fig. In the third embodiment shown in Figure 11, the lamp speed command D and the calculated roll speed P are correlated with each other, and consequently not only is the lamp angle α delayed with respect to the calculated bank angle δ, but also the coordination is no longer required.
[0105] Fig. 12 illustrates a block diagram of the headlight device 11B constructed in accordance with a fourth preferred embodiment of the present invention. According to the fourth embodiment, in addition to the previously described third embodiment, the light distribution controller 20 includes a second subtraction circuit 80 for determining a difference between the calculated roll angle δ and the lamp angle α, a second division circuit 82 for dividing the output of the second subtraction circuit 80 by a predetermined standard time value, and a third addition circuit 84 for adding the output of the second division circuit 82 to the calculated roll speed P to generate a lamp speed command signal D.
[0106] The second subtraction circuit 80 generates a difference (δ - α) between the calculated roll angle δ output by the angular velocity integrating circuit 62 and the lamp angle α output by the lamp velocity integrating circuit 74, and the second division circuit 82 divides this difference (δ - α) by time T. The third addition circuit 84 is operable to add the output of the second division circuit 82 and the output of the roll velocity calculating circuit 60 together. The lamp velocity integrating circuit 74 integrates an output of the third addition circuit 84 and then outputs the lamp angle α. The feedback line 78 is used to feed the output α of the lamp velocity integrating circuit 74 back to a negative input of the second subtraction circuit 80.
[0107] According to the first embodiment described above, the lamp angle α can clearly follow the calculated bank angle δ, but the lamp angle α is slightly delayed with respect to the calculated bank angle δ as described above. On the other hand, however, according to the third embodiment described in Fig. 11 and with particular reference to Fig. 11, the delay of the lamp angle α with respect to the calculated bank angle δ can be improved, but there is no guarantee that in the light distribution adjusting mechanism 16, the lamp angle α can be made to coincide with the calculated bank angle δ if a control deviation occurs in the actual lamp speed with respect to the lamp command speed D.
[0108] In contrast, the Fig. The fourth embodiment shown in Fig. 12 both have respective constructions according to the previously described first and third embodiments, and consequently, the following characteristic and the response can be made consistent with each other if the standard time T is properly selected. The output of the second subtraction circuit in the circuit of Fig. 12 is equivalent to the output of the first subtraction circuit 76, which is shown in Fig. 9. In other words, the lamp speed command D in the circuit of Fig. 12 by adding the quotient of the lamp angle control deviation δ1 in the circuit of Fig. 9 divided by the time T to the calculated rolling speed P in the circuit of Fig. 11 can be obtained. Accordingly, by properly selecting the time T, the response characteristic exhibited when the previously described first embodiment is practiced and the response exhibited when the previously described third embodiment is practiced can be made consistent.
[0109] In other words, if the time T is chosen to be short, the output of the difference δ - α, which is divided by the time T in the second dividing circuit 82, becomes large, and thus approaches the value shown in Fig. 9 and with reference to Fig. 9. On the other hand, if the time T is chosen to be long, the output of the difference δ - α, which is divided by the time T, becomes small, thus approaching the Fig. 11 and with reference to Fig. 11. The standard time T is preferably selected within the range of 0.5 to 5 seconds, and more preferably within the range of 1 to 2 seconds. It should be noted that even in the Fig. 12, the lamp angle α can be supplied by the degree of rotation of the driver 18, which is detected by the value sensor 29.
[0110] With the present invention fully described above, the bank angle detecting device of the present invention can be applied not only to the headlight device for the motorcycle, but also to any of the following applications. For example, it can be applied to the application in which, for example, since a vehicle tire is prone to slipping if the bank angle is large during the motorcycle's running, the engine torque can be restricted depending on the magnitude of the detected bank angle to prevent the tire from slipping. It can also be applied to the application in which, while the bank angle during running is stored in a tachograph as data, running details can be examined by referring to this data, or this data can be used for future running.However, it can be applied to the application in which, when the bank angle increases while the road surface is so wet in rainy weather that it is sufficient to cause a skidding vehicle, a warning can be issued to attract the driver's attention.
[0111] Although the present invention has been fully described in connection with the preferred embodiments thereof with reference to the accompanying drawings which are used for the purpose of illustration only, those skilled in the art will readily devise numerous changes and modifications within the scope of obviousness upon reading the specifications of the present invention presented herein.For example, the bank angle detecting device of the present invention can be equally used in various vehicles which can generally be turned with the body tilted laterally, such as a scooter or any other vehicle of a type which a rider can maneuver while straddling it, and including, for example, a small powerboat, although reference has been made to the motorcycle in the embodiment of the present invention fully described above.
[0112] Although in the previous description of the preferred embodiment of the present invention only one angular rate sensor 55 has been illustrated and described as being used and mounted in an inclined manner, two or more angular rate sensors may be used. [Reference symbol] 19 Bank angle detection device 55 Angular velocity sensor 57 Speed sensor 59, 59A bank angle calculator 60, 94 Roll speed calculation circuit 64 feedback circuit 66 drift-removing circuit 67 Straight-ahead driving determiner 68 Yaw Rate Calculator 69 Straight-line time drift height calculator 71 Angular velocity corrector 73 standstill determiners 75 downtime drift height calculator 81 process interrupting circuit 83 Reset circuit 89 Suppression circuit D1 Straight-line time drift update altitude D2 Standstill time drift update level P calculated rolling speed R calculated yaw rate (value associated with the calculated bank angle) v speed δ calculated bank angle (value associated with the calculated bank angle) ω angular velocity θ angle of inclination
Claims
[1] A bank angle detecting device (19) for a vehicle, comprising: an angular velocity sensor (55) for obtaining a detection value including a corresponding component of a roll velocity, which is an angular velocity about a forward and backward axis of the vehicle, and a yaw velocity, which is an angular velocity about a vertical axis of the vehicle; a roll speed calculator (60, 94) for calculating a calculated roll speed based on the detected value of the angular velocity and a traveling speed of the vehicle; a bank angle calculator (59, 55A) for calculating a calculated bank angle of the vehicle from the calculated roll speed; a straight-ahead travel determiner (67) for determining a straight-ahead travel state of the vehicle during travel of the vehicle based on the calculated roll speed and a value associated with the calculated bank angle; a straight-ahead travel time drift height calculator (69) for calculating a sensor drift height during straight-ahead travel of the vehicle from an output of the angular velocity sensor (55) in the case where the straight-ahead travel determiner (67) determines the straight-ahead travel state; and an angular velocity corrector (71) for correcting the output of the angular velocity sensor (55) with the sensor drift height calculated by the straight-ahead time drift height calculator (69). [2] A bank angle detecting device (19) for the vehicle according to claim 1, wherein the angular velocity sensor (55) is arranged to tilt at a predetermined tilt angle about a left and right axis with respect to the front and rear axles of the vehicle. [3] A bank angle detecting device (19) for the vehicle according to claim 1, wherein the straight-ahead traveling determiner (67) determines the straight-ahead traveling state in the case that a state in which the calculated roll speed is lower than a first predetermined determination value continues for a first predetermined length of time, and also that a state in which the value associated with the calculated bank angle is lower than a second predetermined determination value continues for a second predetermined length of time. [4] A bank angle detecting device (19) for the vehicle according to claim 1, wherein the angular velocity corrector (71) comprises a suppression circuit (89) for suppressing a change in a correction amount. [5] A bank angle detecting device (19) for the vehicle according to claim 1, further comprising a process interrupting circuit (81) configured to interrupt the calculation of the drift height during straight-ahead travel performed by the straight-ahead time drift height calculator (69) in the event that, following the determination of the straight-ahead travel state, the calculated roll speed and the value associated with the calculated bank angle exceed respective predetermined values, but to resume the calculation in the event that they reach respective values lower than the predetermined values. [6] A bank angle detecting device (19) for the vehicle according to claim 5, further comprising a reset circuit (83) arranged to cancel a calculation of the drift height during straight-ahead travel performed by the straight-ahead travel time drift height calculator (69) in the event that the calculation does not finish within a predetermined length of time following the determination of the straight-ahead travel state. [7] A bank angle detecting device (19) for the vehicle according to claim 1, further comprising a standstill determiner for determining a standstill state of the vehicle and a standstill time drift amount calculator (75) for calculating a sensor drift amount from an output of the angular velocity sensor (55) in the case where the standstill determiner (73) determines the standstill state, and wherein the angular velocity corrector (71) corrects the output of the angular velocity sensor (55) with the sensor drift amount calculated during the standstill state. [8] A bank angle detecting device (19) for the vehicle according to claim 7, wherein the calculated roll speed input to the standstill determiner (73) is the one from which a frequency change lower than a predetermined frequency is removed. [9] A motorcycle equipped with the bank angle detecting device (19) according to claim 1. [10] A bank angle detection method for a vehicle, comprising: a detection step of obtaining a detection value including roll rate and yaw rate components of the vehicle by means of an angular rate sensor (55); a roll speed calculating step of calculating a calculated roll speed, which is an angular velocity about a forward and backward axis, based on the detection value detected during the detecting step and a traveling speed of the vehicle; a bank angle calculation step of calculating a calculated bank angle of the vehicle from the calculated roll speed; a straight-ahead traveling determining step of determining a straight-ahead traveling state of the vehicle during traveling of the vehicle based on the calculated roll speed and a value associated with the calculated bank angle; a straight-ahead travel time drift amount calculation step of calculating a sensor drift amount during straight travel of the vehicle from an output of the angular velocity sensor (55) in the case where the straight-ahead travel state is determined in the straight-ahead travel step; and an angular velocity correcting step of correcting the output of the angular velocity sensor (55) with the sensor drift amount calculated in the straight-ahead time drift amount calculating step.
Citation Information
Patent Citations
Headlamp device for motorcycle
JP2004155404A
Green-mode flyback pulse width modulation apparatus
US20080037296A1
Motorcycle headlight device
US20080112174A1
JP002004155404A
