JP7420023B2 - 慣性センサ較正装置および慣性センサ較正プログラム - Google Patents
慣性センサ較正装置および慣性センサ較正プログラム Download PDFInfo
- Publication number
- JP7420023B2 JP7420023B2 JP2020148868A JP2020148868A JP7420023B2 JP 7420023 B2 JP7420023 B2 JP 7420023B2 JP 2020148868 A JP2020148868 A JP 2020148868A JP 2020148868 A JP2020148868 A JP 2020148868A JP 7420023 B2 JP7420023 B2 JP 7420023B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- value
- receiving section
- acceleration
- angular velocity
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 230000001133 acceleration Effects 0.000 claims description 497
- 238000004364 calculation method Methods 0.000 claims description 41
- 230000008859 change Effects 0.000 claims description 40
- 206010034719 Personality change Diseases 0.000 claims description 35
- 238000000034 method Methods 0.000 claims description 31
- 238000006243 chemical reaction Methods 0.000 claims description 5
- 239000011159 matrix material Substances 0.000 description 123
- 230000014509 gene expression Effects 0.000 description 69
- 230000035945 sensitivity Effects 0.000 description 45
- 230000007704 transition Effects 0.000 description 27
- 230000008569 process Effects 0.000 description 22
- 101150041689 SLC25A5 gene Proteins 0.000 description 13
- 101150092978 Slc25a4 gene Proteins 0.000 description 13
- 238000002474 experimental method Methods 0.000 description 12
- 238000004088 simulation Methods 0.000 description 12
- 230000006870 function Effects 0.000 description 10
- 238000001514 detection method Methods 0.000 description 5
- 230000009466 transformation Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 230000005484 gravity Effects 0.000 description 3
- 238000004590 computer program Methods 0.000 description 2
- 230000007423 decrease Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004069 differentiation Effects 0.000 description 1
- 238000012887 quadratic function Methods 0.000 description 1
- 210000002784 stomach Anatomy 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P21/00—Testing or calibrating of apparatus or devices covered by the preceding groups
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/14—Receivers specially adapted for specific applications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/40—Correcting position, velocity or attitude
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/52—Determining velocity
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/53—Determining attitude
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Gyroscopes (AREA)
Description
誤差推定部によって推定された角速度誤差に関する値(εΩ)に基づいて、慣性センサによって検出された車両の角速度に関する値(Ωc)を較正する較正部(S214)と、を備え、第1受信部は、車両において参照用受信部よりも左後側に配置されており、第2受信部は、車両において参照用受信部よりも右後側に配置されており、姿勢推定部は、現時点より前の車両の姿勢に関する値(q)に基づいて現時点の車両の姿勢に関する値を予測した値を算出して、算出した車両の姿勢に関する値を予測した値と、第1相対位置(P1)と、第2相対位置(P2)とに基づいて現時点の車両の姿勢に関する値(q)を推定するとともに、現時点より前の車両の姿勢に関する値(q)と、推定した現時点の車両の姿勢に関する値(q)とに基づいて現時点の車両の姿勢変化に関する値(Δq)を推定する慣性センサ較正装置である。
また、請求項2に記載の発明は、測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の角速度(Ωc)を検出する慣性センサ(20)とを備える車両に用いられる慣性センサ較正装置であって、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて参照用受信部の位置に対する第1受信部の相対位置である第1相対位置(P1)を算出するとともに、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて参照用受信部の位置に対する第2受信部である第2相対位置(P2)を算出する位置算出部(S206)と、第1相対位置(P1)と、第2相対位置(P2)とに基づいて、車両の姿勢に関する値(q)と、車両の姿勢変化に関する値(Δq)とを推定する姿勢推定部(S208)と、姿勢推定部によって推定された車両の姿勢に関する値(q)と、姿勢推定部によって推定された車両の姿勢変化に関する値(Δq)とに基づいて車両の角速度に関する値(Ωe)を推定する角速度推定部(S210)と、角速度推定部によって推定された車両の角速度に関する値(Ωe)と、慣性センサによって検出された車両の角速度に関する値(Ωc)とに基づいて、角速度推定部によって推定された車両の角速度に関する値(Ωe)と慣性センサによって検出された車両の角速度に関する値(Ωc)との誤差である角速度誤差に関する値(εΩ)を推定する誤差推定部(S212)と、誤差推定部によって推定された角速度誤差に関する値(εΩ)に基づいて、慣性センサによって検出された車両の角速度に関する値(Ωc)を較正する較正部(S214)と、を備え、第1受信部は、車両において参照用受信部よりも左後側に配置されており、第2受信部は、車両において参照用受信部よりも右後側に配置されており、角速度誤差に関する値(εΩ)は、車両の角速度が変化するときに慣性センサによって検出される車両の角速度の変化に関する値(εφφ、εψψ、εθθ、εψφ、εθφ、εφψ、εθψ、εφθ、εψθ)または車両が停止しているときの慣性センサによって検出される車両の角速度に関する値(εφ0、εψ0、εθ0)を含み、誤差推定部は、現時点より前の角速度誤差に関する値(εΩ)に基づいて現時点の角速度誤差に関する値を予測した値を算出して、算出した角速度誤差に関する値を予測した値と、角速度推定部によって推定された車両の角速度に関する値(Ωe)と、慣性センサによって検出された車両の角速度に関する値(Ωc)とに基づいて、現時点の角速度誤差に関する値(εΩ)を推定する慣性センサ較正装置である。
さらに、請求項3に記載の発明は、測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の角速度(Ωc)を検出する慣性センサ(20)とを備える車両に用いられる慣性センサ較正装置であって、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて参照用受信部の位置に対する第1受信部の相対位置である第1相対位置(P1)を算出するとともに、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて参照用受信部の位置に対する第2受信部である第2相対位置(P2)を算出する位置算出部(S206)と、第1相対位置(P1)と、第2相対位置(P2)とに基づいて、車両の姿勢に関する値(q)と、車両の姿勢変化に関する値(Δq)とを推定する姿勢推定部(S208)と、姿勢推定部によって推定された車両の姿勢に関する値(q)と、姿勢推定部によって推定された車両の姿勢変化に関する値(Δq)とに基づいて車両の角速度に関する値(Ωe)を推定する角速度推定部(S210)と、角速度推定部によって推定された車両の角速度に関する値(Ωe)と、慣性センサによって検出された車両の角速度に関する値(Ωc)とに基づいて、角速度推定部によって推定された車両の角速度に関する値(Ωe)と慣性センサによって検出された車両の角速度に関する値(Ωc)との誤差である角速度誤差に関する値(εΩ)を推定する誤差推定部(S212)と、誤差推定部によって推定された角速度誤差に関する値(εΩ)に基づいて、慣性センサによって検出された車両の角速度に関する値(Ωc)を較正する較正部(S214)と、を備え、第1受信部は、車両において参照用受信部よりも左後側に配置されており、第2受信部は、車両において参照用受信部よりも右後側に配置されており、慣性センサ較正装置は、参照用受信部、第1受信部または第2受信部の位置が予め設定された位置に対してズレているか否かを判定する位置判定部(S114、S116、S118)をさらに備え、較正部は、位置判定部によって参照用受信部、第1受信部および第2受信部の位置が予め設定された位置に対してズレていないと判定されるとき、慣性センサの較正を行う、慣性センサ較正装置である。
また、請求項5に記載の発明は、測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の加速度(Ac)を検出する慣性センサ(40)とを備える車両に用いられる慣性センサ較正装置であって、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて参照用受信部の位置に対する第1受信部の相対位置である第1相対位置(P1)を算出するとともに、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて参照用受信部の位置に対する第2受信部である第2相対位置(P2)を算出する位置算出部(S206)と、第1相対位置と、第2相対位置とに基づいて、車両の姿勢に関する値(q)を推定する姿勢推定部(S208)と、姿勢推定部によって推定された車両の姿勢に関する値(q)に基づいて、車両の加速度に関する値(Ae)を推定する加速度推定部(S216)と、加速度推定部によって推定された車両の加速度に関する値(Ae)と、慣性センサによって検出された車両の加速度に関する値(Ac)とに基づいて、加速度推定部によって推定された車両の加速度に関する値(Ae)と慣性センサによって検出された車両の加速度に関する値(Ac)との誤差である加速度誤差に関する値(εA)を推定する誤差推定部(S218)と、誤差推定部によって推定された加速度誤差に関する値(εA)に基づいて、慣性センサによって検出された車両の加速度に関する値(Ac)を較正する較正部(S220)と、を備え、第1受信部は、車両において参照用受信部よりも左後側に配置されており、第2受信部は、車両において参照用受信部よりも右後側に配置されており、加速度誤差に関する値(εA)は、車両の加速度が変化するときに慣性センサによって検出される車両の加速度の変化に関する値(εxx、εyy、εzz、εyx、εzx、εxy、εzy、εxz、εyz)または車両が停止しているときの慣性センサによって検出される車両の加速度に関する値(εx0、εy0、εz0)を含み、誤差推定部は、現時点より前の加速度誤差に関する値(εA)に基づいて現時点の加速度誤差に関する値を予測した値を算出して、算出した加速度誤差に関する値を予測した値と、加速度推定部によって推定された車両の加速度に関する値(Ae)と、慣性センサによって検出された車両の加速度に関する値(Ac)とに基づいて、現時点の加速度誤差に関する値(εA)を推定する慣性センサ較正装置である。
さらに、請求項6に記載の発明は、測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の加速度(Ac)を検出する慣性センサ(40)とを備える車両に用いられる慣性センサ較正装置であって、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて参照用受信部の位置に対する第1受信部の相対位置である第1相対位置(P1)を算出するとともに、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて参照用受信部の位置に対する第2受信部である第2相対位置(P2)を算出する位置算出部(S206)と、第1相対位置と、第2相対位置とに基づいて、車両の姿勢に関する値(q)を推定する姿勢推定部(S208)と、姿勢推定部によって推定された車両の姿勢に関する値(q)に基づいて、車両の加速度に関する値(Ae)を推定する加速度推定部(S216)と、加速度推定部によって推定された車両の加速度に関する値(Ae)と、慣性センサによって検出された車両の加速度に関する値(Ac)とに基づいて、加速度推定部によって推定された車両の加速度に関する値(Ae)と慣性センサによって検出された車両の加速度に関する値(Ac)との誤差である加速度誤差に関する値(εA)を推定する誤差推定部(S218)と、誤差推定部によって推定された加速度誤差に関する値(εA)に基づいて、慣性センサによって検出された車両の加速度に関する値(Ac)を較正する較正部(S220)と、を備え、第1受信部は、車両において参照用受信部よりも左後側に配置されており、第2受信部は、車両において参照用受信部よりも右後側に配置されており、慣性センサ較正装置は、車両が停止しているか否かを判定する停止判定部(S300)をさらに備え、較正部は、車両が停止しているとき、慣性センサによって検出された車両の加速度に関する値(Ac)を較正し、姿勢推定部は、現時点より前の車両の姿勢に関する値(q)と、現時点の車両の姿勢に関する値(q)とに基づいて現時点の車両の姿勢変化に関する値(Δq)を推定し、慣性センサ較正装置は、姿勢推定部によって推定された車両の姿勢に関する値(q)と、姿勢推定部によって推定された車両の姿勢変化に関する値(Δq)とに基づいて、車両の角速度に関する値(ωeφ、ωeψ、ωeθ)を推定する角速度推定部(S210)をさらに備え、停止判定部は、角速度推定部によって推定された車両の角速度に関する値(ωeφ、ωeψ、ωeθ)が閾値未満であるとき、車両が停止していると判定し、角速度推定部によって推定された車両の角速度に関する値(ωeφ、ωeψ、ωeθ)が閾値以上であるとき、車両が停止していないと判定する慣性センサ較正装置である。
また、請求項7に記載の発明は、測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の加速度(Ac)を検出する慣性センサ(40)とを備える車両に用いられる慣性センサ較正装置であって、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて参照用受信部の位置に対する第1受信部の相対位置である第1相対位置(P1)を算出するとともに、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて参照用受信部の位置に対する第2受信部である第2相対位置(P2)を算出する位置算出部(S206)と、第1相対位置と、第2相対位置とに基づいて、車両の姿勢に関する値(q)を推定する姿勢推定部(S208)と、姿勢推定部によって推定された車両の姿勢に関する値(q)に基づいて、車両の加速度に関する値(Ae)を推定する加速度推定部(S216)と、加速度推定部によって推定された車両の加速度に関する値(Ae)と、慣性センサによって検出された車両の加速度に関する値(Ac)とに基づいて、加速度推定部によって推定された車両の加速度に関する値(Ae)と慣性センサによって検出された車両の加速度に関する値(Ac)との誤差である加速度誤差に関する値(εA)を推定する誤差推定部(S218)と、誤差推定部によって推定された加速度誤差に関する値(εA)に基づいて、慣性センサによって検出された車両の加速度に関する値(Ac)を較正する較正部(S220)と、を備え、第1受信部は、車両において参照用受信部よりも左後側に配置されており、第2受信部は、車両において参照用受信部よりも右後側に配置されており、慣性センサ較正装置は、参照用受信部、第1受信部または第2受信部の位置が予め設定された位置に対してズレているか否かを判定する位置判定部(S114、S116、S118)をさらに備え、較正部は、位置判定部によって参照用受信部、第1受信部および第2受信部の位置が予め設定された位置に対してズレていないと判定されるとき、慣性センサの較正を行う、慣性センサ較正装置である。
また、請求項15に記載の発明は、測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の角速度(Ωc)を検出する慣性センサ(20)とを備える車両に用いられる慣性センサ較正装置を、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて参照用受信部の位置に対する第1受信部の相対位置である第1相対位置(P1)を算出するとともに、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて参照用受信部の位置に対する第2受信部である第2相対位置(P2)を算出する位置算出部(S206)、第1相対位置(P1)と、第2相対位置(P2)とに基づいて、車両の姿勢に関する値(q)と、車両の姿勢変化に関する値(Δq)とを推定する姿勢推定部(S208)、姿勢推定部によって推定された車両の姿勢に関する値(q)と、姿勢推定部によって推定された車両の姿勢変化に関する値(Δq)とに基づいて車両の角速度に関する値(Ωe)を推定する角速度推定部(S210)、角速度推定部によって推定された車両の角速度に関する値(Ωe)と、慣性センサによって検出された車両の角速度に関する値(Ωc)とに基づいて、角速度推定部によって推定された車両の角速度に関する値(Ωe)と慣性センサによって検出された車両の角速度に関する値(Ωc)との誤差である角速度誤差に関する値(εΩ)を推定する誤差推定部(S212)、および、誤差推定部によって推定された角速度誤差に関する値(εΩ)に基づいて、慣性センサによって検出された車両の角速度に関する値(Ωc)を較正する較正部(S214)として、機能させ、第1受信部は、車両において参照用受信部よりも左後側に配置されており、第2受信部は、車両において参照用受信部よりも右後側に配置されており、角速度誤差に関する値(εΩ)は、車両の角速度が変化するときに慣性センサによって検出される車両の角速度の変化に関する値(εφφ、εψψ、εθθ、εψφ、εθφ、εφψ、εθψ、εφθ、εψθ)または車両が停止しているときの慣性センサによって検出される車両の角速度に関する値(εφ0、εψ0、εθ0)を含み、誤差推定部は、現時点より前の角速度誤差に関する値(εΩ)に基づいて現時点の角速度誤差に関する値を予測した値を算出して、算出した角速度誤差に関する値を予測した値と、角速度推定部によって推定された車両の角速度に関する値(Ωe)と、慣性センサによって検出された車両の角速度に関する値(Ωc)とに基づいて、現時点の角速度誤差に関する値(εΩ)を推定する慣性センサ較正プログラムである。
さらに、請求項16に記載の発明は、測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の角速度(Ωc)を検出する慣性センサ(20)とを備える車両に用いられる慣性センサ較正装置を、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて参照用受信部の位置に対する第1受信部の相対位置である第1相対位置(P1)を算出するとともに、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて参照用受信部の位置に対する第2受信部である第2相対位置(P2)を算出する位置算出部(S206)、第1相対位置(P1)と、第2相対位置(P2)とに基づいて、車両の姿勢に関する値(q)と、車両の姿勢変化に関する値(Δq)とを推定する姿勢推定部(S208)、姿勢推定部によって推定された車両の姿勢に関する値(q)と、姿勢推定部によって推定された車両の姿勢変化に関する値(Δq)とに基づいて車両の角速度に関する値(Ωe)を推定する角速度推定部(S210)、角速度推定部によって推定された車両の角速度に関する値(Ωe)と、慣性センサによって検出された車両の角速度に関する値(Ωc)とに基づいて、角速度推定部によって推定された車両の角速度に関する値(Ωe)と慣性センサによって検出された車両の角速度に関する値(Ωc)との誤差である角速度誤差に関する値(εΩ)を推定する誤差推定部(S212)、および、誤差推定部によって推定された角速度誤差に関する値(εΩ)に基づいて、慣性センサによって検出された車両の角速度に関する値(Ωc)を較正する較正部(S214)として、機能させ、第1受信部は、車両において参照用受信部よりも左後側に配置されており、第2受信部は、車両において参照用受信部よりも右後側に配置されており、慣性センサ較正装置を、参照用受信部、第1受信部または第2受信部の位置が予め設定された位置に対してズレているか否かを判定する位置判定部(S114、S116、S118)として機能させ、較正部は、位置判定部によって参照用受信部、第1受信部および第2受信部の位置が予め設定された位置に対してズレていないと判定されるとき、慣性センサの較正を行う、慣性センサ較正プログラムである。
また、請求項18に記載の発明は、測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の加速度(Ac)を検出する慣性センサ(40)とを備える車両に用いられる慣性センサ較正装置を、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて参照用受信部の位置に対する第1受信部の相対位置である第1相対位置(P1)を算出するとともに、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて参照用受信部の位置に対する第2受信部である第2相対位置(P2)とを算出する位置算出部(S206)、第1相対位置と、第2相対位置とに基づいて、車両の姿勢に関する値(q)を推定する姿勢推定部(S208)、姿勢推定部によって推定された車両の姿勢に関する値(q)に基づいて、車両の加速度に関する値(Ae)を推定する加速度推定部(S216)、加速度推定部によって推定された車両の加速度に関する値(Ae)と、慣性センサによって検出された車両の加速度に関する値(Ac)とに基づいて、加速度推定部によって推定された車両の加速度に関する値(Ae)と慣性センサによって検出された車両の加速度に関する値(Ac)との誤差である加速度誤差に関する値(εA)を推定する誤差推定部(S218)、および、誤差推定部によって推定された加速度誤差に関する値(εA)に基づいて、慣性センサによって検出された車両の加速度に関する値(Ac)を較正する較正部(S220)として、機能させ、第1受信部は、車両において参照用受信部よりも左後側に配置されており、第2受信部は、車両において参照用受信部よりも右後側に配置されており、加速度誤差に関する値(εA)は、車両の加速度が変化するときに慣性センサによって検出される車両の加速度の変化に関する値(εxx、εyy、εzz、εyx、εzx、εxy、εzy、εxz、εyz)または車両が停止しているときの慣性センサによって検出される車両の加速度に関する値(εx0、εy0、εz0)を含み、誤差推定部は、現時点より前の加速度誤差に関する値(εA)に基づいて現時点の加速度誤差に関する値を予測した値を算出して、算出した加速度誤差に関する値を予測した値と、加速度推定部によって推定された車両の加速度に関する値(Ae)と、慣性センサによって検出された車両の加速度に関する値(Ac)とに基づいて、現時点の加速度誤差に関する値(εA)を推定する慣性センサ較正プログラムである。
さらに、請求項19に記載の発明は、測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の加速度(Ac)を検出する慣性センサ(40)とを備える車両に用いられる慣性センサ較正装置を、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて参照用受信部の位置に対する第1受信部の相対位置である第1相対位置(P1)を算出するとともに、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて参照用受信部の位置に対する第2受信部である第2相対位置(P2)とを算出する位置算出部(S206)、第1相対位置と、第2相対位置とに基づいて、車両の姿勢に関する値(q)を推定する姿勢推定部(S208)、姿勢推定部によって推定された車両の姿勢に関する値(q)に基づいて、車両の加速度に関する値(Ae)を推定する加速度推定部(S216)、加速度推定部によって推定された車両の加速度に関する値(Ae)と、慣性センサによって検出された車両の加速度に関する値(Ac)とに基づいて、加速度推定部によって推定された車両の加速度に関する値(Ae)と慣性センサによって検出された車両の加速度に関する値(Ac)との誤差である加速度誤差に関する値(εA)を推定する誤差推定部(S218)、および、誤差推定部によって推定された加速度誤差に関する値(εA)に基づいて、慣性センサによって検出された車両の加速度に関する値(Ac)を較正する較正部(S220)として、機能させ、第1受信部は、車両において参照用受信部よりも左後側に配置されており、第2受信部は、車両において参照用受信部よりも右後側に配置されており、慣性センサ較正装置を、車両が停止しているか否かを判定する停止判定部(S300)として機能させ、較正部は、車両が停止しているとき、慣性センサによって検出された車両の加速度に関する値(Ac)を較正し、姿勢推定部は、現時点より前の車両の姿勢に関する値(q)と、現時点の車両の姿勢に関する値(q)とに基づいて現時点の車両の姿勢変化に関する値(Δq)を推定し、慣性センサ較正装置を、姿勢推定部によって推定された車両の姿勢に関する値(q)と、姿勢推定部によって推定された車両の姿勢変化に関する値(Δq)とに基づいて、車両の角速度に関する値(ωeφ、ωeψ、ωeθ)を推定する角速度推定部(S210)として機能させ、
停止判定部は、角速度推定部によって推定された車両の角速度に関する値(ωeφ、ωeψ、ωeθ)が閾値未満であるとき、車両が停止していると判定し、角速度推定部によって推定された車両の角速度に関する値(ωeφ、ωeψ、ωeθ)が閾値以上であるとき、車両が停止していないと判定する慣性センサ較正プログラムである。
また、請求項20に記載の発明は、測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の加速度(Ac)を検出する慣性センサ(40)とを備える車両に用いられる慣性センサ較正装置を、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて参照用受信部の位置に対する第1受信部の相対位置である第1相対位置(P1)を算出するとともに、参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて参照用受信部の位置に対する第2受信部である第2相対位置(P2)とを算出する位置算出部(S206)、第1相対位置と、第2相対位置とに基づいて、車両の姿勢に関する値(q)を推定する姿勢推定部(S208)、姿勢推定部によって推定された車両の姿勢に関する値(q)に基づいて、車両の加速度に関する値(Ae)を推定する加速度推定部(S216)、加速度推定部によって推定された車両の加速度に関する値(Ae)と、慣性センサによって検出された車両の加速度に関する値(Ac)とに基づいて、加速度推定部によって推定された車両の加速度に関する値(Ae)と慣性センサによって検出された車両の加速度に関する値(Ac)との誤差である加速度誤差に関する値(εA)を推定する誤差推定部(S218)、および、誤差推定部によって推定された加速度誤差に関する値(εA)に基づいて、慣性センサによって検出された車両の加速度に関する値(Ac)を較正する較正部(S220)として、機能させ、第1受信部は、車両において参照用受信部よりも左後側に配置されており、第2受信部は、車両において参照用受信部よりも右後側に配置されており、慣性センサ較正装置を、参照用受信部、第1受信部または第2受信部の位置が予め設定された位置に対してズレているか否かを判定する位置判定部(S114、S116、S118)として機能させ、較正部は、位置判定部によって参照用受信部、第1受信部および第2受信部の位置が予め設定された位置に対してズレていないと判定されるとき、慣性センサの較正を行う、慣性センサ較正プログラムである。
変形例では、較正装置50の処理が上記実施形態と異なる。具体的には、較正装置50は、図5に示すように、停止判定部65を機能ブロックとしてさらに有する。
本開示は、上記実施形態に限定されるものではなく、上記実施形態に対して、適宜変更が可能である。また、上記各実施形態において、実施形態を構成する要素は、特に必須であると明示した場合および原理的に明らかに必須であると考えられる場合等を除き、必ずしも必須のものではないことは言うまでもない。
10 参照用GNSS受信機
11 第1GNSS受信機
12 第2GNSS受信機
20 ジャイロセンサ
30 車速センサ
40 加速度センサ
50 較正装置
Claims (20)
- 測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の角速度(Ωc)を検出する慣性センサ(20)とを備える前記車両に用いられる慣性センサ較正装置であって、
前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて前記参照用受信部の位置に対する前記第1受信部の相対位置である第1相対位置(P1)を算出するとともに、前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて前記参照用受信部の位置に対する前記第2受信部である第2相対位置(P2)を算出する位置算出部(S206)と、
前記第1相対位置(P1)と、前記第2相対位置(P2)とに基づいて、前記車両の姿勢に関する値(q)と、前記車両の姿勢変化に関する値(Δq)とを推定する姿勢推定部(S208)と、
前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)と、前記姿勢推定部によって推定された前記車両の姿勢変化に関する値(Δq)とに基づいて前記車両の角速度に関する値(Ωe)を推定する角速度推定部(S210)と、
前記角速度推定部によって推定された前記車両の角速度に関する値(Ωe)と、前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)とに基づいて、前記角速度推定部によって推定された前記車両の角速度に関する値(Ωe)と前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)との誤差である角速度誤差に関する値(εΩ)を推定する誤差推定部(S212)と、
前記誤差推定部によって推定された前記角速度誤差に関する値(εΩ)に基づいて、前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)を較正する較正部(S214)と、
を備え、
前記第1受信部は、前記車両において前記参照用受信部よりも左後側に配置されており、
前記第2受信部は、前記車両において前記参照用受信部よりも右後側に配置されており、
前記姿勢推定部は、現時点より前の前記車両の姿勢に関する値(q)に基づいて現時点の前記車両の姿勢に関する値を予測した値を算出して、算出した前記車両の姿勢に関する値を予測した値と、前記第1相対位置(P1)と、前記第2相対位置(P2)とに基づいて現時点の前記車両の姿勢に関する値(q)を推定するとともに、現時点より前の前記車両の姿勢に関する値(q)と、推定した現時点の前記車両の姿勢に関する値(q)とに基づいて現時点の前記車両の姿勢変化に関する値(Δq)を推定する慣性センサ較正装置。 - 測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の角速度(Ωc)を検出する慣性センサ(20)とを備える前記車両に用いられる慣性センサ較正装置であって、
前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて前記参照用受信部の位置に対する前記第1受信部の相対位置である第1相対位置(P1)を算出するとともに、前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて前記参照用受信部の位置に対する前記第2受信部である第2相対位置(P2)を算出する位置算出部(S206)と、
前記第1相対位置(P1)と、前記第2相対位置(P2)とに基づいて、前記車両の姿勢に関する値(q)と、前記車両の姿勢変化に関する値(Δq)とを推定する姿勢推定部(S208)と、
前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)と、前記姿勢推定部によって推定された前記車両の姿勢変化に関する値(Δq)とに基づいて前記車両の角速度に関する値(Ωe)を推定する角速度推定部(S210)と、
前記角速度推定部によって推定された前記車両の角速度に関する値(Ωe)と、前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)とに基づいて、前記角速度推定部によって推定された前記車両の角速度に関する値(Ωe)と前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)との誤差である角速度誤差に関する値(εΩ)を推定する誤差推定部(S212)と、
前記誤差推定部によって推定された前記角速度誤差に関する値(εΩ)に基づいて、前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)を較正する較正部(S214)と、
を備え、
前記第1受信部は、前記車両において前記参照用受信部よりも左後側に配置されており、
前記第2受信部は、前記車両において前記参照用受信部よりも右後側に配置されており、
前記角速度誤差に関する値(εΩ)は、前記車両の角速度が変化するときに前記慣性センサによって検出される前記車両の角速度の変化に関する値(εφφ、εψψ、εθθ、εψφ、εθφ、εφψ、εθψ、εφθ、εψθ)または前記車両が停止しているときの前記慣性センサによって検出される前記車両の角速度に関する値(εφ0、εψ0、εθ0)を含み、
前記誤差推定部は、現時点より前の前記角速度誤差に関する値(εΩ)に基づいて現時点の前記角速度誤差に関する値を予測した値を算出して、算出した前記角速度誤差に関する値を予測した値と、前記角速度推定部によって推定された前記車両の角速度に関する値(Ωe)と、前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)とに基づいて、現時点の前記角速度誤差に関する値(εΩ)を推定する慣性センサ較正装置。 - 測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の角速度(Ωc)を検出する慣性センサ(20)とを備える前記車両に用いられる慣性センサ較正装置であって、
前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて前記参照用受信部の位置に対する前記第1受信部の相対位置である第1相対位置(P1)を算出するとともに、前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて前記参照用受信部の位置に対する前記第2受信部である第2相対位置(P2)を算出する位置算出部(S206)と、
前記第1相対位置(P1)と、前記第2相対位置(P2)とに基づいて、前記車両の姿勢に関する値(q)と、前記車両の姿勢変化に関する値(Δq)とを推定する姿勢推定部(S208)と、
前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)と、前記姿勢推定部によって推定された前記車両の姿勢変化に関する値(Δq)とに基づいて前記車両の角速度に関する値(Ωe)を推定する角速度推定部(S210)と、
前記角速度推定部によって推定された前記車両の角速度に関する値(Ωe)と、前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)とに基づいて、前記角速度推定部によって推定された前記車両の角速度に関する値(Ωe)と前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)との誤差である角速度誤差に関する値(εΩ)を推定する誤差推定部(S212)と、
前記誤差推定部によって推定された前記角速度誤差に関する値(εΩ)に基づいて、前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)を較正する較正部(S214)と、
を備え、
前記第1受信部は、前記車両において前記参照用受信部よりも左後側に配置されており、
前記第2受信部は、前記車両において前記参照用受信部よりも右後側に配置されており、
前記慣性センサ較正装置は、前記参照用受信部、前記第1受信部または前記第2受信部の位置が予め設定された位置に対してズレているか否かを判定する位置判定部(S114、S116、S118)をさらに備え、
前記較正部は、前記位置判定部によって前記参照用受信部、前記第1受信部および前記第2受信部の位置が予め設定された位置に対してズレていないと判定されるとき、前記慣性センサの較正を行う、慣性センサ較正装置。 - 測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の加速度(Ac)を検出する慣性センサ(40)とを備える前記車両に用いられる慣性センサ較正装置であって、
前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて前記参照用受信部の位置に対する前記第1受信部の相対位置である第1相対位置(P1)を算出するとともに、前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて前記参照用受信部の位置に対する前記第2受信部である第2相対位置(P2)を算出する位置算出部(S206)と、
前記第1相対位置と、前記第2相対位置とに基づいて、前記車両の姿勢に関する値(q)を推定する姿勢推定部(S208)と、
前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)に基づいて、前記車両の加速度に関する値(Ae)を推定する加速度推定部(S216)と、
前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)とに基づいて、前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と前記慣性センサによって検出された前記車両の加速度に関する値(Ac)との誤差である加速度誤差に関する値(εA)を推定する誤差推定部(S218)と、
前記誤差推定部によって推定された前記加速度誤差に関する値(εA)に基づいて、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)を較正する較正部(S220)と、
を備え、
前記第1受信部は、前記車両において前記参照用受信部よりも左後側に配置されており、
前記第2受信部は、前記車両において前記参照用受信部よりも右後側に配置されており、
前記姿勢推定部は、現時点より前の前記車両の姿勢に関する値(q)に基づいて現時点の前記車両の姿勢に関する値を予測した値を算出して、算出した前記車両の姿勢に関する値を予測した値と、前記第1相対位置(P1)と、前記第2相対位置(P2)とに基づいて、前記車両の姿勢に関する値(q)を推定する慣性センサ較正装置。 - 測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の加速度(Ac)を検出する慣性センサ(40)とを備える前記車両に用いられる慣性センサ較正装置であって、
前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて前記参照用受信部の位置に対する前記第1受信部の相対位置である第1相対位置(P1)を算出するとともに、前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて前記参照用受信部の位置に対する前記第2受信部である第2相対位置(P2)を算出する位置算出部(S206)と、
前記第1相対位置と、前記第2相対位置とに基づいて、前記車両の姿勢に関する値(q)を推定する姿勢推定部(S208)と、
前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)に基づいて、前記車両の加速度に関する値(Ae)を推定する加速度推定部(S216)と、
前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)とに基づいて、前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と前記慣性センサによって検出された前記車両の加速度に関する値(Ac)との誤差である加速度誤差に関する値(εA)を推定する誤差推定部(S218)と、
前記誤差推定部によって推定された前記加速度誤差に関する値(εA)に基づいて、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)を較正する較正部(S220)と、
を備え、
前記第1受信部は、前記車両において前記参照用受信部よりも左後側に配置されており、
前記第2受信部は、前記車両において前記参照用受信部よりも右後側に配置されており、
前記加速度誤差に関する値(εA)は、前記車両の加速度が変化するときに前記慣性センサによって検出される前記車両の加速度の変化に関する値(εxx、εyy、εzz、εyx、εzx、εxy、εzy、εxz、εyz)または前記車両が停止しているときの前記慣性センサによって検出される前記車両の加速度に関する値(εx0、εy0、εz0)を含み、
前記誤差推定部は、現時点より前の前記加速度誤差に関する値(εA)に基づいて現時点の前記加速度誤差に関する値を予測した値を算出して、算出した前記加速度誤差に関する値を予測した値と、前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)とに基づいて、現時点の前記加速度誤差に関する値(εA)を推定する慣性センサ較正装置。 - 測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の加速度(Ac)を検出する慣性センサ(40)とを備える前記車両に用いられる慣性センサ較正装置であって、
前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて前記参照用受信部の位置に対する前記第1受信部の相対位置である第1相対位置(P1)を算出するとともに、前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて前記参照用受信部の位置に対する前記第2受信部である第2相対位置(P2)を算出する位置算出部(S206)と、
前記第1相対位置と、前記第2相対位置とに基づいて、前記車両の姿勢に関する値(q)を推定する姿勢推定部(S208)と、
前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)に基づいて、前記車両の加速度に関する値(Ae)を推定する加速度推定部(S216)と、
前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)とに基づいて、前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と前記慣性センサによって検出された前記車両の加速度に関する値(Ac)との誤差である加速度誤差に関する値(εA)を推定する誤差推定部(S218)と、
前記誤差推定部によって推定された前記加速度誤差に関する値(εA)に基づいて、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)を較正する較正部(S220)と、
を備え、
前記第1受信部は、前記車両において前記参照用受信部よりも左後側に配置されており、
前記第2受信部は、前記車両において前記参照用受信部よりも右後側に配置されており、
前記慣性センサ較正装置は、前記車両が停止しているか否かを判定する停止判定部(S300)をさらに備え、
前記較正部は、前記車両が停止しているとき、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)を較正し、
前記姿勢推定部は、現時点より前の前記車両の姿勢に関する値(q)と、現時点の前記車両の姿勢に関する値(q)とに基づいて現時点の前記車両の姿勢変化に関する値(Δq)を推定し、
前記慣性センサ較正装置は、前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)と、前記姿勢推定部によって推定された前記車両の姿勢変化に関する値(Δq)とに基づいて、前記車両の角速度に関する値(ωeφ、ωeψ、ωeθ)を推定する角速度推定部(S210)をさらに備え、
前記停止判定部は、前記角速度推定部によって推定された前記車両の角速度に関する値(ωeφ、ωeψ、ωeθ)が閾値未満であるとき、前記車両が停止していると判定し、前記角速度推定部によって推定された前記車両の角速度に関する値(ωeφ、ωeψ、ωeθ)が前記閾値以上であるとき、前記車両が停止していないと判定する慣性センサ較正装置。 - 測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の加速度(Ac)を検出する慣性センサ(40)とを備える前記車両に用いられる慣性センサ較正装置であって、
前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて前記参照用受信部の位置に対する前記第1受信部の相対位置である第1相対位置(P1)を算出するとともに、前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて前記参照用受信部の位置に対する前記第2受信部である第2相対位置(P2)を算出する位置算出部(S206)と、
前記第1相対位置と、前記第2相対位置とに基づいて、前記車両の姿勢に関する値(q)を推定する姿勢推定部(S208)と、
前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)に基づいて、前記車両の加速度に関する値(Ae)を推定する加速度推定部(S216)と、
前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)とに基づいて、前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と前記慣性センサによって検出された前記車両の加速度に関する値(Ac)との誤差である加速度誤差に関する値(εA)を推定する誤差推定部(S218)と、
前記誤差推定部によって推定された前記加速度誤差に関する値(εA)に基づいて、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)を較正する較正部(S220)と、
を備え、
前記第1受信部は、前記車両において前記参照用受信部よりも左後側に配置されており、
前記第2受信部は、前記車両において前記参照用受信部よりも右後側に配置されており、
前記慣性センサ較正装置は、前記参照用受信部、前記第1受信部または前記第2受信部の位置が予め設定された位置に対してズレているか否かを判定する位置判定部(S114、S116、S118)をさらに備え、
前記較正部は、前記位置判定部によって前記参照用受信部、前記第1受信部および前記第2受信部の位置が予め設定された位置に対してズレていないと判定されるとき、前記慣性センサの較正を行う、慣性センサ較正装置。 - 前記慣性センサ較正装置は、前記車両が停止しているか否かを判定する停止判定部(S300)をさらに備え、
前記較正部は、前記車両が停止しているとき、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)を較正する請求項4、5、7のいずれか1つに記載の慣性センサ較正装置。 - 前記姿勢推定部は、現時点より前の前記車両の姿勢に関する値(q)と、現時点の前記車両の姿勢に関する値(q)とに基づいて現時点の前記車両の姿勢変化に関する値(Δq)を推定し、
前記慣性センサ較正装置は、前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)と、前記姿勢推定部によって推定された前記車両の姿勢変化に関する値(Δq)とに基づいて、前記車両の角速度に関する値(ωeφ、ωeψ、ωeθ)を推定する角速度推定部(S210)をさらに備え、
前記停止判定部は、前記角速度推定部によって推定された前記車両の角速度に関する値(ωeφ、ωeψ、ωeθ)が閾値未満であるとき、前記車両が停止していると判定し、前記角速度推定部によって推定された前記車両の角速度に関する値(ωeφ、ωeψ、ωeθ)が前記閾値以上であるとき、前記車両が停止していないと判定する請求項8に記載の慣性センサ較正装置。 - 前記慣性センサ較正装置は、前記参照用受信部、前記第1受信部または前記第2受信部の位置が予め設定された位置に対してズレているか否かを判定する位置判定部(S114、S116、S118)をさらに備え、
前記較正部は、前記位置判定部によって前記参照用受信部、前記第1受信部および前記第2受信部の位置が予め設定された位置に対してズレていないと判定されるとき、前記慣性センサの較正を行う請求項1、2、4、5、6のいずれか1つに記載の慣性センサ較正装置。 - 前記慣性センサ較正装置は、
前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)に基づいて、前記車両のヨー角に関する値(θ)を推定する変換部(S106)と、
前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)により前記参照用受信部の速度(Vref)を算出し、前記第1受信部が測位衛星から受信した信号に基づくデータ(D1)により前記第1受信部の速度(V1)を算出し、前記第2受信部が測位衛星から受信した信号に基づくデータ(D2)により前記第2受信部の速度(V2)を算出する速度算出部(S110)と、
前記参照用受信部の速度(Vref)と、前記第1受信部の速度(V1)と、前記第2受信部の速度(V2)とに基づいて、前記車両のヨー角に関する値(θe)を推定するヨー角推定部(S112)と、
をさらに備え、
前記位置判定部は、前記変換部によって推定された前記車両のヨー角に関する値(θ)と、前記ヨー角推定部によって推定された前記車両のヨー角に関する値(θe)とに基づいて、前記参照用受信部、前記第1受信部または前記第2受信部の位置が予め設定された位置に対してズレているか否かを判定する請求項3、7、10のいずれか1つに記載の慣性センサ較正装置。 - 前記慣性センサ較正装置は、
前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)に基づいて、前記車両のヨー角に関する値(θ)を推定する変換部(S106)と、
前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)による前記参照用受信部の速度(Vref)、前記第1受信部が測位衛星から受信した信号に基づくデータ(D1)による前記第1受信部の速度(V1)および前記第2受信部が測位衛星から受信した信号に基づくデータ(D2)による前記第2受信部の速度(V2)のうちいずれかを算出する速度算出部(S110)と、
前記参照用受信部の速度(Vref)、前記第1受信部の速度(V1)および前記第2受信部の速度(V2)のうちいずれかに基づいて、前記車両のヨー角に関する値(θe)を推定するヨー角推定部(S112)と、
をさらに備え、
前記位置判定部は、前記変換部によって推定された前記車両のヨー角に関する値(θ)と、前記ヨー角推定部によって推定された前記車両のヨー角に関する値(θe)とに基づいて、前記参照用受信部、前記第1受信部または前記第2受信部の位置が予め設定された位置に対してズレているか否かを判定する請求項3、7、10のいずれか1つに記載の慣性センサ較正装置。 - 前記慣性センサ較正装置は、
前記車両の速さ(Vc)が前記車両の速さに関する閾値(Vc_th)以上であるか否かを判定する速度判定部(S108)をさらに備え、
前記位置判定部は、前記速度判定部によって前記車両の速さ(Vc)が前記車両の速さに関する閾値(Vc_th)以上であると判定されているとき、前記参照用受信部、前記第1受信部および前記第2受信部の位置が予め設定された位置に対してズレているか否かを判定する請求項3、7、10、11、12のいずれか1つに記載の慣性センサ較正装置。 - 測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の角速度(Ωc)を検出する慣性センサ(20)とを備える前記車両に用いられる慣性センサ較正装置を、
前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて前記参照用受信部の位置に対する前記第1受信部の相対位置である第1相対位置(P1)を算出するとともに、前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて前記参照用受信部の位置に対する前記第2受信部である第2相対位置(P2)を算出する位置算出部(S206)、
前記第1相対位置(P1)と、前記第2相対位置(P2)とに基づいて、前記車両の姿勢に関する値(q)と、前記車両の姿勢変化に関する値(Δq)とを推定する姿勢推定部(S208)、
前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)と、前記姿勢推定部によって推定された前記車両の姿勢変化に関する値(Δq)とに基づいて前記車両の角速度に関する値(Ωe)を推定する角速度推定部(S210)、
前記角速度推定部によって推定された前記車両の角速度に関する値(Ωe)と、前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)とに基づいて、前記角速度推定部によって推定された前記車両の角速度に関する値(Ωe)と前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)との誤差である角速度誤差に関する値(εΩ)を推定する誤差推定部(S212)、および、
前記誤差推定部によって推定された前記角速度誤差に関する値(εΩ)に基づいて、前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)を較正する較正部(S214)として、機能させ、
前記第1受信部は、前記車両において前記参照用受信部よりも左後側に配置されており、
前記第2受信部は、前記車両において前記参照用受信部よりも右後側に配置されており、
前記姿勢推定部は、現時点より前の前記車両の姿勢に関する値(q)に基づいて現時点の前記車両の姿勢に関する値を予測した値を算出して、算出した前記車両の姿勢に関する値を予測した値と、前記第1相対位置(P1)と、前記第2相対位置(P2)とに基づいて現時点の前記車両の姿勢に関する値(q)を推定するとともに、現時点より前の前記車両の姿勢に関する値(q)と、推定した現時点の前記車両の姿勢に関する値(q)とに基づいて現時点の前記車両の姿勢変化に関する値(Δq)を推定する慣性センサ較正プログラム。 - 測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の角速度(Ωc)を検出する慣性センサ(20)とを備える前記車両に用いられる慣性センサ較正装置を、
前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて前記参照用受信部の位置に対する前記第1受信部の相対位置である第1相対位置(P1)を算出するとともに、前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて前記参照用受信部の位置に対する前記第2受信部である第2相対位置(P2)を算出する位置算出部(S206)、
前記第1相対位置(P1)と、前記第2相対位置(P2)とに基づいて、前記車両の姿勢に関する値(q)と、前記車両の姿勢変化に関する値(Δq)とを推定する姿勢推定部(S208)、
前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)と、前記姿勢推定部によって推定された前記車両の姿勢変化に関する値(Δq)とに基づいて前記車両の角速度に関する値(Ωe)を推定する角速度推定部(S210)、
前記角速度推定部によって推定された前記車両の角速度に関する値(Ωe)と、前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)とに基づいて、前記角速度推定部によって推定された前記車両の角速度に関する値(Ωe)と前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)との誤差である角速度誤差に関する値(εΩ)を推定する誤差推定部(S212)、および、
前記誤差推定部によって推定された前記角速度誤差に関する値(εΩ)に基づいて、前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)を較正する較正部(S214)として、機能させ、
前記第1受信部は、前記車両において前記参照用受信部よりも左後側に配置されており、
前記第2受信部は、前記車両において前記参照用受信部よりも右後側に配置されており、
前記角速度誤差に関する値(εΩ)は、前記車両の角速度が変化するときに前記慣性センサによって検出される前記車両の角速度の変化に関する値(εφφ、εψψ、εθθ、εψφ、εθφ、εφψ、εθψ、εφθ、εψθ)または前記車両が停止しているときの前記慣性センサによって検出される前記車両の角速度に関する値(εφ0、εψ0、εθ0)を含み、
前記誤差推定部は、現時点より前の前記角速度誤差に関する値(εΩ)に基づいて現時点の前記角速度誤差に関する値を予測した値を算出して、算出した前記角速度誤差に関する値を予測した値と、前記角速度推定部によって推定された前記車両の角速度に関する値(Ωe)と、前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)とに基づいて、現時点の前記角速度誤差に関する値(εΩ)を推定する慣性センサ較正プログラム。 - 測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の角速度(Ωc)を検出する慣性センサ(20)とを備える前記車両に用いられる慣性センサ較正装置を、
前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて前記参照用受信部の位置に対する前記第1受信部の相対位置である第1相対位置(P1)を算出するとともに、前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて前記参照用受信部の位置に対する前記第2受信部である第2相対位置(P2)を算出する位置算出部(S206)、
前記第1相対位置(P1)と、前記第2相対位置(P2)とに基づいて、前記車両の姿勢に関する値(q)と、前記車両の姿勢変化に関する値(Δq)とを推定する姿勢推定部(S208)、
前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)と、前記姿勢推定部によって推定された前記車両の姿勢変化に関する値(Δq)とに基づいて前記車両の角速度に関する値(Ωe)を推定する角速度推定部(S210)、
前記角速度推定部によって推定された前記車両の角速度に関する値(Ωe)と、前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)とに基づいて、前記角速度推定部によって推定された前記車両の角速度に関する値(Ωe)と前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)との誤差である角速度誤差に関する値(εΩ)を推定する誤差推定部(S212)、および、
前記誤差推定部によって推定された前記角速度誤差に関する値(εΩ)に基づいて、前記慣性センサによって検出された前記車両の角速度に関する値(Ωc)を較正する較正部(S214)として、機能させ、
前記第1受信部は、前記車両において前記参照用受信部よりも左後側に配置されており、
前記第2受信部は、前記車両において前記参照用受信部よりも右後側に配置されており、
前記慣性センサ較正装置を、前記参照用受信部、前記第1受信部または前記第2受信部の位置が予め設定された位置に対してズレているか否かを判定する位置判定部(S114、S116、S118)として機能させ、
前記較正部は、前記位置判定部によって前記参照用受信部、前記第1受信部および前記第2受信部の位置が予め設定された位置に対してズレていないと判定されるとき、前記慣性センサの較正を行う、慣性センサ較正プログラム。 - 測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の加速度(Ac)を検出する慣性センサ(40)とを備える前記車両に用いられる慣性センサ較正装置を、
前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて前記参照用受信部の位置に対する前記第1受信部の相対位置である第1相対位置(P1)を算出するとともに、前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて前記参照用受信部の位置に対する前記第2受信部である第2相対位置(P2)とを算出する位置算出部(S206)、
前記第1相対位置と、前記第2相対位置とに基づいて、前記車両の姿勢に関する値(q)を推定する姿勢推定部(S208)、
前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)に基づいて、前記車両の加速度に関する値(Ae)を推定する加速度推定部(S216)、
前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)とに基づいて、前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と前記慣性センサによって検出された前記車両の加速度に関する値(Ac)との誤差である加速度誤差に関する値(εA)を推定する誤差推定部(S218)、および、
前記誤差推定部によって推定された前記加速度誤差に関する値(εA)に基づいて、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)を較正する較正部(S220)として、機能させ、
前記第1受信部は、前記車両において前記参照用受信部よりも左後側に配置されており、
前記第2受信部は、前記車両において前記参照用受信部よりも右後側に配置されており、
前記姿勢推定部は、現時点より前の前記車両の姿勢に関する値(q)に基づいて現時点の前記車両の姿勢に関する値を予測した値を算出して、算出した前記車両の姿勢に関する値を予測した値と、前記第1相対位置(P1)と、前記第2相対位置(P2)とに基づいて、前記車両の姿勢に関する値(q)を推定する慣性センサ較正プログラム。 - 測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の加速度(Ac)を検出する慣性センサ(40)とを備える前記車両に用いられる慣性センサ較正装置を、
前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて前記参照用受信部の位置に対する前記第1受信部の相対位置である第1相対位置(P1)を算出するとともに、前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて前記参照用受信部の位置に対する前記第2受信部である第2相対位置(P2)とを算出する位置算出部(S206)、
前記第1相対位置と、前記第2相対位置とに基づいて、前記車両の姿勢に関する値(q)を推定する姿勢推定部(S208)、
前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)に基づいて、前記車両の加速度に関する値(Ae)を推定する加速度推定部(S216)、
前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)とに基づいて、前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と前記慣性センサによって検出された前記車両の加速度に関する値(Ac)との誤差である加速度誤差に関する値(εA)を推定する誤差推定部(S218)、および、
前記誤差推定部によって推定された前記加速度誤差に関する値(εA)に基づいて、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)を較正する較正部(S220)として、機能させ、
前記第1受信部は、前記車両において前記参照用受信部よりも左後側に配置されており、
前記第2受信部は、前記車両において前記参照用受信部よりも右後側に配置されており、
前記加速度誤差に関する値(εA)は、前記車両の加速度が変化するときに前記慣性センサによって検出される前記車両の加速度の変化に関する値(εxx、εyy、εzz、εyx、εzx、εxy、εzy、εxz、εyz)または前記車両が停止しているときの前記慣性センサによって検出される前記車両の加速度に関する値(εx0、εy0、εz0)を含み、
前記誤差推定部は、現時点より前の前記加速度誤差に関する値(εA)に基づいて現時点の前記加速度誤差に関する値を予測した値を算出して、算出した前記加速度誤差に関する値を予測した値と、前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)とに基づいて、現時点の前記加速度誤差に関する値(εA)を推定する慣性センサ較正プログラム。 - 測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の加速度(Ac)を検出する慣性センサ(40)とを備える前記車両に用いられる慣性センサ較正装置を、
前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて前記参照用受信部の位置に対する前記第1受信部の相対位置である第1相対位置(P1)を算出するとともに、前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて前記参照用受信部の位置に対する前記第2受信部である第2相対位置(P2)とを算出する位置算出部(S206)、
前記第1相対位置と、前記第2相対位置とに基づいて、前記車両の姿勢に関する値(q)を推定する姿勢推定部(S208)、
前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)に基づいて、前記車両の加速度に関する値(Ae)を推定する加速度推定部(S216)、
前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)とに基づいて、前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と前記慣性センサによって検出された前記車両の加速度に関する値(Ac)との誤差である加速度誤差に関する値(εA)を推定する誤差推定部(S218)、および、
前記誤差推定部によって推定された前記加速度誤差に関する値(εA)に基づいて、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)を較正する較正部(S220)として、機能させ、
前記第1受信部は、前記車両において前記参照用受信部よりも左後側に配置されており、
前記第2受信部は、前記車両において前記参照用受信部よりも右後側に配置されており、
前記慣性センサ較正装置を、前記車両が停止しているか否かを判定する停止判定部(S300)として機能させ、
前記較正部は、前記車両が停止しているとき、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)を較正し、
前記姿勢推定部は、現時点より前の前記車両の姿勢に関する値(q)と、現時点の前記車両の姿勢に関する値(q)とに基づいて現時点の前記車両の姿勢変化に関する値(Δq)を推定し、
前記慣性センサ較正装置を、前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)と、前記姿勢推定部によって推定された前記車両の姿勢変化に関する値(Δq)とに基づいて、前記車両の角速度に関する値(ωeφ、ωeψ、ωeθ)を推定する角速度推定部(S210)として機能させ、
前記停止判定部は、前記角速度推定部によって推定された前記車両の角速度に関する値(ωeφ、ωeψ、ωeθ)が閾値未満であるとき、前記車両が停止していると判定し、前記角速度推定部によって推定された前記車両の角速度に関する値(ωeφ、ωeψ、ωeθ)が前記閾値以上であるとき、前記車両が停止していないと判定する慣性センサ較正プログラム。 - 測位衛星からの信号を受信する少なくとも1つの参照用受信部(10)と、測位衛星からの信号を受信する少なくとも1つの第1受信部(11)と、測位衛星からの信号を受信する少なくとも1つの第2受信部(12)と、車両(1)の加速度(Ac)を検出する慣性センサ(40)とを備える前記車両に用いられる慣性センサ較正装置を、
前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第1受信部が測位衛星から受信した信号に基づくデータ(D1)とに基づいて前記参照用受信部の位置に対する前記第1受信部の相対位置である第1相対位置(P1)を算出するとともに、前記参照用受信部が測位衛星から受信した信号に基づくデータ(Dref)と前記第2受信部が測位衛星から受信した信号に基づくデータ(D2)とに基づいて前記参照用受信部の位置に対する前記第2受信部である第2相対位置(P2)とを算出する位置算出部(S206)、
前記第1相対位置と、前記第2相対位置とに基づいて、前記車両の姿勢に関する値(q)を推定する姿勢推定部(S208)、
前記姿勢推定部によって推定された前記車両の姿勢に関する値(q)に基づいて、前記車両の加速度に関する値(Ae)を推定する加速度推定部(S216)、
前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)とに基づいて、前記加速度推定部によって推定された前記車両の加速度に関する値(Ae)と前記慣性センサによって検出された前記車両の加速度に関する値(Ac)との誤差である加速度誤差に関する値(εA)を推定する誤差推定部(S218)、および、
前記誤差推定部によって推定された前記加速度誤差に関する値(εA)に基づいて、前記慣性センサによって検出された前記車両の加速度に関する値(Ac)を較正する較正部(S220)として、機能させ、
前記第1受信部は、前記車両において前記参照用受信部よりも左後側に配置されており、
前記第2受信部は、前記車両において前記参照用受信部よりも右後側に配置されており、
前記慣性センサ較正装置を、前記参照用受信部、前記第1受信部または前記第2受信部の位置が予め設定された位置に対してズレているか否かを判定する位置判定部(S114、S116、S118)として機能させ、
前記較正部は、前記位置判定部によって前記参照用受信部、前記第1受信部および前記第2受信部の位置が予め設定された位置に対してズレていないと判定されるとき、前記慣性センサの較正を行う、慣性センサ較正プログラム。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020148868A JP7420023B2 (ja) | 2020-09-04 | 2020-09-04 | 慣性センサ較正装置および慣性センサ較正プログラム |
US17/465,211 US20220074967A1 (en) | 2020-09-04 | 2021-09-02 | Apparatus and method for calibrating inertial sensor |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2020148868A JP7420023B2 (ja) | 2020-09-04 | 2020-09-04 | 慣性センサ較正装置および慣性センサ較正プログラム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2022043546A JP2022043546A (ja) | 2022-03-16 |
JP7420023B2 true JP7420023B2 (ja) | 2024-01-23 |
Family
ID=80469674
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2020148868A Active JP7420023B2 (ja) | 2020-09-04 | 2020-09-04 | 慣性センサ較正装置および慣性センサ較正プログラム |
Country Status (2)
Country | Link |
---|---|
US (1) | US20220074967A1 (ja) |
JP (1) | JP7420023B2 (ja) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007163335A (ja) | 2005-12-15 | 2007-06-28 | Mitsubishi Electric Corp | 姿勢標定装置、姿勢標定方法および姿勢標定プログラム |
JP2008116370A (ja) | 2006-11-06 | 2008-05-22 | Toyota Motor Corp | 移動体位置測位装置 |
JP2011122921A (ja) | 2009-12-10 | 2011-06-23 | Mitsubishi Electric Corp | 位置標定装置、位置標定方法、位置標定プログラム、速度ベクトル算出装置、速度ベクトル算出方法および速度ベクトル算出プログラム |
JP2014228495A (ja) | 2013-05-24 | 2014-12-08 | 株式会社Ihi | 自己位置推定装置及び方法 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5898390A (en) * | 1995-09-14 | 1999-04-27 | Zexel Corporation | Method and apparatus for calibration of a distance sensor in a vehicle navigation system |
JPH09154308A (ja) * | 1995-12-12 | 1997-06-17 | Kubota Corp | 作業機械の姿勢制御装置 |
US6308134B1 (en) * | 1996-12-27 | 2001-10-23 | Magellan Dis, Inc. | Vehicle navigation system and method using multiple axes accelerometer |
GB2363000B (en) * | 2000-05-31 | 2004-02-25 | Nokia Mobile Phones Ltd | Antenna system |
US8265826B2 (en) * | 2003-03-20 | 2012-09-11 | Hemisphere GPS, LLC | Combined GNSS gyroscope control system and method |
US8583315B2 (en) * | 2004-03-19 | 2013-11-12 | Agjunction Llc | Multi-antenna GNSS control system and method |
JP5405417B2 (ja) * | 2010-08-24 | 2014-02-05 | 株式会社小野測器 | 姿勢角安定化装置及び方法 |
JP2020020631A (ja) * | 2018-07-31 | 2020-02-06 | セイコーエプソン株式会社 | 姿勢推定方法、姿勢推定装置及び移動体 |
-
2020
- 2020-09-04 JP JP2020148868A patent/JP7420023B2/ja active Active
-
2021
- 2021-09-02 US US17/465,211 patent/US20220074967A1/en active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007163335A (ja) | 2005-12-15 | 2007-06-28 | Mitsubishi Electric Corp | 姿勢標定装置、姿勢標定方法および姿勢標定プログラム |
JP2008116370A (ja) | 2006-11-06 | 2008-05-22 | Toyota Motor Corp | 移動体位置測位装置 |
JP2011122921A (ja) | 2009-12-10 | 2011-06-23 | Mitsubishi Electric Corp | 位置標定装置、位置標定方法、位置標定プログラム、速度ベクトル算出装置、速度ベクトル算出方法および速度ベクトル算出プログラム |
JP2014228495A (ja) | 2013-05-24 | 2014-12-08 | 株式会社Ihi | 自己位置推定装置及び方法 |
Also Published As
Publication number | Publication date |
---|---|
US20220074967A1 (en) | 2022-03-10 |
JP2022043546A (ja) | 2022-03-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106560725B (zh) | 用于确定目标车辆的偏航速率的自动化车辆雷达系统 | |
CA3003298C (en) | Gnss and inertial navigation system utilizing relative yaw as an observable for an ins filter | |
EP1760431B1 (en) | Inertial navigation system with a plurality of Kalman filters and vehicle equipped with such a system | |
US9714841B2 (en) | Satellite navigation/dead-reckoning navigation integrated positioning device | |
US10901095B2 (en) | Position and attitude estimation device, image processing device, and position and attitude estimation method | |
US8560234B2 (en) | System and method of navigation based on state estimation using a stepped filter | |
JP5662642B2 (ja) | 水中ナビゲーションの方法およびシステム | |
JP5301762B2 (ja) | キャリア位相相対測位装置 | |
CN110554376A (zh) | 用于运载工具的雷达测程法 | |
EP2717014B1 (en) | Position calculation method and position calculation device | |
JP5602070B2 (ja) | 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム | |
US9423486B2 (en) | Position calculating method and position calculating device | |
JP2011122921A (ja) | 位置標定装置、位置標定方法、位置標定プログラム、速度ベクトル算出装置、速度ベクトル算出方法および速度ベクトル算出プログラム | |
US20140365117A1 (en) | Position output device using satellite navigation system | |
WO2016203744A1 (ja) | 測位装置 | |
JP2013181985A (ja) | 転送アライメントの間、マスターナビゲーション・システム・リセットを組み込むシステム及び方法 | |
EP3770554A1 (en) | Apparatus and method for terrain aided navigation using inertial position | |
US20140104101A1 (en) | Position calculating method and position calculating device | |
JP5022747B2 (ja) | 移動体の姿勢及び方位検出装置 | |
WO2017141469A1 (ja) | 位置推定装置 | |
JP7420023B2 (ja) | 慣性センサ較正装置および慣性センサ較正プログラム | |
JP7409037B2 (ja) | 推定装置、推定方法、推定プログラム | |
TWI422825B (zh) | 高精度速度估測方法及其裝置 | |
JPWO2018066291A1 (ja) | 方位算出装置、方位算出方法、および方位算出プログラム | |
JP2013195325A (ja) | 移動体の測位方法、および移動体の測位装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20221107 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20230823 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20230829 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20231018 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20231212 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20231225 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 7420023 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |