JPWO2019159278A1 - 作業機 - Google Patents
作業機 Download PDFInfo
- Publication number
- JPWO2019159278A1 JPWO2019159278A1 JP2019571875A JP2019571875A JPWO2019159278A1 JP WO2019159278 A1 JPWO2019159278 A1 JP WO2019159278A1 JP 2019571875 A JP2019571875 A JP 2019571875A JP 2019571875 A JP2019571875 A JP 2019571875A JP WO2019159278 A1 JPWO2019159278 A1 JP WO2019159278A1
- Authority
- JP
- Japan
- Prior art keywords
- point
- landmark
- working machine
- work
- work machine
- 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.)
- Granted
Links
- 238000001514 detection method Methods 0.000 claims abstract description 45
- 230000008859 change Effects 0.000 claims description 18
- 238000005259 measurement Methods 0.000 claims description 10
- 238000000034 method Methods 0.000 description 15
- 238000003384 imaging method Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000007246 mechanism Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 230000006870 function Effects 0.000 description 1
- 229930014626 natural product Natural products 0.000 description 1
- 239000004576 sand 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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0234—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
-
- 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
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D2101/00—Lawn-mowers
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Electromagnetism (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (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)
- Harvester Elements (AREA)
Abstract
Description
‐先ず、上述のとおり、角度θA及びθB、走行距離dAB、並びに、進行方向の変化量ΔθABを取得する;
‐次に、変化量ΔθAB及び走行距離dABに基づいて、地点Aから地点Bまでの旋回半径Rを、
R≒dAB/ΔθAB
により算出する(式1);
‐その後、変化量ΔθAB及び径Rに基づいて、地点Aから地点Bまでの直線距離dAB’を、
dAB’=2×R×sin(ΔθAB/2)
により算出する(式2);
‐そして、角度θA及びθB並びに変化量ΔθABに基づいて、角度θA’(∠MAB)及び角度θB’(∠MBA)を、それぞれ、
θA’=θA−ΔθAB/2
θB’=π−θB−ΔθAB/2
により算出する(式3);
‐その後、角度θA’及びθB’並びに直線距離dAB’に基づいて、三角形MABの底辺ABに対する高さH1を、
H1=dAB’×tanθA’×tanθB’/(tanθA’+tanθB’)
により算出する(式4);
‐これにより、高さH1及び角度θB’に基づいて、BM間距離LBが、
LB=H1/sinθB’
により算出される(式5)。
‐先ず、上述のとおり、角度θB及びθC並びに変化量ΔθBCを取得する;
‐次に、角度θB及び角度θC並びに変化量ΔθBCに基づいて、角度θB’(∠MBC)及び角度θC’(∠MCB)を、
θB’=θB−ΔθBC/2
θC’=π−θC−ΔθBC/2
により算出する(式6);
‐その後、角度θB’及びθC’に基づいて、角度θM(∠BMC)を、
θM=π−θB’−θC’
により算出する(式7);
‐そして、角度θB’及び角度θM並びに距離LBに基づいて、三角形MBCの底辺MBに対する高さH2を、
H2=LB×tanθB’×tanθM/(tanθB’+tanθM)
により算出する(式8);
‐これにより、高さH2及び角度θMに基づいて、CM間距離LCが、
LC=H2/sinθM
により算出される(式9)。
第1の態様は、走行部(例えば11)を備える自走式の作業機(例えば1)であって、作業エリア(例えばRW)のランドマーク(例えばM)についての前記作業機の進行方向に対する方向を検出する検出部(例えば13、133)と、前記検出部による検出結果に基づいて、前記ランドマークに対する前記作業機の相対的な位置を特定する演算部(例えば141)と、を備える。
Claims (13)
- 走行部を備える自走式の作業機であって、
作業エリアのランドマークについての前記作業機の進行方向に対する方向を検出する検出部と、
前記検出部による検出結果に基づいて、前記ランドマークに対する前記作業機の相対的な位置を特定する演算部と、を備える
ことを特徴とする作業機。 - 前記演算部は、走行中の進行方向の変化量に更に基づいて、前記作業機の前記相対的な位置を特定する
ことを特徴とする請求項1に記載の作業機。 - 前記演算部は、前記作業機の前記特定された相対的な位置に基づいて、更に前記作業機の走行経路を決定する
ことを特徴とする請求項1または請求項2に記載の作業機。 - 前記演算部は、
前記作業機が前記作業エリア内の第1地点に位置している時の該作業機の進行方向に対する前記ランドマークの方向と、
前記作業機が前記作業エリア内の前記第1地点とは異なる第2地点に位置している時の該作業機の進行方向に対する前記ランドマークの方向と、
を前記検出部により検出し、
前記検出部により検出された前記第1地点及び前記第2地点のそれぞれにおける前記ランドマークの方向と、
前記作業機が前記第1地点から前記第2地点に移動するまでの間の前記走行部による走行距離と、
前記作業機が前記第1地点から前記第2地点に移動している間の前記作業機の進行方向の変化量と、
に基づいて、前記第2地点から前記ランドマークまでの距離を特定する
ことを特徴とする請求項1から請求項3の何れか1項に記載の作業機。 - 前記作業機が前記第1地点から前記第2地点に移動する際、前記演算部は、前記作業機の走行経路が平面視で円弧を描くように前記走行部を駆動する
ことを特徴とする請求項4に記載の作業機。 - 前記作業機の姿勢を計測するための姿勢センサを更に備える
ことを特徴とする請求項4または請求項5に記載の作業機。 - 前記走行部による前記作業機の走行距離を計測する計測センサを更に備える
ことを特徴とする請求項4から請求項6の何れか1項に記載の作業機。 - 前記演算部は、
前記作業機が前記作業エリア内の第2地点に位置している時の該作業機の進行方向に対する前記ランドマークの方向と、
前記作業機が前記作業エリア内の前記第2地点とは異なる第3地点に位置している時の該作業機の進行方向に対する前記ランドマークの方向と、
を前記検出部により検出し、
前記検出部により検出された前記第2地点及び前記第3地点のそれぞれにおける前記ランドマークの方向と、
前記作業機が前記第2地点から前記第3地点に移動している間の前記作業機の進行方向の変化量と、
前記第2地点から前記ランドマークまでの距離と、
に基づいて、前記第3地点から前記ランドマークまでの距離を特定する
ことを特徴とする請求項1から請求項7の何れか1項に記載の作業機。 - 前記作業エリアには前記ランドマークは2以上設けられ、
前記検出部は、前記2以上のランドマークを区別して検出可能に構成されている
ことを特徴とする請求項1から請求項8の何れか1項に記載の作業機。 - 前記検出部は撮像センサを含む
ことを特徴とする請求項1から請求項9の何れか1項に記載の作業機。 - 前記ランドマークは電磁波を発生しており、前記検出部は、前記電磁波を検出可能に構成されたセンサを含む
ことを特徴とする請求項1から請求項10の何れか1項に記載の作業機。 - 前記ランドマークはビーコン(Beacon)である
ことを特徴とする請求項11に記載の作業機。 - 前記ランドマークは音波を発生しており、前記検出部はマイクロフォンを含む
ことを特徴とする請求項1から請求項10の何れか1項に記載の作業機。
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2018/005234 WO2019159278A1 (ja) | 2018-02-15 | 2018-02-15 | 作業機 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPWO2019159278A1 true JPWO2019159278A1 (ja) | 2021-01-07 |
JP6982105B2 JP6982105B2 (ja) | 2021-12-17 |
Family
ID=67619196
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019571875A Active JP6982105B2 (ja) | 2018-02-15 | 2018-02-15 | 作業機 |
Country Status (4)
Country | Link |
---|---|
US (1) | US20200359560A1 (ja) |
EP (1) | EP3739416A4 (ja) |
JP (1) | JP6982105B2 (ja) |
WO (1) | WO2019159278A1 (ja) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112567958B (zh) * | 2019-09-12 | 2024-08-09 | 南京泉峰科技有限公司 | 自行走割草系统及其漏割区域的补充作业的方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05189033A (ja) * | 1992-01-13 | 1993-07-30 | Tatsumi Denshi Kogyo Kk | ロボットの位置計測方法 |
JP2000132229A (ja) * | 1998-10-22 | 2000-05-12 | Hitachi Zosen Corp | 移動体の走行制御方法 |
JP2015001863A (ja) * | 2013-06-17 | 2015-01-05 | 株式会社リコー | 配達装置、自走型フィニッシャ、画像形成システム、及び配達プログラム |
JP2016035423A (ja) * | 2014-08-04 | 2016-03-17 | 日産自動車株式会社 | 位置検出装置及び位置検出方法 |
JP2017520057A (ja) * | 2014-06-19 | 2017-07-20 | ハスクバーナ・アーベー | 自動的なビーコン位置判定 |
JP2017168058A (ja) * | 2016-03-18 | 2017-09-21 | 本田技研工業株式会社 | 無人走行作業車 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5828776B2 (ja) | 1977-05-17 | 1983-06-17 | 株式会社ケンウッド | 出力制御回路 |
KR100928964B1 (ko) * | 2003-04-15 | 2009-11-26 | 삼성전자주식회사 | 이동로봇의 도킹스테이션 귀환방법 및 장치 |
DE112005000738T5 (de) * | 2004-03-29 | 2007-04-26 | Evolution Robotics, Inc., Pasadena | Verfahren und Vorrichtung zur Positionsbestimmung unter Verwendung von reflektierten Lichtquellen |
-
2018
- 2018-02-15 JP JP2019571875A patent/JP6982105B2/ja active Active
- 2018-02-15 EP EP18906014.8A patent/EP3739416A4/en not_active Withdrawn
- 2018-02-15 WO PCT/JP2018/005234 patent/WO2019159278A1/ja unknown
-
2020
- 2020-08-06 US US16/986,733 patent/US20200359560A1/en not_active Abandoned
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05189033A (ja) * | 1992-01-13 | 1993-07-30 | Tatsumi Denshi Kogyo Kk | ロボットの位置計測方法 |
JP2000132229A (ja) * | 1998-10-22 | 2000-05-12 | Hitachi Zosen Corp | 移動体の走行制御方法 |
JP2015001863A (ja) * | 2013-06-17 | 2015-01-05 | 株式会社リコー | 配達装置、自走型フィニッシャ、画像形成システム、及び配達プログラム |
JP2017520057A (ja) * | 2014-06-19 | 2017-07-20 | ハスクバーナ・アーベー | 自動的なビーコン位置判定 |
JP2016035423A (ja) * | 2014-08-04 | 2016-03-17 | 日産自動車株式会社 | 位置検出装置及び位置検出方法 |
JP2017168058A (ja) * | 2016-03-18 | 2017-09-21 | 本田技研工業株式会社 | 無人走行作業車 |
Also Published As
Publication number | Publication date |
---|---|
EP3739416A1 (en) | 2020-11-18 |
EP3739416A4 (en) | 2020-12-30 |
JP6982105B2 (ja) | 2021-12-17 |
US20200359560A1 (en) | 2020-11-19 |
WO2019159278A1 (ja) | 2019-08-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112584697B (zh) | 使用视觉系统的自主机器导航和训练 | |
EP3168705B1 (en) | Domestic robotic system | |
JP6916784B2 (ja) | 位置捕捉方法及びシステム | |
EP3351077B1 (en) | Travel route generation device and travel route generation program | |
CN105270410B (zh) | 用于自主驾驶车辆的路径规划的精确曲率估计算法 | |
US20180011495A1 (en) | Route search method, route search system, non-transitory computer-readable storage medium, and work vehicle | |
US11852484B2 (en) | Method for determining the orientation of a robot, orientation determination apparatus of a robot, and robot | |
JP2020506388A (ja) | デジタルマップを更新するための方法および装置 | |
JP2011065308A (ja) | 自律移動システム及び自律移動装置 | |
JP7211605B2 (ja) | 地形を考慮したルート計画 | |
JP6982105B2 (ja) | 作業機 | |
EP4066076B1 (en) | Autonomous machine navigation in various lighting environments | |
US20230069475A1 (en) | Autonomous machine navigation with object detection and 3d point cloud | |
JP2022183962A (ja) | 経路決定方法、経路決定システム、及び経路決定プログラム | |
CN109258059B (zh) | 一种割草机位置的确定方法和装置 | |
TWI426241B (zh) | Self - propelled device for the tracking system | |
KR20230118813A (ko) | 자동 주행 시스템, 자동 주행 방법, 및 자동 주행 프로그램 | |
CN114111779A (zh) | 一种建立工作区域地图的方法及自移动设备 | |
JP2022183958A (ja) | 自動走行方法、自動走行システム、及び自動走行プログラム | |
WO2018157197A1 (en) | A system and methodology for light level audit sampling | |
JP2006065762A (ja) | 算出装置及び車椅子 | |
WO2024159849A1 (zh) | 一种自主作业设备的作业方法及自主作业设备 | |
JP2022183956A (ja) | 自動走行方法、自動走行システム、及び自動走行プログラム | |
JP2022183957A (ja) | 自動走行方法、自動走行システム、及び自動走行プログラム | |
JP2023127875A (ja) | 自動走行方法、自動走行システム、及び自動走行プログラム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20200727 |
|
RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20210103 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20210125 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20210416 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20210430 |
|
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: 20211022 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20211118 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6982105 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |