Sensor calibration method for vehicle
09804191 · 2017-10-31
Assignee
Inventors
Cpc classification
G01P21/00
PHYSICS
B62K11/007
PERFORMING OPERATIONS; TRANSPORTING
International classification
G01C25/00
PHYSICS
G01P21/00
PHYSICS
B62K11/00
PERFORMING OPERATIONS; TRANSPORTING
Abstract
An inverted two-wheel vehicle includes: an inverted two-wheel vehicle body; an acceleration sensor and a gyro sensor which are mounted on the same substrate; and an ECU. The ECU calculates a mounting angle error of the acceleration sensor with respect to the inverted two-wheel vehicle body based on an output value of the acceleration sensor obtained when the inverted two-wheel vehicle is brought into a stationary state in a state where a reference yaw axis of the inverted two-wheel vehicle is made coincident with a vertical direction, and corrects an output value of the gyro sensor by using the mounting angle error of the acceleration sensor with respect to the inverted two-wheel vehicle body as a mounting angle error of the gyro sensor with respect to the inverted two-wheel vehicle body.
Claims
1. A sensor calibration method for a vehicle, the vehicle comprising: a vehicle body; an acceleration sensor; and a gyro sensor, a geometrical posture of the gyro sensor with respect to the acceleration sensor being known, the sensor calibration method comprising: calculating a mounting angle error of the acceleration sensor with respect to the vehicle body based on an output value of the acceleration sensor when the vehicle is brought into a stationary state in a state where a reference yaw axis of the vehicle is made coincident with a vertical direction; and correcting an output value of the gyro sensor by using the mounting angle error of the acceleration sensor with respect to the vehicle body as a mounting angle error of the gyro sensor with respect to the vehicle body.
2. The sensor calibration method according to claim 1, wherein an offset value of the acceleration sensor is obtained in advance prior to mounting of the acceleration sensor and the gyro sensor on the vehicle body.
3. The sensor calibration method according to claim 1, wherein the mounting angle error of the acceleration sensor with respect to the vehicle body is calculated based on: an output value of the acceleration sensor obtained when the vehicle is brought into the stationary state in the state where the reference yaw axis of the vehicle is made coincident with the vertical direction; an output value of the acceleration sensor obtained when the vehicle is inclined at an arbitrary angle in a roll direction from the state where the reference yaw axis of the vehicle is made coincident with the vertical direction and the vehicle is then brought into the stationary state; and an output value of the acceleration sensor obtained when the vehicle is inclined at an arbitrary angle in a pitch direction from the state where the reference yaw axis of the vehicle is made coincident with the vertical direction and the vehicle is then brought into the stationary state.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
(13)
(14)
DESCRIPTION OF THE EXEMPLARY EMBODIMENTS
First Exemplary Embodiment
(15) A first exemplary embodiment of the present invention will be described below.
(16) An inverted two-wheel vehicle 1 (i.e., a vehicle, an inverted vehicle) shown in
(17) The inverted two-wheel vehicle 1 includes an inverted two-wheel vehicle body 2 (i.e., a vehicle body, an inverted vehicle body), a pair of footrests 3, an ECU 4 (Engine Control Unit), two wheels 5, a handle 6, a posture angle sensor 7, and a handle angle sensor 8.
(18) The pair of footrests 3 and the ECU 4 are mounted on the inverted two-wheel vehicle body 2.
(19) The two wheels 5 are respectively mounted on both side surfaces of the inverted two-wheel vehicle body 2 in a rotatable manner.
(20) The handle 6 is mounted at a front end of the inverted two-wheel vehicle body 2.
(21) In the first exemplary embodiment, the posture angle sensor 7 and the handle angle sensor 8 are accommodated in the ECU 4.
(22) The inverted two-wheel vehicle body 2 includes two motors 9. The two motors 9 drive the two wheels 5, respectively.
(23) The inverted two-wheel vehicle body 2 has a reference yaw axis Z which is used as a reference yaw axis for the inverted two-wheel vehicle body 2. For example, the reference yaw axis Z is defined to be orthogonal to a footrest surface 3a of each footrest 3. Similarly, a reference pitch axis Y which is used as a reference pitch axis for the inverted two-wheel vehicle body 2 is defined as, for example, a rotation axis common to the two wheels 5. A reference roll axis X which is used as a reference roll axis for the inverted two-wheel vehicle body 2 is defined as, for example, an axis that is orthogonal to the reference yaw axis Z and orthogonal to the reference pitch axis Y.
(24) As shown in
(25)
(26)
(27) Accordingly, the output value of the acceleration sensor 10 is output in a state where an error due to an offset value specific to the acceleration sensor 10 and an error due to the mounting angle error P and the mounting angle error Q are superimposed on a true value.
(28) Similarly, the output value of the gyro sensor 11 is output in a state where an error due to a bias value specific to the gyro sensor 11 and an error due to the mounting angle error P and the mounting angle error Q described above are superimposed on a true value.
(29) The handle angle sensor 8 detects an angle of the handle 6 with respect to the inverted two-wheel vehicle body 2, and outputs the detection result to an inversion control unit 24 as operation information.
(30) The ECU 4 shown in
(31) The correction unit 20 corrects the output values of the acceleration sensor 10 and the gyro sensor 11 based on correction information stored in the correction information storage unit 21, and outputs the corrected values to the posture angle calculation unit 23.
(32) Specifically, the correction unit 20 first performs a correction to remove an error due to an offset from the output value of the acceleration sensor 10 based on Expression 1 shown below, and then performs a correction to remove an error due to a mounting angle error from the output value of the acceleration sensor 10 based on Expression 2 shown below. The correction unit 20 outputs the corrected values to the posture angle calculation unit 23.
(33) In Expression 1 shown below, accX, accY, and accZ respectively represent X-axis acceleration, Y-axis acceleration, and Z-axis acceleration which are obtained before the correction of the acceleration sensor 10; ΔaccX, ΔaccY, and ΔaccZ respectively represent offset values of X-axis acceleration, Y-axis acceleration, and Z-axis acceleration of the acceleration sensor 10; and accX′, accY′, and accZ′ respectively represent X-axis acceleration, Y-axis acceleration, and Z-axis acceleration which are obtained after the offset correction of the acceleration sensor 10.
(34) In Expression 2 shown below, Δφ represents a mounting angle error about the roll axis of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2; Δθ represents a mounting angle error about the pitch axis of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2; and accX″, accY″, and accZ″ respectively represent X-axis acceleration, Y-axis acceleration, and Z-axis acceleration which are obtained after the offset correction and the mounting angle error correction of the acceleration sensor 10.
(35)
(36) Similarly, the correction unit 20 first performs a correction to remove an error due to a bias from the output value of the gyro sensor 11 based on Expression 3 shown below, and then performs a correction to remove an error due to a mounting angle error from the output value of the gyro sensor 11 based on Expression 4 shown below. The correction unit 20 outputs the corrected values to the posture angle calculation unit 23.
(37) In Expression 3 shown below, ωφ, ωθ, and ωψ respectively represent a roll axis angular velocity, a pitch axis angular velocity, and a yaw axis angular velocity which are obtained before the correction of the gyro sensor 11; Δωφ, Δωθ, and Δωψ respectively represent bias values of the roll axis angular velocity, the pitch axis angular velocity, and the yaw axis angular velocity of the gyro sensor 11; and ωφ′, ωθ, and ωψ′ respectively represent a roll axis angular velocity, a pitch axis angular velocity, and a yaw axis angular velocity which are obtained after the bias correction of the gyro sensor 11.
(38) In Expression 4 shown below, Δφ represents a mounting angle error about the roll axis of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2; and Δθ represents a mounting angle error about the pitch axis of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2. In this case, the acceleration sensor 10 and the gyro sensor 11 are mounted on the surface of the same substrate 12. Accordingly, the mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 is theoretically equal to the mounting angle error of the gyro sensor 11 with respect to the inverted two-wheel vehicle body 2. Accordingly, Λφ and Λθ which are used for correction to remove an error due to the mounting angle error from the output value of the acceleration sensor 10 can also be used for correction to remove an error due to the mounting angle error from the output value of the gyro sensor 11. In Expression 4, ωφ″, ωθ″, and ωψ″ respectively represent a roll axis angular velocity, a pitch axis angular velocity, and a yaw axis angular velocity which are obtained after the bias correction and the mounting angle error correction of the gyro sensor 11.
(39)
(40) The correction information storage unit 21 stores correction information including: ΔaccX, ΔaccY, and ΔaccZ which are used in the above Expression 1; Δωφ, Δωθ, and Δωψ which are used in the above Expression 3; and Δφ and Δθ which are used in the above Expressions 2 and 4.
(41) The correction information generating unit 22 generates the correction information based on the output value of the posture angle sensor 7. The correction information generating unit 22 includes an offset correction information generating unit 30 and a mounting correction information generating unit 32.
(42) In the first exemplary embodiment, assume that the offset value of the acceleration sensor 10 and the bias value of the gyro sensor 11 are known. Specifically, the offset value of the acceleration sensor 10 is measured in advance prior to the mounting of the posture angle sensor 7 on the ECU 4 and the inverted two-wheel vehicle body 2 in the first exemplary embodiment. In this case, in order to measure the offset value of the acceleration sensor 10, the output value of the acceleration sensor 10 may be obtained, for example, when the substrate 12 of the posture angle sensor 7 is placed on a level surface. Further, since the bias value of the gyro sensor 11 is the output value obtained when the gyro sensor 11 is in a stationary state, the output value of the gyro sensor 11 may be obtained in a state where the gyro sensor 11 is brought into a stationary state.
(43) Thus, the offset correction information generating unit 30 does not operate in the first exemplary embodiment. The offset value of the acceleration sensor 10 and the bias value of the gyro sensor 11, which are measured in advance, are stored in the correction information storage unit 21.
(44) The mounting correction information generating unit 32 calculates the mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 based on the output value of the acceleration sensor 10 obtained when the inverted two-wheel vehicle 1 is brought into a stationary state in a state where the reference yaw axis Z of the inverted two-wheel vehicle 1 is made coincident with the vertical direction (i.e., a reference posture, a horizontal posture). Specifically, the mounting correction information generating unit 32 calculates the mounting angle error Δφ about the roll axis and the mounting angle error Δθ about the pitch axis based on Expression 5 shown below, and stores the calculation results in the correction information storage unit 21.
(45)
(46) The posture angle calculation unit 23 performs sensor fusion of the corrected acceleration and angular velocity, which are output from the correction unit 20, by using a Kalman filter or the like, thereby calculating the current posture angle of the inverted two-wheel vehicle 1 and outputting the calculation result to the inversion control unit 24.
(47) The inversion control unit 24 performs inversion control of the inverted two-wheel vehicle 1 by driving the motors 9 using the posture angle of the inverted two-wheel vehicle 1 that is input from the posture angle calculation unit 23, and also performs traveling control of the inverted two-wheel vehicle 1 by driving the motors 9 based on operation information input from the handle angle sensor 8.
(48) Referring next to
(49) In the output value correction flow shown in
(50) Next, the substrate 12 of the posture angle sensor 7 is mounted on the ECU 4 (S110)
(51) Next, the ECU 4 is mounted on the inverted two-wheel vehicle body 2 (S 120).
(52) Next, the mounting correction information generating unit 32 obtains the output value of the acceleration sensor 10 when the inverted two-wheel vehicle 1 is brought into a stationary state in the reference posture (S130).
(53) Next, the mounting correction information generating unit 32 calculates a mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 by using the above Expressions 1 and 5 (S140).
(54) Lastly, the correction unit 20 corrects the output value of the gyro sensor 11 by using the mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 as a mounting angle error of the gyro sensor 11 with respect to the inverted two-wheel vehicle body 2 (S150).
(55) The first exemplary embodiment has the following features.
(56) The inverted two-wheel vehicle 1 (inverted vehicle) includes: the inverted two-wheel vehicle body 2 (inverted vehicle body); the acceleration sensor 10 and the gyro sensor 11 which are mounted on the same substrate 12; and the ECU 4 (control device). The ECU 4 calculates a mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 based on an output value of the acceleration sensor 10 obtained when the inverted two-wheel vehicle 1 is brought into a stationary state in a state where the reference yaw axis of the inverted two-wheel vehicle 1 is made coincident with the vertical direction (S140), and corrects an output value of the gyro sensor 11 by using the mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 as a mounting angle error of the gyro sensor 11 with respect to the inverted two-wheel vehicle body 2 (S150). According to the above configuration, the output value of the gyro sensor 11 can be corrected without using a large test apparatus that allows the inverted two-wheel vehicle 1 itself to turn on a pivot.
(57) Calibration of the gyro sensor 11 in the inverted two-wheel vehicle 1 including the inverted two-wheel vehicle body 2, and the acceleration sensor 10 and the gyro sensor 11 which are mounted on the same substrate 12 is performed in the following manner. (1) A mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 is calculated based on an output value of the acceleration sensor 10 obtained when the inverted two-wheel vehicle 1 is brought into a stationary state in a state where the reference yaw axis of the inverted two-wheel vehicle 1 is made coincident with the vertical direction (S140). (2) An output value of the gyro sensor 11 is corrected using the mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 as a mounting angle error of the gyro sensor 11 with respect to the inverted two-wheel vehicle body 2 (S150). According to the above method, the output value of the gyro sensor 11 can be corrected without using a large test apparatus that allows the inverted two-wheel vehicle 1 itself to turn on a pivot.
(58) Further, the calibration is performed in the following manner. An offset value of the acceleration sensor 10 is obtained in advance prior to the mounting of the acceleration sensor 10 and the gyro sensor 11, which are mounted on the same substrate 12, on the inverted two-wheel vehicle body 2 (S100) According to the above method, the output value of the gyro sensor 11 can be corrected merely by bringing the inverted two-wheel vehicle 1 into the stationary state in the state where the reference yaw axis of the inverted two-wheel vehicle 1 is made coincident with the vertical direction, without the need for causing the inverted two-wheel vehicle 1 to make a special motion, such as inclination, after the vehicle is brought into the stationary state.
Second Exemplary Embodiment
(59) Next, a second exemplary embodiment will be described with reference to
(60) As shown in
(61) As shown in
(62) On the other hand, in the second exemplary embodiment, as shown in
(63) In this manner, the posture angle sensor 7 may be mounted on the inverted two-wheel vehicle body 2 after the posture angle sensor 7 is accommodated in the ECU 4, or the posture angle sensor 7 may be directly mounted on the inverted two-wheel vehicle body 2. In any case, the advantageous effect that “the output value of the gyro sensor 11 can be corrected without using a large test apparatus that allows the inverted two-wheel vehicle 1 itself to turn on a pivot” and the advantageous effect that “the output value of the gyro sensor 11 can be corrected merely by bringing the inverted two-wheel vehicle 1 into a stationary state in a state where the reference yaw axis of the inverted two-wheel vehicle 1 is made coincident with the vertical direction, without causing the inverted two-wheel vehicle 1 to make a special motion, such as inclination, after the inverted two-wheel vehicle 1 is brought into the stationary state” can be obtained without any problem.
Third Exemplary Embodiment
(64) Next, a third exemplary embodiment will be described with reference to
(65) In the first exemplary embodiment described above, the offset value of the acceleration sensor 10 is measured in advance prior to the mounting of the posture angle sensor 7 on the ECU 4 and the inverted two-wheel vehicle body 2.
(66) On the other hand, in the third exemplary embodiment, the offset value of the acceleration sensor 10 is not measured in advance prior to the mounting of the posture angle sensor 7 on the ECU 4 and the inverted two-wheel vehicle body 2. In other words, in the third exemplary embodiment, the posture angle sensor 7 is mounted on the inverted two-wheel vehicle body 2 and a mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 is obtained without the need for obtaining the offset value of the acceleration sensor 10 in advance. Further, the offset value of the acceleration sensor 10 is obtained using the mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2.
(67) Specifically, the mounting correction information generating unit 32 calculates a mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 based on: (a) an output value of the acceleration sensor 10 obtained when the inverted two-wheel vehicle 1 is set in a reference posture and is brought into a stationary state; (b) an output value of the acceleration sensor 10 obtained when the inverted two-wheel vehicle 1 in the reference posture is inclined at an arbitrary angle in the roll direction and is brought into a stationary state; and (c) an output value of the acceleration sensor 10 obtained when the inverted two-wheel vehicle 1 in the reference posture is inclined at an arbitrary angle in the pitch direction and is brought into a stationary state. That is, the mounting correction information generating unit 32 calculates the mounting angle error Δφ about the roll axis of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 and the mounting angle error Δθ about the pitch axis of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 based on Expression 6 shown below, and stores the calculation results in the correction information storage unit 21. In this case, Expression 6 shown below corresponds to the mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2. In Expression 6, G represents gravitational acceleration. In the case of obtaining the mounting angle error Δφ about the roll axis of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2, diff=(Y-axis acceleration in the reference posture)−(Y-axis acceleration during an inclination at an arbitrary angle in the roll direction) holds. In the case of obtaining the mounting angle error Δθ about the pitch axis of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2, diff=(X-axis acceleration in the reference posture)−(X-axis acceleration during an inclination at an arbitrary angle in the pitch direction) holds. In Expression 6, α represents an arbitrary inclination angle.
(68)
(69) The offset correction information generating unit 30 calculates the offset value of the acceleration sensor 10 by using the calculation result of the mounting correction information generating unit 32. Specifically, the offset correction information generating unit 30 calculates the offset value of the acceleration sensor 10 based on Expression 7 shown below, and stores the calculation result in the correction information storage unit 21. In Expression 7 shown below, accX, accY, and accZ respectively represent X-axis acceleration, Y-axis acceleration, and Z-axis acceleration of the acceleration sensor 10 when the inverted two-wheel vehicle 1 is set in the reference posture; ΔaccX, ΔaccY, and ΔaccZ respectively represent offset values of the X-axis acceleration, the Y-axis acceleration, and the Z-axis acceleration of the acceleration sensor 10; Δφ represents a mounting angle error about the roll axis of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2; Δθ represents a mounting angle error about the pitch axis of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2; and G represents gravitational acceleration.
(70)
(71) Referring next to
(72) First, the substrate 12 of the posture angle sensor 7 is mounted on the ECU 4 (S200).
(73) Next, the ECU 4 is mounted on the inverted two-wheel vehicle body 2 (S210).
(74) Next, the mounting correction information generating unit 32 obtains the output value of the acceleration sensor 10 when the inverted two-wheel vehicle 1 is brought into a stationary state in the reference posture (S220).
(75) Next, an operator causes the inverted two-wheel vehicle 1 in the reference posture to be inclined at an arbitrary angle in the pitch direction. The mounting correction information generating unit 32 obtains the output value of the acceleration sensor 10 when the inverted two-wheel vehicle 1 in the reference posture is inclined at an arbitrary angle in the pitch direction and is brought into a stationary state (S230).
(76) Next, the operator causes the inverted two-wheel vehicle 1 in the reference posture to be inclined at an arbitrary angle in the roll direction. The mounting correction information generating unit 32 obtains the output value of the acceleration sensor 10 when the inverted two-wheel vehicle 1 in the reference posture is inclined at an arbitrary angle in the roll direction and is brought into a stationary state (S240).
(77) Next, the mounting correction information generating unit 32 calculates a mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 by using the above Expression 6 (S250).
(78) Lastly, the correction unit 20 corrects the output value of the gyro sensor 11 by using the mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 as a mounting angle error of the gyro sensor 11 with respect to the inverted two-wheel vehicle body 2 (S260).
(79) The third exemplary embodiment has the following features.
(80) The ECU 4 calculates the mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 based on: (a) an output value of the acceleration sensor 10 obtained when the inverted two-wheel vehicle 1 is brought into a stationary state in a state where the reference yaw axis of the inverted two-wheel vehicle 1 is made coincident with the vertical direction; (b) an output value of the acceleration sensor 10 obtained when the inverted two-wheel vehicle 1 is inclined at an arbitrary angle in the roll direction from the state where the reference yaw axis of the inverted two-wheel vehicle 1 is made coincident with the vertical direction and the vehicle is then brought into a stationary state; and (c) an output value of the acceleration sensor 10 obtained when the inverted two-wheel vehicle 1 is inclined at an arbitrary angle in the pitch direction from the state where the reference yaw axis of the inverted two-wheel vehicle 1 is made coincident with the vertical direction and the vehicle is then brought into a stationary state (S250). According to the above configuration, the output value of the gyro sensor 11 can be corrected without the need for obtaining the offset value of the acceleration sensor 10 in advance prior to the mounting of the acceleration sensor 10 and the gyro sensor 11, which are mounted on the same substrate 12, on the inverted two-wheel vehicle body 2.
(81) Calibration of the gyro sensor 11 is performed in the following manner. That is, a mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 is calculated based on: (a) an output value of the acceleration sensor 10 obtained when the inverted two-wheel vehicle 1 is brought into a stationary state in a state where the reference yaw axis of the inverted two-wheel vehicle 1 is made coincident with the vertical direction; (b) an output value of the acceleration sensor 10 obtained when the inverted two-wheel vehicle 1 is inclined at an arbitrary angle in the roll direction from the state where the reference yaw axis of the inverted two-wheel vehicle 1 is made coincident with the vertical direction and the vehicle is then brought into a stationary state; and (c) an output value of the acceleration sensor 10 obtained when the inverted two-wheel vehicle 1 is inclined at an arbitrary angle in the pitch direction from the state where the reference yaw axis of the inverted two-wheel vehicle 1 is made coincident with the vertical direction and the vehicle is then brought into a stationary state (S250). According to the above method, the output value of the gyro sensor 11 can be corrected without the need for obtaining the offset value of the acceleration sensor 10 in advance prior to the mounting of the acceleration sensor 10 and the gyro sensor 11 on the inverted two-wheel vehicle body 2.
Fourth Exemplary Embodiment
(82) Next, a fourth exemplary embodiment will be described with reference to
(83) In the fourth exemplary embodiment, the posture angle sensor 7 is not accommodated in the ECU 4, but is instead directly mounted on the inverted two-wheel vehicle body 2.
(84) As shown in
(85) On the other hand, in the fourth exemplary embodiment, as shown in
(86) Thus, the posture angle sensor 7 may be mounted on the inverted two-wheel vehicle body 2 after the posture angle sensor 7 is accommodated in the ECU 4, or the posture angle sensor 7 may be directly mounted on the inverted two-wheel vehicle body 2. In any case, the advantageous effect that “the output value of the gyro sensor 11 can be corrected without using a large test apparatus that allows the inverted two-wheel vehicle 1 itself to turn on a pivot”, and the advantageous effect that “the output value of the gyro sensor 11 can be corrected without the need for obtaining an offset value of the acceleration sensor 10 in advance prior to the mounting of the acceleration sensor 10 and the gyro sensor 11, which are mounted on the same substrate 12, on the inverted two-wheel vehicle body 2” can be obtained without any problem.
Fifth Exemplary Embodiment
(87) Next, a fifth exemplary embodiment will be described with reference to
(88) In the first exemplary embodiment described above, the offset value of the acceleration sensor 10 is measured in advance prior to the mounting of the posture angle sensor 7 on the ECU 4 and the inverted two-wheel vehicle body 2. During the measurement, the substrate 12 of the posture angle sensor 7 is placed on a level surface. However, it may be difficult to prepare a level surface in some cases. The fifth exemplary embodiment assumes a case where it is difficult to prepare a level surface, and therefore, the offset value of the acceleration sensor 10 is measured in advance prior to the mounting of the posture angle sensor 7 on the ECU 4 and the inverted two-wheel vehicle body 2 in the following manner.
(89) As shown in
(90) Next, the ECU 4 is placed on an arbitrary surface, which may be inclined, and the output value of the acceleration sensor 10 is obtained (S310).
(91) Next, the ECU 4 in the state of S310 is inclined at an arbitrary angle in the pitch direction. The output value of the acceleration sensor 10 is obtained when the ECU 4 in the state of S310 is inclined at an arbitrary angle in the pitch direction and is brought into a stationary state (S320).
(92) Next, the ECU 4 in the state of S310 is inclined at an arbitrary angle in the roll direction. The output value of the acceleration sensor 10 is obtained when the ECU 4 in the state of S310 is inclined at an arbitrary angle in the roll direction and is brought into a stationary state (S330).
(93) Next, the offset value of the acceleration sensor 10 is calculated using Expressions 8 and 9 shown below (S340). In this case, Expression 8 shown below corresponds to an initial inclination angle of the ECU 4 in the state of S310. G represents gravitational acceleration. In the case of obtaining an initial inclination angle about the roll axis of the acceleration sensor 10, diff=(Y-axis acceleration in S310)−(Y-axis acceleration during an inclination at an arbitrary angle in the roll direction) holds. In the case of obtaining an initial inclination angle about the pitch axis of the acceleration sensor 10, diff=(X-axis acceleration in S310)−(X-axis acceleration during an inclination at an arbitrary angle in the pitch direction) holds. α represents an arbitrary inclination angle. In Expression 9 shown below, accX, accY, and accZ respectively represent X-axis acceleration, Y-axis acceleration, and Z-axis acceleration of the acceleration sensor 10 in the state of S310; ΔaccX, ΔaccY, and ΔaccZ respectively represent offset values of the X-axis acceleration, the Y-axis acceleration, and the Z-axis acceleration of the acceleration sensor 10; Δφ represents an initial inclination angle about the roll axis of the ECU 4 in the state of S310; Δθ represents an initial inclination angle about the pitch axis of the ECU 4 in the state of S310; and G represents gravitational acceleration.
(94)
(95) Next, the ECU 4 is mounted on the inverted two-wheel vehicle body 2 (S350). Next, the mounting correction information generating unit 32 obtains the output value of the acceleration sensor 10 when the inverted two-wheel vehicle 1 is brought into a stationary state in the reference posture (S360).
(96) Next, the mounting correction information generating unit 32 calculates a mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 by using the above Expressions 1 and 5 (S370).
(97) Lastly, the correction unit 20 corrects the output value of the gyro sensor 11 by using the mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 as a mounting angle error of the gyro sensor 11 with respect to the inverted two-wheel vehicle body 2 (S380).
(98) According to the above method, the advantageous effect that “the output value of the gyro sensor 11 can be corrected without using a large test apparatus that allows the inverted two-wheel vehicle 1 itself to turn on a pivot” and the advantageous effect that “the output value of the gyro sensor 11 can be corrected merely by bringing the inverted two-wheel vehicle 1 into a stationary state in a state where the reference yaw axis of the inverted two-wheel vehicle 1 is made coincident with the vertical direction, without causing the inverted two-wheel vehicle 1 to make a special motion, such as inclination, after the inverted two-wheel vehicle 1 is brought into the stationary state” can be obtained without any problem.
Sixth Exemplary Embodiment
(99) Next, a sixth exemplary embodiment will be described with reference to
(100) In the sixth exemplary embodiment, the posture angle sensor 7 is not accommodated in the ECU 4, but is instead directly mounted on the inverted two-wheel vehicle body 2. The method for obtaining the offset value of the acceleration sensor 10 is substantially the same as that of the fifth exemplary embodiment described above.
(101) As shown in
(102) Next, the substrate 12 of the posture angle sensor 7 in the state of S400 is inclined to the pitch direction at an arbitrary angle. The output value of the acceleration sensor 10 is obtained when the substrate 12 of the posture angle sensor 7 in the state of S400 is inclined in the pitch direction at an arbitrary angle and brought into a stationary state (S410).
(103) Next, the substrate 12 of the posture angle sensor 7 in the state of S400 is inclined at an arbitrary angle in the roll direction. The output value of the acceleration sensor 10 is obtained when the substrate 12 of the posture angle sensor 7 in the state of S400 is inclined at an arbitrary angle in the roll direction and is brought into a stationary state (S420).
(104) Next, the offset value of the acceleration sensor 10 is calculated using Expressions 10 and 11 shown below (S430). In this case, Expression 10 shown below corresponds to an initial inclination angle of the substrate 12 of the posture angle sensor 7 in the state of S400. G represents gravitational acceleration. In the case of obtaining an initial inclination angle about the roll axis of the acceleration sensor 10, diff=(Y-axis acceleration in S400)−(Y-axis acceleration during an inclination at an arbitrary angle in the roll direction) holds. In the case of obtaining an initial inclination angle about the pitch axis of the acceleration sensor 10, diff=(X-axis acceleration in S400)−(X-axis acceleration during an inclination at an arbitrary angle in the pitch direction) holds a represents an arbitrary inclination angle. In Expression 11 shown below, accX, accY, and accZ respectively represent X-axis acceleration, Y-axis acceleration, and Z-axis acceleration of the acceleration sensor 10 in the state of S400; ΔaccX, ΔaccY, and ΔaccZ respectively represent offset values of the X-axis acceleration, the Y-axis acceleration, and the Z-axis acceleration of the acceleration sensor 10; Δφ represents an initial inclination angle about the roll axis of the substrate 12 of the posture angle sensor 7 in the state of S400; Δθ represents an initial inclination angle about the pitch axis of the substrate 12 of the posture angle sensor 7 in the state of S400; and G represents gravitational acceleration.
(105)
(106) Next, the substrate 12 of the posture angle sensor 7 is mounted on the inverted two-wheel vehicle body 2 (S440).
(107) Next, the mounting correction information generating unit 32 obtains the output value of the acceleration sensor 10 when the inverted two-wheel vehicle 1 is brought into a stationary state in the reference posture (S450).
(108) Next, the mounting correction information generating unit 32 calculates a mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 by using the above Expressions 1 and 5 (S460).
(109) Lastly, the correction unit 20 corrects the output value of the gyro sensor 11 by using the mounting angle error of the acceleration sensor 10 with respect to the inverted two-wheel vehicle body 2 as a mounting angle error of the gyro sensor 11 with respect to the inverted two-wheel vehicle body 2 (S470).
(110) Thus, the posture angle sensor 7 may be mounted on the inverted two-wheel vehicle body 2 after the posture angle sensor 7 is accommodated in the ECU 4, or the posture angle sensor 7 may be directly mounted on the inverted two-wheel vehicle body 2. In any case, the advantageous effect that “the output value of the gyro sensor 11 can be corrected without using a large test apparatus that allows the inverted two-wheel vehicle 1 itself to turn on a pivot” and the advantageous effect that “the output value of the gyro sensor 11 can be corrected merely by bringing the inverted two-wheel vehicle 1 into a stationary state in a state where the reference yaw axis of the inverted two-wheel vehicle 1 is made coincident with the vertical direction, without causing the inverted two-wheel vehicle 1 to make a special motion, such as inclination, after the inverted two-wheel vehicle 1 is brought into the stationary state” can be obtained without any problem.
(111) In the above exemplary embodiments, the inverted two-wheel vehicle 1 is illustrated as an exemplary vehicle. However, a vehicle other than an inverted two-wheel vehicle, or a non-inverted vehicle can also be used. Specifically, the inverted two-wheel vehicle 1 according to the above exemplary embodiments includes the two wheels 5 and the two motors 9 which drive the two wheels 5, respectively. However, instead of this, the inverted two-wheel vehicle 1 including one or three or more wheels, and one or three or more motors which drive the one or three or more wheels 5, respectively, may be used.
(112) From the invention thus described, it will be obvious that the embodiments of the invention may be varied in many ways. Such variations are not to be regarded as a departure from the spirit and scope of the invention, and all such modifications as would be obvious to one skilled in the art are intended for inclusion within the scope of the following claims.