JP2019106941A - Mower - Google Patents

Mower Download PDF

Info

Publication number
JP2019106941A
JP2019106941A JP2017242687A JP2017242687A JP2019106941A JP 2019106941 A JP2019106941 A JP 2019106941A JP 2017242687 A JP2017242687 A JP 2017242687A JP 2017242687 A JP2017242687 A JP 2017242687A JP 2019106941 A JP2019106941 A JP 2019106941A
Authority
JP
Japan
Prior art keywords
grass
traveling
distance
reference line
line
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
JP2017242687A
Other languages
Japanese (ja)
Other versions
JP6877327B2 (en
Inventor
孝徳 小林
Takanori Kobayashi
孝徳 小林
雅寛 川畑
Masahiro Kawabata
雅寛 川畑
中村 太郎
Taro Nakamura
太郎 中村
純一郎 瀧口
Junichiro Takiguchi
純一郎 瀧口
佑輔 南方
Yusuke Minakata
佑輔 南方
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.)
Kubota Corp
Original Assignee
Kubota Corp
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 Kubota Corp filed Critical Kubota Corp
Priority to JP2017242687A priority Critical patent/JP6877327B2/en
Priority to US16/771,264 priority patent/US11696525B2/en
Priority to CN201880080844.8A priority patent/CN111447827B/en
Priority to EP18893078.8A priority patent/EP3729937B1/en
Priority to KR1020207016331A priority patent/KR102457518B1/en
Priority to PCT/JP2018/046872 priority patent/WO2019124463A1/en
Publication of JP2019106941A publication Critical patent/JP2019106941A/en
Application granted granted Critical
Publication of JP6877327B2 publication Critical patent/JP6877327B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Guiding Agricultural Machines (AREA)
  • Harvester Elements (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

To provide a mower capable of automatically traveling and accurately distinguishing a ground surface which has been mowed and grasses before being mowed.SOLUTION: A mower comprises: a travel machine body 1 for performing mowing travel; a travel control part for controlling the travel machine body; a distance sensor 10 for scanning a distance between the travel machine body 1 and an object positioned in a machine body lateral direction over both of left and right directions of the machine body; a decode control part for generating ground height data over both of left and right sides of the machine body on the basis of the distance detected by scanning of the distance sensor 10 and scanning angle; an object detection part for generating a ground surface reference line identified as a line of a ground surface which has been mowed, and a grass reference line identified as a line of grasses before being mowed, by an approximate line based on the ground height data; a target distance calculation part for calculating a target distance on the basis of the distance between the grass reference line and the travel machine body; and a travel instruction part for outputting an instruction signal so that the distance between the grass reference line and the travel machine body matches the target distance.SELECTED DRAWING: Figure 5

Description

本発明は、草刈走行を行う走行機体と、走行機体を制御する走行制御部と、距離センサと、が備えられた草刈機に関する。   The present invention relates to a mowing machine provided with a traveling machine body that performs mowing traveling, a traveling control unit that controls the traveling machine body, and a distance sensor.

例えば特許文献1に、草刈走行を行う走行機体(文献では「車体3」)と、作業領域の範囲に存在する物体を検出する検出装置(文献では「物体検出部11」)と、検出装置により検出された物体に基づいて算出された基準線(文献では符号「SL」)から走行機体までの離間距離を演算する距離算出部(文献では「距離演算部14」)と、基準線から走行機体までの距離が予め設定された範囲内に収まるように走行制御する走行制御部(文献では符号「16」)と、が備えられている自動草刈機が開示されている。特許文献1の自動草刈機では、果樹園内の二つ以上の果樹を目標物として基準線が生成される。   For example, in Patent Document 1, a traveling machine body performing mowing travel ("the vehicle body 3" in the document), a detection device ("the object detection unit 11" in the document) that detects an object present in the range of the work area, A distance calculation unit ("the distance calculation unit 14" in the document) for calculating the separation distance from the reference line (reference "SL" in the document) calculated based on the detected object to the traveling vehicle body; An automatic mowing machine is disclosed that is provided with a traveling control unit (reference numeral "16" in the literature) that performs traveling control so that the distance to the point falls within a preset range. In the automatic mowing machine of Patent Document 1, a reference line is generated with two or more fruit trees in an orchard as targets.

特開2016−189172号公報JP, 2016-189172, A

特許文献1に記載の発明では、果樹の幹が地面から立ち上がって果樹と地面とを容易に区別可能であるため、距離算出部は、果樹を目標物とする基準線と、走行機体と、の離間距離を演算できる。しかし、例えば法面等では地面から立ち上がる幹等が存在しない場合があり、目標物の設定ができずに基準線の生成ができない虞がある。   In the invention described in Patent Document 1, since the trunk of the fruit tree stands up from the ground and the fruit tree and the ground can be easily distinguished, the distance calculation unit is configured to measure the reference line with the fruit tree as a target and the traveling aircraft. The separation distance can be calculated. However, for example, there may be no trunk or the like rising from the ground on a slope or the like, and there is a possibility that the reference line can not be generated because the target can not be set.

上述した実情に鑑みて、本発明の目的は、草刈対象領域に目標物が無い場合であっても、刈取前の草と刈取後の地面とを精度良く判別して自動走行が可能な草刈機を提供することにある。   In view of the above-described situation, an object of the present invention is a mowing machine capable of automatically traveling by accurately discriminating the grass before harvesting and the ground after harvesting even when there is no target in the mowing target area To provide.

本発明の草刈機は、
草刈走行を行う走行機体と、
前記走行機体を制御する走行制御部と、
前記走行機体と、機体左右方向に位置する物体と、の距離を、機体左右両方に亘って走査する距離センサと、
前記距離センサの走査によって検出された距離及び走査角度に基づいて、機体左右両方に亘る対地高さデータを生成するデコード制御部と、
前記対地高さデータに基づく近似線によって、刈取後の地面のラインとして識別される地面基準線と、刈取前の草のラインとして識別される草基準線と、を生成する物体検出部と、
前記草基準線と前記走行機体との距離に基づいて目標距離を算出する目標距離算出部と、
前記草基準線と前記走行機体との距離が、前記目標距離と一致するように指示信号を出力する走行指示部と、
が備えられていることを特徴とする。
The mower of the present invention is
A traveling vehicle that carries out mowing traveling,
A traveling control unit that controls the traveling aircraft body;
A distance sensor for scanning the distance between the traveling body and an object located in the left and right direction of the body across both the left and right sides of the body;
A decoding control unit that generates ground height data for both the left and right of the vehicle based on the distance and scanning angle detected by the scanning of the distance sensor;
An object detection unit that generates a ground reference line identified as a ground line after cutting and a grass reference line identified as a grass line before cutting according to the approximation line based on the ground height data;
A target distance calculation unit that calculates a target distance based on the distance between the grass reference line and the traveling airframe;
A travel instruction unit that outputs an instruction signal such that the distance between the grass reference line and the traveling body matches the target distance;
Are provided.

例えば樹木等の目立った目標物が無い草刈対象領域であっても、草刈の対象となる草は存在する。本発明によると、距離センサが走行機体の左右方向を操作することによって、刈取後の地面と刈取前の草とを識別し、草の識別に基づく草基準線と、走行機体と、が予め設定された距離を保持するように、走行機体が制御される。このことから、草刈機は、刈取後の地面と刈取前の草との境界に沿って、草刈走行を自動的に行うことが可能となる。その結果、草刈対象領域に目標物が無い場合であっても、刈取前の草と刈取後の地面とを精度良く判別して自動走行が可能な草刈機が実現される。   For example, even if it is a mowing target area | region which has no remarkable targets, such as a tree | wood, the grass which becomes the object of mowing exists. According to the present invention, the distance sensor identifies the ground after harvesting and the grass before harvesting by manipulating the lateral direction of the traveling vehicle, and the grass reference line based on the identification of the grass and the traveling vehicle are set in advance. The traveling vehicle is controlled to maintain the determined distance. From this, the mowing machine can perform mowing traveling automatically along the boundary between the ground after cutting and the grass before cutting. As a result, even if there is no target in the mowing target area, a mowing machine capable of automatically traveling by accurately discriminating the grass before mowing and the ground after mowing is realized.

本構成において、
前記走行機体の走行モードを判定する走行モード判定部が備えられ、
前記走行モードは、手動制御モードと、自動制御モードと、を有し、
前記走行モードが前記手動制御モードの場合、前記走行制御部は手動制御の操作信号に基づいて前記走行機体を制御し、
前記走行モードが前記自動制御モードの場合、前記走行制御部は前記走行指示部の指示信号に基づいて前記走行機体を制御すると好適である。
In this configuration,
A traveling mode determination unit that determines a traveling mode of the traveling aircraft body;
The travel mode has a manual control mode and an automatic control mode,
When the traveling mode is the manual control mode, the traveling control unit controls the traveling machine based on an operation signal of manual control,
When the traveling mode is the automatic control mode, preferably, the traveling control unit controls the traveling machine body based on an instruction signal of the traveling instruction unit.

草刈対象領域の状況や走行機体の状況に対応して、草刈機は遠隔操作が可能な方が望ましい。本構成であれば、走行モード判定部による走行モードの判定から、走行制御部が入力する信号を、手動制御モードの場合における操作信号と、自動制御モードの場合における指示信号と、に切換可能となる。   It is desirable that the mowing machine can be operated remotely according to the conditions of the mowing target area and the conditions of the traveling aircraft. With this configuration, it is possible to switch the signal input by the traveling control unit to the operation signal in the manual control mode and the instruction signal in the automatic control mode from the determination of the traveling mode by the traveling mode determination unit Become.

本構成において、
前記距離センサは、機体前後方向を軸芯に回転することによって走査するように構成されていると好適である。
In this configuration,
It is preferable that the distance sensor is configured to scan by rotating around a longitudinal axis of the machine.

本構成であれば、距離センサの走査角度が前後方向を軸芯に回転するため、距離センサは、刈取後の地面のうち、走行機体の下方近傍の地面を走査できる。これにより、距離センサが刈取後の地面と刈取前の草とを精度良く走査可能となる。   In this configuration, since the scanning angle of the distance sensor rotates about the longitudinal axis in the front-rear direction, the distance sensor can scan the ground in the vicinity of the lower part of the traveling body among the ground after cutting. As a result, the distance sensor can scan the ground after harvesting and the grass before harvesting precisely.

前記距離センサは、前記走行機体の前部又は後部の何れか一方に設けられていると好適である。   It is preferable that the distance sensor be provided at either the front or the rear of the traveling body.

本構成であれば、距離センサが走行機体の前後中央部に設けられる構成と比較して、距離センサは、距離センサの真下の地面を走査可能となる。これにより、距離センサが刈取後の地面と刈取前の草とを精度良く走査可能となる。   With this configuration, the distance sensor can scan the ground directly below the distance sensor, as compared to a configuration in which the distance sensor is provided at the front-rear center of the traveling vehicle. As a result, the distance sensor can scan the ground after harvesting and the grass before harvesting precisely.

本構成において、
前記距離センサは、前記走行機体の前部及び後部の両方に設けられていると好適である。
In this configuration,
It is preferable that the distance sensor be provided at both the front and the rear of the traveling body.

本構成であれば、走行機体の前部に設けられた距離センサによって草刈走行が行われる前の地面及び草を走査できると共に、走行機体の後部に設けられた距離センサによって草刈走行が行われた後の地面及び草を走査できる。これにより、草刈機は、刈取後の地面と刈取前の草との境界に精度良く沿うことが可能となる。   With this configuration, the distance sensor provided at the front of the traveling machine can scan the ground and grass before mowing and the mowing is performed using the distance sensor provided at the rear of the traveling machine. You can scan the ground and grass behind. As a result, the mower can accurately follow the boundary between the ground after harvesting and the grass before harvesting.

本構成において、
前記物体検出部は、前記対地高さデータのうち、前記距離センサの機体鉛直下方から予め設定された機体左右方向の範囲内のデータから近似線を算出することによって、前記地面基準線を生成するように構成されていると好適である。
In this configuration,
The object detection unit generates the ground reference line by calculating an approximate line from data in the range in the left-right direction of the aircraft which is preset from the vertical direction of the distance sensor among the ground height data. Preferably, it is configured.

本構成であれば、近似線に基づいて地面基準線が生成される構成であるため、対地高さデータから刈取後の地面と草刈前の草とを効率よく判別できる。   With this configuration, since the ground reference line is generated based on the approximate line, the ground after cutting and the grass before cutting can be efficiently discriminated from the ground height data.

本構成において、
前記物体検出部は、前記対地高さデータのうち、前記地面基準線から一定値以上の高さを有するデータが一定範囲以上に亘って連続する箇所のデータから近似線を算出することによって、草候補線を生成するように構成されていると好適である。
In this configuration,
The object detection unit calculates grass by calculating an approximation line from data of a location where data having a height greater than or equal to a predetermined value from the ground reference line in the ground height data continues over a predetermined range or more. Preferably, it is configured to generate candidate lines.

本構成であれば、草候補線として生成される対地高さデータは、データが一定範囲以上に亘って連続する箇所のデータに限定される。このため、一定範囲に亘って連続しないデータが、草候補線のデータから排除され、草を誤検出する虞が低減される。また、近似線に基づいて草候補線が生成される構成であるため、対地高さデータから刈取後の地面と草刈前の草とを効率よく判別できる。   In the present configuration, the ground height data generated as the grass candidate line is limited to data of a portion where the data is continuous over a predetermined range or more. For this reason, the data which is not continuous over a certain range is excluded from the data of the grass candidate line, and the risk of erroneously detecting the grass is reduced. Further, since the grass candidate line is generated based on the approximate line, the ground after cutting and the grass before mowing can be efficiently discriminated from the ground height data.

本構成において、
前記草候補線は、複数生成され、
前記走行機体に、前記走行機体の傾斜角度を検出する慣性センサが備えられ、
前記物体検出部は、前記草候補線のうち、前記草候補線の前記地面基準線に対する傾斜角度と、前記慣性センサによって検出された傾斜角度から算出された算出傾斜角度と、が予め定められた基準範囲内である一つの前記草候補線を、前記草基準線と特定するように構成されるように構成されていると好適である。
In this configuration,
A plurality of grass candidate lines are generated,
The traveling body is provided with an inertial sensor that detects an inclination angle of the traveling body.
Among the grass candidate lines, the object detection unit predetermines an inclination angle of the grass candidate line with respect to the ground reference line and a calculated inclination angle calculated from the inclination angle detected by the inertial sensor. Preferably, one of the candidate grass lines within a reference range is configured to be identified as the grass reference line.

一般的に、草は傾斜地であっても特定方向(例えば鉛直方向)に沿って上方に生える場合が多い。本構成であると、慣性センサの傾斜角度に基づいて当該特定方向の算出が可能である。このため、複数の草候補線のうち、当該特定方向に沿う草候補線を草基準線と特定することによって、草の判別精度が向上する。   Generally, grass often grows upward along a specific direction (e.g. vertical direction) even on slopes. With this configuration, the specific direction can be calculated based on the inclination angle of the inertial sensor. For this reason, the discrimination | determination precision of grass improves by specifying the grass candidate line which follows the said specific direction among several grass candidate lines as a grass reference line.

本構成において、
前記草基準線は、前記地面基準線から予め設定された高さの範囲内に限定されると好適である。
In this configuration,
It is preferable that the grass reference line is limited within a height range preset from the ground reference line.

草の上部は風で揺れる場合が多いため、本構成であれば、風等の外乱による草の誤検出を防止できる。   Since the upper part of the grass is often shaken by the wind, this configuration can prevent erroneous detection of the grass due to disturbance such as wind.

本構成において、
前記草基準線と前記走行機体との距離は、現在と過去複数回とに亘って算出された複数の値が記憶され、
前記目標距離は、前記複数の値の移動平均値に基づいて算出されると好適である。
In this configuration,
As the distance between the grass reference line and the traveling vehicle, a plurality of values calculated over the present and a plurality of times in the past are stored,
Preferably, the target distance is calculated based on a moving average value of the plurality of values.

草刈走行において、草と走行機体との距離が一定範囲内に保持されている場合であっても、地面の石や杭等の検知によって草基準線と走行機体との距離が急激に大きく変化する場合も考えられる。本構成であれば、目標距離が移動平均値であるため、草基準線と走行機体との距離が急激に大きく変化する場合であっても、目標距離の変化は、草基準線と走行機体との距離の変化よりも小さなものとなり、走行指示部における指示信号が安定する。   Even when the distance between the grass and the traveling airframe is kept within a certain range during mowing, the distance between the grass reference line and the traveling airframe changes significantly by detection of stones or piles on the ground The case is also conceivable. In the case of this configuration, since the target distance is a moving average value, even if the distance between the grass reference line and the traveling airframe changes sharply and sharply, the change in the target distance is determined by the grass reference line and the traveling airframe Is smaller than the change in the distance d, and the instruction signal in the travel instruction unit is stabilized.

草刈機の構成を示す側面図である。It is a side view showing composition of a mowing machine. 旋回状態の平面図である。It is a top view of a turning state. 直進状態の平面図である。It is a top view of a rectilinear state. 制御ユニットを表すブロック図である。It is a block diagram showing a control unit. 草刈機の草刈走行を示す正面図である。It is a front view showing mowing travel of a mowing machine. 距離センサの走査に基づく二次元の座標位置情報を示すグラフ図である。It is a graph which shows the two-dimensional coordinate positional information based on the scan of a distance sensor. 未刈草の検出処理を示すフロートチャートである。It is a float chart which shows detection processing of uncut grass. 刈取後の地面の判定を示す説明図である。It is an explanatory view showing judgment of the ground after mowing. 傾斜面と未刈草との相対角度の算出を示す説明図である。It is explanatory drawing which shows calculation of the relative angle of an inclined surface and uncut grass. 草候補線及び草基準線の生成を示す説明図である。It is explanatory drawing which shows the production | generation of a grass candidate line and a grass reference line. 目標距離の算出を示す説明図である。It is an explanatory view showing calculation of a target distance. 草候補線の生成の別実施形態を示す説明図である。It is an explanatory view showing another embodiment of generation of a grass candidate line. 距離センサの走査の別実施形態を示す平面図である。It is a top view which shows another embodiment of the scan of a distance sensor.

〔草刈機の基本構成〕
本発明による草刈機について、その実施形態を図面に基づいて説明する。
図1に示されているように、本実施形態に例示される草刈機に、走行機体1と、第一車輪2Aと、第二車輪2Bと、草刈装置3と、が備えられている。第一車輪2Aは、走行機体1における長手方向の一端側に左右一対で設けられている。第二車輪2Bは、走行機体1における長手方向の他端側に左右一対で設けられている。草刈装置3は、走行機体1の下部における第一車輪2Aと第二車輪2Bとの間に設けられている。
[Basic configuration of mowing machine]
An embodiment of a mowing machine according to the present invention will be described based on the drawings.
As shown in FIG. 1, the mowing machine exemplified in the present embodiment includes a traveling body 1, a first wheel 2A, a second wheel 2B, and a mowing apparatus 3. The first wheels 2 </ b> A are provided on the one end side in the longitudinal direction of the traveling body 1 in a left-right pair. The second wheels 2 </ b> B are provided on the other end side in the longitudinal direction of the traveling airframe 1 in a left-right pair. The mowing device 3 is provided between the first wheel 2A and the second wheel 2B in the lower part of the traveling body 1.

走行機体1の上部に、送信機7(図4参照)と通信可能なアンテナ8が立設されている。送信機7は、操作者が持ち運びしながら草刈機を人為操作可能なように構成されている。送信機7は、例えば作業者が手元で操作するプロポーショナル方式のコントローラによる操作であったり、タッチパネル方式の表示画面を有する携帯端末機器による操作であったりしても良い。   An antenna 8 capable of communicating with the transmitter 7 (see FIG. 4) is provided upright on the upper part of the traveling body 1. The transmitter 7 is configured such that the operator can operate the mowing machine while carrying it. The transmitter 7 may be, for example, an operation by a proportional type controller operated by a worker at hand or an operation by a portable terminal device having a touch panel type display screen.

図示はしないが、走行機体1に、エンジンEの動力を、第一車輪2Aと第二車輪2Bに伝達すると共に、草刈装置3に伝達する伝動機構が備えられている。伝動機構は、第一車輪2A及び第二車輪2Bと、草刈装置3と、に対する動力伝達を断続できるように構成されている。エンジンEの動力が、第一車輪2A及び第二車輪2Bと、草刈装置3と、に伝達されることで、機体を走行させながら草刈作業を行うことができる。第一車輪2Aに第一操向モータ9Aが設けられ、第一車輪2Aは第一操向モータ9Aの駆動力により縦軸芯周りで揺動してステアリング操作自在なように構成されている。また、第二車輪2Bに第二操向モータ9Bが設けられ、第二車輪2Bは第二操向モータ9Bの駆動力により縦軸芯周りで揺動してステアリング操作自在なように構成されている。図2及び図3に示されているように、第一車輪2A及び第二車輪2Bは夫々、直進用姿勢、右向き揺動姿勢、並びに、左向き揺動姿勢の夫々に向き変更操作可能である。   Although not shown, the traveling body 1 is provided with a transmission mechanism that transmits the power of the engine E to the first wheel 2A and the second wheel 2B and also transmits the power to the mowing device 3. The power transmission mechanism is configured to be able to interrupt power transmission to the first wheel 2A, the second wheel 2B, and the mowing device 3. The power of the engine E is transmitted to the first wheel 2A, the second wheel 2B, and the mowing apparatus 3, so that mowing work can be performed while the vehicle is traveling. A first steering motor 9A is provided on the first wheel 2A, and the first wheel 2A is configured to swing around a longitudinal axis center by the driving force of the first steering motor 9A so as to be steerable. In addition, the second steering motor 9B is provided on the second wheel 2B, and the second wheel 2B is configured to swing around the longitudinal axis center by the driving force of the second steering motor 9B so that steering operation is possible. There is. As shown in FIG. 2 and FIG. 3, the first wheel 2A and the second wheel 2B can be changed in direction to a straight forward posture, a rightward swinging posture, and a leftward swinging posture, respectively.

走行機体1の前上部又は後上部に距離センサ10が備えられている。距離センサ10は、例えば、LRF(Laser Range Finder)であって、例えばレーザー光や超音波のような空中伝搬する信号を検出信号として送信する。検出信号が検出対象物に照射されると、検出信号は検出対象物の表面で反射する。そして、距離センサ10は、検出対象物の表面で反射した検出信号を、反射信号として取得する。つまり、距離センサ10は、距離センサ10の検出用範囲に向けて検出信号を送信し、かつ、検出信号に対する反射信号を取得する。そして、距離センサ10は、検出信号を送信してから反射信号を取得するまでの時間に基づいて、距離センサ10と検出対象物との距離を算出するように構成されている。距離センサ10が検出信号を送信し、かつ、反射信号を取得する処理を、以下「走査」と称する。なお、距離センサ10は、走行機体1の前部又は後部の何れか一方に設けられる構成であっても良いし、走行機体1の前部又は後部の両方に設けられる構成であっても良い。   A distance sensor 10 is provided on the front upper or rear upper portion of the traveling vehicle 1. The distance sensor 10 is, for example, an LRF (Laser Range Finder), and transmits, for example, a signal propagating in the air, such as a laser beam or an ultrasonic wave, as a detection signal. When the detection signal is irradiated to the detection target, the detection signal is reflected on the surface of the detection target. Then, the distance sensor 10 acquires a detection signal reflected by the surface of the detection target as a reflection signal. That is, the distance sensor 10 transmits a detection signal toward the detection range of the distance sensor 10, and acquires a reflection signal with respect to the detection signal. The distance sensor 10 is configured to calculate the distance between the distance sensor 10 and the detection target based on the time from the transmission of the detection signal to the acquisition of the reflection signal. The process in which the distance sensor 10 transmits a detection signal and acquires a reflection signal is hereinafter referred to as “scanning”. The distance sensor 10 may be provided at either the front or the rear of the traveling body 1 or may be provided at both the front or the rear of the traveling body 1.

傾斜角度検出部11が走行機体1に備えられ、傾斜角度検出部11は、例えば慣性センサの一例であるIMU(Inertial Measurement Unit)であって、走行機体1の傾きを検出して検出傾斜角度Imを出力する。   The inclination angle detection unit 11 is provided in the traveling body 1 and the inclination angle detection unit 11 is, for example, an IMU (Inertial Measurement Unit), which is an example of an inertial sensor, and detects an inclination of the traveling body 1 to detect a detection inclination angle Im. Output

〔制御構成について〕
図4に示されているように、草刈機の自動走行を可能にするための制御ユニットUが、例えばマイクロコンピュータに組み込まれた状態で、草刈機に備えられている。制御ユニットUに、デコード制御部12と、走行モード判定部13と、物体検出部14と、目標距離算出部15と、走行指示部16と、が備えられている。デコード制御部12は、距離センサ10の走査によって算出された距離と、当該算出時の走査角度と、に基づいて、距離センサ10に対する機体左右方向の水平距離と、距離センサ10に対する機体上下方向の垂直距離と、を座標位置情報として算出する。制御ユニットUは、自動制御モードと手動制御モードとに切替可能なように構成され、走行モード判定部13の判定によって、自動制御モードと手動制御モードとの何れであるかが判定される。
[About control configuration]
As shown in FIG. 4, a control unit U for enabling the automatic travel of the mower is provided in the mower, for example, in a state of being incorporated in a microcomputer. The control unit U is provided with a decode control unit 12, a travel mode determination unit 13, an object detection unit 14, a target distance calculation unit 15, and a travel instruction unit 16. The decode control unit 12 determines the horizontal distance between the distance sensor 10 in the lateral direction of the vehicle and the vertical direction of the distance sensor 10 based on the distance calculated by the scanning of the distance sensor 10 and the scanning angle at the time of calculation. The vertical distance is calculated as coordinate position information. The control unit U is configured to be switchable between an automatic control mode and a manual control mode, and the determination of the traveling mode determination unit 13 determines which of the automatic control mode and the manual control mode.

物体検出部14は、詳細について後述するが、座標位置情報に基づいて刈取後の地面を近似直線(近似線)で表す地面基準線LGと、刈取前の草のラインを近似直線で表す草基準線LKと、を生成する。物体検出部14に記憶部14aが備えられ、記憶部14aは、例えばRAM(Random Access Memory)であって、デコード制御部12によって算出された座標位置情報を経時的に記憶する。地面基準線LG及び草基準線LKの生成は、記憶部14aに記憶された座標位置情報を用いることによって行われる。   The object detection unit 14 will be described later in detail, but on the basis of coordinate position information, a ground reference line LG representing the ground after cutting by an approximate straight line (approximate line) and a grass reference representing the grass line before cutting off by an approximate straight line Generate a line LK. The object detection unit 14 is provided with a storage unit 14a, and the storage unit 14a is, for example, a random access memory (RAM), and temporally stores coordinate position information calculated by the decode control unit 12. Generation of the ground reference line LG and the grass reference line LK is performed by using coordinate position information stored in the storage unit 14a.

目標距離算出部15は、草基準線LKと距離センサ10との離間距離を算出する。また、目標距離算出部15は、走行機体1のうち、距離センサ10の位置する箇所が草基準線LKと離間しながら好適に草刈走行するための目標距離LMを算出する。そして、走行指示部16は、草基準線LKと距離センサ10との離間距離を、目標距離LMに保持するように制御信号を出力する。   The target distance calculation unit 15 calculates the distance between the grass reference line LK and the distance sensor 10. Further, the target distance calculation unit 15 calculates a target distance LM for appropriately mowing traveling while the portion where the distance sensor 10 is positioned in the traveling machine body 1 is separated from the grass reference line LK. Then, the travel instruction unit 16 outputs a control signal so as to hold the separation distance between the grass reference line LK and the distance sensor 10 at the target distance LM.

走行機体1に、送信機7から無線送信される操作信号を、アンテナ8を介して受信可能な通信部17が備えられている。通信部17の受信情報は制御ユニットUに入力される。手動制御モードでは、送信機7の人為操作に基づいて草刈走行等が行われる。このため、手動制御モードの状態で、走行指示部16は無効化されるが、走行指示部16と連動して物体検出部14及び目標距離算出部15も無効化される構成であっても良い。   The traveling body 1 is provided with a communication unit 17 capable of receiving an operation signal wirelessly transmitted from the transmitter 7 via the antenna 8. Information received by the communication unit 17 is input to the control unit U. In the manual control mode, mowing travel or the like is performed based on an artificial operation of the transmitter 7. For this reason, in the state of the manual control mode, the travel instruction unit 16 is invalidated, but the object detection unit 14 and the target distance calculation unit 15 may be invalidated in conjunction with the travel instruction unit 16 .

走行指示部16の出力対象は走行制御部Cであり、走行制御部Cに、走行制御モータ18と、前後進モータ19と、第一操向モータ9Aと、第二操向モータ9Bと、が備えられている。走行制御モータ18は、エンジンEに対する燃料供給量を調整するアクセル20と、第一車輪2A及び第二車輪2Bを制動するブレーキ21と、を操作する。前後進モータ19は、正逆転切換機構22を切り換え操作する。図示はしないが、正逆転切換機構22は、第一車輪2A及び第二車輪2BにエンジンEの動力を伝達する伝動装置に備えられ、エンジンEの動力を正転方向と逆転方向とに切換えるためのギア機構である。第一操向モータ9Aは第一車輪2Aを操向操作し、第二操向モータ9Bは第二車輪2Bを操向操作する。走行制御モータ18と、前後進モータ19と、の夫々は、電動モータであっても良いし、電磁スイッチであっても良い。   The output target of the travel instruction unit 16 is the travel control unit C, and the travel control unit C includes the travel control motor 18, the forward / backward advancing motor 19, the first steering motor 9A, and the second steering motor 9B. It is equipped. The travel control motor 18 operates an accelerator 20 that adjusts the amount of fuel supplied to the engine E, and a brake 21 that brakes the first wheel 2A and the second wheel 2B. The forward / reverse motor 19 switches the forward / reverse switching mechanism 22. Although not shown, the forward / reverse switching mechanism 22 is provided in a transmission that transmits the power of the engine E to the first wheel 2A and the second wheel 2B, and switches the power of the engine E between forward and reverse directions. Gear mechanism. The first steering motor 9A steers the first wheel 2A, and the second steering motor 9B steers the second wheel 2B. Each of the traveling control motor 18 and the forward and reverse motor 19 may be an electric motor or an electromagnetic switch.

走行モードが自動制御モードの場合、走行制御部Cは、走行指示部16の指示信号に基づく制御を行う。走行モードが手動制御モードの場合、送信機7の人為操作に基づく操作信号が、通信部17及び走行モード判定部13を介して走行制御部Cに入力され、走行制御部Cは、当該操作信号に基づく制御を行う。   When the traveling mode is the automatic control mode, the traveling control unit C performs control based on an instruction signal of the traveling instruction unit 16. When the traveling mode is the manual control mode, an operation signal based on a manual operation of the transmitter 7 is input to the traveling control unit C via the communication unit 17 and the traveling mode determination unit 13, and the traveling control unit C receives the operation signal Control based on

草刈機の状態は、通信部17から機体外部の機器に送信可能であり、例えば携帯端末機器の表示画面に、草刈機の現在位置や状態を表示することも可能である。草刈機の状態は、例えば、草刈走行の車速であったり、燃料の残量であったり、草刈機に搭載された各種機器の不具合を示すものであったりしても良い。   The state of the mowing machine can be transmitted from the communication unit 17 to a device outside the machine, and it is also possible to display the current position or state of the mowing machine, for example, on the display screen of the portable terminal device. The state of the mowing machine may be, for example, the vehicle speed of mowing travel, the remaining amount of fuel, or may indicate a malfunction of various devices mounted on the mowing machine.

〔未刈草の検出処理〕
図5に示されているように、草刈機が自動走行を伴って草刈作業を行うとき、距離センサ10は、走行機体1の機体前後方向を軸芯に回転しながら、機体左右両方に亘って走査を行う。即ち、地面及び未刈草(図5のGNで示された領域)の距離センサ10に対する離間距離が、距離センサ10の走査によって得られる。本実施形態では、距離センサ10による走査は、図5で示された反時計回りの回転で、走査角度Ssと走査角度Sfとに亘って270度の走査角度範囲で行われ、走査角度Ss及び走査角度Sfは、機体の真上に対して左右に夫々45度傾斜する。なお、走査角度Ss及び走査角度Sfの傾斜角度は、適宜変更可能であり、夫々同じ傾斜角度でなくても良い。
[Detection processing of uncut grass]
As shown in FIG. 5, when the mowing machine performs mowing work with automatic traveling, the distance sensor 10 rotates around the longitudinal axis of the traveling body 1 as the axial center, and spans both the left and right sides of the body Do a scan. That is, the distance between the ground and the uncut grass (area indicated by GN in FIG. 5) with respect to the distance sensor 10 is obtained by scanning of the distance sensor 10. In the present embodiment, the scan by the distance sensor 10 is performed in the scan angle range of 270 degrees over the scan angle Ss and the scan angle Sf by the counterclockwise rotation shown in FIG. The scan angle Sf is inclined 45 degrees to the left and right with respect to the upper side of the airframe, respectively. The inclination angles of the scanning angle Ss and the scanning angle Sf can be changed as appropriate, and may not be the same inclination angle.

距離センサ10の走査によって、距離センサ10の走査角度毎に、反射信号に基づく距離情報が取得される。デコード制御部12は、例えば三角関数を用いる等の方法によって、この走査角度及び距離情報を、距離センサ10に対する機体左右方向の水平距離と、距離センサ10に対する機体上下方向の垂直距離と、に変換する。これにより、距離センサ10の経時的な走査によって取得された距離情報は、二次元の座標位置情報に逐次変換され、当該座標位置情報の集合は、物体検出部14に備えられる記憶部14aに記憶される。   By the scanning of the distance sensor 10, distance information based on the reflection signal is acquired for each scanning angle of the distance sensor 10. The decoding control unit 12 converts this scanning angle and distance information into a horizontal distance with respect to the distance sensor 10 in the lateral direction of the machine and a vertical distance with respect to the distance sensor 10 in the vertical direction with respect to the distance sensor 10 Do. Thereby, the distance information acquired by the temporal scanning of the distance sensor 10 is sequentially converted into two-dimensional coordinate position information, and the set of the coordinate position information is stored in the storage unit 14a provided in the object detection unit 14 Be done.

二次元の座標位置情報の集合は、図6に示されるような波形として表され、この波形は、当該座標位置情報の集合に基づいてプロットされるデジタルの波形である。座標の中心は、距離センサ10の走査角度の回転軸中心である。座標の下側において左右方向に沿う波形は、刈取後の地面を示す地面ラインG1であり、座標の右側において上下方向に沿う波形は、未刈草を示す未刈草ラインG2である。これにより、未刈草ラインG2の地面ラインG1に対する対地高さデータが得られる。   A set of two-dimensional coordinate position information is represented as a waveform as shown in FIG. 6, which is a digital waveform plotted based on the set of coordinate position information. The center of the coordinates is the rotation axis center of the scanning angle of the distance sensor 10. A waveform along the horizontal direction below the coordinates is a ground line G1 indicating the ground after cutting, and a waveform along the vertical direction on the right of the coordinates is an uncut grass line G2 indicating uncut grass. Thereby, the ground height data to ground line G1 of uncut grass line G2 is obtained.

なお、図6では未刈草ラインG2が機体の側部よりも離れた状態で位置しているが、これは例示である。例えば、距離センサ10が走行機体1の前端部に位置する場合、機体前方に未刈草が存在することから、未刈草ラインG2が機体と重複する状態で位置することが考えられる。また、例えば距離センサ10が走行機体1の後端部に位置する場合、未刈草ラインG2が機体の横側部と接する状態で位置することが考えられる。   In addition, although uncut grass line G2 is located in the state which left | separated from the side part of the airframe in FIG. 6, this is an illustration. For example, when the distance sensor 10 is located at the front end of the traveling vehicle 1, it is conceivable that the unharvested grass line G2 is located so as to overlap the vehicle because uncut grass exists in front of the vehicle. Also, for example, when the distance sensor 10 is located at the rear end of the traveling vehicle 1, it is conceivable that the uncut grass line G2 is located in contact with the lateral side of the vehicle.

次に、未刈草を検知するための具体的な手順の例を図7に基づいて説明する。この手順では、走査角度Ssから走査が開始され、地面の走査を経て走査角度Sfで走査が完了するまでの一周期の走査の例を示しており、走査角度Ssから走査角度Sfまでの走査が繰り返し行われる。   Next, an example of a specific procedure for detecting uncut grass will be described based on FIG. In this procedure, an example of a scan of one cycle from the scan angle Ss to the start of the scan through the ground scan to the completion of the scan at the scan angle Sf is shown, and the scan from the scan angle Ss to the scan angle Sf is It will be repeated.

距離センサ10による走査が走査角度Ssから開始される(ステップ#1)。距離センサ10の走査角度が回転しながら走査が継続され(ステップ#2)、走査によって取得された距離情報は、走査が行われた時点の走査角度と紐付けられて、デコード制御部12によって二次元の座標位置情報に逐次変換される(ステップ#3)。ステップ#2の処理とステップ#3の処理とは、距離センサ10の走査角度が走査角度Sfに到達するまで継続する。   The scan by the distance sensor 10 is started from the scan angle Ss (step # 1). The scanning is continued while the scanning angle of the distance sensor 10 is rotated (step # 2), and the distance information acquired by the scanning is linked with the scanning angle at the time the scanning is performed. It is sequentially converted into coordinate position information of a dimension (step # 3). The process of step # 2 and the process of step # 3 continue until the scan angle of the distance sensor 10 reaches the scan angle Sf.

距離センサ10の走査角度が、刈取後の地面を判定するタイミングの走査角度Sg2(図8参照)に到達し、かつ、地面基準線LGが生成されていない状態であると(ステップ#4:Yes)、刈取後の地面のラインとして識別される地面基準線LGが、物体検出部14によって生成される(ステップ#5)。図8に示されているように、距離センサ10の走査角度Sg1と、距離センサ10の走査角度Sg2との間で対応する座標情報に基づく近似直線として、地面基準線LGが生成される。地面基準線LGから上下方向の距離d1,d2の範囲内にある座標位置情報は地面の座標位置情報(地面データ)として判別される。   If the scanning angle of distance sensor 10 reaches scanning angle Sg2 (see FIG. 8) at the timing of determining the ground after cutting, and ground reference line LG is not generated (step # 4: Yes) And the ground reference line LG identified as the ground line after cutting is generated by the object detection unit 14 (step # 5). As shown in FIG. 8, ground reference line LG is generated as an approximate straight line based on coordinate information corresponding between scan angle Sg1 of distance sensor 10 and scan angle Sg2 of distance sensor 10. Coordinate position information within a range of distances d1 and d2 in the vertical direction from the ground reference line LG is determined as coordinate position information (ground data) of the ground.

走査角度Sg1及び走査角度Sg2は、距離センサ10が走行機体1に対して機体鉛直下方(機体垂直下方)を向く走査角度Sbに対して左右対称に傾斜する。本実施形態では、走査角度Sg1及び走査角度Sg2は、走査角度Sbに対して左右に夫々10度傾くように構成されているが、この傾斜角度は適宜変更可能であり、例えば走行機体1の左右幅に亘る傾斜角度であっても良い。また、走査角度Sg1及び走査角度Sg2は、走査角度Sbに対して左右対称でなくても良い。   The scanning angle Sg1 and the scanning angle Sg2 are symmetrically inclined with respect to the scanning angle Sb in which the distance sensor 10 is directed vertically downward (vertically downward) to the traveling airframe 1. In the present embodiment, the scanning angle Sg1 and the scanning angle Sg2 are configured to be inclined by 10 degrees to the left and right with respect to the scanning angle Sb, but this inclination angle can be changed appropriately. It may be a tilt angle across the width. Further, the scanning angle Sg1 and the scanning angle Sg2 may not be symmetrical with respect to the scanning angle Sb.

地面基準線LGから上下方向の距離d1,d2は、例えば夫々十センチメートルに設定されているが、この値は適宜変更可能である。また、距離d1,d2は、同じ値でなくても良い。   The distances d1 and d2 in the vertical direction from the ground reference line LG are set, for example, to 10 centimeters, respectively, but this value can be changed as appropriate. Further, the distances d1 and d2 may not be the same value.

地面基準線LGの生成が完了すると、刈取後の地面に対する未刈草の算出傾斜角度θ2が物体検出部14によって算出される(ステップ#6)。刈取後の地面の傾斜角度θ1は、傾斜角度検出部11によって出力される検出傾斜角度Imに基づいて算出される。傾斜角度θ1は、検出傾斜角度Imの瞬時測定値であっても良いし、周期的に出力された過去複数個の検出傾斜角度Imの平均値であっても良い。図9に示されているように、一般的に、未刈草は傾斜地であっても鉛直方向に沿って上方に生えることが知られており、刈取後の地面に対する未刈草の算出傾斜角度θ2は、下記の式で算出される。   When the generation of the ground reference line LG is completed, the object detection unit 14 calculates the calculated inclination angle θ2 of the uncut grass with respect to the ground after cutting (step # 6). The inclination angle θ1 of the ground after cutting is calculated based on the detected inclination angle Im output by the inclination angle detection unit 11. The inclination angle θ1 may be an instantaneous measurement value of the detected inclination angle Im, or may be an average value of a plurality of detected inclination angles Im periodically output. As shown in FIG. 9, it is generally known that uncut grass grows upward along the vertical direction even on slopes, and the calculated inclination angle θ2 of uncut grass with respect to the ground after cutting is , It is calculated by the following equation.

算出傾斜角度θ2=90°−θ1   Calculated inclination angle θ2 = 90 ° -θ1

距離センサ10の走査は継続し、物体検出部14は、距離センサ10の走査に基づく座標位置情報が、草の座標位置情報(草データ)であるかどうかを判定する(ステップ#7)。本実施形態では、地面基準線LGから上下方向の距離d1,d2の範囲内にある座標位置情報は、地面データとして判別される。このため、物体検出部14は、距離d1,d2の範囲から外れた座標位置情報を、草データとして判定する。つまり、物体検出部14は、地面基準線LGから一定値以上の高さの座標位置情報を、草データとして判定する。   The scanning of the distance sensor 10 continues, and the object detection unit 14 determines whether the coordinate position information based on the scanning of the distance sensor 10 is grass coordinate position information (grass data) (step # 7). In the present embodiment, coordinate position information within the range of the distances d1 and d2 in the vertical direction from the ground reference line LG is determined as ground data. Therefore, the object detection unit 14 determines coordinate position information deviated from the ranges of the distances d1 and d2 as grass data. That is, the object detection unit 14 determines coordinate position information having a height equal to or more than a predetermined value from the ground reference line LG as grass data.

誤検出を防止するため、草データが予め設定された個数に亘って、連続して検出されるかどうかが、物体検出部14によって判定される(ステップ#8)。草データが予め設定された個数に亘って、連続して検出されると(ステップ#8:Yes)、物体検出部14は、当該草データに基づいて草候補線Lcを生成する(ステップ#9)。つまり、草候補線Lcとして生成される草データは、該当データが一定範囲以上に亘って連続する箇所の草データに限定される。草候補線Lcの生成の可否を判定する連続検出個数は、天候や季節や未刈草の種類に対応して適宜変更可能である。距離センサ10の走査角度が走査角度Sfに到達するまで、物体検出部14は、草候補線Lcを複数生成する。図10において、草候補線Lcは、地面基準線LGの位置する側に最も近い草候補線Lc(1)から、地面基準線LGの位置する側から最も遠い草候補線Lc(4)まで、四個の草候補線Lcが生成された状態が示されている。物体検出部14が草候補線Lcを生成する個数は、適宜変更可能である。   In order to prevent erroneous detection, it is determined by the object detection unit 14 whether or not grass data is continuously detected over a preset number of pieces (step # 8). If the grass data is continuously detected over the preset number (Step # 8: Yes), the object detection unit 14 generates a grass candidate line Lc based on the grass data (Step # 9). ). That is, the grass data generated as the grass candidate line Lc is limited to grass data of a portion where the corresponding data continues over a predetermined range or more. The continuously detected number for determining whether or not to generate the grass candidate line Lc can be appropriately changed according to the weather, the season, and the type of uncut grass. The object detection unit 14 generates a plurality of grass candidate lines Lc until the scanning angle of the distance sensor 10 reaches the scanning angle Sf. In FIG. 10, the grass candidate line Lc is from the grass candidate line Lc (1) closest to the ground reference line LG side to the grass candidate line Lc (4) farthest from the ground reference line LG side A state in which four grass candidate lines Lc are generated is shown. The number of object detection units 14 for generating the grass candidate line Lc can be changed as appropriate.

距離センサ10の走査角度が走査角度Sg2に到達すると(ステップ#10:Yes)、距離センサ10の走査が完了する。その後、物体検出部14は、ステップ#10の処理とステップ#11との処理を繰り返す。つまり、夫々の草候補線Lcの、地面基準線LGに対する傾斜角度(以下、「相対角度θ」と称する)を算出する(ステップ#11)。そして、物体検出部14は相対角度θと算出傾斜角度θ2とを比較する(ステップ#12)。相対角度θが、算出傾斜角度θ2から予め設定された基準範囲内であれば(ステップ#12:一致判定)、物体検出部14は、該当する草候補線Lcを草基準線LKして確定する(ステップ#13)。図11において、草候補線Lc(2)に基づく草基準線LKが示されている。この場合、地面基準線LGに対する草候補線Lc(2)の相対角度θが、算出傾斜角度θ2から予め設定された範囲内に収まっていることが、物体検出部14によって判定され、草候補線Lcが、草基準線LKして確定する。これにより、草基準線LKが物体検出部14によって特定される。   When the scanning angle of the distance sensor 10 reaches the scanning angle Sg2 (step # 10: Yes), the scanning of the distance sensor 10 is completed. Thereafter, the object detection unit 14 repeats the process of step # 10 and the process of step # 11. That is, the inclination angle (hereinafter referred to as “relative angle θ”) of each of the grass candidate lines Lc with respect to the ground reference line LG is calculated (step # 11). Then, the object detection unit 14 compares the relative angle θ with the calculated inclination angle θ2 (step # 12). If the relative angle θ is within a reference range preset from the calculated inclination angle θ2 (step # 12: coincidence determination), the object detection unit 14 determines the corresponding grass candidate line Lc as the grass reference line LK. (Step # 13). In FIG. 11, a grass reference line LK based on the grass candidate line Lc (2) is shown. In this case, it is determined by the object detection unit 14 that the relative angle θ of the grass candidate line Lc (2) with respect to the ground reference line LG falls within the range set in advance from the calculated inclination angle θ2. Lc is determined by the grass reference line LK. Thereby, the grass reference line LK is specified by the object detection unit 14.

このとき、物体検出部14は、複数の草候補線Lcのうち、算出傾斜角度θ2から予め設定された範囲内に相対角度θが収まっていることが最初に判定された草候補線Lcを、草基準線LKして確定する構成であっても良い。また、物体検出部14は、全ての草候補線Lcの地面基準線LGに対する相対角度θを算出し、算出傾斜角度θ2に最も近似する相対角度θを有する草候補線Lcを、草基準線LKして確定する構成であっても良い。   At this time, the object detection unit 14 selects one of the plurality of grass candidate lines Lc, the grass candidate line Lc which is first determined that the relative angle θ falls within the range set in advance from the calculated inclination angle θ2, It may be configured to be determined by the grass reference line LK. Further, the object detection unit 14 calculates the relative angle θ of all the grass candidate lines Lc with respect to the ground reference line LG, and the grass candidate line Lc having the relative angle θ most approximate to the calculated inclination angle θ2 is the grass reference line LK. It may be configured to be determined.

草基準線LKの確定後、目標距離算出部15は、地面基準線LGと草基準線LKとの交点Sを算出する。そして、交点Sと距離センサ10との離間距離を算出し、交点Sと走行機体1との離間距離のうち、走行機体1の草刈走行に好適な目標距離LMを算出する(ステップ#14)。走行機体1の草刈走行に好適な目標距離LMは、地面の傾斜角度や未刈草の種類や高さ、走行機体1における距離センサ10の取付位置、走行機体1の前進方向等に基づいて決定できる。   After the determination of the grass reference line LK, the target distance calculation unit 15 calculates an intersection point S between the ground reference line LG and the grass reference line LK. Then, the separation distance between the intersection point S and the distance sensor 10 is calculated, and among the separation distances between the intersection point S and the traveling body 1, a target distance LM suitable for mowing the traveling body 1 is calculated (step # 14). The target distance LM suitable for mowing the traveling body 1 can be determined based on the inclination angle of the ground and the type and height of uncut grass, the mounting position of the distance sensor 10 in the traveling body 1, the forward direction of the traveling body 1, etc. .

このように、距離センサ10の走査角度が一回転する毎に、ステップ#1乃至ステップ#14の処理が周期的に行われる。また、目標距離LMは、毎回のばらつきを抑制するため、過去複数回に亘って周期的に算出された過去複数個の目標距離の移動平均値に基づいて目標距離LMを算出するように構成されていても良い。   As such, each time the scanning angle of the distance sensor 10 makes one rotation, the processes of steps # 1 to # 14 are periodically performed. Further, the target distance LM is configured to calculate the target distance LM based on the moving average value of a plurality of past target distances periodically calculated over a plurality of past times in order to suppress the variation of each time. May be

〔別実施形態〕
本発明は、上述の実施形態に例示された構成に限定されるものではなく、以下、本発明の代表的な別実施形態を例示する。
[Another embodiment]
The present invention is not limited to the configuration exemplified in the above-described embodiment, and hereinafter, another representative embodiment of the present invention will be illustrated.

〔1〕上述した実施形態において、物体検出部14は、距離センサ10の走査角度が走査角度Sfに到達するまで、草候補線Lcを複数生成するように構成されているが、上述した実施形態に限定されない。例えば、草データの地面基準線LGに対する対地高さが、予め設定された高さよりも高い場合、物体検出部14は、当該草データに基づいて草候補線Lcを生成しないように構成されていても良い。未刈草の上端箇所は、風等に揺れやすいことから、この構成によって、風等の外乱による草の誤検出を防止できる。 [1] In the embodiment described above, the object detection unit 14 is configured to generate a plurality of grass candidate lines Lc until the scanning angle of the distance sensor 10 reaches the scanning angle Sf, but the embodiment described above It is not limited to. For example, if the ground height of the grass data with respect to the ground reference line LG is higher than a preset height, the object detection unit 14 is configured not to generate the grass candidate line Lc based on the grass data. Also good. Since the upper end portion of the uncut grass is easily shaken by wind or the like, this configuration can prevent erroneous detection of grass due to disturbance such as wind.

〔2〕上述した実施形態において、物体検出部14は、草データに基づいて草候補線Lcを生成するように構成されているが、上述した実施形態に限定されない。例えば、図12に示されているように、草データが予め設定された個数に亘って、連続して検出されると、物体検出部14は、当該草データは草基準線LKを生成するための候補データKcとして複数記憶される構成であっても良い。つまり、候補データKcは二次元の座標位置情報の集合であり、距離センサ10の走査角度が走査角度Sfに到達するまで、草基準線LKの候補データKcが複数記憶される。なお、候補データKcの記憶の可否を判定する連続検出個数は、天候や季節や未刈草の種類に対応して適宜変更可能である。複数の候補データKcの組合せに基づいて、近似直線である草候補線Lcを生成する構成であっても良い。 [2] In the embodiment described above, the object detection unit 14 is configured to generate the grass candidate line Lc based on the grass data, but is not limited to the embodiment described above. For example, as shown in FIG. 12, when the grass data is continuously detected over a preset number of objects, the object detection unit 14 generates the grass reference line LK for the grass data. A plurality of candidate data Kc may be stored. That is, the candidate data Kc is a set of two-dimensional coordinate position information, and a plurality of candidate data Kc of the grass reference line LK are stored until the scanning angle of the distance sensor 10 reaches the scanning angle Sf. In addition, the continuously detected number which determines the decision | availability of storage of candidate data Kc can be suitably changed according to the weather, the season, and the kind of uncut grass. The grass candidate line Lc which is an approximate straight line may be generated based on a combination of a plurality of candidate data Kc.

例えば、図12において、候補データKc(1)〜Kc(6)が記憶されている。草候補線Lc(1)は候補データKc(1)及び候補データKc(2)の組合せに基づいて生成されている。草候補線Lc(2)は候補データKc(2)及び候補データKc(3)の組合せに基づいて生成されている。草候補線Lc(3)〜Lc(5)も、草候補線Lc(1)及び草候補線Lc(2)と同様のパターンで生成されている。そして、夫々の草候補線Lcにおいて地面基準線LGに対する相対角度θを算出し、相対角度θが算出傾斜角度θ2から予め設定された範囲内であれば、当該草候補線Lcを草基準線LKとして確定する構成であっても良い。草候補線Lcの生成において候補データKcの組合せは適宜変更可能である。例えば、相対角度θが算出傾斜角度θ2から予め設定された範囲内でなければ、複数の候補データKcの組合せをやり直し、新たな組合せに基づいて草候補線Lcを生成する構成であっても良い。   For example, in FIG. 12, candidate data Kc (1) to Kc (6) are stored. The grass candidate line Lc (1) is generated based on the combination of the candidate data Kc (1) and the candidate data Kc (2). The grass candidate line Lc (2) is generated based on the combination of the candidate data Kc (2) and the candidate data Kc (3). The grass candidate lines Lc (3) to Lc (5) are also generated in the same pattern as the grass candidate line Lc (1) and the grass candidate line Lc (2). Then, the relative angle θ with respect to the ground reference line LG is calculated in each of the candidate grass lines Lc, and if the relative angle θ is within the range preset from the calculated inclination angle θ2, the relevant grass candidate line Lc is used as the grass reference line LK. It may be determined as The combination of candidate data Kc can be appropriately changed in the generation of the grass candidate line Lc. For example, if the relative angle θ is not within the range preset from the calculated inclination angle θ2, the combination of a plurality of candidate data Kc may be redone, and the grass candidate line Lc may be generated based on the new combination. .

〔3〕上述した実施形態において、距離センサ10は走行機体1の前上部又は後上部に備えられているが、上述した実施形態に限定されない。例えば、距離センサ10は、図13に示されているように、走行機体1の前上部に設けられる距離センサ10aと、走行機体1の後上部に設けられる距離センサ10bと、の二箇所に備えられる構成であっても良い。図13のGNは未刈草である。また、距離センサ10a及び距離センサ10bが、走行機体1の左右方向側端部に設けられる構成であっても良い。草刈走行が行われる前の地面と、未刈草GNと、が走行機体1の前部に設けられた距離センサ10aによって走査される。また、草刈走行が行われた後の地面と、未刈草GNと、が走行機体1の後部に設けられた距離センサ10bによって走査される。この構成であれば、走行機体1の前後で、夫々異なる目標距離LMを独立して算出可能となるため、走行指示部16が出力する指示信号を、一層好適なものにできる。また、図13における草刈走行のときに、距離センサ10aによって、例えば石や杭が検知された場合、草刈装置3の回転を停止する等の対処が可能になる。 [3] In the embodiment described above, the distance sensor 10 is provided on the front upper portion or the rear upper portion of the traveling body 1, but is not limited to the above-described embodiment. For example, as shown in FIG. 13, the distance sensor 10 is provided at two places of a distance sensor 10 a provided in the front upper part of the traveling machine body 1 and a distance sensor 10 b provided in the rear upper part of the traveling machine body 1. May be configured. GN in FIG. 13 is uncut grass. Further, the distance sensor 10 a and the distance sensor 10 b may be provided at the lateral end of the traveling machine body 1. The ground before the mowing travel is performed and the uncut grass GN are scanned by the distance sensor 10 a provided at the front of the traveling airframe 1. Further, the ground after the mowing travel and the uncut grass GN are scanned by the distance sensor 10 b provided at the rear of the traveling body 1. With this configuration, it is possible to independently calculate different target distances LM before and after the traveling machine body 1, so that the instruction signal output by the traveling instruction unit 16 can be made more suitable. Further, when, for example, a stone or a pile is detected by the distance sensor 10 a during mowing travel in FIG. 13, measures such as stopping the rotation of the mowing device 3 can be taken.

〔4〕上述した実施形態において、図7に示されたステップ#1からステップ#14までの手順で目標距離LMが算出されるように構成されているが、上述した実施形態に限定されない。例えば、走査角度Ssから走査角度Sfまで270度に亘る走査が行われた後に(ステップ#1〜ステップ#3)、地面基準線LGの生成(ステップ#5)と算出傾斜角度θ2の算出(ステップ#6)とが行われ、その後に草データの検出に基づく草候補線Lcの生成(ステップ#7〜ステップ#9)と、相対角度θの算出処理(ステップ#11)から目標距離LMの算出(ステップ#14)までの処理が行われる構成であっても良い。この構成であれば、例えば走査角度が走査角度Sfから走査角度Ssに向けて逆方向に回転する場合にも適用可能である。 [4] In the embodiment described above, the target distance LM is calculated by the procedure from step # 1 to step # 14 shown in FIG. 7, but it is not limited to the embodiment described above. For example, after a scan ranging from 270 degrees from scan angle Ss to scan angle Sf is performed (steps # 1 to # 3), generation of ground reference line LG (step # 5) and calculation of calculated inclination angle θ2 (steps) After step # 6) is performed, the generation of the grass candidate line Lc based on the detection of grass data (steps # 7 to # 9) and the process of calculating the relative angle θ (step # 11) are used to calculate the target distance LM. The configuration may be such that the processing up to (step # 14) is performed. This configuration is also applicable to, for example, the case where the scan angle rotates in the reverse direction from the scan angle Sf toward the scan angle Ss.

〔5〕上述した実施形態において、地面基準線LGと、草候補線Lcと、草基準線LKと、は夫々近似直線となっているが、上述した実施形態に限定されない。例えば、地面基準線LGと、草候補線Lcと、草基準線LKと、は夫々近似曲線であっても良い。 [5] In the embodiment described above, the ground reference line LG, the grass candidate line Lc, and the grass reference line LK are respectively approximate straight lines, but the present invention is not limited to the embodiment described above. For example, the ground reference line LG, the grass candidate line Lc, and the grass reference line LK may be approximate curves.

〔6〕上述の実施形態では、草刈機が草刈りを行いながら自動走行するとして説明したが、例えば、手動操作による草刈走行の操向操作をアシストする草刈機であっても良い。また、草刈機以外に、芝刈機やモアであっても良い。 [6] In the above embodiment, the mowing machine travels automatically while mowing, but it may be, for example, a mowing machine that assists steering operation of mowing travel by manual operation. Besides the mower, it may be a mower or mower.

本発明は、草刈対象領域を草刈走行する草刈機に適用可能である。   The present invention is applicable to a mowing machine that mowing the mowing target area.

1 :走行機体
10 :距離センサ
12 :デコード制御部
13 :走行モード判定部
14 :物体検出部
15 :目標距離算出部
16 :走行指示部
C :走行制御部
Im :検出傾斜角度
LG :地面基準線
Lc :草候補線
LK :草基準線
LM :目標距離
θ :相対角度(傾斜角度)
θ2 :算出傾斜角度
1: traveling vehicle 10: distance sensor 12: decode control unit 13: traveling mode determination unit 14: object detection unit 15: target distance calculation unit 16: traveling instruction unit C: traveling control unit Im: detection inclination angle LG: ground reference line Lc: Grass candidate line LK: Grass reference line LM: Target distance θ: Relative angle (tilt angle)
θ2: Calculated inclination angle

Claims (10)

草刈走行を行う走行機体と、
前記走行機体を制御する走行制御部と、
前記走行機体と、機体左右方向に位置する物体と、の距離を、機体左右両方に亘って走査する距離センサと、
前記距離センサの走査によって検出された距離及び走査角度に基づいて、機体左右両方に亘る対地高さデータを生成するデコード制御部と、
前記対地高さデータに基づく近似線によって、刈取後の地面のラインとして識別される地面基準線と、刈取前の草のラインとして識別される草基準線と、を生成する物体検出部と、
前記草基準線と前記走行機体との距離に基づいて目標距離を算出する目標距離算出部と、
前記草基準線と前記走行機体との距離が、前記目標距離と一致するように指示信号を出力する走行指示部と、
が備えられている草刈機。
A traveling vehicle that carries out mowing traveling,
A traveling control unit that controls the traveling aircraft body;
A distance sensor for scanning the distance between the traveling body and an object located in the left and right direction of the body across both the left and right sides of the body;
A decoding control unit that generates ground height data for both the left and right of the vehicle based on the distance and scanning angle detected by the scanning of the distance sensor;
An object detection unit that generates a ground reference line identified as a ground line after cutting and a grass reference line identified as a grass line before cutting according to the approximation line based on the ground height data;
A target distance calculation unit that calculates a target distance based on the distance between the grass reference line and the traveling airframe;
A travel instruction unit that outputs an instruction signal such that the distance between the grass reference line and the traveling body matches the target distance;
A mower equipped with
前記走行機体の走行モードを判定する走行モード判定部が備えられ、
前記走行モードは、手動制御モードと、自動制御モードと、を有し、
前記走行モードが前記手動制御モードの場合、前記走行制御部は手動制御の操作信号に基づいて前記走行機体を制御し、
前記走行モードが前記自動制御モードの場合、前記走行制御部は前記走行指示部の指示信号に基づいて前記走行機体を制御する請求項1に記載の草刈機。
A traveling mode determination unit that determines a traveling mode of the traveling aircraft body;
The travel mode has a manual control mode and an automatic control mode,
When the traveling mode is the manual control mode, the traveling control unit controls the traveling machine based on an operation signal of manual control,
The mowing machine according to claim 1, wherein when the traveling mode is the automatic control mode, the traveling control unit controls the traveling machine body based on an instruction signal of the traveling instruction unit.
前記距離センサは、機体前後方向を軸芯に回転することによって走査するように構成されている請求項1又は2に記載の草刈機。   The mowing machine according to claim 1 or 2, wherein the distance sensor is configured to scan by rotating around a longitudinal axis of the machine body. 前記距離センサは、前記走行機体の前部又は後部の何れか一方に設けられている請求項1から3の何れか一項に記載の草刈機。   The mowing machine according to any one of claims 1 to 3, wherein the distance sensor is provided at one of a front part and a rear part of the traveling body. 前記距離センサは、前記走行機体の前部及び後部の両方に設けられている請求項1から3の何れか一項に記載の草刈機。   The mowing machine according to any one of claims 1 to 3, wherein the distance sensor is provided at both the front and the rear of the traveling body. 前記物体検出部は、前記対地高さデータのうち、前記距離センサの機体鉛直下方から予め設定された機体左右方向の範囲内のデータから近似線を算出することによって、前記地面基準線を生成するように構成されている請求項1から5の何れか一項に記載の草刈機。   The object detection unit generates the ground reference line by calculating an approximate line from data in the range in the left-right direction of the aircraft which is preset from the vertical direction of the distance sensor among the ground height data. A mower according to any one of the preceding claims, wherein the mower is configured as follows. 前記物体検出部は、前記対地高さデータのうち、前記地面基準線から一定値以上の高さを有するデータが一定範囲以上に亘って連続する箇所のデータから近似線を算出することによって、草候補線を生成するように構成されている請求項1から6の何れか一項に記載の草刈機。   The object detection unit calculates grass by calculating an approximation line from data of a location where data having a height greater than or equal to a predetermined value from the ground reference line in the ground height data continues over a predetermined range or more. 7. A mowing machine according to any one of the preceding claims, which is configured to generate candidate lines. 前記草候補線は、複数生成され、
前記走行機体に、前記走行機体の傾斜角度を検出する慣性センサが備えられ、
前記物体検出部は、前記草候補線のうち、前記草候補線の前記地面基準線に対する傾斜角度と、前記慣性センサによって検出された傾斜角度から算出された算出傾斜角度と、が予め定められた基準範囲内である一つの前記草候補線を、前記草基準線と特定するように構成されるように構成されている請求項7に記載の草刈機。
A plurality of grass candidate lines are generated,
The traveling body is provided with an inertial sensor that detects an inclination angle of the traveling body.
Among the grass candidate lines, the object detection unit predetermines an inclination angle of the grass candidate line with respect to the ground reference line and a calculated inclination angle calculated from the inclination angle detected by the inertial sensor. 8. A mowing machine according to claim 7, wherein the grass candidate line which is within the reference range is configured to be identified as the grass reference line.
前記草基準線は、前記地面基準線から予め設定された高さの範囲内に限定される請求項1から8の何れか一項に記載の草刈機。   The mowing machine according to any one of claims 1 to 8, wherein the grass reference line is limited within a height range preset from the ground reference line. 前記草基準線と前記走行機体との距離は、現在と過去複数回とに亘って算出された複数の値が記憶され、
前記目標距離は、前記複数の値の移動平均値に基づいて算出される請求項1から9の何れか一項に記載の草刈機。
As the distance between the grass reference line and the traveling vehicle, a plurality of values calculated over the present and a plurality of times in the past are stored,
The mowing machine according to any one of claims 1 to 9, wherein the target distance is calculated based on a moving average value of the plurality of values.
JP2017242687A 2017-12-19 2017-12-19 Mower Active JP6877327B2 (en)

Priority Applications (6)

Application Number Priority Date Filing Date Title
JP2017242687A JP6877327B2 (en) 2017-12-19 2017-12-19 Mower
US16/771,264 US11696525B2 (en) 2017-12-19 2018-12-19 Automatic travel work machine, automatic travel grass mower, grass mower, and grass mower automatic travel system
CN201880080844.8A CN111447827B (en) 2017-12-19 2018-12-19 Automatic traveling working machine, automatic traveling mower, and automatic traveling system for mower
EP18893078.8A EP3729937B1 (en) 2017-12-19 2018-12-19 Autonomous travel work machine
KR1020207016331A KR102457518B1 (en) 2017-12-19 2018-12-19 Automatic travel implement, automatic travel mower, mower and mower automatic travel system
PCT/JP2018/046872 WO2019124463A1 (en) 2017-12-19 2018-12-19 Automatic travel work machine, automatic travel grass mower, grass mower, and grass mower automatic travel system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017242687A JP6877327B2 (en) 2017-12-19 2017-12-19 Mower

Publications (2)

Publication Number Publication Date
JP2019106941A true JP2019106941A (en) 2019-07-04
JP6877327B2 JP6877327B2 (en) 2021-05-26

Family

ID=67178019

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017242687A Active JP6877327B2 (en) 2017-12-19 2017-12-19 Mower

Country Status (1)

Country Link
JP (1) JP6877327B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111707256A (en) * 2020-05-13 2020-09-25 苏州天炯信息科技有限公司 Comprehensive positioning navigation equipment for rapidly arranging special vehicle by aid of navigation lamp

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6332411A (en) * 1986-07-24 1988-02-12 井関農機株式会社 Direction control unit of combine
JP2000270607A (en) * 1999-03-25 2000-10-03 Kubota Corp Reaping harvester
US8275506B1 (en) * 2008-06-08 2012-09-25 Richard Anthony Bishel Boundary sensor
JP2016066207A (en) * 2014-09-24 2016-04-28 株式会社クボタ Automatic travel vehicle
JP2016189172A (en) * 2015-03-30 2016-11-04 株式会社クボタ Automatic traveling information management system
JP2016195546A (en) * 2013-09-30 2016-11-24 日立工機株式会社 Self-propelled mower

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6332411A (en) * 1986-07-24 1988-02-12 井関農機株式会社 Direction control unit of combine
JP2000270607A (en) * 1999-03-25 2000-10-03 Kubota Corp Reaping harvester
US8275506B1 (en) * 2008-06-08 2012-09-25 Richard Anthony Bishel Boundary sensor
JP2016195546A (en) * 2013-09-30 2016-11-24 日立工機株式会社 Self-propelled mower
JP2016066207A (en) * 2014-09-24 2016-04-28 株式会社クボタ Automatic travel vehicle
JP2016189172A (en) * 2015-03-30 2016-11-04 株式会社クボタ Automatic traveling information management system

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111707256A (en) * 2020-05-13 2020-09-25 苏州天炯信息科技有限公司 Comprehensive positioning navigation equipment for rapidly arranging special vehicle by aid of navigation lamp

Also Published As

Publication number Publication date
JP6877327B2 (en) 2021-05-26

Similar Documents

Publication Publication Date Title
CN111447827B (en) Automatic traveling working machine, automatic traveling mower, and automatic traveling system for mower
US8275506B1 (en) Boundary sensor
JP6638695B2 (en) Autonomous driving system
WO2020137135A1 (en) Obstacle detection system for work vehicle
JP6817183B2 (en) Self-driving mower
JP6562678B2 (en) Automated traveling vehicle
US20230052257A1 (en) Lawn mower robot and control method for same
JP7229303B2 (en) traveling work machine
JP7139492B2 (en) field work machine
US20200081440A1 (en) Autonomous travel cart and method of controlling travel thereof
JP6851589B2 (en) Work platform
JP2017046656A (en) Guide system for agricultural implement
JP2019106942A (en) Mower automatic travel system
JP2019106941A (en) Mower
JPWO2020065701A1 (en) Information processing equipment and mobile robots
JP6989886B2 (en) Work platform
JP6916544B2 (en) Guidance system for agricultural work machines
JP6884339B2 (en) Work platform
JP6309413B2 (en) Autonomous vehicle
JP2011145743A (en) Autonomous mobile robot system
JP6309412B2 (en) Autonomous vehicle
JP6275609B2 (en) Autonomous vehicle
JP2016063769A (en) Automatic travel vehicle
JP2016218504A (en) Movement device and movement system
JP6342764B2 (en) Autonomous vehicle

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20191225

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20201125

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20201201

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210106

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210427

R150 Certificate of patent or registration of utility model

Ref document number: 6877327

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150