JP2016063769A - Automatic travel vehicle - Google Patents

Automatic travel vehicle Download PDF

Info

Publication number
JP2016063769A
JP2016063769A JP2014194129A JP2014194129A JP2016063769A JP 2016063769 A JP2016063769 A JP 2016063769A JP 2014194129 A JP2014194129 A JP 2014194129A JP 2014194129 A JP2014194129 A JP 2014194129A JP 2016063769 A JP2016063769 A JP 2016063769A
Authority
JP
Japan
Prior art keywords
unit
reference line
target
vehicle
automatic traveling
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
JP2014194129A
Other languages
Japanese (ja)
Other versions
JP6376921B2 (en
Inventor
孝徳 小林
Takanori Kobayashi
孝徳 小林
田中　秀明
Hideaki Tanaka
秀明 田中
幸枝 相原
Yukie Aihara
幸枝 相原
和樹 福岡
Kazuki Fukuoka
和樹 福岡
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 JP2014194129A priority Critical patent/JP6376921B2/en
Publication of JP2016063769A publication Critical patent/JP2016063769A/en
Application granted granted Critical
Publication of JP6376921B2 publication Critical patent/JP6376921B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

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

Abstract

PROBLEM TO BE SOLVED: To provide an automatic travel vehicle capable of traveling automatically.SOLUTION: An automatic travel vehicle 1 includes: an object detection unit 11 detecting an object existing in a predetermined range; a target setting unit 12 setting at least two objects as target on the basis of the positions of the at least two objects out of the objects detected by the object detection unit 11; a reference line setting unit 13 setting a reference line passing the at least two objects set by the target setting unit 12 and serving as the reference in traveling; a distance calculation unit 14 calculating a distance from the reference line to a vehicle body; an outer diameter estimation unit 45 estimating an outer diameter of the object on the basis of the detection result of the object detection unit 11; and a travel control unit 16 allowing the vehicle to travel along the reference line in a predetermined section while keeping the distance within a predetermined range and avoiding contact to the object on the basis of the outer diameter.SELECTED DRAWING: Figure 3

Description

本発明は、自動で走行する自動走行車両に関する。   The present invention relates to an automatic traveling vehicle that automatically travels.

従来、車両の位置を検出する際に、ＧＰＳ（Global Positioning System）が用いられてきた。このようなＧＰＳでは所定の誤差が含まれていることから、例えば自動で車両を走行させる場合には、ＧＰＳは利用し難いものであった。そこで、車両を自動で走行させる際に利用する技術が検討されてきた（例えば特許文献１及び２）。   Conventionally, GPS (Global Positioning System) has been used to detect the position of a vehicle. Since such a GPS includes a predetermined error, it is difficult to use the GPS when, for example, the vehicle is driven automatically. Then, the technique utilized when driving a vehicle automatically has been examined (for example, patent documents 1 and 2).

特許文献１に記載の移動体の位置計測装置は、所定の座標軸上における移動体の位置及び走行方向を推定演算する推定演算手段と、移動体の予定走行路に沿って間欠的に配設された基準点に対する移動体の相対位置を検出する相対位置検出手段とを有して構成される。   The moving body position measuring device described in Patent Document 1 is provided intermittently along an estimated calculation means for estimating and calculating the position and traveling direction of the moving body on a predetermined coordinate axis, and along the scheduled traveling path of the moving body. And a relative position detecting means for detecting the relative position of the moving body with respect to the reference point.

また、特許文献２に記載の移動体の位置計測装置は、移動経路の周囲に配置された設置位置が既知の２個以上の反射手段を備え、移動体から反射手段に対して光等を投射して、その反射光等により移動体の進行方向と反射光等の入射角度との間の相対角度を計測する。また、移動体には当該移動体の進行方向に沿った走行距離を計測する計測手段と、移動体の進行方向を向きとして計測する計測手段とが備えられ、反射手段の設置位置、移動体から見た反射手段に対する現在及びそれより一定時間前の相対角度、一定時間前から現在に至るまでの移動体の位置の変位量と向きの変位量から、移動体の絶対位置及び向きを演算する。   In addition, the position measuring apparatus for a moving body described in Patent Document 2 includes two or more reflecting means whose installation positions are known around the moving path, and projects light or the like from the moving body to the reflecting means. Then, the relative angle between the traveling direction of the moving body and the incident angle of the reflected light or the like is measured by the reflected light or the like. In addition, the moving body is provided with measuring means for measuring the travel distance along the traveling direction of the moving body, and measuring means for measuring the traveling direction of the moving body as an orientation. The absolute position and orientation of the moving object are calculated from the relative angle of the current reflecting unit with respect to the observed reflection means and a relative amount of the moving object before and a displacement amount of the position of the moving object and a displacement amount of the direction from the predetermined time to the present.

特開平７−１５９１８７号公報JP-A-7-159187 特開平１１−２７１０４３号公報JP-A-11-271043

特許文献１に記載の技術では、予定走行路に沿って、予め光反射手段を設置しておく必要がある。また、特許文献２に記載の技術では、複数の反射板を予め設置しておき、当該設置位置を登録しておかなければならない。このため、特許文献１及び２に記載の技術では、移動体は予め光反射手段や反射板が設置されている場所でしか自動で走行することができない。   In the technique described in Patent Document 1, it is necessary to install light reflecting means in advance along the planned traveling path. In the technique described in Patent Document 2, a plurality of reflectors must be installed in advance and the installation positions must be registered. For this reason, in the techniques described in Patent Documents 1 and 2, the moving body can automatically travel only in a place where the light reflecting means and the reflecting plate are previously installed.

本発明の目的は、上記問題に鑑み、予め光反射手段や反射板が設置されていない場所であっても、自動で走行可能な自動走行車両を提供することにある。   In view of the above problems, an object of the present invention is to provide an automatic traveling vehicle capable of automatically traveling even in a place where a light reflecting means and a reflecting plate are not previously installed.

上記目的を達成するための本発明に係る自動走行車両の特徴構成は、予め設定された範囲に向けて検出信号を送信し、前記検出信号に対する反射信号を取得して、前記予め設定された範囲に存在する物体を検出する物体検出部と、前記物体検出部により検出された物体のうち、少なくとも２つの物体の位置に基づいて、当該少なくとも２つの物体を目標物として設定する目標物設定部と、前記目標物設定部により設定された少なくとも２つの目標物を通り、走行時の基準となる基準線を設定する基準線設定部と、前記基準線から車体までの距離を演算する距離演算部と、前記物体検出部の検出結果に基づき、前記物体の外径を推定する外径推定部と、前記距離を予め設定された範囲内に維持しつつ、予め設定された区画内において前記基準線に沿って走行させると共に、前記外径に基づき前記物体への接触を回避する走行制御部と、を備える点にある。   In order to achieve the above object, the characteristic configuration of the automatic traveling vehicle according to the present invention is such that a detection signal is transmitted toward a preset range, a reflection signal for the detection signal is acquired, and the preset range is obtained. An object detection unit for detecting an object existing in the object, and a target setting unit for setting the at least two objects as targets based on positions of at least two objects among the objects detected by the object detection unit; A reference line setting unit that sets a reference line that is a reference when traveling through at least two targets set by the target setting unit; and a distance calculation unit that calculates a distance from the reference line to the vehicle body. An outer diameter estimating unit that estimates an outer diameter of the object based on a detection result of the object detecting unit; and the reference line within a preset section while maintaining the distance within a preset range. Together to travel along, in that and a travel control unit to avoid contact with the object on the basis of the outer diameter.

このような特徴構成とすれば、物体検出部が物体を検出し、その検出結果に基づき目標物設定部が目標物を設定することができるので、自動走行車両を走行させる区画において、予め光反射手段や反射板等を設置しておかなくても自動走行することが可能となる。また、自動走行中に物体の外径を推定するので、当該外径に係る物体に接近し過ぎないようにすることができる。したがって、衝突を未然に回避することが可能となる。   With such a characteristic configuration, the object detection unit can detect an object, and the target setting unit can set the target based on the detection result. It is possible to automatically travel without installing means or a reflector. Further, since the outer diameter of the object is estimated during automatic traveling, it is possible to prevent the object related to the outer diameter from being too close. Therefore, it is possible to avoid a collision in advance.

また、前記目標物設定部は、前記物体検出部により検出された複数の物体のうち、予め設定された範囲内にある物体をグループ化して一つの目標物を設定すると好適である。   The target setting unit preferably sets a target by grouping objects within a preset range among a plurality of objects detected by the object detection unit.

このような構成とすれば、複数の物体で構成される一組の物体を一つの目標物として設定することができるので、基準線を略直線状に設定することが可能となる。したがって、自動走行車両を蛇行させることなく走行させることができる。また、目標物の設定に係る演算処理を軽減することも可能となる。   With such a configuration, a set of objects composed of a plurality of objects can be set as one target, so that the reference line can be set substantially linearly. Therefore, the automatic traveling vehicle can be driven without meandering. In addition, it is possible to reduce the arithmetic processing related to the setting of the target.

自動走行車両が走行する領域を示す図である。It is a figure which shows the area | region where a self-propelled vehicle drive | works. 自動走行車両を模式的に示した側面図である。It is the side view which showed the automatic traveling vehicle typically. 自動走行車両の自動走行に係る機能部を模式的に示したブロック図である。It is the block diagram which showed typically the function part which concerns on the automatic driving | running | working of an autonomous vehicle. 物体検出部の検出範囲を示す図である。It is a figure which shows the detection range of an object detection part. 物体のグループ化について示す模式図である。It is a schematic diagram shown about grouping of an object. 物体の外径推定に係る模式図である。It is a schematic diagram which concerns on the outer diameter estimation of an object. 自動走行車両の処理を示すフローチャートである。It is a flowchart which shows the process of an automatic traveling vehicle.

本発明に係る自動走行車両は、予め設定された区画内において目標物を設定し、当該目標物に基づいて自動で走行可能に構成される。以下、本実施形態の自動走行車両１について説明する。本実施形態では、自動走行車両１は、図１に示されるような果樹園Ｐに植えられている複数の樹木Ｋの間に生えている草を刈り取りながら自動走行するよう構成されている。この際、自動走行車両１は、果樹園Ｐの中央部では図１において一点鎖線Ａで示されるように樹木Ｋに沿って走行し、果樹園Ｐの進行方向の両端部では破線Ｂで示されるように前後進を繰り返して、自動走行車両１の位置を側方にずらすようにスイッチバックを行う。したがって、自動走行車両１は、果樹園Ｐの一方の端部から他方の端部に向って走行する場合と、果樹園Ｐの他方の端部から一方の端部に向って走行する場合とで進行方向を向く側が異なることになる。   The automatic traveling vehicle according to the present invention is configured such that a target is set in a preset section and can be automatically driven based on the target. Hereinafter, the automatic traveling vehicle 1 of the present embodiment will be described. In the present embodiment, the automatic traveling vehicle 1 is configured to automatically travel while cutting grass growing between a plurality of trees K planted in an orchard P as shown in FIG. At this time, the automatic traveling vehicle 1 travels along the tree K as indicated by a one-dot chain line A in FIG. 1 at the center of the orchard P, and is indicated by broken lines B at both ends in the traveling direction of the orchard P. As described above, the vehicle is switched back and forth so as to shift the position of the automatic traveling vehicle 1 to the side by repeatedly moving forward and backward. Accordingly, the automatic traveling vehicle 1 travels from one end of the orchard P toward the other end and when traveling from the other end of the orchard P toward one end. The side facing the direction of travel will be different.

図２には本実施形態の自動走行車両１の側面図が示される。図２に示されるように、自動走行車両１は、車輪２と走行機体３とを備えて構成される。車輪２は、車体の車長方向の一端側の第１車輪２Ａ、及び車長方向の他端側の第２車輪２Ｂから構成される。走行機体３には、自動走行車両１の動力源であるエンジン４、エンジン４に供給する燃料が備蓄されている燃料タンク５、エンジン４により駆動される発電機６、発電機６により発電された電力を蓄電し、自動走行車両１が有する電気機器に電力供給するバッテリ７、自動走行車両１の自動走行を制御する自動走行制御装置１０、バッテリ７から供給される電力に基づき第１車輪２Ａの操向操作を行う第１車輪操向操作機構５１、バッテリ７から供給される電力に基づき第２車輪２Ｂの操向操作を行う第２車輪操向操作機構５２、エンジン４の回転力が入力され、草刈りに使用する刈り刃５４を有する草刈装置５３、第１車輪２Ａ及び第２車輪２Ｂの少なくとも一方と草刈装置５３とへのエンジン４の回転力の断接を行う動力伝達機構５５を備えている。   FIG. 2 shows a side view of the automatic traveling vehicle 1 of the present embodiment. As shown in FIG. 2, the automatic traveling vehicle 1 includes a wheel 2 and a traveling machine body 3. The wheel 2 includes a first wheel 2A on one end side in the vehicle length direction of the vehicle body and a second wheel 2B on the other end side in the vehicle length direction. The traveling machine body 3 is generated by an engine 4 that is a power source of the automatic traveling vehicle 1, a fuel tank 5 that stores fuel to be supplied to the engine 4, a generator 6 that is driven by the engine 4, and the generator 6. A battery 7 that stores electric power and supplies electric power to the electric equipment of the automatic traveling vehicle 1, an automatic traveling control device 10 that controls automatic traveling of the automatic traveling vehicle 1, and the first wheel 2 </ b> A based on electric power supplied from the battery 7. The first wheel steering operation mechanism 51 that performs the steering operation, the second wheel steering operation mechanism 52 that performs the steering operation of the second wheel 2B based on the power supplied from the battery 7, and the rotational force of the engine 4 are input. A power transmission mechanism 55 for connecting and disconnecting the rotational force of the engine 4 to at least one of the first wheel 2A and the second wheel 2B and the mowing device 53, which has a mowing blade 54 used for mowing. Eteiru.

図３には、自動走行車両１の自動走行に係る機能部を示すブロック図が示される。自動走行車両１は、自動走行制御装置１０、第１車輪操向操作機構５１、第２車輪操向操作機構５２、動力伝達機構５５の各機能部を備えて構成される。自動走行制御装置１０は、物体検出部１１、目標物設定部１２、基準線設定部１３、距離演算部１４、走行範囲設定部１５、走行制御部１６、物体数設定部１７、物体計数部１８、判定部１９、外径推定部４５の各機能部を備えて構成され、各機能部は、自動走行車両１の自動走行に係る種々の処理を行うためにＣＰＵを中核部材としてハードウェア又はソフトウェア或いはその両方で構築されている。   FIG. 3 is a block diagram showing functional units related to the automatic traveling of the automatic traveling vehicle 1. The automatic traveling vehicle 1 includes the automatic traveling control device 10, a first wheel steering operation mechanism 51, a second wheel steering operation mechanism 52, and a power transmission mechanism 55. The automatic travel control device 10 includes an object detection unit 11, a target setting unit 12, a reference line setting unit 13, a distance calculation unit 14, a travel range setting unit 15, a travel control unit 16, an object number setting unit 17, and an object counting unit 18. The determination unit 19 and the outer diameter estimation unit 45 are configured to include each function unit, and each function unit is a hardware or software having a CPU as a core member for performing various processes related to the automatic traveling of the autonomous vehicle 1. Or both.

物体検出部１１は、予め設定された範囲に向けて検出信号を送信し、当該検出信号に対する反射信号を取得して、当該予め設定された範囲に存在する物体を検出する。予め設定された範囲とは物体検出部１１の検出可能な範囲であり、本実施形態では図４に示されるような自動走行車両１を中心とする約２７０度の範囲Ｒである。検出信号とはレーザーや光や超音波等のように空中伝搬する信号である。このような検出信号は、物体に衝突すると反射される。物体検出部１１は、検出信号を予め設定された範囲に送信し、衝突によって生じる反射信号を取得する。物体検出部１１は、検出信号の送信方向に基づいて物体検出部１１を基準とした物体が存在する方向を示す情報と、検出信号を送信してから反射信号を取得するまでの時間に基づいて演算した物体検出部１１から物体までの距離を示す情報とを取得する。本実施形態では、物体検出部１１は水平方向に、且つ、上述した範囲Ｒに対して例えば０．５度ピッチで検出信号を送信する。   The object detection unit 11 transmits a detection signal toward a preset range, acquires a reflection signal with respect to the detection signal, and detects an object existing in the preset range. The preset range is a range that can be detected by the object detection unit 11, and in the present embodiment, is a range R of about 270 degrees centering on the automatic traveling vehicle 1 as shown in FIG. The detection signal is a signal that propagates in the air, such as a laser, light, or ultrasonic wave. Such a detection signal is reflected when it collides with an object. The object detection unit 11 transmits a detection signal to a preset range and acquires a reflection signal generated by the collision. The object detection unit 11 is based on information indicating the direction in which an object is present with reference to the object detection unit 11 based on the transmission direction of the detection signal, and the time from when the detection signal is transmitted until the reflection signal is acquired. Information indicating the calculated distance from the object detection unit 11 to the object is acquired. In the present embodiment, the object detection unit 11 transmits detection signals in the horizontal direction and at a pitch of, for example, 0.5 degrees with respect to the range R described above.

上述したように本実施形態では、物体検出部１１が検出する範囲Ｒは自動走行車両１を中心とした全周囲のうち約２７０度の範囲である。そこで、自動走行車両１は図４に示されるように、自動走行車両１が紙面上側の方向に向って走行する場合には進行方向を見て左側を検出し、自動走行車両１が紙面下側の方向に向って走行する場合には進行方向を見て右側を検出するよう構成されている。このように物体検出部１１は、自動走行車両１の片側に存在する物体を検出する。自動走行車両１の片側とは、本実施形態では、図４において車長延長線Ｓよりも左側をいう。もちろん、自動走行車両１が紙面上側の方向に向って走行する場合には進行方向を見て右側を検出し、自動走行車両１が紙面下側の方向に向って走行する場合には進行方向を見て左側を検出するよう構成することも可能であるし、自動走行車両１の両側に存在する物体を検出するよう構成することも可能である。また、必要に応じて物体検出部１１を回転し、範囲Ｒが車長延長線Ｓに対して反転するように構成することも可能である。   As described above, in the present embodiment, the range R detected by the object detection unit 11 is a range of about 270 degrees out of the entire circumference centering on the automatic traveling vehicle 1. Therefore, as shown in FIG. 4, the automatic traveling vehicle 1 detects the left side when looking at the traveling direction when the automatic traveling vehicle 1 travels in the upper direction of the page, and the automatic traveling vehicle 1 When traveling in the direction of, the right side is detected by looking at the traveling direction. In this way, the object detection unit 11 detects an object that exists on one side of the automatic traveling vehicle 1. In this embodiment, the one side of the automatic traveling vehicle 1 means the left side of the vehicle length extension line S in FIG. Of course, when the automatic traveling vehicle 1 travels in the upper direction of the paper, the right side is detected by looking at the traveling direction, and when the automatic traveling vehicle 1 travels in the lower direction of the paper, the traveling direction is determined. It can be configured to detect the left side as viewed, or can be configured to detect objects present on both sides of the autonomous vehicle 1. Further, the object detection unit 11 may be rotated as necessary, and the range R may be reversed with respect to the vehicle length extension line S.

目標物設定部１２は、物体検出部１１により検出された物体のうち、少なくとも２つの物体の位置に基づいて、当該少なくとも２つの物体を目標物Ｏとして設定する。物体検出部１１は、図４に示されるように所定の範囲内に検出信号を送信し、範囲Ｒ内に存在する物体を検出する。ここで、本実施形態では自動走行車両１は樹木Ｋが植えられている果樹園Ｐを自動走行する。このため、果樹園Ｐ内の樹木Ｋや樹木Ｋを支持する支柱等から目標物Ｏが設定される。また、本実施形態では、自動走行車両１は少なくとも２つの物体を検出できれば目標物Ｏを設定することができる。本実施形態では、目標物設定部１２は範囲Ｒ内において物体検出部１１により検出された物体から２つの物体を用いて目標物Ｏとして設定するとして説明する。   The target setting unit 12 sets the at least two objects as the target O based on the positions of at least two objects among the objects detected by the object detection unit 11. As shown in FIG. 4, the object detection unit 11 transmits a detection signal within a predetermined range and detects an object existing within the range R. Here, in this embodiment, the automatic traveling vehicle 1 automatically travels through the orchard P where the trees K are planted. For this reason, the target object O is set from the tree K in the orchard P, the support that supports the tree K, and the like. In the present embodiment, the automatic traveling vehicle 1 can set the target O if it can detect at least two objects. In the present embodiment, the target object setting unit 12 will be described as setting the target object O using two objects from the objects detected by the object detection unit 11 within the range R.

２つの目標物Ｏのうちの一方は、自動走行車両１から左側方を見て最も近い位置にある物体が選択される。図４の例では、符号Ｏ１を付したものが相当し、この目標物Ｏ１は進行方向手前側の目標物Ｏに相当する。２つの目標物Ｏのうちの他方は、先に設定された目標物Ｏ１から見て自動走行車両１の進行方向において最も近い物体が選択される。図４の例では、符号Ｏ２を付したものが相当し、この目標物Ｏ２は進行方向奥側の目標物Ｏに相当する。目標物Ｏ１と目標物Ｏ２との間の距離は、目標物Ｏ１に係る物体検出部１１の検出結果と目標物Ｏ２に係る物体検出部１１の検出結果とに基づき、公知の三角測量法を用いて演算することができる。   As one of the two targets O, an object that is closest to the autonomous traveling vehicle 1 when viewed from the left side is selected. In the example of FIG. 4, the reference numeral O1 corresponds to the target object O1, and the target object O1 corresponds to the target object O on the front side in the traveling direction. As the other of the two targets O, the closest object in the traveling direction of the automatic traveling vehicle 1 is selected as viewed from the previously set target O1. In the example of FIG. 4, the reference symbol O2 corresponds to the target object O2, and the target object O2 corresponds to the target object O on the far side in the traveling direction. The distance between the target object O1 and the target object O2 is determined using a known triangulation method based on the detection result of the object detection unit 11 related to the target object O1 and the detection result of the object detection unit 11 related to the target object O2. Can be calculated.

また、目標物設定部１２は、物体検出部１１により検出された複数の物体のうち、予め設定された範囲内にある物体をグループ化して一つの目標物Ｏを設定する。上述したように、果樹園Ｐの樹木Ｋの中には支柱により支持されるものもある。また、自動走行車両１により刈られた草や落ち葉もある。そこで、図５に示されるように、樹木Ｋから所定範囲（例えば０．４ｍ）内にある支柱や草等は、樹木Ｋとグループ化して一つの目標物Ｏとして設定される。これにより、支柱を目標物Ｏとして設定して走行したり、草等を障害物として避けて走行したりすることによって自動走行車両１が蛇行しながら走行することを防止できる。   The target setting unit 12 sets one target O by grouping objects within a preset range among a plurality of objects detected by the object detection unit 11. As described above, some trees K of the orchard P are supported by the support columns. There are also grass and fallen leaves cut by the automatic traveling vehicle 1. Therefore, as shown in FIG. 5, pillars, grasses, and the like within a predetermined range (for example, 0.4 m) from the tree K are grouped with the tree K and set as one target object O. Accordingly, it is possible to prevent the automatic traveling vehicle 1 from traveling while meandering by setting the column as the target object O and traveling while avoiding grass as an obstacle.

ここで、自動走行車両１は、進行方向がどの方向かを自ら認識することができないので、自動走行車両１に対して予めユーザが進行方向を設定しておくと好適である。もちろん、自動走行車両１の長さ方向両端のうち、最初に進行する側の端部を設定しておき、当該端部が向いている側を進行方向として設定しても良い。   Here, since the automatic traveling vehicle 1 cannot recognize by itself which direction the traveling direction is, it is preferable that the user sets the traveling direction in advance for the automatic traveling vehicle 1. Of course, it is also possible to set an end portion on the first traveling side of both ends in the length direction of the automatic traveling vehicle 1 and set the side facing the end portion as the traveling direction.

基準線設定部１３は、目標物設定部１２により設定された少なくとも２つの目標物Ｏを通り、走行時の基準となる基準線ＳＬを設定する。目標物設定部１２により設定された少なくとも２つの目標物Ｏとは、本実施形態では上述した目標物Ｏ１及び目標物Ｏ２である。基準線設定部１３は、自動走行制御装置１０内で用いる座標系において、この目標物Ｏ１と目標物Ｏ２とを直線で繋いで基準線ＳＬを設定する。基準線ＳＬは、物体検出部１１により一つの物体として検出された検出結果のうち、夫々の中央部分を通るように直線で繋いでも良いし、夫々の検出結果の一方の端部を通るように直線で繋いでも良い。或いは、夫々の検出結果のうち、物体検出部１１に最も近い部分を通るように直線で繋いでも良い。もちろん、他の所定の条件の下、夫々の検出結果を直線で繋ぐことも可能である。このような基準線ＳＬは後述するように自動走行車両１が自動走行する際に基準として利用される。   The reference line setting unit 13 passes through at least two targets O set by the target setting unit 12 and sets a reference line SL serving as a reference for traveling. In the present embodiment, the at least two targets O set by the target setting unit 12 are the target O1 and the target O2 described above. The reference line setting unit 13 sets the reference line SL by connecting the target object O1 and the target object O2 with a straight line in the coordinate system used in the automatic travel control device 10. Of the detection results detected as one object by the object detection unit 11, the reference line SL may be connected by a straight line so as to pass through each central portion, or may pass through one end of each detection result. It may be connected with a straight line. Or you may connect with a straight line so that it may pass through the part nearest to the object detection part 11 among each detection result. Of course, it is also possible to connect the respective detection results with a straight line under other predetermined conditions. Such a reference line SL is used as a reference when the automatic traveling vehicle 1 automatically travels as described later.

距離演算部１４は、基準線ＳＬから車体までの距離を演算する。基準線ＳＬから車体までの距離とは、上記座標系において基準線ＳＬと車体とを最短で繋いだ距離である。このため、基準線ＳＬから車体を通るように引いた垂線上での距離にあたる。   The distance calculation unit 14 calculates the distance from the reference line SL to the vehicle body. The distance from the reference line SL to the vehicle body is a distance that connects the reference line SL and the vehicle body in the shortest distance in the coordinate system. For this reason, it corresponds to the distance on the perpendicular drawn from the reference line SL so as to pass through the vehicle body.

走行範囲設定部１５は、自動走行車両１が自動走行する走行経路に対して許容される走行範囲を設定する。本実施形態では自動走行車両１は自動走行しながら草を刈り取る。このため、自動走行車両１が自動走行する走行経路は、草を刈り取る経路に相当する。詳細は省略するが、刈り刃５４は自動走行車両１の走行機体３の中央部の底面に車幅方向に亘って設けられる。自動走行車両１は果樹園Ｐの一方の端部から他方の端部まで自動走行する際、刈り漏れを防止するために先に走行した経路に対して刈り取る領域の一部（例えば２０〜３０ｃｍ）を重複させて自動走行する。上述した許容される走行範囲は、このような重複する幅の１／２〜１／３（例えば１０〜１５ｃｍ）程度に設定すると好適である。   The travel range setting unit 15 sets a travel range allowed for the travel route on which the autonomous traveling vehicle 1 travels automatically. In the present embodiment, the automatic traveling vehicle 1 cuts grass while traveling automatically. For this reason, the traveling route on which the automatic traveling vehicle 1 automatically travels corresponds to a route for cutting grass. Although details are omitted, the cutting blade 54 is provided on the bottom surface of the central portion of the traveling machine body 3 of the automatic traveling vehicle 1 over the vehicle width direction. When the automatic traveling vehicle 1 automatically travels from one end portion of the orchard P to the other end portion, a part of a region (for example, 20 to 30 cm) that cuts the route traveled earlier in order to prevent cutting leakage. Autorun with overlapping. The allowable travel range described above is preferably set to about 1/2 to 1/3 (for example, 10 to 15 cm) of such overlapping width.

外径推定部４５は、物体検出部１１の検出結果に基づき、物体の外径を推定する。上述したように、物体検出部１１は水平方向に所定のピッチ（例えば０．５度ピッチ）で検出信号を送信する。例えば、物体の外径の演算を３ピッチ毎に行うとすると、図６に示されるように、１ステップ（３ピッチ）に係る物体の幅は、「Ｌ１×ｔａｎθ」で近似的に演算することができる（ただし、θは３ピッチ分の角度）。この１ステップ分の物体の幅に、物体からの反射信号を受信したステップ数を掛けると、物体の外径を推定することができる。図６の例では、物体からの反射信号を受信したステップ数は８であるので、物体の外径は「８×Ｌ１×ｔａｎθ」として推定される。このようにして外径推定部４５は、物体検出部１１により検出された物体の外径を推定する。この推定結果は後述する走行制御部１６に伝達される。なお、上記の演算は、ピッチ毎に行うことも可能である。   The outer diameter estimation unit 45 estimates the outer diameter of the object based on the detection result of the object detection unit 11. As described above, the object detection unit 11 transmits detection signals at a predetermined pitch (for example, 0.5 degree pitch) in the horizontal direction. For example, if the outer diameter of an object is calculated every three pitches, the width of the object related to one step (three pitches) is approximately calculated by “L1 × tan θ” as shown in FIG. (However, θ is an angle corresponding to 3 pitches). The outer diameter of the object can be estimated by multiplying the width of the object for one step by the number of steps at which the reflected signal from the object is received. In the example of FIG. 6, the number of steps at which the reflection signal from the object is received is 8, and thus the outer diameter of the object is estimated as “8 × L1 × tan θ”. In this way, the outer diameter estimation unit 45 estimates the outer diameter of the object detected by the object detection unit 11. This estimation result is transmitted to the travel control unit 16 described later. The above calculation can also be performed for each pitch.

図３に戻り、走行制御部１６は、基準線ＳＬから車体までの距離を予め設定された範囲内に維持しつつ、予め設定された区画内において基準線ＳＬに沿って走行させると共に、外径推定部４５により推定された外径に基づき物体への接触を回避する。基準線ＳＬから車体までの距離は、上述した距離演算部１４により演算され、順次、リアルタイムで走行制御部１６に伝達される。予め設定された区画とは、自動走行車両１が自動走行を行う区画であり、本実施形態では草の刈り取り対象となる果樹園Ｐの一方の端部から他方の端部まで列毎に樹木Ｋにより仕切られる区画である。自動走行車両１は、このような区画内を往復走行しながら、草刈りを行う。   Returning to FIG. 3, the travel control unit 16 travels along the reference line SL in the preset section while maintaining the distance from the reference line SL to the vehicle body within the preset range, and has an outer diameter. Contact with the object is avoided based on the outer diameter estimated by the estimation unit 45. The distance from the reference line SL to the vehicle body is calculated by the distance calculation unit 14 described above, and sequentially transmitted to the travel control unit 16 in real time. The preset section is a section in which the automatic traveling vehicle 1 performs automatic traveling, and in this embodiment, the tree K for each row from one end portion to the other end portion of the orchard P that is the target of grass cutting. It is a section partitioned by. The automatic traveling vehicle 1 cuts grass while reciprocating in such a section.

上述したように、自動走行車両１はエンジン４を動力源として走行する。また、第１車輪２Ａ及び第２車輪２Ｂは、夫々操向操作可能に構成され、夫々第１車輪操向操作機構５１及び第２車輪操向操作機構５２により操向操作が行われる。また、エンジン４により発生された回転力は、第１車輪２Ａ及び第２車輪２Ｂの少なくとも一方に動力伝達機構５５を介して伝達される。第１車輪２Ａ及び第２車輪２Ｂに対する動力の伝達は、双方に行って自動走行車両１を４輪駆動としても良いし、一方に行って２輪駆動としても良い。また、第１車輪２Ａ及び第２車輪２Ｂの夫々は、左右一対で構成されても良いし、少なくとも一方が１輪で構成されていても良い。走行制御部１６は、基準線ＳＬから自動走行車両１までの距離が予め設定された範囲内に収まるように、第１車輪操向操作機構５１、第２車輪操向操作機構５２、及び動力伝達機構５５を制御して、基準線ＳＬに沿って走行させる。この際、走行制御部１６は、外径推定部４５により推定された物体の外径を考慮して、自動走行車両１が物体との接触を避けるべく、自動走行車両１が物体に接近し過ぎないよう自動走行させる。   As described above, the automatic traveling vehicle 1 travels using the engine 4 as a power source. Moreover, the 1st wheel 2A and the 2nd wheel 2B are comprised so that steering operation is possible respectively, and steering operation is performed by the 1st wheel steering operation mechanism 51 and the 2nd wheel steering operation mechanism 52, respectively. Further, the rotational force generated by the engine 4 is transmitted to at least one of the first wheel 2A and the second wheel 2B via the power transmission mechanism 55. The transmission of power to the first wheel 2A and the second wheel 2B may be performed on both sides so that the automatic traveling vehicle 1 may be four-wheel drive, or may be performed on one side and may be two-wheel drive. Moreover, each of the 1st wheel 2A and the 2nd wheel 2B may be comprised by left-right pair, and at least one may be comprised by 1 wheel. The traveling control unit 16 includes a first wheel steering operation mechanism 51, a second wheel steering operation mechanism 52, and a power transmission so that the distance from the reference line SL to the automatic traveling vehicle 1 is within a preset range. The mechanism 55 is controlled to travel along the reference line SL. At this time, the traveling control unit 16 considers the outer diameter of the object estimated by the outer diameter estimating unit 45, and the automatic traveling vehicle 1 is too close to the object so that the automatic traveling vehicle 1 avoids contact with the object. Let it run automatically so that there is no.

自動走行車両１は、基準線ＳＬに沿って走行しながら次の目標物Ｏとなる物体を検出する。現在の基準線ＳＬの設定に係る進行方向前側の目標物Ｏ２近傍に達すると、当該目標物Ｏ２を進行方向手前側の目標物Ｏ１とし、新たに設定した目標物Ｏを進行方向奥側の目標物Ｏ２として設定する。これらの目標物Ｏ１及び目標物Ｏ２により基準線ＳＬを設定し直して、当該基準線ＳＬに沿って果樹園Ｐの一方の端部から他方の端部まで走行する。   The automatic traveling vehicle 1 detects an object to be the next target object O while traveling along the reference line SL. When reaching the vicinity of the target object O2 on the front side in the traveling direction related to the setting of the current reference line SL, the target object O2 is set as the target object O1 on the front side in the traveling direction, and the newly set target object O is the target on the far side in the traveling direction Set as object O2. The reference line SL is reset by the target object O1 and the target object O2 and travels from one end portion of the orchard P to the other end portion along the reference line SL.

自動走行車両１は、果樹園Ｐの一方の端部から他方の端部まで基準線ＳＬに沿って走行し、端部においてはスイッチバックをして、そこで設定された基準線ＳＬに沿って走行する。スイッチバックとは、自車が区画の端部に達した際に前後進を繰り返して、自動走行車両１の位置を当該端部の位置から側方にずらすように移動する走行形態である。本実施形態では、自動走行車両１は自車が果樹園Ｐの端部に達した否かを物体の数によって認識するよう構成されている。すなわち、物体数設定部１７が区画内において物体検出部１１が検出する物体の数を予め設定しておく。区画内において物体検出部１１が検出する物体の数とは、自動走行車両１は、果樹園Ｐの一方の端部から他方の端部まで走行する際に目標物Ｏとして設定する物体の数である。物体数設定部１７は、このような物体の数を予め設定し、記憶しておく。   The automatic traveling vehicle 1 travels along the reference line SL from one end of the orchard P to the other end, switches back at the end, and travels along the reference line SL set there. To do. The switchback is a traveling mode in which the host vehicle repeats forward and backward movement when it reaches the end of the section, and moves so as to shift the position of the automatic traveling vehicle 1 from the position of the end to the side. In the present embodiment, the automatic traveling vehicle 1 is configured to recognize whether or not the own vehicle has reached the end of the orchard P by the number of objects. That is, the object number setting unit 17 sets in advance the number of objects detected by the object detection unit 11 in the section. The number of objects detected by the object detection unit 11 in the section is the number of objects set as the target object O when the automatic traveling vehicle 1 travels from one end of the orchard P to the other end. is there. The object number setting unit 17 presets and stores the number of such objects.

この物体の数は、ユーザが自動走行車両１を自動走行させる前に、予め手動で入力して物体数設定部１７に設定しておいても良いし、区画内に存在する物体の数を示すマップを物体数設定部１７に読み込ませて自動で物体の数を設定しても良い。例えば、マップを用いて物体の数を設定する場合には、区画内に存在する物体の列数、及び夫々の列毎の物体の個数を記載しておくと良い。更には、自動走行車両１は基準線ＳＬに沿って草を刈り取りながら走行する前に例えばラジコン操作によりティーチング走行を行い、当該ティーチング走行時に物体数設定部１７が区画内の物体の数を計数し、当該計数した物体の数を基準線ＳＬに沿って走行する際に目標物Ｏとして設定される物体検出部１１が検出する物体の数として設定することも可能である。これにより、物体数設定部１７は物体検出部１１が検出する物体の数を容易に設定することが可能となる。   The number of objects may be manually input in advance and set in the object number setting unit 17 before the user automatically travels the automatic traveling vehicle 1, or indicates the number of objects existing in the section. The number of objects may be automatically set by reading the map into the object number setting unit 17. For example, when the number of objects is set using a map, the number of columns of objects existing in a section and the number of objects in each column may be described. Further, the automatic traveling vehicle 1 performs teaching traveling by, for example, a radio control operation before traveling while cutting grass along the reference line SL, and the object number setting unit 17 counts the number of objects in the section during the teaching traveling. It is also possible to set the counted number of objects as the number of objects detected by the object detection unit 11 set as the target object O when traveling along the reference line SL. Thereby, the object number setting unit 17 can easily set the number of objects detected by the object detection unit 11.

物体計数部１８は、区画の一方の端部から他方の端部に向って走行する際に、基準線ＳＬの設定に用いた物体の数を計数する。物体計数部１８は目標物設定部１２が目標物Ｏを新たに設定した場合には、その旨を示す情報を取得し、当該新たに設定した目標物Ｏを用いて実際に基準線ＳＬを設定に用いた物体の数を計数する。ここで、元々、進行方向奥側の目標物Ｏ２として設定していたものを、自動走行車両１の走行に応じて進行方向手前側の目標物Ｏ１として設定した場合には、双方を計数すると、同一の物体に係る目標物Ｏであることから重複して計数することになる。このような重複して計数することを避けるために、物体計数部１８は、自動走行車両１が区画の一方の端部から他方の端部に向って走行する際に、予め決定された進行方向手前側に設定された目標物Ｏ１に係る物体及び進行方向奥側に設定された目標物Ｏ２に係る物体の何れか一方のみを計数し、当該計数結果に１を加えておくことで、区画の一方の端部から他方の端部に至るまで基準線ＳＬの設定に係る物体を計数することが可能となる。   The object counting unit 18 counts the number of objects used for setting the reference line SL when traveling from one end of the section toward the other end. When the target setting unit 12 newly sets the target O, the object counting unit 18 acquires information indicating that fact, and actually sets the reference line SL using the newly set target O. Count the number of objects used. Here, when what was originally set as the target object O2 in the traveling direction back side is set as the target object O1 in the traveling direction front side according to the traveling of the automatic traveling vehicle 1, when both are counted, Since it is the target object O related to the same object, counting is repeated. In order to avoid such overlapping counting, the object counting unit 18 determines a traveling direction that is determined in advance when the automatic traveling vehicle 1 travels from one end of the section toward the other end. Only one of the object related to the target object O1 set on the near side and the object related to the target object O2 set on the far side in the traveling direction is counted, and by adding 1 to the count result, It is possible to count objects related to the setting of the reference line SL from one end to the other end.

判定部１９は、物体計数部１８の係数結果が、物体数設定部１７により設定された物体の数に達した場合に、自動走行車両１が区画の他方の端部に達したと判定する。これにより、走行制御部１６はその位置で自動走行車両１を一旦、停車させ、当該停車した位置から自動走行車両１をスイッチバックさせて次に草を刈り取る分だけ位置をずらし、その位置から再度、目標物Ｏに基づき基準線ＳＬを設定して自動走行しながら草を刈り取る。このようにして自動走行車両１は、自車で自動走行する際に基準となる基準線ＳＬを設定し、自動走行することが可能となる。   The determination unit 19 determines that the automatic traveling vehicle 1 has reached the other end of the section when the coefficient result of the object counting unit 18 reaches the number of objects set by the object number setting unit 17. As a result, the traveling control unit 16 temporarily stops the automatic traveling vehicle 1 at that position, switches back the automatic traveling vehicle 1 from the stopped position, and then shifts the position by the amount of grass cutting. Then, the reference line SL is set on the basis of the target object O, and the grass is cut while running automatically. In this way, the automatic traveling vehicle 1 can automatically travel by setting the reference line SL as a reference when automatically traveling with the own vehicle.

次に、自動走行車両１が自動走行を行う際の処理について図７のフローチャートを用いて説明する。自動走行車両１が、任意の位置に配置される（ステップ＃１）。この際、自動走行車両１は、自動走行車両１における最初に進行させる側の端部を自動走行させたい方向に向けておくと良い。   Next, processing when the autonomous vehicle 1 performs automatic traveling will be described with reference to the flowchart of FIG. The automatic traveling vehicle 1 is disposed at an arbitrary position (step # 1). At this time, the automatic traveling vehicle 1 is preferably directed so that the end of the automatic traveling vehicle 1 on the side to be first advanced is directed to automatically travel.

物体検出部１１は、所定の範囲について物体の検出を開始する（ステップ＃２）。以後、物体検出部１１は、自動走行車両１が自動走行を終了するまで継続して物体の検出を行う。このように自動走行車両１の周囲において検出された物体が目標物Ｏとしての所定の条件を満たす場合には（ステップ＃３：Ｙｅｓ）、検出された物体（ステップ＃３において目標物Ｏの条件を満たすと判定された物体）から所定範囲内に他の物体が存在するか否か判定を行われる（ステップ＃４）。検出された物体の所定範囲内に他の物体がある場合には（ステップ＃４：Ｙｅｓ）、検出された物体と所定範囲内の他の物体とをグループ化して（ステップ＃５）、一つの目標物Ｏが設定される（ステップ＃６）。一方、検出された物体の所定範囲内に他の物体がない場合には（ステップ＃４：Ｎｏ）、検出された物体のみで一つの目標物Ｏが設定される（ステップ＃６）。   The object detection unit 11 starts detecting an object for a predetermined range (step # 2). Thereafter, the object detection unit 11 continuously detects an object until the automatic traveling vehicle 1 finishes the automatic traveling. Thus, when the object detected in the periphery of the automatic traveling vehicle 1 satisfies the predetermined condition as the target object O (step # 3: Yes), the detected object (the condition of the target object O in step # 3) is determined. It is determined whether or not another object exists within a predetermined range from the object determined to satisfy (step # 4). If there is another object within the predetermined range of the detected object (step # 4: Yes), the detected object and another object within the predetermined range are grouped (step # 5), The target object O is set (step # 6). On the other hand, when there is no other object within the predetermined range of the detected object (step # 4: No), one target O is set with only the detected object (step # 6).

次に、外径推定部４５により物体検出部１１により検出された物体の外径が推定される（ステップ＃７）。この目標物Ｏの検出は、少なくとも２つの目標物Ｏが設定されるまで行われる（ステップ＃８：Ｙｅｓ）。   Next, the outer diameter of the object detected by the object detection unit 11 is estimated by the outer diameter estimation unit 45 (step # 7). The detection of the target object O is performed until at least two target objects O are set (step # 8: Yes).

ここで、自動走行制御装置１０内では、物体検出部１１により取得された当該物体検出部１１を基準とした物体が存在する方向を示す情報と、物体検出部１１から物体までの距離を示す情報とに基づき、自動走行車両１を基準とした座標系において目標物Ｏ１及び目標物Ｏ２の座標が演算される。係る場合、自動走行車両１の座標が（０，０）として設定され、目標物Ｏ１の座標が（Ｘ１，Ｙ１）、目標物Ｏ２の座標が（Ｘ２，Ｙ２）として演算される。   Here, in the automatic travel control device 10, information indicating the direction in which the object exists with reference to the object detection unit 11 acquired by the object detection unit 11, and information indicating the distance from the object detection unit 11 to the object. Based on the above, the coordinates of the target object O1 and the target object O2 are calculated in the coordinate system with the automatic traveling vehicle 1 as a reference. In such a case, the coordinates of the automatic traveling vehicle 1 are set as (0, 0), the coordinates of the target object O1 are calculated as (X1, Y1), and the coordinates of the target object O2 are calculated as (X2, Y2).

次に、基準線設定部１３は、２つの目標物Ｏ１及び目標物Ｏ２を基準に基準線ＳＬを設定する（ステップ＃９）。この基準線ＳＬは、物体検出部１１により検出された目標物Ｏ１と目標物Ｏ２との夫々の外縁部を繋いだ線で設定される。   Next, the reference line setting unit 13 sets the reference line SL based on the two targets O1 and O2 (step # 9). The reference line SL is set by a line connecting the outer edge portions of the target object O1 and the target object O2 detected by the object detection unit 11.

次に、自動走行車両１が走行する基準線ＳＬを基準とした走行経路を設定する。この設定は、基準線ＳＬから走行経路までの距離に応じて設定される（ステップ＃１０）。この場合、当該距離の演算処理及び以降の処理を行い易くするために、自動走行制御装置１０では、自動走行車両１を基準とした座標系から基準線ＳＬをｙ軸とする座標系に座標変換が行われる。これにより、目標物Ｏ１の座標（Ｘ１，Ｙ１）、及び目標物Ｏ２の座標（Ｘ２）が座標変換され、目標物Ｏ１の座標（０，ｙ１）、及び目標物Ｏ２の座標（０，ｙ２）となる。このような座標変換後の座標系において、基準線ＳＬから走行経路までの距離がｍとして設定される。この場合、自動走行車両１の座標は（ｘ１，０）に変換される。また、この距離に対する許容範囲±ａが設定される（ステップ＃１１）。   Next, a travel route with reference to the reference line SL on which the automatic traveling vehicle 1 travels is set. This setting is set according to the distance from the reference line SL to the travel route (step # 10). In this case, in order to facilitate the distance calculation processing and the subsequent processing, the automatic travel control device 10 performs coordinate conversion from the coordinate system based on the automatic traveling vehicle 1 to the coordinate system using the reference line SL as the y axis. Is done. Thereby, the coordinates (X1, Y1) of the target object O1 and the coordinates (X2) of the target object O2 are coordinate-transformed, and the coordinates (0, y1) of the target object O1 and the coordinates (0, y2) of the target object O2 are converted. It becomes. In the coordinate system after such coordinate conversion, the distance from the reference line SL to the travel route is set as m. In this case, the coordinates of the automatic traveling vehicle 1 are converted to (x1, 0). Further, an allowable range ± a for this distance is set (step # 11).

走行制御部１６は、基準線ＳＬから自動走行車両１までの距離が、設定された「ｍ±ａ」に収まるように自動走行車両１を走行させる（ステップ＃１２）。基準線ＳＬから自動走行車両１までの距離が、設定された「ｍ±ａ」に収まらない場合には（ステップ＃１３：Ｙｅｓ）、走行制御部１６は許容範囲内に収まるようにステアリングを操作する（ステップ＃１４）。これにより、自動走行車両１は、所期の走行経路に沿って走行することが可能となる。ステップ＃１３において、基準線ＳＬから自動走行車両１までの距離が、設定された「ｍ±ａ」に収まる場合には（ステップ＃１３：Ｎｏ）、走行制御部１６はそのままの舵角で走行させる。なお、この場合、自動走行車両１の位置によって物体検出部１１により検出される物体の検出結果が異なるので、都度、目標物Ｏ１，Ｏ２の座標変換を行いつつ、基準線ＳＬを更新しながら自動走行が行われる。この時のステアリングの操作は、同位相の４輪ステアリング操作であっても、その他のステアリング操作であっても良い。   The travel control unit 16 causes the automatic travel vehicle 1 to travel so that the distance from the reference line SL to the automatic travel vehicle 1 falls within the set “m ± a” (step # 12). When the distance from the reference line SL to the automatic traveling vehicle 1 does not fall within the set “m ± a” (step # 13: Yes), the traveling control unit 16 operates the steering so that it is within the allowable range. (Step # 14). As a result, the automatic traveling vehicle 1 can travel along the intended travel route. In step # 13, when the distance from the reference line SL to the automatic traveling vehicle 1 falls within the set “m ± a” (step # 13: No), the traveling control unit 16 travels with the steering angle as it is. Let In this case, the detection result of the object detected by the object detection unit 11 differs depending on the position of the automatic traveling vehicle 1, so that the reference line SL is automatically updated while the coordinates of the targets O1 and O2 are changed each time. Driving is performed. The steering operation at this time may be a four-wheel steering operation in the same phase or another steering operation.

自動走行車両１が進行方向奥側の目標物Ｏ２に達し（ステップ＃１５：Ｙｅｓ）、且つ、当該目標物Ｏ２が区画の端部の目標物Ｏでなければ（ステップ＃１６：Ｙｅｓ）、目標物設定部１２はこれまでの進行方向奥側の目標物Ｏ２を進行方向手前側の目標物Ｏ１に設定し（ステップ＃１７）、ステップ＃３から処理が継続される。   If the vehicle 1 reaches the target O2 on the far side in the traveling direction (step # 15: Yes) and the target O2 is not the target O at the end of the section (step # 16: Yes), the target The object setting unit 12 sets the target object O2 on the far side in the traveling direction so far as the target object O1 on the near side in the traveling direction (step # 17), and the processing is continued from step # 3.

ステップ＃１６において、目標物Ｏ２が区画の端部の目標物Ｏであれば（ステップ＃１６：Ｎｏ）、走行制御部１６は自動走行を停止し（ステップ＃１８）、その位置からスイッチバックにより自動走行車両１の位置が変更される（ステップ＃１９）。スイッチバックについては、基準線ＳＬからの距離に拘らず一定の動作で行われることから予めプログラミングしておくと良い。   In step # 16, if the target object O2 is the target object O at the end of the section (step # 16: No), the travel control unit 16 stops automatic travel (step # 18), and switches back from that position. The position of the automatic traveling vehicle 1 is changed (step # 19). The switchback is preferably performed in advance because it is performed in a constant operation regardless of the distance from the reference line SL.

〔その他の実施形態〕
上記実施形態では、物体検出部１１が果樹園Ｐの樹木Ｋや樹木Ｋを支持する支柱等を検出するとして説明したが、樹木Ｋや支柱以外に、柵やフェンス等を検出するよう構成することも可能である。 [Other Embodiments]
In the above embodiment, the object detection unit 11 has been described as detecting the tree K of the orchard P, the support supporting the tree K, and the like. However, in addition to the tree K and the support, it is configured to detect a fence, a fence, and the like. Is also possible.

上記実施形態では、目標物設定部１２は２つの物体から２つの目標物Ｏを設定するとして説明したが、３つ以上の物体から３つ以上の目標物Ｏを設定する構成とすることも可能である。   In the above embodiment, the target setting unit 12 has been described as setting two targets O from two objects. However, a configuration in which three or more targets O are set from three or more objects is also possible. It is.

上記実施形態では、物体計数部１８の係数結果が、物体数設定部１７により設定された物体の数に達した場合に自動走行車両１が区画の他方の端部に達したと判定部１９が判定し、走行制御部１６は、区画の端部に達したと判定された場合に自動走行車両１を停車させるとして説明したが、走行制御部１６は例えば走行距離やリモコン操作等によって区画の端部に達したと判定し、自動走行車両１を停車させるよう構成することも可能である。   In the above embodiment, when the coefficient result of the object counting unit 18 reaches the number of objects set by the object number setting unit 17, the determination unit 19 determines that the automatic traveling vehicle 1 has reached the other end of the section. In the above description, the traveling control unit 16 is described as stopping the automatic traveling vehicle 1 when it is determined that the end of the section has been reached. It is also possible to determine that the vehicle has reached the vehicle and stop the automatic traveling vehicle 1.

上記実施形態では、自動走行車両１が草の刈り取りを行いながら自動走行するとして説明したが、自動走行車両１を例えば運搬車両として用いることも可能であるし、他の用途に用いることも当然に可能である。   In the above-described embodiment, the automatic traveling vehicle 1 has been described as automatically traveling while cutting grass. However, the automatic traveling vehicle 1 can be used as a transport vehicle, for example, and can be used for other purposes. Is possible.

上記実施形態では、自動走行車両１は、目標物設定部１２により設定された目標物Ｏに基づいて自動走行するとして説明したが、例えば樹木Ｋの樹列毎の本数や、開始樹列番号、終了樹列番号、区画の端部の側に植えられている樹木Ｋから当該区画の端部までの距離を規定するオフセット量、目標とする樹木Ｋを切り替える切換距離等が入力されたマップを読み込ませ、物体検出部１１の検出結果と共に、マップも用いて自動走行するよう構成することも可能である。これにより、自動走行する領域を認識することができ、オフセット量で規定されるオフセット領域の草の刈り残しを低減できる。また、必要に応じてマップを修正することで、草を刈り取る領域を自由に設定することも可能となる。また、このようなマップは、自動走行車両１に記憶しておき、適宜読み出して使用することも可能であるし、新たな物体を検出した場合には、更新するよう構成することも可能である。   In the above-described embodiment, the automatic traveling vehicle 1 has been described as automatically traveling based on the target O set by the target setting unit 12, but for example, the number of trees K for each tree row, the starting tree number, Reads a map in which an end tree number, an offset amount that defines the distance from the tree K planted on the end of the section to the end of the section, a switching distance for switching the target tree K, and the like are input. In addition to the detection result of the object detection unit 11, a map may be used to automatically travel. Thereby, the area | region which drive | works automatically can be recognized and the uncut grass of the offset area | region prescribed | regulated by offset amount can be reduced. It is also possible to freely set a region for cutting grass by correcting the map as necessary. Further, such a map can be stored in the automatic traveling vehicle 1 and can be read and used as appropriate, or can be configured to be updated when a new object is detected. .

上記実施形態では、自動走行制御装置１０において、自動走行車両１を基準とした座標系から目標物Ｏを基準とした座標系に座標変換を行って、自動走行に係る演算処理を行うとして説明したが、座標変換を行わずに自動走行に係る演算処理を行うことも可能である。   In the above-described embodiment, the automatic travel control device 10 has been described as performing arithmetic processing related to automatic travel by performing coordinate conversion from the coordinate system based on the automatic travel vehicle 1 to the coordinate system based on the target object O. However, it is also possible to perform arithmetic processing related to automatic travel without performing coordinate conversion.

本発明は、自動で走行する自動走行車両に利用することが可能である。   The present invention can be used for an automatic traveling vehicle that automatically travels.

１：自動走行車両
１１：物体検出部
１２：目標物設定部
１３：基準線設定部
１４：距離演算部
１６：走行制御部
４５：外径推定部
Ｏ：目標物
Ｒ：範囲
ＳＬ：基準線 1: automatic traveling vehicle 11: object detection unit 12: target setting unit 13: reference line setting unit 14: distance calculation unit 16: travel control unit 45: outer diameter estimation unit O: target R: range SL: reference line

Claims (2)

予め設定された範囲に向けて検出信号を送信し、前記検出信号に対する反射信号を取得して、前記予め設定された範囲に存在する物体を検出する物体検出部と、
前記物体検出部により検出された物体のうち、少なくとも２つの物体の位置に基づいて、当該少なくとも２つの物体を目標物として設定する目標物設定部と、
前記目標物設定部により設定された少なくとも２つの目標物を通り、走行時の基準となる基準線を設定する基準線設定部と、
前記基準線から車体までの距離を演算する距離演算部と、
前記物体検出部の検出結果に基づき、前記物体の外径を推定する外径推定部と、
前記距離を予め設定された範囲内に維持しつつ、予め設定された区画内において前記基準線に沿って走行させると共に、前記外径に基づき前記物体への接触を回避する走行制御部と、
を備える自動走行車両。 An object detection unit for transmitting a detection signal toward a preset range, acquiring a reflection signal for the detection signal, and detecting an object existing in the preset range;
A target setting unit configured to set the at least two objects as targets based on positions of at least two objects among the objects detected by the object detection unit;
A reference line setting unit that sets a reference line that is a reference when traveling through at least two targets set by the target setting unit;
A distance calculation unit for calculating a distance from the reference line to the vehicle body;
Based on the detection result of the object detection unit, an outer diameter estimation unit that estimates the outer diameter of the object;
A travel control unit that travels along the reference line in a preset section while maintaining the distance within a preset range, and that avoids contact with the object based on the outer diameter;
An automatic traveling vehicle comprising: 前記目標物設定部は、前記物体検出部により検出された複数の物体のうち、予め設定された範囲内にある物体をグループ化して一つの目標物を設定する請求項１に記載の自動走行車両。   The automatic traveling vehicle according to claim 1, wherein the target setting unit sets one target by grouping objects within a preset range among a plurality of objects detected by the object detection unit. .
JP2014194129A 2014-09-24 2014-09-24 Autonomous vehicle Active JP6376921B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2014194129A JP6376921B2 (en) 2014-09-24 2014-09-24 Autonomous vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2014194129A JP6376921B2 (en) 2014-09-24 2014-09-24 Autonomous vehicle

Publications (2)

Publication Number Publication Date
JP2016063769A true JP2016063769A (en) 2016-04-28
JP6376921B2 JP6376921B2 (en) 2018-08-22

Family

ID=55803652

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2014194129A Active JP6376921B2 (en) 2014-09-24 2014-09-24 Autonomous vehicle

Country Status (1)

Country Link
JP (1) JP6376921B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018102134A (en) * 2016-12-22 2018-07-05 株式会社クボタ Mobile vehicle
JP2019170309A (en) * 2018-03-29 2019-10-10 ヤンマー株式会社 Work vehicle

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6047606A (en) * 1983-08-24 1985-03-15 株式会社クボタ Self-propelling working vehicle
JPS63157908A (en) * 1986-12-22 1988-06-30 株式会社クボタ Steering control apparatus of running working vehicle between trees
JPH02170205A (en) * 1988-09-06 1990-07-02 Transitions Res Corp Visual navigation composed of light beam system and obstacle avoiding apparatus
JPH0373004A (en) * 1989-08-14 1991-03-28 Honda Motor Co Ltd Self-running work robot
JPH03272607A (en) * 1990-03-20 1991-12-04 Yanmar Agricult Equip Co Ltd Crop row detection apparatus of farm working machine
JPH041812A (en) * 1990-04-19 1992-01-07 Yanmar Agricult Equip Co Ltd Automatic traveling work vehicle with ultrasonic sensor
JP2996705B2 (en) * 1990-09-18 2000-01-11 ヤンマー農機株式会社 Steering control device for automatic traveling work vehicle
JP2011129126A (en) * 2009-12-17 2011-06-30 Deere & Co Automatic tagging for landmark identification
JP2011130729A (en) * 2009-11-30 2011-07-07 Imasen Electric Ind Co Ltd Device for steer-controlling movable implement
US20130261868A1 (en) * 2012-03-30 2013-10-03 Caterpillar, Inc. Laser Sensors For Trolley Guidance Signal

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6047606A (en) * 1983-08-24 1985-03-15 株式会社クボタ Self-propelling working vehicle
JPS63157908A (en) * 1986-12-22 1988-06-30 株式会社クボタ Steering control apparatus of running working vehicle between trees
JPH02170205A (en) * 1988-09-06 1990-07-02 Transitions Res Corp Visual navigation composed of light beam system and obstacle avoiding apparatus
JPH0373004A (en) * 1989-08-14 1991-03-28 Honda Motor Co Ltd Self-running work robot
JPH03272607A (en) * 1990-03-20 1991-12-04 Yanmar Agricult Equip Co Ltd Crop row detection apparatus of farm working machine
JPH041812A (en) * 1990-04-19 1992-01-07 Yanmar Agricult Equip Co Ltd Automatic traveling work vehicle with ultrasonic sensor
JP2996705B2 (en) * 1990-09-18 2000-01-11 ヤンマー農機株式会社 Steering control device for automatic traveling work vehicle
JP2011130729A (en) * 2009-11-30 2011-07-07 Imasen Electric Ind Co Ltd Device for steer-controlling movable implement
JP2011129126A (en) * 2009-12-17 2011-06-30 Deere & Co Automatic tagging for landmark identification
US20130261868A1 (en) * 2012-03-30 2013-10-03 Caterpillar, Inc. Laser Sensors For Trolley Guidance Signal

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018102134A (en) * 2016-12-22 2018-07-05 株式会社クボタ Mobile vehicle
JP2019170309A (en) * 2018-03-29 2019-10-10 ヤンマー株式会社 Work vehicle

Also Published As

Publication number Publication date
JP6376921B2 (en) 2018-08-22

Similar Documents

Publication Publication Date Title
US11696525B2 (en) Automatic travel work machine, automatic travel grass mower, grass mower, and grass mower automatic travel system
JP6562678B2 (en) Automated traveling vehicle
CN102713987A (en) Road information detection device and vehicle travel control device
JP6851589B2 (en) Work platform
JP6376921B2 (en) Autonomous vehicle
JP6824866B2 (en) Mower automatic driving system
JP5505651B2 (en) Detection device
AU2013240048B2 (en) Automatic trolley guidance
JP6275609B2 (en) Autonomous vehicle
JP2016187305A (en) Mobile agricultural machine
JP6342764B2 (en) Autonomous vehicle
JP6989886B2 (en) Work platform
JP6345558B2 (en) Autonomous vehicle
JP6456083B2 (en) Autonomous vehicle
JP6342763B2 (en) Autonomous vehicle
JP6309413B2 (en) Autonomous vehicle
JP6452366B2 (en) Autonomous vehicle
JP6884339B2 (en) Work platform
JP6309412B2 (en) Autonomous vehicle
JP2016066206A (en) Automatic travel vehicle
JP6877327B2 (en) Mower
JP7290091B2 (en) Automatic guided vehicle control system and control method
JP7228116B2 (en) self-driving vehicle
US20160061608A1 (en) Carrier
WO2023158606A1 (en) System and method for defining a work region boundary for use by an autonomous grounds care vehicle

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20161223

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20170728

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20170815

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20171012

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20171219

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20180216

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20180724

R150 Certificate of patent or registration of utility model

Ref document number: 6376921

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150