The present disclosure relates to an acceleration detection device and a mounting angle detection method for detecting a mounting angle of an acceleration sensor.
A related art discloses a technique of calculating an angle (hereinafter, yaw mounting angle θy) between a vehicle front-rear direction axis and a sensor x-axis, based on θy=sin−1 (−ASY/ABX). In the above equation, ASY is an acceleration in a sensor y-axis direction detected by an acceleration sensor, and ABX is an acceleration in a vehicle front direction. The acceleration ABX in the vehicle front-rear direction is calculated from a change in speed in the vehicle front-rear direction detected by a speed sensor when the vehicle is traveling straight on a horizontal plane.
One example of the present disclosure, an acceleration detection device includes an acceleration sensor that has a first detection axis and a second detection axis such that a yaw mounting angle between a vehicle reference axis and a virtual line is ±15 degrees or less, an acquisition section acquiring an acceleration in a direction of the first detection axis and an acceleration in a direction of the second detection axis, and a mounting angle calculation section calculating the yaw mounting angle from an angle calculation formula and the acceleration in the direction of the first detection axis and the acceleration in the direction of the second detection axis.
Because the acceleration sensor is fixed to the casing, the yaw mounting angle θy of the acceleration sensor can also be determined by the technique disclosed in a related art. However, it is necessary to calculate the acceleration ABX in the vehicle front-rear direction from the change in speed in the vehicle front-rear direction detected by the speed sensor when the vehicle is traveling straight on a horizontal plane. Therefore, in a case where the vehicle and the acceleration sensor is inclined with respect to the horizontal plane, for example, in a case where the road surface on which the vehicle is traveling is inclined, the calculation accuracy of the yaw mounting angle θy is lower.
The present disclosure provides an acceleration detection device and a mounting angle detection method capable of preventing or reducing a decrease in calculation accuracy of a mounting angle of an acceleration sensor.
According to one aspect of the present disclosure, an acceleration detection device mounted on a vehicle is provided. The acceleration detection device comprises: an acceleration sensor that has at least a first detection axis and a second detection axis orthogonal to each other and is mounted on the vehicle such that a yaw mounting angle between a vehicle reference axis that is either a vehicle front-rear direction axis or a vehicle width direction axis and a virtual line set between the first detection axis and the second detection axis is ±15 degrees or less; an acquisition section that is configured to acquire, from the acceleration sensor, an acceleration in a direction of the first detection axis and an acceleration in a direction of the second detection axis in a state where acceleration in the vehicle front-rear direction is generated in the vehicle and no acceleration is generated in the vehicle width direction; and a mounting angle calculation section that is configured to calculate the yaw mounting angle from an angle calculation formula that calculates the yaw mounting angle from an acceleration in the direction of the first detection axis and an acceleration in the direction of the second detection axis and the acceleration in the direction of the first detection axis and the acceleration in the direction of the second detection axis detected by the acquisition section, the angle calculation formula being derived by assuming a state where acceleration in the vehicle front-rear direction is generated in the vehicle and no acceleration is generated in the vehicle width direction and by using a fact that a tan value of the yaw mounting angle is approximated to the yaw mounting angle.
When assuming that the acceleration sensor is disposed as described above, that the acceleration in the vehicle front-rear direction is generated, and that substantially no acceleration is generated in the vehicle width direction, and using the fact that the tan value of the yaw mounting angle can be approximated to the yaw mounting angle, it is possible to derive the angle calculation formula for calculating the yaw mounting angle from the acceleration in the first detection axis direction and the acceleration in the second detection axis direction.
Therefore, the mounting angle calculation section calculates the yaw mounting angle from (i) the acceleration in the first detection axis direction and the acceleration in the second detection axis direction acquired by the acquisition section in a state where acceleration in the vehicle front-rear direction is generated in the vehicle and substantially no acceleration is generated in the vehicle width direction and (ii) the above-mentioned angle calculation formula.
The angle calculation formula is a formula derived assuming a state where acceleration is generated in the vehicle front-rear direction and no acceleration is generated in the vehicle width direction. When the vehicle is inclined in the front-rear direction, acceleration caused by the inclination in the front-rear direction of the vehicle is applied along the first detection axis and the second detection axis. However, the angle calculation formula is a formula assuming that acceleration is generated in the vehicle front-rear direction. Therefore, even in a case where the first detection axis and the second detection axis of the acceleration sensor are inclined in the vehicle front-rear direction with respect to the horizontal plane for, for example, a reason that the road surface on which the vehicle is traveling is inclined in the vehicle front-rear direction, a decrease in a calculation accuracy of the yaw mounting angle is prevented or reduced.
According to one aspect of the present disclosure, a mounting angle detection method for detecting a mounting angle of an acceleration sensor that has at least a first detection axis and a second detection axis orthogonal to each other and is disposed on a vehicle such that a yaw mounting angle between a vehicle reference axis that is either a vehicle front-rear direction axis or a vehicle width direction axis and a virtual line set between the first detection axis and the second detection axis is ±15 degrees or less is provided. The method comprises: acquiring, from the acceleration sensor, an acceleration in a direction of the first detection axis and an acceleration in a direction of the second detection axis in a state where acceleration in the vehicle front-rear direction is generated in the vehicle and substantially no acceleration is generated in the vehicle width direction; and calculating the yaw mounting angle from an angle calculation formula that calculates the yaw mounting angle from an acceleration in the direction of the first detection axis and an acceleration in the direction of the second detection axis and the acceleration in the direction of the first detection axis and the acceleration in the direction of the second detection axis acquired, the angle calculation formula being derived by assuming a state where acceleration in the vehicle front-rear direction is generated in the vehicle and no acceleration is generated in the vehicle width direction and by using a fact that a tan value of the yaw mounting angle is approximated to the yaw mounting angle.
Hereinafter, an embodiment will be described with reference to the drawings.
The sx-axis and the sy-axis included in the acceleration sensor 20 are axes representing directions in which the acceleration sensor 20 detects an acceleration A. The sx-axis that is a first detection axis and the sy-axis that is a second detection axis are in the same plane and orthogonal to each other. The acceleration sensor 20 also includes an sz-axis as illustrated in
As illustrated in
The sx-axis and the sy-axis are disposed along a vehicle plane including the front-rear direction and the left-right direction of the vehicle 1. The vehicle plane includes the bx-axis and the by-axis. However, it is difficult to mount the acceleration sensor 20 on the vehicle 1, via a casing or the like in which the acceleration sensor 20 is accommodated, such that a plane (hereinafter, a sensor plane) including the sx-axis and the sy-axis of the acceleration sensor 20 is completely parallel to the vehicle plane. When the sensor plane and the vehicle plane are substantially parallel, it can be said that the sensor plane is along the vehicle plane. However, when the sensor plane and the vehicle plane are not parallel, the bz-axis and the sz-axis do not coincide with each other.
Therefore, after the acceleration sensor 20 is mounted on the vehicle 1, misalignment between the bz-axis and the sz-axis is detected, whereby the acceleration Asz is corrected and used to control the vehicle. The misalignment between the bz-axis and the sz-axis can be detected by detecting the deviation between the direction of a gravity vector and the sz-axis.
It is also difficult to mount the acceleration sensor 20 such that the sx-axis and the sy-axis of the acceleration sensor 20 strictly coincide with predetermined directions of the vehicle 1. However, unlike the misalignment between the bz-axis and the sz-axis, it is difficult to detect, by using the gravity vector, the misalignment between the sx-axis and the bx-axis and the misalignment between the sy-axis and the by-axis.
To address this issue, in the acceleration detection device 10 of the present embodiment, a virtual line VL is set between the sx-axis and the sy-axis of the acceleration sensor 20. The virtual line VL of the present embodiment bisects the space between the sx-axis and the sy-axis on the same plane as the plane on which the sx-axis and the sy-axis are on. The acceleration sensor 20 is mounted on the vehicle 1 such that an angle (hereinafter, a yaw mounting angle) Δθ between the virtual line VL and the bx-axis is ±15° or less with the bx-axis as a vehicle reference axis.
Although it is difficult to mount the acceleration sensor 20 on the vehicle 1 such that the yaw mounting angle Δθ is 0°, it is easy to mount the acceleration sensor 20 on the vehicle 1 such that the yaw mounting angle Δθ is ±15° or less. When the acceleration sensor 20 is mounted on the vehicle 1 such that the yaw mounting angle Δθ is ±15° or less, it is easy to calculate the yaw mounting angle Δθ as described below. If the yaw mounting angle Δθ can be calculated, the directions of the sx-axis and the sy-axis can also be calculated.
The arithmetic device 30 can be implemented by a computer including a processor, a non-volatile memory, a random-access memory (RAM), an input/output (I/O), a bus line connecting these components, and the like. The arithmetic device 30 may include a hardware logic circuit in addition to the processor. The non-volatile memory stores a program for causing a general-purpose computer to operate as the arithmetic device 30. The processor executes the program stored in the non-volatile memory while using a temporary storage function of the RAM, so that the arithmetic device 30 implements the function as each section illustrated in
As illustrated in
The acquisition section 31 includes low-pass filters 32 and 33. The low-pass filter 32 allows a low-frequency component of the signal representing the acceleration Asx acquired from the acceleration sensor 20 to pass through. The low-pass filter 33 allows a low-frequency component of the signal representing the acceleration Asy acquired from the acceleration sensor 20 to pass through. The low-pass filters 32 and 33 are provided to remove noise components from the signal representing the acceleration A.
The low-pass filters 32 and 33 respectively output the signal to the addition section 34 and the subtraction section 35. The addition section 34 adds the signal input from the low-pass filter 32 and the signal input from the low-pass filter 33. The subtraction section 35 subtracts the signal input from the low-pass filter 33 from the signal input from the low-pass filter 32. That is, the subtraction section 35 subtracts the acceleration Asy from which the noise component is removed from the acceleration Asx from which the noise component is removed.
The straight traveling acceleration/deceleration determination section 36 determines whether the vehicle 1 is traveling straight. A calculation value calculated by the addition section 34 and a calculation value calculated by the subtraction section 35 are input to the straight traveling acceleration/deceleration determination section 36. These calculation values are calculated based on the signals output from the acceleration sensor 20. When the vehicle 1 is accelerating or decelerating in the straight traveling direction, the acceleration A in the vehicle front-rear direction is generated in the vehicle 1, and acceleration or deceleration in the vehicle width direction is not generated. Therefore, it is possible to determine whether the vehicle 1 is accelerating or decelerating in the straight traveling direction, from the signals output from the acceleration sensor 20.
In addition, a detection value of a steering sensor 2 and a yaw angular velocity detection value of the gyro sensor 3 are also input to the straight traveling acceleration/deceleration determination section 36. The detection value of the steering sensor 2 and the yaw angular velocity detection value of the gyro sensor 3 are straight traveling determination signals for determining whether the vehicle 1 is traveling straight. Note that only one of the detection value of the steering sensor 2 and the detection value of the gyro sensor 3 may be input to the straight traveling acceleration/deceleration determination section 36 as the straight traveling determination signal. Although
The mounting angle calculation section 37 calculates the yaw mounting angle Δθ by using the calculation value calculated by the addition section 34, the calculation value calculated by the subtraction section 35, and an angle calculation formula described below. The mounting angle calculation section 37 outputs the calculated yaw mounting angle Δθ to the vehicle control device 4. The vehicle control device 4 corrects the accelerations Asx and Asy output from the acquisition section 31 by using the yaw mounting angle Δθ and uses the corrected accelerations for vehicle control.
Next, the angle calculation formula will be described. In the present embodiment, Equation (1) shown in
The left sides of Equations (2) and (3) and the right sides of Equations (2) and (3) are each added together, and the right side of the result is deformed by using the addition theorem, whereby Equation (4) is obtained. In addition, the left side and the right side of Equation (3) are respectively subtracted from the left side and the right side of Equation (2), and the right side of the result is deformed using the addition theorem, whereby Equation (5) is obtained. The angle calculation formula shown by Equation (1) assumes a state where the acceleration Abx in the front-rear direction is generated in the vehicle 1 but the acceleration Aby in the vehicle width direction is an acceleration A that is small enough to consider that substantially no acceleration is generated. When this assumption is applied to Equations (4) and (5), the second terms in the parentheses can be eliminated in Equations (4) and (5), and Equations (6) and (7) are obtained. By using Equations (6) and (7), the calculation shown by Equation (8) can be further performed.
In the present embodiment, the acceleration sensor 20 is mounted such that the yaw mounting angle Δθ is ±15° or less. When the yaw mounting angle Δθ is ±15° or less, tan θ can be approximated as tan θ≈θ(rad). This is because tan(15 π/180) is approximately 0.259, and 15° is 0.261 (rad). When tan θ≈θ is applied to Equation (8), Equation (1) is obtained.
In step S10, the straight traveling acceleration/deceleration determination section 36 determines whether the vehicle 1 is traveling straight, by using one or both of the detection values of the steering sensor 2 and the yaw angular velocity detection value of the gyro sensor 3. When the detection value of the steering sensor 2 indicates that a steering angle is around 0°, it can be determined that the vehicle 1 is traveling straight. When the yaw angular velocity detection value indicates that a yaw angular velocity is around 0, it may be determined that the vehicle 1 is traveling straight.
When a determination result of step S10 is NO, the determination in step S10 is repeated. When the determination result of step S10 is YES, the process proceeds to step S20. In step S20, the acquisition section 31 acquires the accelerations Asx and Asy from the acceleration sensor 20. In step S30, the addition section 34 and the subtraction section 35 calculate Asx+Asy and Asx−Asy on the basis of the accelerations Asx and Asy acquired in step S20.
In step S40, the straight traveling acceleration/deceleration determination section 36 uses a calculation result of step S30 to determine whether Asx+Asy is sufficiently larger than Asx−Asy. As illustrated in
Since the angle calculation formula is a formula calculated on the assumption that the acceleration Aby is zero, it is determined whether the acceleration Aby is substantially zero also when acquiring the data to be substituted into the angle calculation formula. In a specific example of the determination in step S40, when Asx+Asy is larger than Asx−Asy by a predetermined value, the determination result of step S40 can be set to YES. Alternatively, when Asx+Asy is greater than or equal to a predetermined multiple of Asx−Asy, the determination result of step S40 may be YES.
Alternatively, Asx cos α+Asy cos (π/2−α) may be used instead of Asx+Asy, and Asx cos (π/2−α)−Asy cos α may be used instead of Asx−Asy. The value a is an assumed angular difference between the sx-axis and the bx-axis. When the determination result of step S40 is NO, step S10 is executed again. When the determination result of step S40 is YES, the process proceeds to step S50.
In step S50, the mounting angle calculation section 37 accumulates the calculation value calculated in step S30. In step S60, the mounting angle calculation section 37 determines whether the accumulated calculation value has reached a certain number. When the determination result of step S60 is NO, the process returns to step S10. When the determination result of step S60 is YES, the process proceeds to step S70. The certain number is a value determined in advance, and is a number for ensuring accuracy required in statistical processing in step S70.
In step S70, the data accumulated in step S50 is statistically processed to calculate the yaw mounting angle Δθ. In an example of the statistical processing, a slope of the approximate straight line is estimated.
The vehicle control device 4 can calculate the directions of the sx-axis and the sy-axis on the basis of the yaw mounting angle Δθ. However, the arithmetic device 30 may also calculate the directions of the sx-axis and the sy-axis and output the calculated directions to the vehicle control device 4.
In the first embodiment described above, the virtual line VL is set between the sx-axis and the sy-axis. When it is assumed that the acceleration Aby in the vehicle width direction is not substantially generated and that tan Δθ can be approximated to Δθ, an angle calculation formula (Equation (1)) for calculating the yaw mounting angle Δθ can be derived.
The angle calculation formula is a formula derived assuming a state where the acceleration Abx is generated in the vehicle front-rear direction and the acceleration Aby is not generated in the vehicle width direction. When the pitch angle of the vehicle 1 is not zero, the acceleration A caused by the inclination in the front-rear direction of the vehicle 1 is applied along the sx-axis and the sy-axis. However, the angle calculation formula is a formula assuming that the acceleration Abx in the vehicle front-rear direction is generated. Therefore, even when the sx-axis and the sy-axis of the acceleration sensor 20 are inclined in the vehicle front-rear direction with respect to the horizontal plane, a decrease in a calculation accuracy of the yaw mounting angle Δθ is prevented or reduced.
The virtual line VL bisects between the sx-axis and the sy-axis. When the acceleration sensor 20 is mounted such that the yaw mounting angle Δθ between the virtual line VL and the bx-axis is ±15° or less, the angle between each of the sx-axis and the sy-axis and the bx-axis is close to 45°. As a result, it is possible to prevent or reduce the chance that one of Asx and Asy to be substituted into Equation (1) becomes extremely small, the yaw mounting angle Δθ can be calculated more accurately.
The acceleration detection device 10 includes the straight traveling acceleration/deceleration determination section 36. The straight traveling acceleration/deceleration determination section 36 determines whether the vehicle 1 is accelerating or decelerating in the straight traveling direction on the basis of the output signals of the acceleration sensor 20 (step S40). The accelerations Asx and Asy when the determination result of step S40 is NO are not used as the data for calculating the yaw mounting angle Δθ. Also by this processing, the yaw mounting angle Δθ can be accurately calculated.
Further, the straight traveling acceleration/deceleration determination section 36 does not just determine whether the vehicle 1 is accelerating or decelerating in the straight traveling direction by using the output signals of the acceleration sensor 20. The straight traveling acceleration/deceleration determination section 36 determines whether the vehicle 1 is traveling straight, also in step S10. In step S10, by using one or both of the detection values of the steering sensor 2 and the yaw angular velocity detection value of the gyro sensor 3, the straight traveling acceleration/deceleration determination section 36 determines whether the vehicle 1 is traveling straight.
In a case where it is determined whether the vehicle 1 is traveling straight by using the output signals of the acceleration sensor 20, there is a possibility that a state where the vehicle 1 is traveling in a curve on an inclined road surface is erroneously determined as a state of traveling straight. In detail, this is due to the following reason. Even in a case where the acceleration A in the by direction is generated due to the curve traveling of the vehicle 1, because the road surface is inclined, the gravitational acceleration generated in the vehicle 1 may be in such a direction that the gravitational acceleration generated in vehicle 1 offsets the acceleration A generated by the curve traveling.
However, in the present embodiment, whether the vehicle 1 is traveling straight is determined using one or both of the detection values of the steering sensor 2 and the yaw angular velocity detection value of the gyro sensor 3. Therefore, it is possible to prevent or reduce the chance that the yaw mounting angle Δθ is calculated based on the acceleration A detected by the acceleration sensor 20 in a state where the vehicle 1 is traveling on a curve.
Next, a second embodiment will be described. In the description of the second embodiment and subsequent embodiments, elements having the same reference signs as the already used reference signs are the same elements as the elements shown in the previous embodiments and having the same reference signs unless otherwise specified. In the case where only a part of the configuration is described, previously described other embodiments can be applied to the other part of the configuration.
In step S32, a normal range determined based on the acceleration A calculated in step S31 is calculated. The normal range is a range for determining whether Asx+Asy is normal. Asx+Asy represents the acceleration A in the front direction of the vehicle 1 as illustrated in
In step S33, it is determined whether Asx+Asy calculated in step S30 is included within the normal range calculated in step S32. This is equivalent to comparison between the acceleration A calculated in step S31 and Asx+Asy. When the determination result of step S33 is NO, the process proceeds to step S34. In step S34, it is determined that the acceleration sensor 20 is abnormal. Then, the processing is terminated without calculating the yaw mounting angle Δθ.
In this manner, the abnormality determination section 238 compares the acceleration A obtained by differentiating the vehicle speed with Asx+Asy representing the acceleration A in the front direction of the vehicle 1 calculated from the output signals of the acceleration sensor 20 (step S33). When the acceleration sensor 20 is determined to be abnormal by this comparison, the mounting angle calculation section 37 does not calculate the yaw mounting angle Δθ. As a result, it is possible to prevent or reduce the chance that the yaw mounting angle Δθ having an abnormal value is calculated.
In a third embodiment, the vehicle 1 is placed on an inspection table 6 illustrated in
With reference to
Since, in the mounting angle detection method described in the third embodiment, it is not necessary to cause the vehicle 1 to travel, the yaw mounting angle Δθ can be easily detected before the vehicle 1 is shipped.
In a fourth embodiment, the directions of the sx-axis and the sy-axis of an acceleration sensor 20 are different from those in the previous embodiments. As illustrated in
In the fourth embodiment, Equations (9) and (10) shown in
As described above, also when the acceleration sensor 20 is oriented as described in the fourth embodiment, the angle calculation formula for calculating the yaw mounting angle Δθ can be derived from Asx and Asy.
In a fifth embodiment, as illustrated in
In the fifth embodiment, Equations (14) and (15) shown in
In a sixth embodiment, as illustrated in
In the sixth embodiment, Equations (18) and (19) shown in
In the above embodiments, the virtual line VL is a line bisecting between the sx-axis and the sy-axis. However, the virtual line VL can be arbitrarily set between the sx-axis and the sy-axis. Assuming that the angle between the virtual line VL and the sx-axis is a and the angle between the virtual line VL and the sy-axis is β.
When Equations (2) and (3) are generalized using a and 13, Equations (20) and (21) shown in
In an eighth embodiment, the angle calculation formula different from that described above is shown. When Aby=0 is substituted into Equations (2) and (3), and the right sides are deformed by the addition theorem, Equations (27) and (28) shown in
Although the embodiments have been described above, the disclosed techniques are not limited to the above-described embodiments, and the following modifications are also included in the disclosed scope, and various modifications other than the followings can be made without departing from the gist.
As for the acceleration sensor 20, it is possible to separately include a sensor that detects the acceleration A in the sx-axis direction and a sensor that detects the acceleration A in the sy-axis direction. The acceleration sensor 20 may be a sensor including only an sx-axis and an sy-axis, instead of including three axes.
Band-pass filters may be used instead of the low-pass filters 32 and 33. When the band-pass filters are used, it is easy to remove biases.
In the first embodiment, it is determined in step S10 whether the vehicle is traveling straight, and it is determined in step S40 whether the vehicle is accelerating or decelerating only in the straight traveling direction. However, only either one of the determinations may be made.
Number | Date | Country | Kind |
---|---|---|---|
2021-121107 | Jul 2021 | JP | national |
The present application is a continuation application of International Patent Application No. PCT/JP2022/025336 filed on Jun. 24, 2022 which designated the U.S. and claims the benefit of priority from Japanese Patent Application No. 2021-121107 filed on Jul. 22, 2021. The entire disclosures of all of the above applications are incorporated herein by reference.
Number | Date | Country | |
---|---|---|---|
Parent | PCT/JP2022/025336 | Jun 2022 | US |
Child | 18416769 | US |