JP7136917B2 - 走行経路決定装置および作業機 - Google Patents
走行経路決定装置および作業機 Download PDFInfo
- Publication number
- JP7136917B2 JP7136917B2 JP2020554670A JP2020554670A JP7136917B2 JP 7136917 B2 JP7136917 B2 JP 7136917B2 JP 2020554670 A JP2020554670 A JP 2020554670A JP 2020554670 A JP2020554670 A JP 2020554670A JP 7136917 B2 JP7136917 B2 JP 7136917B2
- Authority
- JP
- Japan
- Prior art keywords
- travel route
- information
- work
- area
- divided
- 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
- 238000009826 distribution Methods 0.000 claims description 18
- 238000011156 evaluation Methods 0.000 claims description 15
- 238000012876 topography Methods 0.000 claims description 12
- 230000007613 environmental effect Effects 0.000 claims description 10
- 238000005259 measurement Methods 0.000 claims description 9
- 238000010586 diagram Methods 0.000 description 20
- 238000012545 processing Methods 0.000 description 18
- 238000000034 method Methods 0.000 description 14
- 230000006870 function Effects 0.000 description 10
- 238000004891 communication Methods 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 230000001186 cumulative effect Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 244000025254 Cannabis sativa Species 0.000 description 1
- HBBGRARXTFLTSG-UHFFFAOYSA-N Lithium ion Chemical compound [Li+] HBBGRARXTFLTSG-UHFFFAOYSA-N 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 230000006698 induction Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 229910001416 lithium ion Inorganic materials 0.000 description 1
- 229910052987 metal hydride Inorganic materials 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 229910052759 nickel Inorganic materials 0.000 description 1
- PXHVJJICTQNCMI-UHFFFAOYSA-N nickel Substances [Ni] PXHVJJICTQNCMI-UHFFFAOYSA-N 0.000 description 1
- -1 nickel metal hydride Chemical class 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0217—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with energy consumption, time reduction or distance reduction criteria
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D34/00—Mowers; Mowing apparatus of harvesters
- A01D34/006—Control or measuring arrangements
- A01D34/008—Control or measuring arrangements for automated or remotely controlled operation
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0225—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving docking at a fixed facility, e.g. base station or loading bay
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D2101/00—Lawn-mowers
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental Sciences (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
作業領域における作業機の走行経路を決定するための走行経路決定装置であって、
前記作業領域の地形情報を取得する取得手段と、
前記作業領域の勾配分布を前記地形情報に基づいて評価する評価手段と、
前記作業領域における前記作業機の現在地から目的地までの走行経路を、該走行経路における起伏が小さくなるように、前記勾配分布に基づいて決定する決定手段と、を備え、
前記地形情報は、前記作業領域を仮想的に分割して得られ且つサイズ及び形状が互いに異なる複数の領域のそれぞれに対して与えられた座標情報を含み、前記複数の領域において、前記起伏が存在する領域は他の領域よりも小さいサイズで分割される
ことを特徴とする。
(経路A) Rd11→Rd21→Rd31→Rd41→Rd51→Rd62、
(経路B) Rd11→Rd21→Rd31→Rd42→Rd52→Rd62、
(経路C) Rd11→Rd21→Rd32→Rd41→Rd52→Rd62、
等が考えられる。ここで、経路Aにおいては移動コストの合計値は19となる。また、経路Bにおいては移動コストの合計値は14となる。これに対して、経路Cにおいては移動コストの合計値は12となり、経路A及びBにおける移動コストの合計値に比べて小さい。また、他の経路の移動コストを考慮しても、経路Cにおける移動コストの合計値より小さい経路はない。よって、図3Cの例においては、分割領域Rd11(現在地)から分割領域Rd62(目的地)までの走行経路として、上記経路Cが選択され決定されることとなる。
P11=(X11,Y11,Z11)、
P21=(X21,Y21,Z21)、
P12=(X12,Y12,Z12)、
P22=(X22,Y22,Z22)、
と表わせるものとする。この場合、分割領域RdAには、次の式:
XA=(X11+X21+X12+X22)/4;
YA=(Y11+Y21+Y12+Y22)/4;
ZA=(Z11+Z21+Z12+Z22)/4、
を満たす座標(XA,YA,ZA)の情報が与えられる。
P31=(X31,Y31,Z31)、
P32=(X32,Y32,Z32)、
と表わせるものとする。この場合、分割領域RdBには、次の式:
XB=(X21+X31+X22+X32)/4;
YB=(Y21+Y31+Y22+Y32)/4;
ZB=(Z21+Z31+Z22+Z32)/4、
を満たす座標(XB,YB,ZB)の情報が与えられる。
L={(XA-XB)2+(YA-YB)2+(ZA-ZB)2}1/2、
LH={(XA-XB)2+(YA-YB)2}1/2、
H=|ZA-ZB|、
と表せる。また、分割領域RdA‐RdB間の傾斜角θは、
θ=arcsin(H/L)、
と表せる。
CAB=K0×sinθ、
K0:係数(K0>0)
と設定されてもよい。この例において、分割領域RdA‐RdB間が水平な場合(θ=0°の場合)には移動コストCABは、
CAB=0、
と設定される。また、傾斜角θが大きくなるほど移動コストCABが大きくなることとなる(θ→90°でCAB→K0、となる。)。
CAB=K1×L/cоsθ、
K1:係数(K1>0)
と設定されてもよい。この例において、分割領域RdA‐RdB間が水平な場合(θ=0°の場合)には移動コストCABは、
CAB=K1×L、
と設定される。また、傾斜角θが大きくなる程、移動コストCABが大きくなることとなる(θ→90°でCAB→∞、となる。)。
CAB=L×(K2+K3×sinθ)、
K2:係数(K2≧0)
K3:係数(K3≧0)
と設定されてもよい。この例において、分割領域RdA‐RdB間が水平な場合(θ=0°の場合)には移動コストCABは、
CAB=L×K2、
と設定される。また、傾斜角θが大きくなる程、移動コストCABが大きくなることとなる(θ→90°でCAB→L×(K2+K3)、となる。)。尚、K3>K2とすることで、傾斜の度合いを重視した移動コストを設定可能となる。
CAB<CBA、
となるように設定されるとよい。
第1の態様は、走行経路決定装置(例えば106、2)に係り、前記走行経路決定装置は、作業領域(例えばWR)における作業機(例えば1)の走行経路を決定するための走行経路決定装置であって、前記作業領域の地形情報を取得する取得手段(例えばS1061)と、前記作業領域の勾配分布を前記地形情報に基づいて評価する評価手段(例えばS1062~S1063)と、前記作業領域における前記作業機の現在地から目的地までの走行経路を、該走行経路における起伏が小さくなるように、前記勾配分布に基づいて決定する決定手段(例えばS1064)と、を備える。
Claims (11)
- 作業領域における作業機の走行経路を決定するための走行経路決定装置であって、
前記作業領域の地形情報を取得する取得手段と、
前記作業領域の勾配分布を前記地形情報に基づいて評価する評価手段と、
前記作業領域における前記作業機の現在地から目的地までの走行経路を、該走行経路における起伏が小さくなるように、前記勾配分布に基づいて決定する決定手段と、を備え、
前記地形情報は、前記作業領域を仮想的に分割して得られ且つサイズ及び形状が互いに異なる複数の領域のそれぞれに対して与えられた座標情報を含み、前記複数の領域において、前記起伏が存在する領域は他の領域よりも小さいサイズで分割される
ことを特徴とする走行経路決定装置。 - 前記地形情報は、前記作業領域についての水平方向および垂直方向の座標情報を含む
ことを特徴とする請求項1記載の走行経路決定装置。 - 前記評価手段は、前記座標情報から得られる各領域間の勾配に基づいて、各領域間を移動する際の移動コストを評価し、
前記決定手段は、前記現在地から前記目的地までの走行経路を、該走行経路を形成する各領域間の前記移動コストの合計値が最小となるように、決定する
ことを特徴とする請求項1または請求項2記載の走行経路決定装置。 - 前記分割された複数の領域は、互いに隣り合い且つ互いに異なる高さの前記座標情報が与えられた第1領域および第2領域を含んでおり、
前記評価手段は、前記第1領域から前記第2領域に移動する場合の前記移動コストと、前記第2領域から前記第1領域に移動する場合の前記移動コストとを個別に評価する
ことを特徴とする請求項3記載の走行経路決定装置。 - 前記地形情報は、前記分割された複数の領域のそれぞれに存在する凸状または凹状の領域の数を示す凹凸数情報を更に含み、
前記決定手段は、更に前記凹凸数情報に基づいて前記走行経路を決定する
ことを特徴とする請求項2から請求項4の何れか1項記載の走行経路決定装置。 - 前記作業機周辺の環境情報を取得する第2の取得手段を更に備え、
前記決定手段は、更に前記環境情報に基づいて前記走行経路を決定する
ことを特徴とする請求項1から請求項5の何れか1項記載の走行経路決定装置。 - 前記環境情報は、湿度を示す情報を含む
ことを特徴とする請求項6記載の走行経路決定装置。 - 前記環境情報は気候情報を含む
ことを特徴とする請求項6または請求項7記載の走行経路決定装置。 - 請求項1から請求項8の何れか1項記載の走行経路決定装置と、車両の走行を行うための走行部と、前記走行経路決定装置の前記決定手段により決定された前記走行経路に基づいて前記走行部を制御する走行制御部と、を備える
ことを特徴とする作業機。 - 前記作業領域の地形を計測するための計測部と、前記計測部による計測結果を前記地形情報として保持する情報保持部と、を更に備える
ことを特徴とする請求項9記載の作業機。 - バッテリを更に備え、
前記走行経路決定装置は、前記バッテリの残量が基準量より少なくなった場合に、充電用ステーションを前記目的地として前記決定手段により前記走行経路を決定する
ことを特徴とする請求項9または請求項10記載の作業機。
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2018/040527 WO2020090039A1 (ja) | 2018-10-31 | 2018-10-31 | 走行経路決定装置および作業機 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPWO2020090039A1 JPWO2020090039A1 (ja) | 2021-09-16 |
JP7136917B2 true JP7136917B2 (ja) | 2022-09-13 |
Family
ID=70464085
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2020554670A Active JP7136917B2 (ja) | 2018-10-31 | 2018-10-31 | 走行経路決定装置および作業機 |
Country Status (4)
Country | Link |
---|---|
US (1) | US20210232146A1 (ja) |
EP (1) | EP3855271B1 (ja) |
JP (1) | JP7136917B2 (ja) |
WO (1) | WO2020090039A1 (ja) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111947673B (zh) * | 2019-05-17 | 2022-09-06 | 北京京东振世信息技术有限公司 | 无人车路径控制方法、装置和系统 |
JP2023051461A (ja) * | 2021-09-30 | 2023-04-11 | 井関農機株式会社 | 作業車両 |
CN115032995B (zh) | 2022-06-17 | 2023-07-14 | 未岚大陆(北京)科技有限公司 | 运动控制方法、装置、电子设备及计算机存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040068352A1 (en) | 2002-10-03 | 2004-04-08 | Deere & Company, A Delaware Corporation | Method and system for determining an energy-efficient path of a machine |
JP2015061803A (ja) | 2006-06-19 | 2015-04-02 | アマゾン・テクノロジーズ・インコーポレーテッド | 目録品を移送するシステムおよび方法 |
JP2016028311A (ja) | 2014-07-10 | 2016-02-25 | 株式会社リコー | ロボット、プログラム、及び記憶媒体 |
US20160282869A1 (en) | 2015-03-27 | 2016-09-29 | Honda Motor Co., Ltd. | Control apparatus for autonomously navigating utility vehicle |
US20180051991A1 (en) | 2016-08-17 | 2018-02-22 | Sharp Laboratories Of America, Inc. | Lazier graph-based path planning for autonomous navigation |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3359799B2 (ja) | 1995-11-02 | 2002-12-24 | 株式会社日立製作所 | 無人移動作業機械の制御方式 |
GB2358843B (en) * | 2000-02-02 | 2002-01-23 | Logical Technologies Ltd | An autonomous mobile apparatus for performing work within a pre-defined area |
CN104268862B (zh) * | 2014-09-18 | 2017-04-26 | 中国人民解放军国防科学技术大学 | 一种自主车三维地形可通行性分析方法 |
KR101854680B1 (ko) * | 2016-04-29 | 2018-06-14 | 엘지전자 주식회사 | 이동 로봇 및 그 제어방법 |
-
2018
- 2018-10-31 WO PCT/JP2018/040527 patent/WO2020090039A1/ja unknown
- 2018-10-31 JP JP2020554670A patent/JP7136917B2/ja active Active
- 2018-10-31 EP EP18938382.1A patent/EP3855271B1/en active Active
-
2021
- 2021-04-14 US US17/230,314 patent/US20210232146A1/en active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040068352A1 (en) | 2002-10-03 | 2004-04-08 | Deere & Company, A Delaware Corporation | Method and system for determining an energy-efficient path of a machine |
JP2015061803A (ja) | 2006-06-19 | 2015-04-02 | アマゾン・テクノロジーズ・インコーポレーテッド | 目録品を移送するシステムおよび方法 |
JP2016028311A (ja) | 2014-07-10 | 2016-02-25 | 株式会社リコー | ロボット、プログラム、及び記憶媒体 |
US20160282869A1 (en) | 2015-03-27 | 2016-09-29 | Honda Motor Co., Ltd. | Control apparatus for autonomously navigating utility vehicle |
JP2016186751A (ja) | 2015-03-27 | 2016-10-27 | 本田技研工業株式会社 | 無人作業車の制御装置 |
US20180051991A1 (en) | 2016-08-17 | 2018-02-22 | Sharp Laboratories Of America, Inc. | Lazier graph-based path planning for autonomous navigation |
Also Published As
Publication number | Publication date |
---|---|
EP3855271A4 (en) | 2021-10-13 |
US20210232146A1 (en) | 2021-07-29 |
WO2020090039A1 (ja) | 2020-05-07 |
EP3855271A1 (en) | 2021-07-28 |
EP3855271B1 (en) | 2023-06-07 |
JPWO2020090039A1 (ja) | 2021-09-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112584697B (zh) | 使用视觉系统的自主机器导航和训练 | |
JP7136917B2 (ja) | 走行経路決定装置および作業機 | |
CN111990929B (zh) | 一种障碍物探测方法、装置、自行走机器人和存储介质 | |
EP4163756B1 (en) | Smart scheduling for autonomous machine operation | |
JP7203120B2 (ja) | 制御システム、制御装置、自律作業機、制御装置の動作方法、自律作業機の制御方法及びプログラム | |
CN109932726B (zh) | 机器人测距校准方法、装置、机器人和介质 | |
CN113460033B (zh) | 一种自动泊车方法以及装置 | |
CN106960589A (zh) | 用于反向垂直停车的系统和方法 | |
CN111427357A (zh) | 一种机器人避障方法、装置和存储介质 | |
US11927964B2 (en) | Autonomous work machine, method of controlling the same, and storage medium | |
CN113848940A (zh) | 一种agv自主导航控制方法及系统 | |
US20230136798A1 (en) | Method and apparatus for detecting lane line | |
US20230069475A1 (en) | Autonomous machine navigation with object detection and 3d point cloud | |
US20210302980A1 (en) | Autonomous work system, autonomous work setting method, and storage medium | |
CN112346446B (zh) | 自动导引运输车脱码恢复方法、装置及电子设备 | |
WO2021159397A1 (zh) | 车辆可行驶区域的检测方法以及检测装置 | |
US20230249568A1 (en) | System and method for autonomously charging electric vehicles | |
CN114092898A (zh) | 目标物的感知方法及装置 | |
WO2024174500A1 (zh) | 数据处理方法、可读存储介质和电子设备 | |
EP4207133A1 (en) | Traffic element observation method and apparatus | |
WO2024173028A1 (en) | Image notification for autonomous grounds maintenance machines | |
CN116539051A (zh) | 站点采集方法、相关装置和介质 | |
CN117629219A (zh) | 充电定位引导方法和自动充电机器人 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20210428 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220221 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220407 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220627 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220803 |
|
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: 20220815 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20220901 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7136917 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |