JP6987711B2 - 作業機 - Google Patents
作業機 Download PDFInfo
- Publication number
- JP6987711B2 JP6987711B2 JP2018133668A JP2018133668A JP6987711B2 JP 6987711 B2 JP6987711 B2 JP 6987711B2 JP 2018133668 A JP2018133668 A JP 2018133668A JP 2018133668 A JP2018133668 A JP 2018133668A JP 6987711 B2 JP6987711 B2 JP 6987711B2
- Authority
- JP
- Japan
- Prior art keywords
- positioning device
- positioning
- calculation unit
- vehicle body
- position calculation
- 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
Images
Classifications
-
- 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
- G01S19/41—Differential correction, e.g. DGPS [differential GPS]
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01B—SOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
- A01B69/00—Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
-
- 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/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Life Sciences & Earth Sciences (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Mechanical Engineering (AREA)
- Soil Sciences (AREA)
- Environmental Sciences (AREA)
- Guiding Agricultural Machines (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Description
そこで、本発明は上記問題点に鑑み、走行車体に対して精度のよい測位を行うことができる作業機を提供することを目的とする。
作業機は、走行車体と、GNSS衛星から送信された第1衛星信号を受信する第1アンテナと、前記第1アンテナで受信した前記第1衛星信号に基づいて測位を行う第1位置演算部とを有する第1測位装置と、少なくともQZSS衛星から送信された第2衛星信号を受信する第2アンテナと、前記第2アンテナで受信した前記第2衛星信号に基づいて補正情報を生成する信号処理部と、前記補正情報を前記第1測位装置に送信する補正情報出力部と、前記第2アンテナで受信した補正情報に基づいて第2位置を演算する第2位置演算部とを備えた第2測位装置と、を備え、前記第1測位装置及び前記第2測位装置は、前記走行車体に設けられ、且つ、前記走行車体の進行方向と同一の方向に並んで取付けられており、前記第1位置演算部は、前記補正情報出力部から送信された前記補正情報及び前記第1衛星信号に基づいて前記第1測位装置の3次元座標を演算し、前記第1測位装置は、前記第1位置演算部が演算した前記第1測位装置の3次元座標を含む第1測位情報を前記第2測位装置に送信し、前記第2位置演算部は、前記第1衛星信号又は前記第2衛星信号と前記補正情報とに基づいて前記第2測位装置の3次元座標を演算し、前記第2測位装置は、前記第1位置演算部が演算した前記第1測位装置の3次元座標と前記第2位置演算部が演算した前記第2測位装置の3次元座標とによる3次元の基線ベクトルを用いて、前記走行車体の方位角及びピッチ角を求める状態演算部を備えている。
前記第2測位装置を前記走行車体に対して着脱自在に支持する支持ブラケットを備えている。
作業機は、前記走行車体に設けられた原動機と、前記走行車体に装着され且つ前記原動機の動力によって作動する作業装置と、前記走行車体の操舵を行う操舵装置と、を備えている。
作業機は、トラクタ、コンバイン、田植機等の農業機械、バックホー、ローダ等の建設機械である。トラクタ1を例にあげて作業機について説明する。
図7に示すように、トラクタ1は、走行装置7を有する走行車両(走行車体)3と、原動機4と、変速装置5とを備えている。走行装置7は、前輪7F及び後輪7Rを有する装置である。前輪7Fは、タイヤ型であってもクローラ型であってもよい。また、後輪7も、タイヤ型であってもクローラ型であってもよい。原動機4は、ディーゼルエンジン、電動モータ等である。変速装置5は、変速によって走行装置7の推進力を切換可能であると共に、走行装置7の前進、後進の切換が可能である。走行車両3にはキャビン9が設けられ、当該キャビン9内には運転席10が設けられている。
シャトル部5dは、シャトル軸12と、前後進切換部13とを有している。シャトル軸12には、副変速部5cから出力された動力がギア等を介して伝達される。前後切換部13は、例えば、油圧クラッチ等で構成され、油圧クラッチの入切によってシャトル軸12の回転方向、即ち、トラクタ1の前進及び後進を切り換える。シャトル軸12は、後輪デフ装置に接続されている。後輪デフ装置は、後輪7Rが取り付けられた後車軸を回転自在に支持している。
図3に示すように、第1測位装置31及び第2測位装置32は、それぞれトラクタ1のキャビン9に設けられている。第1測位装置31は、キャビン9のルーフ9aの幅方向の中央部に配置され、第2測位装置32も、キャビン9のルーフ9aの幅方向の中央部に配置されている。即ち、第1測位装置31と第2測位装置32とを見た場合、第1測位装置31及び第2測位装置32は、ルーフ9aの幅方向には同一位置に配置されていて、走行車体3の進行方向(幅方向と直交する方向、前後方向)には並んで配置されている。
第1測位装置31は、筐体31a及び第1アンテナ31bの他に、信号処理部31cと、第1位置演算部31dと、第1取得部31eと、第1出力部31fとを有している。信号処理部31c、第1位置演算部31d、第1取得部31e及び第1出力部31fは、第1測位装置31に設けられた電子・電子部品等で構成されている。
第1位置演算部31dは、信号処理部31cから出力された観測データ(復調されたL1信号、L2信号)に基づいて、位置(第1位置)の演算を行う。即ち、第1位置演算部31dは、GNSS衛星101の観測データ(第1観測データ)に基づいて単独測位を行う。第1取得部31eは、第2測位装置32から送信された情報を取得し、取得した情報を第1位置演算部31dに出力する。第1出力部31fは、第1位置演算部31dが演算した結果(第1測位結果)を第2測位装置32に出力する。
信号処理部32cは、第2アンテナ32bが受信した衛星信号の処理を行う部分であって、例えば、第2アンテナ32bが受信したL1信号、L2信号及びL6信号の増幅及び復調を行うことで、観測データを生成する。なお、第2アンテナ32bが受信したL1信号、L2信号は、GNSS衛星101の第1衛星信号であっても、QZSS測位衛星102の第2衛星信号であってもよい。
第1測位装置31は、第2出力部(補正情報出力部)32fから出力された補正情報を第1取得部31eが取得すると、取得した補正情報(衛星時計誤差情報、衛星信号バイアス誤差情報、衛星軌道誤差情報、対流圏伝播誤差情報、電離層伝播誤差情報を含む)と、第1アンテナ31bが受信したL1信号及びL2信号(航法メッセージ、C/Aコード、L1搬送波等)の第1観測情報とを用いて、第1測位装置31の物理的な位置(緯度、経度、高さ)、即ち、3次元座標(x1、y1、z1)を求める。第1出力部31fは、補正情報を用いて位置を求めると、求めた位置を含む第1測位結果を第2測位装置32に出力する。
さて、図1に示すように、第2測位装置32は、状態演算部32gを有している。状態演算部32gは、第2測位装置32に設けられた電子・電子部品等で構成されている。
なお、状態演算部32gは、走行車体3のロール角θ3を求めてもよい。ロール角θ3を求める場合、トラクタ1に対する第1測位装置31及び第2測位装置32の取付けが上述した実施形態と異なる。まず、第1測位装置31及び第2測位装置32の取付けについて説明する。
第2測位装置32は、第1測位情報と、当該第2測位装置32で求めた第2測位情報とに基づいて走行車体3の方位及び姿勢のいずれかを求める状態演算部32gを有している。これによれば、状態演算部32gによって、走行車体3の方位又は、ロール角、ピッチ角等の姿勢を簡単に求めることができる。
第1測位装置31及び第2測位装置32は、走行車体3の進行方向と直交する方向に並んで取付けられている。これによれば、例えば、走行車体3の幅方向のロール角等を求めることができる。
作業機は、走行車体3に設けられた原動機4と、走行車体3に装着され且つ原動機4の動力によって作動する作業装置2と、走行車体3の操舵を行う操舵装置11と、を備えている。これによれば、作業装置2を原動機4の動力によって作動させるようなトラクタ等の正確な測位を行うことができる。
今回開示された実施の形態はすべての点で例示であって制限的なものではないと考えられるべきである。本発明の範囲は上記した説明ではなくて特許請求の範囲によって示され、特許請求の範囲と均等の意味及び範囲内でのすべての変更が含まれることが意図される。
2 作業装置
3 走行車体
4 原動機
11 操舵装置
31 第1測位装置
31b 第1アンテナ
31d 第1位置演算部
32 第2測位装置
32b 第2アンテナ
32c 信号処理部
32d 第2位置演算部
32f 補正情報出力部
101 GNSS衛星
102 QZSS衛星
Claims (6)
- 走行車体と、
GNSS衛星から送信された第1衛星信号を受信する第1アンテナと、前記第1アンテナで受信した前記第1衛星信号に基づいて測位を行う第1位置演算部とを有する第1測位装置と、
少なくともQZSS衛星から送信された第2衛星信号を受信する第2アンテナと、前記第2アンテナで受信した前記第2衛星信号に基づいて補正情報を生成する信号処理部と、前記補正情報を前記第1測位装置に送信する補正情報出力部と、前記第2アンテナで受信した補正情報に基づいて測位を行う第2位置演算部とを備えた第2測位装置と、
を備え、
前記第1測位装置及び前記第2測位装置は、前記走行車体に設けられ、且つ、前記走行車体の進行方向と同一の方向に並んで取付けられており、
前記第1位置演算部は、前記補正情報出力部から送信された前記補正情報及び前記第1衛星信号に基づいて前記第1測位装置の3次元座標を演算し、
前記第1測位装置は、前記第1位置演算部が演算した前記第1測位装置の3次元座標を含む第1測位情報を前記第2測位装置に送信し、
前記第2位置演算部は、前記第1衛星信号又は前記第2衛星信号と前記補正情報とに基づいて前記第2測位装置の3次元座標を演算し、
前記第2測位装置は、前記第1位置演算部が演算した前記第1測位装置の3次元座標と前記第2位置演算部が演算した前記第2測位装置の3次元座標とによる3次元の基線ベクトルを用いて、前記走行車体の方位角及びピッチ角を求める状態演算部を備えている作業機。 - 走行車体と、
GNSS衛星から送信された第1衛星信号を受信する第1アンテナと、前記第1アンテナで受信した前記第1衛星信号に基づいて測位を行う第1位置演算部とを有する第1測位装置と、
少なくともQZSS衛星から送信された第2衛星信号を受信する第2アンテナと、前記第2アンテナで受信した前記第2衛星信号に基づいて補正情報を生成する信号処理部と、前記補正情報を前記第1測位装置に送信する補正情報出力部と、前記第2アンテナで受信した補正情報に基づいて測位を行う第2位置演算部とを備えた第2測位装置と、
を備え、
前記第1測位装置及び前記第2測位装置は、前記走行車体に設けられ、且つ、前記走行車体の進行方向と直交する方向に並んで取付けられており、
前記第1位置演算部は、前記補正情報出力部から送信された前記補正情報及び前記第1衛星信号に基づいて前記第1測位装置の3次元座標を演算し、
前記第1測位装置は、前記第1位置演算部が演算した前記第1測位装置の3次元座標を含む第1測位情報を前記第2測位装置に送信し、
前記第2位置演算部は、前記第1衛星信号又は前記第2衛星信号と前記補正情報とに基づいて前記第2測位装置の3次元座標を演算し、
前記第2測位装置は、前記第1位置演算部が演算した前記第1測位装置の3次元座標と前記第2位置演算部が演算した前記第2測位装置の3次元座標とによる3次元の基線ベクトルを用いて、前記走行車体のロール角を求める状態演算部を備えている作業機。 - 走行車体と、
GNSS衛星から送信された第1衛星信号を受信する第1アンテナと、前記第1アンテナで受信した前記第1衛星信号に基づいて測位を行う第1位置演算部とを有する2個の第1測位装置と、
少なくともQZSS衛星から送信された第2衛星信号を受信する第2アンテナと、前記第2アンテナで受信した前記第2衛星信号に基づいて補正情報を生成する信号処理部と、前記補正情報を前記第1測位装置に送信する補正情報出力部と、前記第2アンテナで受信した補正情報に基づいて測位を行う第2位置演算部とを備えた第2測位装置と、
を備え、
前記2個の第1測位装置のうちの一方の第1測位装置と前記第2測位装置とは、前記走行車体の進行方向に並んで前記走行車体に取付けられており、前記2個の第1測位装置のうちの他方の第1測位装置は、前記第2測位装置から、前記走行車体の進行方向と直交する方向に並んで前記走行車体に取付けられており、
前記第1位置演算部は、前記補正情報出力部から送信された前記補正情報及び前記第1衛星信号に基づいて前記第1測位装置の3次元座標を演算し、
前記第1測位装置は、前記第1位置演算部が演算した前記第1測位装置の3次元座標を含む第1測位情報を前記第2測位装置に送信し、
前記第2位置演算部は、前記第1衛星信号又は前記第2衛星信号と前記補正情報とに基づいて前記第2測位装置の3次元座標を演算し、
前記第2測位装置は、前記一方の第1測位装置の前記第1位置演算部が演算した当該一方の第1測位装置の3次元座標と前記第2位置演算部が演算した前記第2測位装置の3次元座標とによる3次元の基線ベクトルを用いて、前記走行車体の方位角及びピッチ角を求めると共に、前記他方の第1測位装置の前記第1位置演算部が演算した当該他方の第1測位装置の3次元座標と前記第2位置演算部が演算した前記第2測位装置の3次元座標とによる3次元の基線ベクトルを用いて、前記走行車体のロール角を求める状態演算部を備えている作業機。 - 前記第2測位装置を前記走行車体に対して着脱自在に支持する支持ブラケットを備えている請求項1〜3のいずれかに記載の作業機。
- 前記走行車体に設けられた原動機と、
前記走行車体に装着され且つ前記原動機の動力によって作動する作業装置と、
前記走行車体の操舵を行う操舵装置と、
を備えている請求項1〜4のいずれかに記載の作業機。 - 前記操舵装置は、前記測位に基づいて前記走行車体の操舵角を変更する請求項5に記載の作業機。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018133668A JP6987711B2 (ja) | 2018-07-13 | 2018-07-13 | 作業機 |
PCT/JP2019/025830 WO2020012987A1 (ja) | 2018-07-13 | 2019-06-28 | 作業機 |
KR1020207030775A KR102370181B1 (ko) | 2018-07-13 | 2019-06-28 | 작업기 |
AU2019302085A AU2019302085B2 (en) | 2018-07-13 | 2019-06-28 | Working machine |
CN201980035588.5A CN112166347A (zh) | 2018-07-13 | 2019-06-28 | 作业机 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018133668A JP6987711B2 (ja) | 2018-07-13 | 2018-07-13 | 作業機 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2020012680A JP2020012680A (ja) | 2020-01-23 |
JP6987711B2 true JP6987711B2 (ja) | 2022-01-05 |
Family
ID=69142380
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2018133668A Active JP6987711B2 (ja) | 2018-07-13 | 2018-07-13 | 作業機 |
Country Status (5)
Country | Link |
---|---|
JP (1) | JP6987711B2 (ja) |
KR (1) | KR102370181B1 (ja) |
CN (1) | CN112166347A (ja) |
AU (1) | AU2019302085B2 (ja) |
WO (1) | WO2020012987A1 (ja) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7496732B2 (ja) | 2020-08-06 | 2024-06-07 | 三菱マヒンドラ農機株式会社 | 作業車両 |
JPWO2022107588A1 (ja) | 2020-11-18 | 2022-05-27 | ||
EP4250044A1 (en) | 2020-11-18 | 2023-09-27 | Kubota Corporation | Moving body, control unit, and method for controlling operation of moving body |
WO2022107587A1 (ja) | 2020-11-18 | 2022-05-27 | 株式会社クボタ | 移動体、データ生成ユニット、およびデータを生成する方法 |
JP7502174B2 (ja) | 2020-12-22 | 2024-06-18 | 株式会社クボタ | 農業機械、ならびに農業機械を制御するシステムおよび方法 |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2364454B1 (en) * | 2008-12-05 | 2019-02-13 | Leica Geosystems AG | A positioning system and method |
JP2012233353A (ja) * | 2011-05-02 | 2012-11-29 | Komatsu Ltd | 油圧ショベルの較正システム及び油圧ショベルの較正方法 |
JP2015020674A (ja) * | 2013-07-22 | 2015-02-02 | 株式会社クボタ | 農作業車 |
JP2015112068A (ja) * | 2013-12-12 | 2015-06-22 | 株式会社クボタ | 圃場作業機 |
EP3163324B1 (en) * | 2014-06-25 | 2022-01-05 | Mitsubishi Electric Corporation | Positioning device, positioning method, and program |
US9778368B2 (en) * | 2014-09-07 | 2017-10-03 | Trimble Inc. | Satellite navigation using side by side antennas |
JP6422912B2 (ja) | 2016-04-06 | 2018-11-14 | 株式会社クボタ | 測位検出装置及び測位検出装置を備えた作業機 |
US20180011202A1 (en) * | 2016-07-06 | 2018-01-11 | Getac Technology Corporation | Method for calculating attitude angle and apparatus therefor |
JP2018066577A (ja) | 2016-10-17 | 2018-04-26 | 一般財団法人 衛星測位利用推進センター | 測位処理システム、方法、コンピュータプログラム、測位処理装置及びユーザ端末 |
JP6688545B2 (ja) * | 2016-11-10 | 2020-04-28 | ヤンマー株式会社 | コンバイン |
JP2018096799A (ja) * | 2016-12-12 | 2018-06-21 | ヤンマー株式会社 | 通信システム |
CN106600962A (zh) * | 2016-12-21 | 2017-04-26 | 南京多伦科技股份有限公司 | 一种车辆检测装置及检测方法 |
JP6733619B2 (ja) * | 2017-07-07 | 2020-08-05 | 株式会社デンソー | 測位装置 |
CN107589432A (zh) * | 2017-10-16 | 2018-01-16 | 驭势科技(北京)有限公司 | 基于天线阵列的卫星导航算法、导航***和车辆 |
-
2018
- 2018-07-13 JP JP2018133668A patent/JP6987711B2/ja active Active
-
2019
- 2019-06-28 AU AU2019302085A patent/AU2019302085B2/en active Active
- 2019-06-28 WO PCT/JP2019/025830 patent/WO2020012987A1/ja active Application Filing
- 2019-06-28 KR KR1020207030775A patent/KR102370181B1/ko active IP Right Grant
- 2019-06-28 CN CN201980035588.5A patent/CN112166347A/zh active Pending
Also Published As
Publication number | Publication date |
---|---|
JP2020012680A (ja) | 2020-01-23 |
WO2020012987A1 (ja) | 2020-01-16 |
AU2019302085B2 (en) | 2022-06-30 |
CN112166347A (zh) | 2021-01-01 |
AU2019302085A1 (en) | 2020-12-17 |
KR20200135509A (ko) | 2020-12-02 |
KR102370181B1 (ko) | 2022-03-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6987711B2 (ja) | 作業機 | |
JP6267626B2 (ja) | 走行経路設定装置 | |
EP3351080B1 (en) | Automatic traveling work vehicle and method for controlling work traveling for an automatic traveling work vehicle along a target travel route in a work field | |
JP2017174229A (ja) | 経路生成装置 | |
JP7179607B2 (ja) | 作業車両 | |
JP7233916B2 (ja) | 作業車両の制御装置、作業車両、及び作業車両の制御方法 | |
JP7083445B2 (ja) | 自律走行システム | |
JP2023101605A (ja) | 自動走行制御システム及び自律走行制御方法 | |
JP6879896B2 (ja) | 作業車のための衛星測位システム | |
JP6766240B1 (ja) | 作業車両 | |
CN112312760B (zh) | 作业车辆 | |
JP2023021229A (ja) | 作業車両 | |
JP7140858B2 (ja) | 走行経路生成方法、走行経路生成システム | |
JP6832996B2 (ja) | 走行経路生成方法 | |
WO2021125124A1 (ja) | 作業機 | |
JP2020006872A (ja) | 作業車両 | |
JP7330878B2 (ja) | 作業機 | |
JP7062542B2 (ja) | 作業機の測位システム及び作業機の測位方法 | |
JP7179565B2 (ja) | 作業車両 | |
JP6833941B1 (ja) | 作業車両 | |
JP6995711B2 (ja) | 作業機の測位システム | |
JP6938444B2 (ja) | 作業機 | |
JP7106419B2 (ja) | 作業車両 | |
JP2020012679A (ja) | 衛星信号受信装置及び衛星信号受信装置を備えた測位装置 | |
JP2018050632A (ja) | 走行経路設定装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20201225 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20210727 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20210903 |
|
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: 20211102 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20211201 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6987711 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |