Acceleration detection device and mounting angle detection method
The acceleration detection device and method ensure accurate yaw mounting angle calculation by mounting the sensor within ±15 degrees and using a derived formula, addressing the challenge of sensor inclination and maintaining precision.
Patent Information
- Application Number
- JP2021121107
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2021-07-22
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2041-07-22
AI Technical Summary
The accuracy of calculating the yaw mounting angle of an acceleration sensor is reduced when the vehicle and the sensor are inclined with respect to a horizontal plane, as the calculation of vehicle longitudinal acceleration is required, which is challenging in non-horizontal conditions.
An acceleration detection device and method that utilizes an acceleration sensor with orthogonal first and second detection axes, mounted such that the yaw angle is within ±15 degrees, and employs an angle calculation formula derived from the assumption of longitudinal acceleration without width acceleration, approximating the tangent of the yaw angle to calculate the yaw mounting angle accurately.
This approach maintains high accuracy in calculating the yaw mounting angle even when the sensor is inclined, by approximating the tangent of the yaw angle to its actual value, thereby preventing a decrease in calculation precision.
Smart Images

Figure 0007586013000001 
Figure 0007586013000002 
Figure 0007586013000003
Abstract
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 based on the above circumstances, and an object of the present disclosure is to provide an acceleration detection device and an installation angle detection method that can suppress a decrease in the calculation accuracy of the installation angle of the acceleration sensor. [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 longitudinal direction occurs in the vehicle and substantially no acceleration occurs in a vehicle width direction; 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 in the longitudinal direction and no acceleration occurs in the vehicle width 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) 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] When the acceleration sensors are arranged as described above, and acceleration occurs in the vehicle longitudinal direction, and substantially no acceleration occurs in the vehicle width direction, and when the tangent value of the yaw mounting angle can be approximated to the yaw mounting angle, 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 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's longitudinal direction and substantially no acceleration occurs in the vehicle's width 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 longitudinal direction and no acceleration occurs in the vehicle width direction. When the vehicle is tilted in the longitudinal direction, the first detection axis and the second detection axis are subjected to acceleration due to the tilt of the vehicle in the longitudinal direction. However, the angle calculation formula is a formula assuming that acceleration occurs in the vehicle longitudinal direction. Therefore, even if the first detection axis and the second detection axis of the acceleration sensor are tilted in the vehicle longitudinal direction with respect to the horizontal plane due to the road surface on which the vehicle is traveling being tilted in the vehicle longitudinal 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 in which acceleration occurs in a vehicle longitudinal direction and substantially no acceleration occurs in a vehicle width direction, acceleration in a first detection axis direction and acceleration in a second detection axis direction are acquired from an acceleration sensor; The vehicle is assumed to have an acceleration in the vehicle longitudinal direction and no acceleration in the vehicle width 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] 5A to 5C are diagrams showing equations in the process of deriving an angle calculation equation used in the first embodiment. [Diagram 5] FIG. 4 is a diagram showing a process flow up to calculating a yaw mounting angle Δθ. [Figure 6] A diagram showing the direction of acceleration A due to Asx+Asy and Asx-Asy. [Figure 7] FIG. 2 is a diagram showing an approximation line approximating the relationship between Asx+Asy and Asx-Asy. [Figure 8] FIG. 13 is a diagram showing the configuration of an acceleration detecting device 210 according to a second embodiment. [Figure 9] FIG. 4 is a diagram showing a process executed by an abnormality determination unit 238. [Figure 10] FIG. 13 is a diagram showing a state in which a mounting angle calculation method according to a third embodiment is executed. [Figure 11] FIG. 13 is a diagram showing the configuration of an acceleration detecting device 310 according to a 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. 13 is a diagram showing the mounting direction of the acceleration sensor 20 according to the sixth embodiment. [Figure 17] FIG. 23 is a diagram showing an equation for deriving an angle calculation equation used in the sixth embodiment. [Figure 18] FIG. 23 is a diagram showing an equation in the process of deriving an angle calculation equation used in the seventh embodiment. [Figure 19] FIG. 23 is a diagram showing an equation for the process of deriving an angle calculation equation used in the eighth 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 , Asy , 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 method corresponding to the program is executed.
[0023] 3, the calculation device 30 functions as an acquisition unit 31, an addition unit 34, a subtraction unit 35, a straight-line acceleration / deceleration determination unit 36, and a mounting angle calculation unit 37. The acquisition unit 31 acquires the 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 remove noise components from the signal indicative of acceleration A.
[0025] Low-pass filters 32 and 33 output signals to an adder 34 and a subtracter 35, respectively. Adder 34 adds the signal input from low-pass filter 32 and the signal input from low-pass filter 33. Subtracter 35 subtracts the signal input from low-pass filter 33 from the signal input from low-pass filter 32. In other words, subtracter 35 calculates acceleration A after removing noise components. sx From the acceleration A after removing noise components sy Subtract.
[0026] The straight-line acceleration / deceleration determination unit 36 determines whether the vehicle 1 is traveling straight. The straight-line acceleration / deceleration determination unit 36 receives the calculated values calculated by the adder 34 and the subtracter 35. These calculated values are calculated based on the signal output by the acceleration sensor 20. When the vehicle 1 is accelerating or decelerating in the straight-line direction, the vehicle 1 experiences an acceleration A in the vehicle's longitudinal direction, and does not experience any acceleration or deceleration in the vehicle's lateral direction. Therefore, it is possible to determine from the signal output by the acceleration sensor 20 whether the vehicle 1 is accelerating or decelerating in the straight-line direction.
[0027] In addition, the detection value of the steering sensor 2 and the detection value of the yaw angular velocity of the gyro sensor 3 are also input to the straight-line acceleration / deceleration determination unit 36. The detection value of the steering sensor 2 and the detection value of the yaw angular velocity of the gyro sensor 3 form a straight-line determination signal for determining whether the vehicle 1 is in a straight-line state. 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-line acceleration / deceleration determination unit 36 as the straight-line determination signal. Also, in FIG. 3, the gyro sensor 3 is shown as being not included in the acceleration detection device 10, but the gyro sensor 3 may be configured as an integral part of the acceleration sensor 20 included in the acceleration detection device 10.
[0028] The mounting angle calculation unit 37 calculates the yaw mounting angle Δθ using the value calculated by the addition unit 34, the value calculated by the subtraction unit 35, and an angle calculation formula to be 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 calculates the acceleration A output by the acquisition unit 31 using the yaw mounting angle Δθ. sx , A sy is corrected and used for vehicle control.
[0029] [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.
[0030] 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 obtained by applying the acceleration A bx However, the vehicle lateral acceleration A byIt is assumed that the acceleration A is so small that it can be considered that no acceleration is actually occurring. By applying this assumption to equations (4) and (5), the second term in the parentheses can be eliminated, and equations (6) and (7) are obtained. Using equations (6) and (7), the calculation shown in equation (8) can be further performed.
[0031] 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).
[0032] [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 Δθ.
[0033] In S10, the straight-line acceleration / deceleration determination unit 36 determines whether the vehicle 1 is traveling straight 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 near 0°, it can be determined that the vehicle 1 is traveling straight. If the yaw angular velocity detection value indicates that the yaw angular velocity is near 0, it may be determined that the vehicle 1 is traveling straight.
[0034] If the determination result of S10 is NO, the determination of S10 is repeated. If the determination result of S10 is YES, the process proceeds to S20. In S20, the acquisition unit 31 acquires the acceleration A sx , A sy In S30, the adder 34 and the subtracter 35 calculate the acceleration A sx , A sy Based on this, A sx+A sy and A sx -A sy Calculate.
[0035] In S40, the straight-line acceleration / deceleration determination unit 36 uses the calculation result of S30 to determine A sx +A sy A sx -A sy As shown in Figure 6, 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. S40 is the acceleration A bx There is an acceleration A by is approximately zero, that is, whether the vehicle 1 is accelerating or decelerating only in the straight line direction.
[0036] The angle calculation formula is acceleration A by is zero, so when obtaining the data to be substituted into the angle calculation formula, by The judgement is whether or not the value of the product is almost zero. sx +A sy A sx -A sy If the value is greater than the predetermined value, the result of the determination in S40 can be YES. sx +A sy A sx -A sy If the difference is equal to or greater than the predetermined multiple, the result of the determination in S40 may be YES.
[0037] 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 syAlternatively, cosα may be used, where α is the expected angle difference between the sx axis and the bx axis. If the determination result of S40 is NO, S10 is executed again. If the determination result of S40 is YES, the process proceeds to S50.
[0038] In S50, the mounting angle calculation unit 37 accumulates the calculation values calculated in S30. In S60, the mounting angle calculation unit 37 judges whether the accumulated calculation values reach a certain number. If the judgment result in S60 is NO, the process returns to S10. If the judgment result in S60 is YES, the process proceeds to S70. The certain number is a value determined in advance, and is a number for ensuring the accuracy required in the statistical processing in S70.
[0039] In S70, the data accumulated in S50 is statistically processed to calculate the yaw angle Δθ. One example of statistical processing is to estimate the slope of an approximate straight line. Figure 7 shows an example of an approximate straight line. In Figure 7, the horizontal axis is A sx +A sy and the vertical axis is A sx -A sy Therefore, the slope of the approximation line obtained by linearly approximating the data shown in FIG. 7 is the yaw setting angle Δθ. As another example of statistical processing, the most frequent value of the yaw setting angle Δθ calculated based on the accumulated data may be used. The yaw setting angle Δθ obtained by the statistical processing is output to the vehicle control device 4.
[0040] 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.
[0041] In the first embodiment described above, a virtual line VL is set between the sx axis and the sy axis. by is not substantially generated, and by utilizing the fact that tan Δθ can be approximated to Δθ, the angle calculation formula (formula (1)) for calculating the yaw setting angle Δθ can be derived.
[0042] The angle calculation formula is the acceleration A in the longitudinal direction of the vehicle. bxIn addition, an acceleration A by When the pitch angle of the vehicle 1 is not zero, an acceleration A caused by the inclination of the vehicle 1 in the longitudinal direction is applied to the sx and sy axes. However, the angle calculation formula does not include the acceleration A in the longitudinal direction of the vehicle. bx Therefore, even if the sx-axis and sy-axis of the acceleration sensor 20 are inclined in the vehicle front-rear direction with respect to the horizontal plane, the calculation accuracy of the yaw mounting angle Δθ is prevented from decreasing.
[0043] 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.
[0044] The acceleration detection device 10 also includes a straight-line acceleration / deceleration determination unit 36. The straight-line acceleration / deceleration determination unit 36 determines whether the vehicle 1 is accelerating or decelerating in the straight-line direction based on the output signal of the acceleration sensor 20 (S40). When the determination result of S40 is NO, 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.
[0045] Further, the straight-line acceleration / deceleration determination unit 36 does not only determine whether the vehicle 1 is accelerating or decelerating in the straight-line direction by using the output signal of the acceleration sensor 20. The straight-line acceleration / deceleration determination unit 36 also determines whether the vehicle 1 is traveling straight in S10. In S10, the straight-line acceleration / deceleration determination unit 36 determines whether the vehicle 1 is traveling straight by 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.
[0046] When using the output signal from the acceleration sensor 20 to determine whether the vehicle 1 is moving straight, there is a risk that the state in which the vehicle 1 is traveling around a curve on an inclined road surface may be erroneously determined as traveling straight. In more detail, even if acceleration A in the by direction occurs as the vehicle 1 is traveling around a curve, the direction of the gravitational acceleration acting on the vehicle 1 may be in a direction that offsets the acceleration A occurring in the by direction due to traveling around the curve, due to the inclination of the road surface.
[0047] However, in this embodiment, it is determined whether the vehicle 1 is traveling straight or not by 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. Therefore, it is possible to prevent the yaw mounting angle Δθ from being calculated based on the acceleration A detected by the acceleration sensor 20 while the vehicle 1 is traveling around a curve.
[0048] <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.
[0049] 8 shows the configuration of an acceleration detection device 210 of the second embodiment. The acceleration detection device 210 includes an abnormality determination unit 238. The abnormality determination unit 238 determines whether or not the acceleration sensor 20 is abnormal. In order to determine whether or not the acceleration sensor 20 is abnormal, the abnormality determination unit 238 acquires a signal indicating the vehicle speed of the vehicle 1 from the vehicle speed sensor 5. The abnormality determination unit 238 also acquires a calculated value calculated by the addition unit 34. These two values are compared to determine whether or not the acceleration sensor 20 is abnormal.
[0050] 9 shows the process executed by the abnormality determination unit 238. S31 is executed following S30. In S31, the vehicle speed determined by the signal acquired from the vehicle speed sensor 5 is differentiated to calculate the acceleration A in the longitudinal direction of the vehicle.
[0051] In S32, the normal range is calculated based on the acceleration A calculated in S31. sx +A sy This is the range that determines whether a condition is normal or not. sx +A sy As shown in FIG. 7, A indicates the acceleration A of the vehicle 1 in the forward direction. The acceleration A calculated in S31 is also the acceleration A in the forward direction of the vehicle. Therefore, A is calculated based on the acceleration A calculated in S31. sx +A sy A normal range for determining whether the acceleration A is normal or not can be calculated. The formula for calculating the normal range from the acceleration A calculated in S31 is determined in advance.
[0052] In S33, the normal range calculated in S32 is added to the A calculated in S30. sx +A sy This is done by determining whether the acceleration A and A calculated in S31 are included. sx +A sy If the determination result in S33 is NO, the process proceeds to S34. In S34, it is determined that the acceleration sensor 20 is abnormal. Then, the process ends without calculating the yaw mounting angle Δθ.
[0053] In this way, the abnormality determination unit 238 determines the acceleration A obtained by differentiating the vehicle speed and the acceleration A in the forward direction of the vehicle 1 calculated from the output signal of the acceleration sensor 20. sx +A sy (S33). If it is determined by this comparison that the acceleration sensor 20 is abnormal, the mounting angle calculation unit 37 does not calculate the yaw mounting angle Δθ. This makes it possible to prevent the yaw mounting angle Δθ from being calculated as an abnormal value.
[0054] <Third embodiment> In the third embodiment, the vehicle 1 is placed on an inspection table 6 shown in Fig. 10, and the yaw mounting angle Δθ is calculated while the vehicle 1 is stopped. The inspection table 6 is installed, for example, in a manufacturing plant for the vehicle 1. The inspection table 6 has an upper surface 7 on which the vehicle 1 is placed that is flat and inclined.
[0055] In Fig. 10, the vehicle 1 is tilted forward in the longitudinal direction, but is not tilted left-right. In this state, as shown in Fig. 10, the acceleration sensor 20 detects acceleration A in the sx-axis and sy-axis directions due to gravity. Since the acceleration sensor 20 detects acceleration A in the sx-axis and sy-axis directions, the yaw mounting angle Δθ can be calculated from equation (1) even when the vehicle 1 is not moving. The inclination of the upper surface 7 of the inspection table 6 is determined by the acceleration A sx , A sy is determined so that the yaw mounting angle Δθ can be calculated with high accuracy.
[0056] Fig. 11 shows the configuration of an acceleration detection device 310 of the third embodiment. Since the yaw mounting angle Δθ is calculated with the vehicle 1 placed on the inspection stand 6, the acceleration detection device 310 does not include a straight-line acceleration / deceleration determination unit 36, unlike the acceleration detection device 10 of the first embodiment. The mounting angle detection method executed by the acceleration detection device 310 of the third embodiment is the method in Fig. 5 except for S10 and S40.
[0057] According to the mounting angle detection method described in the third embodiment, since there is no need to run the vehicle 1, the yaw mounting angle Δθ can be easily detected before the vehicle 1 is shipped.
[0058] <Fourth embodiment> In the fourth 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. 12, in the fourth 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 fourth 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.
[0059] In the fourth embodiment, the formulas (9) and (10) shown in Fig. 13 are established based on the geometrical relationship shown in Fig. 12. The left and right sides of the formulas (9) and (10) are added together, and the right sides are transformed using the addition theorem. byIf we set =0, we obtain equation (11). In addition, we subtract the left and right sides of equation (10) from the left and right sides of equation (9), respectively, and transform the right side using the addition theorem, and then we obtain by = 0, we obtain equation (12). Furthermore, equation (13), which is an equation for calculating the angle, can be obtained from equations (11) and (12).
[0060] In this way, even in the orientation of the acceleration sensor 20 of the fourth embodiment, sx , A sy From this, an angle calculation formula for calculating the yaw mounting angle Δθ can be derived.
[0061] <Fifth embodiment> In the fifth embodiment, as shown in Fig. 14, the acceleration sensor 20 is rotated 180° around the sz axis from the orientation in the first embodiment. The yaw setting angle Δθ is the angle between the virtual line VL and the bx axis, similar to the first embodiment.
[0062] In the fifth embodiment, the formulas (14) and (15) shown in FIG. 15 are established based on the geometric relationship shown in FIG. 14. The left and right sides of the formulas (14) and (15) are added together, and the right sides are transformed using the addition theorem. by If we set =0, we obtain equation (16). In addition, we subtract the left and right sides of equation (15) from the left and right sides of equation (14), respectively, and transform the right side using the addition theorem, and then A by = 0, equation (17) is obtained. Furthermore, equation (8) is obtained from equations (16) and (17), which is the same as in the first embodiment. Therefore, in the fifth 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.
[0063] Sixth embodiment In the sixth embodiment, as shown in Fig. 16, the acceleration sensor 20 is rotated 270° counterclockwise around the sz axis from the orientation in the first embodiment. From the fourth 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 fourth embodiment.
[0064] In the sixth embodiment, the formulas (18) and (19) shown in FIG. 17 are established based on the geometric relationship shown in FIG. 16. The left and right sides of the formulas (18) and (19) are added together, and the right sides are transformed using the addition theorem. by If A = 0, the formula (11) shown in the fourth embodiment is obtained. In addition, the left and right sides of the formula (19) are subtracted from the left and right sides of the formula (18), respectively, and the right side is transformed using the addition theorem, and A by = 0, the formula (12) shown in the fourth embodiment is obtained. Therefore, in the sixth embodiment, the yaw setting angle Δθ can be calculated using the formula (13) like the fourth embodiment.
[0065] Seventh 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 β.
[0066] When formulas (2) and (3) are generalized using α and β, formulas (20) and (21) shown in FIG. 18 are obtained. Adding and subtracting the right-hand sides and the left-hand sides of formulas (20) and (21), and A by If we set =0, we obtain equations (22) and (23). Furthermore, equation (24) is obtained from equations (22) and (23). In equation (24), numerical values can be found for all but sin Δθ and cos Δθ. By calculating the numerical values, we obtain equation (25). In equation (25), γ is a numerical value. From equation (25), we further obtain equation (26). Since equation (26) is obtained, it can be seen that the virtual line VL can be set anywhere between the sx-axis and sy-axis.
[0067] Eighth embodiment In the eighth embodiment, a formula for calculating an angle different from the above is shown. by= 0 and transforming the right-hand side by the addition theorem, we obtain equations (27) and (28) shown in Figure 19. Since cos45 = sin45, equation (28) can be further transformed into equation (29). Using tan Δθ ≒ Δθ, equation (30) can be obtained from equation (29). This equation (30) may be used as an angle calculation formula to calculate the yaw setting angle Δθ.
[0068] 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.
[0069] <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.
[0070] <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.
[0071] <Variation 3> In the first embodiment, it is determined in S10 whether the vehicle is traveling straight ahead, and it is determined in S40 whether the vehicle is accelerating or decelerating only in the straight ahead direction. However, it is also possible to determine only one of the two. [Explanation of symbols]
[0072] 1: Vehicle 2: Steering sensor 3: Gyro sensor 4: Vehicle control device 5: Vehicle speed sensor 6: Inspection table 7: Top surface 10: Acceleration detection device 20: Acceleration sensor 30: Calculation device 31: Acquisition unit 32: Low pass filter 33: Low pass filter 34: Addition unit 35: Subtraction unit 36: Straight-line acceleration / deceleration judgment unit 37: Mounting angle calculation unit 210: Acceleration detection device 238: Abnormality judgment unit 310: Acceleration detection device 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 in a state in which an acceleration in a vehicle longitudinal direction occurs in the vehicle and substantially no acceleration occurs in a vehicle width 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 angle calculation formula being derived by assuming a state in which an acceleration in the vehicle longitudinal direction and an acceleration in the vehicle width direction are generated in the vehicle, and utilizing that a tangent value of the yaw mounting angle can be approximated to the yaw mounting angle; and a mounting angle calculation unit (37) 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 straight-line acceleration / deceleration determination unit (36) for determining whether the vehicle is accelerating or decelerating in a straight-line direction based on an output signal from 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 straight-line acceleration / deceleration determination unit that the vehicle is accelerating or decelerating in a straight-line direction.
4. 4. The acceleration detection device according to claim 3, wherein the straight-line acceleration / deceleration determination unit determines whether the vehicle is moving straight on the basis of a straight-line determination signal that is separate from the output signal of the acceleration sensor.
5. an abnormality determination unit (238) for determining whether the acceleration sensor is abnormal by comparing an acceleration obtained by differentiating a vehicle speed detected by a vehicle speed sensor (5) provided on the vehicle with a forward acceleration of the vehicle determined based on an output signal of the acceleration sensor; 5. The acceleration detection device according to claim 1, wherein the mounting angle calculation unit does not calculate the yaw mounting angle when the abnormality determination unit determines that the acceleration sensor is abnormal.
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 longitudinal direction occurs in the vehicle and substantially no acceleration occurs in a vehicle width direction; The mounting angle detection method includes: assuming a state in which an acceleration occurs in the vehicle longitudinal direction and no acceleration occurs in the vehicle width direction, and utilizing that a tangent value of the yaw mounting angle can be approximated to the yaw mounting angle, the mounting angle detection method comprising: 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; and calculating the yaw mounting angle from the acquired acceleration in the first detection axis direction and the acceleration in the second detection axis direction.
7. 7. The mounting angle detection method according to claim 6, wherein the acceleration in the first detection axis direction and the acceleration in the second detection axis direction are acquired from the acceleration sensor in a state in which the vehicle is parked on a slope that is inclined in a front-rear direction and is not inclined in a left-right 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
