JP2021108566A - Stack determining device for robot work machine - Google Patents
Stack determining device for robot work machine Download PDFInfo
- Publication number
- JP2021108566A JP2021108566A JP2020002021A JP2020002021A JP2021108566A JP 2021108566 A JP2021108566 A JP 2021108566A JP 2020002021 A JP2020002021 A JP 2020002021A JP 2020002021 A JP2020002021 A JP 2020002021A JP 2021108566 A JP2021108566 A JP 2021108566A
- Authority
- JP
- Japan
- Prior art keywords
- work
- work machine
- stack
- predetermined time
- signal
- 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.)
- Pending
Links
- 230000001133 acceleration Effects 0.000 claims description 48
- 238000001514 detection method Methods 0.000 claims description 43
- 230000002093 peripheral effect Effects 0.000 claims description 6
- 230000006854 communication Effects 0.000 claims description 5
- 238000004891 communication Methods 0.000 claims description 5
- 230000007175 bidirectional communication Effects 0.000 claims 1
- 238000000034 method Methods 0.000 description 130
- 230000008569 process Effects 0.000 description 127
- 230000007246 mechanism Effects 0.000 description 35
- 230000008859 change Effects 0.000 description 22
- 230000000694 effects Effects 0.000 description 20
- 238000006557 surface reaction Methods 0.000 description 7
- 238000010586 diagram Methods 0.000 description 6
- 238000012545 processing Methods 0.000 description 5
- 230000005540 biological transmission Effects 0.000 description 3
- 239000003550 marker Substances 0.000 description 3
- 238000003032 molecular docking Methods 0.000 description 3
- 238000000926 separation method Methods 0.000 description 3
- 238000002485 combustion reaction Methods 0.000 description 2
- 238000005265 energy consumption Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- HBBGRARXTFLTSG-UHFFFAOYSA-N Lithium ion Chemical compound [Li+] HBBGRARXTFLTSG-UHFFFAOYSA-N 0.000 description 1
- 241000270666 Testudines Species 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000007667 floating Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 229910001416 lithium ion Inorganic materials 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 239000004575 stone Substances 0.000 description 1
- 238000004804 winding Methods 0.000 description 1
Images
Classifications
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D34/00—Mowers; Mowing apparatus of harvesters
- A01D34/006—Control or measuring arrangements
- A01D34/008—Control or measuring arrangements for automated or remotely controlled operation
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0272—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising means for registering the travel distance, e.g. revolutions of wheels
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental Sciences (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Guiding Agricultural Machines (AREA)
- Harvester Elements (AREA)
Abstract
Description
この発明は、作業エリアを原動機で走行しながら搭載作業具で作業するロボット作業機のスタック判定装置に関する。 The present invention relates to a stack determination device for a robot work machine that works with on-board work tools while traveling on a work area with a prime mover.
この種のロボット作業機としては例えば特許文献１記載の技術が知られている。特許文献１記載の技術は、作業エリアの周縁に配置され、電源から電流を通電される電線の磁界（エリア信号）を検出して作業エリアの境界を認識すると共に、ユーザによって設定された作業をブレード（搭載作業具）で実行するように構成している。
As a robot working machine of this type, for example, the technique described in
特許文献１記載のロボット作業機が走行する作業エリアは必ずしも平坦ではないことから、図２０に示すように石などに乗り上げて駆動輪が空転したり、石などに進路を阻まれて前進不可となったりする場合がある。泥濘路や雪道でも駆動輪が空転してスタックすることもある。尚、ここで「スタック」とは駆動輪をとられて作業機が立ち往生する場合など、作業機が停止したままとなってユーザの意図通りに移動できない全ての場合を意味する。
Since the work area in which the robot work machine described in
しかしながら、この種のロボット作業機にあっては、従来、スタックを判定することができず、ある時間走行して作業エリアを規定する電線のエリア信号を検出できない場合には停止させているのが実情である。 However, in this type of robot work machine, conventionally, it is not possible to determine the stack, and if the area signal of the electric wire that defines the work area cannot be detected after traveling for a certain period of time, the robot work machine is stopped. It is the actual situation.
従って、この発明は、作業エリアでのスタックを簡易に判定するようにしたロボット作業機のスタック判定装置を提供することにある。 Therefore, the present invention is to provide a stack determination device for a robot work machine that can easily determine a stack in a work area.
上記した課題を解決するため、この発明に係るロボット作業機のスタック判定装置は、車体に取り付けられる駆動輪を原動機で駆動して作業エリアを走行するロボット作業機において、前記作業エリアに配置された固定信号源からの信号を検知する信号検知部と、前記信号検知部で検知された信号の強度が所定時間以上変化しないか否か判定し、変化しないとき、前記作業機がスタックしたと判定するスタック判定部とを備える如く構成した。 In order to solve the above-mentioned problems, the stack determination device of the robot work machine according to the present invention is arranged in the work area in the robot work machine that travels in the work area by driving the drive wheels attached to the vehicle body with the prime mover. It is determined whether or not the signal strength of the signal detection unit that detects the signal from the fixed signal source and the signal strength detected by the signal detection unit does not change for a predetermined time or longer, and if it does not change, it is determined that the work equipment is stuck. It is configured to include a stack determination unit.
また、この発明に係るロボット作業機のスタック判定装置は、車体に取り付けられる車輪を原動機で駆動して作業エリアを走行するロボット作業機において、前記作業エリアにおける前記作業機の位置を検知する位置検知部と、前記位置検知部で検知された前記作業機の位置が所定時間以上変化しないか否か判定し、変化しないとき、前記作業機がスタックしたと判定するスタック判定部とを備える如く構成した。 Further, the stack determination device of the robot work machine according to the present invention is a position detection that detects the position of the work machine in the work area in the robot work machine that drives the wheels attached to the vehicle body by the prime mover and travels in the work area. It is configured to include a unit and a stack determination unit that determines whether or not the position of the work machine detected by the position detection unit does not change for a predetermined time or more, and if it does not change, determines that the work machine is stuck. ..
（第１実施形態）
図１はこの発明の第１実施形態に係るスタック判定装置が前提とするロボット作業機を模式的に示す説明図、図２は図１のロボット作業機の上面図、図３は図１のロボット作業機（実機として示す）の底部斜視図である。
(First Embodiment)
FIG. 1 is an explanatory view schematically showing a robot working machine presupposed by the stack determination device according to the first embodiment of the present invention, FIG. 2 is a top view of the robot working machine of FIG. 1, and FIG. 3 is a robot of FIG. It is a bottom perspective view of a working machine (shown as an actual machine).
図１において符号１０はロボット作業機（以下「作業機」という）を示す。作業機１０は具体的には芝刈り機からなる。作業機１０は車体１２を備え、車体１２はシャシ１２ａとそれに取り付けられるフレーム１２ｂとからなる。
In FIG. 1,
以下では上面視における作業機１０の進行方向（車長方向）と、それに直交する横方向（車幅方向）と、進行方向と横方向に直交する鉛直方向とをそれぞれ前後方向、左右方向、上下方向と定義し、それに従って各部の構成を説明する。
In the following, the traveling direction (vehicle length direction) of the
作業機１０は、前後方向においてシャシ１２ａの前側にステー１２ａ１を介して固定される比較的小径の左右２個の前輪１４を備えると共に、それに隣接して後側でシャシ１２ａに直接取り付けられる比較的大径の左右の後輪１６を備える。この実施形態および以降の実施形態において後輪１６と前輪１４の一方または双方は図示のような車輪型に限らず、クローラ（キャタピラ）式であっても良い。
The
作業機１０のシャシ１２ａの中央位置付近には芝刈り作業用のブレード（ロータリブレード。作業具）２０が取り付けられると共に、その上部には電動モータ（以下「ワークモータ」という）２２が配置される。
A blade (rotary blade. Work tool) 20 for lawn mowing work is attached near the center position of the
ブレード２０は、図３に示す如く、ワークモータ２２の回転軸２２ａに連結されるディスク２０ａと、ディスク２０ａの円周に相互に１２０度ずつの間隔をあけて取り付けられる３個のブレード部２０ｂとからなる。尚、その詳細は本出願人が先に提案した国際公開公報（ＷＯ２０１８／０７８８７９ Ａ１）に記載されているので、これ以上の説明は止める。
As shown in FIG. 3, the
ブレード２０のディスク２０ａは回転軸２２ａを介してワークモータ２２に接続され、ワークモータ２２によってディスク２０ａとブレード部２０ｂとが一体に回転駆動されて芝を刈るように構成される。ブレード２０はＣＷ（時計方向）とＣＣＷ（反時計方向）に回転可能である。
The
尚、ブレード２０は図３に示す形状に限るものではなく、ワークモータ２２によって回転駆動されるものであれば、長尺の１個のカッタなど、どのような形状でも良い。
The
作業機１０のシャシ１２ａには、ブレード２０の後端側で２個の電動モータ（原動機。以下「ドライブモータ」という）２６Ｌ，２６Ｒが取り付けられる。ドライブモータ２６Ｌ，２６Ｒは左右の後輪１６に接続され、前輪１４を従動輪、後輪１６を駆動輪として左右独立に正転（前進方向への回転）あるいは逆転（後進方向への回転）させる。ブレード２０とワークモータ２２とドライブモータ２６などはフレーム１２ｂで被覆される。
Two electric motors (motors; hereinafter referred to as "drive motors") 26L and 26R are attached to the
この実施形態において、作業機１０はユーザが運搬可能な重量と寸法を有し、例えば全長（前後方向長さ）７１ｃｍ程度、全幅５５ｃｍ程度、高さ３０ｃｍ程度の寸法を有する。
In this embodiment, the
作業機１０の後部には搭載充電ユニット３０と搭載電池（バッテリ）３２とが格納されると共に、フレーム１２ｂには一対の電池充電端子３４が前進方向の前端位置において前方に突出するように取り付けられる。搭載電池３２は例えばリチウムイオン電池からなる。
The on-
電池充電端子３４は搭載充電ユニット３０に配線を介して接続されると共に、搭載充電ユニット３０は搭載電池３２に接続される。また、ワークモータ２２とドライブモータ２６も搭載電池３２に接続され、搭載電池３２から通電されるように構成される。尚、図１では配線の図示を省略する。
The
作業機１０において車体１２の前側には左右２個の磁気センサ（第１磁気センサ３６Ｌ、第２磁気センサ３６Ｒ）が配置されると共に、後側には１個の第３磁気センサ３６Ｃが配置され、それぞれ磁界の大きさ（磁界強度）を示す信号を出力する。図２に示す如く、第１、第２磁気センサ３６Ｌ，３６Ｒは作業機１０の車体１２の前後方向において前側に前後方向に延びる車体中心線ＣＬ１に対して左右方向に対称となる位置に、第３磁気センサ３６Ｃは車体中心線ＣＬ１上に配置される。
In the
図１に示す如く、ブレード２０（とワークモータ２２）にはブレード高さ調節機構３８が設けられ、ブレード２０はブレード高さ調節機構３８によって接地面ＧＲに対して上下方向の高さが調節可能に構成される。
As shown in FIG. 1, the blade 20 (and the work motor 22) is provided with a blade height adjusting mechanism 38, and the height of the
ブレード高さ調節機構３８は、図４に示す如く、電動モータ（以下「高さ調節モータ」という）３８ａと、ドライブギア３８ｂと、ドライブギア３８ｂに噛合するドリブンギア３８ｃと、ドライブギア３８ｂの過回転を阻止するラチェット３８ｄとを備え、ドリブンギア３８ｃはブレード２０に接続されるように構成される。
As shown in FIG. 4, the blade height adjusting mechanism 38 includes an electric motor (hereinafter referred to as “height adjusting motor”) 38a, a
図４において符号１２ｂ１はフレーム１２ｂの底部を、符号２０ｃはブレード２０のフードを示す。また、ブレード２０は図１に示すように作業機１０の矢印で示す前方に向けて前下がりとなるようにフレーム１２ｂに取り付けられる。
In FIG. 4, reference numeral 12b1 indicates the bottom portion of the
また、作業機１０の車体１２のフレーム１２ｂには、障害物や異物との接触によってフレーム１２ｂがシャシ１２ａから外れるとき、オン信号を出力する接触センサ４０が取り付けられる。
Further, a
図１において作業機１０の中央位置付近には収納ボックス（図示せず）が設けられると共に、その内部に収納された回路基板４２上にはマイクロコンピュータからなる電子制御ユニット（Electronic Control Unit。制御装置。以下「ＥＣＵ」という）４４が搭載される。図５に示す如く、ＥＣＵ４４は、ＣＰＵ４４ａと、Ｉ／Ｏ４４ｂと、メモリ（ＲＯＭ，ＥＥＰＲＯＭ，ＲＡＭ）４４ｃを備える。
In FIG. 1, a storage box (not shown) is provided near the center position of the
回路基板４２上には、ＥＣＵ４４に近接して作業機１０の重心位置のｚ軸（鉛直軸）回りの角速度（ヨーレート）を示す出力を生じる角速度センサ４６と、作業機１０が走行するときの加速度を示す出力を生じる加速度センサ５０と、地磁気に応じた絶対方位を示す出力を生じる方位センサ５２と、ＧＰＳ衛星からの電波を受信して作業機１０の現在位置（緯度、経度）を示す出力を生じるＧＰＳ受信機（後述の位置検知部）５４が設けられる。
On the
また、作業機１０の左右の後輪１６の付近には左右の後輪１６の回転（車輪速）を示す出力を生じる駆動輪回転センサ５６が配置されると共に、シャシ１２ａとフレーム１２ｂの間には、ユーザなどによってフレーム１２ｂがシャシ１２ａからリフトされたとき、オン信号を出力するリフトセンサ６０が配置される。搭載電池３２には搭載電池３２の消費電流を示す出力を生じる電流センサ６２が配置される。
Further, a drive
また、作業機１０には、作業の動作開始などを指令するメインスイッチ６４と非常停止を指令する非常停止スイッチ６６とがユーザの操作自在に設けられる。さらに、作業機１０のフレーム１２ｂは上面で大きく切り欠かれてそこにユーザの指令などの入力のためのキーボードやタッチパネルなどの入力機器６８が設けられると共に、ディスプレイ７０が設けられる。入力機器６８とディスプレイ７０はＥＣＵ４４に接続され、ディスプレイ７０にはＥＣＵ４４の指令に応じて作業モードなどの各種の情報が表示される。
Further, the
図５に示す如く、磁気センサ３６、接触センサ４０、角速度センサ４６などのセンサ類の出力とメインスイッチ６４などのスイッチ類の出力は、ＥＣＵ４４に送られ、Ｉ／Ｏ４４ｂを介して入力される。ＥＣＵ４４は、それらの出力に基づき、搭載電池３２からワークモータ２２とドライブモータ２６に通電すると共に、Ｉ／Ｏ４４ｂを介して制御値を出力してワークモータ２２とドライブモータ２６の動作を制御することで作業機１０の走行を制御する。
As shown in FIG. 5, the output of sensors such as the
また、ＥＣＵ４４が高さ調節モータ３８ａに通電すると、ブレード２０がワークモータ２２と共に上下方向に自動的に上昇あるいは下降され、ブレード２０の接地面ＧＲに対する高さが調節される。
Further, when the
ブレード高さ調節機構３８のドリブンギア３８ｃの付近にはフォトセンサ３８ｅが配置されてブレード２０の、フレーム１２ｂに対する高さ、換言すればブレード２０の接地面ＧＲに対する高さを示す出力を生じる。フォトセンサ３８ｅの出力はＥＣＵ４４に入力され、ＥＣＵ４４はフォトセンサ３８ｅからの入力値に基づいてブレード高さ調節機構３８の動作を制御してブレード２０の高さ（昇降）を調節する。
A
ドライブモータ２６Ｌ，２６Ｒは左右の後輪１６を互いに独立に正転（前進方向への回転）あるいは逆転（後進方向への回転）可能に構成され、左右の後輪１６の回転に速度差を生じさせて作業機１０を任意の方向に旋回させるように構成される。
The
例えば、左右の後輪１６をそれぞれ正転させる際、右後輪１６の回転速度を左後輪１６の回転速度よりも速くすると、その速度差に応じた旋回角度で作業機１０は左方に旋回する。一方、左後輪１６の回転速度を右後輪１６の回転速度よりも速くすると、その速度差に応じた旋回角度で作業機１０を右方に旋回する。また、左右の後輪１６を互いに同一速度で一方を正転、他方を逆転させると、作業機１０はその場で旋回する。
For example, when the left and right
また、ＥＣＵ４４はセンサ類の出力、特に磁気センサ３６の出力から作業エリア（作業領域）ＡＲの周縁（境界）を検出（認識）し、それに基づいてワークモータ２２に通電して作業エリアＡＲで作業させる。作業エリアＡＲの検出（認識）とそこでの作業について図６を参照して説明する。
Further, the
作業エリアＡＲは、その周縁（境界）に埋設されるなどして配置されるエリアワイヤ（電線。固定信号源）７２によって規定される。エリアワイヤ７２には作業機１０の搭載電池３２を充電するための充電ステーション（以下「充電ＳＴ」という）７６が配置される。なお、図６では作業機１０や充電ＳＴ７６の大きさなどを誇張して示す。
The work area AR is defined by an area wire (electric wire, fixed signal source) 72 arranged so as to be buried in the peripheral edge (boundary) thereof. A charging station (hereinafter referred to as “charging ST”) 76 for charging the on-
図７は充電ＳＴ７６の電気的な構成を示すブロック図である。 FIG. 7 is a block diagram showing an electrical configuration of the charging ST76.
同図に示す如く、充電ＳＴ７６は、電源（商用電源）８０にコンセント８２を介して接続される充電器８４と、充電器８４に接続される一対の充電端子８６とを備える。充電端子８６は、作業機１０に搭載される一対の電池充電端子３４にその接点３４ａ（図２に示す）を介して接続自在に構成される。
As shown in the figure, the charging ST76 includes a
充電器８４は、ＡＣ／ＤＣ変換器８４ａと、ＡＣ／ＤＣ変換器８４ａの動作を制御するマイクロコンピュータからなる充電用ＥＣＵ（電子制御ユニット）８４ｂと、信号発生器８４ｃとを備える。
The
充電ＳＴ７６において電源８０からコンセント８２を通じて送られる交流は、充電器８４のＡＣ／ＤＣ変換器８４ａで適宜な電圧に降圧されつつ直流に変換されて充電端子８６に送られ、充電ＳＴ７６に帰還した作業機１０が充電端子８６と電池充電端子３４とを介して接続（ドッキング）されたとき、作業機１０の搭載電池３２を充電するように構成される。
The alternating current sent from the
また、ＡＣ／ＤＣ変換器８４ａの出力は信号発生器８４ｃと充電用ＥＣＵ８４ｂに供給される。充電用ＥＣＵ８４ｂはＥＣＵ４４と通信自在に構成され、ＥＣＵ４４の指令に応じて信号発生器８４ｃの動作を制御する。
Further, the output of the AC /
信号発生器８４ｃは、ＥＣＵ４４から充電用ＥＣＵ８４ｂへの指令に従ってＡＣ／ＤＣ変換器８４ａで適宜な電圧に降圧された直流電流を所定の信号に変換し、エリアワイヤ７２と、充電ＳＴ７６でのドッキング位置を示すドッキングワイヤ（電線）９０と、充電ＳＴ７６を示すＳＴワイヤ（電線）９２に通電する。
The signal generator 84c converts the direct current lowered to an appropriate voltage by the AC /
図８に、信号発生器８４ｃからエリアワイヤ７２に通電される電流の波形を示す。電流波形は信号長Ｌを有し、任意な周期Ｔｎで通電される。尚。図示は省略するが、信号発生器８４ｃはドッキングワイヤ９０とＳＴワイヤ９２にも同種の電流波形（位相において異なる）を通電する。
FIG. 8 shows the waveform of the current applied from the signal generator 84c to the
図６に戻って作業エリアＡＲの検出について説明すると、信号発生器８４ｃによってエリアワイヤ７２に図８に示されるような電流が流されると、アンペアの右ねじの法則に従ってエリアワイヤ７２を中心として右巻き同心円状の磁界が発生する。このときの磁界強度はエリアワイヤ７２の全長によって相違すると共に、作業機１０のエリアワイヤ７２からの離間距離によっても相違する 。
Returning to FIG. 6, when the detection of the work area AR will be described, when a current as shown in FIG. 8 is passed through the
図９は、エリアワイヤ７２からの離間距離ｄと磁界強度Ｈとの関係を示す図である。同図に示すように、磁界強度Ｈはエリアワイヤ７２からの離間距離ｄに応じて変化し、エリアワイヤ７２上において０となり、作業エリアＡＲの内側でプラス、外側でマイナスの値となる。
FIG. 9 is a diagram showing the relationship between the distance d from the
ＥＣＵ４４はエリアワイヤ７２への通電によって発生する磁界（エリア信号）の強度を作業機１０に搭載された磁気センサ３６で検出することによって作業エリアＡＲ内における作業機（自機）１０の位置、即ち、作業機１０が作業エリアＡＲの内側／外側のいずれにいるかを判断すると共に、エリアワイヤ７２に対する作業機１０の位置（離間距離）を検出（算出）する。尚、その詳細は特許文献１に記載されているので、説明は以上に止める。
The
この実施形態に係るロボット作業機のスタック判定装置の特徴は、作業エリアＡＲでの作業機１０のスタック判定にあるので、以下その点に焦点をおいて説明する。
Since the feature of the stack determination device of the robot work machine according to this embodiment lies in the stack determination of the
図１０はその動作を示すフロー・チャートである。図示のプログラムは、ユーザによってメインスイッチ６４がオンされて通常の芝刈り作業モードが実行されるとき、ＥＣＵ４４によって実行される。
FIG. 10 is a flow chart showing the operation. The illustrated program is executed by the
以下説明すると、Ｓ１０において固定信号源からの信号、即ち、エリアワイヤ７２からのエリア信号の強度の変化をモニタ（検知）する（Ｓ：処理ステップ）。
Described below, in S10, a change in the intensity of the signal from the fixed signal source, that is, the area signal from the
次いでＳ１２に進み、エリア信号の強度が所定時間（例えば１０ｓｅｃ）以上同一範囲にあるか否か、換言すればエリア信号の強度が所定時間以上変化しない否か判断する。強度が「所定時間以上同一範囲にある」とは、強度が同じ値にあるか、あるいは同じ値でないにしても差が微小であることを意味する。 Next, the process proceeds to S12, and it is determined whether or not the strength of the area signal is in the same range for a predetermined time (for example, 10 sec) or more, in other words, whether or not the strength of the area signal does not change for a predetermined time or longer. When the intensities are "in the same range for a predetermined time or more", it means that the intensities are at the same value, or the difference is small even if they are not the same values.
Ｓ１２で否定されるときは作業機１０がスタックしていないと判断（判定）してＳ１４に進み、通常の芝刈り作業モードに復帰する。一方、肯定される（同一範囲にある）ときはＳ１６に進み、作業機１０がスタックしたと判定する。
If it is denied in S12, it is determined (determined) that the working
これについて説明すると、エリア信号の強度を搭載された磁気センサ３６で検出して作業エリアＡＲ内における作業機（自機）１０の位置を検出することから、エリア信号の強度が所定時間以上同一範囲にあることは作業機１０が所定時間以上、作業エリアＡＲで同じ位置にあることを意味し、よって作業機１０がスタックしたと判定することができる。
Explaining this, since the position of the work machine (own machine) 10 in the work area AR is detected by detecting the strength of the area signal with the mounted
尚、エリア信号の検知精度を上げるため、図６に想像線（符号ａ）で示すように、エリアワイヤ（電線）７２は作業エリアＡＲの内側に向けて局部的に突出するように配置しても良く、想像線（符号ｂ）で示すように所定の位置（例えば充電ＳＴ７６）から作業エリアＡＲの内側に向けて分岐するように配置しても良い。 In order to improve the detection accuracy of the area signal, as shown by the imaginary line (reference numeral a) in FIG. 6, the area wire (electric wire) 72 is arranged so as to locally project toward the inside of the work area AR. Alternatively, as shown by the imaginary line (reference numeral b), it may be arranged so as to branch from a predetermined position (for example, charging ST76) toward the inside of the work area AR.
即ち、エリアワイヤ７２は作業エリアＡＲの内側に向けて延びるように配置しても良い。これにより、作業機１０が作業エリアＡＲの内奥部位にあるときも、その位置を精度良く検知することができる。
That is, the
尚、符号ａの場合、エリアワイヤ７２は内側に突出した後、幅ＡＲｗで折り返される。幅ＡＲｗは作業機１０の前側に配置される第１、第２磁気センサ３６Ｌ，３６Ｒの離間距離未満の値とする。具体的には、第３磁気センサ３６Ｃも含めた３個の磁気センサの出力が全て作業機１０が作業エリアＡＲの外に出たことを示すとき、作業機１０が作業エリアＡＲの外に出たと判断するように構成することで、内奥部位でのエリア信号の検知精度を向上できると共に、通常の作業におけるエリア信号による位置検出の妨げとはならない。
In the case of reference numeral a, the
図１０フロー・チャートにあっては、Ｓ１６で作業機１０がスタックしたと判定されると、脱出モードに移行する。
In the flow chart of FIG. 10, when it is determined in S16 that the working
脱出モードにおいては次のＳ１８において先ず作業機１０を規定時間（例えば５ｓｅｃ）だけ微速で前進または後退させるようにドライブモータ２６の駆動を制御する。次いでＳ２０に進み、エリア信号の強度が所定時間以上同一範囲にあるか否か判断する。
In the escape mode, in the next S18, the drive of the
例えば作業機１０が図２０に示すような状態にあるとき、作業機１０を後退させることで作業機１０の移動は可能となってスタックから脱出させることも可能となる。その場合、Ｓ２０の判断は否定されてＳ１４に進む。
For example, when the
他方、Ｓ２０で依然として肯定されるときはＳ２２に進み、ドライブモータ２６を駆動して既定時間（例えば３ｓｅｃ）、作業機１０を左に旋回させ、次いで前進させ、次いで右に旋回させる。
On the other hand, if it is still affirmed in S20, the process proceeds to S22, and the
Ｓ２２の処理は作業機１０を現状から移動させるための処理であるので、旋回などの順序は例示であり、最初に前進させてから左に旋回させるなど変更可能である。尚、ここで「旋回」とは先に述べたように左右の駆動輪１６に回転速度差を与える、左右の駆動輪１６を相反する方向に回転させて作業機１０を旋回させる動作を含む。
Since the process of S22 is a process for moving the
次いでＳ２４に進み、エリア信号の強度が所定時間以上同一範囲にあるか否か再び判断する。Ｓ２４で否定されるときは作業機１０がスタックを脱出したと判断できるので、Ｓ１４に進む。
Then, the process proceeds to S24, and it is determined again whether or not the strength of the area signal is in the same range for a predetermined time or longer. If it is denied in S24, it can be determined that the working
一方、Ｓ２４で肯定されるときはＳ２６に進み、ブレード高さ調節機構３８を介してワークモータ２２（とブレード２０）を上方に移動（上昇）させ、ドライブモータ２６を駆動して既定時間作業機１０を左に旋回させ、次いで前進させた後、右に旋回させる。
On the other hand, if the result is affirmed in S24, the process proceeds to S26, the work motor 22 (and the blade 20) is moved upward (raised) via the blade height adjusting mechanism 38, and the
この順序も例示であり、変更可能である。また、ワークモータ２２の上方への移動は上限位置への移動に限らず、上方への移動であれば上限位置と下限位置の間の任意の位置であっても良い。
This order is also an example and can be changed. Further, the upward movement of the
次いでＳ２８に進み、エリア信号の強度が所定時間以上同一範囲にあるか否か再び判断する。Ｓ２８で否定されるときはスタックを脱出したと判断できることから、Ｓ１４に進む。 Then, the process proceeds to S28, and it is determined again whether or not the strength of the area signal is in the same range for a predetermined time or longer. If it is denied in S28, it can be determined that the stack has escaped, so the process proceeds to S14.
これについて図２１を参照して説明すると、作業機１０のブレード２０（具体的にはそのディスク２０ａ）が図示のような石（あるいは接地面ＧＲの突起部位など）に乗り上げて作業機１０が宙ぶらりんとなり、駆動輪１６が接地面ＧＲから遊離して空転するような状況にあったとする。
Explaining this with reference to FIG. 21, the blade 20 (specifically, the
作業機１０がこのような亀の子状態にあったとすると、ブレード２０を上昇させることで、状況によっては駆動輪１６が路面に接地して路面反力を回復でき、作業機１０をスタックから脱出させることが可能となる。
Assuming that the
一方、図１０フロー・チャートのＳ２８で肯定されるときはＳ３０に進み、ブレード高さ調節機構３８を介してワークモータ２２（とブレード２０）を下方に移動（下降）させ、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させた後、右に旋回させる。
On the other hand, when affirmed in S28 of the flow chart of FIG. 10, the process proceeds to S30, the work motor 22 (and the blade 20) is moved downward (downward) via the blade height adjusting mechanism 38, and the
この順序も例示で、変更可能である。また、ワークモータ２２の下方への移動も下限位置に限らず、下方への移動であれば上限位置と下限位置の間の任意の位置であっても良い。
This order is also an example and can be changed. Further, the downward movement of the
次いでＳ３２に進み、エリア信号の強度が所定時間以上同一範囲にあるか否か再び判断する。Ｓ３２で否定されるときはスタックを脱出したと判断できることから、Ｓ３４に進む。 Then, the process proceeds to S32, and it is determined again whether or not the strength of the area signal is in the same range for a predetermined time or longer. If it is denied in S32, it can be determined that the stack has escaped, so the process proceeds to S34.
このとき作業機１０の駆動輪１６が窪地、泥濘部位、積雪部位にはまり、駆動輪１６が接地面ＧＲとの路面反力を得られずに空転するような状況にあったとすると、ブレード２０を下降させることで、状況によっては駆動輪１６と路面との接地位置が変わって路面反力を受けることができ、作業機１０をスタックから脱出させることも可能となる。
At this time, if the
一方、Ｓ３２で依然肯定されるときはＳ３６に進み、ブレード高さ調節機構３８を介してワークモータ２２（とブレード２０）を上方に移動（上昇）させると共に、ワークモータ２２の回転方向をブレード２０が時計回り（ＣＷ）に回転する方向としながら、ドライブモータ２６を駆動して既定時間駆動輪１６を回転させ、作業機１０を時計回り（同方向）に旋回させる。これも駆動輪１６と接地面ＧＲとの路面反力を回復するための動作である。尚、ブレード２０の回転方向の選択の順序は任意である。
On the other hand, if it is still affirmed in S32, the process proceeds to S36, the work motor 22 (and the blade 20) is moved upward (raised) via the blade height adjusting mechanism 38, and the rotation direction of the
即ち、Ｓ１６からＳ３０までの処理においてはワークモータ２２を駆動してブレード２０を回転させる動作は行わないが、Ｓ３６以降の処理においてはブレード２０を昇降させて接地面ＧＲに接触させ、駆動輪１６が接地面ＧＲから受ける路面反力のみならず、ブレード２０が接地面ＧＲから受ける路面反力も利用してスタックから脱出させることとする。
That is, in the processes from S16 to S30, the operation of driving the
次いでＳ３８に進み、エリア信号の強度が所定時間以上同一範囲にあるか否か再び判断する。Ｓ３８で否定されるときはスタックを脱出したと判断できることから、Ｓ３４に進む。 Then, the process proceeds to S38, and it is determined again whether or not the strength of the area signal is in the same range for a predetermined time or longer. If it is denied in S38, it can be determined that the player has escaped from the stack, so the process proceeds to S34.
一方、Ｓ３８で肯定されるときはＳ４０に進み、ブレード高さ調節機構３８を介してワークモータ２２（とブレード２０）を上方に移動（上昇）させると共に、ワークモータ２２の回転方向をブレード２０が反時計回り（ＣＣＷ）に回転する方向としながら、ドライブモータ２６を駆動して既定時間駆動綸１６を回転させ、作業機１０を反時計回り（同方向）に旋回させる。これも駆動輪１６とブレード２０が接地面ＧＲからの路面反力を回復するための措置であり、ブレードの回転方向の選択の順序は任意である。
On the other hand, when affirmed in S38, the process proceeds to S40, the work motor 22 (and the blade 20) is moved upward (raised) via the blade height adjusting mechanism 38, and the
尚、Ｓ３６とＳ４０の少なくともいずれかにおいてワークモータ２２の回転方向と作業機１０の旋回方向を逆にしても良い。例えば、ワークモータ２２（ブレード２０）が反時計回り（ＣＣＷ）に回転するとき、作業機１０が時計回り（ＣＷ）に旋回するようにしても良い。
In at least one of S36 and S40, the rotation direction of the
次いでＳ４２に進み、エリア信号の強度が所定時間以上同一範囲にあるか否か再び判断する。Ｓ４２で否定されるときはスタックを脱出したと判断できることから、Ｓ３４に進む。 Then, the process proceeds to S42, and it is determined again whether or not the strength of the area signal is in the same range for a predetermined time or longer. If it is denied in S42, it can be determined that the player has escaped from the stack, so the process proceeds to S34.
一方、Ｓ４２で肯定されるときはスタックを脱出できなかったと判断し、Ｓ４４に進んでユーザに通知し、次いでＳ４６に進んでドライブモータ２６などへの通電を停止して作業機１０を停止する。
On the other hand, when affirmed in S42, it is determined that the stack could not be escaped, the user proceeds to S44 to notify the user, and then S46 proceeds to stop the energization of the
第１実施形態に係るロボット作業機のスタック判定装置においては、作業エリアＡＲに配置された固定信号源（エリアワイヤ）７２からの信号を検知する検知部（ＥＣＵ４４）と、検知された信号の強度が所定時間同一範囲にあるか否か判定し、同一範囲にあるとき、作業機１０がスタックしたと判定するスタック判定部（ＥＣＵ４４）とを備えるように構成したので、作業エリアＡＲでの作業機１０のスタックを簡易に判定することができる。
In the stack determination device of the robot work machine according to the first embodiment, the detection unit (ECU 44) for detecting the signal from the fixed signal source (area wire) 72 arranged in the work area AR and the strength of the detected signal. Is configured to include a stack determination unit (ECU 44) that determines whether or not the devices are in the same range for a predetermined time and determines that the
それにより、ロボット作業機１０を初期の作業に迅速に復帰させることができて作業効率を向上できると共に、ロボット作業機１０が捜索し難い場所でスタックして発見に時間を要するなどの不都合が生じることがない。
As a result, the
また、固定信号源が作業エリアＡＲの周縁に配置されると共に、電源８０から電流を通電されるエリアワイヤ（電線）７２からなるように構成したので、上記した効果に加え、エリアワイヤ７２を作業エリア認識に用いる作業機１０にあっては既存の設備をそのまま利用できると共に、電波障害などの外乱を受けることがない。
Further, since the fixed signal source is arranged on the periphery of the work area AR and is composed of the area wire (electric wire) 72 to which the current is applied from the
また、エリアワイヤ（電線）７２が作業エリアＡＲの内側に向けて延びるように配置される如く構成したので、上記した効果に加え、作業エリアＡＲの内奥部位などにおいても検知精度を向上させることができる。 Further, since the area wire (electric wire) 72 is arranged so as to extend toward the inside of the work area AR, in addition to the above-mentioned effect, the detection accuracy can be improved even in the inner part of the work area AR. Can be done.
また、信号検知部で検知された信号に基づいてドライブモータ（原動機）２６の駆動を制御して作業エリアＡＲで走行させる制御部（ＥＣＵ４４）を備えるように構成したので、上記した効果に加え、スタックと判定されないときは所期の作業を実行させることができる。 Further, since the control unit (ECU 44) that controls the drive of the drive motor (motor) 26 to travel in the work area AR based on the signal detected by the signal detection unit is provided, in addition to the above effects, If it is not determined to be a stack, the desired work can be executed.
また、制御部は、スタック判定部で作業機１０がスタックしたと判定されるとき、作業機１０をスタックから脱出させるスタック脱出制御を行うように構成したので、上記した効果に加え、作業機１０を短時間にスタックから脱出させることができ、作業効率とエネルギ消費効率を向上させることができる。
Further, since the control unit is configured to perform stack escape control for escaping the
また、制御部は、スタック判定部で作業機１０がスタックしたと判定されるとき、作業機１０を規定時間だけ前進または後退させるようにドライブモータ（原動機）２６の駆動を制御するように構成したので、上記した効果に加え、一時的にスタックしている場合などに作業機１０をスタックから迅速に脱出させることができる。
Further, the control unit is configured to control the drive of the drive motor (motor) 26 so as to move the
また、制御部は、スタック判定部で作業機１０がスタックしたと判定されるとき、ユーザに通知するように構成したので、上記した効果に加え、ユーザは自身で作業機１０をスタックから脱出させる、メインスイッチ６４をオフするなどの措置を講じることも可能となる。
Further, since the control unit is configured to notify the user when the stack determination unit determines that the
尚、第１実施形態において、原動機（ドライブモータ）２６と動力源（ワークモータ）２２とを共に電動モータから構成したが、それに限定されるものではなく、原動機２６と動力源２２の一方または双方は内燃機関、あるいは内燃機関と電動モータのハイブリッド、油圧モータなどであっても良い。これは第２実施形態以降においても同様である。
In the first embodiment, the prime mover (drive motor) 26 and the power source (work motor) 22 are both composed of an electric motor, but the present invention is not limited thereto, and one or both of the
（第２実施形態）
図１１はこの発明の第２実施形態に係るロボット作業機のスタック判定装置の構成を示す、図６と同様な作業エリアＡＲの模式的な説明図である。
(Second Embodiment)
FIG. 11 is a schematic explanatory view of a work area AR similar to FIG. 6 showing a configuration of a stack determination device for a robot work machine according to a second embodiment of the present invention.
第１実施形態と相違する点に焦点をおいて説明すると、第２実施形態においては固定信号源として作業エリアＡＲの周縁（境界）に相互に所定の離間距離をおいて配置される複数個のビーコン１００からなるように構成した。
Focusing on the differences from the first embodiment, in the second embodiment, a plurality of fixed signal sources are arranged on the periphery (boundary) of the work area AR at a predetermined distance from each other. It was configured to consist of a
ビーコン１００は周囲に向けて電波（あるいは光）などの信号を発信する装置であり、作業機１０にはビーコン１００から発信される信号を受信する受信端末１０２を備える。
The
ＥＣＵ４４は受信端末１０２で受信したビーコン１００からの発信信号に基づいて作業エリアＡＲでの作業機１０の位置を検知し、図１０フロー・チャートと同様な処理に基づいて作業機１０のスタックを検知する。
The
尚、第２実施形態において固定信号源はビーコン１００に限るものではなく、
図１１に想像線で示す如く、作業エリアＡＲの周辺（境界）にＩＣタグ１０４（１個のみ示す）を配置し、それから発信される識別情報（Radio Frequency ID）を作業機１０に搭載したＩＣタグ信号受信機１０６で受信して作業エリアＡＲを認識して作業機１０の位置を検知しても良い。
In the second embodiment, the fixed signal source is not limited to the
As shown by an imaginary line in FIG. 11, an IC in which an IC tag 104 (only one is shown) is arranged around (boundary) the work area AR and the identification information (Radio Frequency ID) transmitted from the
第２実施形態に係るロボット作業機のスタック判定装置においては、作業エリアＡＲに配置された固定信号源（ビーコン１００、ＩＣタグ１０４）からの信号を検知する信号検知部（受信端末１０２、ＩＣタグ信号受信機１０６）と、信号検知部で検知された信号の強度を作業機１０に搭載した受信端末１０２で検知し、検知された信号の強度が所定時間以上同一範囲にあるか否か判定し、同一範囲にあるとき、作業機１０がスタックしたと判定するスタック判定部（ＥＣＵ４４）を備えるように構成したので、作業エリアＡＲでの作業機１０のスタックを簡易に判定することができる。
In the stack determination device of the robot work machine according to the second embodiment, a signal detection unit (
また、固定信号源が、作業エリアＡＲの周縁に相互に所定の離間距離をおいて配置される複数個のビーコン１００などからなる如く構成したので、ビーコン１００などを用いて作業エリアＡＲを認識する作業機１０にあっては既存の設備をそのまま利用できると共に、比較的近距離での送受信であるので、電波障害などの外乱を受けることがない。残余の構成と効果は第１実施形態と異ならない。
Further, since the fixed signal source is configured to consist of a plurality of
（第３実施形態）
図１２はこの発明の第３実施形態に係るロボット作業機のスタック判定装置の動作を示す、図１０に類似するフロー・チャートである。
(Third Embodiment)
FIG. 12 is a flow chart similar to FIG. 10 showing the operation of the stack determination device of the robot working machine according to the third embodiment of the present invention.
従前の実施形態と相違する点に焦点をおいて説明すると、第３実施形態においては固定信号源（エリアワイヤ７２あるいはビーコン１００など）からの信号に加え、加速度センサ５０の出力を使用するように構成した。
Focusing on the differences from the previous embodiments, the third embodiment uses the output of the
図１２を参照して説明すると、Ｓ１００において固定信号源からの信号、即ち、エリアワイヤ７２からのエリア信号あるいはビーコン１００などからの信号の強度と、加速度センサ５０の出力（即ち、加速度信号）の変化をモニタ（検知）する。
Explaining with reference to FIG. 12, in S100, the strength of the signal from the fixed signal source, that is, the area signal from the
次いでＳ１０２に進み、固定信号源からの信号の強度と加速度信号が所定時間同一範囲にあるか、換言すればエリア信号の強度と加速度信号が所定時間以上変化しないか否か判断する。 Then, the process proceeds to S102 to determine whether the intensity of the signal from the fixed signal source and the acceleration signal are in the same range for a predetermined time, in other words, whether the intensity of the area signal and the acceleration signal do not change for a predetermined time or more.
Ｓ１０２で否定されるときは作業機１０がスタックしていないと判断してＳ１０４に進み、通常の芝刈り作業モードに復帰する一方、Ｓ１０２で肯定される（同一範囲にある）ときはＳ１０６に進み、作業機１０がスタックしたと判定する。
If it is denied in S102, it is determined that the
即ち、固定信号源からの信号の強度が所定時間以上同一範囲にあることは作業機１０が所定時間以上、作業エリアＡＲで同じ位置にあることを意味すると共に、作業機１０は走行（移動）すれば加速度センサ５０の出力である加速度信号が変化するはずであるから、加速度信号を検知することによって第１実施形態に比してより精度良く、作業機１０がスタックしたと判定することができる。
That is, the fact that the strength of the signal from the fixed signal source is in the same range for a predetermined time or longer means that the
図１２フロー・チャートにあっても、Ｓ１０６で作業機１０がスタックしたと判定されると、脱出モードに移行し、次のＳ１０８において先ず作業機１０を規定時間だけ微速で前進または後退させるようにドライブモータ２６の駆動を制御する。
Even in the flow chart of FIG. 12, when it is determined in S106 that the
次いでＳ１１０に進み、固定信号源からの信号の強度と加速度信号が所定時間以上同一範囲にあるか否か判断する。Ｓ１１０の判断が否定されるときはＳ１０４に進む一方、依然として肯定されるときはＳ１１２に進み、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させ、次いで右に旋回させる。 Then, the process proceeds to S110, and it is determined whether or not the intensity of the signal from the fixed signal source and the acceleration signal are in the same range for a predetermined time or longer. If the judgment of S110 is denied, the process proceeds to S104, and if the judgment is still affirmed, the process proceeds to S112. Turn.
次いでＳ１１４に進み、固定信号源からの信号の強度と加速度信号が所定時間以上同一範囲にあるか否か再び判断する。Ｓ１１４で否定されるときは作業機１０がスタックを脱出したと判断できるので、Ｓ１０４に進む。
Then, the process proceeds to S114, and it is determined again whether or not the strength of the signal from the fixed signal source and the acceleration signal are in the same range for a predetermined time or longer. If it is denied in S114, it can be determined that the working
一方、Ｓ１１４で肯定されるときはＳ１１６に進み、ブレード高さ調節機構３８を介してワークモータ２２（とブレード２０）を上方に移動させ、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させた後、右に旋回させる。
On the other hand, when affirmed in S114, the process proceeds to S116, the work motor 22 (and the blade 20) is moved upward via the blade height adjusting mechanism 38, and the
次いでＳ１１８に進み、固定信号源からの信号の強度と加速度信号が所定時間以上同一範囲にあるか否か再び判断する。Ｓ１１８で否定されるときはスタックを脱出したと判断できることから、Ｓ１０４に進む。 Then, the process proceeds to S118, and it is determined again whether or not the strength of the signal from the fixed signal source and the acceleration signal are in the same range for a predetermined time or longer. If it is denied in S118, it can be determined that the stack has escaped, so the process proceeds to S104.
一方、Ｓ１１８で肯定されるときはＳ１２０に進み、ブレード高さ調節機構３８を介してワークモータ２２（とブレード２０）を下方に移動させ、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させた後、右に旋回させる。
On the other hand, when affirmed in S118, the process proceeds to S120, the work motor 22 (and the blade 20) is moved downward via the blade height adjusting mechanism 38, and the
次いでＳ１２２に進み、固定信号源からの信号の強度と加速度信号が所定時間以上同一範囲にあるか否か再び判断する。Ｓ１２２で否定されるときはスタックを脱出したと判断できることから、Ｓ１２４に進む。 Then, the process proceeds to S122, and it is determined again whether or not the strength of the signal from the fixed signal source and the acceleration signal are in the same range for a predetermined time or longer. If it is denied in S122, it can be determined that the stack has escaped, so the process proceeds to S124.
一方、Ｓ１２２で依然肯定されるときはＳ１２６に進み、ブレード高さ調節機構３８を介してワークモータ２２（とブレード２０）を上方に移動させると共に、ワークモータ２２の回転方向をブレード２０が時計回りに回転する方向としながら、ドライブモータ２６を駆動して既定時間駆動輪１６を回転させ、作業機１０を時計回り（同方向）に旋回させる。
On the other hand, if it is still affirmed in S122, the process proceeds to S126, the work motor 22 (and the blade 20) is moved upward via the blade height adjusting mechanism 38, and the
次いでＳ１２８に進み、固定信号源からの信号の強度と加速度信号が所定時間以上同一範囲にあるか否か再び判断し、Ｓ１２８で否定されるときはスタックを脱出したと判断できることから、Ｓ１２４に進む。 Next, the process proceeds to S128, and it is determined again whether the strength of the signal from the fixed signal source and the acceleration signal are in the same range for a predetermined time or longer. ..
一方、Ｓ１２８で肯定されるときはＳ１３０に進み、ブレード高さ調節機構３８を介してワークモータ２２（ブレード２０）を上方に移動させると共に、ワークモータ２２の回転方向をブレード２０が反時計回りに回転する方向としながら、ドライブモータ２６を駆動して既定時間駆動輪１６を回転させ、作業機１０を反時計回り（同方向）に旋回させる。
On the other hand, when affirmed in S128, the process proceeds to S130, the work motor 22 (blade 20) is moved upward via the blade height adjusting mechanism 38, and the
次いでＳ１３２に進み、固定信号源からの信号の強度と加速度信号が所定時間以上同一範囲にあるか否か再び判断する。Ｓ１３２で否定されるときはスタックを脱出したと判断できることから、Ｓ１２４に進む。 Then, the process proceeds to S132, and it is determined again whether or not the strength of the signal from the fixed signal source and the acceleration signal are in the same range for a predetermined time or longer. If it is denied in S132, it can be determined that the stack has escaped, so the process proceeds to S124.
一方、Ｓ１３２で肯定されるときはスタックを脱出できなかったと判断し、Ｓ１３４に進んでユーザに通知し、次いでＳ１３６に進んでドライブモータ２６などへの通電を停止して作業機１０を停止する。
On the other hand, when affirmed in S132, it is determined that the stack could not be escaped, the user proceeds to S134 to notify the user, and then S136 proceeds to stop the energization of the
尚、図１０フロー・チャートの処理で記載した所定時間、規定時間あるいは既定時間、旋回や前進の順序あるいはワークモータ２２の回転方向の選択順序、ワークモータ２２（ブレード２０）とドライブモータ２６の回転方向を逆にすることなどは、図１２フロー・チャートの処理にも全て妥当する。これは後述する第４実施形態のフロー・チャートの処理でも同様である。
The predetermined time, the specified time or the predetermined time, the order of turning and advancing or the order of selecting the rotation direction of the
第３実施形態に係るロボット作業機のスタック判定装置においては、作業機１０が走行するときの加速度を示す出力を生じる加速度センサ５０を備えると共に、検知された固定信号源からの信号の強度が所定時間以上同一範囲にあり、かつ加速度センサ５０の出力である加速度信号が所定時間以上同一範囲にあるとき、作業機１０がスタックしたと判定するように構成したので、第１実施形態に比し、作業エリアＡＲでの作業機１０のスタックを簡易かつ精度良く判定することができる。
The stack determination device of the robot work machine according to the third embodiment includes an
特に、作業エリアＡＲが長い狭路を有する場合など、作業機１０が移動するにも関わらず、エリア信号の強度は変わらないので、加速度信号も考慮することでスタックを精度良く判定することができる。作業機１１がその場旋回など極小の旋回半径で旋回する場合も同様である。
In particular, when the work area AR has a long narrow road, the strength of the area signal does not change even though the
尚、第３実施形態において加速度信号を加速度センサ５０から求めたが、ＧＰＳ受信機５４あるいは駆動輪回転センサ５６の出力から求めても良い。尚、残余の構成と効果は従前の実施形態と異ならない。
Although the acceleration signal is obtained from the
（第４実施形態）
図１３はこの発明の第４実施形態に係るロボット作業機のスタック判定装置の動作を示す、図１０に類似するフロー・チャートである。
(Fourth Embodiment)
FIG. 13 is a flow chart similar to FIG. 10 showing the operation of the stack determination device of the robot working machine according to the fourth embodiment of the present invention.
従前の実施形態と相違する点に焦点をおいて説明すると、第４実施形態においては固定信号源（エリアワイヤ７２、ビーコン１００など）からの信号に加え、駆動輪１６の回転を示す出力を生じる駆動輪回転センサ５６の出力を使用するように構成した。
Focusing on the differences from the conventional embodiment, in the fourth embodiment, in addition to the signal from the fixed signal source (
図１３を参照して説明すると、Ｓ２００において固定信号源からの信号、即ち、エリアワイヤ７２からのエリア信号あるいはビーコン１００などからの信号の強度と、駆動輪回転センサ５６の出力（即ち、駆動輪回転信号）の変化をモニタ（検知）する。
Explaining with reference to FIG. 13, in S200, the strength of the signal from the fixed signal source, that is, the area signal from the
次いでＳ２０２に進み、固定信号源からの信号の強度と駆動輪回転信号が所定時間以上同一範囲にあるか、換言すればエリア信号の強度と駆動輪回転信号が所定時間以上変化しないか否か判断する。 Then, the process proceeds to S202 to determine whether the signal strength from the fixed signal source and the drive wheel rotation signal are in the same range for a predetermined time or longer, in other words, whether the area signal strength and the drive wheel rotation signal do not change for a predetermined time or longer. do.
Ｓ２０２で否定されるときは作業機１０がスタックしていないと判断してＳ２０４に進み、通常の芝刈り作業モードに復帰する一方、肯定される（同一範囲にある）ときはＳ２０６に進み、作業機１０がスタックしたと判定する。
If it is denied in S202, it is determined that the
即ち、固定信号源からの信号の強度が所定時間以同一範囲にあることは作業機１０が所定時間以上、作業エリアＡＲで同じ位置にあることを意味すると共に、作業機１０は走行（移動）すれば駆動輪１６の回転を示す駆動輪回転センサ５６の信号（駆動輪回転信号）が変化するはずであるから、駆動輪回転信号を検知することによって第１実施形態に比してより精度良く、作業機１０がスタックしたと判定することができる。
That is, the fact that the strength of the signal from the fixed signal source is in the same range for a predetermined time or longer means that the
Ｓ２０６で作業機１０がスタックしたと判定されると脱出モードに移行し、次のＳ２０８において先ず作業機１０を規定時間だけ微速で前進または後退させるようにドライブモータ２６の駆動を制御する。
When it is determined in S206 that the
次いでＳ２１０に進み、固定信号源からの信号の強度と駆動輪回転信号が所定時間以上同一範囲にあるか否か判断する。Ｓ２１０の判断が否定されるときはＳ２０４に進む一方、肯定されるときはＳ２１２に進み、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させ、次いで右に旋回させる。 Then, the process proceeds to S210, and it is determined whether or not the strength of the signal from the fixed signal source and the drive wheel rotation signal are in the same range for a predetermined time or longer. If the judgment of S210 is denied, the process proceeds to S204, and if the judgment is affirmed, the process proceeds to S212. Let me.
次いでＳ２１４に進み、固定信号源からの信号の強度と駆動輪回転信号が所定時間以上同一範囲にあるか否か再び判断する。Ｓ２１４で否定されるときは作業機１０がスタックを脱出したと判断できるので、Ｓ２０４に進む。
Then, the process proceeds to S214, and it is determined again whether or not the strength of the signal from the fixed signal source and the drive wheel rotation signal are in the same range for a predetermined time or longer. If it is denied in S214, it can be determined that the working
一方、Ｓ２１４で肯定されるときはＳ２１６に進み、ブレード高さ調節機構３８を介してワークモータ２２を上方に移動させ、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させた後、右に旋回させる。
On the other hand, when affirmed in S214, the process proceeds to S216, the
次いでＳ２１８に進み、固定信号源からの信号の強度と駆動輪回転信号が所定時間以上同一範囲にあるか否か再び判断する。Ｓ２１８で否定されるときはスタックを脱出したと判断できることから、Ｓ２０４に進む。 Then, the process proceeds to S218, and it is determined again whether or not the strength of the signal from the fixed signal source and the drive wheel rotation signal are in the same range for a predetermined time or longer. If it is denied in S218, it can be determined that the stack has escaped, so the process proceeds to S204.
一方、Ｓ２１８で肯定されるときはＳ２２０に進み、ブレード高さ調節機構３８を介してワークモータ２２を下方に移動させ、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させた後、右に旋回させる。
On the other hand, when affirmed in S218, the process proceeds to S220, the
次いでＳ２２２に進み、固定信号源からの信号の強度と駆動輪回転信号が所定時間以上同一範囲にあるか否か再び判断し、否定されるときはスタックを脱出したと判断できることから、Ｓ２２４に進む。 Next, the process proceeds to S222, and it is determined again whether the strength of the signal from the fixed signal source and the drive wheel rotation signal are in the same range for a predetermined time or longer. ..
一方、Ｓ２２２で依然肯定されるときはＳ２２６に進み、ブレード高さ調節機構３８を介してワークモータ２２を上方に移動させると共に、ワークモータ２２の回転方向をブレード２０が時計回りに回転する方向としながら、ドライブモータ２６を駆動して既定時間駆動輪１６を回転させ、作業機１０を同方向に旋回させる。
On the other hand, if it is still affirmed in S222, the process proceeds to S226, the
次いでＳ２２８に進み、固定信号源からの信号の強度と駆動輪回転信号が所定時間以上同一範囲にあるか否か再び判断し、Ｓ２２８で否定されるときはスタックを脱出したと判断できることから、Ｓ２２４に進む。 Next, the process proceeds to S228, and it is determined again whether the strength of the signal from the fixed signal source and the drive wheel rotation signal are in the same range for a predetermined time or longer. Proceed to.
一方、Ｓ２２８で肯定されるときはＳ２３０に進み、ブレード高さ調節機構３８を介してワークモータ２２を上方に移動させると共に、ワークモータ２２の回転方向をブレード２０が反時計回りに回転する方向としながら、ドライブモータ２６を駆動して既定時間駆動輪１６を回転させ、作業機１０を同方向に旋回させる。
On the other hand, when affirmed in S228, the process proceeds to S230, the
次いでＳ２３２に進み、固定信号源からの信号の強度と駆動輪回転信号が所定時間以上同一範囲にあるか否か再び判断する。Ｓ２３２で否定されるときはスタックを脱出したと判断できることから、Ｓ２２４に進む。 Then, the process proceeds to S232, and it is determined again whether or not the strength of the signal from the fixed signal source and the drive wheel rotation signal are in the same range for a predetermined time or longer. If it is denied in S232, it can be determined that the stack has escaped, so the process proceeds to S224.
一方、Ｓ２３２で肯定されるときはスタックを脱出できなかったと判断し、Ｓ２３４に進んでユーザに通知し、次いでＳ２３６に進んでドライブモータ２６などへの通電を停止して作業機１０を停止する。
On the other hand, when affirmed in S232, it is determined that the stack could not be escaped, the user proceeds to S234 to notify the user, and then S236 stops the energization of the
第４実施形態に係るロボット作業機のスタック判定装置においては、駆動輪１６の回転を示す出力を生じる駆動輪回転センサ５６を備えると共に、検知された固定信号源からの信号の強度が所定時間以同一範囲にあり、かつ駆動輪回転センサ５６の出力である駆動輪回転信号が所定時間以上同一範囲にあるとき、作業機１０がスタックしたと判定するように構成したので、第１実施形態に比し、作業エリアＡＲでの作業機１０のスタックを簡易かつ精度良く判定することができる。尚、残余の構成と効果は従前の実施形態と異ならない。
The stack determination device of the robot work machine according to the fourth embodiment includes a drive
（第５実施形態）
図１４はこの発明の第５実施形態に係るロボット作業機のスタック判定装置の動作を示す、図１０に類似するフロー・チャートである。
(Fifth Embodiment)
FIG. 14 is a flow chart similar to FIG. 10 showing the operation of the stack determination device of the robot working machine according to the fifth embodiment of the present invention.
従前の実施形態と相違する点に焦点をおいて説明すると、第５実施形態においては固定信号源（エリアワイヤ７２、ビーコン１００など）からの信号に加え、駆動輪１６の回転を示す出力を生じる駆動輪回転センサ５６の出力と従動輪１４の回転を示す従動輪回転センサ５８を使用するように構成した。即ち、図１に想像線で示す如く、作業機１０の左右の従動輪１４の付近には従動輪の回転（車輪速）を示す従動輪回転センサ５８を配置するように構成した。
Focusing on the differences from the conventional embodiment, in the fifth embodiment, in addition to the signal from the fixed signal source (
図１４を参照して説明すると、Ｓ３００において固定信号源からの信号、即ち、エリアワイヤ７２からのエリア信号あるいはビーコン１００などからの信号の強度と、駆動輪回転センサ５６の出力（即ち、駆動輪回転信号）と、従動輪回転センサ５８の出力（従動輪回転信号）の変化をモニタ（検知）する。
Explaining with reference to FIG. 14, in S300, the strength of the signal from the fixed signal source, that is, the area signal from the
次いでＳ３０２に進み、固定信号源からの信号の強度が所定時間以上同一範囲にある、換言すれば固定信号源からの信号の強度が所定時間以上変化しないと共に、駆動輪回転センサ５６と従動輪回転センサ５８の出力から駆動輪１６は回転する一方、従動輪１４は回転しない状態が所定時間以上続いているか否か判断する。
Then, the process proceeds to S302, and the strength of the signal from the fixed signal source is in the same range for a predetermined time or longer, in other words, the strength of the signal from the fixed signal source does not change for a predetermined time or longer, and the drive
Ｓ３０２で否定されるときは作業機１０がスタックしていないと判断してＳ３０４に進み、通常の芝刈り作業モードに復帰する一方、Ｓ３０２で肯定されるときはＳ３０６に進み、作業機１０がスタックしたと判定する。
If it is denied by S302, it is determined that the working
即ち、固定信号源からの信号の強度が所定時間以上同一範囲にあることは作業機１０が所定時間以上、作業エリアＡＲで同じ位置にあることを意味すると共に、ドライブモータ２６で駆動される駆動輪１６は回転する一方、従動輪１４は回転しない状態が所定時間以上続いていることは、従動輪１４が宙に浮くなどの状況にあると推定されることから、駆動輪１６と従動輪１４の回転を検知することによって作業機１０がスタックしたと判定することが可能となる。
That is, the fact that the strength of the signal from the fixed signal source is in the same range for a predetermined time or longer means that the
Ｓ３０６で作業機１０がスタックしたと判定されると脱出モードに移行し、次のＳ３０８において先ず作業機１０を規定時間だけ微速で前進または後退させるようにドライブモータ２６の駆動を制御する。
When it is determined in S306 that the
次いでＳ３１０に進み、固定信号源からの信号の強度が所定時間以上同一範囲にあると共に、駆動輪１６は回転する一方、従動輪１４は回転しない状態が所定時間以上続いているか否か判断する。Ｓ３１０の判断が否定されるときはＳ３０４に進む一方、肯定されるときはＳ３１２に進み、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させ、次いで右に旋回させる。
Next, the process proceeds to S310, and it is determined whether or not the intensity of the signal from the fixed signal source is in the same range for a predetermined time or longer, and the
次いでＳ３１４に進み、固定信号源からの信号の強度が所定時間以上同一範囲にあると共に、駆動輪１６は回転する一方、従動輪１４は回転しないか状態が所定時間以上続いているか否か再び判断する。Ｓ３１４で否定されるときは作業機１０がスタックを脱出したと判断できるので、Ｓ３０４に進む。
Then, the process proceeds to S314, and it is determined again whether the strength of the signal from the fixed signal source is in the same range for a predetermined time or longer, the driving
一方、肯定されるときはＳ３１６に進み、ブレード高さ調節機構３８を介してワークモータ２２を上方に移動させ、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させた後、右に旋回させる。
On the other hand, if affirmed, the process proceeds to S316, the
次いでＳ３１８に進み、固定信号源からの信号の強度が所定時間以上同一範囲にあると共に、駆動輪１６は回転する一方、従動輪１４は回転しない状態が所定時間以上続いているか否か再び判断する。Ｓ３１８で否定されるときはスタックを脱出したと判断できることから、Ｓ３０４に進む。
Then, the process proceeds to S318, and it is determined again whether or not the intensity of the signal from the fixed signal source is in the same range for a predetermined time or longer, the driving
一方、Ｓ３１８で肯定されるときはＳ３２０に進み、ブレード高さ調節機構３８を介してワークモータ２２を下方に移動させ、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させた後、右に旋回させる。
On the other hand, when affirmed in S318, the process proceeds to S320, the
次いでＳ３２２に進み、固定信号源からの信号の強度が所定時間以上同一範囲にあると共に、駆動輪１６は回転する一方、従動輪１４は回転しない状態が所定時間以上続いているか否か再び判断する。Ｓ３２２で否定されるときはスタックを脱出したと判断できることから、Ｓ３２４に進む。
Next, the process proceeds to S322, and it is determined again whether or not the strength of the signal from the fixed signal source is in the same range for a predetermined time or longer, the driving
一方、Ｓ３２２で依然肯定されるときはＳ３２６に進み、ブレード高さ調節機構３８を介してワークモータ２２を上方に移動させると共に、ワークモータ２２の回転方向をブレード２０が時計回りに回転する方向としながら、ドライブモータ２６を駆動して既定時間駆動輪１６を回転させ、作業機１０を同方向に旋回させる。
On the other hand, if it is still affirmed in S322, the process proceeds to S326, the
次いでＳ３２８に進み、固定信号源からの信号の強度が同一範囲にあると共に、駆動輪回転信号が変化しないか状態が所定時間以上続いているか否か再び判断し、Ｓ３２８で否定されるときはスタックを脱出したと判断できることから、Ｓ３２４に進む。 Then, the process proceeds to S328, and it is determined again whether the strength of the signal from the fixed signal source is in the same range and whether the drive wheel rotation signal does not change or the state continues for a predetermined time or longer. Since it can be determined that the vehicle has escaped, the process proceeds to S324.
一方、Ｓ３２８で肯定されるときはＳ３３０に進み、ブレード高さ調節機構３８を介してワークモータ２２を上方に移動させると共に、ワークモータ２２の回転方向をブレード２０が反時計回りに回転する方向としながら、ドライブモータ２６を駆動して既定時間駆動輪１６を回転させ、作業機１０を同方向に旋回させる。
On the other hand, when affirmed in S328, the process proceeds to S330, the
次いでＳ３３２に進み、固定信号源からの信号の強度が所定時間以上同一範囲にあると共に、駆動輪１６が回転する一方、従動輪１４が回転しない状態が所定時間以上続いているか否か再び判断する。Ｓ３３２で否定されるときはスタックを脱出したと判断できることから、Ｓ３２４に進む。
Next, the process proceeds to S332, and it is determined again whether or not the strength of the signal from the fixed signal source is in the same range for a predetermined time or longer, and the
一方、Ｓ３３２で肯定されるときはスタックを脱出できなかったと判断し、Ｓ３３４に進んでユーザに通知し、次いでＳ３３６に進んでドライブモータ２６などへの通電を停止して作業機１０を停止する。
On the other hand, when affirmed in S332, it is determined that the stack could not be escaped, the user proceeds to S334 to notify the user, and then S336 proceeds to stop the energization of the
第５実施形態に係るロボット作業機のスタック判定装置においては、駆動輪１６の回転を示す出力を生じる駆動輪回転センサ５６と、車体１２に駆動輪１６に隣接して取り付けられる従動輪１４の回転を示す出力を生じる従動輪回転センサ５８とを備え、検知された固定信号源からの信号の強度が所定時間以上同一範囲にあると共に、駆動輪回転センサ５６と従動輪回転センサ５８の出力から駆動輪１６は回転する一方、従動輪１４は回転しない状態が所定時間以上続くとき、作業機１０がスタックしたと判定するように構成したので、第１実施形態に比し、作業エリアＡＲでの作業機１０のスタックを簡易かつ精度良く判定することができる。
In the stack determination device of the robot work machine according to the fifth embodiment, the drive
（第６実施形態）
図１５はこの発明の第６実施形態に係るロボット作業機のスタック判定装置の構成を示す、図６と同様な作業エリアＡＲの説明図、図１６は第６実施形態の動作を示す、図１０に類似するフロー・チャートである。
(Sixth Embodiment)
FIG. 15 is an explanatory view of a work area AR similar to FIG. 6, showing a configuration of a stack determination device for a robot work machine according to a sixth embodiment of the present invention, and FIG. 16 shows an operation of the sixth embodiment. It is a flow chart similar to.
従前の実施形態と相違する点に焦点をおいて説明すると、第６実施形態においては、作業エリアＡＲにおける作業機１０の位置を検知するのに、作業エリアＡＲに配置される固定信号源（エリアワイヤ７２、ビーコン１００など）に代え、前記したＧＰＳ衛星からの電波を受信して作業機１０の現在位置（緯度、経度）を示す出力を生じるＧＰＳ受信機（位置検知部）５４の出力を用いるようにした。
Focusing on the differences from the conventional embodiments, in the sixth embodiment, a fixed signal source (area) arranged in the work area AR is used to detect the position of the
より具体的には、ＧＰＳ受信機５４として望ましくはＲＴＫ（Real-time-kinematic） ＧＰＳを使用する。即ち、ＧＰＳ受信機５４として作業機１０に搭載される受信機（移動局）に加え、作業エリアＡＲの付近に配置される受信機５４ａ（固定局）を備えるようにした。
More specifically, RTK (Real-time-kinematic) GPS is preferably used as the
以下、図１６を参照して第６実施形態に係るロボット作業機のスタック判定装置の動作を説明する。 Hereinafter, the operation of the stack determination device of the robot working machine according to the sixth embodiment will be described with reference to FIG.
まずＳ４００においてＧＰＳ受信機５４，５４ａからの信号、即ち、ＧＰＳ信号をモニタ（検知）し、Ｓ４０２に進み、ＧＰＳ信号による作業機１０の位置が所定時間以上同一範囲にあるか、換言すればＧＰＳ信号の強度が所定時間以上変化しないか否か判断する
First, in S400, the signals from the
Ｓ４０２で否定されるときは作業機１０がスタックしていないと判断してＳ４０４に進み、通常の芝刈り作業モードに復帰する一方、Ｓ４０２で肯定されるときはＳ４０６に進み、作業機１０がスタックしたと判定する。
If it is denied by S402, it is determined that the working
即ち、ＧＰＳ信号による作業機１０の位置が所定時間以上同一範囲にあることは作業機１０が所定時間以上、作業エリアＡＲで同じ位置にあることを意味することから、それによって作業機１０がスタックしたと判定することが可能となる。
That is, if the position of the
Ｓ４０６で作業機１０がスタックしたと判定されると脱出モードに移行し、次のＳ４０８において先ず作業機１０を規定時間だけ微速で前進または後退させるようにドライブモータ２６の駆動を制御する。
When it is determined in S406 that the
次いでＳ４１０に進み、ＧＰＳ信号による作業機１０の位置が所定時間以上同一範囲にあるか否か判断する。Ｓ４１０の判断が否定されるときはＳ４０４に進む一方、肯定されるときはＳ４１２に進み、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させ、次いで右に旋回させる。
Next, the process proceeds to S410, and it is determined whether or not the position of the
次いでＳ４１４に進み、ＧＰＳ信号による作業機１０の位置が所定時間以上同一範囲にあるか否か再び判断する。Ｓ４１４で否定されるときは作業機１０がスタックを脱出したと判断できるので、Ｓ４０４に進む。
Then, the process proceeds to S414, and it is determined again whether or not the position of the working
一方、Ｓ４１４で肯定されるときはＳ４１６に進み、ブレード高さ調節機構３８を介してワークモータ２２を上方に移動させ、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させた後、右に旋回させる。
On the other hand, when affirmed in S414, the process proceeds to S416, the
次いでＳ４１８に進み、ＧＰＳ信号による作業機１０の位置が所定時間以同一範囲にあるか否か再び判断し、Ｓ４１８で否定されるときはスタックを脱出したと判断できることから、Ｓ４０４に進む。
Next, the process proceeds to S418, and it is determined again whether or not the position of the working
一方、Ｓ４１８で肯定されるときはＳ４２０に進み、ブレード高さ調節機構３８を介してワークモータ２２を下方に移動させ、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させた後、右に旋回させる。
On the other hand, when affirmed in S418, the process proceeds to S420, the
次いでＳ４２２に進み、ＧＰＳ信号による作業機１０の位置が所定時間以上同一範囲にあるか否か再び判断し、Ｓ４２２で否定されるときはスタックを脱出したと判断できることから、Ｓ４２４に進む。
Next, the process proceeds to S422, and it is determined again whether or not the position of the
一方、Ｓ４２２で肯定されるときはＳ４２６に進み、ブレード高さ調節機構３８を介してワークモータ２２を上方に移動させると共に、ワークモータ２２の回転方向をブレード２０が時計回りに回転する方向としながら、ドライブモータ２６を駆動して既定時間駆動輪１６を回転させ、作業機１０を同方向に旋回させる。
On the other hand, when affirmed in S422, the process proceeds to S426, the
次いでＳ４２８に進み、ＧＰＳ信号による作業機１０の位置が所定時間以上同一範囲にあるか否か再び判断し、Ｓ４２８で否定されるときはスタックを脱出したと判断できることから、Ｓ４２４に進む。
Next, the process proceeds to S428, and it is determined again whether or not the position of the
一方、Ｓ４２８で肯定されるときはＳ４３０に進み、ブレード高さ調節機構３８を介してワークモータ２２を上方に移動させると共に、ワークモータ２２の回転方向をブレード２０が反時計回りに回転する方向としながら、ドライブモータ２６を駆動して既定時間駆動輪１６を回転させ、作業機１０を同方向に旋回させる。
On the other hand, when affirmed in S428, the process proceeds to S430, the
次いでＳ４３２に進み、ＧＰＳ信号による作業機１０の位置が所定時間以上同一範囲にあるか否か再び判断し、Ｓ４３２で否定されるときはスタックを脱出したと判断できることから、Ｓ４２４に進む。
Next, the process proceeds to S432, and it is determined again whether or not the position of the
一方、Ｓ４３２で肯定されるときはスタックを脱出できなかったと判断し、Ｓ４３４に進んでユーザに通知し、次いでＳ４３６に進んでドライブモータ２６などへの通電を停止して作業機１０を停止する。
On the other hand, when affirmed in S432, it is determined that the stack could not be escaped, the user proceeds to S434 to notify the user, and then S436 stops the energization of the
第６実施形態に係るロボット作業機のスタック判定装置においては、作業エリアＡＲにおける作業機１０の位置を検知するＧＰＳ受信機（位置検知部）５６，５６ａを備え、ＧＰＳ受信機５４，５５ａで検知されたＧＰＳ信号による作業機１０の位置が所定時間以上同一範囲にあるか否か判定し、同一範囲にあるときは作業機１０が作業エリアＡＲでスタックしたと判定するように構成したので、第１実施形態と同様、作業エリアＡＲでの作業機１０のスタックを簡易に判定することができる。
The stack determination device for the robot work machine according to the sixth embodiment includes GPS receivers (position detection units) 56, 56a for detecting the position of the
また、ＧＰＳ受信機（位置検出部）５６，５６ａで検知された作業機１０の位置に基づいてドライブモータ（原動機）２６の駆動を制御して作業エリアＡＲで走行させる制御部（ＥＣＵ４４）を備えるように構成したので、スタックと判定されないときは所期の作業を行うことができると共に、スタックと判定されたときはスタック脱出制御を行うことも可能となる。残余の構成と効果は従前の実施形態と異ならない。
Further, it is provided with a control unit (ECU 44) that controls the drive of the drive motor (motor) 26 based on the position of the
尚、第６実施形態においてＧＰＳ受信機５４として望ましくは、ＲＴＫ（Real-time-kinematic） ＧＰＳを使用するようにしたが、それに限定されるものではなく、ＧＰＳ受信機を１個だけ用いた通例の単独測位でも良く、２個以上用いたスタティック測位や仮想基準点方式ＶＲＳ（Virtual Reference Station）を用いた測位でも良い。
In the sixth embodiment, RTK (Real-time-kinematic) GPS is preferably used as the
さらには、図１５に想像線で示す如く、作業エリアＡＲの周縁（境界）に相互に所定の離間距離をおいてマーカ１０８（１個のみ示す）を配置し、それを作業機１０に搭載したカメラ１１０で撮影して作業エリアＡＲを認識して作業機１０の位置を検知しても良い。
Further, as shown by an imaginary line in FIG. 15, markers 108 (only one is shown) are arranged at a predetermined distance from each other on the peripheral edge (boundary) of the work area AR, and the markers 108 (only one is shown) are mounted on the
（第７実施形態）
図１７はこの発明の第７実施形態に係るロボット作業機のスタック判定装置の動作を示す、図１２に類似するフロー・チャートである。
(7th Embodiment)
FIG. 17 is a flow chart similar to FIG. 12 showing the operation of the stack determination device of the robot working machine according to the seventh embodiment of the present invention.
第６実施形態と相違する点に焦点をおいて説明すると、第７実施形態においてはＧＰＳ信号に加え、加速度センサ５０の出力を使用するように構成した。
Focusing on the differences from the sixth embodiment, the seventh embodiment is configured to use the output of the
図１７を参照して説明すると、Ｓ５００においてＧＰＳ信号と、加速度センサ５０の出力（即ち、加速度信号）の変化をモニタ（検知）する。
Explaining with reference to FIG. 17, in S500, the GPS signal and the change in the output (that is, the acceleration signal) of the
次いでＳ５０２に進み、ＧＰＳ信号による作業機１０の位置と加速度信号が所定時間以上同一範囲にあるか、換言すればＧＰＳ信号による作業機１０の位置と加速度信号が所定時間以上変化しないか否か判断する。
Next, the process proceeds to S502, and it is determined whether the position of the working
Ｓ５０２で否定されるときは作業機１０がスタックしていないと判断してＳ５０４に進み、通常の芝刈り作業モードに復帰する一方、Ｓ５０２で肯定される（同一範囲にある）ときはＳ５０６に進み、作業機１０がスタックしたと判定する。
If it is denied by S502, it is determined that the
即ち、ＧＰＳ信号による作業機１０の位置が所定時間以上同一範囲にあることは作業機１０が所定時間以上、作業エリアＡＲで同じ位置にあることを意味すると共に、作業機１０は走行（移動）すれば加速度センサ５０の出力である加速度信号が変化するはずであるから、加速度信号を検知することによって第６実施形態に比してより精度良く作業機１０がスタックしたと判定することができる。
That is, the fact that the position of the
Ｓ５０６で作業機１０がスタックしたと判定されると脱出モードに移行し、次のＳ５０８において先ず作業機１０を規定時間だけ微速で前進または後退させるようにドライブモータ２６の駆動を制御する。
When it is determined in S506 that the
次いでＳ５１０に進み、ＧＰＳ信号による作業機１０の位置と加速度信号が所定時間以上同一範囲にあるか否か判断する。Ｓ５１０の判断が否定されるときはＳ５０４に進む一方、依然として肯定されるときはＳ５１２に進み、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させ、次いで右に旋回させる。
Next, the process proceeds to S510, and it is determined whether or not the position of the
次いでＳ５１４に進み、ＧＰＳ信号による作業機１０の位置と加速度信号が所定時間以上同一範囲にあるか否か再び判断する。Ｓ５１４で否定されるときは作業機１０がスタックを脱出したと判断できるので、Ｓ５０４に進む。
Then, the process proceeds to S514, and it is determined again whether or not the position of the
一方、肯定されるときはＳ５１６に進み、ブレード高さ調節機構３８を介してワークモータ２２を上方に移動させ、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させた後、右に旋回させる。
On the other hand, if affirmed, the process proceeds to S516, the
次いでＳ５１８に進み、ＧＰＳの信号による作業機１０の位置と加速度信号が所定時間以上同一範囲にある確認否か再び判断する。Ｓ５１８で否定されるときはスタックを脱出したと判断できることから、Ｓ５０４に進む。
Then, the process proceeds to S518, and it is determined again whether or not the position of the
一方、Ｓ５１８で肯定されるときはＳ５２０に進み、ブレード高さ調節機構３８を介してワークモータ２２を下方に移動させ、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させた後、右に旋回させる。
On the other hand, when affirmed in S518, the process proceeds to S520, the
次いでＳ５２２に進み、ＧＰＳ信号による作業機１０の位置と加速度信号が所定時間以上同一範囲にあるか否か再び判断する。Ｓ５２２で否定されるときはスタックを脱出したと判断できることから、Ｓ５２４に進む。
Then, the process proceeds to S522, and it is determined again whether or not the position of the
一方、Ｓ５２２で肯定されるときはＳ５２６に進み、ブレード高さ調節機構３８を介してワークモータ２２を上方に移動させると共に、ワークモータ２２の回転方向をブレード２０が時計回りに回転する方向としながら、ドライブモータ２６を駆動して既定時間駆動輪１６を回転させ、作業機１０を同方向に旋回させる。
On the other hand, when affirmed in S522, the process proceeds to S526, the
次いでＳ５２８に進み、ＧＰＳ信号による作業機１０の位置と加速度信号が所定時間以上同一範囲にあるか否か再び判断し、Ｓ５２８で否定されるときはスタックを脱出したと判断できることから、Ｓ５２４に進む。
Next, the process proceeds to S528, and it is determined again whether or not the position of the
一方、Ｓ５２８で肯定されるときはＳ５３０に進み、ブレード高さ調節機構３８を介してワークモータ２２を上方に移動させると共に、ワークモータ２２の回転方向をブレード２０が反時計回りに回転する方向としながら、ドライブモータ２６を駆動して既定時間駆動輪１６を回転させ、作業機１０を同方向に旋回させる。
On the other hand, when affirmed in S528, the process proceeds to S530, the
次いでＳ５３２に進み、ＧＰＳ信号による作業機１０の位置と加速度信号が所定時間以上同一範囲にあるか否か再び判断する。Ｓ５３２で否定されるときはスタックを脱出したと判断できることから、Ｓ５２４に進む。
Then, the process proceeds to S532, and it is determined again whether or not the position of the
一方、Ｓ５３２で肯定されるときはスタックを脱出できなかったと判断し、Ｓ５３４に進んでユーザに通知し、次いでＳ５３６に進んでドライブモータ２６などへの通電を停止して作業機１０を停止する。
On the other hand, when affirmed in S532, it is determined that the stack could not be escaped, the user proceeds to S534 to notify the user, and then S536 proceeds to stop the energization of the
第７実施形態に係るロボット作業機のスタック判定装置においては、作業エリアＡＲにおける作業機１０の位置を検知するＧＰＳ受信機（位置検知部）５６，５６ａと、作業機１０が走行するときの加速度を示す出力を生じる加速度センサ５０を備えると共に、ＧＰＳ受信機５４，５４ａで検知された（ＧＰＳ信号による）作業機１０の位置が所定時間以上同一範囲にあり、かつ加速度センサ５０の出力である加速度信号が所定時間以上同一範囲にあるとき、作業機１０がスタックしたと判定するように構成したので、第６実施形態に比し、作業エリアＡＲでの作業機１０のスタックを簡易かつ精度良く判定することができる。尚、残余の構成と効果は従前の実施形態と異ならない。
In the stack determination device of the robot work machine according to the seventh embodiment, the GPS receivers (position detection units) 56, 56a for detecting the position of the
（第８実施形態）
図１８はこの発明の第８実施形態に係るロボット作業機のスタック判定装置の動作を示す、図１３に類似するフロー・チャートである。
(8th Embodiment)
FIG. 18 is a flow chart similar to FIG. 13 showing the operation of the stack determination device of the robot working machine according to the eighth embodiment of the present invention.
第６実施形態と相違する点に焦点をおいて説明すると、第８実施形態においてはＧＰＳ信号に加え、駆動輪１６の回転を示す出力を生じる駆動輪回転センサ５６の出力を使用するように構成した。
Focusing on the differences from the sixth embodiment, the eighth embodiment is configured to use the output of the drive
図１８を参照して説明すると、Ｓ６００においてＧＰＳ信号と、駆動輪回転センサ５６の出力（即ち、駆動輪回転信号）の変化をモニタ（検知）する。 Explaining with reference to FIG. 18, in S600, changes in the GPS signal and the output of the drive wheel rotation sensor 56 (that is, the drive wheel rotation signal) are monitored (detected).
次いでＳ６０２に進み、ＧＰＳ信号による作業機１０の位置と駆動輪回転信号が所定時間以上同一範囲にあるか、換言すればＧＰＳ信号による作業機１０の位置と駆動輪回転信号が所定時間以上変化しないか否か判断する。
Next, the process proceeds to S602, and whether the position of the working
Ｓ６０２で否定されるときは作業機１０がスタックしていないと判断してＳ６０４に進み、通常の芝刈り作業モードに復帰する一方、Ｓ６０２で肯定される（同一範囲にある）ときはＳ６０６に進み、作業機１０がスタックしたと判定する。
If it is denied in S602, it is determined that the
即ち、ＧＰＳ信号による作業機１０の位置が所定時間以上同一範囲にあることは作業機１０が所定時間以上、作業エリアＡＲで同じ位置にあることを意味すると共に、作業機１０は走行（移動）すれば駆動輪１６の回転を示す駆動輪回転センサ５６の信号（駆動輪回転信号）が変化するはずであるから、駆動輪回転信号を検知することによって第６実施形態に比してより精度良く、作業機１０がスタックしたと判定することができる。
That is, the fact that the position of the
Ｓ６０６で作業機１０がスタックしたと判定されると、脱出モードに移行し、次のＳ６０８において先ず作業機１０を規定時間だけ微速で前進または後退させるようにドライブモータ２６の駆動を制御する。
When it is determined in S606 that the
次いでＳ６１０に進み、ＧＰＳ信号による作業機１０の位置と駆動輪回転信号が所定時間以上同一範囲にあるか否か判断する。Ｓ６１０の判断が否定されるときはＳ６０４に進む一方、肯定されるときはＳ６１２に進み、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させ、次いで右に旋回させる。
Next, the process proceeds to S610, and it is determined whether or not the position of the
次いでＳ６１４に進み、ＧＰＳ信号による作業機１０の位置と駆動輪回転信号が所定時間以上同一範囲にあるか否か再び判断する。Ｓ６１４で否定されるときは作業機１０がスタックを脱出したと判断できるので、Ｓ６０４に進む。
Then, the process proceeds to S614, and it is determined again whether or not the position of the
一方、肯定されるときはＳ６１６に進み、ブレード高さ調節機構３８を介してワークモータ２２を上方に移動させ、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させた後、右に旋回させる。
On the other hand, if affirmed, the process proceeds to S616, the
次いでＳ６１８に進み、ＧＰＳ信号による作業機１０の位置と駆動輪回転信号が所定時間以上同一範囲にあるか否か再び判断する。Ｓ６１８で否定されるときはスタックを脱出したと判断できることから、Ｓ６０４に進む。
Then, the process proceeds to S618, and it is determined again whether or not the position of the
一方、Ｓ６１８で肯定されるときはＳ６２０に進み、ブレード高さ調節機構３８を介してワークモータ２２を下方に移動させ、ドライブモータ２６を駆動して既定時間、作業機１０を左に旋回させ、次いで前進させた後、右に旋回させる。
On the other hand, when affirmed in S618, the process proceeds to S620, the
次いでＳ６２２に進み、固定信号源からの信号の強度と駆動輪回転信号が所定時間以上同一範囲にある否か再び判断する。Ｓ６２２で否定されるときはスタックを脱出したと判断できることから、Ｓ６２４に進む。 Then, the process proceeds to S622, and it is determined again whether or not the strength of the signal from the fixed signal source and the drive wheel rotation signal are in the same range for a predetermined time or longer. If it is denied in S622, it can be determined that the player has escaped from the stack, so the process proceeds to S624.
一方、Ｓ６２２で依然肯定されるときはＳ６２６に進み、ブレード高さ調節機構３８を介してワークモータ２２を上方に移動させると共に、ワークモータ２２の回転方向をブレード２０が時計回りに回転する方向としながら、ドライブモータ２６を駆動して既定時間駆動輪１６を回転させ、作業機１０を同方向に旋回させる。
On the other hand, if it is still affirmed in S622, the process proceeds to S626, the
次いでＳ６２８に進み、ＧＰＳ信号による作業機１０の位置と駆動輪回転信号が所定時間以上同一範囲にあるか否か再び判断し、Ｓ６２８で否定されるときはスタックを脱出したと判断できることから、Ｓ６２４に進む。
Next, the process proceeds to S628, and it is determined again whether or not the position of the
一方、Ｓ６２８で肯定されるときはＳ６３０に進み、ブレード高さ調節機構３８を介してワークモータ２２を上方に移動させると共に、ワークモータ２２の回転方向をブレード２０が反時計回りに回転する方向としながら、ドライブモータ２６を駆動して既定時間駆動輪１６を回転させ、作業機１０を同方向に旋回させる。
On the other hand, when affirmed in S628, the process proceeds to S630, the
次いでＳ６３２に進み、ＧＰＳ信号による作業機１０の位置と駆動輪回転信号が所定時間以上同一範囲にあるか否か再び判断する。Ｓ６３２で否定されるときはスタックを脱出したと判断できることから、Ｓ６２４に進む。
Then, the process proceeds to S632, and it is determined again whether or not the position of the
一方、Ｓ６３２で肯定されるときはスタックを脱出できなかったと判断し、Ｓ６３４に進んでユーザに通知し、次いでＳ６３６に進んでドライブモータ２６などへの通電を停止して作業機１０を停止する。
On the other hand, when affirmed in S632, it is determined that the stack could not be escaped, the user is notified in S634, and then S636 is performed to stop the energization of the
第８実施形態に係るロボット作業機のスタック判定装置においては、作業エリアＡＲにおける作業機１０の位置を検知するＧＰＳ受信機（位置検知部）５６，５６ａと、駆動輪１６の回転を示す出力を生じる駆動輪回転センサ５６を備えると共に、ＧＰＳ受信機５４，５４ａで検知された作業機１０の位置が所定時間以上同一範囲にあり、かつ駆動輪回転センサ５６の出力が所定時間以上同一範囲にあるとき、前記作業機がスタックしたと判定するように構成したので、第６実施形態に比し、作業エリアＡＲでの作業機１０のスタックを簡易かつ精度良く判定することができる。尚、残余の構成と効果は従前の実施形態と異ならない。
In the stack determination device of the robot work machine according to the eighth embodiment, GPS receivers (position detection units) 56, 56a for detecting the position of the
（第９実施形態）
図１９はこの発明の第９実施形態に係るロボット作業機のスタック判定装置の構成を示す、図１に類似する説明図である。
(9th Embodiment)
FIG. 19 is an explanatory diagram similar to FIG. 1 showing a configuration of a stack determination device for a robot working machine according to a ninth embodiment of the present invention.
従前の実施形態と相違する点に焦点をおいて説明すると、第９実施形態において作業機１０は遠隔地のオフィスなどに設置されるクラウド上のサーバ２００に無線を介してイーサネット（登録商標）あるいは公衆電話通信網などの通信手段２０２によって双方向通信可能に接続され、作業機１０に搭載されるＥＣＵ４４はサーバ２００からの指令あるいはサーバ２００に格納される制御プログラムに従って作業機１０を動作させるように構成した。
Focusing on the differences from the conventional embodiment, in the ninth embodiment, the
サーバ２００は、例えば大容量のコンピュータ（メインフレーム）からなる。これにより、ＥＣＵ４４のＣＰＵ４４ａの演算負荷をメモリ４４ｃの容量を低減することが可能となる。具体的には、上記の第１から第８実施形態においてＥＣＵ４４のＣＰＵ４４ａが実行する制御のうち、少なくとも一部（例えば、固定信号源からの信号の強度の変化のモニタリングや、信号の強度が所定時間以上同一範囲にあるか否かの判定）をサーバ２００側で実行しても良い。
The
さらに、第９実施形態において作業機１０も１台に限らず、同図に示すように複数台（図示例では３台）からなるように構成しても良い。その場合、それぞれの作業機１０のＥＣＵ４４はクラウド上のサーバ２００に接続され、送受信にはそれぞれの識別コードが付され、サーバ２００は作業機１０それぞれを識別可能に構成される。
Further, in the ninth embodiment, the working
その結果、作業機１０のそれぞれはサーバ２００の指令に従って共同で芝刈り作業する、あるいは作業機１０の１台がスタックしたと判定されたとき、他の作業機１０が後方から押すなどしてスタックからの脱出に助力することも可能となる。これにより、複数台の作業機１０を共同で動作させることができて作業効率を向上させることが可能となる。
As a result, each of the
上記した如く、この発明の第１から第９実施形態に係るロボット作業機のスタック判定装置は、車体１２に取り付けられる駆動輪１６を原動機（ドライブモータ）２６で駆動して作業エリアＡＲを走行するロボット作業機１０において、前記作業エリアＡＲに配置された固定信号源（エリアワイヤ７２、ビーコン１００、マーカ１０４、ＩＣタグ１０８）からの信号を検知する信号検知部（磁気センサ３６、受信端末１０２、カメラ１０６、ＩＣタグ信号受信機１１０、ＥＣＵ４４，Ｓ１０，Ｓ１００，Ｓ２００，Ｓ３００）と、前記信号検知部で検知された信号の強度が所定時間以上同一範囲にあるか否か判定し、同一範囲にあるとき、前記作業機１０がスタックしたと判定するスタック判定部（ＥＣＵ４４，Ｓ１２−Ｓ４６、Ｓ１０２−Ｓ１３６，Ｓ２０２−Ｓ２３６，Ｓ３０２−Ｓ３３６）とを備える如く構成したので、作業エリアＡＲでの作業機１０のスタックを簡易に判定することができる。
As described above, the stack determination device of the robot work machine according to the first to ninth embodiments of the present invention drives the
それにより、ロボット作業機１０を初期の作業に迅速に復帰させることができて作業効率を向上できると共に、ロボット作業機１０が捜索し難い場所でスタックして発見に時間を要するなどの不都合が生じることがない。
As a result, the
また、固定信号源が作業エリアＡＲの周縁に配置されると共に、電源８０から電流を通電されるエリアワイヤ（電線）７２からなるように構成したので、上記した効果に加え、エリアワイヤ７２を作業エリア認識に用いる作業機１０にあっては既存の設備をそのまま利用できると共に、電波障害などの外乱を受けることがない。
Further, since the fixed signal source is arranged on the periphery of the work area AR and is composed of the area wire (electric wire) 72 to which the current is applied from the
また、前記固定信号源が、前記作業エリアＡＲの周縁に配置されると共に、電源８０から電流を通電される電線（エリアワイヤ）７２からなる如く構成したので、上記した効果に加え、エリアワイヤ７２を作業エリア認識に用いる作業機１０にあっては既存の設備をそのまま利用できると共に、電波障害などの外乱を受けることがない。
Further, since the fixed signal source is arranged on the periphery of the work area AR and is composed of an electric wire (area wire) 72 which is energized by a current from the
また、前記電線（エリアワイヤ）７２が前記作業エリアＡＲの内側に向けて延びるように配置される如く構成したので、上記した効果に加え、作業エリアＡＲの内奥部位などにおいても検知精度を向上させることができる。 Further, since the electric wire (area wire) 72 is arranged so as to extend toward the inside of the work area AR, in addition to the above-mentioned effect, the detection accuracy is improved even in the inner and inner parts of the work area AR. Can be made to.
また、第２実施形態においては、前記固定信号源が、前記作業エリアＡＲの周縁に相互に所定の離間距離をおいて配置される複数個のビーコン１００からなるように構成したので、作業エリアＡＲでの作業機１０のスタックを簡易に判定することができる。
Further, in the second embodiment, since the fixed signal source is configured to consist of a plurality of
また、第３実施形態などにおいては、前記作業機１０が走行するときの加速度を示す出力を生じる加速度センサ５０を備えると共に、前記スタック判定部（ＥＣＵ４４）は、前記信号検知部で検知された固定信号源からの信号の強度が所定時間以上同一範囲にあり、かつ前記加速度センサの出力が所定時間以上同一範囲にあるとき、前記作業機１０がスタックしたと判定する（Ｓ１０２，Ｓ１１０，Ｓ１１４，Ｓ１１８，Ｓ１２２，Ｓ１２８，Ｓ１３２）ように構成したので、作業エリアＡＲでの作業機１０のスタックを簡易にかつ精度良く判定することができる。
Further, in the third embodiment or the like, the
特に、作業エリアＡＲが長い狭路を有する場合など、作業機１０が移動するにも関わらず、エリア信号の強度は変わらないので、加速度信号も考慮することでスタックを精度良く判定することができる。作業機１１がその場旋回など極小の旋回半径で旋回する場合も同様である。
In particular, when the work area AR has a long narrow road, the strength of the area signal does not change even though the
また、第４実施形態などにおいては、前記駆動輪の回転を示す出力を生じる駆動輪回転センサ５６を備えると共に、前記スタック判定部（ＥＣＵ４４）は、前記信号検知部で検知された固定信号源からの信号の強度が所定時間以上同一範囲にあり、かつ前記駆動輪回転センサの出力が所定時間以上同一範囲にあるとき、前記作業機がスタックしたと判定する（Ｓ２０２，Ｓ２１０，Ｓ２１４，Ｓ２１８，Ｓ２２２，Ｓ２２８，Ｓ２３２）ように構成したので、作業エリアＡＲでの作業機１０のスタックを簡易にかつ精度良く判定することができる。
Further, in the fourth embodiment or the like, the drive
また、第５実施形態においては、前記駆動輪の回転を示す出力を生じる駆動輪回転センサ５６と、前記車体に前記駆動輪に隣接して取り付けられる従動輪の回転を示す出力を生じる従動輪回転センサ５８とを備え、前記スタック判定部（ＥＣＵ４４）は、前記信号検知部で検知された固定信号源からの信号の強度が所定時間以上同一範囲にあると共に、前記駆動輪回転センサと従動輪回転センサの出力から前記駆動輪は回転する一方、前記従動輪は回転しない状態が所定時間以上続くとき、前記作業機がスタックしたと判定する（Ｓ３０２，Ｓ３１０，Ｓ３１４，Ｓ３１８，Ｓ３２２，Ｓ３２８，Ｓ３３２）ように構成したので、作業エリアＡＲでの作業機１０のスタックを簡易にかつ精度良く判定することができる。
Further, in the fifth embodiment, the drive
また、第５実施形態などにおいては、車体１２に取り付けられる駆動輪１６を原動機（ドライブモータ）２６で駆動して作業エリアＡＲを走行するロボット作業機１０において、前記作業エリアＡＲにおける前記作業機１０の位置を検知する位置検知部（ＧＰＳ受信機５４，ＥＣＵ４４，Ｓ４００，Ｓ５００，Ｓ６００）と、前記位置検知部で検知された前記作業機１０の位置が所定時間以上同一範囲にあるか否か判定し、同一範囲にあるとき、前記作業機がスタックしたと判定するスタック判定部（ＥＣＵ４４，Ｓ４０２−Ｓ４３６，Ｓ５０２−Ｓ５３６，Ｓ６０２−Ｓ６３６）とを備えるように構成したので、作業エリアＡＲでの作業機１０のスタックを簡易に判定することができる。
Further, in the fifth embodiment or the like, in the
また、第７実施形態にあっては、前記作業機が走行するときの加速度を示す出力を生じる加速度センサ５０を備えると共に、前記スタック判定部（ＥＣＵ４４）は、前記位置検知部で検知された前記作業機の位置が所定時間以上同一範囲にあり、かつ前記加速度センサの出力が所定時間以上同一範囲にあるとき、前記作業機がスタックしたと判定する（Ｓ５０２，Ｓ５１０，Ｓ５１４，Ｓ５１８，Ｓ５２２，Ｓ５２８，Ｓ５３２）ように構成したので、作業エリアＡＲでの作業機１０のスタックを簡易に判定することができる。
Further, in the seventh embodiment, the
また、第８実施形態にあっては、前記駆動輪の回転を示す出力を生じる駆動輪回転センサ５６を備えると共に、前記スタック判定部（ＥＣＵ４４）は、前記位置検知部で検知された前記作業機の位置が所定時間以上同一範囲にあり、かつ前記駆動輪回転センサの出力が所定時間以上同一範囲にあるとき、前記作業機がスタックしたと判定する（Ｓ６０２，Ｓ６１０，Ｓ６１４，Ｓ６１８，Ｓ６２２，Ｓ６２８，Ｓ６３２）ように構成したので、作業エリアＡＲでの作業機１０のスタックを簡易に判定することができる。
Further, in the eighth embodiment, the drive
また、第１から第８実施形態にあっては、前記信号検知部（磁気センサ３６、受信端末１０２、ＩＣタグ１０４とＩＣタグ信号受信機１０６）で検知された信号と前記位置検出部（ＧＰＳ受信機５４，マーカ１０８、カメラ１１０、ＥＣＵ４４，Ｓ４００，Ｓ５００，Ｓ６００）で検知された前記作業機１０の位置とのうちの少なくとものいずれかに基づいて前記原動機の駆動を制御して前記作業エリアで走行させる制御部（ＥＣＵ４４，Ｓ１４，Ｓ３４，Ｓ１０４，Ｓ１２４，Ｓ２０４，Ｓ２２４，Ｓ３０４，Ｓ３２４，Ｓ４０４，Ｓ４２４，Ｓ５０４，Ｓ５２４、Ｓ６０４，Ｓ６２４）を備えるように構成したので、上記した効果に加え、スタックと判定されないときは所期の作業を実行させることができる。
Further, in the first to eighth embodiments, the signal detected by the signal detection unit (
前記制御部（ＥＣＵ４４）は、前記スタック判定部で前記作業機がスタックしたと判定されるとき、前記作業機をスタックから脱出させるスタック脱出制御を行う（Ｓ１８，Ｓ２２，Ｓ２６，Ｓ３０，Ｓ３６，Ｓ４０，Ｓ１０８，Ｓ１１２，Ｓ１１６，Ｓ１２０，Ｓ１２６，Ｓ１３０，Ｓ２０８，Ｓ２１２，Ｓ２１６，Ｓ２２０，Ｓ２２６，Ｓ２３０，Ｓ３０８，Ｓ３１２，Ｓ３１６，Ｓ３２０，Ｓ３２６，Ｓ３３０，Ｓ４０８，Ｓ４１２，Ｓ４１６，Ｓ４２０，Ｓ４２６，Ｓ４３０，Ｓ５０８，Ｓ５１２，Ｓ５１６，Ｓ５２０，Ｓ５２６，Ｓ５３０，Ｓ６０８，Ｓ６１２，Ｓ６１６，Ｓ６２０，Ｓ６２６，Ｓ６３０）ように構成したので、上記した効果に加え、作業機１０を短時間にスタックから脱出させることができ、作業効率とエネルギ消費効率を向上させることができる。 When the stack determination unit determines that the work machine is stuck, the control unit (ECU 44) performs stack escape control for escaping the work machine from the stack (S18, S22, S26, S30, S36, S40). , S108, S112, S116, S120, S126, S130, S208, S212, S216, S220, S226, S230, S308, S312, S316, S320, S326, S330, S408, S421, S416, S420, S426, S430, S508. , S512, S516, S520, S526, S530, S608, S612, S616, S620, S626, S630). Work efficiency and energy consumption efficiency can be improved.
また、前記制御部（ＥＣＵ４４）は、前記スタック判定部で前記作業機がスタックしたと判定されるとき、前記作業機を規定時間だけ前進または後退させるように前記原動機（ドライブモータ）２６の駆動を制御する（Ｓ１８，Ｓ１０８，Ｓ２０８，Ｓ３０８，Ｓ４０８，Ｓ５０８，Ｓ６０８）ように構成したので、上記した効果に加え、一時的にスタックしている場合などに作業機１０をスタックから迅速に脱出させることができる。
Further, when the stack determination unit determines that the work machine is stuck, the control unit (ECU 44) drives the prime mover (drive motor) 26 so as to move the work machine forward or backward by a predetermined time. Since it is configured to be controlled (S18, S108, S208, S308, S408, S508, S608), in addition to the above-mentioned effects, the working
前記制御部（ＥＣＵ４４）は、前記スタック判定部で前記作業機がスタックしたと判定されるとき、ユーザに通知する（Ｓ４４，Ｓ１３４，Ｓ２３４，Ｓ３３４，Ｓ４３４，Ｓ５３４，Ｓ６３４）ように構成したので、上記した効果に加え、ユーザは自身で作業機１０をスタックから脱出させる、メインスイッチ６４をオフするなどの措置を講じることも可能となる。
The control unit (ECU 44) is configured to notify the user when the stack determination unit determines that the work machine is stuck (S44, S134, S234, S334, S434, S534, S634). In addition to the above effects, the user can also take measures such as escaping the
また、この発明の第９実施形態に係るロボット作業機のスタック判定装置は、クラウド上のサーバ２００に通信手段２０２によって双方向通信自在に接続される如く構成したので、上記した効果に加え、ＥＣＵ４４のＣＰＵ４４ａの演算負荷をメモリ４４ｃの容量を低減することが可能となる。
Further, since the stack determination device of the robot working machine according to the ninth embodiment of the present invention is configured to be freely connected to the
また、第９実施形態に係るロボット作業機のスタック判定装置は、複数台の作業機１０を備え、前記複数台の作業機のそれぞれが前記サーバ２００に双方向通信自在に接続される如く構成したので、上記した効果に加え、複数台の作業機１０を共同で動作させることができて作業効率を向上させえることが可能となる。
Further, the stack determination device for the robot work machine according to the ninth embodiment includes a plurality of
尚、この発明を第１実施形態から第９実施形態にわたって説明してきたが、上記した実施形態は例示であり、例えば第２実施形態と第３実施形態を組み合わせるなど、種々の変形が可能である。 Although the present invention has been described from the first embodiment to the ninth embodiment, the above-described embodiment is an example, and various modifications such as combining the second embodiment and the third embodiment are possible. ..
また、この発明を芝刈り用のロボット作業機として説明してきたが、それに限られるものではなく、清掃、樹木や手入れなど屋外で位置認識しつつ作業する全てのロボット作業機にも妥当する。 Further, although the present invention has been described as a robot working machine for lawn mowing, the present invention is not limited to this, and is applicable to all robot working machines that work while recognizing the position outdoors such as cleaning, trees and maintenance.
１０ ロボット作業機（作業機）、１２ 車体、１４ 前輪、１６ 後輪、２０ ブレード（作業機）、２２ 電動モータ（ワークモータ。作業機）、２６ 電動モータ（原動機。ドライブモータ）、３０ 搭載充電ユニット、３２ 搭載電池、３４ 電池充電端子、３６ 磁気センサ（３６Ｌ 第１磁気センサ，３６Ｒ 第２磁気センサ、３６Ｃ 第３磁気センサ）、３８ ブレード高さ調節機構、４４ 電子制御ユニット（ＥＣＵ）、４４ａ１ 作業負荷判断部、４４ａ２ 作業日程修正部、４６ 角速度センサ、５０ 加速度センサ、５２ 方位センサ、５４ ＧＰＳ受信機、５６ 駆動輪回転センサ、５８ 従動輪回転センサ、６２ 電流センサ、６４ メインスイッチ、７０ ディスプレイ、７２ エリアワイヤ、７６ 充電ＳＴ（ステーション）、８４ 充電器、８６ 充電端子、ＡＲ 作業エリア、１００ ビーコン、１０２ 受信端末、１０４ マーカ、１０６ カメラ 、１０８ ＩＣタグ、１１０ ＩＣタグ信号受信機、２００ サーバ、２０２ 通信手段 10 Robot work machine (work machine), 12 body, 14 front wheels, 16 rear wheels, 20 blades (work machine), 22 electric motor (work motor, work machine), 26 electric motor (motor, drive motor), 30 on-board charging Unit, 32 on-board battery, 34 battery charging terminal, 36 magnetic sensor (36L 1st magnetic sensor, 36R 2nd magnetic sensor, 36C 3rd magnetic sensor), 38 blade height adjustment mechanism, 44 electronic control unit (ECU), 44a1 Workload Judgment Unit, 44a2 Work Schedule Correction Unit, 46 Angle Speed Sensor, 50 Acceleration Sensor, 52 Direction Sensor, 54 GPS Receiver, 56 Drive Wheel Rotation Sensor, 58 Driven Wheel Rotation Sensor, 62 Current Sensor, 64 Main Switch, 70 Display , 72 area wire, 76 charging ST (station), 84 charger, 86 charging terminal, AR work area, 100 beacon, 102 receiving terminal, 104 marker, 106 camera, 108 IC tag, 110 IC tag signal receiver, 200 server , 202 means of communication
Claims (16)
前記作業エリアに配置された固定信号源からの信号を検知する信号検知部と、
前記信号検知部で検知された信号の強度が所定時間以上同一範囲にあるか否か判定し、同一範囲にあるとき、前記作業機がスタックしたと判定するスタック判定部と、
を備えたことを特徴とするロボット作業機のスタック判定装置。 In a robot work machine that travels in a work area by driving the drive wheels attached to the vehicle body with a prime mover
A signal detection unit that detects signals from a fixed signal source located in the work area, and
A stack determination unit that determines whether or not the signal intensities detected by the signal detection unit are in the same range for a predetermined time or longer, and if they are in the same range, determines that the work equipment is stuck.
A stack determination device for a robot work machine, which is characterized by being equipped with.
を備えると共に、前記スタック判定部は、前記信号検知部で検知された固定信号源からの信号の強度が所定時間以上同一範囲にあり、かつ前記加速度センサの出力が所定時間以上同一範囲にあるとき、前記作業機がスタックしたと判定することを特徴とする請求項１から４のいずれかに記載のロボット作業機のスタック判定装置。 An accelerometer that produces an output that indicates the acceleration of the work equipment as it travels.
When the strength of the signal from the fixed signal source detected by the signal detection unit is in the same range for a predetermined time or more and the output of the acceleration sensor is in the same range for a predetermined time or more. The stack determination device for a robot work machine according to any one of claims 1 to 4, wherein it is determined that the work machines are stuck.
を備えると共に、前記スタック判定部は、前記信号検知部で検知された固定信号源からの信号の強度が所定時間以上同一範囲にあり、かつ前記駆動輪回転センサの出力が所定時間以上同一範囲にあるとき、前記作業機がスタックしたと判定することを特徴とする請求項１から５のいずれかに記載のロボット作業機のスタック判定装置。 A drive wheel rotation sensor that produces an output indicating the rotation of the drive wheels,
In addition, the stack determination unit has the signal strength from the fixed signal source detected by the signal detection unit in the same range for a predetermined time or more, and the output of the drive wheel rotation sensor is in the same range for a predetermined time or more. The stack determination device for a robot work machine according to any one of claims 1 to 5, wherein it is determined that the work machines are stuck at a certain time.
前記車体に前記駆動輪に取り付けられる従動輪の回転を示す出力を生じる従動輪回転センサと、
を備え、前記スタック判定部は、前記信号検知部で検知された固定信号源からの信号の強度が所定時間以上同一範囲にあると共に、前記駆動輪回転センサと従動輪回転センサの出力から前記駆動輪は回転する一方、前記従動輪は回転しない状態が所定時間以上続くとき、前記作業機がスタックしたと判定することを特徴とする請求項１から６のいずれかに記載のロボット作業機のスタック判定装置。 A drive wheel rotation sensor that produces an output indicating the rotation of the drive wheels,
A driven wheel rotation sensor that produces an output indicating the rotation of the driven wheels attached to the driving wheels on the vehicle body.
The stack determination unit has the same signal strength from the fixed signal source detected by the signal detection unit for a predetermined time or longer, and is driven from the outputs of the drive wheel rotation sensor and the driven wheel rotation sensor. The stack of robot working machines according to any one of claims 1 to 6, wherein it is determined that the working machines are stuck when the driven wheels do not rotate for a predetermined time or longer while the wheels rotate. Judgment device.
前記作業エリアにおける前記作業機の位置を検知する位置検知部と、
前記位置検知部で検知された前記作業機の位置が所定時間以上同一範囲にあるか否か判定し、同一範囲にあるとき、前記作業機がスタックしたと判定するスタック判定部と、
を備えたことを特徴とするロボット作業機のスタック判定装置。 In a robot work machine that travels in a work area by driving the drive wheels attached to the vehicle body with a prime mover
A position detection unit that detects the position of the work machine in the work area, and
A stack determination unit that determines whether or not the position of the work machine detected by the position detection unit is in the same range for a predetermined time or longer, and if the position is in the same range, determines that the work machine is stuck.
A stack determination device for a robot work machine, which is characterized by being equipped with.
を備えると共に、前記スタック判定部は、前記位置検知部で検知された前記作業機の位置が所定時間以上同一範囲にあり、かつ前記加速度センサの出力が所定時間以上同一範囲にあるとき、前記作業機がスタックしたと判定することを特徴とする請求項８に記載のロボット作業機のスタック判定装置。 An accelerometer that produces an output that indicates the acceleration of the work equipment as it travels.
When the position of the work machine detected by the position detection unit is in the same range for a predetermined time or more and the output of the acceleration sensor is in the same range for a predetermined time or more, the stack determination unit is equipped with the above operation. The stack determination device for a robot working machine according to claim 8, wherein the machine is determined to be stuck.
を備えると共に、前記スタック判定部は、前記位置検知部で検知された前記作業機の位置が所定時間以上同一範囲にあり、かつ前記駆動輪回転センサの出力が所定時間以上同一範囲にあるとき、前記作業機がスタックしたと判定することを特徴とする請求項８または９に記載のロボット作業機のスタック判定装置。 A drive wheel rotation sensor that produces an output indicating the rotation of the drive wheels,
When the position of the work machine detected by the position detection unit is in the same range for a predetermined time or more and the output of the drive wheel rotation sensor is in the same range for a predetermined time or more. The stack determination device for a robot work machine according to claim 8 or 9, wherein the work machine is determined to be stuck.
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2020002021A JP2021108566A (en) | 2020-01-09 | 2020-01-09 | Stack determining device for robot work machine |
| DE102021100121.8A DE102021100121A1 (en) | 2020-01-09 | 2021-01-07 | STUCK DETECTION DEVICE FOR A ROBOT WORK MACHINE |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2020002021A JP2021108566A (en) | 2020-01-09 | 2020-01-09 | Stack determining device for robot work machine |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JP2021108566A true JP2021108566A (en) | 2021-08-02 |
Family
ID=76542985
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2020002021A Pending JP2021108566A (en) | 2020-01-09 | 2020-01-09 | Stack determining device for robot work machine |
Country Status (2)
| Country | Link |
|---|---|
| JP (1) | JP2021108566A (en) |
| DE (1) | DE102021100121A1 (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2023276497A1 (en) | 2021-06-30 | 2023-01-05 | Hoya株式会社 | Processor for endoscope and endoscope system |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP6212591B2 (en) | 2016-03-31 | 2017-10-11 | 本田技研工業株式会社 | Control device for autonomous vehicle |
| JP6802852B2 (en) | 2016-10-31 | 2020-12-23 | 本田技研工業株式会社 | Work vehicle |
-
2020
- 2020-01-09 JP JP2020002021A patent/JP2021108566A/en active Pending
-
2021
- 2021-01-07 DE DE102021100121.8A patent/DE102021100121A1/en active Pending
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2023276497A1 (en) | 2021-06-30 | 2023-01-05 | Hoya株式会社 | Processor for endoscope and endoscope system |
Also Published As
| Publication number | Publication date |
|---|---|
| DE102021100121A1 (en) | 2021-07-15 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP6212590B2 (en) | Control device for autonomous vehicle | |
| JP6263567B2 (en) | Control device for autonomous vehicle | |
| JP6243951B2 (en) | Control device for autonomous vehicle | |
| EP3073602B1 (en) | Charging station for autonomously navigating utility vehicle | |
| JP6498627B2 (en) | Control device for autonomous vehicle | |
| JP5420510B2 (en) | Control device for autonomous vehicle | |
| CN103246284B (en) | The unmanned control device travelling Operation Van | |
| EP3225454A1 (en) | Charging station for utility vehicle | |
| EP2685339A2 (en) | Navigation system and method for autonomous mowers | |
| US11934190B2 (en) | Low-profile robotic platform | |
| JP2012105557A (en) | Automatic lawn mower | |
| JP6594119B2 (en) | Autonomous traveling device | |
| JP2007233771A (en) | Autonomous mobile vehicle guidance system and method | |
| JP2018014963A (en) | Self-propelled work machine | |
| JP2021108566A (en) | Stack determining device for robot work machine | |
| JP2017033450A (en) | Moving robot | |
| JP2021108565A (en) | Stack escaping device for robot work machine | |
| CN109164830A (en) | A kind of automatic follower method of balance car and balance car | |
| JP2024075749A (en) | Autonomous traveling work device | |
| JP2024079807A (en) | Autonomous traveling work device and autonomous traveling work system | |
| JP2017068439A (en) | Autonomous traveling system | |
| WO2017164911A1 (en) | Transportation device | |
| JP2017199094A (en) | Autonomous traveling equipment | |
| CN113050620A (en) | Self-driven equipment system and boundary line breakage detection method thereof | |
| JP7554695B2 (en) | Operating systems and charging stations |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20200727 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A821 Effective date: 20200727 |