Acceleration detection device and mounting angle detection method

The acceleration detection device and method use orthogonal sensor axes and a virtual line to accurately calculate yaw angles, addressing inaccuracies due to sensor inclination, ensuring precise yaw angle determination.

JP7593257B2Active Publication Date: 2024-12-03DENSO CORP
View PDF 6 Cites 0 Cited by

Patent Information

Application Number
JP2021121108
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Filing Date
2021-07-22
Publication Date
2024-12-03
Estimated Expiration
2041-07-22

AI Technical Summary

Technical Problem

Existing methods for calculating the yaw mounting angle of an acceleration sensor are inaccurate when the vehicle and sensor are inclined relative to a horizontal plane, as they rely on longitudinal vehicle acceleration measurements which are affected by road inclinations.

Method used

An acceleration detection device and method that uses orthogonal first and second detection axes in the sensor, with a virtual line bisecting these axes, allowing for accurate yaw angle calculation by approximating the tangent of the yaw angle based on accelerations in these axes, even when the sensor is inclined.

Benefits of technology

The method ensures accurate calculation of the yaw mounting angle by minimizing the impact of sensor inclination, maintaining precision even on inclined road surfaces.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007593257000001
    Figure 0007593257000001
  • Figure 0007593257000002
    Figure 0007593257000002
  • Figure 0007593257000003
    Figure 0007593257000003
Patent Text Reader

Abstract

To provide an acceleration detector capable of precisely detecting a mounting angle of an acceleration sensor.SOLUTION: The acceleration detector includes an acceleration sensor 20 with at least an sx-axis and an sy-axis that are orthogonal to each other in which the acceleration sensor 20 is placed on a vehicle so that the yaw mounting angle, which is the angle between the vehicle reference axis and the virtual line set between the sx-axis and the sy-axis, is ±15 degrees or less. The acceleration detector includes: an acquisition unit 31 that acquires the sx-axis acceleration and the sy-axis acceleration from the acceleration sensor 20 under the condition that the vehicle is subjected to acceleration in the width direction of the vehicle and low acceleration / deceleration in the longitudinal direction of the vehicle; a mounting angle calculation unit 37 calculates the yaw mounting angle from the obtained acceleration in the sx-axis direction and the acceleration in the sy-axis direction from an angle calculate expression that is derived by using the fact that the tan value of the yaw mounting angle is approximate to the yaw mounting angle and assuming that the vehicle is subject to acceleration in the width direction of the vehicle and no acceleration in the longitudinal direction of the vehicle.SELECTED DRAWING: Figure 3
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to an acceleration detection device and a mounting angle detection method for detecting the mounting angle of an acceleration sensor. [Background technology]

[0002] In Patent Document 1, θy=sin -1 (-A SY / A BX The technology disclosed here calculates the angle between the vehicle longitudinal axis and the sensor x-axis (hereinafter, referred to as the yaw mounting angle θy) by using the above formula. SY is the acceleration in the y-axis direction detected by the acceleration sensor, and A BX is the acceleration in the forward direction of the vehicle. Acceleration A in the forward / rearward direction of the vehicle BX is calculated from the change in speed in the longitudinal direction of the vehicle detected by the speed sensor when the vehicle is traveling straight on a horizontal plane. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] JP 2015-4593 A Summary of the Invention [Problem to be solved by the invention]

[0004] Since the acceleration sensor is fixed to the housing, the yaw mounting angle θy of the acceleration sensor can also be determined by the technology disclosed in Patent Document 1. However, the acceleration A BX must be calculated from the change in speed in the front-rear direction of the vehicle detected by the speed sensor when the vehicle is traveling straight on a horizontal plane. Therefore, when the road surface on which the vehicle is traveling is inclined, or when the vehicle or the acceleration sensor is inclined with respect to the horizontal plane, the calculation accuracy of the yaw mounting angle θy decreases.

[0005] The present disclosure has been made in light of the above-mentioned circumstances, and an object of the present disclosure is to provide an acceleration detection device and a mounting angle detection method that can detect the mounting angle of an acceleration sensor with high accuracy. [Means for solving the problem]

[0006] The above object is achieved by the combination of features recited in the independent claims, and the subclaims define further advantageous specific examples. The reference characters in parentheses in the claims correspond to specific aspects described in the following embodiment as one aspect, and are not intended to limit the disclosed technical scope.

[0007] One disclosure relating to an acceleration detection device for achieving the above object is: An acceleration detection device (10) equipped with an acceleration sensor (20) having at least a first detection axis (sx) and a second detection axis (sy) perpendicular to each other, the acceleration detection device (10) being mounted on a vehicle (1), The acceleration sensor is disposed on the vehicle so that a yaw angle (Δθ), which is an angle between a vehicle reference axis, which is either a vehicle longitudinal axis (bx) or a vehicle transverse axis (by), and a virtual line (VL) set between the first detection axis and the second detection axis, is within ±15 degrees; an acquisition unit (31) that acquires an acceleration in a first detection axis direction and an acceleration in a second detection axis direction from an acceleration sensor in a state in which an acceleration in a vehicle width direction occurs in the vehicle and the acceleration / deceleration in the vehicle front-rear direction is low; The acceleration detection device includes: an 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, the formula being derived by assuming a state in which acceleration occurs in the vehicle width direction and no acceleration occurs in the vehicle longitudinal direction, and utilizing the fact that the tangent value of the yaw mounting angle can be approximated to the yaw mounting angle; and a mounting angle calculation unit (37, 237) for calculating the yaw mounting angle from the acceleration in the first detection axis direction and the acceleration in the second detection axis direction acquired by the acquisition unit.

[0008] If the acceleration sensor is arranged as described above, and if there is no acceleration in the vehicle longitudinal direction, and if the tangent value of the yaw setting angle can be approximated to the yaw setting angle, an angle calculation formula for calculating the yaw setting angle from the acceleration in the first detection axis direction and the acceleration in the second detection axis direction can be derived.

[0009] Therefore, the mounting angle calculation unit calculates the yaw mounting angle from the acceleration in the first detection axis direction and the acceleration in the second detection axis direction acquired by the acquisition unit in a state in which acceleration occurs in the vehicle width direction and low acceleration occurs in the vehicle front-rear direction, and from the above angle calculation formula.

[0010] The angle calculation formula is derived assuming a state in which acceleration occurs in the vehicle width direction and no acceleration occurs in the vehicle front-rear direction. When the vehicle is tilted in the vehicle width direction, the first detection axis and the second detection axis are subjected to acceleration due to the tilt of the vehicle in the vehicle width direction. However, the angle calculation formula is a formula assuming that acceleration occurs in the vehicle width direction. Therefore, even if the first detection axis and the second detection axis of the acceleration sensor are tilted in the vehicle width direction with respect to the horizontal plane due to the road surface on which the vehicle is traveling being tilted in the vehicle width direction, a decrease in the calculation accuracy of the yaw mounting angle is suppressed.

[0011] One disclosure relating to a mounting angle detection method for achieving the above object is: A mounting angle detection method for detecting a mounting angle of an acceleration sensor (20) mounted on a vehicle, the acceleration sensor having at least a first detection axis (sx) and a second detection axis (sy) perpendicular to each other, comprising: The acceleration sensor is disposed on the vehicle so that a yaw angle (Δθ), which is an angle between a vehicle reference axis, which is either a vehicle longitudinal axis (bx) or a vehicle transverse axis (by), and a virtual line (VL) set between the first detection axis and the second detection axis, is within ±15 degrees; In a state where an acceleration in a vehicle width direction occurs in a vehicle and acceleration / deceleration in a vehicle front-rear direction is low, an acceleration in a first detection axis direction and an acceleration in a second detection axis direction are acquired from an acceleration sensor; The vehicle is assumed to have an acceleration in the vehicle width direction and no acceleration in the vehicle front-rear direction, and the tangent value of the yaw mounting angle is approximated to the yaw mounting angle. The vehicle is thus derived using an 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, and the mounting angle detection method calculates the yaw mounting angle from the acquired acceleration in the first detection axis direction and the acceleration in the second detection axis direction. [Brief description of the drawings]

[0012] [Figure 1] 2 is a diagram showing the orientation of the sx axis and the sy axis of the acceleration sensor 20. FIG. [Diagram 2] 3 is a diagram showing the orientation of the sz axis of the acceleration sensor 20. FIG. [Diagram 3] 1 is a diagram showing a configuration of an acceleration detection device 10. [Figure 4] FIG. 11 is a diagram showing an equation for deriving an angle calculation equation. [Diagram 5] FIG. 4 is a diagram showing a process flow up to calculating a yaw mounting angle Δθ in the first embodiment. [Figure 6] FIG. 13 is a diagram showing the configuration of an acceleration detecting device 210 according to a second embodiment. [Figure 7] FIG. 11 is a diagram showing an angle calculation formula used in the second embodiment. [Figure 8] FIG. 11 is a diagram showing a process flow up to calculating a yaw mounting angle Δθ in the second embodiment. [Figure 9] A diagram showing the direction of acceleration A due to Asx+Asy and Asx-Asy. [Figure 10] FIG. 11 is a diagram showing the mounting direction of the acceleration sensor 20 according to the third embodiment. [Figure 11] 13A to 13C are diagrams showing equations in a process for deriving an angle calculation equation used in the third embodiment. [Figure 12] FIG. 13 is a diagram showing the mounting direction of the acceleration sensor 20 according to the fourth embodiment. [Figure 13] 13A to 13C are diagrams showing equations in the process of deriving an angle calculation equation used in the fourth embodiment. [Figure 14] FIG. 13 is a diagram showing the mounting direction of the acceleration sensor 20 according to the fifth embodiment. [Figure 15] 13A to 13C are diagrams showing equations in the process of deriving an angle calculation equation used in the fifth embodiment. [Figure 16] FIG. 23 is a diagram showing an equation for deriving an angle calculation equation used in the sixth embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0013] First Embodiment Hereinafter, an embodiment will be described with reference to the drawings. FIG. 1 is a diagram showing the orientation of the sx axis and sy axis of an acceleration sensor 20 provided in an acceleration detection device 10 (see FIG. 3) of this embodiment. The acceleration sensor 20 is mounted on a vehicle 1. The longitudinal direction of the vehicle 1 is defined as the bx direction, and the transverse direction of the vehicle 1 is defined as the by direction. An axis indicating the bx direction may be referred to as the bx axis, and an axis indicating the by direction may be referred to as the by axis. The bx axis is the longitudinal axis of the vehicle, and the by axis is the transverse axis of the vehicle. In addition, as shown in FIG. 2, the vertical direction of the vehicle 1 is defined as the bz direction. An axis indicating the bz direction may be referred to as the bz axis.

[0014] The sx-axis and sy-axis of the acceleration sensor 20 indicate the direction in which the acceleration sensor 20 detects acceleration A. The sx-axis, which is the first detection axis, and the sy-axis, which is the second detection axis, are in the same plane and are perpendicular to each other. The acceleration sensor 20 also has an sz-axis as shown in FIG. 2. The sz-axis is an axis perpendicular to the sx-axis and sy-axis. The acceleration sensor 20 detects acceleration A in each of these three axial directions.

[0015] As shown in Figures 1 and 2, the acceleration in each axis direction is indicated by adding a subscript indicating the axis to "A". Therefore, the acceleration A bx , A by , A bz indicate the acceleration A in the bx-axis, by-axis, and bz-axis directions, respectively. Acceleration A sx , A sy , A sz indicate the acceleration A in the sx-axis direction (i.e., the first detection axis direction), the acceleration A in the sy-axis direction (i.e., the second detection axis direction), and the acceleration A in the sz-axis direction, respectively.

[0016] The sx and sy axes are arranged along a vehicle plane including the longitudinal and lateral directions of the vehicle 1. The vehicle plane is a plane including the bx and by axes. However, it is difficult to mount the acceleration sensor 20 on the vehicle 1 via a housing that houses the acceleration sensor 20 so that the plane including the sx and sy axes of the acceleration sensor 20 (hereinafter, the sensor plane) is completely parallel to the vehicle plane. If the sensor plane and the vehicle plane are approximately parallel, it can be said that the sensor plane is aligned with the vehicle plane. However, if the sensor plane and the vehicle plane are not parallel, the bz and sz axes do not coincide with each other.

[0017] Therefore, after the acceleration sensor 20 is attached to the vehicle 1, the deviation between the bz-axis and the sz-axis is detected, and the acceleration A sz The deviation between the bz-axis and the sz-axis can be detected by detecting the deviation between the direction of the gravity vector and the sz-axis.

[0018] It is also difficult to mount the acceleration sensor 20 so that the sx and sy axes are precisely aligned with the predetermined direction of the vehicle 1. However, unlike the deviation between the bz and sz axes, it is difficult to detect the deviation between the sx and bx axes and the deviation between the sy and by axes using the gravity vector.

[0019] Therefore, in the acceleration detection device 10 of this embodiment, a virtual line VL is set between the sx-axis and sy-axis of the acceleration sensor 20. In this embodiment, the virtual line VL bisects the distance between the sx-axis and sy-axis in the same plane as the sx-axis and sy-axis. The acceleration sensor 20 is attached to the vehicle 1 so that the bx-axis is the vehicle reference axis and the angle between the virtual line VL and the bx-axis (hereinafter, yaw mounting angle) Δθ is ±15° or less.

[0020] Even if it is difficult to mount the acceleration sensor 20 on the vehicle 1 so that the yaw mounting angle Δθ is 0°, it is easy to mount the acceleration sensor 20 on the vehicle 1 so that the yaw mounting angle Δθ is ±15° or less. By mounting the acceleration sensor 20 on the vehicle 1 so that the yaw mounting angle Δθ is ±15° or less, the yaw mounting angle Δθ can be easily calculated 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.

[0021] [Configuration of acceleration detection device 10] Fig. 3 shows the configuration of the acceleration detection device 10. The acceleration detection device 10 includes an acceleration sensor 20 and a calculation device 30. Fig. 3 mainly shows the configuration of the calculation device 30 that calculates the yaw setting angle Δθ, and omits configurations that are not related to the configuration that calculates the yaw setting angle Δθ.

[0022] The arithmetic device 30 can be realized by a computer including a processor, a non-volatile memory, a RAM, an I / O, and a bus line connecting these components. The arithmetic device 30 may also include a hardware logic circuit in addition to the processor. The non-volatile memory stores a program for operating a general-purpose computer as the arithmetic device 30. The processor executes the program stored in the non-volatile memory while utilizing the temporary storage function of the RAM, so that the arithmetic device 30 realizes the functions of each unit shown in FIG. 3. When the arithmetic device 30 functions as each unit shown in FIG. 3, it means that a mounting angle detection method corresponding to the program is executed.

[0023] As shown in Fig. 3, the calculation device 30 functions as an acquisition unit 31, a curve low acceleration / deceleration judgment unit 36, and a mounting angle calculation unit 37. The acquisition unit 31 acquires three-axis acceleration A sx , A sy , A sz The acquisition unit 31 acquires a signal indicating the acquired acceleration A sx , A sy , A szThe vehicle control device 4 sequentially outputs a signal indicating the acceleration / deceleration of the vehicle 1 based on the acceleration A, angular acceleration, and the like generated in the vehicle 1.

[0024] The acquisition unit 31 includes low-pass filters 32 and 33. The low-pass filter 32 receives the acceleration A sx The low-pass filter 33 passes the low-frequency components of the signal indicating the acceleration A sy The low-pass filters 32 and 33 are provided to pass low-frequency components of the signal indicating the acceleration A. The low-pass filters 32 and 33 are provided to remove noise components from the signal indicating the acceleration A. The low-pass filters 32 and 33 output the signals to a curve low acceleration / deceleration judgment unit 36 ​​and a setting angle calculation unit 37, respectively.

[0025] The curve low acceleration / deceleration judgment unit 36 ​​judges whether the vehicle 1 is traveling around a curve and in a low acceleration / deceleration state. The detection value of the steering sensor 2 and the yaw angular velocity detection value of the gyro sensor 3 are input to the curve low acceleration / deceleration judgment unit 36. The detection value of the steering sensor 2 and the yaw angular velocity detection value of the gyro sensor 3 form a curve traveling judgment signal for determining whether the vehicle 1 is traveling around a curve. 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 curve low acceleration / deceleration judgment unit 36 ​​as the curve traveling judgment signal. Also, in FIG. 3, the gyro sensor 3 is shown as a configuration not included in the acceleration detection device 10, but the gyro sensor 3 may be integrated with the acceleration sensor 20 included in the acceleration detection device 10.

[0026] A signal indicating the vehicle speed of the vehicle 1 is also input to the curve low acceleration / deceleration judgment unit 36 ​​from the vehicle speed sensor 5. The curve low acceleration / deceleration judgment unit 36 ​​calculates the acceleration A from the change in vehicle speed. This acceleration A means the acceleration A in the traveling direction of the vehicle 1. The curve low acceleration / deceleration judgment unit 36 ​​judges whether the vehicle 1 is in a low acceleration / deceleration state based on the acceleration A calculated from the time change in the vehicle speed. Whether the vehicle 1 is in a low acceleration / deceleration state is judged based on whether the acceleration A of the vehicle 1 is within a low acceleration / deceleration range set in advance. The low acceleration / deceleration range is a range that is determined from the perspective of whether equations (6) and (7) described below hold true, and is a range that is set in advance based on experiments, etc.

[0027] The mounting angle calculation unit 37 calculates the acceleration A sx , A sy The yaw mounting angle calculation unit 37 calculates the yaw mounting angle Δθ using a signal indicating the yaw mounting angle Δθ and an angle calculation formula described next. The mounting angle calculation unit 37 outputs the calculated yaw mounting angle Δθ to the vehicle control device 4. The vehicle control device 4 uses the yaw mounting angle Δθ to calculate the acceleration A sx , A sy is corrected and used for vehicle control.

[0028] [Angle calculation formula] Next, the angle calculation formula will be described. In this embodiment, formula (1) shown in Fig. 4 is used as the angle calculation formula. A method for deriving this formula (1) will be described below. Formulas (2) and (3) shown in Fig. 4 hold true from the geometric relationship shown in Fig. 1.

[0029] Adding the left and right sides of equations (2) and (3) together and transforming the right side using the addition theorem gives equation (4). Also, subtracting the left and right sides of equation (3) from the left and right sides of equation (2), respectively, and transforming the right side using the addition theorem gives equation (5). The angle calculation formula shown in equation (1) is used to calculate the acceleration A in the longitudinal direction of the vehicle when, for example, vehicle 1 is traveling at a constant speed around a curve. bx is the acceleration A in the vehicle width direction. by In other words, the angle calculation formula is based on the vehicle longitudinal acceleration A bxThis assumes a state in which the acceleration A is so small that it can be considered that no substantial force is occurring. By applying this assumption to equations (4) and (5), the first term in parentheses can be eliminated, yielding equations (6) and (7). Using equations (6) and (7), the calculation shown in equation (8) can be carried out.

[0030] In this embodiment, the acceleration sensor 20 is attached so that the yaw mounting angle Δθ is within ±15°. If the yaw mounting angle Δθ is within ±15°, it can be approximated as tan θ≒θ(rad). This is because tan(15π / 180) is approximately 0.259, and 15° is 0.261(rad). Applying tan θ≒θ to equation 8 gives equation (1).

[0031] [Processing flow] Fig. 5 shows the flow of processing up to the calculation of the yaw setting angle Δθ. The processing shown in Fig. 5 can be executed while the vehicle 1 is traveling if the yaw setting angle Δθ has not been calculated. Alternatively, even if the yaw setting angle Δθ has been calculated, the processing may be executed while the vehicle 1 is traveling if a certain period of time has passed since the calculation of the yaw setting angle Δθ.

[0032] In S10, the curve low acceleration / deceleration judgment unit 36 ​​judges whether the vehicle 1 is traveling around a curve using one or both of the detection value of the steering sensor 2 and the yaw angular velocity detection value of the gyro sensor 3. If the detection value of the steering sensor 2 indicates that the steering angle is equal to or greater than an angle threshold value indicating traveling around a curve, it can be judged that the vehicle 1 is traveling around a curve. Also, if the yaw angular velocity detection value indicates that the yaw angular velocity is equal to or greater than an angular velocity threshold, it may be judged that the vehicle 1 is traveling around a curve. The angle threshold value and the angular velocity threshold value are values ​​that are set in advance.

[0033] If the determination result in S10 is NO, the determination in S10 is repeated. If the determination result in S10 is YES, the process proceeds to S20. In S20, the curve low acceleration / deceleration determination unit 36 ​​calculates the acceleration A from the time change in the vehicle speed. Then, based on this acceleration A, it is determined whether the vehicle 1 is traveling at a constant speed. If the acceleration A calculated from the vehicle speed is within a low acceleration / deceleration range set in advance, it is determined that the vehicle 1 is traveling at a constant speed. This determination can also be said to be a determination of whether the vehicle 1 is in a low acceleration / deceleration state. If the determination result in S20 is NO, the process returns to S10. If the determination result in S20 is YES, the process proceeds to S30.

[0034] In S30, the acquisition unit 31 acquires the acceleration A sx , A sy In S40, the curve low acceleration / deceleration judgment unit 36 ​​acquires the acceleration A sx , A sy Substitute this into equation (1) to calculate the yaw setting angle Δθ.

[0035] In S50, the mounting angle calculation unit 37 judges whether the yaw mounting angle Δθ calculated in S40 is out of standard. For example, if the yaw mounting angle Δθ calculated in S40 is out of the range of ±15°, it is judged that the yaw mounting angle Δθ is out of standard. If the judgment result in S50 is YES, the process returns to S10. If the judgment result in S50 is YES, the process proceeds to S60.

[0036] In S60, the mounting angle calculation unit 37 accumulates the yaw mounting angle Δθ calculated in S40. In S70, the mounting angle calculation unit 37 judges whether the accumulated yaw mounting angle Δθ has reached a certain number. If the judgment result in S70 is NO, the process returns to S10. If the judgment result in S10 is YES, the process proceeds to S80. The certain number is a value determined in advance, and is a number for ensuring the accuracy required in the statistical processing in S80.

[0037] In S80, the mounting angle calculation unit 37 performs statistical processing on the data accumulated in S60 to calculate the yaw mounting angle Δθ. As an example of the statistical processing, the most frequent value of the accumulated yaw mounting angle Δθ can be adopted. In addition, as another example of the statistical processing, sx-A sy The vertical axis is A sx +A sy The point where the yaw angle is Δθ is plotted, and the approximation line of the points is calculated. From the formula (1), the gradient of the approximation line is the yaw angle Δθ. The setting angle calculation unit 37 outputs the yaw angle Δθ obtained by the statistical processing to the vehicle control device 4.

[0038] The vehicle control device 4 can calculate the orientations of the sx and sy axes based on the yaw mounting angle Δθ. Note that the calculation device 30 may also calculate the orientations of the sx and sy axes and output them to the vehicle control device 4.

[0039] In the first embodiment described above, a virtual line VL is set between the sx axis and the sy axis. bx is the acceleration A in the vehicle width direction by If it is assumed that the imaginary line VL is sufficiently smaller than the vehicle longitudinal axis bx, then an angle calculation equation (equation (1)) for calculating the yaw mounting angle Δθ between the imaginary line VL and the bx axis which is the vehicle longitudinal axis can be derived.

[0040] The angle calculation formula is the acceleration A in the vehicle width direction. by In addition, the vehicle experiences an acceleration A bx When the vehicle 1 is tilted in the vehicle width direction, an acceleration A caused by the tilt of the vehicle 1 in the vehicle width direction is applied to the sx-axis and sy-axis. However, the angle calculation formula is a formula assuming that the acceleration A in the vehicle width direction is generated. Therefore, even if the sx-axis and sy-axis of the acceleration sensor 20 are tilted in the vehicle width direction with respect to the horizontal plane because the road surface on which the vehicle 1 is traveling is tilted in the vehicle width direction, the calculation accuracy of the yaw mounting angle Δθ is prevented from decreasing.

[0041] The virtual line VL bisects the distance between the sx axis and the sy axis. If the acceleration sensor 20 is attached so that the yaw setting angle Δθ between the virtual line VL and the bx axis is ±15° or less, the angles of both the sx axis and the sy axis with the bx axis will be close to 45°. This prevents one of Asx and Asy substituted into equation (1) from becoming extremely small, allowing the yaw setting angle Δθ to be calculated with greater accuracy.

[0042] The acceleration detection device 10 also includes a curve low acceleration / deceleration determination unit 36. When the curve low acceleration / deceleration determination unit 36 ​​determines that the vehicle 1 is not in a curve running state and is not in a low acceleration / deceleration state, the acceleration A sx , A sy is not used as data for calculating the yaw setting angle Δθ. Even with this processing, the yaw setting angle Δθ can be calculated with high accuracy.

[0043] Moreover, the curve low acceleration / deceleration judgment unit 36 ​​judges whether the vehicle 1 is traveling on a curve based on a curve traveling judgment signal, which is the detection value of the steering sensor 2 and the yaw angular velocity detection value of the gyro sensor 3. Moreover, whether the vehicle 1 is traveling at a constant speed is judged based on the acceleration obtained by differentiating the vehicle speed. Therefore, even if the acceleration sensor 20 detects an abnormal value, it is possible to prevent the yaw mounting angle Δθ from being erroneously calculated using the abnormal value.

[0044] <Second embodiment> Next, a second embodiment will be described. In the following description of the second embodiment, elements having the same reference numbers as those used up to that point are the same as those in the previous embodiment unless otherwise specified. In addition, when only a part of the configuration is described, the previously described embodiment can be applied to the other parts of the configuration.

[0045] FIG. 6 shows the configuration of the acceleration detection device 210 of the second embodiment. In the acceleration detection device 210, the process executed by the curve low acceleration / deceleration judgment unit 236 is different from that of the curve low acceleration / deceleration judgment unit 36 ​​of the first embodiment. The curve low acceleration / deceleration judgment unit 236 judges whether the vehicle 1 is traveling on a curve using at least one of the detection value of the steering sensor 2 and the yaw angular velocity detection value of the gyro sensor 3, similar to the curve low acceleration / deceleration judgment unit 36. However, whether the vehicle is in a low acceleration / deceleration state is judged using the acceleration A detected by the acceleration sensor 20. Therefore, the curve low acceleration / deceleration judgment unit 236 does not acquire a signal from the vehicle speed sensor 5. In addition, in the second embodiment, the angle calculation formula used by the mounting angle calculation unit 237 is different from that of the first embodiment.

[0046] [Angle calculation formula] Next, an angle calculation formula used in the second embodiment will be described. In the second embodiment, the formula (9) shown in FIG. 7 is used as the angle calculation formula. A method for deriving the formula (9) will be described below. In the formula (5) shown in FIG. 4, A by = 0. Also, if the yaw setting angle Δθ is ±15° or less, it can be approximated as cosθ ≒ 1 (rad). From these facts, the left side of equation (9) can be obtained from equation (5) shown in Fig. 4. Furthermore, equation (10) shown in Fig. 7 holds true from the geometric relationship shown in Fig. 1. By transforming equation (10), the right side of equation (9) can be obtained.

[0047] In addition, equation (9) is two equations, but the equation on the left determines the A of the equation on the right. by By eliminating, equation (9) can be summarized as one equation shown in equation (11). As can be seen from equation (11), the angle calculation equation in equation (9) also sx , A sy It can be seen that the yaw mounting angle Δθ can be calculated from

[0048] 8 shows the flow of processing up to the calculation of the yaw mounting angle Δθ in the second embodiment. FIG. 8 does not include S20 in FIG. 5, and executes S31 instead. In S31, the curve low acceleration / deceleration judgment unit 236 calculates the acceleration A sx , A sy Based on this, A sx +A sy A sx -A sy As shown in Figure 9, A sx +A sy is a value that substitutes for the acceleration A in the longitudinal direction of the vehicle, and A sx -A sy is a value that substitutes for the acceleration A in the vehicle width direction. S31 is the acceleration A by There is an acceleration A bx is approximately zero, that is, whether the vehicle 1 is traveling at a constant speed around the curve.

[0049] The angle calculation formula is acceleration A bx is zero, so when obtaining the data to be substituted into the angle calculation formula, bx It is judged whether A is close to zero. sx -A sy A sx +A sy If the value is greater than the predetermined value, the result of the determination in S31 can be YES. sx -A sy A sx +A sy If the difference is equal to or greater than a predetermined multiple (for example, 8 times), the result of the determination in S31 may be YES.

[0050] Also, A sx +A sy A instead of sx cosα+A sy Using cos(π / 2-α), A sx -A sy A instead of sx cos(π / 2-α)-A sy Cosα may also be used, where α is the angular difference in likelihood between the sx and bx axes.

[0051] If the determination result of S31 is NO, S10 is executed again. If the determination result of S31 is YES, the process proceeds to S41. In S41, the mounting angle calculation unit 237 calculates the acceleration A sx , A sy Substitute this into equation (9) to calculate the yaw setting angle Δθ.

[0052] In the second embodiment, the output signal of the acceleration sensor 20 is used to determine whether the vehicle 1 is traveling at a constant speed around a curve (S31). If the determination is negative, the yaw angle Δθ is not calculated, and the acceleration A obtained in a situation different from the situation assumed in deriving the angular velocity calculation formula is not calculated. sx , A sy It is possible to prevent the yaw mounting angle Δθ from being calculated using the above formula.

[0053] In the second embodiment, the vehicle 1 is judged whether or not it is traveling around a curve by using one or both of the detection value of the steering sensor 2 and the detection value of the yaw angular velocity of the gyro sensor 3. As a result, the acceleration A detected when the vehicle 1 is not traveling around a curve is sx , A sy It is possible to further suppress the calculation of the yaw mounting angle Δθ using

[0054] <Third embodiment> In the third embodiment, the directions of the sx and sy axes of the acceleration sensor 20 are different from those of the previous embodiments. As shown in FIG. 10, in the third embodiment, the acceleration sensor 20 is rotated 90° counterclockwise around the sz axis from the orientation in the first embodiment. The yaw mounting angle Δθ is the angle between the virtual line VL and the by axis. In the third embodiment, the by axis is the vehicle reference axis. The acceleration sensor 20 is attached to the vehicle 1 so that the angle θ between the virtual line VL and the by axis is ±15° or less.

[0055] In the third embodiment, the formulas (12) and (13) shown in FIG. 11 are established based on the geometric relationship shown in FIG. 10. The left and right sides of the formulas (12) and (13) are added together, and the right sides are transformed using the addition theorem. bx If we set =0, we obtain equation (14). In addition, we subtract the left and right sides of equation (13) from the left and right sides of equation (12), respectively, and transform the right side using the addition theorem, and then we obtain bx = 0, we obtain equation (15). Furthermore, by multiplying both sides of equation (14) and equation (15) by a negative number, we obtain equation (16), which is the angle calculation equation.

[0056] In this way, even in the orientation of the acceleration sensor 20 of the third embodiment, the acceleration A sx , A sy From this, an angle calculation formula for calculating the yaw mounting angle Δθ can be derived.

[0057] <Fourth embodiment> In the fourth embodiment, the acceleration sensor 20 is rotated 180° around the sz axis from the orientation in the first embodiment, as shown in Fig. 12. The yaw mounting angle Δθ is the angle between the imaginary line VL and the bx axis, similar to the first embodiment.

[0058] In the fourth embodiment, the formulas (17) and (18) shown in FIG. 13 are established based on the geometric relationship shown in FIG. 12. The left and right sides of the formulas (17) and (18) are added together, and the right sides are transformed using the addition theorem. bx If we set =0, we obtain equation (19). In addition, we subtract the left and right sides of equation (18) from the left and right sides of equation (17), respectively, and transform the right side using the addition theorem, and then we obtain bx = 0, equation (20) is obtained. Furthermore, equation (8) is obtained from equations (19) and (20), which is the same as in the first embodiment. Therefore, in the fourth embodiment, the yaw setting angle Δθ can be calculated by using equation (1) as the angle calculation equation, which is the same as in the first embodiment.

[0059] <Fifth embodiment> In the fifth embodiment, as shown in Fig. 14, the acceleration sensor 20 is rotated 270° counterclockwise around the sz axis from the orientation in the first embodiment. From the third embodiment, it can be said that the acceleration sensor 20 is rotated 180° around the sz axis. The yaw mounting angle Δθ is the angle between the virtual line VL and the by axis, as in the third embodiment.

[0060] In the fifth embodiment, the formulas (21) and (22) shown in FIG. 15 are established based on the geometric relationship shown in FIG. 14. The left and right sides of the formulas (21) and (22) are added together, and the right sides are transformed using the addition theorem. bx If we set =0, we obtain equation (23). In addition, we subtract the left and right sides of equation (22) from the left and right sides of equation (21), respectively, and transform the right side using the addition theorem, and then we obtain bx = 0, the formula (24) is obtained. Furthermore, the formula (16) same as in the third embodiment is obtained from the formula (23) and the formula (24) multiplied by a negative number on both sides. Therefore, in the fifth embodiment, the yaw setting angle Δθ can be calculated using the formula (16) like the third embodiment.

[0061] Sixth Embodiment In the above embodiments, the virtual line VL is a line that divides the sx-axis and the sy-axis into two equal parts. However, the virtual line VL can be set arbitrarily between the sx-axis and the sy-axis. The angle between the virtual line VL and the sx-axis is α, and the angle between the virtual line VL and the sy-axis is β.

[0062] Generalizing equations (2) and (3) using α and β gives equations (25) and (26) shown in FIG. 16. Adding and subtracting the right and left sides of equations (25) and (26), and A bx If we set =0, we obtain equations (27) and (28). Furthermore, equation (29) is obtained from equations (27) and (28). In equation (29), numerical values ​​can be found for all elements except sin Δθ and cos Δθ. By calculating the numerical values, we obtain equation (30). In equation (30), γ is a numerical value. From equation (30), we further obtain equation (31). Since equation (31) is obtained, it can be seen that the virtual line VL can be set anywhere between the sx-axis and sy-axis.

[0063] Although the embodiments have been described above, the disclosed technology is not limited to the above-described embodiments, and the following modifications are also included in the scope of the disclosure. Furthermore, in addition to the modifications described below, various modifications can be made without departing from the spirit of the invention.

[0064] <Variation 1> The acceleration sensor 20 may be configured to include a sensor for detecting the acceleration A in the sx-axis direction and a sensor for detecting the acceleration A in the sy-axis direction separately. The acceleration sensor 20 may also be a sensor that includes only the sx-axis and the sy-axis instead of the three axes.

[0065] <Variation 2> A band-pass filter may be used instead of the low-pass filters 32 and 33. The use of a band-pass filter makes it easier to remove the bias.

[0066] <Variation 3> In the second embodiment, in addition to determining in S31 whether the vehicle is traveling around a curve at a constant speed, it is also determined in S10 whether the vehicle is traveling around a curve. However, the determination in S10 may be omitted.

[0067] <Modification 4> In the second embodiment, formula (1) may be used as the angle calculation formula. In the first embodiment, formula (9) may be used as the angle calculation formula. [Explanation of symbols]

[0068] 1: Vehicle 2: Steering sensor 3: Gyro sensor 4: Vehicle control device 5: Vehicle speed sensor 10: Acceleration detection device 20: Acceleration sensor 30: Calculation device 31: Acquisition unit 32: Low pass filter 33: Low pass filter 36: Curve low acceleration / deceleration judgment unit 37: Mounting angle calculation unit 210: Acceleration detection device 236: Curve low acceleration / deceleration judgment unit 237: Mounting angle calculation unit VL: Virtual line Δθ: Yaw mounting angle bx: Vehicle longitudinal axis by: Vehicle lateral axis sx: First detection axis sy: Second detection axis

Claims

1. An acceleration detection device (10) equipped with an acceleration sensor (20) having at least a first detection axis (sx) and a second detection axis (sy) perpendicular to each other, the acceleration detection device (10) being mounted on a vehicle (1), the acceleration sensor is disposed on the vehicle such that a yaw mounting angle (Δθ) between a vehicle reference axis, which is either a vehicle longitudinal axis (bx) or a vehicle transverse axis (by), and a virtual line (VL) set between the first detection axis and the second detection axis is within ±15 degrees; An acquisition unit (31) that acquires an acceleration in a first detection axis direction and an acceleration in a second detection axis direction from the acceleration sensor when an acceleration in a vehicle width direction occurs in the vehicle and the vehicle is experiencing a low acceleration / deceleration in a vehicle front-rear direction; The acceleration detection device includes: an angle calculation formula for calculating the yaw mounting angle from an acceleration in the first detection axis direction and an acceleration in the second detection axis direction, the equation being derived by assuming a state in which an acceleration in the vehicle width direction and an acceleration in the vehicle front-rear direction are not generated in the vehicle; and a mounting angle calculation unit (37, 237) for calculating the yaw mounting angle from the acceleration in the first detection axis direction and the acceleration in the second detection axis direction acquired by the acquisition unit.

2. The acceleration detection device according to claim 1 , wherein the virtual line is a line that bisects the first detection axis and the second detection axis.

3. a curve low acceleration / deceleration judgment unit (36) for judging whether the vehicle is traveling on a curve based on a curve traveling judgment signal different from the output signal of the acceleration sensor, and judging whether the vehicle is in a low acceleration / deceleration state in the front-rear direction based on a change in the vehicle speed, 3. The acceleration detection device according to claim 1, wherein the mounting angle calculation unit calculates the yaw mounting angle based on the determination by the curve low acceleration / deceleration determination unit that the vehicle is traveling around a curve and in a low acceleration / deceleration state.

4. a curve low acceleration / deceleration determination unit (236) for determining whether or not the vehicle is traveling on a curve and in a low acceleration / deceleration state in the longitudinal direction of the vehicle based on an output signal of the acceleration sensor; 3. The acceleration detection device according to claim 1, wherein the mounting angle calculation unit calculates the yaw mounting angle based on the determination by the curve low acceleration / deceleration determination unit that the vehicle is traveling around a curve and in the low acceleration / deceleration state.

5. 5. The acceleration detection device according to claim 4, wherein the curve low acceleration / deceleration determination unit determines whether or not the vehicle is traveling on a curve based on a curve traveling determination signal separate from the output signal of the acceleration sensor.

6. A mounting angle detection method for detecting a mounting angle of an acceleration sensor (20) mounted on a vehicle, the acceleration sensor having at least a first detection axis (sx) and a second detection axis (sy) perpendicular to each other, comprising: the acceleration sensor is disposed on the vehicle such that a yaw mounting angle (Δθ) between a vehicle reference axis, which is either a vehicle longitudinal axis (bx) or a vehicle transverse axis (by), and a virtual line (VL) set between the first detection axis and the second detection axis is within ±15 degrees; acquiring an acceleration in a first detection axis direction and an acceleration in a second detection axis direction from the acceleration sensor in a state in which an acceleration in a vehicle width direction occurs in the vehicle and a low acceleration / deceleration in a vehicle front-rear direction; The mounting angle detection method assumes a state in which an acceleration occurs in the vehicle width direction and no acceleration occurs in the vehicle front-rear direction, and a formula is derived utilizing that a tangent value of the yaw mounting angle can be approximated to the yaw mounting angle, the yaw mounting angle being calculated from an acceleration in the first detection axis direction and an acceleration in the second detection axis direction, and the yaw mounting angle is calculated from the acquired acceleration in the first detection axis direction and the acceleration in the second detection axis direction.

Citation Information

Patent Citations

  • Attaching angle calculation system

    JP2005147696A

  • Acceleration calculation method of navigation device

    JP2005274186A

  • Navigation system

    JP2011209162A

  • Navigation device

    JP2015004593A

  • Attitude angle estimation device and movement state detection device provided with same

    WO2014171227A1