JP7761035B2 - 拘束運動を用いた絶対的ヘディング推定 - Google Patents
拘束運動を用いた絶対的ヘディング推定Info
- Publication number
- JP7761035B2 JP7761035B2 JP2023501374A JP2023501374A JP7761035B2 JP 7761035 B2 JP7761035 B2 JP 7761035B2 JP 2023501374 A JP2023501374 A JP 2023501374A JP 2023501374 A JP2023501374 A JP 2023501374A JP 7761035 B2 JP7761035 B2 JP 7761035B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- gyroscope
- pivot
- orientation
- earth
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
- E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
- E02F9/264—Sensors and their calibration for indicating the position of the work tool
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
- G01C19/02—Rotary gyroscopes
- G01C19/34—Rotary gyroscopes for indicating a direction in the horizontal plane, e.g. directional gyroscopes
- G01C19/38—Rotary gyroscopes for indicating a direction in the horizontal plane, e.g. directional gyroscopes with north-seeking action by other than magnetic means, e.g. gyrocompasses using earth's rotation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/183—Compensation of inertial measurements, e.g. for temperature effects
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Structural Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Civil Engineering (AREA)
- Mining & Mineral Resources (AREA)
- Mechanical Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental & Geological Engineering (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Gyroscopes (AREA)
- Navigation (AREA)
- Ultra Sonic Daignosis Equipment (AREA)
Description
2 車輪
3 連続トラック
4,7,9 旋回軸
5 マニピュレータアーム
6 第1アームセクション
8 ショベル
101a,101b,101c ジャイロスコープ
102a シャーシ
102b 本体
102c 第1アームセクション
103a,103b,103c 加速度計
401 移動距離
402 ショベル位置
403 真北と物体の主軸との間の角度
404 物体の主軸
ωcarousel 角速度
N 真北
Claims (6)
- 車両(102a,102b,102c)の偏角、方位、及び位置の少なくとも1つを測定する方法であって、
前記車両(102a,102b,102c)がマニピュレータアーム(5)を備え、前記マニピュレータアーム(5)の第1アーム部分(6)は前記マニピュレータアーム(5)の第2アーム部分に対して、あるいは前記車両(102a,102b,102c)のフレームまたは本体に対して旋回軸(4,7,9)を中心に枢動可能であり、
前記第1アーム部分(6)に機械的に取り付けられたジャイロスコープ(101a,101b,101c)を、前記旋回軸(4,7,9)を中心に枢動角速度(ωcarousel)で枢動させるステップと、
前記ジャイロスコープ(101a,101b,101c)に作用する地球の回転の成分を、前記枢動角速度(ωcarousel)を用いて測定するステップと、
前記車両(102a,102b,102c)の、真北に対する偏角を、前記ジャイロスコープ(101a,101b,101c)に作用する地球の回転の成分から測定するステップ、又は、
前記車両(102a,102b,102c)の前記方位及び位置を、前記車両(102a,102b,102c)の初期方位及び初期位置から出発して、前記枢動角速度(ωcarousel)、及び前記車両(102a,102b,102c)が移動した距離を用いて測定し、且つ、地球の回転の前記測定された成分の、前記車両(102a,102b,102c)の前記方位及び位置における影響を補償するステップと、
前記ジャイロスコープ(101a,101b,101c)の、前記旋回軸(4,7,9)を中心とした前記枢動角速度(ωcarousel)を、前記ジャイロスコープ(101a,101b,101c)とは異なる第2センサ(103a,103b,103c)を用いて測定するステップを含むことを特徴とする、方法。 - 前記車両が車輪付き車両又は無限軌道車両であり、前記第1アーム部分(6)が車輪であり、当該車輪が既知の車輪半径を含み、且つ、前記第2アーム部分が、前記車輪付き車両のフレーム又は本体である、請求項1に記載の方法。
- 前記第2センサが加速度センサであり、当該加速度センサが、前記旋回軸からの既知の距離だけ離れた位置に配置されている、請求項1または2に記載の方法。
- 前記枢動が360度以上の回転である、請求項1乃至3のいずれかに記載の方法。
- 前記ジャイロスコープがマイクロエレクトロメカニカルシステムである、請求項1乃至4のいずれかに記載の方法。
- 前記ジャイロスコープ及び前記加速度センサが、6自由度の計測システムを形成する、請求項3に記載の方法。
Applications Claiming Priority (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| DE102020118321 | 2020-07-10 | ||
| DE102020118321.6 | 2020-07-10 | ||
| PCT/EP2021/068286 WO2022008361A2 (en) | 2020-07-10 | 2021-07-02 | Absolute heading estimation with constrained motion |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2023533065A JP2023533065A (ja) | 2023-08-01 |
| JP7761035B2 true JP7761035B2 (ja) | 2025-10-28 |
Family
ID=76859612
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2023501374A Active JP7761035B2 (ja) | 2020-07-10 | 2021-07-02 | 拘束運動を用いた絶対的ヘディング推定 |
Country Status (5)
| Country | Link |
|---|---|
| US (1) | US12235109B2 (ja) |
| EP (1) | EP4179274B8 (ja) |
| JP (1) | JP7761035B2 (ja) |
| AU (1) | AU2021304421A1 (ja) |
| WO (1) | WO2022008361A2 (ja) |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP4296434B1 (en) | 2022-06-22 | 2026-05-06 | Leica Geosystems Technology A/S | Improved determination of an excavator swing boom angle based on intermittent first interim swing boom angles |
| EP4431873A1 (en) * | 2023-03-13 | 2024-09-18 | Leica Geosystems Technology A/S | Sensor chain fusion algorithm |
| JP2025034999A (ja) * | 2023-08-31 | 2025-03-13 | 株式会社小松製作所 | 作業車両の移動量推定モデルの生成方法および作業車両の移動量推定モデルの生成装置 |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2001141507A (ja) | 1999-11-11 | 2001-05-25 | Yokogawa Denshikiki Co Ltd | 慣性航法装置 |
| JP2007155584A (ja) | 2005-12-07 | 2007-06-21 | Japan Agengy For Marine-Earth Science & Technology | 慣性航法システム |
| US20130238280A1 (en) | 2010-11-11 | 2013-09-12 | Israel Aerospace Industries Ltd. | System and method for north finding |
| JP2020105802A (ja) | 2018-12-27 | 2020-07-09 | 日立建機株式会社 | 作業機械 |
Family Cites Families (14)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US3127774A (en) | 1961-11-08 | 1964-04-07 | North American Aviation Inc | Means and method for determining the direction of the axis of rotation of a controllably rotating platform |
| US4166406A (en) | 1977-09-06 | 1979-09-04 | Litton Systems, Inc. | Self-aligning pitch and azimuth reference unit |
| US4321678A (en) | 1977-09-14 | 1982-03-23 | Bodenseewerk Geratetechnik Gmbh | Apparatus for the automatic determination of a vehicle position |
| DE3229819C2 (de) * | 1982-08-11 | 1985-02-14 | Bodenseewerk Gerätetechnik GmbH, 7770 Überlingen | Integriertes Navigations- und Feuerleitsystem für Kampfpanzer |
| FR2961305B1 (fr) | 2010-06-14 | 2012-06-22 | Eurocopter France | Dispositif de mesure inertielle ameliore et aeronef comportant un tel dispositif |
| EP2578992B1 (de) * | 2011-10-06 | 2017-01-25 | Vectronix AG | Geographisch nordreferenzierte Azimutbestimmung |
| FI124697B (en) | 2012-04-04 | 2014-12-15 | Jc Inertial Oy | Vehicle location |
| AU2017232241B1 (en) * | 2017-03-31 | 2018-09-20 | Commonwealth Scientific And Industrial Research Organisation | Low Cost INS |
| US20180345533A1 (en) * | 2017-05-31 | 2018-12-06 | Cazza Inc. | Mobile three-dimensional printer with layer smoothing |
| US10586349B2 (en) * | 2017-08-24 | 2020-03-10 | Trimble Inc. | Excavator bucket positioning via mobile device |
| DE102018200060B4 (de) * | 2018-01-04 | 2024-05-08 | Robert Bosch Gmbh | Verfahren zum Betreiben einer mobilen Arbeitsmaschine und mobile Arbeitsmaschine |
| KR102659077B1 (ko) | 2018-03-27 | 2024-04-18 | 스미도모쥬기가이고교 가부시키가이샤 | 쇼벨 |
| EP3862491B1 (en) * | 2018-10-03 | 2024-04-10 | Sumitomo Heavy Industries, Ltd. | Excavator |
| US20210340724A1 (en) * | 2020-05-01 | 2021-11-04 | Deere & Company | Work vehicle magnetorheological fluid joystick systems providing machine state feedback |
-
2021
- 2021-07-02 EP EP21740005.0A patent/EP4179274B8/en active Active
- 2021-07-02 JP JP2023501374A patent/JP7761035B2/ja active Active
- 2021-07-02 WO PCT/EP2021/068286 patent/WO2022008361A2/en not_active Ceased
- 2021-07-02 US US18/004,859 patent/US12235109B2/en active Active
- 2021-07-02 AU AU2021304421A patent/AU2021304421A1/en active Pending
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2001141507A (ja) | 1999-11-11 | 2001-05-25 | Yokogawa Denshikiki Co Ltd | 慣性航法装置 |
| JP2007155584A (ja) | 2005-12-07 | 2007-06-21 | Japan Agengy For Marine-Earth Science & Technology | 慣性航法システム |
| US20130238280A1 (en) | 2010-11-11 | 2013-09-12 | Israel Aerospace Industries Ltd. | System and method for north finding |
| JP2020105802A (ja) | 2018-12-27 | 2020-07-09 | 日立建機株式会社 | 作業機械 |
Also Published As
| Publication number | Publication date |
|---|---|
| CA3189127A1 (en) | 2022-01-13 |
| JP2023533065A (ja) | 2023-08-01 |
| EP4179274A2 (en) | 2023-05-17 |
| EP4179274C0 (en) | 2025-06-25 |
| US20230349699A1 (en) | 2023-11-02 |
| WO2022008361A3 (en) | 2022-03-10 |
| WO2022008361A2 (en) | 2022-01-13 |
| US12235109B2 (en) | 2025-02-25 |
| AU2021304421A1 (en) | 2023-03-09 |
| EP4179274B8 (en) | 2025-08-13 |
| EP4179274B1 (en) | 2025-06-25 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN101413800B (zh) | 导航/稳瞄一体化系统的导航、稳瞄方法 | |
| US9921065B2 (en) | Unit and method for improving positioning accuracy | |
| EP2901104B1 (en) | Improved inertial navigation system and method | |
| JP7761035B2 (ja) | 拘束運動を用いた絶対的ヘディング推定 | |
| CN110954102B (zh) | 用于机器人定位的磁力计辅助惯性导航系统及方法 | |
| CN113063429B (zh) | 一种自适应车载组合导航定位方法 | |
| EP2583059B1 (en) | Improved north finder | |
| CN105823481A (zh) | 一种基于单天线的gnss-ins车辆定姿方法 | |
| US7957898B2 (en) | Computational scheme for MEMS inertial navigation system | |
| JP3767372B2 (ja) | 衛星追尾用アンテナ制御装置 | |
| AU2017232241B1 (en) | Low Cost INS | |
| CN112880669A (zh) | 一种航天器星光折射和单轴旋转调制惯性组合导航方法 | |
| Yang et al. | A SINS/CNS integrated navigation scheme with improved mathematical horizon reference | |
| Zhang et al. | The standing calibration method of MEMS gyro bias for autonomous pedestrian navigation system | |
| Guan et al. | An innovative high accuracy autonomous navigation method for the Mars rovers | |
| CA3189127C (en) | Absolute heading estimation with constrained motion | |
| CN109596139B (zh) | 基于mems的车载导航方法 | |
| IL278733B1 (en) | Method for harmonising two inertial measurement units with one another and navigation system implementing this method | |
| CN111141283A (zh) | 一种通过地磁数据判断行进方向的方法 | |
| CN113503882B (zh) | 一种车载惯性/地磁组合导航方法及装置 | |
| CN121067844B (zh) | 适用多种运动模型车辆的通用导航方法、介质及设备 | |
| Oei et al. | Attitude estimation for ground vehicles using low-cost sensors with in-vehicle calibration | |
| CN114234972B (zh) | 用于惯性导航系统的惯性导航方法 | |
| Kang et al. | Analysis of factors affecting performance of integrated INS/SPR positioning during GPS signal Blockage | |
| Hakaya et al. | Integrated Land Vehicle Navigation System Using Kalman Filtering |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20240215 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20250122 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20250212 |
|
| A601 | Written request for extension of time |
Free format text: JAPANESE INTERMEDIATE CODE: A601 Effective date: 20250501 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20250611 |
|
| 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: 20250916 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20250929 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7761035 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |