JP2017068870A - 作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のためのシステム、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システム - Google Patents

作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のためのシステム、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システム Download PDF

Info

Publication number
JP2017068870A
JP2017068870A JP2016256505A JP2016256505A JP2017068870A JP 2017068870 A JP2017068870 A JP 2017068870A JP 2016256505 A JP2016256505 A JP 2016256505A JP 2016256505 A JP2016256505 A JP 2016256505A JP 2017068870 A JP2017068870 A JP 2017068870A
Authority
JP
Japan
Prior art keywords
travel route
work
travel
predetermined
route
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
Application number
JP2016256505A
Other languages
English (en)
Other versions
JP6289603B2 (ja
Inventor
誠一郎 石島
Seiichiro ISHIJIMA
誠一郎 石島
正 押見
Tadashi Oshimi
正 押見
山本 和孝
Kazutaka Yamamoto
和孝 山本
矢▲崎▼ 登
Noboru Yazaki
登 矢▲崎▼
洋 菅原
Hiroshi Sugawara
洋 菅原
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mamiya OP Co Ltd
Original Assignee
Mamiya OP Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Mamiya OP Co Ltd filed Critical Mamiya OP Co Ltd
Publication of JP2017068870A publication Critical patent/JP2017068870A/ja
Application granted granted Critical
Publication of JP6289603B2 publication Critical patent/JP6289603B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0219Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01BSOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
    • A01B69/00Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
    • A01B69/007Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow
    • A01B69/008Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow automatic
    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01DHARVESTING; MOWING
    • A01D34/00Mowers; Mowing apparatus of harvesters
    • A01D34/006Control or measuring arrangements
    • A01D34/008Control or measuring arrangements for automated or remotely controlled operation
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/0088Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/027Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising intertial navigation means, e.g. azimuth detector
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01DHARVESTING; MOWING
    • A01D2101/00Lawn-mowers

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Environmental Sciences (AREA)
  • Soil Sciences (AREA)
  • Mechanical Engineering (AREA)
  • Business, Economics & Management (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Game Theory and Decision Science (AREA)
  • Medical Informatics (AREA)
  • Guiding Agricultural Machines (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

【課題】作業機械が走行経路から離脱した場合に、作業機械を作業完了位置又は作業未完位置の手前で走行経路に前進のみで進入させることができるような、進入準備のための作業機械の配置をより確実に行えるようにすること。
【解決手段】作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械の現在位置を検出する検出手段と、前記作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定し、進入可能か否かの判定情報を生成する判定情報生成部とを含む進入可否判定システム。
【選択図】図9

Description

本発明は、例えばゴルフ場、サッカー場等の競技場や河川の堤防、公園緑地、庭園で利用される芝刈り機、散水機、散布機、施肥機、種まき機、土壌状態測定機、収穫機、耕耘機、耕土機、整地機をはじめとする農業機械や清掃機械のような作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のための装置、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システムに関する。
芝刈り、耕作、清掃などの作業に対して、作業対象領域を、互いに平行な複数の直線経路の端部を反転経路を介して相互に連結して形成された経路を走行する自走式の作業機械が知られている(例えば、特許文献1、2参照)。
特許第3318170号公報 特開2013−228821号公報
しかしながら、上記特許文献1、2に記載されているような従来の作業機械においては、作業対象領域の外部に、作業機械の進入が禁止される領域(例えばゴルフ場の芝刈りにおいて、グリーン又はフェアウエイ(以下、「グリーン等」という)の外側の崖、バンカー、岩、立木などの存在のために進入が禁止される領域)があることが考慮されておらず、走行経路は、作業機械が直線経路の外側でターンを行うようなものであった。
このような作業機械が直線経路の外側でターンを行う走行経路においては、作業対象領域の外周と進入禁止領域の外周との位置関係によっては、例えば作業対象領域の外周と進入禁止領域の外周が接近している場合には、反転経路上を走行する作業機械と進入禁止領域の外周との間に干渉が生じる場合がある。そのため、これを避けるためには、作業対象領域の外周よりも内側でターン動作を開始する必要があり、実際の作業領域が作業対象領域よりも小さくなってしまう。
そこで、本発明は、作業対象領域の外周と進入禁止領域の外周との位置関係によらず、例えば作業対象領域の外周と進入禁止領域の外周が接近していても、作業対象領域の全域にわたって作業を行うことを可能とする作業機械の走行経路を生成することを目的の1つとする。
また、本発明は、そのように生成された走行経路を作業機械に自動走行させることを目的の1つとする。
ある作業対象領域における作業が終了しないうちに、その作業対象領域が使用されるため作業機械を待避させる場合、作業機械の異常を感じて検査のために作業機械を作業対象領域の外に移動させる場合、作業を行うための走行中に予定外の障害物を検知したため緊急停止をして障害物を回避しなければならない場合等、作業機械が作業のために走行経路を走行している途中で、何らかの事情によって作業機械の走行を停止し、走行経路を離脱する場合がある。その場合、少なくとも走行経路離脱時の最終の作業完了位置(以下、単に「作業完了位置」ともいう。)から作業が再開されるように作業機械を走行経路に復帰させる必要がある。そのため、ユーザは、作業機械を作業完了位置の近くに移動させる。また、作業が行われるべき経路と作業が行われない経路と作業が行われるべき経路が接続されている場合において、前の作業が行われるべき経路の作業がすべて完了しているとき、すなわち走行経路離脱時の作業完了位置が前の作業が行われるべき経路と作業が行われない経路との接続点であるときは、後の作業が行われるべき経路の始点(作業が行われない経路と後の作業が行われるべき経路の接続点)、すなわち走行経路離脱時の最初の作業未完位置(以下、単に「作業未完位置」ともいう。)から作業が再開されればよい。よって、そのような場合は、ユーザは、作業機械を作業未完位置の近くに移動させてもよい。
一方、作業機械は、自動走行の場合、現在位置と所定の走行経路に基づいて走行経路を自動走行する。すなわち、作業機械は、所定の走行経路に沿うように、フィードバック制御やフィードフォワード制御といった制御によって軌道修正を行いながら走行する。したがって、作業機械は、上記の作業完了位置又は作業未完位置の近くの位置(以下、「進入準備のための位置」ともいう。)から走行を開始すると、現在位置とこれから進入しようとする走行経路とのずれを修正するように軌道修正が行いながら、走行経路に進入し、走行経路上を走行することになる。よって、作業機械が、実際に走行経路上のどの位置で走行経路に進入するのかは制御できない。
したがって、作業機械を作業完了位置又は作業未完位置の手前で走行経路に前進のみで進入させることができるような、進入準備のための作業機械の配置を行うことは、熟練を要するし、熟練者でもそのような配置に失敗することがある。
そこで、本発明は、作業機械が走行経路から離脱した場合に、作業機械を作業完了位置又は作業未完位置の手前で走行経路に前進のみで進入させることができるような、進入準備のための作業機械の配置をより確実に行えるようにすることを目的の1つとする。
1つ又は複数の作業対象領域の各々について、それぞれの作業対象領域に対して対応する所定の走行経路に沿って自動走行しながら所定作業を行う作業機械を用いて作業を行う場合、作業対象領域までの移動や作業対象領域間の移動は、手動運転で行うことがある。このような場合、ユーザは、各作業対象領域にそれぞれ対応する所定の走行経路の走行経路開始位置の近くまで手動で作業機械を移動させる。その際、その走行経路開始位置の近くの位置は、手動運転と自動走行の切り換え位置であるので、作業機械が、各所定の走行経路の走行経路開始位置と作業開始位置の間に位置する進入位置において進入可能であるように、ユーザは作業機械を配置する必要があり、またユーザは、これから作業を行う作業領域に対応する所定の走行経路を選択する必要がある。
一方、作業機械は、自動走行の場合、現在位置と所定の走行経路に基づいて走行経路を自動走行する。すなわち、作業機械は、所定の走行経路に沿うように、フィードバック制御やフィードフォワード制御といった制御によって軌道修正を行いながら走行する。したがって、作業機械は、上記の走行経路開始位置の近くの位置(以下、「進入準備のための位置」ともいう。)から走行を開始すると、現在位置とこれから進入しようとする走行経路とのずれを修正するように軌道修正が行いながら、走行経路に進入し、走行経路上を走行することになる。よって、作業機械が、実際に走行経路上のどの位置で走行経路に進入するのかは制御できない。
したがって、作業機械を作業開始位置の手前で走行経路に前進のみで進入させることができるような、進入準備のための作業機械の配置を行うことは、熟練を要するし、熟練者でもそのような配置に失敗することがある。
また、各作業対象領域にそれぞれ対応する所定の走行経路間の区別は、慣れていないユーザにとっては難しい場合もあり、これから作業を行う作業領域の走行経路を、各作業対象領域にそれぞれ対応する所定の走行経路からユーザが選択することは、手間がかかり、また走行経路の選択の間違いを招くおそれもある。
そのため、作業対象領域までの移動や作業対象領域間の移動も含めて自動走行経路を準備し、すべて自動走行とすることも考えられる。しかしながら、その場合、作業領域間の作業順序を変更することができないので、ある作業領域が作業禁止状態にあった場合、その作業禁止状態が解除されるまで作業を進めることができなくなってしまう。
そこで、本発明は、複数の作業対象領域の各々について、それぞれの作業対象領域に対して対応する所定の走行経路に沿って自動走行しながら所定作業を行う作業機械を用いて作業を行う場合に、作業対象領域の作業順序の変更を柔軟に行うことを可能とすることを目的の1つとする。
また、本発明は、1つ又は複数の作業対象領域の各々について、それぞれの作業対象領域に対して対応する所定の走行経路に沿って自動走行しながら所定作業を行う作業機械を用いて作業を行う場合であって、作業対象領域までの移動や作業対象領域間の移動は、手動運転で行う場合に、作業機械を作業開始位置の手前で走行経路に前進のみで進入させることができるような、進入準備のための作業機械の配置をより確実に行うことができ、これから作業を行う作業領域の走行経路の選択の手間をなくし、誤りを防止するようにすることを目的の1つとする。
本発明の1つの態様は、作業対象領域において、少なくとも複数の略平行な経路の端部を反転経路を介して相互に連結して形成された経路を走行しながら所定作業を行う作業機械の走行経路を生成するシステムであって、前記端部は、前記経路と前記作業対象領域の外周との交点付近に位置し、前記作業対象領域の外周及び前記作業対象領域の外部の進入禁止領域の外周を設定する領域設定部と、前記反転経路の各々について、前記作業対象領域の外周と前記進入禁止領域の外周との位置関係に応じて、前記作業機械が反転経路に前記作業対象領域の外側方向に進入する外側反転経路ではなく、前記作業機械が反転経路に前記作業対象領域の内側方向に進入する内側反転経路を前記走行経路として選択する経路生成部と、を含む走行経路生成システムを提供するものである。
前記経路生成部は、前記反転経路の各々を走行する前記作業機械が、前記進入禁止領域の外周に干渉しないように、前記内側反転経路、前記外側反転経路、のいずれかを前記走行経路として選択することができる。
前記作業対象領域の外周及び前記作業対象領域の外部の進入禁止領域の外周は、測量により得られた、前記作業対象領域の外周及び前記作業対象領域の外部の進入禁止領域の外周に関するデータに基づいて設定されることができる。
前記複数の略平行な経路は直線状の経路とすることができる。
本発明の1つの態様は、前記走行経路生成システムにより生成された走行経路を記憶する記憶部と、前記作業対象領域を走行しながら所定作業を行う前記作業機械の挙動及び現在位置を検出する検出手段と、前記作業対象領域を走行する前記作業機械の現在位置及び前記記憶部に記録された前記走行経路に少なくとも基づいて、前記作業機械に前記走行経路を走行させるための走行制御信号を出力することにより、前記作業機械が備える走行駆動機構を制御する制御手段と、を含む作業機械制御システムを提供するものである。
本発明の1つの態様は、作業機械制御システムから出力される前記走行制御信号に基づいて自己の走行を駆動する走行駆動機構を含む作業機械を提供するものである。
本発明の1つの態様は、作業対象領域において、少なくとも複数の略平行な経路の端部を反転経路を介して相互に連結して形成された経路を走行しながら所定作業を行う作業機械の走行経路を生成する方法であって、前記端部は、前記経路と前記作業対象領域の外周との交点付近に位置し、前記作業対象領域の外周、及び前記作業対象領域の外部の進入禁止領域の外周を設定するステップと、前記反転経路の各々について、前記作業対象領域の外周と前記進入禁止領域の外周との位置関係に応じて、前記作業機械が反転経路に前記作業対象領域の外側方向に進入する外側反転経路ではなく、前記作業機械が反転経路に前記作業対象領域の内側方向に進入する内側反転経路を前記走行経路として選択するステップと、を含む走行経路生成方法を提供するものである。
前記選択するステップは、前記反転経路の各々を走行する作業機械が、前記進入禁止領域の外周に干渉しないように、前記内側反転経路、前記外側反転経路、のいずれかを前記走行経路として選択することができる。
前記作業対象領域の外周及び前記作業対象領域の外部の進入禁止領域の外周は、測量により得られた、前記作業対象領域の外周及び前記作業対象領域の外部の進入禁止領域の外周に関するデータに基づいて設定されることができる。
前記複数の略平行な経路は直線状の経路とすることができる。
本発明の1つの態様は、前記走行経路生成方法をコンピュータに実行させるためのプログラムを提供するものである。
本発明の1つの態様は、前記プログラムを記録したコンピュータ読み取り可能な記録媒体を提供するものである。
本発明の1つの態様は、作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械の現在位置を検出する検出手段と、前記作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定し、進入可能か否かの判定情報を生成する判定情報生成部と、を含む進入可否判定システムを提供するものである。
前記判定情報は、前記進入可否判定システムとは別体の進入可否報知装置に送信されることができる。
前記進入可否判定システムは、前記判定情報に基づいて、進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令を生成する報知信号・命令生成部を更に含むことができる。
前記判定情報、及び/又は前記進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令は、前記進入可否判定システムとは別体の進入可否報知装置に出力及び/又は送信されることができる。
本発明の1つの態様は、作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定する進入可否判定システムであって、前記作業機械の現在位置と向きを検出する検出手段と、前記走行経路が記録された記憶部と、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に対応する、前記記憶部に記録された走行経路上の点である対応点を決定する対応点決定部と、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成する判定情報生成部と、を含み、前記所定の第1の値は、少なくとも前記作業機械の操舵性能、及び所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離を考慮して予め定められたものである進入可否判定システムを提供するものである。
前記検出手段は、更に前記作業機械の向きを検出し、前記判定情報生成部は、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きく、又は前記走行経路上の前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成することができる。
前記所定の第2の値は、30°以下の所定の値とすることができる。
前記進入可否判定システムは、前記作業完了位置を前記記憶部に記録する作業完了位置記録部を更に含み、前記判定情報生成部は、前記所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ前記走行経路における前記作業機械の進行方向に離れた点が、前記作業完了位置よりも前記作業機械の進行方向側に位置する場合に、進入不可能と判定することができる。
本発明の1つの態様は、作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入不可能か否かを判定する進入可否判定システムであって、前記作業機械の現在位置を検出する検出手段と、前記走行経路が記録された記憶部と、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に対応する、前記記憶部に記録された走行経路上の点である対応点を決定する対応点決定部と、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成する判定情報生成部と、を含み、前記所定の第1の値は、少なくとも前記作業機械の操舵性能、及び所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離を考慮して予め定められたものである進入可否判定システムを提供するものである。
前記検出手段は、更に前記作業機械の向きを検出し、前記判定情報生成部は、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きく、又は前記走行経路上の前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成することができる。
前記所定の第2の値は、30°以下の所定の値とすることができる。
前記作業完了位置及び前記作業未完位置を前記記憶部に記録する作業完了・未完位置記録部を更に含み、前記判定情報生成部は、前記所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ前記走行経路における前記作業機械の進行方向に離れた点が、前記作業完了位置又は前記作業未完位置よりも前記作業機械の進行方向側に位置する場合に、進入不可能と判定することができる。
前記対応点は、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に最も近い、前記記憶部に記録された走行経路上の点である最近点とすることができる。
前記対応点は、前記作業完了位置又は前記作業未完位置よりも前記作業機械の進行方向と反対側において、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に最も近い、前記記憶部に記録された走行経路上の点である作業完了側最近点とすることができる。
前記進入可否判定システムは、前記判定情報に基づいて、進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令を生成する報知信号・命令生成部を更に含むことができる。
前記判定情報は、前記進入可否判定システムとは別体の進入可否報知装置に送信されることができる。
前記判定情報、及び/又は前記進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令は、前記進入可否判定システムとは別体の進入可否報知装置に出力及び/又は送信されることができる。
前記判定情報の内容が進入可能である場合に、自動走行による進入開始を前記作業機械に指示する信号を生成することができる。
本発明の1つの態様は、前記作業対象領域を走行する前記作業機械の現在位置及び前記記憶部に記録された前記走行経路に少なくとも基づいて、前記作業機械に前記走行経路を走行させるための走行制御信号を出力することにより、前記作業機械が備える走行駆動機構を制御する制御手段と、前記進入可否判定システムと、を含む作業機械制御システムを提供するものである。
本発明の1つの態様は、前記作業機械制御システムから出力される前記走行制御信号に基づいて自己の走行を駆動する走行駆動機構を含む作業機械を提供するものである。
本発明の1つの態様は、作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械の現在位置を検出するステップと、前記作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定し、前記進入可能か否かの判定情報を生成するステップと、を含む進入可否判定方法を提供するものである。
前記判定情報は、前記進入可否判定システムとは別体の進入可否報知装置に送信されることができる。
前記進入可否判定方法は、前記判定情報に基づいて、進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令を生成するステップを更に含むことができる。
前記判定情報、及び/又は前記進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令は、進入可否報知装置に出力及び/又は送信されることができる。
本発明の1つの態様は、作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能か否かを判定する進入可否判定方法であって、前記作業機械の現在位置と向きを検出するステップと、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に対応する、前記記憶部に記録された走行経路上の点である対応点を決定するステップと、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成するステップと、を含み、前記所定の第1の値は、少なくとも前記作業機械の操舵性能、及び所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離を考慮して予め定められたものである進入可否判定方法を提供するものである。
前記検出するステップは、更に前記作業機械の向きを検出し、前記判定情報を生成するステップは、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きく、又は前記走行経路上の前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成することができる。
前記所定の第2の値は、30°以下の所定の値とすることができる。
前記進入可否判定方法は、前記作業完了位置を記録するステップと、前記所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ前記走行経路における前記作業機械の進行方向に離れた点が、前記作業完了位置よりも前記作業機械の進行方向側に位置する場合に、進入不可能と判定するステップと、を更に含むことができる。
本発明の1つの態様は、作業対象領域を所定の走行経路に沿って走行しながら所定作業を行う作業機械が、前記走行経路を離脱した場合に、前記走行経路上の作業完了位置又は作業未完位置よりも前記作業機械の進行方向と反対側に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入不可能か否かを判定する進入可否判定方法であって、前記作業機械の現在位置を検出するステップと、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に対応する、前記記憶部に記録された走行経路上の点である対応点を決定するステップと、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成するステップと、を含み、前記所定の第1の値は、少なくとも前記作業機械の操舵性能、及び所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離を考慮して予め定められたものである進入可否判定方法を提供するものである。
前記検出するステップは、更に前記作業機械の向きを検出し、前記判定情報を生成するステップは、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きく、又は前記走行経路上の前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、進入不可能と判定し、前記進入可能か否かの判定情報を生成することができる。
前記所定の第2の値は、30°以下の所定の値とすることができる。
前記作業完了位置及び前記作業完了位置を記録するステップと、
前記所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ前記走行経路における前記作業機械の進行方向に離れた点が、前記作業完了位置又は前記作業未完位置よりも前記作業機械の進行方向側に位置する場合に、進入不可能と判定するステップとを更に含むことができる。
前記対応点は、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に最も近い、走行経路上の点である最近点とすることができる。
前記対応点は、前記作業完了位置又は前記作業未完位置よりも前記作業機械の進行方向と反対側において、前記作業機械の前記検出手段によって検出された前記進入準備のための現在位置に最も近い、前記記憶部に記録された走行経路上の点である作業完了側最近点とすることができる。
前記進入可否判定方法は、前記判定情報に基づいて、進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令を生成するステップを更に含むことができる。
前記判定情報は、進入可否報知装置に送信されることができる。
前記判定情報、及び/又は前記進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令は、進入可否報知装置に出力及び/又は送信されることができる。
前記判定情報の内容が進入可能である場合に、自動走行による進入開始を前記作業機械に指示する信号を生成することができる。
本発明の1つの態様は、前記進入可否判定方法をコンピュータに実行させるためのプログラムを提供するものである。
本発明の1つの態様は、前記プログラムを記録したコンピュータ読み取り可能な記録媒体を提供するものである。
本発明の1つの態様は、1つ又は複数の作業対象領域の各々について、それぞれの作業対象領域に対応する所定の走行経路に沿って自動走行しながら所定作業を行う作業機械のための走行経路自動選択システムであって、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路について、少なくとも走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分を記録する記憶部と、前記作業機械の現在位置を取得する現在位置取得手段と、前記走行経路開始位置と前記作業開始位置の間に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能であるという条件を満たす走行経路を、前記記憶部に記録された、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の少なくとも走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分に少なくとも基づいて、前記条件を満たすか否かを判定することによって、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の中から検索する走行経路検索部と、を含む走行経路自動選択システムを提供するものである。
前記走行経路検索部は、前記記憶部に記録された、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の少なくとも走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分について、前記現在位置取得手段によって取得された前記進入準備のための現在位置に対応する、前記走行経路部分上の点である対応点をそれぞれ決定し、前記走行経路部分の各々について、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きい場合に、前記条件を満たさないと判定し、前記所定の第1の値は、少なくとも前記作業機械の操舵性能、及び所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離を考慮して予め定められたものであるとすることができる。
前記走行経路検索部は、前記所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ前記走行経路における前記作業機械の進行方向に離れた点が、前記作業開始位置よりも前記作業機械の進行方向側に位置する場合に、前記条件を満たさないと判定することができる。
前記走行経路自動選択システムは、前記作業機械の向きを取得する方位取得手段を更に有し、前記走行経路検索部は、前記走行経路上の前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、前記条件を満たさないと判定することができる。
前記記録部が、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路について、走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分を含む走行開始可能エリアを記録するか、又は前記走行経路検索部が、前記走行経路部分に基づいて走行開始可能エリアを生成し、前記走行経路検索部は、前記走行開始可能エリアの各々について、前記作業機械の現在位置が前記走行開始可能エリア内にあるか否かに基づいて、前記条件を満たす走行経路を、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の中から検索することができる。
前記走行開始可能エリアは、前記走行経路部分に対して前記走行経路部分の両側に所定の第1の値の幅を有することができる。
前記走行開始可能エリアは、前記作業機械の手動運転による目標位置からのずれについて最大想定される量の少なくともの2倍の長さを有することができる。
前記走行経路部分は直線とすることができる。
走行開始可能エリアは、矩形とすることができる。
前記走行経路自動選択システムは、前記作業機械の向きを取得する方位取得手段を更に有し、前記走行経路検索部は、前記記憶部に記録された、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の少なくとも走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分について、前記現在位置取得手段によって取得された前記進入準備のための現在位置に対応する、前記走行経路部分上の点である対応点をそれぞれ決定し、前記走行経路の各々について、前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、前記条件を満たさないと判定することができる。
前記走行経路自動選択システムは、前記作業機械の向きを取得する方位取得手段を更に有し、前記走行経路検索部は、前記走行経路部分の各々について、前記走行経路部分の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、前記条件を満たさないと判定することができる。
前記所定の第2の値は、30°以下の所定の値とすることができる。
前記1つ又は複数の作業対象領域のうちの少なくとも1つの作業対象領域の各々にそれぞれ対応する前記所定の走行経路は複数であり、前記走行経路開始位置から前記作業開始位置に向かう方向が異なる2つの走行経路を含むことができる。
前記走行経路検索部は、前記条件を満たす走行経路が発見された場合、前記条件を満たす走行経路を識別するための情報、並びに走行経路に進入可能な位置にいる旨の報知を指示する信号及び/又は命令を生成することができる。
前記走行経路検索部は、前記条件を満たす走行経路が発見された場合、更に自動運転開始指示の入力の要求の報知を指示する信号及び/又は命令を生成することができる。
前記自動運転開始指示の入力の要求の報知は、ユーザが前記作業機械に乗車していないと判定した後に行われることができる。
前記走行経路検索部は、前記条件を満たす走行経路が発見された場合、更に前記条件を満たす走行経路に関する情報の報知を指示する信号及び/又は命令を生成することができる。
前記記憶部は、前記1つ又は複数の作業対象領域の各々の作業履歴を記録していることができる。
前記条件を満たす走行経路に関する情報は、前記条件を満たす走行経路の作業対象領域の前記作業履歴又は該作業履歴から得られる情報とすることができる。
前記1つ又は複数の作業対象領域のうちの少なくとも1つの作業対象領域の各々にそれぞれ対応する前記所定の走行経路は複数であり、前記複数の所定の走行経路のうちの少なくとも2つは、前記走行経路開始位置から所定距離の走行経路部分が同一であり、前記作業対象領域内の走行経路が互いに異なる走行経路を含み、前記走行経路検索部により検索される前記複数の所定の走行経路のうちの少なくとも2つの中から、所定の選択条件に基づいて、1つの走行経路が選択されることができる。
本発明の1つの態様は、前記走行経路自動選択システムと、前記作業対象領域を走行する前記作業機械の現在位置及び前記走行経路検索部により発見された前記条件を満たす走行経路に少なくとも基づいて、前記作業機械に前記走行経路を走行させるための走行制御信号を出力することにより、前記作業機械が備える走行駆動機構を制御する制御手段と、を含む作業機械制御システムを提供するものである。
本発明の1つの態様は、前記作業機械制御システムから出力される前記走行制御信号に基づいて自己の走行を駆動する走行駆動機構を含む作業機械を提供するものである。
本発明の1つの態様は、1つ又は複数の作業対象領域の各々について、それぞれの作業対象領域に対応する所定の走行経路に沿って自動走行しながら所定作業を行う作業機械のための走行経路自動選択方法であって、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路について、少なくとも走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分を記憶部に記録するステップと、前記作業機械の現在位置を取得するステップと、前記走行経路開始位置と前記作業開始位置の間に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能であるという条件を満たす走行経路を、前記記憶部に記録された、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の少なくとも走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分に少なくとも基づいて、前記条件を満たすか否かを判定することによって、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の中から検索するステップと、を含む走行経路自動選択方法を提供するものである。
前記走行経路自動選択方法は、前記記憶部に記録された、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の少なくとも走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分について、前記作業機械の現在位置を取得するステップによって取得された前記進入準備のための現在位置に対応する、前記走行経路部分上の点である対応点をそれぞれ決定し、前記走行経路部分の各々について、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きい場合に、前記条件を満たさないと判定するステップを更に含み、前記所定の第1の値は、少なくとも前記作業機械の操舵性能、及び所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離を考慮して予め定められたものとすることができる。
前記走行経路自動選択方法は、前記所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ前記走行経路における前記作業機械の進行方向に離れた点が、前記作業開始位置よりも前記作業機械の進行方向側に位置する場合に、前記条件を満たさないと判定するステップを更に含むことができる。
前記走行経路自動選択方法は、前記作業機械の向きを取得するステップと、前記走行経路上の前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、前記条件を満たさないと判定するステップと、を更に含むことができる。
前記記録部が、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路について、走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分を含む走行開始可能エリアを記録しており、前記走行経路自動選択方法は、前記走行開始可能エリアの各々について、前記作業機械の現在位置が前記走行開始可能エリア内にあるか否かに基づいて、前記条件を満たす走行経路を、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の中から検索するステップを含むことができる。
前記走行経路自動選択方法は、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路について、前記走行経路部分に基づいて走行開始可能エリアを生成するステップと、前記走行開始可能エリアの各々について、前記作業機械の現在位置が前記走行開始可能エリア内にあるか否かに基づいて、前記条件を満たす走行経路を前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の中から検索するステップと、を含むことができる。
前記走行開始可能エリアは、前記走行経路部分に対して前記走行経路部分の両側に所定の第1の値の幅を有することができる。
前記走行開始可能エリアは、前記作業機械の手動運転による目標位置からのずれについて最大想定される量の少なくともの2倍の長さを有することができる。
前記走行経路部分は直線とすることができる。
走行開始可能エリアは、矩形とすることができる。
前記走行経路自動選択方法は、前記作業機械の向きを取得するステップと、前記記憶部に記録された、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の少なくとも走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分について、前記作業機械の現在位置を取得するステップによって取得された前記進入準備のための現在位置に対応する、前記走行経路部分上の点である対応点をそれぞれ決定し、前記走行経路の各々について、前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、前記条件を満たさないと判定するステップと、を更に含むことができる。
前記走行経路自動選択方法は、前記作業機械の向きを取得するステップと、
前記走行経路部分の各々について、前記走行経路部分の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、前記条件を満たさないと判定するステップと、を更に含むことができる。
前記所定の第2の値は、30°以下の所定の値とすることができる。
前記1つ又は複数の作業対象領域のうちの少なくとも1つの作業対象領域の各々にそれぞれ対応する前記所定の走行経路は複数であり、前記走行経路開始位置から前記作業開始位置に向かう方向が異なる2つの走行経路を含むことができる。
前記検索するステップにおいて、前記条件を満たす走行経路が発見された場合、前記条件を満たす走行経路を識別するための情報、並びに走行経路に進入可能な位置にいる旨の報知を指示する信号及び/又は命令を生成することができる。
前記検索するステップにおいて、前記条件を満たす走行経路が発見された場合、更に自動運転開始指示の入力の要求の報知を指示する信号及び/又は命令を生成することができる。
前記自動運転開始指示の入力の要求の報知は、ユーザが前記作業機械に乗車していないと判定した後に行われることができる。
前記検索するステップにおいて、前記条件を満たす走行経路が発見された場合、更に前記条件を満たす走行経路に関する情報の報知を指示する信号及び/又は命令を生成することができる。
前記記憶部は、前記1つ又は複数の作業対象領域の各々の作業履歴を記録していることができる。
前記条件を満たす走行経路に関する情報は、前記条件を満たす走行経路の作業対象領域の前記作業履歴又は該作業履歴から得られる情報とすることができる。
前記1つ又は複数の作業対象領域のうちの少なくとも1つの作業対象領域の各々にそれぞれ対応する前記所定の走行経路は複数であり、前記複数の所定の走行経路のうちの少なくとも2つは、前記走行経路開始位置から所定距離の走行経路部分が同一であり、前記作業対象領域内の走行経路が互いに異なる走行経路を含み、前記検索するステップにおいて検索される前記複数の所定の走行経路のうちの少なくとも2つの中から、所定の選択条件に基づいて、1つの走行経路が選択されることができる。
本発明の1つの態様は、前記走行経路自動選択方法をコンピュータに実行させるためのプログラムを提供するものである。
本発明の1つの態様は、前記プログラムを記録したコンピュータ読み取り可能な記録媒体を提供するものである。
本明細書及び特許請求の範囲において、「作業完了位置」、「作業未完位置」とは、作業機械が走行経路から離脱した時の最終の作業完了位置、最初の作業未完位置をそれぞれ意味する。
本明細書及び特許請求の範囲において、「対応点」とは、進入準備のための現在位置が、作業機械が、所定の走行経路から逸脱した結果位置している位置であると仮定した場合に、仮に逸脱することなく走行していたとすると走行経路上ではどの点に対応するかを考えた場合の走行経路上の対応点を意味する。
本明細書及び特許請求の範囲において、「作業開始位置」とは、1つ又は複数の作業対象領域の各々にそれぞれ対応する所定の走行経路において、作業機械が初めて作業を開始する位置を意味する。
上記構成を有する本発明によれば、複数の作業対象領域の各々について、それぞれの作業対象領域に対して対応する所定の走行経路に沿って自動走行しながら所定作業を行う作業機械を用いて作業を行う場合に、作業対象領域の作業順序の変更を柔軟に行うことができる。
また、上記構成を有する本発明によれば、1つ又は複数の作業対象領域の各々について、それぞれの作業対象領域に対して対応する所定の走行経路に沿って自動走行しながら所定作業を行う作業機械を用いて作業を行う場合であって、作業対象領域までの移動や作業対象領域間の移動は、手動運転で行う場合に、作業機械を作業開始位置の手前で走行経路に前進のみで進入させることができるような、進入準備のための作業機械の配置をより確実に行うことができ、これから作業を行う作業領域の走行経路の選択の手間をなくし、誤りを防止することができる。
芝刈り作業に必要となる装置類の全体概要図。 芝刈り作業に必要となる装置類の全体概要図。 (a)は本発明を適用した芝刈り機の側面外観図、同(b)は上面外観図。 (a)はゴルフ場での作業領域の外周の設定と進入禁止領域の外周の設定の説明図。 走行経路生成処理のフローチャート。 直線経路の設定を説明するための図。 反転経路のタイプを説明するための図。 生成される走行経路の一例図。 生成される走行経路の別例図。 進入可否判定処理のフローチャート。 芝刈り機が進入準備のための位置に配置されている状態の一例図。 走行経路自動選択処理のフローチャート。 複数の作業対象のホールの各々にそれぞれ対応する走行経路、走行経路開始位置、作業開始位置、開始つなぎ経路の位置関係の一例図。 芝刈り機が進入準備のための位置に配置されている状態の一例図。
以下、本発明の作業機械、作業機械の走行経路への進入可否判定のための装置、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御装置を、ゴルフ場の芝刈りを行う芝刈り機に適用した場合の実施の形態例を説明する。一般的な芝刈り機は、前進しながら芝刈り作業を行うように設計されている。ゴルフ場のグリーン等の芝を刈る場合、ライン状に芝が刈られた後の隣り合うラインの芝目がそれぞれ逆方向となるように芝刈り機に規則的に芝刈り作業を行わせることが望まれる。グリーン等とラフとの境界についても、なるべく滑らかになるように芝刈り作業を行うことが望まれる。
そのため、本実施形態では、芝刈対象領域であるグリーン等の周縁の芝を刈るための外周経路、及び、グリーン等の芝を規則的に刈るための反転経路を介して相互に連結された略平行な直線経路を芝刈り機に走行させ、それぞれの経路で芝刈り作業させる場合の例を説明する。ここで、本実施形態は、隣接する直線経路が反転経路を介して連結して形成され、芝刈り機が隣接する直線経路を順次逆方向に走行する例を説明するが、例えば特許第3454666号に示されるように、ある直線経路が、いくつかの隣接する直線経路を飛ばした直線経路に反転経路を介して連結して形成された経路(以下、「飛ばし経路」ともいう。)を走行経路の一部又は全部としてもよい。また、略平行な直線経路に替えて、略平行な曲線経路としてもよい。
なお、直線経路での作業が終了した後に外周経路での芝刈り作業を開始するか、外周経路での芝刈り作業を先行させるかは任意であるが、本実施形態では、前者の例を説明する。
<全体概要>
芝刈り作業に必要となる装置類の全体概要を図1(a)、(b)に示す。本実施形態では、RTK−GPS方式(Real Time Kinematic GPS:干渉測位方式)を用いて、現在位置の計測を行いながらゴルフ場の芝刈り作業を行う芝刈り機1の例を示す。
基地局2は、RTK−GPSの基準局に相当するGPS受信装置21及び送受信装置22と、GPSアンテナ25と、通信アンテナ26とを備えている。基地局2は、その経度、緯度、高さが既知の地点に設置される。GPS受信装置21は、芝刈り機1の位置情報の誤差を補正するための補正情報を生成する。この補正情報は、送受信装置22及び通信アンテナ26を通じて、芝刈り機1へ適宜送信される。補正情報の送信タイミングは、例えば、芝刈り機1が要求するタイミングであったり、所定の間隔(例えば100ms毎)であったりする。
本実施形態においては、測位方式として、RTK−GPS方式を用いているが、デファレンシャルGPS方式(Differential GPS:相対測位方式)を用いてもよい。
芝刈り機1は、制御装置10、車速センサ11、方位角速度センサ12、駆動制御部13、GPSアンテナ15、通信アンテナ16、操作入力部17、表示部18、音声出力部19を備えている。
制御装置10は、本発明の作業機械制御システムの一例となるもので、CPU、通信機能、ストレージ機能(内部記録媒体並びに外部記録媒体に対するドライブユニット及び/又は入出力インタフェース)及び表示機能(ディスプレイ)を備えたコンピュータ装置と、所定のコンピュータプログラムとで構成される。このコンピュータプログラムは、コンピュータ装置を、GPS受信部101、送受信部102、車両情報受信部105、駆動指令部106、制御情報生成部107、記憶部108、リムーバブル記録媒体インタフェース部109、主制御部112、作業完了・未完位置記録部121、対応点決定部122、判定情報生成部123、報知信号・命令生成部124として機能させる。主制御部112は、各部の動作を統括的に制御する。このコンピュータ装置は、時刻データと制御動作の同期クロックとを出力するRTC(Real Time Clock)モジュールを備えたものである。芝刈り機が方位角速度センサを備えていない等の場合のために、制御装置10が、方位角速度センサを備えてもよい。制御装置10の詳細については後述する。
車速センサ11は、芝刈り機1の前進又は後退する際の走行速度を検出する。方位角速度センサ12は、三次元軸線回り(ロール、ピッチ、ヨー)の角速度により芝刈り機1の傾き、旋回、ふらつき等の挙動(動態)を検出する。方位角速度センサ12で計測すべきデータを加速度計で代用しても良い。また、芝刈り機1が備える各種計器の計測結果を取り込むことで、センサ11,12を代用することもできる。
駆動制御部13は、後述する作業制御信号に基づいて芝刈り機1が備える刈り刃の昇降及び作動等を駆動する作業駆動機構を制御したり、後述する走行制御信号に基づいて芝刈り機1の右左折、前進、後退等を駆動する走行駆動機構を制御する。この駆動制御部13は、図示されるように、制御装置10とは別に設けても良いが、制御装置10の一機能として実現しても良い。
GPSアンテナ15は、GPS衛星から送信されたGPSデータを受信する位置検出センサとして機能するものである。通信アンテナ16は、基地局2の通信アンテナ26との間の通信を可能にする。この通信は、上記の芝刈り機1の位置情報の誤差を補正するための補正情報、芝刈り機1のオペレータとの通信、芝刈り機1の遠隔操作のための信号等の送受信に使用される。
操作入力部17は、キーボードやマウス等から構成されるが、これらに限定されるものではない。
表示部18は、CRT、液晶ディスプレイ、積層表示灯等から構成されるが、これらに限定されるものではない。
音声出力部19は、スピーカ等から構成されるが、これに限定されるものではない。
走行経路生成装置3は、CPU、通信機能、ストレージ機能(内部記録媒体並びに外部記録媒体に対するドライブユニット及び/又は入出力インタフェース)、入力機能(キーボード、マウス等)、表示機能(ディスプレイ)を備えたコンピュータ装置と、所定のコンピュータプログラムとで構成される。このコンピュータプログラムは、コンピュータ装置を、領域設定部301、経路生成部302、動作設定部303、主制御部304を含む制御部30、操作入力部31、表示部32、記憶部33、リムーバブル記録媒体インタフェース部34、送受信部35として機能させる。主制御部304は、各部の動作を統括的に制御する。走行経路生成装置3の詳細については後述する。
<芝刈り機>
芝刈り機1の外観を図2(a)、(b)に示す。図2(a)は芝刈り機1を側面から見た外観図、同(b)は上面から見た外観図である。上述した制御装置10、車速センサ11、方位角速度センサ12、駆動制御部13、及び走行駆動機構及び作業駆動機構は、芝刈り機1の機体に内蔵されている。
方位角速度センサ12は、芝刈り機1の挙動が正しく伝達される位置に設置される。GPSアンテナ15は、芝刈り機1の機体のほぼ中心部位、すなわち機体の長さ方向と幅方向それぞれのほぼ中心となるように備えられる。また、通信アンテナ16は、GPSアンテナ15の受信の障害にならないように芝刈り機1の機体の後方表面から突出するように取り付けられる。
芝刈り機1は、芝を刈るための一対の刈り刃18、19を備えている。前方の刈り刃18は、走行方向と直交する方向の刈り幅W[m]のうち、左右端の芝を刈り取る。後方の刈り刃19は、刈り幅W[m]のうち、中央部の芝を刈り取る。この刈り幅W[m]が、芝刈り機1の1回の走行、作業で芝を刈りとることができる作業幅となる。
<制御装置>
図1(a)に戻り、制御装置10のGPS受信部101は、GPSアンテナ15で受信したGPSデータを制御情報生成部107へ出力する。送受信部102は、通信アンテナ16を介して、制御情報生成部107と基地局2との間の通信を可能にし、通信アンテナ16で受信した芝刈り機1の位置情報の誤差を補正するための補正情報を制御情報生成部107に出力する。制御情報生成部107は、GPSアンテナ15で受信したGPSデータと通信アンテナ16で受信した芝刈り機1の位置情報の誤差を補正するための補正情報に基づいて、芝刈り機1の現在位置を表す位置情報を生成する。また、送受信部102は、有線若しくは無線、又はLAN(Local Area Network)若しくは公衆通信回線を問わず任意のネットワークに接続されることができる。
車両情報受信部105は、車速センサ11及び方位角速度センサ12、及び/又はGPSデータによる位置の追跡から、芝刈り機1の走行速度、方位、挙動を表す検知情報を取得する。取得した情報がアナログデータの場合には、それらをデジタルデータに変換して出力する。その際、必要に応じて、方位角速度センサ12の出力からオフセット成分及びドリフト成分の除去処理等を施すデータ補正を行う。車両情報受信部105の出力情報は、現在時刻データと関連付けて、記憶部108に記録される。
駆動指令部106は、制御情報生成部107の出力情報(走行制御信号/作業制御信号)に基づいて、芝刈り機1を走行制御あるいは作業制御するために走行駆動機構あるいは作業駆動機構の制御内容を定めた情報を駆動制御部13へ出力する。駆動制御部13は、この情報をもとに、芝刈り機の走行駆動機構あるいは作業駆動機構を制御する。これにより、芝刈り機1による芝刈り作業が可能となる。
記憶部108は、後述の走行経路生成装置3により生成された走行経路及び動作データや所定のコンピュータプログラム等を記録することができる。記憶部108は、ハードディスクや半導体メモリ等の任意の数の記憶部品から構成されるが、これらに限定されるものではない。
リムーバブル記録媒体インタフェース部109には、CD−ROMやDVD等の光ディスク、USBメモリ、SDメモリカード等のリムーバブル記録媒体40が着脱自在に装着することができる。また、リムーバブル記録媒体インタフェース部109は、装着されたリムーバブル記録媒体40に記録されたデータを読み出したり、リムーバブル記録媒体40にデータを書き込んだりすることができる。リムーバブル記録媒体インタフェース部109は、例えばリムーバブル記録媒体40がCD−ROMやDVD等の光ディスクであれば専用のリーダ/ライタ等であり、USBメモリであればUSBポート等であり、SDメモリカードであればカードスロット等であるが、これらに限定されるものではない。
後述の走行経路生成装置3により生成された走行経路及び動作データが、記憶部108又はリムーバブル記録媒体インタフェース部109に装着されたリムーバブル記録媒体40に記録されており、制御情報生成部107は、その走行経路及び動作データとGPSデータや各種センサ11等より取得した現在位置とに基づいて、走行制御信号及び作業制御信号を生成し、出力する。これにより自動走行による作業を可能にする。
制御装置10に含まれる進入可否判定装置60に特有の構成である、作業完了・未完位置記録部121、対応点決定部122、判定情報生成部123、報知信号・命令生成部124については、次の<進入可否判定装置>の項で、走行経路自動選択装置70に特有の構成である走行経路検索部125については、次の<走行経路自動選択装置>の項で説明する。
<進入可否判定装置>
進入可否判定装置60は、本発明の進入可否判定システムの一例となるもので、図1aの制御装置10内の点線で囲まれた部分に相当する。上で説明した制御装置10の構成と重複する構成については説明を省略する。
作業完了・未完位置記録部121は、芝刈り機1が芝刈り作業のために走行経路を走行している途中で、芝刈り機1の走行を停止し、走行経路を離脱した時の最終の芝刈り作業完了位置及び最初の芝刈り作業未完位置を記憶部108に記録する。
対応点決定部122は、検出された芝刈り機1の進入準備のための現在位置に最も近い、記憶部108に記録された走行経路上の点である最近点を決定する。
判定情報生成部123は、芝刈り機1の進入準備のための現在位置と最近点との距離が所定の第1の値よりも大きく、又は走行経路上の最近点における接線に対する、進入準備のための現在位置における芝刈り機1の向きの角度の絶対値が所定の第2の値よりも大きい場合に、芝刈り機1の走行経路への進入が不可能であると判定し、進入可能か否かの判定情報を生成する。
報知信号・命令生成部124は、判定情報に基づいて、進入可能及び/又は進入不可能の報知を指示する信号又は命令を生成する。
作業完了・未完位置記録部121、対応点決定部122、判定情報生成部123、報知信号・命令生成部124の動作の詳細については後述する。
<走行経路自動選択装置>
走行経路自動選択装置70は、本発明の走行経路自動選択システムの一例となるもので、図1aの制御装置10内の一点鎖線で囲まれた部分に相当する。上で説明した制御装置10の構成と重複する構成については説明を省略する。
走行経路検索部125は、複数の作業対象領域の各々にそれぞれ対応する所定の走行経路について、走行経路開始位置と作業開始位置の間に位置する進入位置において、芝刈り機1が、進入位置において走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、芝刈り機1が、芝刈り機1の進入準備のための現在位置から前進のみで進入可能であるという条件を満たす走行経路を、記憶部108に記録された、複数の作業対象領域の各々にそれぞれ対応する所定の走行経路の少なくとも走行経路開始位置から作業開始位置の間の走行経路開始位置から所定距離の走行経路部分に少なくとも基づいて、前記条件を満たすか否かを判定することによって、複数の作業対象領域の各々にそれぞれ対応する所定の走行経路の中から検索する。
<走行経路生成装置>
走行経路生成装置3は、本発明の走行経路生成システムの一例となるもので、芝刈り機1が走行するための走行経路は、走行経路生成装置3によって生成される。図1(b)を参照して、操作入力部31は、キーボードやマウス等から構成されるが、これらに限定されるものではない。表示部32は、CRTや液晶ディスプレイ等から構成されるが、これらに限定されるものではない。
記憶部33は、後述の走行経路生成装置3により生成された走行経路及び動作データや所定のコンピュータプログラム等を記録することができる。記憶部33は、ハードディスクや半導体メモリ等の任意の数の記憶部品から構成されるが、これらに限定されるものではない。
リムーバブル記録媒体インタフェース部34には、CD−ROMやDVD等の光ディスク、USBメモリ、SDメモリカード等のリムーバブル記録媒体40が着脱自在に装着することができる。また、リムーバブル記録媒体インタフェース部34は、装着されたリムーバブル記録媒体40に記録されたデータを読み出したり、リムーバブル記録媒体40にデータを書き込んだりすることができる。リムーバブル記録媒体インタフェース部34は、例えばリムーバブル記録媒体40がCD−ROMやDVD等の光ディスクであれば専用のリーダ/ライタ等であり、USBメモリであればUSBポート等であり、SDメモリカードであればカードスロット等であるが、これらに限定されるものではない。
送受信部35は、有線若しくは無線、又はLAN(Local Area Network)若しくは公衆通信回線を問わず任意のネットワークに接続されることができる。送受信部35は、例えば、後述の走行経路生成装置3により生成された走行経路及び動作データをネットワークを介して制御装置1に送信することができる。
制御部30は、領域設定部301、経路生成部302、動作設定部303を有する。領域設定部301は、芝刈り機1が芝刈り作業を行う作業対象領域の外周50、及び崖、バンカー、岩、立木などの存在のために芝刈り機1の進入が禁止である進入禁止領域51の外周の設定を行う。
具体的には、領域設定部301は、図3(b)に、座標A1、A2、・・・、An、座標I11、I12、I13、・・・、座標I21、I22、I23、・・・として例示されるような、GPSデータ等を用いる公知の測量装置によって実際に測量された作業対象領域の外周50及び進入禁止領域の外周51についての離散的な位置情報の集合が記録された記録媒体の情報をリムーバブル記録媒体インタフェース部を介して読み出し、作業対象領域の外周50及び進入禁止領域の外周51についての離散的な位置情報の隣り合う座標の各々を繋いだものを作業対象領域の外周50及び進入禁止領域の外周51として記憶部33に記録する。測量装置はGPSデータ等を用いるものに限定されず、任意のものを用いることができる。また、作業対象領域の外周50及び進入禁止領域の外周51についての緯度経度などを操作入力部31を介して直接入力してもよい。設定された作業対象領域の外周50及び進入禁止領域の外周51を任意の方法で修正することができるようにしてもよい。
経路生成部302は、領域設定部301によって設定された作業対象領域の外周50に基づいて外周経路Cを生成する。経路生成部302は更に、後述のとおり、生成された外周経路Cに基づいて、直線経路を生成するとともに、例えば、任意に設定された自動走行経路開始位置から、ある直線経路の作業開始位置までの走行経路、全ての直線経路での作業が終了した位置から外周経路の作業開始位置までの走行経路、外周経路の作業終了位置から任意に設定された自動走行終了位置までの走行経路である「つなぎ経路」をも生成する。つまり、芝刈り機1が走行すべき経路を記憶部33に記録する。
経路生成部302は、操作入力部31を介して入力された芝刈り機1の機体サイズ、刈り刃の刈り幅、最小旋回半径や旋回時に描く曲線の形状等の旋回特性を含む属性情報、隣接する直線経路間の間隔と、作業対象領域の外周50と進入禁止領域の外周51との位置関係とに基づいて、一つの直線経路(第1直線経路)を走行し終えた芝刈り機1が次の直線経路(第2直線経路)へと方向転換するための反転経路のタイプを、少なくとも反転経路上を走行する芝刈り機1が進入禁止領域の外周51に干渉しないように選択し、第1及び第2直線経路に連結し、走行経路として記憶部33に記録する。
動作設定部303は、経路生成部302によって生成された走行経路と関連づけられた、芝刈り機1の走行中あるいは停止中の刈り刃18,19の昇降動作や刈り刃18,19の回転の起動又は停止などを含む芝刈り作業に係る各種設定、芝刈り機1の速度や反転経路走行時の進行方向(前進又は後進)を含む動作データを生成する。
以上の装置構成を前提に、本発明の一実施形態に係る走行経路生成装置の走行経路生成処理の例を図4に示すフローチャート、図7に示す生成される走行経路等を参照して、以下に説明する。なお、説明の便宜上、図7における、作業対象領域の外周50、進入禁止領域の外周51、直線経路、反転経路の各々の縮尺や形状は一部正確ではない。
ステップS1において、上述のように、領域設定部301は、図3(b)に、座標A1、A2、・・・、An、座標I11、I12、I13、・・・、座標I21、I22、I23、・・・として例示されるような、GPSデータ等を用いる公知の測量装置によって実際に測量された作業対象領域の外周50及び進入禁止領域の外周51についての離散的な位置情報の集合が記録された記録媒体の情報をリムーバブル記録媒体インタフェース部を介して読み出し、作業対象領域の外周50及び進入禁止領域の外周51についての離散的な位置情報の隣り合う座標の各々を繋いだものを作業対象領域の外周50及び進入禁止領域の外周51として記憶部33に記録する。
ステップS2において、操作入力部31を介して、芝刈り機1の機体サイズ、速度特性、刈り刃の刈り幅、最小旋回半径や旋回時に描く曲線の形状等の旋回特性を含む属性情報、隣接する直線経路間の間隔が入力される。入力される情報の一部又は全部は、記憶部33に予め記憶しておき、これを読み出す方式としてもよい。ここで、隣接する直線経路間の間隔は、刈り刃の刈り幅に基づいて、隣接する直線経路での刈り幅のオーバーラップ量を考慮して決められるものであり、入力された刈り刃の刈り幅に基づいて経路生成部302が自動計算をしてもよい。
ステップS3において、外周経路Cは、刈り刃18の刈り幅Wを考慮すると、作業対象領域の外周50から約W/2[m]だけ内側となるので、経路生成部302は、作業対象領域の外周50から外周経路Cを生成する。
ステップS4において、経路生成部302は、生成された外周経路Cに基づいて直線経路を生成する。まず、直線経路の作業開始位置Plsと作業開始位置Plsに対向する直線経路の端部P1が操作入力部31を介して指定される。この作業開始位置Plsと端部P1を通過する直線とステップS2で入力された隣接する直線経路間の間隔だけ離れて生成された直線群の中から、外周経路Cとの交点を持つものを選択して、その交点につながる線分を直線経路とする。
例えば、図5に示すように、外周経路Cと直線経路との交点のうち、作業開始位置Plsである交点(座標)をP0とする。また、外周経路Cを挟んで交点(座標)P0(Pls)と対向する交点(座標)がP1となる。さらに、交点(座標)P1に対して反時計回り方向で隣接する交点(座標)をP2、外周経路Cを挟んで交点(座標)P2と対向する交点(座標)をP3とする。以下同様に、交点(座標)P4から交点(座標)P19(Ple)まで、順番に番号を割り当てていく。このように、複数の交点(座標)に対して0から順番に番号を割り当てていく作業をラベリングといい、番号をラベルという。ラベリングの順番が、芝刈り機1が直線経路を走行する際に通過する、外周経路Cとの交点(座標)の順番となる。
つまり、芝刈り機1は、交点(座標)P0(Pls)から交点(座標)P1に向かって直線経路を走行し、その後、交点(座標)P2から交点(座標)P3に方向転換して、順次、直線経路を走行する。交点(座標)P4以降についても同様となる。
設定された作業対象領域の外周50と進入禁止領域の外周51、生成された直線経路は表示部32に表示され、ユーザは操作入力部31を介した入力によって、生成された直線経路の位置や方向、隣接する直線経路間の間隔等の修正を行うことができる。
本実施形態では、略平行な経路を直線経路としたが、任意の曲線経路としてもよい。
本実施形態では、直線経路の作業開始位置Plsに対して、作業開始位置Plsに対向する直線経路の端部P1を指定することによって直線経路の傾きを決定したが、直線経路の作業開始位置Plsを指定した後に、経路生成部302が、記憶部30に記憶されたユーザが予め設定した規則に基づいて、直線経路の傾き(曲線経路の場合は曲線経路の方向)を自動的に決定してもよい。ユーザが予め設定する規則としては、例えば、指定された直線経路の作業開始位置Plsを通過する直線及びその直線に基づく直線群を、直線経路の作業開始位置Plsを中心として回転させ、外周経路Cとの交点につながる線分群において最大の長さの線分が得られる傾きを直線経路の傾きとすることが考えられる。
本実施形態では作業領域は一つの方向の直線で刈り込んだ一つの面で構成されるが、ゴルフ場でのドックレッグコースのような場合では、全体を同じ方向に刈り込まず、コースをいくつかの部分に分けて、その各部分について刈り込む方向を一つの方向に揃える場合がある。そのような場合には、各部分の領域を、例えば操作入力部31を介して指定し、各部分について、ステップS4以下の処理をそれぞれ実施すればよい。
ステップS5において、経路生成部302は、入力された属性情報と隣接する直線経路間の間隔に基づいて、図6に示すような水滴型、右半水滴型、左半水滴型、スイッチバック型の反転経路を、それぞれの反転経路のタイプに対応する所定のアルゴリズムを用いて生成し、記憶部33に記録する。本実施形態では、各タイプの反転経路は各1つ生成されるが、各タイプの反転経路について、曲率の異なる複数の反転経路を生成してもよい。
水滴型の反転経路の特徴は、左右の両側で急激なカーブがないため、運転性(drivability)がよいが、作業対象領域の外周50と進入禁止領域の外周51が接近している場合に、反転経路上を走行する芝刈り機1と進入禁止領域の外周51との間に干渉が生じやすい。また、反転経路の曲率が大きい場合は、芝を傷めやすい。
右半水滴型の反転経路の特徴は、反転経路の左側について進入禁止領域の外周51への干渉を避けやすいことが挙げられる。左半水滴型の反転経路についても同様に、反転経路の右側について進入禁止領域の外周51への干渉を避けやすい。
スイッチバック型の反転経路は、図6に示されるように、2つのスイッチバック点(切り返し点)を有し、始点と第1のスイッチバック点、第1のスイッチバック点と第2のスイッチバック点、第2のスイッチバック点と終点はそれぞれ緩和曲線であるクロソイド曲線をベースとしている。スイッチバック型の反転経路の特徴は、反転経路が緩和曲線であるクロソイド曲線をベースとして構成されているので、芝を傷めにくい。一方、反転には時間がかかる。
また、反転経路の方向のタイプは、芝刈り機1が反転経路に作業対象領域の外側方向に進入する外側反転経路と、芝刈り機1が反転経路に作業対象領域の内側方向に進入する内側反転経路が用意されている。外側反転経路においては、芝刈り機1は反転経路に前進で進入することになり、内側反転経路においては、芝刈り機1は反転経路に後進で進入することになる。
ステップS6において、水滴型、右半水滴型、左半水滴型、スイッチバック型の順で、隣接する一対の直線経路の端部に外側反転経路として接続された反転経路上を走行する芝刈り機1が進入禁止領域に干渉するか否かを判定し、進入禁止領域に干渉しないタイプの反転経路が発見された時点で、ステップS7において、そのタイプの反転経路を走行経路として選択し、隣接する一対の直線経路の端部に連結する。このとき、通常、生成された反転経路の始点又は終点のいずれかと隣接する一対の直線経路の端部にいずれかとの間に間が空くので、その直線経路に重なるか又はその直線経路の延長となる直線を補充して連結する。
例えば、図7において、生成された水滴型の反転経路を外側反転経路として、隣接する一対の直線経路L3、L4の端部である交点(座標)P5、P6に接続してみると、その反転経路上を走行する芝刈り機1は進入禁止領域に干渉する。そこで、次に生成された右半水滴型の反転経路を外側反転経路として、交点(座標)P5、P6に接続してみると、なお進入禁止領域に干渉する。そこで、生成された左半水滴型の反転経路を外側反転経路として、交点(座標)P5、P6に接続してみると、進入禁止領域に干渉しなくなるので、この左半水滴型の反転経路を走行経路R3として選択する。そして、左半水滴型の反転経路の終点を交点(座標)P6に連結すると、左半水滴型の反転経路の始点と交点(座標)P5との間に間が空くので、直線経路L3の延長となる直線を補充して、左半水滴型の反転経路を交点(座標)P5に連結する。
ステップS8において、いずれのタイプの反転経路を外側反転経路として接続しても反転経路上を走行する芝刈り機1が進入禁止領域の外周51に干渉する場合は、同様に水滴型、右半水滴型、左半水滴型、スイッチバック型の順で、隣接する一対の直線経路の端部に内側反転経路として接続された反転経路上を走行する芝刈り機1が進入禁止領域に干渉するか否かを判定し、進入禁止領域に干渉しないタイプの反転経路が発見された時点で、ステップS9において、そのタイプの反転経路を走行経路として選択し、隣接する一対の直線経路の端部に連結する。このとき、通常、生成された反転経路の始点又は終点のいずれかと隣接する一対の直線経路の端部にいずれかとの間に間が空くので、その直線経路に重なるか又はその直線経路の延長となる直線を補充して連結する。
例えば、図7において、隣接する一対の直線経路L1、L2の端部である交点(座標)P1、P2については、いずれのタイプの反転経路についても外側反転経路として接続した場合は、反転経路上を走行する芝刈り機1は進入禁止領域に干渉する。そこで、生成された水滴型の反転経路を内側反転経路として、交点(座標)P1、P2に接続してみると、進入禁止領域に干渉しなくなるので、この左半水滴型の反転経路を走行経路R1として選択する。そして、水滴型の反転経路の始点を交点(座標)P1に連結すると、水滴型の反転経路の終点と交点(座標)P2との間に間が空くので、直線経路L2と重なる直線を補充して、水滴型の反転経路を交点(座標)P2に連結する。
なお、グリーン等の内部にバンカーや池等が存在する等の理由によって、ステップS9において、適切なタイプの反転経路が発見されなかった場合は、表示部32や図示されていない音声出力部を用いてその旨をユーザに知らせる。芝刈り機1が、走行経路を生成しながら遠隔操縦されている場合は、送受信部35を介して遠隔操縦しているユーザに知らせてもよい。そして、ユーザは、反転経路の形状を操作入力部31を介して指定するようにする。
ステップS10において、ステップS6〜S9を、隣接する一対の直線経路のすべてについて終了するまで繰り返す。
ステップS11において、操作入力部31を介して、走行経路開始位置Pts、走行経路終了位置Pteを指定する。
ステップS12において、経路生成部302は、指定された走行経路開始位置Pts、走行経路終了位置Pte、ステップS3で入力された属性情報に基づいて、走行経路開始位置Ptsから、ある直線経路の作業開始位置Plsまでの走行経路である開始つなぎ経路J1、全ての直線経路での作業が終了した位置Pleから外周経路の作業開始位置Pcsまでの走行経路である外周つなぎ経路J2、外周経路の作業終了位置Pceから走行経路終了位置Pteまでの走行経路J3である終了つなぎ経路を所定のアルゴリズムにより生成する。これにより、走行経路開始位置、反転経路を介して直線経路が相互に連結して形成された走行経路、外周経路、走行経路終了位置が、各つなぎ経路により接続され、全走行経路が生成される。
設定された作業対象領域の外周50と進入禁止領域の外周51、生成された全走行経路は表示部32に表示され、ユーザは操作入力部31を介した入力によって、走行経路の修正を行うことができる。例えば、ある選択された反転経路を、既に生成された水滴型、右半水滴型、左半水滴型、スイッチバック型の反転経路の1つに置き換えることができる。また、例えば、直線経路の位置や方向、隣接する直線経路間の間隔、反転経路の形状をユーザの指定のものに変更することもできる。
ステップS13において、経路生成部302は、生成された全走行経路を記憶部33又はリムーバブル記録媒体インタフェース部34に装着されたリムーバブル記録媒体40に記録する。
ステップS14において、動作設定部303は、操作入力部31を介して入力された芝刈り機1属性情報に基づいて、芝刈り機1の走行中あるいは停止中の刈り刃18,19の昇降動作や刈り刃18,19の回転の起動又は停止などを含む芝刈り作業に係る各種設定、芝刈り機1の速度、芝刈り機1の反転経路走行時の進行方向(前進又は後進)を、経路生成部302によって生成された走行経路と関連づけて行い、動作設定データを生成する。
芝刈り機1の反転経路走行時の進行方向(前進又は後進)については、デフォルトの設定が前進であるので、内側反転経路である場合に後進とする。
ステップS15において、動作設定部303は、生成された動作データを記憶部33又はリムーバブル記録媒体インタフェース部34に装着されたリムーバブル記録媒体40に記録する。
生成された走行経路及び動作データは、リムーバブル記録媒体40を介して制御装置10に移すことができる。また、生成された走行経路及び動作データは、走行経路生成装置3の送受信部35及び制御装置10の送受信部102によって任意のネットワークを介して制御装置10にダウンロードしてもよい。例えば、芝刈り機1に乗車しているオペレータが持っているタブレット型のコンピュータで走行経路生成装置3を構成し、無線LAN経由で制御装置10にダウンロードすることが考えられる。また、基地局に経路生成装置3を設け、基地局から直接制御装置10に、又は基地局からタブレット型のコンピュータのような任意のコンピュータ装置に一旦ダウンロードし、更にそのタブレット型のコンピュータのような任意のコンピュータ装置から制御装置10にダウンロードすることも考えられる。
本実施形態によれば、作業対象領域の外周と進入禁止領域の外周が接近していても、作業対象領域の全域にわたって作業を行うことを可能とする作業機械の走行経路を生成することができる。
上記の実施形態においては、全走行経路は自動生成されたが、走行経路及び/又は動作データの一部又は全部をユーザの指定により生成してもよい。例えば、直線経路の位置や方向、反転経路の形状や方向、隣接する直線経路間の間隔、つなぎ経路、芝刈り機1の速度、刈り刃18,19の昇降動作は、ユーザが、表示部32に表示された作業対象領域の外周50、進入禁止領域の外周51、生成中の走行経路を参照して、指定する構成とすることができる。
上記の実施形態においては、ステップS6において、水滴型、右半水滴型、左半水滴型、スイッチバック型の順で、外側反転経路として、次いで内側反転経路として、直線経路の端部に接続された反転経路上を走行する芝刈り機1が進入禁止領域に干渉するか否かを判定し、進入禁止領域に干渉しないタイプの反転経路が発見された時点で、そのタイプの反転経路を走行経路として選択した。しかしながら、作業対象領域の外周と進入禁止領域の外周との位置関係によっては、進入禁止領域の外周とは干渉しない水滴型、右半水滴型、又は左半水滴型の外側反転経路はあるが、その反転経路の曲率が大きく芝を傷める可能性があり、一方でスイッチバック型の外側反転経路では反転経路上を走行する芝刈り機1が進入禁止領域の外周と干渉してしまう場合が考えられる。したがって、水滴型、右半水滴型、又は左半水滴型の外側反転経路の曲率が所定の値よりも大きく、スイッチバック型の外側反転経路では反転経路上を走行する芝刈り機1が進入禁止領域の外周と干渉する場合、スイッチバック型の内側反転経路を選択する、すなわち、作業対象領域の外周と進入不可領域の外周との位置関係に応じて、外側反転経路ではなく、内側反転経路を走行経路として選択するように構成してもよい。
また、作業対象領域の外周や進入禁止領域の外周以外の地形データ(例えば、傾斜データ)を更に記憶部33に記録しておき、作業対象領域の外周や進入禁止領域の外周以外の地形データも参照して、走行経路が生成されるようにしてもよい。例えば、傾斜がある場合、平面上に投影された刈り幅は、刈り刃の刈り幅Wよりも小さくなる。そこで、作業対象領域の外周50付近に刈り残しが生じないように、傾斜を考慮して、外周経路Cを作業対象領域の外周50のW/2内側から補正して設定されるようにしてもよい。また、傾斜を考慮して、隣接する直線経路での刈り幅のオーバーラップ量が所定の値以上確保されるように直線経路が生成されるようにしてもよい。また、作業対象領域の外周や進入禁止領域の外周以外の地形データも参照して、反転経路のタイプが選択されるようにしてもよい。
上記の実施形態においては、隣接する直線経路が反転経路を介して連結して形成され、芝刈り機が隣接する直線経路を順次逆方向に走行する例を説明したが、上述の飛ばし経路を用いる場合は、反転経路のタイプとして更に図6に示される盆型の反転経路を生成するアルゴリズムを用意し、ステップS6において、盆型、水滴型、右半水滴型、左半水滴型、スイッチバック型の順で、外側反転経路として、次いで内側反転経路として、直線経路の端部に接続された反転経路が進入禁止領域に干渉するか否かを判定し、進入禁止領域に干渉しないタイプの反転経路が発見された時点で、そのタイプの反転経路を走行経路として選択し、直線経路の端部に連結すればよい。図8に、飛ばし経路を一部に用いた走行経路の生成例を示す。図8の走行経路においては、飛ばし経路に関連して反転経路R3、R5、R7について盆型の反転経路が選択されている。図8の盆型の反転経路R3、R5、R7は、図7の反転経路R3、R5、R7に比べて、距離も短く、かつ芝も傷めにくい。したがって、この場合、全体として作業が短時間で、芝を傷めにくい走行経路を実現することができる。
上記の実施形態においては、本発明を自動走行方式の作業機械に適用した例を説明したが、本発明は、表示装置に表示される走行経路のナビゲーションにしたがって人間が運転を行う作業機械に適用可能である。
上記の実施形態においては、走行経路生成装置は、走行制御装置とは別個のものであったが、走行制御装置に走行経路生成装置を組み入れてもよい。
上記の実施形態においては、走行経路生成システムの一例である走行経路生成装置3は、例えばタブレット型のコンピュータとして構成されていたが、走行経路生成装置3の一部又は全部を、タブレット型のコンピュータとは別体のものとして構成してもよい。例えば、記憶部108、領域設定部301、経路生成部302、動作設定部303の一部の機能を、タブレット型のコンピュータとは別体のサーバ、基地局や走行制御装置が備えるようにしてもよい。
次に、本発明の一実施形態に係る進入可否判定システム及び方法について説明する。まず、進入可否判定の原理について説明する。
あるホールでの芝刈り作業が終了しないうちにホールがプレイのために使用されるため芝刈り機1を待避させる場合、芝刈り機1の異常を感じて検査のために芝刈り機1をホール外に移動させる場合、芝刈り作業を走行中に予定外の障害物を検知したため緊急停止をして障害物を回避しなければならない場合等、芝刈り機1が芝刈り作業のために走行経路を走行している途中で、何らかの事情によって芝刈り機1の走行を停止し、走行経路を離脱する場合がある。その場合、走行離脱時の最終の芝刈り作業完了位置(以下、単に「作業完了位置」ともいう。)又は最初の芝刈り作業未完位置(以下、単に「作業未完位置」ともいう。)から芝刈り作業が再開されるように芝刈り機1を走行経路に復帰させる必要がある。そのため、ユーザは、芝刈り機1を作業完了位置又は作業未完位置の近くに移動させる。また、作業が行われるべき走行経路と作業が行われない走行経路と作業が行われるべき走行経路が接続されている場合において、前の作業が行われるべき走行経路の作業がすべて完了しているとき、すなわち作業完了位置が前の作業が行われるべき走行経路と作業が行われない走行経路との接続点であるときは、後の作業が行われるべき走行経路の始点(作業が行われない走行経路と後の作業が行われるべき走行経路の接続点)、すなわち作業未完位置から作業が再開されればよい。よって、そのような場合は、ユーザは、作業機械を作業未完位置の近くに移動させることもできる。
一方、芝刈り機1は、現在位置と所定の走行経路に基づいて走行経路を自動走行する。すなわち、芝刈り機1は、所定の走行経路に沿うように、フィードバック制御やフィードフォワード制御といった制御によって軌道修正を行いながら走行する。したがって、芝刈り機1は、上記の作業完了位置又は作業未完位置の近くの位置(以下、「進入準備のための(現在)位置」ともいう。)から走行を開始すると、現在位置とこれから進入しようとする走行経路とのずれを修正するように軌道修正を行いながら、走行経路に進入し、走行経路上を走行することになる。よって、芝刈り機1が、実際に走行経路上のどの位置で走行経路に進入するのかは制御できない。
したがって、芝刈り機1を作業完了位置又は作業未完位置の手前で走行経路に前進のみで進入させることができるような進入準備のための芝刈り機1の配置を行うことは、熟練を要するし、熟練者でもそのような配置に失敗することがある。
そこで、進入準備のための芝刈り機1のある配置に対して、芝刈り機1を作業完了位置又は作業未完位置の手前で走行経路に前進のみで進入させることが不可能であることが確実か、又はほぼ確実である場合、進入不可である旨をユーザに報知すれば、芝刈り機1に対して、進入不可が確実であるか、又はほぼ確実である進入準備のための配置から芝刈り機1の走行が行われることを避けることができ、進入がより確実な配置を行うことができる。
更に、どのような場合に、より確実に進入準備のための芝刈り機1の配置を行うことができるかについて鋭意研究したところ、進入準備のための位置と走行経路との距離と、走行経路の方向に対する、進入準備のための位置における芝刈り機1の向きの角度は、それそれ、芝刈り機1を前進のみで走行経路の軌道にのせるためにはどのぐらいの距離が進入準備のための位置から走行経路に沿って必要であるかということと相関関係があることに、本発明者らは着目した。すなわち、進入準備のための位置と走行経路との距離が所定の第1の値よりも大きい場合や、走行経路の方向に対する、進入準備のための位置における芝刈り機1の向きの角度の絶対値が所定の第2の値よりも大きい場合は、一定の距離内で芝刈り機1を前進のみで走行経路の軌道にのせることができないか、又はほぼできない。したがって、これらの場合は、一定の距離内での進入が不可能であることが確実であるか、又はほぼ確実であるので、進入不可である旨をユーザに報知すれば、芝刈り機1に対して、進入不可が確実であるか、又はほぼ確実である進入準備のための配置から芝刈り機1の走行が行われることを避けることができ、進入がより確実な配置を行うことができる。
そして、上記一定の距離内に作業完了位置又は作業未完位置が位置する場合は、作業が行われた領域とこれから作業が行われる領域に不連続が生じる可能性があるので、所望の、後述の対応点から芝刈り機1が走行経路に進入する点までの距離に余裕距離を加えた予め定められた第3の値の距離だけ走行経路における作業機械の進行方向に離れた点が、作業完了位置又は作業未完位置よりも作業機械の進行方向側に位置する場合も、進入不可である旨をユーザに報知すれば、進入が更により確実な配置を行うことができる。
ここで、芝刈り作業が既に行われた部分とまだ行われていない部分の境界が容易に判別でき、芝刈り機1を作業完了位置の近くに移動させることが容易であるような場合、走行経路にほぼ沿って、すなわち走行経路の方向に対する、進入準備のための位置における芝刈り機1の向きの角度の絶対値が所定の第2の値よりも小さい値で芝刈り機1を配置することは容易である場合が多いから、そのような場合を前提とするならば、走行経路の方向に対する、進入準備のための位置における芝刈り機1の向きの角度の考慮は省略することができる。
また、走行経路の方向に対する、進入準備のための位置における芝刈り機1の向きの角度の絶対値が所定の値よりも小さい値であれば、芝刈り機1の向きが走行経路の方向と反対方向になるような配置に誤ってしてしまうことを防止することができる作用効果もある。例えば、直線経路に進入しようとしているときに、走行経路の方向に対する、進入準備のための位置における芝刈り機1の向きの角度の絶対値が90°よりも小さい値であれば、芝刈り機1の向きが走行経路の方向と反対方向になるような配置に誤ってしてしまうことを防止することができる。
上述の進入準備のための位置と走行経路との距離、走行経路の方向、芝刈り機1を前進のみで走行経路の軌道にのせるためにはどのぐらいの距離が進入準備のための位置から走行経路に沿って必要であるかを求めるためには、進入準備のための現在位置が、芝刈り機1が、走行経路から逸脱した結果位置している位置であると仮定したときに、仮に逸脱することなく走行していたとすると走行経路上ではどの点に対応するかを考えた場合の走行経路上の対応点を用いることができる。
すなわち、対応点を用いた場合、進入準備のための位置と走行経路との距離は、進入準備のための位置と対応点の距離となり、走行経路の方向は、走行経路上の対応点における接線の方向となり、芝刈り機1を前進のみで走行経路の軌道にのせるためにはどのぐらいの距離が進入準備のための位置から走行経路に沿って必要であるかを求める際には対応点を起点として距離を考えることになる。
ここで、対応点が存在する走行経路が直線経路である場合、走行経路上の対応点における接線は、その直線経路と一致するものとする。
そして、その対応点の一例として、進入準備のための位置に最も近い走行経路上の点である最近点を用いることができる。
また、対応点を、作業完了位置又は作業未完位置よりも芝刈り機1の進行方向と反対側において、進入準備のための位置に最も近い走行経路上の点である作業完了側最近点とすると、例えば進入準備のための位置の近くに両側に走行経路が存在するような場合に、進入すべきでない走行経路部分に誤って進入することを防止することができる。すなわち、進入準備のための位置の近くに両側に走行経路が存在し、進入準備のための位置に最も近い走行経路上の点が進入するべき走行経路部分ではない方の走行経路部分上に存在し、進入準備のための位置に2番目に最も近い走行経路上の点が進入するべき走行経路部分上に存在したような場合、対応点を、作業完了位置又は作業未完位置よりも芝刈り機1の進行方向と反対側(作業完了側)に位置するという条件の下に選択すれば、誤った走行経路部分に進入することを防止することができる。
ここで、対応点として、上述の最近点や作業完了側最近点以外の適切な点を用いることもできることは言うまでもない。
上記の所定の第1の値及び所定の第2の値は、芝刈り機1の操舵性能や、どのくらいの距離で対応点から芝刈り機1を走行経路に進入させたいか等を考慮して予め定める。また、所定の第1の値及び所定の第2の値があまりにも小さいと、ユーザは非常に狭い範囲の進入可能エリアに芝刈り機1を配置しなければならなくなるので、所定の第1の値及び所定の第2の値は、熟練者でなくとも進入可能に配置することができる程度の値とすることが好ましい。
上記の事情を考慮すると、第2の値は、30°以下の所定の値であることが好ましい。
また、上記の所定の第3の値は、上記の所望の、対応点から芝刈り機1が走行経路に進入する点までの距離に余裕距離を考慮して定められる。
続いて、本発明の一実施形態に係る進入可否判定システムの進入可否判定処理の例を図9に示すフローチャート、図10に示す芝刈り機が進入準備のための位置に配置されている状態の一例等を参照して、以下に説明する。ここで、図10は、図7の走行経路の直線経路L6上の作業完了位置(作業未完位置)90の近くで、芝刈り機1が進入準備のための位置91に配置されている状態を示したものである。芝刈り機1は、直線経路L6から距離d1だけ離れて、直線経路L6の方向に対して+10°の向きAに配置されている。
まず、芝刈り機1が芝刈り作業のために走行経路を走行している途中で、何らかの事情によって芝刈り機1の走行を停止し、走行経路を離脱する場合、S21において、ユーザは、進入可否判定装置60に、操作入力部17又はタブレット型コンピュータや基地局のコンピュータ等の進入可否判定装置60の外部の機器を介して離脱する旨を入力する。
S22において、ユーザは、予め走行経路を離脱する必要があることが分かっている場合等においては、操作入力部17又はタブレット型コンピュータや基地局のコンピュータ等の進入可否判定装置60の外部の機器を介して作業停止位置を芝刈り機1に指示する。作業完了・未完位置記録部121は、指示された作業停止位置を作業完了位置として記憶部108に記録する。芝刈り機1は、指示された作業停止位置に到達すると芝刈り作業を停止する。より正確を期するために、ユーザが指示した作業停止位置に替えて、実際に作業が停止された位置を検出したものを用いてもよい。芝刈り機1の走行停止が事前に指示されたものでなかった場合、S21において離脱する旨が入力されたことをトリガとして、作業完了・未完位置記録部121は、芝刈り機1の走行停止位置を検出し、記憶部108に記録する。そして、作業完了・未完位置記録部121は、記憶部108に記憶された走行停止位置と動作データを参照して芝刈り作業完了位置を求め、記憶部108に記録する。すなわち、芝刈り作業中に走行停止した場合は、走行停止位置と芝刈り作業完了位置がほぼ一致するが、ターン経路等の芝刈り作業を行っていない位置において走行停止した場合等においては、走行停止位置と芝刈り作業完了位置は一致しないので、走行経路に関連づけられている動作データを参照することによって、芝刈り作業完了位置を特定する。また、作業完了・未完位置記録部121は、その作業停止位置又は走行停止位置と記憶部108に記憶された動作データを参照して芝刈り作業未完位置を求め、記憶部108に記録する。例えば、図10においては、作業停止位置又は走行停止位置は、芝刈り作業を行う経路である直線経路上にあるので、作業未完位置は作業完了位置と一致する。また、例えば、図7の走行経路の直線経路L7、交点P15、反転経路R8、交点P16、直線経路L8の部分において、直線経路L7、L8の動作データには芝刈りを行うための動作が規定されており、反転経路R8の作業データには芝刈りをしないような動作が規定されているから、走行停止位置が反転経路R8上であった場合、芝刈り作業完了位置は交点P15、芝刈り作業未完位置は交点P16と特定される。ここで、作業完了位置の近くからの進入のみ可能であればよい場合は、作業未完位置を求め記憶部108に記録する構成は、省略することができる。
次に、芝刈り機1は、走行経路から離脱し、所定の場所に移動させられる。その後、芝刈り作業を再開する際に、芝刈り機1は、作業完了位置(作業未完位置)90(上述のように図10においては作業完了位置と作業未完位置が一致するので、以降は単に「作業完了位置90」ともいう。)の近くの芝刈り機1の進入準備のための位置91まで移動させられる。S23において、ユーザは、操作入力部17又はタブレット型コンピュータや基地局のコンピュータ等の進入可否判定装置60の外部の機器を介して、進入可否判定装置60に、進入可否判定の指示を入力する。
ステップS24において、芝刈り機1の進入準備のための現在位置91と方位Aが検出手段である制御情報生成部107と車両情報受信部105により検出される。
ステップS25において、対応点決定部122は、検出された芝刈り機1の進入準備のための現在位置91に最も近い、記憶部108に記録された走行経路上の点である最近点92を決定する。本実施形態においては、検出された芝刈り機1の進入準備のための現在位置91に対応する走行経路上の対応点として最近点92を用いるが、上述の作業完了位置又は作業未完位置よりも芝刈り機1の進行方向と反対側において、進入準備のための位置に最も近い走行経路上の点である作業完了側最近点等の最近点以外の対応点を用いてもよいことは言うまでもない。
ステップS26において、判定情報生成部123は、進入準備のための現在位置91と最近点92との距離d1が所定の第1の値よりも大きいか否かを判定する。図10の例においては、走行経路が直線経路であるので、進入準備のための位置91を通る、直線経路L6に対する垂線と、直線経路L6との交点が最近点92となる。
ステップS27において、判定情報生成部123は、走行経路上の最近点92における接線の向きに対する芝刈り機1の向きAの角度の絶対値が所定の第2の値よりも大きいか否かを判定する。図10の例においては、走行経路が直線経路であるので、上述のように、最近点92における接線は直線経路L6と一致し、芝刈り機1の向きAは直線経路L6の向きに対して+10°であるから、最近点92における接線の向きに対する芝刈り機1の向きAの角度は+10°である。ここで、芝刈り作業が既に行われた部分とまだ行われていない部分の境界が容易に判別でき、芝刈り機1を作業完了位置又は作業未完位置の近くに移動させることが容易であるような場合、走行経路にほぼ沿って、すなわち走行経路上の最近点における接線と芝刈り機1の向きのなす角度の絶対値が小さい角度で芝刈り機1を配置することは容易である場合が多いから、そのような場合を前提とするならば、本ステップは省略することができる。
ステップS28において、判定情報生成部123は、最近点92から予め定められた第3の値d3の距離だけ走行経路における芝刈り機1の進行方向に離れた点93が、作業完了位置又は作業未完位置90よりも芝刈り機1の進行方向側に位置するか否かを判定する。図10の例においては、点93は、作業完了位置90の手前に位置している。ここで、芝刈り機1による芝刈り作業は重複して行われても問題はないので、当初から余裕をもった距離で作業完了位置又は作業未完位置の手前に芝刈り機1を配置すること等を前提とするならば、本ステップは省略することができる。
ステップS29において、判定情報生成部123は、ステップS26〜28のすべてにおいてNoの場合は、進入可能と判定する。
ステップS30において、判定情報生成部123は、ステップS26〜28のいずれかにおいてYesの場合は、進入不可能と判定する。
ここで、図10においては、作業完了位置と作業未完位置が一致していたが、作業完了位置と作業未完位置が異なる場合、すなわち上述のような走行停止位置が作業が行われない走行経路上にあった場合は、その作業が行われない走行経路が芝刈り機1が後進で走行する走行経路であったとすると、進入準備の位置から一定の距離内で前進のみで走行経路に進入することができない。したがって、反転経路として内側反転経路を用いるような場合は、通常はそのような走行経路に進入しようとはしないが、内側反転経路を外側反転経路と思い違いをして進入準備の配置をしてしまったような場合も考えられるので、作業完了位置と作業未完位置が異なり、かつ作業未完位置に対して芝刈り機1の進行方向と反対側に接続される走行経路が、芝刈り機1が後進で走行する走行経路であった場合、進入不可能と判定すれば、上記の思い違いのような場合に有効である。
ステップS31において、判定情報生成部123は、進入可能か否かの判定情報を生成する。
ステップS32において、報知信号・命令生成部124は、生成された判定情報に基づいて、進入可能及び/又は進入不可能の報知を指示する信号及び/又は命令を生成する。
生成された進入可能及び/又は進入不可能の報知を指示する信号又は命令に基づいて、表示部18、音声出力部19等を介して進入可否の報知が行われる。報知の手法としては、ディスプレイへの表示、音声出力手段による音声出力、積層表示灯による点灯、振動など公知の手法を用いることができる。その際に、併せて、ディスプレイに走行経路を表示すると共に表示された走行経路のいずれの走行経路部分(例えば、直線経路、反転経路等)に進入するのかを表示してもよい。また、進入可否判定装置60とは別体の進入可否報知装置として機能するタブレット型コンピュータや基地局のコンピュータ等に送受信部102を介して、生成された判定情報又は進入可能及び/又は進入不可能の報知を指示する命令を送信し、タブレット型のコンピュータや基地局のコンピュータ等のディスプレイに表示し、及び/又は音声出力を行う構成とすることもできる。
ステップS32において進入可能の報知を指示する信号又は命令が生成され、それに基づいて進入可能と報知された場合、ユーザは、操作入力部17を介して制御装置10に進入開始(走行開始)を指示する。芝刈り機1は、現在位置と記憶部108に記憶された走行経路に基づいて自動走行する、すなわち、走行経路に沿うように軌道修正を行いながら走行する。したがって、芝刈り機1は、進入準備のための位置から走行を開始すると、現在位置とこれから進入しようとする走行経路とのずれ修正するように軌道修正が行われ、点93の手前で走行経路に進入し、走行経路上を走行する。芝刈り機1が走行経路に進入すると、芝刈り作業を再開する。
上記の実施形態においては、ステップS32において進入可能の報知を指示する信号又は命令が生成され、それに基づいて進入可能と報知された場合、ユーザは、操作入力部17を介して制御装置10に進入開始(走行開始)を指示したが、ステップS31において生成された判定情報の内容が進入可能であった場合に、ステップS32において進入可能の報知を指示する信号又は命令が生成されることに替えて又は加えて、芝刈り機1に進入開始(走行開始)を指示する走行制御信号が制御情報生成部107によって生成され、これによってユーザの入力なく、進入可能判定後に自動的に芝刈り機1が進入を開始する構成としてもよい。
上記の実施形態においては、進入可否判定開始指示入力に基づいて、1回の進入可否判定及び判定結果の報知を行ったが、進入可否判定終了を指示するまで常時又は間欠的に繰り返し進入可否判定及び判定結果の報知を行ってもよい。
上記の実施形態においては、芝刈り機1は、作業完了位置又は作業未完位置の近くの走行経路上の進入位置から走行経路に進入したが、走行経路の開始位置を含む、作業完了位置又は作業未完位置よりも作業機械の進行方向と反対側に位置する任意の位置を進入位置として走行経路に進入することができることは言うまでもない。
上記の実施形態においては、進入可否判定システムの一例である進入可否判定装置60は、作業機械である芝刈り機1に設けられていたが、進入可否判定装置60の一部又は全部を、芝刈り機1とは別体のものとして構成してもよい。例えば、記憶部108の一部の機能、作業完了・未完位置記録部121の機能の一部又は全部、対応点決定部122の機能の一部又は全部、判定情報生成部123の機能の一部又は全部、報知信号・命令生成部124の機能の一部又は全部の少なくとも1つを、芝刈り機1とは別体のサーバや基地局が備えるようにしてもよい。また、進入可否判定装置60を、例えば芝刈り機1を操作するユーザが所持するタブレット型のコンピュータで構成してもよい。また、走行経路自動選択装置70を、例えば芝刈り機1を操作するユーザが所持するタブレット型のコンピュータを用いて構成するような場合も、例えば、記憶部108の一部の機能、作業完了・未完位置記録部121、対応点決定部122、判定情報生成部123、報知信号・命令生成部124の少なくとも1つを、タブレット型コンピュータとは別体のサーバや芝刈り機1が備えるようにしてもよいことはもちろんである。
次に、本発明の一実施形態に係る走行経路自動選択システムの走行経路自動選択処理の例を図11に示すフローチャート、図12に示す複数の作業対象のホールの各々にそれぞれ対応する走行経路、走行経路開始位置、作業開始位置、開始つなぎ経路の位置関係の一例、図13に示す芝刈り機が進入準備のための位置に配置されている状態の一例等を参照して、以下に説明する。なお、上述の進入可否判定装置及び方法と同様の処理を行う部分については詳細な説明は省略する。
図12は、複数の作業対象領域である2番ホール2H、3番ホール3H、5番ホール5Hと今回の作業対象領域ではない4番ホール4H、カート道CP、各ホールにそれぞれ対応する走行経路T2、T3、T5、走行経路T2、T3、T5の各々の走行経路開始位置PtsT2、PtsT3、PtsT5、作業開始位置PlsT2、PlsT3、PlsT5、走行経路開始位置PtsT2、PtsT3、PtsT5の各々と作業開始位置PlsT2、PlsT3、PlsT5の各々をそれぞれつなぐ開始つなぎ経路J1T2、J1T3、J1T5を示す。
図13は、図11に示した2番ホール2Hに対応する走行経路開始位置PtsT2付近の拡大図である。走行経路開始位置PtsT2の近くで、芝刈り機1が進入準備のための位置RPに配置されている状態を示したものである。芝刈り機1は、マークM2から開始つなぎ経路J1T2の方向に距離eだけずれている。また、後述のようにカート道CPの道幅が芝刈り機1の幅と同程度であるので、芝刈り機1の進入準備のための位置RPは、開始つなぎ経路J1T2からはほとんど離れておらす、また芝刈り機1は、開始つなぎ経路J1T2方向とほぼ同じ向きに配置されている。
まず、S41において、走行経路生成装置3等により生成された、複数の作業対象のホールである2番ホール2H、3番ホール3H、5番ホール5Hの走行経路及び動作データが、上述のようにリムーバブル記録媒体40や任意のネットワークを介して、芝刈り機1の記憶部108に記録される。
ユーザは、手動運転や遠隔操縦等によって、芝刈り機1を作業を行うホールに移動させる。ホールへの移動には、多くの場合、カート道が用いられる。作業対象の各ホールに対応する走行経路の走行経路開始位置は、カート道上の各ホールに近い位置に位置するように走行経路が生成されている。カート道には、作業対象の各ホールの走行経路開始位置から所定距離だけ作業開始位置側の位置に対応するマークが、進入準備位置へのガイドとして、作業対象の各ホールの近くに設けられている。このマークとしては、例えば、自動車の駐車場のようなマークで、前輪と後輪が収まる範囲が描かれたものが考えられる。カート道の道幅は通常芝刈り機1の幅と同程度であるので、マークの位置をカート道上に設けることによって、芝刈り機1の停止位置について、走行経路に対して垂直方向における位置や、芝刈り機1の向きが限定される。これにより、前後方向の停車位置を合わせさえすれば、進入準備のための位置と走行経路との距離が所定の第1の値よりも小さく、且つ、走行経路の方向に対する、進入準備のための位置における芝刈り機1の向きの角度の絶対値を所定の第2の値よりも小さくすることができる。ここで、進入可否をより正確に判定したい場合や、芝刈り機1が取ることができる向きの自由度が大きい場合、例えばカート道以外の広い場所にマークを設けた場合は、芝刈り機1の方位を、方位取得手段である車両情報受信部105により取得してもよい。
ユーザは、手動運転や遠隔操縦等によって、芝刈り機1をまず最初の作業対象の2番ホール2Hに移動させる。上述のようにホールへの移動には、カート道CPが用いられ、2番ホール2Hの近くのカート道CP上のマークM2を目標にして、進入準備のための(現在)位置に芝刈り機1を停止させる。ユーザが芝刈り機1に乗車して運転している場合、芝刈り機1を停止させた後、ユーザは、パーキングブレーキをかけて芝刈り機1から降りる。
ステップS42において、ユーザは、走行経路自動選択装置70に、操作入力部17又はタブレット型コンピュータや基地局のコンピュータ等の走行経路自動選択装置70の外部の機器を介して走行経路検索開始を指示する旨を入力する。ユーザが芝刈り機1に乗車して運転していた場合、これに替えて、制御情報生成部107が、パーキングブレーキがかかっていること及び芝刈り機1の運転席に人が座っていないことの検知等からユーザが降車したと判定すると、走行経路検索開始を指示する信号を生成する構成としてもよい。
ステップS43において、芝刈り機1の進入準備のための現在位置RPが、現在位置取得手段である制御情報生成部107により取得される。これに加えて、芝刈り機1の方位を方位取得手段である車両情報受信部105により取得してもよい。
ステップS44において、走行経路検索部125は、記憶部108に記録された、作業対象のホールである2番ホール2H、3番ホール3H、5番ホール5Hの各々にそれぞれ対応する走行経路T2、T3、T5の少なくとも走行経路開始位置PtsT2、PtsT3、PtsT5から作業開始位置PlsT2、PlsT4、PlsT5の間の走行経路開始位置PtsT2、PtsT3、PtsT5から所定距離の走行経路部分について、順に、走行経路開始位置PtsT2、PtsT3、PtsT5と作業開始位置PlsT2、PlsT3、PlsT5の間に位置する進入位置において、芝刈り機1が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、芝刈り機1が、芝刈り機1の進入準備のための現在位置RPから前進のみで進入可能であるという条件を満たすか否かを判定することによって、そのような条件を満たす走行経路を、作業対象のホールである2番ホール2H、3番ホール3H、5番ホール5Hの各々にそれぞれ対応する走行経路T2、T3、T5の中から検索する。なお、4番ホール4Hは今回の作業対象領域ではないため、芝刈り機1の記憶部108にその走行経路が記録されていないため、検索の対象とはなっていない。
ここで、上記条件を満たすか否かの判定は、上述の進入可否判定装置及び方法と同様の手法を用いることができる。すなわち、走行経路検索部125は、記憶部108に記録された、作業対象のホールである2番ホール2H、3番ホール3H、5番ホール5Hの各々にそれぞれ対応する走行経路のT2、T3、T5の少なくとも走行経路開始位置PtsT2、PtsT3、PtsT5から作業開始位置PlsT2、PlsT3、PlsT5の間の走行経路開始位置PtsT2、PtsT3、PtsT5から所定距離の走行経路部分について、位置取得検出手段である制御情報生成部107によって取得された進入準備のための現在位置RPに対応する、該走行経路部分上の点である対応点をそれぞれ決定する。そして、該走行経路部分の各々について、進入準備のための現在位置RPと対応点との距離が、少なくとも前記作業機械の操舵性能、及び所望の対応点から芝刈り機1が走行経路に進入する点までの距離を考慮して予め定められた所定の第1の値よりも大きい場合、所望の対応点から芝刈り機1が走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ走行経路における芝刈り機1の進行方向に離れた点が、作業開始位置よりも芝刈り機1の進行方向側に位置する場合、又は方位取得手段である車両情報受信部105により取得された芝刈り機1の方位に基づいて、走行経路上の対応点における接線の方向に対する、芝刈り機1の向きの角度の絶対値が所定の第2の値よりも大きい場合に、前記条件を満たさないと判定することができる。
また、ここで、芝刈りを同じ経路で繰り返し行うと芝の特定の部分が傷んだり、芝が一定方向に寝たりする場合がある。そこで、同じ経路で芝刈りを繰り返すことを避けるために、作業対象のホールである2番ホール2H、3番ホール3H、5番ホール5Hのうちの少なくとも1つのホールの各々にそれぞれ対応する走行経路として、走行経路開始位置から作業開始位置の間の走行経路開始位置から所定距離の走行経路部分が同一であり、作業対象領域内の走行経路が互いに異なる走行経路を走行経路生成装置3等により生成し、芝刈り機1の記憶部に記録し、所定の選択条件に基づいて、1つの走行経路が選択されるようにしてもよい。所定の選択条件としては、日付、曜日や後述の作業履歴等を用いることができる。
S45において、上記条件を満たす走行経路が発見された場合、S46において、走行経路検索部125は、発見された走行経路を識別するための情報、並びに発見された走行経路のホール番号のホールに対応する走行経路に進入可能な位置にいる旨及び自動運転開始指示の入力の要求の報知を指示する信号及び/又は命令を生成する。生成された報知を指示する信号又は命令に基づいて、表示部18、音声出力部19等を介して、発見された走行経路のホール番号のホールに対応する走行経路に進入可能な位置にいる旨及び自動運転開始指示の入力の要求の報知が行われる。ここで、発見された走行経路のホール番号の報知、自動運転開始指示の入力の要求の報知は行わなくてもよい。報知の手法としては、ディスプレイへの表示、音声出力手段による音声出力、積層表示灯による点灯、振動など公知の手法を用いることができる。また、走行経路自動選択装置70とは別体の報知装置として機能するタブレット型コンピュータや基地局のコンピュータ等に送受信部102を介して、生成された報知を指示する信号及び/又は命令を送信し、タブレット型のコンピュータや基地局のコンピュータ等のディスプレイに表示し、及び/又は音声出力を行う構成とすることもできる。
自動運転開始指示の入力の要求の報知は、ユーザが芝刈り機1に乗車して運転している場合、制御情報生成部107が、パーキングブレーキがかかっていること及び芝刈り機1の運転席に人が座っていないことの検知等からユーザが乗車していないと判定した後に行われるようにすると、ユーザの安全を確保できる。
自動運転開始指示の入力の要求の報知は、操作入力部17と表示部に18が一体となったタッチパネルが用いられるような場合は、自動運転開始ボタンをタッチパネルに表示してもよい。
また、上記の報知を指示する信号及び/又は命令に加えて、上記条件を満たす走行経路に関する情報の報知を指示する信号及び/又は命令を生成してもよい。上記条件を満たす走行経路に関する情報としては、例えば当該走行経路の地図情報が考えられる。また、各作業対象領域の作業履歴を記憶部108に記録しておき、当該走行経路の作業対象領域の作業履歴を表示したり、作業履歴に基づいてその作業対象領域の作業の必要性を報知してもよい。
ユーザが、自動運転開始指示の入力の要求に対して、例えば自動運転開始ボタンをタッチすると、操作入力部17を介して制御装置10に自動走行開始が指示される。芝刈り機1は、現在位置と記憶部108に記憶された、走行経路検索部125により発見された2番ホール2Hの走行経路T2に基づいて自動走行する。すなわち、芝刈り機1は、進入準備のための位置から走行を開始すると、現在位置とこれから進入しようとする走行経路とのずれ修正するように軌道修正が行われ、作業開始位置PlsT2の手前で走行経路T2に進入し、走行経路T2上を走行し、2番ホール2Hの芝刈り作業が行われる。
S47において、上記条件を満たす走行経路が走行経路検索部125により発見されなかった場合、走行経路検索部125は、そのホールは作業対象のホールでないか、又は現在の位置では走行経路に進入可能でない旨を報知する信号及び/又は命令を生成する。生成された報知を指示する信号又は命令に基づいて、表示部18、音声出力部19等を介して、そのホール作業対象のホールでないか、又は現在の位置では走行経路に進入可能でない旨の報知が行われる。
芝刈り機1が、芝刈り作業を終えて、走行経路終了位置PteT2(図示しない)に達すると、芝刈り機1は自動停止し、手動運転モードに切り替わり、パーキングブレーキがかかった状態となる。ユーザは、手動運転や遠隔操縦等によって、芝刈り機1を次の作業対象のホールである3番ホール3Hに移動させ、上述の2番ホール2Hでの操作と同様の操作を行う。
ここで、3番ホール3Hが使用中である等の事情により、3番ホール3Hの芝刈りが行えない場合でも、本実施形態によれば、作業対象のホールの各々に対応する走行経路の走行経路開始位置付近の進入可能位置に芝刈り機1を停車させれば、作業対象のホールの各々に対応する走行経路が自動的に選択されるので、作業対象のホールの芝刈り作業を予め決められた順番で行う必要がなく、他のホール、例えば5番ホール5Hの芝刈り作業を先に行うことができる。
5番ホール5Hの芝刈り作業を先に行った場合、次に3番ホール3Hの芝刈り作業を行うことになる。カート道CPにおいて、2番ホール2Hから3番ホール3Hへ向かう方向と、5番ホール5Hから3番ホール3Hへ向かう方向は逆になるが、上述のようにカート道CPの道幅と芝刈り機1の幅は同程度であるため、2番ホール2Hから3番ホール3Hへ向かう方向から芝刈り機1が進入するために用意された3番ホール3Hに対応する走行経路T3(の開始つなぎ経路J1T3)では、5番ホール5Hから3番ホール3Hへ向かう方向から進入するためには、芝刈り機1の方向転換が必要であり、この方向転換が面倒な場合もある。そのため、例えば、5番ホール5Hから3番ホール3Hへ向かう方向から進入するための開始つなぎ経路J1T3'も記憶部108に記録しておく構成が考えられる。この構成によれば、上述の走行経路上の対応点における接線の方向に対する、芝刈り機1の向きの角度の絶対値が所定の第2の値よりも大きい場合に、前記条件を満たさないと判定する構成を用いることにより、方位取得手段である車両情報受信部105により取得される芝刈り機1の方位に応じて、2番ホール2Hから3番ホール3Hへ向かう方向から進入するための開始つなぎ経路J1T3又は5番ホール5Hから3番ホール3Hへ向かう方向から進入するための開始つなぎ経路J1T3’が選択され、開始つなぎ経路J1T3又はJ1T3’の走行後、作業開始位置PlsT3へ進入することができる。
そして、走行経路を生成する際に、作業対象のホールの各々に対応する走行経路の走行経路終了位置を、カート道へ左右いずれの方向にも進入しやすい位置とすると、芝刈り機1をいずれの方向の作業対象のホールに移動させやすいので好都合である。
このように、本実施形態によれば、複数の作業対象領域の各々について、それぞれの作業対象領域に対して対応する所定の走行経路に沿って自動走行しながら所定作業を行う作業機械を用いて作業を行う場合に、作業対象領域の作業順序の変更を柔軟に行うことができる。
また、本実施形態によれば、1つ又は複数の作業対象領域の各々について、それぞれの作業対象領域に対して対応する所定の走行経路に沿って自動走行しながら所定作業を行う作業機械を用いて作業を行う場合であって、作業対象領域までの移動や作業対象領域間の移動は、手動運転で行う場合に、作業機械を作業開始位置の手前で走行経路に前進のみで進入させることができるような、進入準備のための作業機械の配置をより確実に行うことができ、これから作業を行う作業領域の走行経路の選択の手間をなくし、誤りを防止することができる。
次に、上記実施形態の変形例について説明する。本変形例は、上記実施形態を簡略化したものであり、上記条件を満たすか否かの判定を、芝刈り機1の進入準備のための現在位置が、走行開始可能エリア内にあるか否かによって判定する。
上述の進入可否判定装置及び方法における、進入準備のための現在位置と走行経路との距離が所定の第1の値よりも大きいか否かの判定は、進入準備のための現在位置が、走行経路から所定の第1の値だけ離れた走行経路に平行な走行経路の両側の曲線よりも走行経路側に位置するか否かの判定と考えることができる。そうすると、手動運転による目標位置からのずれについて最大想定される量を想定最大ずれ量とすると、少なくとも想定最大ずれ量の2倍の長さと所定の第1の値の2倍の幅を有するエリア、すなわち、走行経路開始位置から少なくとも想定最大ずれ量の2倍の長さの走行経路部分から所定の第1の値だけ離れた走行経路に平行な走行経路の両側の曲線と当該走行経路部分の始点と終点において該走行経路部分と直交する直線で囲まれた走行開始可能エリア内に、進入準備のための現在位置が位置するか否かを判定することで進入可否判定を簡略化することができる。ここで、当該走行経路部分を直線とすると、走行開始可能エリアは矩形となり、ユーザが走行開始可能エリアの形状を認識しやすくなる。
本変形例においては、上記のステップS41において、走行経路生成装置3等により生成された、1つ又は複数の作業を行うホールである2番ホール2H、3番ホール3H、5番ホール5Hの走行経路及び動作データが、芝刈り機1の記憶部108に記録されると共に、1つ又は複数の作業を行うホールの走行経路に対応する走行開始可能エリアSA2、SA3、SA5が記憶部108に記録される。ここで、これに替えて、判定時に、走行経路検索部125が、記憶部108に記録された2番ホール2H、3番ホール3H、5番ホール5Hの走行経路T2、T3、T5に基づいて、1つ又は複数の作業を行うホールの走行経路T2、T3、T5にそれぞれ対応する走行開始可能エリアSA2、SA3、SA5を生成してもよい。
本変形例においては、上記のステップS44ににおいて、走行経路検索部125は、記憶部108に記録された、作業対象のホールである2番ホール、3番ホール、5番ホールの各々にそれぞれ対応する走行開始可能エリアSA2、SA3、SA5について、芝刈り機1の進入準備のための現在位置が、走行開始エリア内に位置するか否かを判定することによって、芝刈り機1の進入準備のための現在位置が走行開始可能エリア内に位置する走行経路を、作業対象のホールである2番ホール2H、3番ホール3H、5番ホール5Hの各々にそれぞれ対応する走行経路T2、T3、T5の中から検索する。
上記の実施形態においては、走行経路自動選択システムの一例である走行経路自動選択装置70は、作業機械である芝刈り機1に設けられていたが、走行経路自動選択装置70の一部又は全部を、芝刈り機1とは別体のものとして構成してもよい。例えば、各作業対象領域に対応する所定の走行経路の少なくとも走行経路開始位置から作業開始位置の間の走行経路開始位置から所定距離の走行経路部分を記録する記憶部108や走行経路検索部125の一部の機能を、芝刈り機1とは別体のサーバや基地局が備えるようにしてもよい。また、走行経路自動選択装置70を、例えば芝刈り機1を操作するユーザが所持するタブレット型のコンピュータで構成してもよい。この場合、上記の実施形態のように、複数の作業対象領域の各々にそれぞれ対応する所定の走行経路の全部分ではなく、進入可能な走行経路の検索に必要な、走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分を記録する構成としてもよい。また、走行経路自動選択装置70を、例えば芝刈り機1を操作するユーザが所持するタブレット型のコンピュータを用いて構成するような場合も、各作業対象領域に対応する所定の走行経路の少なくとも走行経路開始位置から作業開始位置の間の走行経路開始位置から所定距離の走行経路部分を記録する記録部や走行経路検索部125の一部の機能を、タブレット型コンピュータとは別体のサーバや芝刈り機1が備えるようにしてもよいことはもちろんである。
上記の実施形態においては、判定開始指示入力に基づいて、1回の進入可能な走行経路の検索及び検索結果の報知を行ったが、手動運転や遠隔操縦を行っている間は常時又は間欠的に繰り返し進入可能な走行経路の検索及び検索結果の報知を行ってもよい。このとき、遠隔操縦の場合、進入可能な走行経路が発見されると、その走行経路に進入可能な位置にいる旨の報知が行われ、自動運転開始指示の入力なしに自動運転が行われるようにしてもよい。
上記の実施形態においては、作業対象領域は複数であったが、作業対象領域が1つであってもよい。作業対象領域が1つである場合も、作業機械を作業開始位置の手前で走行経路に前進のみで進入させることができるような、進入準備のための作業機械の配置をより確実に行うことができ、これから作業を行う作業領域の走行経路の選択の手間をなくし、誤りを防止することができる。
なお、上記の実施形態の方法を実現するコンピュータプログラムを記録した記録媒体を、走行経路生成装置3や制御装置10(進入可否判定装置60、走行経路自動選択装置70)に対して供給してもよい。この場合、走行経路生成装置3や制御装置10(進入可否判定装置60、走行経路自動選択装置70)のコンピュータが、記録媒体に記録されたコンピュータプログラムを読み取り、実行することによって、本発明の目的を達成することができる。したがって、記録媒体から読み取られたコンピュータプログラム自体が本発明の方法を実現するため、そのコンピュータプログラムが本発明を構成する。
上記の実施形態においては、本発明を芝刈り機に適用した例を説明したが、本発明は、散水機、散布機、施肥機、種まき機、土壌状態測定機、収穫機、耕耘機、耕土機、整地機をはじめとする農業機械や清掃機械等の任意の作業機械に適用可能である。
以上、本発明について、例示のためにいくつかの実施形態に関して説明してきたが、本発明はこれに限定されるものでなく、本発明の範囲及び精神から逸脱することなく、形態及び詳細について、様々な変形及び修正を行うことができることは、当業者に明らかであろう。
1・・・芝刈り機
10・・・制御装置
11・・・車速センサ
12・・・方位角速度センサ
13・・・駆動制御部
15・・・GPSアンテナ
16・・・通信アンテナ
17・・・操作入力部
18・・・表示部
19・・・音声出力部
101・・・GPS受信部
102・・・送受信部
105・・・車両情報受信部
106・・・駆動指令部
107・・・制御情報生成部
108・・・記憶部
109・・・リムーバブル記録媒体インタフェース部
112・・・主制御部
121・・・作業完了・未完位置記録部
122・・・対応点決定部
123・・・判定情報生成部
124・・・報知信号・命令生成部
125・・・走行経路検索部
2・・・基地局
21・・・GPS受信装置
22・・・送受信装置
25・・・GPSアンテナ
26・・・通信アンテナ
3・・・走行経路生成装置
30・・・制御部
31・・・操作入力部
32・・・表示部
33・・・記憶部
34・・・リムーバブル記録媒体インタフェース部
35・・・送受信部
301・・・領域設定部
302・・・経路生成部
303・・・動作設定部
304・・・主制御部
40・・・リムーバブル記録媒体
50・・・作業対象領域の外周
51・・・進入禁止領域の外周
60・・・進入可否判定装置
70・・・走行経路自動選択装置
90・・・作業完了位置(作業未完位置)
91・・・進入準備のための(現在)位置
92・・・最近点
93・・・最近点92から予め定められた第3の値d3の距離だけ走行経路における芝刈り機1の進行方向に離れた点

Claims (45)

  1. 1つ又は複数の作業対象領域の各々について、それぞれの作業対象領域に対応する所定の走行経路に沿って自動走行しながら所定作業を行う作業機械のための走行経路自動選択システムであって、
    前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路について、少なくとも走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分を記録する記憶部と、
    前記作業機械の現在位置を取得する現在位置取得手段と、
    前記走行経路開始位置と前記作業開始位置の間に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能であるという条件を満たす走行経路を、前記記憶部に記録された、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の少なくとも走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分に少なくとも基づいて、前記条件を満たすか否かを判定することによって、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の中から検索する走行経路検索部と、
    を含む走行経路自動選択システム。
  2. 前記走行経路検索部は、前記記憶部に記録された、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の少なくとも走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分について、前記現在位置取得手段によって取得された前記進入準備のための現在位置に対応する、前記走行経路部分上の点である対応点をそれぞれ決定し、前記走行経路部分の各々について、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きい場合に、前記条件を満たさないと判定し、
    前記所定の第1の値は、少なくとも前記作業機械の操舵性能、及び所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離を考慮して予め定められたものである請求項1に記載の走行経路自動選択システム。
  3. 前記走行経路検索部は、前記所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ前記走行経路における前記作業機械の進行方向に離れた点が、前記作業開始位置よりも前記作業機械の進行方向側に位置する場合に、前記条件を満たさないと判定する請求項2に記載の走行経路自動選択システム。
  4. 前記作業機械の向きを取得する方位取得手段を更に有し、
    前記走行経路検索部は、前記走行経路上の前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、前記条件を満たさないと判定する請求項2又は3に記載の走行経路自動選択システム。
  5. 前記記録部が、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路について、走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分を含む走行開始可能エリアを記録するか、又は前記走行経路検索部が、前記走行経路部分に基づいて走行開始可能エリアを生成し、
    前記走行経路検索部は、前記走行開始可能エリアの各々について、前記作業機械の現在位置が前記走行開始可能エリア内にあるか否かに基づいて、前記条件を満たす走行経路を、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の中から検索する、請求項1に記載の走行経路自動選択システム。
  6. 前記走行開始可能エリアは、前記走行経路部分に対して前記走行経路部分の両側に所定の第1の値の幅を有する請求項5に記載の走行経路自動選択システム。
  7. 前記走行開始可能エリアは、前記作業機械の手動運転による目標位置からのずれについて最大想定される量の少なくともの2倍の長さを有する請求項5又は6に記載の走行経路自動選択システム。
  8. 前記走行経路部分は直線である請求項5〜7のいずれか1項に記載の走行経路自動選択システム。
  9. 走行開始可能エリアは、矩形である請求項8に記載の走行経路自動選択システム。
  10. 前記作業機械の向きを取得する方位取得手段を更に有し、
    前記走行経路検索部は、前記記憶部に記録された、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の少なくとも走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分について、前記現在位置取得手段によって取得された前記進入準備のための現在位置に対応する、前記走行経路部分上の点である対応点をそれぞれ決定し、前記走行経路の各々について、前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、前記条件を満たさないと判定する請求項5〜9のいずれか1項に記載の走行経路自動選択システム。
  11. 前記作業機械の向きを取得する方位取得手段を更に有し、
    前記走行経路検索部は、前記走行経路部分の各々について、前記走行経路部分の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、前記条件を満たさないと判定する請求項8又は9に記載の走行経路自動選択システム。
  12. 前記所定の第2の値は、30°以下の所定の値である請求項4、10、11のいずれか1項に記載の走行経路自動選択システム。
  13. 前記1つ又は複数の作業対象領域のうちの少なくとも1つの作業対象領域の各々にそれぞれ対応する前記所定の走行経路は複数であり、前記走行経路開始位置から前記作業開始位置に向かう方向が異なる2つの走行経路を含む請求項4、10、11、12のいずれか1項に記載の走行経路自動選択システム。
  14. 前記走行経路検索部は、前記条件を満たす走行経路が発見された場合、前記条件を満たす走行経路を識別するための情報、並びに走行経路に進入可能な位置にいる旨の報知を指示する信号及び/又は命令を生成する請求項1〜13のいずれか1項に記載の走行経路自動選択システム。
  15. 前記走行経路検索部は、前記条件を満たす走行経路が発見された場合、更に自動運転開始指示の入力の要求の報知を指示する信号及び/又は命令を生成する請求項14に記載の走行経路自動選択システム。
  16. 前記自動運転開始指示の入力の要求の報知は、ユーザが前記作業機械に乗車していないと判定した後に行われる請求項15に記載の走行経路自動選択システム。
  17. 前記走行経路検索部は、前記条件を満たす走行経路が発見された場合、更に前記条件を満たす走行経路に関する情報の報知を指示する信号及び/又は命令を生成する請求項14〜16のいずれか1項に記載の走行経路自動選択システム。
  18. 前記記憶部は、前記1つ又は複数の作業対象領域の各々の作業履歴を記録している請求項1〜17のいずれか1項に記載の走行経路自動選択システム。
  19. 前記条件を満たす走行経路に関する情報は、前記条件を満たす走行経路の作業対象領域の前記作業履歴又は該作業履歴から得られる情報である請求項18に記載の走行経路自動選択システム。
  20. 前記1つ又は複数の作業対象領域のうちの少なくとも1つの作業対象領域の各々にそれぞれ対応する前記所定の走行経路は複数であり、前記複数の所定の走行経路のうちの少なくとも2つは、前記走行経路開始位置から所定距離の走行経路部分が同一であり、前記作業対象領域内の走行経路が互いに異なる走行経路を含み、
    前記走行経路検索部により検索される前記複数の所定の走行経路のうちの少なくとも2つの中から、所定の選択条件に基づいて、1つの走行経路が選択される請求項1〜19のいずれか1項に記載の走行経路自動選択システム。
  21. 請求項1〜19のいずれか1項に記載の走行経路自動選択システムと、
    前記作業対象領域を走行する前記作業機械の現在位置及び前記走行経路検索部により発見された前記条件を満たす走行経路に少なくとも基づいて、前記作業機械に前記走行経路を走行させるための走行制御信号を出力することにより、前記作業機械が備える走行駆動機構を制御する制御手段と、
    を含む作業機械制御システム。
  22. 請求項21に記載の作業機械制御システムから出力される前記走行制御信号に基づいて自己の走行を駆動する走行駆動機構を含む作業機械。
  23. 1つ又は複数の作業対象領域の各々について、それぞれの作業対象領域に対応する所定の走行経路に沿って自動走行しながら所定作業を行う作業機械のための走行経路自動選択方法であって、
    前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路について、少なくとも走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分を記憶部に記録するステップと、
    前記作業機械の現在位置を取得するステップと、
    前記走行経路開始位置と前記作業開始位置の間に位置する進入位置において、前記作業機械が、前記進入位置において前記走行経路を走行する場合の進行方向と同じ方向に進入するようにされた進入経路に沿って、前記作業機械が、前記作業機械の進入準備のための現在位置から前進のみで進入可能であるという条件を満たす走行経路を、前記記憶部に記録された、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の少なくとも走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分に少なくとも基づいて、前記条件を満たすか否かを判定することによって、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の中から検索するステップと、
    を含む走行経路自動選択方法。
  24. 前記記憶部に記録された、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の少なくとも走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分について、前記作業機械の現在位置を取得するステップによって取得された前記進入準備のための現在位置に対応する、前記走行経路部分上の点である対応点をそれぞれ決定し、前記走行経路部分の各々について、前記進入準備のための現在位置と前記対応点との距離が所定の第1の値よりも大きい場合に、前記条件を満たさないと判定するステップを更に含み、
    前記所定の第1の値は、少なくとも前記作業機械の操舵性能、及び所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離を考慮して予め定められたものである請求項23に記載の走行経路自動選択方法。
  25. 前記所望の前記対応点から前記作業機械が前記走行経路に進入する点までの距離に余裕距離を考慮して定められた第3の値の距離だけ前記走行経路における前記作業機械の進行方向に離れた点が、前記作業開始位置よりも前記作業機械の進行方向側に位置する場合に、前記条件を満たさないと判定するステップを更に含む請求項24に記載の走行経路自動選択方法。
  26. 前記作業機械の向きを取得するステップと、
    前記走行経路上の前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、前記条件を満たさないと判定するステップと、
    を更に含む請求項24又は25に記載の走行経路自動選択方法。
  27. 前記記録部が、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路について、走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分を含む走行開始可能エリアを記録しており、
    前記走行開始可能エリアの各々について、前記作業機械の現在位置が前記走行開始可能エリア内にあるか否かに基づいて、前記条件を満たす走行経路を、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の中から検索するステップを含む請求項23に記載の走行経路自動選択方法。
  28. 前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路について、前記走行経路部分に基づいて走行開始可能エリアを生成するステップと、
    前記走行開始可能エリアの各々について、前記作業機械の現在位置が前記走行開始可能エリア内にあるか否かに基づいて、前記条件を満たす走行経路を前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の中から検索するステップと、
    を含む請求項23に記載の走行経路自動選択方法。
  29. 前記走行開始可能エリアは、前記走行経路部分に対して前記走行経路部分の両側に所定の第1の値の幅を有する請求項27又は28に記載の走行経路自動選択方法。
  30. 前記走行開始可能エリアは、前記作業機械の手動運転による目標位置からのずれについて最大想定される量の少なくともの2倍の長さを有する請求項27〜29のいずれか1項に記載の走行経路自動選択方法。
  31. 前記走行経路部分は直線である請求項27〜30のいずれか1項に記載の走行経路自動選方法。
  32. 走行開始可能エリアは、矩形である請求項31に記載の走行経路自動選択方法。
  33. 前記作業機械の向きを取得するステップと、
    前記記憶部に記録された、前記1つ又は複数の作業対象領域の各々にそれぞれ対応する前記所定の走行経路の少なくとも走行経路開始位置から作業開始位置の間の前記走行経路開始位置から所定距離の走行経路部分について、前記作業機械の現在位置を取得するステップによって取得された前記進入準備のための現在位置に対応する、前記走行経路部分上の点である対応点をそれぞれ決定し、前記走行経路の各々について、前記対応点における接線の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、前記条件を満たさないと判定するステップと、
    を更に含む請求項27〜32のいずれか1項に記載の走行経路自動選択方法。
  34. 前記作業機械の向きを取得するステップと、
    前記走行経路部分の各々について、前記走行経路部分の方向に対する、前記作業機械の向きの角度の絶対値が所定の第2の値よりも大きい場合に、前記条件を満たさないと判定するステップと、
    を更に含む請求項31又は32に記載の走行経路自動選択方法。
  35. 前記所定の第2の値は、30°以下の所定の値である請求項26、33、34のいずれか1項に記載の走行経路自動選択方法。
  36. 前記1つ又は複数の作業対象領域のうちの少なくとも1つの作業対象領域の各々にそれぞれ対応する前記所定の走行経路は複数であり、前記走行経路開始位置から前記作業開始位置に向かう方向が異なる2つの走行経路を含む請求項26、33、34、35のいずれか1項に記載の走行経路自動選択方法。
  37. 前記検索するステップにおいて、前記条件を満たす走行経路が発見された場合、前記条件を満たす走行経路を識別するための情報、並びに走行経路に進入可能な位置にいる旨の報知を指示する信号及び/又は命令を生成する請求項23〜36のいずれか1項に記載の走行経路自動選択方法。
  38. 前記検索するステップにおいて、前記条件を満たす走行経路が発見された場合、更に自動運転開始指示の入力の要求の報知を指示する信号及び/又は命令を生成する請求項37に記載の走行経路自動選択方法。
  39. 前記自動運転開始指示の入力の要求の報知は、ユーザが前記作業機械に乗車していないと判定した後に行われる請求項38に記載の走行経路自動選択方法。
  40. 前記検索するステップにおいて、前記条件を満たす走行経路が発見された場合、更に前記条件を満たす走行経路に関する情報の報知を指示する信号及び/又は命令を生成する請求項37〜39のいずれか1項に記載の走行経路自動選択方法。
  41. 前記記憶部は、前記1つ又は複数の作業対象領域の各々の作業履歴を記録している請求項23〜40のいずれか1項に記載の走行経路自動選択方法。
  42. 前記条件を満たす走行経路に関する情報は、前記条件を満たす走行経路の作業対象領域の前記作業履歴又は該作業履歴から得られる情報である請求項41に記載の走行経路自動選択方法。
  43. 前記1つ又は複数の作業対象領域のうちの少なくとも1つの作業対象領域の各々にそれぞれ対応する前記所定の走行経路は複数であり、前記複数の所定の走行経路のうちの少なくとも2つは、前記走行経路開始位置から所定距離の走行経路部分が同一であり、前記作業対象領域内の走行経路が互いに異なる走行経路を含み、
    前記検索するステップにおいて検索される前記複数の所定の走行経路のうちの少なくとも2つの中から、所定の選択条件に基づいて、1つの走行経路が選択される請求項23〜42のいずれか1項に記載の走行経路自動選択方法。
  44. 請求項23〜43のいずれか1項に記載の走行経路自動選択方法をコンピュータに実行させるためのプログラム。
  45. 請求項44に記載のプログラムを記録したコンピュータ読み取り可能な記録媒体。
JP2016256505A 2014-07-04 2016-12-28 作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のためのシステム、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システム Active JP6289603B2 (ja)

Applications Claiming Priority (4)

Application Number Priority Date Filing Date Title
PCT/JP2014/067964 WO2016002082A1 (ja) 2014-07-04 2014-07-04 作業機械、作業機械の走行経路生成のための装置、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御装置
JPPCT/JP2014/067964 2014-07-04
PCT/JP2014/076278 WO2016002096A1 (ja) 2014-07-04 2014-10-01 作業機械、作業機械の走行経路への進入可否判定のための装置、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御装置
JPPCT/JP2014/076278 2014-10-01

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2015510525A Division JP6236652B2 (ja) 2014-07-04 2015-02-13 作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のためのシステム、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システム

Publications (2)

Publication Number Publication Date
JP2017068870A true JP2017068870A (ja) 2017-04-06
JP6289603B2 JP6289603B2 (ja) 2018-03-07

Family

ID=52573832

Family Applications (3)

Application Number Title Priority Date Filing Date
JP2014545017A Active JP5669998B1 (ja) 2014-07-04 2014-07-04 作業機械、作業機械の走行経路生成のための装置、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御装置
JP2015510525A Active JP6236652B2 (ja) 2014-07-04 2015-02-13 作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のためのシステム、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システム
JP2016256505A Active JP6289603B2 (ja) 2014-07-04 2016-12-28 作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のためのシステム、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システム

Family Applications Before (2)

Application Number Title Priority Date Filing Date
JP2014545017A Active JP5669998B1 (ja) 2014-07-04 2014-07-04 作業機械、作業機械の走行経路生成のための装置、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御装置
JP2015510525A Active JP6236652B2 (ja) 2014-07-04 2015-02-13 作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のためのシステム、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システム

Country Status (4)

Country Link
US (3) US10126752B2 (ja)
EP (2) EP4184276A1 (ja)
JP (3) JP5669998B1 (ja)
WO (3) WO2016002082A1 (ja)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109634270A (zh) * 2018-10-25 2019-04-16 丰疆智慧农业股份有限公司 用于无人驾驶农机的作业控制系统及作业控制方法
WO2020044811A1 (ja) * 2018-08-29 2020-03-05 ヤンマー株式会社 自動走行システム
JP2020086995A (ja) * 2018-11-27 2020-06-04 富士ゼロックス株式会社 自律移動装置およびプログラム
JP2021009707A (ja) * 2017-04-26 2021-01-28 株式会社クボタ 自動操舵システム
JP2022085684A (ja) * 2020-11-27 2022-06-08 株式会社クボタ 作業機
JP7506632B2 (ja) 2021-03-25 2024-06-26 ヤンマーホールディングス株式会社 車両監視方法、車両監視システム、及び車両監視プログラム

Families Citing this family (56)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10188029B1 (en) 2014-10-20 2019-01-29 Hydro-Gear Limited Partnership Method of generating a three-dimensional map of a lawn and its use to improve mowing efficiency
DE102015121972A1 (de) * 2015-12-16 2017-06-22 Vorwerk & Co. Interholding Gmbh System und Verfahren zur Bearbeitung eines Bodens mit einer mobilen Robotereinheit
EP3633481A1 (en) * 2016-03-09 2020-04-08 Yanmar Co., Ltd. Work vehicle
JP6977000B2 (ja) * 2016-03-18 2021-12-08 ヤンマーパワーテクノロジー株式会社 作業車両用経路生成システム
CA2953477C (en) * 2016-04-28 2020-06-02 Komatsu Ltd. Work machine management apparatus
US10152891B2 (en) * 2016-05-02 2018-12-11 Cnh Industrial America Llc System for avoiding collisions between autonomous vehicles conducting agricultural operations
JP6945279B2 (ja) * 2016-06-28 2021-10-06 株式会社クボタ 作業車
JP6747117B2 (ja) * 2016-07-11 2020-08-26 株式会社Ihi 航走制御方法および航走制御システム
KR102523426B1 (ko) 2016-09-05 2023-04-20 가부시끼 가이샤 구보다 작업차 자동 주행 시스템, 주행 경로 관리 장치, 주행 경로 생성 장치, 주행 경로 결정 장치
JP6688197B2 (ja) * 2016-09-09 2020-04-28 ヤンマー株式会社 自律走行システム
JP6695248B2 (ja) * 2016-09-26 2020-05-20 ヤンマー株式会社 自律走行システム
JP6832828B2 (ja) * 2016-10-26 2021-02-24 株式会社クボタ 走行経路決定装置
JP6891097B2 (ja) * 2016-12-02 2021-06-18 株式会社クボタ 走行経路決定装置
JP6920969B2 (ja) * 2016-12-19 2021-08-18 株式会社クボタ 走行経路管理システム
CN109936975B (zh) * 2016-12-02 2022-10-28 株式会社久保田 行进路线管理系统及行进路线决定装置
WO2018101351A1 (ja) * 2016-12-02 2018-06-07 株式会社クボタ 走行経路管理システム及び走行経路決定装置
JP6673813B2 (ja) * 2016-12-19 2020-03-25 株式会社クボタ 走行経路管理システム
JP6739382B2 (ja) * 2017-03-24 2020-08-12 ヤンマーパワーテクノロジー株式会社 自律走行システム
JP6718838B2 (ja) * 2017-03-31 2020-07-08 ヤンマーパワーテクノロジー株式会社 農作業車両の運転支援システム
BE1024475B1 (nl) * 2017-05-09 2018-03-01 Cnh Industrial Belgium Nv Werkwijze voor het oogsten en oogsttoestel
JP6980087B2 (ja) * 2017-05-29 2021-12-15 株式会社クボタ 自動走行作業車両のための衛星測位システム
US10980173B2 (en) * 2017-09-13 2021-04-20 Black & Decker Inc. Riding mower with removeable battery module
US10409287B2 (en) * 2017-11-30 2019-09-10 Komatsu America Corp. Vehicle guide display and path navigation method
WO2019180950A1 (ja) * 2018-03-23 2019-09-26 本田技研工業株式会社 設置位置通知システム
JP6850760B2 (ja) * 2018-03-28 2021-03-31 ヤンマーパワーテクノロジー株式会社 作業車両の自動走行装置
CN110573979B (zh) * 2018-03-29 2023-11-14 深圳市大疆软件科技有限公司 作业路径调整方法及装置、可移动设备作业路径调整方法及设备、和记录介质
WO2019194631A1 (ko) * 2018-04-06 2019-10-10 엘지전자 주식회사 이동로봇과 이동로봇의 제어방법
JP7034866B2 (ja) * 2018-08-20 2022-03-14 株式会社クボタ 収穫機
CN109362026B (zh) * 2018-09-13 2021-01-05 北京宝驰新风科技有限公司 一种用于车辆寻找车主的反向定位寻找系统
WO2020085240A1 (ja) 2018-10-22 2020-04-30 株式会社ナイルワークス 運転経路生成システム、運転経路生成方法、運転経路生成プログラム、座標測量システム、およびドローン
JP6708724B2 (ja) * 2018-11-20 2020-06-10 ヤンマーパワーテクノロジー株式会社 自律走行システム
WO2020117699A1 (en) * 2018-12-02 2020-06-11 Mtd Products Inc Autonomous mower navigation system and method
US11105653B2 (en) * 2019-02-05 2021-08-31 Caterpillar Inc. System for generating map with instructional tips
SE544390C2 (en) * 2019-03-05 2022-05-03 Husqvarna Ab Robotic work tool system and method for controlling a robotic work tool based on information from a recording device
JP6854312B2 (ja) * 2019-03-15 2021-04-07 ヤンマーパワーテクノロジー株式会社 走行領域特定装置
TWI684085B (zh) * 2019-04-24 2020-02-01 揚昇育樂事業股份有限公司 自駕車輛之自駕行駛路徑中央控制裝置
JP7353796B2 (ja) * 2019-05-17 2023-10-02 ヤンマーパワーテクノロジー株式会社 作業車両用の自動走行システム
JP7280759B2 (ja) * 2019-06-20 2023-05-24 ヤンマーパワーテクノロジー株式会社 散布作業用の自動走行システム
US11623689B2 (en) * 2019-09-09 2023-04-11 Mtd Products Inc Real time kinematics power equipment device with auto-steering
CN118476376A (zh) * 2019-11-29 2024-08-13 株式会社久保田 自动行驶控制系统、联合收割机、收获机
JP7275010B2 (ja) * 2019-11-29 2023-05-17 株式会社クボタ 自動走行制御システム、及び、コンバイン
JP7047830B2 (ja) * 2019-12-05 2022-04-05 オムロン株式会社 自律走行システム、自律走行方法、及び自律走行プログラム
JP7330878B2 (ja) * 2019-12-18 2023-08-22 株式会社クボタ 作業機
JP7316612B2 (ja) * 2020-02-04 2023-07-28 パナソニックIpマネジメント株式会社 運転支援装置、車両、及び、運転支援方法
SG11202109597YA (en) * 2020-02-13 2021-11-29 Sunrise Resort Inc Golf-shot-tracking-self-driving-path central controlling system
JP7050837B2 (ja) * 2020-03-04 2022-04-08 株式会社クボタ 走行経路管理システム及び収穫機
US12103516B2 (en) * 2020-03-31 2024-10-01 Baidu Usa Llc Parking-trajectory generation method combined with offline and online solutions
JP2020113325A (ja) * 2020-04-03 2020-07-27 ヤンマーパワーテクノロジー株式会社 自律走行システム
JP7332732B2 (ja) * 2020-04-03 2023-08-23 ヤンマーパワーテクノロジー株式会社 自律走行システム
JP7248619B2 (ja) * 2020-04-21 2023-03-29 ヤンマーパワーテクノロジー株式会社 自律走行システム
JP7122339B2 (ja) * 2020-05-21 2022-08-19 ヤンマーパワーテクノロジー株式会社 自律走行システム
JP7511491B2 (ja) 2021-01-05 2024-07-05 株式会社クボタ 自動走行システム及び自動走行方法
JP6997889B2 (ja) * 2021-01-29 2022-01-18 ヤンマーパワーテクノロジー株式会社 経路生成システム
US20230065712A1 (en) * 2021-08-31 2023-03-02 Deere & Company Methods, apparatus, and articles of manufacture to generate a turn path for a vehicle
JP2023150418A (ja) * 2022-03-31 2023-10-16 ヤンマーホールディングス株式会社 経路生成方法、経路生成システム、及び経路生成プログラム
CN115240452B (zh) * 2022-09-23 2022-12-09 山东科翔智能科技有限公司 一种智能化农机北斗导航自动驾驶辅助系统

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0346011A (ja) * 1989-07-14 1991-02-27 Toshiba Corp 無人搬送車の合流制御装置
JP2004168085A (ja) * 2002-11-18 2004-06-17 Nissan Motor Co Ltd 駐車支援装置
JP2004171430A (ja) * 2002-11-22 2004-06-17 Sanyo Electric Co Ltd 搬送車
JP2009053927A (ja) * 2007-08-27 2009-03-12 Panasonic Electric Works Co Ltd 自律移動のための経路生成装置および該装置を用いた自律移動装置
JP2013228821A (ja) * 2012-04-24 2013-11-07 Mamiya-Op Nequos Co Ltd 作業機械及びその構成装置、コンピュータプログラム
JP2014108711A (ja) * 2012-11-30 2014-06-12 Toyota Motor Corp 駐車支援装置

Family Cites Families (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0949729A (ja) * 1995-08-07 1997-02-18 Hitachi Ltd 移動作業機械の運転方法及び作業データの作成方法
JP3318170B2 (ja) * 1995-11-02 2002-08-26 株式会社日立製作所 自動走行機械の経路生成方法
DE19629618A1 (de) * 1996-07-23 1998-01-29 Claas Ohg Routenplanungssystem für landwirtschaftliche Arbeitsfahrzeuge
JP3454666B2 (ja) * 1997-05-15 2003-10-06 株式会社日立産機システム 自走式作業機械の走行制御方法
JPH117318A (ja) * 1997-06-16 1999-01-12 Nissan Motor Co Ltd 移動ロボットの走行制御方法
GB2386970A (en) * 2002-03-26 2003-10-01 Mcmurtry Ltd Environmentally responsive ground maintenance equipment
US6907336B2 (en) * 2003-03-31 2005-06-14 Deere & Company Method and system for efficiently traversing an area with a work vehicle
JP2005078415A (ja) * 2003-09-01 2005-03-24 Fuji Heavy Ind Ltd 走行経路生成方法、走行経路生成装置およびコンピュータプログラム
JP4369419B2 (ja) * 2005-12-09 2009-11-18 株式会社小松製作所 無人車両の誘導走行制御装置
JP2008129695A (ja) * 2006-11-17 2008-06-05 Toyota Motor Corp 移動体の経路生成システム及び経路生成方法
JP5140864B2 (ja) * 2010-11-22 2013-02-13 株式会社小松製作所 無人車両の走行システムおよび走行経路生成方法
US8548666B2 (en) * 2011-12-23 2013-10-01 Agco Corporation Auto-guidance
JP5859912B2 (ja) * 2012-05-10 2016-02-16 株式会社Ihiスター 作業機用の制御装置及び作業機用の制御方法
JP5868788B2 (ja) * 2012-06-13 2016-02-24 住友重機械工業株式会社 移動体
GB201223363D0 (en) * 2012-12-24 2013-02-06 Agco Int Gmbh Path planning method for agricultural vehicle guidance
US9072219B2 (en) * 2013-06-20 2015-07-07 Deere & Company Robotic mower navigation system

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0346011A (ja) * 1989-07-14 1991-02-27 Toshiba Corp 無人搬送車の合流制御装置
JP2004168085A (ja) * 2002-11-18 2004-06-17 Nissan Motor Co Ltd 駐車支援装置
JP2004171430A (ja) * 2002-11-22 2004-06-17 Sanyo Electric Co Ltd 搬送車
JP2009053927A (ja) * 2007-08-27 2009-03-12 Panasonic Electric Works Co Ltd 自律移動のための経路生成装置および該装置を用いた自律移動装置
JP2013228821A (ja) * 2012-04-24 2013-11-07 Mamiya-Op Nequos Co Ltd 作業機械及びその構成装置、コンピュータプログラム
JP2014108711A (ja) * 2012-11-30 2014-06-12 Toyota Motor Corp 駐車支援装置

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021009707A (ja) * 2017-04-26 2021-01-28 株式会社クボタ 自動操舵システム
WO2020044811A1 (ja) * 2018-08-29 2020-03-05 ヤンマー株式会社 自動走行システム
CN109634270A (zh) * 2018-10-25 2019-04-16 丰疆智慧农业股份有限公司 用于无人驾驶农机的作业控制系统及作业控制方法
JP2020086995A (ja) * 2018-11-27 2020-06-04 富士ゼロックス株式会社 自律移動装置およびプログラム
JP2022085684A (ja) * 2020-11-27 2022-06-08 株式会社クボタ 作業機
JP7401422B2 (ja) 2020-11-27 2023-12-19 株式会社クボタ 作業機
JP7506632B2 (ja) 2021-03-25 2024-06-26 ヤンマーホールディングス株式会社 車両監視方法、車両監視システム、及び車両監視プログラム

Also Published As

Publication number Publication date
JPWO2016002082A1 (ja) 2017-04-27
US20170168491A1 (en) 2017-06-15
JP6289603B2 (ja) 2018-03-07
WO2016002082A1 (ja) 2016-01-07
US20170102702A1 (en) 2017-04-13
EP3165985A4 (en) 2018-03-14
JP5669998B1 (ja) 2015-02-18
US10114377B2 (en) 2018-10-30
US10126752B2 (en) 2018-11-13
US20170168490A1 (en) 2017-06-15
EP3165985A1 (en) 2017-05-10
US10120382B2 (en) 2018-11-06
WO2016002096A1 (ja) 2016-01-07
JP6236652B2 (ja) 2017-11-29
JPWO2016002246A1 (ja) 2017-04-27
EP4184276A1 (en) 2023-05-24
WO2016002246A1 (ja) 2016-01-07

Similar Documents

Publication Publication Date Title
JP6289603B2 (ja) 作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のためのシステム、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システム
JPWO2016002246A6 (ja) 作業機械、作業機械の走行経路生成、走行経路への進入可否判定、走行経路自動選択のためのシステム、方法、プログラム、プログラムを記録した記録媒体、作業機械の走行制御システム
US10197407B2 (en) Method and robot system for autonomous control of a vehicle
RU2467374C2 (ru) Устройство для определения маршрута транспортного средства
KR20210039452A (ko) 자동 조타 시스템 및 수확기, 자동 조타 방법, 자동 조타 프로그램, 기록 매체
JP5667731B1 (ja) 圃場ガイダンスシステム及び圃場ガイダンス方法並びにソフトウェア及びソフトウェアを格納した記憶媒体
KR101879247B1 (ko) 자율주행 농업기계의 작업경로 설정방법
US7689356B2 (en) Method and apparatus for creating curved swath patterns for farm machinery
JP2013228821A (ja) 作業機械及びその構成装置、コンピュータプログラム
US20170223889A1 (en) Real-time field mapping for autonomous agricultural platform
US20070233348A1 (en) Method for controlling agricultural machine systems
US20100179716A1 (en) Method for Creating Spiral Swath Patterns for Convex Polygon Shaped Field Boundaries
KR20200018732A (ko) 자율 주행 경로 생성 시스템
US20050038578A1 (en) Method of operating an automated land maintenance vehicle
JP6031491B2 (ja) 圃場ガイダンスシステム及び圃場ガイダンス方法並びにソフトウェア及びソフトウェアを格納した記憶媒体
JP2017060524A (ja) 圃場ガイダンスシステム及び圃場ガイダンス方法並びにソフトウェア及びソフトウェアを格納した記憶媒体
Paraforos et al. Automatic determination of headland turning from auto-steering position data for minimising the infield non-working time
JP6088104B2 (ja) 圃場ガイダンスシステム及び圃場ガイダンス方法並びにソフトウェア及びソフトウェアを格納した記憶媒体
EP3330824A1 (en) Method and robot system for autonomous control of a vehicle
JP6772105B2 (ja) 作業管理システム
JP4753169B2 (ja) 特定区画の推定方法及び特定区画の確定方法
JP2018139604A (ja) 圃場ガイダンスシステム及び圃場ガイダンス方法並びにソフトウェア及びソフトウェアを格納した記憶媒体
US20210037702A1 (en) Dynamically adjusting the cutting height of a mower deck based on a mower's location
JP6857267B2 (ja) 圃場ガイダンスシステム及び圃場ガイダンス方法並びにソフトウェア及びソフトウェアを格納した記憶媒体
CN110268351A (zh) 具有限定的路径和安全措施的机器人车辆

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20161228

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20161228

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20171002

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20170929

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20171201

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20171218

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20171222

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: 20180115

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20180206

R150 Certificate of patent or registration of utility model

Ref document number: 6289603

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

S531 Written request for registration of change of domicile

Free format text: JAPANESE INTERMEDIATE CODE: R313531

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250