JP2019062816A - Travel position recognition system, travel vehicle for farm work, and unmanned automatic travel work vehicle - Google Patents

Travel position recognition system, travel vehicle for farm work, and unmanned automatic travel work vehicle Download PDF

Info

Publication number
JP2019062816A
JP2019062816A JP2017192099A JP2017192099A JP2019062816A JP 2019062816 A JP2019062816 A JP 2019062816A JP 2017192099 A JP2017192099 A JP 2017192099A JP 2017192099 A JP2017192099 A JP 2017192099A JP 2019062816 A JP2019062816 A JP 2019062816A
Authority
JP
Japan
Prior art keywords
traveling
travel
sensor
recognition system
traveling device
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
JP2017192099A
Other languages
Japanese (ja)
Other versions
JP6458258B1 (en
Inventor
博司 竹之内
Hiroshi Takenouchi
博司 竹之内
雄二 松元
Yuji Matsumoto
雄二 松元
加藤 正明
Masaaki Kato
正明 加藤
浩二 今西
Koji Imanishi
浩二 今西
淳一 山崎
Junichi Yamazaki
淳一 山崎
一富 里中
Kazutomi Satonaka
一富 里中
裕信 深水
Hironobu Fukamizu
裕信 深水
啓介 飯牟▲禮▼
Keisuke Iimure
啓介 飯牟▲禮▼
淳也 浅井
Junya Asai
淳也 浅井
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.)
NIPPON KEIKI KAGOSHIMA
Matsumoto Kiko Co Ltd
Kagoshima Prefecture
Original Assignee
NIPPON KEIKI KAGOSHIMA
Matsumoto Kiko Co Ltd
Kagoshima Prefecture
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 NIPPON KEIKI KAGOSHIMA, Matsumoto Kiko Co Ltd, Kagoshima Prefecture filed Critical NIPPON KEIKI KAGOSHIMA
Priority to JP2017192099A priority Critical patent/JP6458258B1/en
Application granted granted Critical
Publication of JP6458258B1 publication Critical patent/JP6458258B1/en
Publication of JP2019062816A publication Critical patent/JP2019062816A/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

To provide a travel position recognition system for grasping and controlling a travel position of a travel device in a width direction of a ridge of a farm crop or the like, a travel vehicle for farm work and an unmanned automatic travel work vehicle which use the same and travel along the ridge.SOLUTION: There is provided a travel position recognition system for grasping and controlling a travel position in a ridge width direction of the ridge of a travel device traveling along the ridge, comprising: a left/right sensor which is arranged on a front side of a travel direction of the travel device and detects the ridge; and a calculator which calculates a travel position of the travel device in the ridge width direction, based on difference information of a distance between an object and the left/right sensor acquired by the left/right sensor.SELECTED DRAWING: Figure 8

Description

本発明は、農作物などの畝の幅方向における走行装置の走行位置を把握、制御する走行位置認知システム、それを利用した畝に沿って走行する、農作業用走行車、及び無人自動走行作業車等に関する。   The present invention relates to a traveling position recognition system for grasping and controlling a traveling position of a traveling device in a width direction of an eyebrow such as agricultural products, an agricultural traveling vehicle traveling along an eyebrow using the same, an unmanned automatic traveling vehicle, etc. About.

出願人は、無人自動走行作業システム、自動走行式茶摘採機として、特許文献3の発明を公開している。   The applicant has disclosed the invention of Patent Document 3 as an unmanned automatic traveling work system and an automatic traveling type tea-picking machine.

特許文献1の発明の前提は、以下の通りである。
図5に示すような、従来の自動走行式茶摘採機12は、特許文献1、2に開示されている。
特許文献1に記載の「自動走行式茶摘採機」は、誰でも簡単に運転でき、かつ、古葉の混入や浅摘みや深摘みが生じない自動走行式茶摘採機であって、第1駆動回路25と第2駆動回路26とは左右の無限走行装置を互いに独立して駆動する。左右の感知板43、44は、茶園畝53の両側部53a、53bの位置を検知する。感知板43、44の回転角に基づく両可変抵抗器47、48の抵抗差が所定値になると、2位置切換弁35、36の何れか一方がシンボルb側に切り替えられ、油圧モータ29、30のうち対応する油圧モータの回転数を低下させる。こうして、感知板43、44によって検知される茶園畝53の両側部の位置に応じて自動的に方向を変えて、自動走行式茶摘採機11は茶園畝53に正確に沿って走行する。したがって、誰でも簡単に運転でき、かつ、古葉の混入や浅摘みや深摘みが生じない。というものである。
The premise of the invention of Patent Document 1 is as follows.
Conventional self-propelled tea-picking machines 12 as shown in FIG. 5 are disclosed in Patent Documents 1 and 2.
The "automatic traveling type tea picking machine" described in Patent Document 1 is an automatic traveling type tea picking machine which can be easily operated by anyone and mixture of old leaves, shallow picking and deep picking does not occur. The drive circuit 25 and the second drive circuit 26 drive the left and right endless traveling devices independently of each other. The left and right sensing plates 43, 44 detect the positions of both side portions 53a, 53b of the tea garden fence 53. When the difference in resistance between the variable resistors 47 and 48 based on the rotation angle of the sensing plates 43 and 44 reaches a predetermined value, one of the two position switching valves 35 and 36 is switched to the symbol b side. Reduce the number of revolutions of the corresponding hydraulic motor. Thus, the direction is automatically changed in accordance with the positions of the both sides of the tea garden ridge 53 detected by the sensing plates 43 and 44, and the self-traveling tea picking machine 11 travels exactly along the tea garden ridge 53. Therefore, anyone can drive easily, and mixing of the old leaves, shallow picking and deep picking do not occur. It is said that.

他方、特許文献2に開示の「自動走行式茶摘採機」は、誰でも簡単に運転でき、かつ、古葉の混入や浅摘みや深摘みが生じない自動走行式茶摘採機であって、走行ハンドル22の回転軸にピニオン25に設けて油圧シリンダ27によって進退されるラック26で回動可能にする。左右の感知板43、44は、茶園畝53の両側部53a、53bの位置を検知する。感知板43、44の回転角に基づく両可変抵抗器47、48の抵抗差が所定値になると、電磁切換弁31が例えばシンボルaに切り換えられ、油圧シリンダ27のピストンロッド28とラック26とが前進する。そうすると、ピニオン25が右回りに回転し、走行ハンドル22も右回りに回転する。こうして、感知板43、44によって検知される茶園畝53の両側部の位置に応じて自動的に方向を変えて、自動走行式茶摘採機11は茶園畝53に正確に沿って走行する。したがって、誰でも簡単に運転でき、かつ、古葉の混入や浅摘みや深摘みが生じない。というものである。   On the other hand, the "automatic traveling type tea picking machine" disclosed in Patent Document 2 is an automatic traveling type tea picking machine which can be operated easily by anyone and mixture of old leaves, shallow picking and deep picking does not occur. The rotation shaft of the traveling handle 22 is provided on the pinion 25 and made rotatable by a rack 26 advanced and retracted by a hydraulic cylinder 27. The left and right sensing plates 43, 44 detect the positions of both side portions 53a, 53b of the tea garden fence 53. When the difference in resistance between the variable resistors 47 and 48 based on the rotation angle of the sensing plates 43 and 44 reaches a predetermined value, the electromagnetic switching valve 31 is switched to, for example, the symbol a, and the piston rod 28 and the rack 26 of the hydraulic cylinder 27 Advance. Then, the pinion 25 rotates clockwise, and the traveling handle 22 also rotates clockwise. Thus, the direction is automatically changed in accordance with the positions of the both sides of the tea garden ridge 53 detected by the sensing plates 43 and 44, and the self-traveling tea picking machine 11 travels exactly along the tea garden ridge 53. Therefore, anyone can drive easily, and mixing of the old leaves, shallow picking and deep picking do not occur. It is said that.

図5に示すような、従来の自動走行式茶摘採機12は、いずれも独立駆動する左右走行装置4a、4bと、それらに立設した門型フレーム4cと、門型フレーム4c上に設置された、前進、後進、左右旋回、速度調節の駆動指示部であるハンドル3e、起動スイッチなどの機器を備える操作部3a、走行装置4の駆動源14(エンジン)、搭乗者が着席する搭乗シートなどを備える搭乗部3bとからなり、門型フレーム4cの間に農作物を栽培する畝を跨ぎ、走行する。   As shown in FIG. 5, the conventional automatic traveling type tea picking machine 12 is installed on left and right traveling devices 4a and 4b which are independently driven, a portal frame 4c standing on them, and a portal frame 4c. In addition, forward / reverse, left / right turn, steering wheel 3e which is a drive instruction unit for speed adjustment, operation unit 3a equipped with devices such as a start switch, drive source 14 (engine) of traveling device 4, boarding seat on which a passenger is seated, etc. And travels across a fence for cultivating agricultural products between gate-shaped frames 4c.

そして、門型フレーム4cの両立設部の内側には、畝位置を感知する左右感知板13a、13bが備えられ、感知板の回転に応じて、ハンドル3eが旋回し、畝を進行する間は、畝の湾曲に追随し、自動走行可能とするものである。   The right and left sensing plates 13a and 13b for sensing the position of the eyebrow are provided inside the compatible part of the portal frame 4c, and while the handle 3e turns and advances the eyebrow according to the rotation of the sensing plate. , Following the curvature of the eyebrows, making it possible to run automatically.

しかしながら、従来の自動走行式茶摘採機12を次の作業畝に移動するためには、自動走行式茶摘採機の旋回操作が必要であり、従来は、搭乗部3bに乗車した作業者がハンドル3e(走行装置の回転方向)を操作して、農作業機械を旋回させていた。これには、熟練した技術を要し、狭い茶園、特に山間地にあるテラス式茶園などでは危険度が高くなり、農作業事故(死亡事故を含む)も発生しやすかった。  However, in order to move the conventional automatic traveling type tea-picking machine 12 to the next work group, the turning operation of the automatic traveling type tea-picking machine is necessary, and conventionally, the operator who got on the boarding portion 3b handles the steering wheel. The farm work machine was turned by operating 3e (rotational direction of traveling device). This required skilled skills, and the risk was high in narrow tea gardens, especially in terraced tea gardens in mountainous areas, and it was easy for farm work accidents (including fatal accidents) to occur.

同様に、図6、7に示すような、従来の乗用型茶木畝上面異物吸引装置16、従来の乗用型茶畝用農薬散布機15であっても、畝間の移動には畝端での農作業機械の旋回操作を必要とする。   Similarly, even with the conventional riding type tea tree top surface foreign matter suction device 16 as shown in FIGS. It requires the turning operation of the machine.

上述のように、農作業機械の旋回は、危険な上、乗用型であっても精神的労働負荷が高いと言われ、広大の圃場ではさらに負荷が高まる。加えて、農業就業者の高齢化、減少が進行しており、さらなる農作業軽減、省力化、効率化のため、一層の農作業機械の自動化が求められていた。   As mentioned above, turning of agricultural machinery is dangerous, and it is said that the mental workload is high even if it is a passenger type, and the load is further increased in a large field. In addition, the aging and decreasing number of agricultural workers are progressing, and further automation of agricultural work machines is required for further reduction of agricultural work, labor saving, and efficiency improvement.

そこで、特許文献3の発明は、圃場における農作業機械の畝間の移動や旋回のために、農作業機械の旋回操作を必要とせず、遠隔制御可能な無人自動走行作業システム、特に、自動走行式茶摘採機に最適なシステム、及びそれを備えた農業作業機械を提供することを目的とする。   Therefore, the invention of Patent Document 3 is an unmanned automatic traveling work system capable of remote control, in particular, an automatic traveling type tea-picking system, which does not require a turning operation of the agricultural working machine for moving or turning between agricultural machinery in a field. An object of the present invention is to provide an optimum system for a machine and an agricultural working machine equipped with the system.

具体的には、特許文献3の発明は、請求の範囲に記載の通り(特許査定時)、
[請求項1]
自動走行可能な走行装置と、前記走行装置上に設置され操作部を含む載置部とで構成される農業作業機械に用いられ、前記農作業機械を次の畝又は畝間に自動で旋回、進入させる無人自動走行作業システムであって、
前記畝の端を感知して知らせる第一センサ及び第二センサを備える端感知センサと、
前記旋回時に次の畝位置を感知して知らせる第三センサ及び第四センサと、
前記端感知センサ及び第三、第四センサの信号を基に前記操作部の操作を制御することで前記走行装置の走行、旋回を自動制御する制御部とからなり、
前記第一センサが載置部の走行方向の前方で畝の上に設置され、前記第二センサが載置部の走行方向の後方で畝の上に設置され、前記第三センサが前記走行装置の左外側の長手方向適所に設置され、前記第四センサが前記走行装置の右外側の長手方向適所に設置され、各種センサがそれぞれ少なくとも1個以上設置されることを特徴とする無人自動走行作業システム。
[請求項2]
前記端感知センサが、畝の端をはじめに感知する第一センサと、前記第一センサの後に再度畝の端を感知する第二センサを備え、
前記第一センサによって前記畝の端を感知した後、前記走行装置の走行速度を減速させ、前記第二センサによって前記畝の端を感知した後、一定距離走行させることを特徴とする請求項1に記載の無人自動走行作業システム。
[請求項3]
前記端感知センサ、第三センサ及び第四センサが、位置検出センサであることを特徴とする請求項1又は請求項2に記載の無人自動走行作業システム。
[請求項4]
さらに、停止センサを備え、あらかじめ設置した感知デバイスを感知した後、作業及び走行を停止させることを特徴とする請求項1〜請求項3の何れか1項に記載の無人自動走行作業システム。
[請求項5]
さらに、方位センサを備え、前記旋回角度精度を向上させたことを特徴とする請求項1〜請求項4の何れか1項に記載の無人自動走行作業システム。
[請求項6]
前記走行装置の前進及び旋回動作を、前記操作部のアクチュエータの動作で制御し、前記アクチュエータの動作を、前記各種センサの感知に同期させてコントロールする制御部によって自動制御することを特徴とする請求項1〜請求項5の何れか1項に記載の無人自動走行作業システム。
[請求項7]
請求項1〜請求項6の何れか1項に記載の無人自動走行作業システムを備えたことを特徴とする農作業機械。
[請求項8]
前記農作業機械が、茶園で用いられることを特徴とする請求項7に記載の農作業機械。
[請求項9]
前記走行装置が、茶木の畝に沿って自動走行可能な走行装置とした自動走行式茶摘採機であることを特徴とする請求項8に記載の農作業機械。
というものである。
Specifically, the invention of Patent Document 3 is as described in the claims (at the time of patent assessment),
[Claim 1]
It is used for an agricultural work machine consisting of a traveling device capable of automatic traveling and a placing part installed on the traveling device and including an operation part, and the agricultural working machine is automatically turned and advanced between the following fences or fences It is an unmanned automatic traveling work system,
An edge sensing sensor comprising a first sensor and a second sensor that senses and informs the edge of the weir;
A third sensor and a fourth sensor for sensing and informing the next heel position at the time of turning;
The control unit automatically controls traveling and turning of the traveling device by controlling the operation of the operation unit based on the signals from the end detection sensor and the third and fourth sensors.
The first sensor is installed on the weir on the front in the traveling direction of the mounting unit, the second sensor is installed on the weir on the rear in the traveling direction of the mounting unit, and the third sensor is the traveling device Unmanned automatic traveling work characterized in that the fourth sensor is installed in the left outer longitudinal right place of the vehicle, the fourth sensor is installed in the right outer longitudinal right place of the traveling device, and at least one of various sensors is installed. system.
[Claim 2]
The edge sensing sensor comprises a first sensor that senses the edge of the heel first, and a second sensor that senses the edge of the heel again after the first sensor,
After the end of the heel is detected by the first sensor, the traveling speed of the traveling device is reduced, and after the end of the heel is detected by the second sensor, the vehicle is allowed to travel for a certain distance. Unmanned automatic traveling work system described in.
[Claim 3]
The unmanned automatic traveling work system according to claim 1 or 2, wherein the end detection sensor, the third sensor and the fourth sensor are position detection sensors.
[Claim 4]
The unmanned automatic traveling work system according to any one of claims 1 to 3, further comprising a stop sensor to stop operation and traveling after sensing a previously installed sensing device.
[Claim 5]
The unmanned automatic traveling work system according to any one of claims 1 to 4, further comprising a direction sensor to improve the turning angle accuracy.
[Claim 6]
The control unit controls the forward movement and the turning movement of the traveling device by the operation of the actuator of the operation unit, and automatically controls the operation of the actuator by a control unit that controls the operation in synchronization with the detection of the various sensors. The unmanned automatic traveling work system according to any one of claims 1 to 5.
[Claim 7]
An agricultural work machine comprising the unmanned automatic traveling work system according to any one of claims 1 to 6.
[Claim 8]
The agricultural working machine according to claim 7, wherein the agricultural working machine is used in a tea garden.
[Claim 9]
9. The agricultural work machine according to claim 8, wherein the traveling device is an automatic traveling type tea-picking machine which is a traveling device capable of automatically traveling along a pot of tea tree.
It is said that.

その結果、畝端、又は感知デバイスを感知するセンサにより、旋回位置を特定し、予めプログラムされている旋回動作、さらには、畝状況、方位情報を元に、次の作業をする畝に自動かつ正確に農作業機械を向けさせ(旋回させ)、進入させることができる。その結果、農作業機械の人的運転操作が削減され、農作業負荷の軽減、省力化、効率化が図られる。さらに、夜行性の病害虫に対する夜間作業や、化学農薬等の散布者への暴露防止など、新たな茶の生産体系構築が可能である。また、少人数の作業者で、さらには農作業機械の旋回操作に慣れていない作業者であっても容易に農作業機械を遠隔制御でき、安全に農作業を行うことができるので、農作業事故が減少することとなる。 As a result, a sensor that senses the edge or the sensing device identifies the pivot position, and automatically performs the next operation based on the pre-programmed pivoting motion, further, the mastication status and the direction information. The farm work machine can be directed (turned) and approached accurately. As a result, the human operation operation of the agricultural working machine is reduced, and the reduction of agricultural workload, labor saving and efficiency can be achieved. In addition, it is possible to construct a new tea production system, such as night work for nocturnal diseases and pests, and prevention of exposure of chemical pesticides to sprayers. In addition, even with a small number of workers and even workers who are not accustomed to turning operations of agricultural working machines, it is possible to easily remotely control agricultural working machines and safely perform agricultural work, thus reducing agricultural work accidents. It will be.

特許文献3の発明は、特許文献3の明細書に記載の通りで、以下に改めて説明する。合わせて、図面を参照されたい。 The invention of Patent Document 3 is as described in the specification of Patent Document 3 and will be described again below. Please refer to the drawings.

図1、図2、図5に示すように、無人自動走行作業システムを備えた自動走行式茶摘採機1は、従来の自動走行式茶摘採機12と同様に、走行装置4と、門型フレーム4cと、載置部3とを備え、さらに無人自動走行作業システム2を備えてなり、畝進行時については、従来の特許文献1、2などの制御手段を採用することで、自動走行が可能になる。従来の直進的な自動走行技術についてはその説明を簡略化する。   As shown in FIG. 1, FIG. 2 and FIG. 5, the automatic traveling type tea-plucking machine 1 equipped with an unmanned automatic traveling operation system is, like the conventional automatic traveling-type tea plucking machine 12, a traveling device 4 and a portal type It is equipped with the frame 4c and the mounting part 3, and further comprises the unmanned automatic traveling work system 2, and when traveling on the weir, by adopting control means such as conventional patent documents 1 and 2, automatic traveling It will be possible. The description of the conventional straight advance automatic travel technology will be simplified.

走行装置4は、図5に示すように、左右独立に回転駆動制御され、前進、後進、方向転換、停止位置での回転が可能なクローラー式の回転体である左右走行装置4a、4bからなる。   As shown in FIG. 5, the traveling device 4 includes left and right traveling devices 4a and 4b, which are crawler-type rotating bodies that are rotationally driven and controlled independently to the left and right, and can rotate in forward, reverse, change direction, and stop position. .

門型フレーム4cは、左右走行装置4a、4bから立設して、その上に載置部3を備え、門型フレーム4cと載置部3の底面とで、畝11を跨ぐ。門型フレーム4cの柱には、門内(跨いだ畝11)に向け、特許文献1、2のように、左右感知板13a、13bが備えられ、畝に沿った直進的な自動走行を可能にする。   The portal frame 4c is erected from the left and right traveling devices 4a and 4b, and is provided thereon with the placement unit 3. The portal frame 4c and the bottom surface of the placement unit 3 straddle the weir 11. The pillars of the portal frame 4c are provided with left and right sensing plates 13a and 13b toward the inside of the portal (cross over the ridge 11), as in Patent Documents 1 and 2, to enable straight automatic traveling along the ridge Do.

載置部3は、門型フレーム4cを介して、走行装置4上に設定され、座席ハンドル3eを含む操作部3a、搭乗シートなどを備える搭乗部3b、エンジンなどの駆動源14、その他作業機器、ここでは茶葉摘採部12aに関連する機器などを備える。操作部3aのハンドル3eで走行装置4が操作され、その操作は、旋回時は、無人自動走行作業システム2によって自動制御される。操作部3aには、走行装置4の無人自動走行作業システム2による自動制御と、作業者による通常操作を切り換える、自動、手動モードを備えた切換スイッチ3nが備えられる。   The placement unit 3 is set on the traveling device 4 through the portal frame 4c, and includes an operation unit 3a including a seat handle 3e, a riding unit 3b including a boarding seat, a drive source 14 such as an engine, and other work equipment , Here, equipment and the like related to the tea leaf extraction unit 12a. The traveling device 4 is operated by the handle 3e of the operation unit 3a, and the operation is automatically controlled by the unmanned automatic traveling work system 2 when turning. The operation unit 3a is provided with a changeover switch 3n having automatic and manual modes for switching between the automatic control by the unmanned automatic traveling work system 2 of the traveling device 4 and the normal operation by the operator.

無人自動走行作業システム2は、図1(B)、図2に示すように、制御部2aと、制御部2aへの入力側である、非常停止スイッチ2bと、スタートスイッチ2eと、第一センサ5と、第二センサ6と、第三センサ7と、第四センサ8と、停止センサ9aと、及び制御部2aの出力側である、前進制御系2pと、旋回制御系2qと、機械停止2rと、エンジン停止2sからなる。これらは、バッテリ14aから駆動電源を得る。   As shown in FIG. 1 (B) and FIG. 2, the unmanned automatic traveling work system 2 includes a control unit 2a, an emergency stop switch 2b which is an input side to the control unit 2a, a start switch 2e, and a first sensor 5, the second sensor 6, the third sensor 7, the fourth sensor 8, the stop sensor 9a, and the forward control system 2p, the turn control system 2q, and the machine stop, which are the output sides of the control unit 2a It consists of 2r and engine stop 2s. These obtain drive power from the battery 14a.

制御部2aは、各種センサから出力される入力信号2tを受け、予め設定されたプログラムを実行すべく、出力側に各種制御信号2uを送るPLCで、状況に応じて前記プログラムと現状のズレを比較し、比較結果に基づき修正命令を出力側に送信する。タイマー機能なども含まれる。走行装置4の走行距離を、タイマーによって、時間で制御することもできる。   The control unit 2a is a PLC that sends various control signals 2u to the output side to receive an input signal 2t output from various sensors and execute a preset program, and the difference between the program and the current state according to the situation The comparison is performed, and the correction instruction is sent to the output side based on the comparison result. The timer function is also included. The traveling distance of the traveling device 4 can also be controlled by time by a timer.

制御部2aによる具体的な制御方法については、該当箇所で説明する。主に端感知センサ及び第三センサ7、第四センサ8の信号を基に操作部3aの操作を制御することで、走行装置4の隣の畝11bへの旋回、進入を自動制御する。   The specific control method by the control unit 2a will be described in the corresponding section. By controlling the operation of the operation unit 3a mainly based on the signals of the end detection sensor and the third sensor 7 and the fourth sensor 8, the turning and the approach to the weir 11b next to the traveling device 4 are automatically controlled.

次に図1、2を参照しながら入力側について詳しく説明する。
非常停止スイッチ2bは、リモコン2cの電波2dで動作し、任意に、また危険時などに、走行装置4の走行又は茶葉摘採部12aの運転を停止するためのスイッチで、作業管理者がリモコン2cを所持し、必要に応じて、圃場10(茶畑)などにいる管理者がリモコン2cを操作することで、所望の停止を可能にする。また駆動源14であるエンジンも停止可能である。
Next, the input side will be described in detail with reference to FIGS.
The emergency stop switch 2b is operated by the radio wave 2d of the remote control 2c and is a switch for stopping the traveling of the traveling device 4 or the operation of the tea leaf removing unit 12a at any time or in danger. The manager in the field 10 (tea plantation) or the like operates the remote control 2c to enable a desired stop, as needed. In addition, the engine that is the drive source 14 can also be stopped.

スタートスイッチ2eは、操作部3aの切換スイッチ3nを自動モードにした後、操作できるもので、管理者がスタートスイッチ2eをオンにすると、無人自動走行作業システム2が、起動して、走行装置4の走行、旋回を自動制御する。   The start switch 2e can be operated after setting the changeover switch 3n of the operation unit 3a to the automatic mode, and when the administrator turns on the start switch 2e, the unmanned automatic traveling work system 2 is activated and the traveling device 4 is operated. Automatic control of traveling and turning.

第一センサ5は、図1に示すように、載置部3の走行方向1b(一点鎖線矢印)の前方で畝11の上に設置され、畝11の端を初めに感知する端感知センサである。第一センサ5としては、例えば、音波センサ等の位置検出センサが例示できる。第二、第三、第四センサも同様である。また畝での感知が困難な場合、畝の代わりとして感知デバイスを設置してもよい。   As shown in FIG. 1, the first sensor 5 is installed on the crucible 11 in front of the traveling direction 1b of the mounting unit 3 (one-dotted chain arrow), and is an edge sensor that senses the edge of the crucible 11 first. is there. As the first sensor 5, for example, a position detection sensor such as a sound wave sensor can be exemplified. The same applies to the second, third and fourth sensors. Also, if it is difficult to detect with a sputum, a sensing device may be installed instead of the sputum.

第一センサ5による作業中の畝11aの端感知により、制御部2aの命令で走行装置4の走行速度は低速に制御される。他方、次の作業場所である隣の畝11bに進入するときも畝11の端を最初に感知し、制御部2aの命令で走行装置4の走行速度は高速に制御される。   By detecting the end of the crucible 11a in operation by the first sensor 5, the traveling speed of the traveling device 4 is controlled to a low speed by an instruction of the control unit 2a. On the other hand, when entering the next work area 11b next to the work area, the end of the work area 11 is first detected, and the traveling speed of the traveling device 4 is controlled at high speed by the command of the control unit 2a.

第二センサ6は、図1に示すように、載置部3の走行方向1bの後方で畝11の上に設置され、第一センサ5の畝端感知の後に再度畝11の端を感知する端感知センサである。   As shown in FIG. 1, the second sensor 6 is installed on the crucible 11 behind the traveling direction 1b of the placement unit 3 and senses the end of the crucible 11 again after the detection of the crucible end of the first sensor 5 It is an edge detection sensor.

第二センサ6による作業中の畝11aの端感知(終点位置1c)により、走行装置4は制御部2aの制御により所定距離走行し、旋回位置1dまで低速で走行する。その後、旋回制御系2qが実行される。   The traveling device 4 travels a predetermined distance under the control of the control unit 2a by the end detection (end point position 1c) of the crucible 11a during work by the second sensor 6, and travels at a low speed to the turning position 1d. Thereafter, the turning control system 2 q is executed.

第三センサ7は、図1(B)に示すように、走行方向1bに対して走行装置4の左外側の長手方向適所に設置され、図1(A)に示すように、走行装置4の第1回目の旋回後に次の畝11を感知して、制御部2aに次の畝11の位置を知らせ、第2回目の旋回位置を決定するためのセンサである。第四センサ8も同じである。走行装置4の旋回方向によって、用いられる旋回位置を決定するセンサ(第三、第四センサ7、8)は異なる。   The third sensor 7 is installed at an appropriate position on the left outside of the traveling device 4 in the longitudinal direction with respect to the traveling direction 1b as shown in FIG. 1 (B), and as shown in FIG. It is a sensor for detecting the next crucible 11 after the first turning and notifying the control unit 2a of the position of the next crucible 11 to determine the second turning position. The fourth sensor 8 is also the same. Depending on the turning direction of the traveling device 4, the sensors (third and fourth sensors 7, 8) for determining the turning position to be used differ.

第四センサ8は、図1(B)に示すように、走行方向1bに対して走行装置4の右外側の長手方向適所に設置され、図1(A)に示すように、走行装置4の第1回目の旋回後に次の畝11を感知して、制御部2aに次の畝11の位置を知らせ、第2回目の旋回位置を決定するためのセンサである。   The fourth sensor 8 is installed at an appropriate position on the right outside of the traveling device 4 in the longitudinal direction with respect to the traveling direction 1b, as shown in FIG. 1B, and as shown in FIG. It is a sensor for detecting the next crucible 11 after the first turning and notifying the control unit 2a of the position of the next crucible 11 to determine the second turning position.

停止センサ9aは、図1(B)に示すように、載置部3の走行方向1bの後方で畝11の上に設置され、図1(A)に示すように、所望の停止位置に置かれた停止指示部材9を感知して、制御部2aに送信する。制御部2aは、停止位置信号の入力後、少なくとも、走行装置4を停止する。その他の機器を停止させてもよい。停止センサ9aとしては、例えば、光反射センサが例示でき、停止指示部材9の反射光を感知する。停止指示部材9は適所に設置でき、停止センサ9aも停止指示部材9の位置に対応し適所に設定できる。停止指示部材9は、停止信号を発信するデバイスなどであってもよく、その場合には、停止センサは停止信号を受信するセンサとする。   The stop sensor 9a is installed on the weir 11 behind the traveling direction 1b of the mounting unit 3 as shown in FIG. 1 (B), and placed at a desired stop position as shown in FIG. 1 (A) It senses the stop instruction member 9 and sends it to the control unit 2a. The control part 2a stops the traveling device 4 at least after the input of the stop position signal. Other devices may be shut down. For example, a light reflection sensor can be exemplified as the stop sensor 9a, and the reflected light of the stop instructing member 9 is sensed. The stop instructing member 9 can be installed at an appropriate position, and the stop sensor 9 a can be set at an appropriate position corresponding to the position of the stop instructing member 9. The stop instruction member 9 may be a device or the like that transmits a stop signal, and in this case, the stop sensor is a sensor that receives the stop signal.

次に、図1−4を参照しながら出力側について、説明する。
前進制御系2pは、走行装置4の前進時のハンドル3eの位置制御のことである。ここでは、図3に示す、制御部2a、弁3l、第一アクチュエータ3fによって、走行装置4の所望の走行速度を制御する。
Next, the output side will be described with reference to FIGS. 1-4.
The forward control system 2p is a position control of the steering wheel 3e when the traveling device 4 advances. Here, a desired traveling speed of the traveling device 4 is controlled by the control unit 2a, the valve 3l and the first actuator 3f shown in FIG.

旋回制御系2qは、走行装置4を左右方向へ旋回させるためのハンドル3eの位置制御のことである。ここでは、図4に示す、制御部2a、弁3m、第二アクチュエータ3iによって、走行装置4の所望の旋回動作を制御する。   The turning control system 2 q is a position control of the steering wheel 3 e for turning the traveling device 4 in the left and right direction. Here, the desired turning operation of the traveling device 4 is controlled by the control unit 2a, the valve 3m, and the second actuator 3i shown in FIG.

機械停止2rは、走行装置4の走行または茶葉摘採部12a、その他作業機器の運転を停止させる制御である。   The machine stop 2 r is control for stopping the traveling of the traveling device 4 or the operation of the tea-plucking unit 12 a and other working devices.

エンジン停止2sは、駆動源14の駆動を停止する制御である、或いは、駆動源14の駆動の伝達を遮断する制御である。   The engine stop 2 s is control for stopping the drive of the drive source 14 or control for blocking the transmission of the drive of the drive source 14.

また、無人自動走行作業システム2は、必要に応じて、図1(B)に示すように、方位センサ2fを備える。方位センサ2fは、旋回時の回転角を方位により正確に判断するためのセンサである。方位センサ2fを備えることで、走行装置4の旋回角度精度が高まる。   In addition, the unmanned automatic traveling work system 2 is provided with a direction sensor 2 f as shown in FIG. 1 (B), as necessary. The orientation sensor 2 f is a sensor for accurately determining the rotation angle at the time of turning based on the orientation. By providing the direction sensor 2 f, the turning angle accuracy of the traveling device 4 is enhanced.

さらに、無人自動走行作業システム2は、必要に応じて、図3、4に示すように、第五センサ〜第十センサ(2g〜2n)を備える。これらは、ハンドル3eの制御を2軸(両方向)アクチュエータで行う場合の動作確認センサであり、アクチュエータが規定の動作をしていない場合には、制御部2aが再度の制御指示を各駆動部に指示する、一種の安全装置である。   Furthermore, as shown in FIGS. 3 and 4, the unmanned automatic traveling work system 2 includes fifth to tenth sensors (2g to 2n) as shown in FIGS. These are operation confirmation sensors in the case where control of the handle 3e is performed by a two-axis (two-way) actuator, and when the actuator does not perform a prescribed operation, the control unit 2a gives another control instruction to each drive unit. It is a kind of safety device to instruct.

第五センサ2g、第六センサ2h、第七センサ2iは、より具体的には、図3に示すように、走行装置4のクローラーの回転方向が正しいか否かの判断信号を制御部2aに送信するセンサである。より詳しくは、ハンドル3eの左右方向の位置を確認するセンサで、第二アクチュエータ3iのピストンロッド3kの位置を監視し、その監視結果を制御部2aに送信(一点鎖線矢印)する。その監視結果に基づき、制御部2aは、現時点のピストンロッド3kの位置が所望の動作に適合するか否か判断する。ピストンロッド3kが所望の位置でない場合には、制御部2aは再度の命令を第二アクチュエータ3iの動作を制御する弁3m(例えば電磁弁)に制御命令を送信(一点鎖線矢印)し、正しく動作させる。   More specifically, as shown in FIG. 3, the fifth sensor 2g, the sixth sensor 2h, and the seventh sensor 2i determine to the control unit 2a whether the rotation direction of the crawler of the traveling device 4 is correct or not. It is a sensor to transmit. More specifically, the position of the piston rod 3k of the second actuator 3i is monitored by a sensor for confirming the position of the handle 3e in the left-right direction, and the monitoring result is transmitted to the control unit 2a (dashed dotted arrow). Based on the monitoring result, the control unit 2a determines whether the current position of the piston rod 3k conforms to a desired operation. If the piston rod 3k is not at the desired position, the control unit 2a transmits a control command to the valve 3m (for example, a solenoid valve) that controls the operation of the second actuator 3i (the alternate long and short dash line arrow). Let

第八センサ2k、第九センサ2m、第十センサ2nは、より具体的には、図4に示すように、走行装置4のクローラーの回転速度が正しいか否かの判断信号を制御部2aに送信するセンサである。より詳しくは、ハンドル3eの前方向の位置を確認するセンサで、第一アクチュエータ3fのピストンロッド3hの位置を監視し、その監視結果を制御部2aに送信(一点鎖線矢印)する。その監視結果に基づき、制御部2aは、現時点のピストンロッド3hの位置が所望の動作に適合するか否か判断する。ピストンロッド3hが所望の位置でない場合には、制御部2aは再度の命令を第一アクチュエータ3fの動作を制御する弁3l(例えば電磁弁)に制御命令を送信(一点鎖線矢印)し、正しく動作させる。   More specifically, as shown in FIG. 4, the eighth sensor 2k, the ninth sensor 2m, and the tenth sensor 2n determine to the control unit 2a a determination signal as to whether or not the rotation speed of the crawler of the traveling device 4 is correct. It is a sensor to transmit. More specifically, the position of the piston rod 3h of the first actuator 3f is monitored by a sensor that confirms the forward position of the handle 3e, and the monitoring result is transmitted to the control unit 2a (dashed dotted arrow). Based on the monitoring result, the control unit 2a determines whether the current position of the piston rod 3h conforms to a desired operation. If the piston rod 3h is not at the desired position, the control unit 2a sends a control command to the valve 3l (for example, a solenoid valve) that controls the operation of the first actuator 3f (a dot-and-dash line arrow). Let

無人自動走行作業システムを備えた自動走行式茶摘採機1は、無人自動走行作業システム2によって、図1(A)に示す、旋回が可能になる。以下、走行、旋回、停止、その制御について、図1を参照しながら、詳しく説明する。   The automatic traveling type tea picking machine 1 equipped with the unmanned automatic traveling work system can be turned by the unmanned automatic traveling work system 2 as shown in FIG. 1 (A). Hereinafter, traveling, turning, stopping, and control thereof will be described in detail with reference to FIG.

作業者が、無人自動走行作業システムを備えた自動走行式茶摘採機1を、圃場10の開始位置1aに、手動で移動させる。その後、作業者又は管理者が、ハンドル3eを前進方向、左右旋回方向ともに、中立位置(図3、4参照)に位置する。そして、切換スイッチ3nを自動モードに切り換え、スタートスイッチ2eをオンにして、無人自動走行作業システム2を起動すると、制御部2aが、前進制御系2pで、ハンドル3eを前進低速位置(図3(B))に移行制御し、走行装置4の低速自動走行が開始される。   The operator manually moves the automatic traveling type tea-picking machine 1 equipped with the unmanned automatic traveling work system to the start position 1 a of the field 10. Thereafter, the operator or the manager positions the handle 3e in the neutral position (see FIGS. 3 and 4) in both the forward direction and the left and right turning direction. Then, when the changeover switch 3n is switched to the automatic mode and the start switch 2e is turned on to start the unmanned automatic traveling work system 2, the control unit 2a advances the steering wheel 3e to the low speed forward position by the forward control system 2p (FIG. Transition control is performed to B) and low speed automatic traveling of the traveling device 4 is started.

第一センサ5が、畝11の端(作業開始位置)を感知したならば、制御部2aが、前進制御系2pで、ハンドル3eを前進高速位置(図3(C))に移行制御し、走行装置4の高速自動走行が開始される。無人自動走行作業システムを備えた自動走行式茶摘採機1が、作業中の畝11aに沿って走行中は、従来の自動走行システム(左右感知板13a、13bとその制御系)によって、畝11の側面形状にしたがって、高速で前進自動走行するとともに、摘採を開始する。   When the first sensor 5 senses the end of the eyelid 11 (work start position), the control unit 2a controls the forward movement control system 2p to shift the handle 3e to the forward high speed position (FIG. 3C), The high-speed automatic traveling of the traveling device 4 is started. While the automatic traveling type tea-picking machine 1 equipped with an unmanned automatic traveling work system is traveling along the working crucible 11a, the conventional automatic traveling system (left and right sensing plates 13a, 13b and its control system) In accordance with the side shape of the automatic forward traveling at high speed and start picking.

走行装置4を走行させながら、摘採作業を進め、作業中の畝11aの端位置を第一センサ5が感知すると、制御部2aによって、前進制御系2pを低速制御(図3(B))に移行させる。その後、第二センサ6が作業中の畝11aの端位置を感知すると(終点位置1c)、制御部2aが、予め設定されていた移動距離にしたがって、走行装置4を直進させ、最初の旋回位置1dに位置させる。このとき、第二センサ6の作業中の畝11aの端位置感知に同期させて茶葉摘採部12aの運転を停止させてもよい。   While the traveling device 4 is traveling, the picking operation is advanced, and when the first sensor 5 detects the end position of the crucible 11a in operation, the control unit 2a controls the forward control system 2p to low speed control (FIG. 3B). Migrate. Thereafter, when the second sensor 6 senses the end position of the crucible 11a in operation (end point position 1c), the control unit 2a causes the traveling device 4 to go straight according to the preset movement distance, and the first turning position Position 1d. At this time, the operation of the tea leaf picking unit 12a may be stopped in synchronization with the end position detection of the eyelid 11a during the operation of the second sensor 6.

最初の旋回位置1dでは、制御部2aが、旋回制御系2qを右旋回位置(図4(B))に移行させる。ここで、走行装置4は、予め制御部2aに設定されていた90°旋回をする。又は、方位センサ2fの情報に基づき、隣の畝11bの延長線と直交する方向に走行装置4の進行方向が向けられる。   In the first turning position 1d, the control unit 2a shifts the turning control system 2q to the right turning position (FIG. 4 (B)). Here, the traveling device 4 turns 90 ° which is set in advance in the control unit 2a. Alternatively, based on the information of the direction sensor 2f, the traveling direction of the traveling device 4 is directed in the direction orthogonal to the extension line of the adjacent weir 11b.

なお、走行装置4が、左旋回するときは、制御部2aが、旋回制御系2qを左旋回位置(図4(C))に移行制御する。第2の旋回位置での左旋回も同じである。   When the traveling device 4 turns to the left, the control unit 2a controls the shift control system 2q to shift to the left turning position (FIG. 4C). The left turn at the second turn position is the same.

走行装置4の第1回目の旋回が終了し、第四センサ8が隣の畝11bを感知するまで、走行装置4は低速走行(図3(B))する。   The traveling device 4 travels at a low speed (FIG. 3 (B)) until the first turning of the traveling device 4 ends and the fourth sensor 8 senses the adjacent weir 11 b.

第四センサ8が隣の畝11bを感知すると、走行装置4は第2の旋回位置1dで、制御部2aが、旋回制御系2qを右旋回位置(図4(B))に移行させる。ここで、走行装置4は、予め制御部2aに設定されていた90°旋回をする。又は、方位センサ2fの情報に基づき、隣の畝11bの延伸線と平行する方向に走行装置4の進行方向が向けられる。このような制御で、走行装置4は、旋回軌道1eに沿って旋回する。走行装置4は、旋回位置1dで前進方向に走行せず点対象の回転でなく、走行装置4が走行しながら旋回することもできる。その場合には、半円状の旋回軌道となる。   When the fourth sensor 8 senses the adjacent hook 11b, the control unit 2a shifts the turning control system 2q to the right turning position (FIG. 4B) at the second turning position 1d. Here, the traveling device 4 turns 90 ° which is set in advance in the control unit 2a. Alternatively, based on the information of the direction sensor 2f, the traveling direction of the traveling device 4 is directed in the direction parallel to the extension line of the adjacent weir 11b. Under such control, the traveling device 4 turns along the turning track 1e. The traveling device 4 does not travel in the forward direction at the turning position 1 d, and can turn while the traveling device 4 travels, not the rotation of a point target. In that case, it becomes a semicircular turning track.

その後、第一センサ5が隣の畝11bの開始端を検知するまで、走行装置4は低速走行する。   Thereafter, the traveling device 4 travels at low speed until the first sensor 5 detects the start end of the adjacent hook 11b.

第一センサ5が、隣の畝11bの開始端を検知した位置(再開位置1f)で、制御部2aが、前進制御系2pを高速位置(図3(C))に移行させる。その後、走行装置4は、従来の自動走行システム(左右感知板13a、13bとその制御系)によって、畝11の側面形状にしたがって、高速で前進自動走行するとともに、摘採を開始する。   The control unit 2a shifts the forward control system 2p to the high-speed position (FIG. 3C) at the position (restart position 1f) at which the first sensor 5 detects the start end of the adjacent crucible 11b. Thereafter, the traveling device 4 starts traveling automatically at high speed according to the side surface shape of the crucible 11 and starts picking according to the conventional automatic traveling system (right and left sensing plates 13a and 13b and its control system).

走行装置4が、作業中の畝の側面形状に沿った自動走行と、上記旋回を繰り返し、最終畝11cの端部に置かれた停止指示部材9を停止センサ9aで感知したならば、その位置、又は予め設定された距離を走行して、制御部2aによって、走行装置4は所定の位置(終了位置1g)で停止する(前進制御系2p、旋回制御系2qともに中立位置(図3(A)、図4(A)))。なお、停止指示部材9は、任意の箇所に設置することができ、走行装置4を任意の箇所で停止させることができる。   If the traveling device 4 repeats the automatic traveling along the side surface shape of the rod during work and the above-mentioned turning, and the stop instruction member 9 placed at the end of the final rod 11c is sensed by the stop sensor 9a, that position The traveling device 4 is stopped at a predetermined position (end position 1g) by the control unit 2a by traveling a predetermined distance (or both of the advancing control system 2p and the turning control system 2q are neutral positions (FIG. 3 (A ), FIG. 4 (A)). The stop instructing member 9 can be installed at any place, and the traveling device 4 can be stopped at any place.

無人自動走行作業システム2は、左右走行装置4a、4b、門型フレーム4cを備えないタイヤ走行するトラクタなどの農作業機械にも応用できる。   The unmanned automatic traveling work system 2 can also be applied to agricultural working machines such as tractors that run on tires that do not include the left and right traveling devices 4a and 4b and the portal frame 4c.

以下、図2−4を参照しながら、自動旋回制御について、より詳しく説明する。なお、ここでは、アクチュエータとして、油圧シリンダを例示したが、その他、電動シリンダ、パルスモータなども採用できる。   Hereinafter, the automatic turning control will be described in more detail with reference to FIGS. In addition, although the hydraulic cylinder was illustrated as an actuator here, in addition, an electric cylinder, a pulse motor, etc. are employable.

先ず、図3を参照して、前進制御系2pの制御を説明する。前進制御系2pは、図3(A)に示すように、載置部3などに位置固定された、第一アクチュエータ3fと、弁3lと、前述の第八センサ2kと、第九センサ2mと、第十センサ2nとからなる。なお、これらセンサは、ハンドル3eを位置判断できれば、種類、設置場所は特に限定されない。   First, control of the forward control system 2p will be described with reference to FIG. The forward control system 2p, as shown in FIG. 3A, includes a first actuator 3f, a valve 3l, the aforementioned eighth sensor 2k, and a ninth sensor 2m, which are fixed in position to the mounting portion 3 or the like. , And a tenth sensor 2n. The type and installation location of these sensors are not particularly limited as long as the position of the handle 3e can be determined.

第一アクチュエータ3fは、油圧シリンダで、固定シリンダ3gと、固定シリンダ3gの一端で油圧で挿抜され一端がハンドル3eに接続するピストンロッド3hとからなる。ピストンロッド3hの挿抜によって、ハンドル3eの前後位置が自動制御され、走行装置4の走行速度が自動制御される。   The first actuator 3f is a hydraulic cylinder, and comprises a fixed cylinder 3g and a piston rod 3h hydraulically inserted and removed at one end of the fixed cylinder 3g and connected at one end to the handle 3e. By inserting and removing the piston rod 3h, the front and back position of the handle 3e is automatically controlled, and the traveling speed of the traveling device 4 is automatically controlled.

弁3lは、固定シリンダ3gへの油圧送液、流出を制御する電磁弁などで、制御部2aの制御命令により駆動し、ピストンロッド3hの挿抜を制御する。   The valve 3l is a solenoid valve or the like that controls hydraulic fluid supply to and flow out from the fixed cylinder 3g, and is driven by a control command of the control unit 2a to control the insertion and removal of the piston rod 3h.

先ず、図3(A)は、ハンドル3eの中立位置を示しおり、走行装置4が停止している状態である。例えば、無人自動走行作業システムを備えた自動走行式茶摘採機1が、図1(A)の開始位置1a、旋回位置1d、終了位置1gで停止したときのハンドル3e位置である。ハンドル3eの中立位置は、第九センサ2mで監視し、制御部2aによって位置が保障される。   First, FIG. 3 (A) shows the neutral position of the steering wheel 3e, in which the traveling device 4 is at rest. For example, it is the position of the steering wheel 3e when the automatic traveling type tea picking machine 1 equipped with the unmanned automatic traveling work system stops at the start position 1a, the turning position 1d, and the end position 1g in FIG. The neutral position of the handle 3e is monitored by a ninth sensor 2m, and the position is ensured by the control unit 2a.

走行装置4の低速前進が必要なときは、例えば、図1に示すように、無人自動走行作業システムを備えた自動走行式茶摘採機1が、第一センサ5によって、作業中の畝11aの端を感知し、停止、又は隣の畝11bに進入するまでの間は、図3(B)に示すように、制御部2aの命令信号により、弁3lが駆動し、固定シリンダ3gから油圧でピストンロッド3hを突出させ、ハンドル3eを押し、ハンドル3eを走行装置4が低速走行する位置に位置させる。その移動を第八センサ2kで監視し、制御部2aによって位置が保障される。   When low-speed advance of the traveling device 4 is necessary, for example, as shown in FIG. 1, the automatic traveling type tea-picking machine 1 equipped with an unmanned automatic traveling work system operates the first sensor As shown in FIG. 3 (B), the valve 3l is driven by the command signal of the control unit 2a until the end is sensed and stopped, or enters the adjacent crucible 11b, and hydraulic pressure is applied from the fixed cylinder 3g. The piston rod 3h is protruded, and the handle 3e is pushed to position the handle 3e at a position where the traveling device 4 travels at low speed. The movement is monitored by an eighth sensor 2k, and the position is secured by the control unit 2a.

ハンドル3eを低速位置から高速位置に位置させるには、制御部2aが次段の動作を制御する。他方、ハンドル3eを中立位置に戻すには、ピストンロッド3hを固定シリンダ3g内に収納する油圧調整を弁3l、制御部2aで行う。   In order to position the handle 3e from the low speed position to the high speed position, the control unit 2a controls the operation of the next stage. On the other hand, in order to return the handle 3e to the neutral position, the valve 3l and the control unit 2a perform oil pressure adjustment to store the piston rod 3h in the fixed cylinder 3g.

走行装置4の高速前進が必要なときは、例えば、図1に示すように、無人自動走行作業システムを備えた自動走行式茶摘採機1が、開始位置1aから作業中の畝11aを進行方向1bに進行し、終点位置1cに至るまでの間は、図3(C)に示すように、制御部2aの命令信号により、弁3lが駆動し、固定シリンダ3gから油圧でピストンロッド3hを突出させ、さらにハンドル3eを押し込み、ハンドル3eを走行装置4が高速走行する位置に位置させる。その移動を第十センサ2nで監視し、制御部2aによって位置が保障される。   When high-speed advance of the traveling device 4 is necessary, for example, as shown in FIG. 1, the automatic traveling type tea-picking machine 1 equipped with an unmanned automatic traveling work system travels the weir 11 a in operation from the start position 1a. As shown in FIG. 3C, the valve 3l is driven by the command signal of the control unit 2a until the end position 1c is reached, and the piston rod 3h is protruded from the fixed cylinder 3g hydraulically. Further, the steering wheel 3e is pushed in to position the steering wheel 3e at a position where the traveling device 4 travels at high speed. The movement is monitored by the tenth sensor 2n, and the position is secured by the control unit 2a.

ハンドル3eを高速位置から低速位置に戻すには、ピストンロッド3hを固定シリンダ3g内に収納する油圧調整を弁3l、制御部2aで行う。   In order to return the handle 3e from the high speed position to the low speed position, the valve 3l and the control unit 2a perform oil pressure adjustment to store the piston rod 3h in the fixed cylinder 3g.

次に、図4を参照して、旋回制御系2qの制御を説明する。旋回制御系2qは、図4(A)に示すように、載置部3などに位置固定された、第二アクチュエータ3iと、弁3mと、前述の第五センサ2gと、第六センサ2hと、第七センサ2iとからなる。なお、これらセンサは、ハンドル3eを位置判断できれば、種類、設置場所は特に限定されない。   Next, control of the turning control system 2 q will be described with reference to FIG. 4. The swing control system 2q, as shown in FIG. 4A, includes a second actuator 3i, a valve 3m, the above-mentioned fifth sensor 2g, and a sixth sensor 2h, which are positionally fixed to the mounting portion 3 or the like. , And a seventh sensor 2i. The type and installation location of these sensors are not particularly limited as long as the position of the handle 3e can be determined.

第二アクチュエータ3iは、油圧シリンダで、固定シリンダ3jと、固定シリンダ3jの一端で油圧で挿抜され一端がハンドル3eに接続するピストンロッド3kとからなる。ピストンロッド3kの挿抜によって、ハンドル3eの左右位置が自動制御され、走行装置4の旋回方向が自動制御される。   The second actuator 3i is a hydraulic cylinder and comprises a fixed cylinder 3j and a piston rod 3k which is hydraulically inserted and withdrawn at one end of the fixed cylinder 3j and one end is connected to the handle 3e. By inserting and removing the piston rod 3k, the left and right positions of the handle 3e are automatically controlled, and the turning direction of the traveling device 4 is automatically controlled.

弁3mは、固定シリンダ3jへの油圧送液、流出を制御する電磁弁などで、制御部2aの制御命令により駆動し、ピストンロッド3kの挿抜を制御する。   The valve 3m is a solenoid valve or the like that controls hydraulic fluid supply to and flow out from the fixed cylinder 3j, and is driven by a control command of the control unit 2a to control insertion and removal of the piston rod 3k.

先ず、図4(A)は、図3(A)と同じで、ハンドル3eの中立位置を示しており、走行装置4が停止している状態である、当然、ハンドル3eは、左右方向への旋回位置にない。なお、旋回制御系2qのみ見れば、走行装置4の直進状態も同じである。ハンドル3eの中立位置は、第六センサ2hで監視し、制御部2aによって位置が保障される。   First, FIG. 4 (A) is the same as FIG. 3 (A) and shows the neutral position of the steering wheel 3e, and the traveling device 4 is in a stopped state. Naturally, the steering wheel 3e is in the left-right direction. It is not in the turning position. In addition, if only the turning control system 2q is seen, the straight traveling state of the traveling device 4 is the same. The neutral position of the handle 3e is monitored by a sixth sensor 2h, and the position is secured by the control unit 2a.

走行装置4の右旋回が必要なときは、例えば、図1に示すように、無人自動走行作業システムを備えた自動走行式茶摘採機1が、旋回位置1dで旋回している間は、図4(B)に示すように、制御部2aの命令信号により、弁3mが駆動し、固定シリンダ3jから油圧でピストンロッド3kを突出させ、ハンドル3eを右旋回位置(中立位置から右側)に押し込む。その移動を第五センサ2gで監視し、制御部2aによって位置が保障される。ハンドル3eを中立位置に戻すには、ピストンロッド3kを固定シリンダ3j内に収納する油圧調整を弁3m、制御部2aで行う。   When it is necessary to turn the traveling device 4 to the right, for example, as shown in FIG. 1, while the automatic traveling type tea-picking machine 1 equipped with an unmanned automatic traveling work system is turning at the turning position 1d, As shown in FIG. 4B, the valve 3m is driven by a command signal from the control unit 2a to cause the piston rod 3k to be hydraulically protruded from the fixed cylinder 3j, and the handle 3e is turned right (right from the neutral position). Push into The movement is monitored by the fifth sensor 2g, and the position is secured by the control unit 2a. In order to return the handle 3e to the neutral position, the valve 3m and the control unit 2a perform oil pressure adjustment to store the piston rod 3k in the fixed cylinder 3j.

走行装置4の左旋回が必要なときは、例えば、図1に示すように、無人自動走行作業システムを備えた自動走行式茶摘採機1が、開始位置1a側の隣の畝11へ旋回する間は、図4(C)に示すように、制御部2aの命令信号により、弁3mが駆動し、油圧で、ピストンロッド3kを、固定シリンダ3j内に収納させ、ハンドル3eを左旋回位置(中立から左側)に引き寄せる。その移動を第七センサ2iで監視し、制御部2aによって位置が保障される。ハンドル3eを中立位置に戻すには、固定シリンダ3jからピストンロッド3kを突出させる油圧調整を弁3m、制御部2aで行う。   When it is necessary to turn the traveling device 4 to the left, for example, as shown in FIG. 1, the automatic traveling type tea-plucking machine 1 equipped with an unmanned automatic traveling work system turns to the weir 11 next to the start position 1a. During this time, as shown in FIG. 4C, the valve 3m is driven by the command signal of the control unit 2a, and the piston rod 3k is accommodated in the fixed cylinder 3j by hydraulic pressure, and the handle 3e is rotated leftward Pull from neutral to the left). The movement is monitored by the seventh sensor 2i, and the position is secured by the control unit 2a. In order to return the handle 3e to the neutral position, the valve 3m and the control unit 2a perform hydraulic pressure adjustment that causes the piston rod 3k to protrude from the fixed cylinder 3j.

このような無人自動走行作業システムは、自動走行茶摘採機のみならず、畝を備える圃場において、例えば、農薬を散布する従来の乗用型農薬散布機15(図7)、乗用型肥料散布機、乗用型の灌水機、茶木畝上面の異物を吸引する従来の乗用型茶木畝上面異物吸引装置16(図6)などの茶園管理機、他の農作業機械にも搭載することができる。その場合、隣接する畝への移動とは限らず2畝毎、3畝毎移動するというように、作業形態によって作業畝をプログラムにより設定できる。   Such an unmanned automatic traveling work system is, for example, a conventional riding type agrochemical sprayer 15 (FIG. 7) that sprays pesticides in a field equipped with not only an automatic running tea picking machine but also a riding type fertilizer spreading machine, It can also be mounted on a riding type irrigation machine, a tea garden management machine such as a conventional riding type tea tree top surface foreign matter suction device 16 (FIG. 6) for sucking foreign substances on the top surface of the tea plant, and other agricultural machines. In such a case, the work group can be set by the program according to the work mode, such as moving every 2 、, every 3 ず instead of moving to the adjacent weir.

そして、特許文献3における畝に沿って直進的な走行をするときは、特許文献2,3の感知板による走行方式を採用していた。   When traveling straight along the weir in Patent Document 3, the traveling method using the sensing plate of Patent Documents 2 and 3 is adopted.

特許文献2,3による走行装置の走行方式では、走行装置に人が搭乗し、運転、修正制御していたため感知板による畝形状の感知で十分に畝に沿った走行が可能であった。他方、無人自動走行になると精度の高い畝に沿った走行が求められる。一方、特許文献2,3では感知板からの情報で油圧を調整、左右のクローラーの回転を制御して畝に沿った走行を補助していた。   In the traveling system of the traveling device according to Patent Documents 2 and 3, a person gets on the traveling device, and driving and correction control are performed, so that traveling along the weir is sufficiently possible by sensing the shape of the weir by the sensing plate. On the other hand, in the case of unmanned automatic traveling, traveling along a highly precise heel is required. On the other hand, in Patent Documents 2 and 3, the hydraulic pressure is adjusted by the information from the sensing plate, and the rotation of the left and right crawlers is controlled to assist the traveling along the heel.

しかしながら、特許文献2,3の感知板は、門型フレーム内に位置し、畝形状の情報生成が遅く、走行装置の適正な走行位置の決定に間に合わないことがあり、また感度、精度が低く、畝に沿って安定して走行装置を走行させることができないことがあった。   However, the sensing plates of Patent Documents 2 and 3 are located in a portal frame, and the information generation of the wedge shape is slow, and may not be in time for determining the proper traveling position of the traveling device, and the sensitivity and accuracy are low. Sometimes, it was not possible to run the traveling device stably along the weir.

特開平09−322628号公報Japanese Patent Application Laid-Open No. 09-322628 特開平11−168947号公報Unexamined-Japanese-Patent No. 11-168947 特開2015−181446号公報JP, 2015-181446, A

そこで、本発明は、農作物などの畝の幅方向における走行装置の走行位置を把握、制御する走行位置認知システム、それを利用した畝に沿って走行する、農作業用走行車、及び無人自動走行作業車等を提供することを目的とする。   Therefore, the present invention relates to a traveling position recognition system for grasping and controlling the traveling position of a traveling device in the width direction of a row of agricultural products, etc., a traveling vehicle for agricultural work traveling along a row using it, and unmanned automatic traveling operation The purpose is to provide cars and the like.

本発明は、上記の課題を解決するために、
(1)
畝に沿って走行する走行装置の前記畝の畝幅方向における走行位置を把握する走行位置認知システムであって、
前記走行装置の進行方向前方に配置され前記畝を検知する左右センサと、
前記左右センサで取得した左右センサと対象までの距離の差情報から前記畝幅方向における前記走行装置の走行位置を算出する計算機と、
からなることを特徴とする、走行位置認知システム。
(2)
畝に沿って走行する走行装置の前記畝の畝幅方向における走行位置を制御する走行位置認知システムであって、
前記走行装置の進行方向前方に配置され前記畝を検知する左右センサと、
前記左右センサで取得した左右センサと対象の距離の差情報から前記畝幅方向における前記走行装置の走行位置を算出する計算機と、
さらに、算出された前記走行装置の走行位置に基づき、前記走行装置を前記畝幅における所望の位置に走行させる制御手段と、
からなることを特徴とする、走行位置認知システム。
(3)
前記対象の距離は、所定時間に得られた対象と前記左右センサとの距離の平均値を用いることを特徴とする(1)又は(2)に記載の走行位置認知システム。
(4)
前記対象の距離は、前記左右センサが検知した前記左右センサと対象との最短距離値を用いることを特徴とする(1)〜(3)の何れか1つに記載の走行位置認知システム。
(5)
前記左右センサが、前記畝のエッジを検知することを特徴とする(1)〜(4)の何れか1つに記載の走行位置認知システム。
(6)
前記左右センサが、前記畝表面に対して、前記左右センサの検知面を、反射を垂直に受ける向きに位置して配置されることを特徴とする(1)〜(5)の何れか1つに記載の走行位置認知システム。
(7)
さらに、カメラを搭載し、前記走行装置の走行を遠隔監視することを特徴とする(1)〜(6)の何れか1つに記載の走行位置認知システム。
(8)
(1)〜(7)の何れか1つに記載の走行位置認知システムを搭載した、自動走行式であることを特徴とする農作業用走行車。
(9)
(1)〜(7)の何れか1つに記載の走行位置認知システムを搭載したことを特徴とする無人自動走行作業車。
(10)
(1)〜(7)の何れか1つに記載の走行位置認知システムを搭載し、前記畝が茶木の畝で、前記走行装置が無人自動走行可能な茶摘採機であることを特徴とする無人自動走行式茶摘採機。
(11)
畝に沿って走行する走行装置の前記畝の畝幅方向における走行位置を制御する走行装置の走行位置制御方法であって、
前記走行装置の進行方向前方に配置された左右センサで、前記畝を検知し、取得した左右センサと対象までの距離の差情報から前記畝幅方向における前記走行装置の走行位置を把握し、前記走行装置を前記畝幅における所望の位置を走行させることを特徴とする、走行装置の走行位置制御方法。
とした。
The present invention solves the above-mentioned problems by:
(1)
A travel position recognition system for grasping a travel position in a heel width direction of the heel of a travel device traveling along a heel, the travel position recognition system comprising:
A left and right sensor disposed forward of the traveling device in the traveling direction to detect the wrinkles;
A computer that calculates the traveling position of the traveling device in the heel width direction from the difference information between the left and right sensors and the distance to the object acquired by the left and right sensors;
A traveling position recognition system characterized by comprising:
(2)
A travel position recognition system for controlling a travel position in a heel width direction of the heel of a travel device traveling along a heel, the travel position recognition system comprising:
A left and right sensor disposed forward of the traveling device in the traveling direction to detect the wrinkles;
A computer for calculating the traveling position of the traveling device in the heel width direction from the difference information of the distance between the left and right sensors and the target acquired by the left and right sensors;
And control means for causing the traveling device to travel to a desired position on the heel width based on the calculated traveling position of the traveling device.
A traveling position recognition system characterized by comprising:
(3)
The travel position recognition system according to (1) or (2), wherein the distance of the object is an average value of the distances between the object obtained in a predetermined time and the left and right sensors.
(4)
The travel position recognition system according to any one of (1) to (3), wherein the distance of the object is a shortest distance value between the left and right sensors detected by the left and right sensors and the object.
(5)
The travel position recognition system according to any one of (1) to (4), wherein the left and right sensors detect an edge of the eyelid.
(6)
The left and right sensors are disposed with respect to the eyelid surface, in a direction in which the detection surface of the left and right sensors is to receive reflection perpendicularly, any one of (1) to (5) The travel position recognition system described in.
(7)
The traveling position recognition system according to any one of (1) to (6), further comprising a camera mounted thereon to remotely monitor traveling of the traveling device.
(8)
A traveling vehicle for agricultural work, which is an automatic traveling type equipped with the traveling position recognition system according to any one of (1) to (7).
(9)
An unmanned automatic traveling working vehicle equipped with the traveling position recognition system according to any one of (1) to (7).
(10)
The traveling position recognition system according to any one of (1) to (7) is mounted, and the rattan is a pot of a tea tree, and the traveling device is a tea picking machine capable of unmanned automatic traveling. Unmanned automatic traveling type tea picking machine.
(11)
A travel position control method of a travel device for controlling a travel position in a heel width direction of the heel of a travel device traveling along a heel, the method comprising:
The left and right sensors disposed forward in the traveling direction of the traveling device detect the heel and grasp the traveling position of the traveling device in the heel width direction from the acquired difference information of the distance to the left and right sensor and object A traveling position control method for a traveling device, comprising: traveling a traveling device to a desired position in the heel width.
And

本発明は、上記構成であるので、以下の効果を発揮する。即ち、本発明は、走行装置の進行方向の前位置で畝の有無、走行装置の位置ズレを感度よく検知、把握することができ、また所望の適正な走行位置で走行させることができ、畝に沿って安定して走行装置を走行させることができる。したがって、農作業用走行車において走行精度の高い無人自動走行を可能にすることができる。   Since the present invention is the above-mentioned composition, the following effects are exhibited. That is, according to the present invention, the presence or absence of a heel and the positional deviation of the traveling device can be detected with high sensitivity and grasped at the front position in the traveling direction of the traveling device, and the vehicle can travel at a desired proper traveling position. Can travel the traveling device stably. Therefore, unmanned automatic traveling with high traveling accuracy can be enabled in the agricultural traveling vehicle.

本発明であるは走行位置認知システム、それを利用した位置制御、農作業用走行車、無人自動走行作業車は、路地、ハウスを問わず、畝を形成して栽培される、一般的な農作物の畝全般に適用できる。   The present invention is a general position of a common agricultural product that is grown by forming a weir, regardless of the alley or the house, of a traveling position recognition system, position control using it, a traveling vehicle for agricultural work, and an unmanned automatic traveling vehicle. Applicable to the generality.

本発明の対象となる農作物としては、実施例示した茶木、その他、さつま芋、馬鈴薯、菊、枝豆などが例示できる。なお、本発明の適用が、これら例示農作物に限定されるものではない。左右センサで、畝、農作物の有無、或いは距離、畝高を検知、或いは算出して、走行装置の位置を把握、所望の位置に制御して、農作業、例えば、耕耘、種蒔き、苗植え、肥料散布、農薬散布、収穫をすることができる。   Examples of agricultural crops to which the present invention is applied include the illustrated tea trees, and others, such as sweet potato, potato, chrysanthemum, and green soybeans. The application of the present invention is not limited to these exemplified crops. The left and right sensors detect or calculate the presence or absence of crops, crops, or the distance and height, and determine the position of the traveling device and control the position to a desired position to perform farming operations such as cultivating, sowing, planting, Fertilizer application, pesticide application, can be harvested.

畝は、ここでは、土を盛り上げた作付け場所の他に、列状に作付けした農作物・作物の列、マルチなども含む概念で、主に、高低差で圃場と区別できる区画である。本発明の左右センサでは、全体的に断面弧状、四角形など畝形状に関係なく、また作物の密集、点在、生育差に関係なく畝位置を検知し、走行装置を所望の位置を走行させることができる。   The mochi is a concept that includes not only soil-rich planting sites, but also crops and rows of crops planted in rows, mulch, etc., and it is a section that can be distinguished from the field mainly by height difference. According to the left and right sensor of the present invention, the position of the weir is detected regardless of the cross section of the arc shape, square shape, etc., regardless of the density of the crops, spotting and growth difference, and the traveling device travels the desired position. Can.

特許文献3の無人自動走行作業システムを備えた自動走行式茶摘採機の圃場での動作説明平面図(A)及び茶摘採機のみの平面図(B)である。Operation | movement explanatory plan view in the field of the automatic traveling type tea-picking machine provided with the unmanned automatic traveling operation system of patent document 3 It is a top view (B) of only a tea-picking machine. 特許文献3の無人自動走行作業システムの制御ブロック図である。It is a control block diagram of an unmanned automatic traveling operation system of patent documents 3. 特許文献3の無人自動走行作業システムを備えた自動走行式茶摘採の前進時のハンドル制御の一例の模式図である。It is a schematic diagram of an example of steering wheel control at the time of the advance of automatic travel-type tea-picking provided with the unmanned automatic travel operation system of patent document 3. FIG. 特許文献3の無人自動走行作業システムを備えた自動走行式茶摘採左右反転時のハンドル制御の一例の模式図である、It is a schematic diagram of an example of steering wheel control at the time of automatic traveling type tea-picking left-right reversal provided with the unmanned automatic traveling work system of patent document 3. 従来の自動走行式茶摘採機の写真である。It is a photograph of the conventional self-traveling tea-picking machine. 従来の乗用型茶木畝上面異物吸引装置の写真である。It is a photograph of the conventional passenger | crew-type type-of-a-trim upper surface foreign material suction apparatus. 従来の乗用型茶畝用農薬散布機の写真である。It is a photograph of the conventional pesticide type sprayer for passenger type bowls. 本発明である走行位置認知システム20を備えた、農作業用走行車の一例である。具体的には自動走行式茶摘採機30で、特許文献3に開示の従来の自動走行式茶摘採機12に走行位置認知システム20を備えてなる。It is an example of a traveling vehicle for agricultural work provided with a traveling position recognition system 20 according to the present invention. Specifically, the automatic traveling type tea-plucking machine 30 includes the traveling position recognition system 20 in the conventional automatic traveling type tea-plucking machine 12 disclosed in Patent Document 3. 本発明である走行位置認知システム20を備えた、無人自動走行式茶摘採機31である。特許文献3に開示の従来の無人自動走行作業システムを備えた自動走行式茶摘採機1に走行位置認知システム20を追加してなる。It is an unmanned automatic traveling type tea plucking machine 31 provided with a traveling position recognition system 20 according to the present invention. A traveling position recognition system 20 is added to the automatic traveling type tea-plucking machine 1 provided with the conventional unmanned automatic traveling work system disclosed in Patent Document 3. 図9のカメラ24を含む遠隔操作システム27の説明図である。It is explanatory drawing of the remote control system 27 containing the camera 24 of FIG. 上面40aが断面弧状に湾曲した畝11に対して、左右センサ21、22の照射向きを説明する図である。It is a figure explaining the irradiation direction of the left-right sensors 21 and 22 with respect to the crucible 11 in which the upper surface 40a curved in cross-sectional arc shape. 畝50が、全体として、断面四角形状の場合の左右センサ21、22の照射と、反射の説明図である。It is explanatory drawing of irradiation of the left-right sensors 21 and 22 in case the crucible 50 is square-shaped in cross section as a whole, and reflection. 畝50が、全体として、断面四角形状の場合の左右センサ21、22の照射と、反射の他の実施形態の説明図である。It is explanatory drawing of irradiation of the left-right sensors 21 and 22 in case the crucible 50 is a square cross-section as a whole, and other embodiment of reflection.

以下、添付の図面を参照し、本発明の実施の形態について、詳細に説明する。なお、本発明は下記実施例に限定されるものではない。   Hereinafter, embodiments of the present invention will be described in detail with reference to the attached drawings. The present invention is not limited to the following examples.

図8に示すように、本発明である自動走行式茶摘採機30は、搭乗者の操作を必要とする、茶木40の畝11に沿って走行する、従来の自動走行式茶摘採機12に、走行位置認知システム20を搭載してなる。必要に応じて、遠隔操作システム27を具備する。   As shown in FIG. 8, the automatic traveling type tea picking machine 30 according to the present invention is a conventional automatic traveling type tea picking machine 12 which travels along the weir 11 of the tea tree 40 which requires the operation of the passenger. , Is equipped with a travel position recognition system 20. A remote control system 27 is provided as necessary.

従来の自動走行式茶摘採機12は、作業者が搭乗部3bに搭乗して操作部3aを操作しつつ、左右感知板13a、13bからの情報で油圧を調整、左右のクローラー(左右走行装置4a、4b)の回転を制御して畝11に沿った走行を補助している。   In the conventional automatic traveling type tea plucking machine 12, the operator adjusts the hydraulic pressure with the information from the left and right sensing plates 13a and 13b while operating the operation part 3a while getting on the boarding part 3b, and the left and right crawlers (left and right traveling devices The rotation of 4a, 4b) is controlled to assist traveling along the weir 11.

しかしながら、従来の自動走行式茶摘採機30は、左右の感知板13a、13bがクローラー(左右走行装置4a、4b)付近に位置するため、精度よく、また、タイムリーに畝11形状を感知し、その形状を反映した走行装置4の畝11に沿った自動走行が十分にできないことがあった。   However, since the conventional automatic traveling type tea-picking machine 30 has the left and right sensing plates 13a and 13b located near the crawlers (left and right traveling devices 4a and 4b), it senses the shape of the crucible 11 with high accuracy and timely. In some cases, automatic traveling along the weir 11 of the traveling device 4 reflecting the shape can not be performed sufficiently.

走行位置認知システム20は、例えば、上面40aが断面略弧状に整形された畝11に沿って走行する走行装置4の畝11の畝幅43方向における走行位置を把握するものであって、走行装置4の進行方向前方(前進のときは前、後進のときは後)に配置され畝11の上面40aの二箇所の畝の有無、或いは畝高(左右畝高41、42)を検知する左右センサ21、22と、左右センサ21、22で取得した左右畝高41、42の差情報から畝幅43方向における走行装置4の走行位置を算出する計算機3と、からなる。ここでは、畝11は、断面部の模式図としてのみ示した。図11に畝11方向から見た拡大断面模式図を掲載した。   The traveling position recognition system 20 is, for example, for grasping the traveling position in the direction of the width 43 of the heel 11 of the traveling device 4 traveling along the crucible 11 whose upper surface 40a is shaped into a substantially arc shape in cross section. Left and right sensors for detecting the presence or absence of two creases on the upper surface 40a of the weir 11, or the heel height (right and left heel heights 41, 42) disposed forward in the traveling direction 4 (forward when moving forward, backward when moving backward) 21 and 22 and the calculator 3 for calculating the traveling position of the traveling device 4 in the direction of the heel width 43 from the difference information of the left and right heel heights 41 and 42 acquired by the left and right sensors 21 and 22. Here, the weir 11 is shown only as a schematic view of the cross section. FIG. 11 is an enlarged cross-sectional schematic view seen from the direction of the crucible 11.

左右センサ21、22は、例えば、超音波センサで、超音波21a、22aの音速と伝搬時間から、左右センサ21、22と畝11の上面までの距離21b、22bが測定できる。もちろん、他の距離測定可能なセンサであれば本発明に採用でき、本発明は超音波センサに限定されるものではない。走行装置4を前進、後進させる場合には、左右センサを走行装置4の前後にそれぞれ備えるとより好ましい。   The left and right sensors 21 and 22 are, for example, ultrasonic sensors, and the distances 21b and 22b to the top surfaces of the left and right sensors 21 and 22 and the crucible 11 can be measured from the speed of sound and propagation time of the ultrasonic waves 21a and 22a. Of course, other sensors capable of measuring distance can be adopted in the present invention, and the present invention is not limited to ultrasonic sensors. In the case where the traveling device 4 is moved forward and backward, it is more preferable to provide left and right sensors in front of and behind the traveling device 4, respectively.

左右センサ21、22は、畝表面に対して、左右センサ21、22の検知面を、畝表面が平坦であれば畝表面と平行(図13)に、畝表面が弧状であればその接線11dと平行(図8、10、11)に、すなわち、反射22dを垂直に受ける向きに(図12)位置して配置される。   The left and right sensors 21, 22 are parallel to the eyebrow surface if the eyebrow surface is flat (Fig. 13) if the detection surface of the left and right sensors 21, 22 is flat with respect to the eyebrow surface (Fig. 13); And parallel (FIGS. 8, 10, 11), that is, in a direction to receive the reflection 22d vertically (FIG. 12).

左右センサ21、22が、走行装置4の幅中心から等距離及び平面地上から同じ高さ位置に配置されれば、測定される距離21a、22bが一致したときは、走行装置4の中心が畝幅43の略中心44に位置することとなる。茶木40の畝11の上面40aは畝幅43の略中心44を基準に左右対象であるためである。   If the left and right sensors 21 and 22 are arranged at the same distance from the width center of the traveling device 4 and at the same height from the plane ground, the center of the traveling device 4 is depressed when the measured distances 21a and 22b coincide. It will be located at the approximate center 44 of the width 43. This is because the upper surface 40 a of the bale 11 of the tea tree 40 is symmetrical with respect to the approximate center 44 of the brow width 43.

したがって、この場合、左右センサ21、22の取り付け高さから距離21a、22aを引くことで、畝11の左右畝高41、42を算出することができる。左右畝高41、42の差も把握できる。   Therefore, in this case, the left and right heel heights 41, 42 of the weir 11 can be calculated by subtracting the distances 21a, 22a from the mounting heights of the left and right sensors 21, 22. The difference between the left and right heel heights 41 and 42 can also be grasped.

計算機23は、左右センサ21、22で取得した情報、距離21a、22a、すなわち左右畝高41、42の差情報を元に、畝幅43方向における走行装置4の走行位置、設定・目標値からのズレを算出する。   Based on the information acquired by the left and right sensors 21 and 22 and the difference information of the distances 21a and 22a, that is, the left and right heel heights 41 and 42, the computer 23 uses the traveling position of the traveling device 4 in the direction of the heel 43 and the setting and target values. Calculate the deviation of

その算出手法として、先ず、対象との距離21a、22aを算出する、例えば、所定時間に得られた対象と左右センサ21、22との距離の平均値を用いる。より具体的には、所定時間内の距離の積算値を、積算のタイミング数で割ることで左右の比較に使用する距離の値とすることができる。平均値を用いることで、畝表面に凹凸、作物の有無、生育のバラツキあっても、イレギュラーな値は平均値に埋没して、凹凸のある作物の畝高を把握することができる。   As the calculation method, first, the distances 21a and 22a to the object are calculated. For example, the average value of the distances between the object obtained in a predetermined time and the left and right sensors 21 and 22 is used. More specifically, the integrated value of the distance within the predetermined time can be divided by the number of integration timings to obtain the value of the distance used for the left and right comparison. By using the average value, irregular values can be buried in the average value even if there are unevenness, presence or absence of crops, and variation in growth on the surface of the eyebrow, and the height of the unevenness of the crop with unevenness can be grasped.

そして、対象との距離としては、左右センサ21、22が検知した左右センサ21、22と対象との最短距離値を用いるとよい。最短距離利用するに際して、畝が角形であればエッジを検知する(図12)、或いは畝50(作物)の有無を検知する(図13)。   Then, as the distance to the object, it is preferable to use the shortest distance value between the left and right sensors 21 and 22 detected by the left and right sensors 21 and 22 and the object. When using the shortest distance, if the ridge is square, the edge is detected (FIG. 12) or the presence or absence of the ridge 50 (crop) is detected (FIG. 13).

図12において、図12(A)は、走行装置4(図示省略)が所望の位置に適正に位置し、畝50に沿って走行している場合を示している。   In FIG. 12, FIG. 12 (A) shows a case where the traveling device 4 (not shown) is properly positioned at a desired position and travels along the weir 50.

左右センサ21、22は、断面長方形の畝50の左右のエッジ50a、50b周辺に当てられた超音波22aの反射22dを検知する。その検知に基づき、計算機23(図示省略)が、左右センサ21、22とエッジ50a、50bとの距離を求め、或いは、超音波22a照射から反射22d検知までの時間を距離と定義する。   The left and right sensors 21, 22 detect the reflection 22d of the ultrasonic wave 22a applied around the left and right edges 50a, 50b of the ridge 50 having a rectangular cross section. Based on the detection, the computer 23 (not shown) obtains the distance between the left and right sensors 21 and 22 and the edges 50a and 50b or defines the time from the irradiation of the ultrasonic wave 22a to the detection of the reflection 22d as a distance.

そして、左右センサ21、22で得られたそれぞれの距離を比較して、その差に応じて走行装置4の位置を把握し、走行装置4が所望の位置、ここでは畝50中央に走行装置4の幅方向中心が一致するように、左右センサ21、22と左右エッジ50a、50bとの左右距離の差が0になるよう走行位置を制御して、走行装置4が畝50に沿った走行を実現する。   Then, the respective distances obtained by the left and right sensors 21 and 22 are compared, and the position of the traveling device 4 is grasped according to the difference, and the traveling device 4 is at the desired position. The traveling position is controlled so that the difference between the left and right sensors 21 and 22 and the left and right edges 50a and 50b is 0 so that the center in the width direction matches, and the traveling device 4 travels along the ridge 50 To realize.

反射22dは、最短距離のものを採用するとよい。この場合、最短距離を測定することで、左右センサ21、22が設定された距離を基準にどれだけズレているかを図12(B)(C)に示す現象から把握することができる。   The reflection 22d may have the shortest distance. In this case, by measuring the shortest distance, it can be grasped from the phenomenon shown in FIGS. 12 (B) and 12 (C) how much the left and right sensors 21 and 22 deviate with reference to the set distance.

図12(B)では、走行装置4が、畝50の右側(右センサ22側)にズレている。この場合、左センサ21の超音波22aからの反射22e(平面に照射された反射)は、左センサ21では検知されない。しかしながら、畝50は作物であり、局所的に見た場合、多方向へ作物の葉は向いており、左センサ21で検知できる反射22dもある。その場合、正規の位置の図12(A)に示す左センサ21が検知するエッジ50aからの反射22dと区別できない。   In FIG. 12B, the traveling device 4 is shifted to the right side (the right sensor 22 side) of the weir 50. In this case, the reflection 22 e from the ultrasonic wave 22 a of the left sensor 21 (reflection applied to a flat surface) is not detected by the left sensor 21. However, the weir 50 is a crop, and when viewed locally, the crop leaves point in multiple directions, and there is also a reflection 22 d that can be detected by the left sensor 21. In that case, the reflection 22d from the edge 50a detected by the left sensor 21 shown in FIG. 12A at the normal position can not be distinguished.

他方、右センサ22からの超音波22aは、畝50の右側面に当たり、その反射22fは、エッジ50bからの反射22dよりも長い距離を示す。したがって、左センサ21と右センサ22との反射(距離)の差は、反射22d(左センサ21)−反射22f(右センサ22)<0であるので、右センサ22側にズレて走行している。その差が0になるよう、走行装置4の走行位置を制御すれば、畝50の中心に沿って走行装置4が走行できる。   On the other hand, the ultrasonic wave 22a from the right sensor 22 strikes the right side of the crucible 50, and its reflection 22f exhibits a longer distance than the reflection 22d from the edge 50b. Therefore, the difference in reflection (distance) between the left sensor 21 and the right sensor 22 is reflection 22 d (left sensor 21) −reflection 22 f (right sensor 22) <0, so the vehicle travels off toward the right sensor 22 There is. If the traveling position of the traveling device 4 is controlled so that the difference becomes 0, the traveling device 4 can travel along the center of the weir 50.

また、図12(C)では、走行装置4が、畝50の左側(左センサ21側)にズレている。この場合、右センサ22の超音波22aからの反射(平面に照射された反射)は、右センサ22では検知されない。しかしながら、畝50は作物であり、局所的に見た場合、多方向へ作物の葉は向いており、右センサ22で検知できる反射22dもある。その場合、正規の位置の図12(A)に示す右センサ22が検知するエッジ50bからの反射22dと区別できない。   Further, in FIG. 12C, the traveling device 4 is shifted to the left side (the left sensor 21 side) of the weir 50. In this case, the reflection from the ultrasonic wave 22 a of the right sensor 22 (reflection applied to a flat surface) is not detected by the right sensor 22. However, the weir 50 is a crop, and when viewed locally, the crop leaves point in multiple directions, and there is also a reflection 22d that can be detected by the right sensor 22. In that case, the reflection 22d from the edge 50b detected by the right sensor 22 shown in FIG. 12A at the normal position can not be distinguished.

他方、左センサ21からの超音波22aは、畝50の左側面に当たり、その反射22fは、エッジ50aからの反射22dよりも長い距離を示す。したがって、左センサ21と右センサ22との反射(距離)の差は、反射22f(左センサ21)−反射22d(右センサ22)>0であるので左センサ21側にズレて走行している。その差が0になるよう、走行装置4の走行位置を制御すれば、畝50の中心に沿って走行装置4が走行できる。   On the other hand, the ultrasonic wave 22a from the left sensor 21 hits the left side surface of the crucible 50, and its reflection 22f shows a longer distance than the reflection 22d from the edge 50a. Therefore, the difference in reflection (distance) between the left sensor 21 and the right sensor 22 is traveling with a shift to the left sensor 21 side since reflection 22 f (left sensor 21) −reflection 22 d (right sensor 22)> 0. . If the traveling position of the traveling device 4 is controlled so that the difference becomes 0, the traveling device 4 can travel along the center of the weir 50.

図13において、図13(A)は、走行装置4(図示省略)が所望の位置に適正に位置し、畝50に沿って走行している場合を示している。なお、左右センサ21、22の検知面は畝50表面(平面50c)と平行に位置している。   In FIG. 13, FIG. 13 (A) shows the case where the traveling device 4 (not shown) is properly positioned at the desired position and traveling along the weir 50. The detection surfaces of the left and right sensors 21 and 22 are located in parallel with the surface of the crucible 50 (the flat surface 50c).

左右センサ21、22は、断面長方形の畝50の平面50cの別々の箇所(ここでは、左右端部)に当てられた超音波22aの反射22dを検知する。その検知に基づき、計算機23(図示省略)が、左右センサ21、22と平面50cとの距離を求め、或いは、超音波22a出射から反射22d検知までの時間を距離と定義する。   The left and right sensors 21 and 22 detect the reflection 22d of the ultrasonic wave 22a applied to different points (here, right and left end portions) of the flat surface 50c of the wedge 50 having a rectangular cross section. Based on the detection, the computer 23 (not shown) obtains the distance between the left and right sensors 21 and 22 and the plane 50c, or defines the time from the emission of the ultrasonic wave 22a to the detection of the reflection 22d as a distance.

そして、左右センサ21、22で得られたそれぞれの距離情報、或いは畝のある無を元に、走行装置4の位置を把握し、走行装置4が所望の位置、ここでは畝50中央に走行装置4の幅方向中心が一致するように、左右センサ21、22いずれも畝50があると判断できる距離を検知するよう、走行位置を制御して、走行装置4が畝50に沿った走行を実現する。   Then, based on the distance information obtained by the left and right sensors 21 and 22 or the presence or absence of a ridge, the position of the traveling device 4 is grasped, and the traveling device 4 is at the desired position. The traveling position is controlled so that the distance between the left and right sensors 21 and 22 can be determined to have a ridge 50 so that the width direction centers of 4 coincide with each other, and the traveling device 4 realizes traveling along the ridge 50 Do.

反射22dは、最短距離のものを採用するとよい。作物の生育度合い、枝葉有無による畝50の平面50cの起伏を吸収することで、作物無との距離の差が最大になり畝50の有無認定精度が高まる。図13(B)(C)に示す現象から、所定位置に位置するか把握することができる。   The reflection 22d may have the shortest distance. By absorbing the unevenness of the flat surface 50c of the weir 50 depending on the growth degree of the crop and the presence or absence of the branches and leaves, the difference in distance from the no crop is maximized, and the accuracy of judging the presence or absence of the weir 50 is enhanced. From the phenomenon shown in FIGS. 13 (B) and 13 (C), it can be grasped whether it is located at a predetermined position.

図13(B)では、走行装置4が、畝50の右側(右センサ22側)にズレている。この場合、左センサ21の超音波22aからの反射22dは、図13(A)に示す左センサ21が検知する反射22dと同じになり、想定の距離を示す。すなわち、畝50の存在を認識していることになる。   In FIG. 13 (B), the traveling device 4 is shifted to the right side (the right sensor 22 side) of the rod 50. In this case, the reflection 22d from the ultrasonic wave 22a of the left sensor 21 is the same as the reflection 22d detected by the left sensor 21 shown in FIG. 13A, and indicates an assumed distance. That is, the existence of the eyelid 50 is recognized.

他方、右センサ22の超音波22aは、畝50に当たらず、地面に当たり、その反射22gは、平面50cからの反射22dよりも畝50の高差分だけ長い距離を示す。したがって、左センサ21と右センサ22との反射(距離)の差は、反射22d(左センサ21)−反射22g(右センサ22)<0であるので、左センサ22側方向にズレて走行している。その差が0になるよう、或いは、左右センサ21、22がいずれも畝50を認識し続けるよう、走行装置4の走行位置を制御すれば、畝50の中心に沿って走行装置4が走行できる。   On the other hand, the ultrasonic wave 22a of the right sensor 22 does not hit the weir 50 but strikes the ground, and its reflection 22g shows a distance longer by a high difference of the weir 50 than the reflection 22d from the plane 50c. Therefore, the difference in reflection (distance) between the left sensor 21 and the right sensor 22 is reflection 22 d (left sensor 21) −reflection 22 g (right sensor 22) <0, so the vehicle travels in the direction away from the left sensor 22 ing. The traveling device 4 can travel along the center of the rod 50 if the traveling position of the traveling device 4 is controlled so that the difference becomes 0 or that both the left and right sensors 21 and 22 continue to recognize the rod 50 .

図13(C)では、走行装置4が、畝50の左側(左センサ21側)にズレている。この場合、右センサ22の超音波22aからの反射22dは、図13(A)に示す右センサ22が検知する反射22dと同じになり、想定の距離を示す。すなわち、畝50の存在を認識していることになる。   In FIG. 13C, the traveling device 4 is shifted to the left side (the left sensor 21 side) of the weir 50. In this case, the reflection 22d from the ultrasonic wave 22a of the right sensor 22 is the same as the reflection 22d detected by the right sensor 22 shown in FIG. 13A, and indicates an assumed distance. That is, the existence of the eyelid 50 is recognized.

他方、左センサ21の超音波22aは、畝50に当たらず、地面に当たり、その反射22gは、平面50cからの反射22dよりも畝50の高差分だけ長い距離を示す。したがって、左センサ21と右センサ22との反射(距離)の差は、反射22g(左センサ21)−反射22d(右センサ22)<0であるので、右センサ22側にズレている。その差が0になるよう(左右センサ21、22がいずれも畝50を認識し続けることも意味する)、走行装置4の走行位置を制御すれば、畝50に沿って走行装置4が走行できる。   On the other hand, the ultrasonic wave 22a of the left sensor 21 does not hit the weir 50 but strikes the ground, and its reflection 22g shows a distance longer by a high difference of the weir 50 than the reflection 22d from the plane 50c. Therefore, the difference in reflection (distance) between the left sensor 21 and the right sensor 22 is shifted to the right sensor 22 side since reflection 22 g (left sensor 21) −reflection 22 d (right sensor 22) <0. By controlling the traveling position of the traveling device 4 so that the difference becomes 0 (meaning that both the left and right sensors 21 and 22 continue to recognize the rod 50), the traveling device 4 can travel along the rod 50 .

以上の左右センサ21、22の検知により、走行装置4がどれだけ畝11に沿ってないかを把握することできるとともに、その情報を各種走行位置の修正、走行制御、すなわち、算出された走行装置4の走行位置に基づき、走行装置4を畝幅43における所望の位置、例えば、走行装置4の幅方向の中心を略中心44に沿って走行させる制御を行うことができる。   By the detection of the left and right sensors 21 and 22 described above, it is possible to grasp how far the traveling device 4 is not along the weir 11, correct the various traveling positions and travel control of the information, that is, the calculated traveling device Based on the traveling position of 4, it is possible to control the traveling device 4 to travel along a desired position in the heel width 43, for example, the approximate center 44 in the width direction of the traveling device 4.

その制御手段としては、例えば、左右センサ21、22の取得情報に相当する信号21c、22cを計算機23に送り、計算機23が、左右距離21b、22b(それから算出した左右畝高41、42)の差から畝11に対する走行装置4に位置を計算し、走行装置4が位置所望の位置からどれだけズレているか割り出し、必要に応じて、そのズレを0に近づけるように制御する。   As the control means, for example, signals 21c and 22c corresponding to acquisition information of the left and right sensors 21 and 22 are sent to the computer 23, and the computer 23 controls the left and right distances 21b and 22b (the left and right heel heights 41 and 42 calculated therefrom). From the difference, the position of the traveling device 4 with respect to the rod 11 is calculated, and how much the traveling device 4 deviates from the position desired position is determined. If necessary, the deviation is controlled to be close to zero.

具体的な制御としては、例えば、図8において、計算機23から操作部3aへ、或いは既存のクローラー(左右の走行装置4a、4b)の油圧へ、制御信号2uとして送る。どの位置に位置させるかだけの問題であるので、既存の位置制御に置き換え、あるいは位置制御の補正係数として、左右センサ21、22で取得した情報を利用することができる。さらに、既存の左右感知板13a、13での情報に基づく制御を、走行装置4が畝50から大きくズレたときの修正として使用することもできる。   As a specific control, for example, in FIG. 8, the control signal 2u is sent from the computer 23 to the operation unit 3a or to the hydraulic pressure of the existing crawler (the left and right traveling devices 4a, 4b). Since it is only a matter of which position to position, it is possible to replace the existing position control or use the information acquired by the left and right sensors 21 and 22 as a correction coefficient for position control. Furthermore, the control based on the information in the existing left and right sensing plates 13a and 13 can also be used as a correction when the traveling device 4 largely deviates from the weir 50.

走行位置認知システム20を備え、左右センサ21、22で畝幅43に対する走行装置4の位置を把握し、所望の位置、例えば走行装置4の車幅の中心を、畝幅43の略中心44に位置、制御させることで、畝11に沿って、より精度よく走行装置4を自動走行することができる。ここでの自動走行には、畝11の終端での走行装置4の回転操作を自動ですることを含まない、回転は搭乗者が操作することを想定している。   A travel position recognition system 20 is provided, and the position of the travel device 4 with respect to the heel width 43 is grasped by the left and right sensors 21 and 22, and a desired position, for example, the center of the vehicle width of the travel device 4 With the position and control, the traveling device 4 can be automatically traveled along the weir 11 more accurately. The automatic traveling here does not include the operation of automatically rotating the traveling device 4 at the end of the weir 11, and the rotation is assumed to be operated by the passenger.

次に、自動走行式茶摘採機30、走行装置4の遠隔操作について説明する。計算機23、或いは既存の制御装置に接続するカメラ24を備える。カメラ24は、走行装置4の進行方向前方の景色、状況映像を映し、計算機に23に送り、端末26がカメラ24の映像をリアルタイムで確認する。計算機23は、通信25aによって、インターネト回線25に接続し、そこには、走行装置4の緊急停止を指令する端末26も通信26aを介して接続する。   Next, remote control of the automatic travel type tea-picking machine 30 and the traveling device 4 will be described. The camera 23 connected to the computer 23 or an existing control device is provided. The camera 24 captures a view in the forward direction of the traveling device 4 and a situation image, sends it to the computer 23, and the terminal 26 confirms the image of the camera 24 in real time. The computer 23 is connected to the Internet line 25 by the communication 25a, and the terminal 26 instructing an emergency stop of the traveling device 4 is also connected thereto via the communication 26a.

端末26は、カメラ24の映像を確認し、緊急時停止信号をインターネット回線25を介して、計算機23に送り、計算機23が走行装置4の走行、自動走行式茶摘採機30を緊急停止することができる。なお、さらに詳細は、図10を参照して後述する。   The terminal 26 confirms the image of the camera 24, sends an emergency stop signal to the computer 23 via the Internet line 25, and the computer 23 makes an emergency stop of the traveling device 4 and the automatic traveling type tea-plucking machine 30 Can. Further details will be described later with reference to FIG.

図9に示すように、特許文献3に開示の無人自動走行作業システム2を備えた自動走行式茶摘採機1に、本発明の走行位置認知システム20を導入することで、畝11に沿った走行のみならず、畝11終端での自動回転も可能になる。左右センサ21、22の信号21c、22cから、計算機23により、走行装置4の位置を把握し、その結果を制御信号2に反映して、従来の感知板である第三センサ7、第四センサ8の信号による制御信号2と共同、補強して、或いは主として、畝11の形状に沿って、走行装置4を畝11において所望の位置を無人、自動走行させることができる。なお、左右感知板13a、13bは、畝11から走行装置4が大きくずれたとき(ズレないようにする)ストッパーとして使用することもできる。   As shown in FIG. 9, the traveling position recognition system 20 of the present invention is introduced into the automatic traveling type tea-plucking machine 1 provided with the unmanned automatic traveling operation system 2 disclosed in Patent Document 3, thereby following the habit 11 Not only traveling but also automatic rotation at the end of 畝 11 becomes possible. The position of the traveling device 4 is grasped by the computer 23 from the signals 21c and 22c of the left and right sensors 21 and 22 and the result is reflected on the control signal 2 to obtain the third sensor 7 and the fourth sensor which are conventional sensing plates. The traveling device 4 can be unmanned and automatically travels at a desired position on the weir 11 in cooperation with the control signal 2 with the eight signals or reinforced or mainly along the shape of the weir 11. The left and right sensing plates 13a and 13b can also be used as a stopper when the traveling device 4 is largely deviated from the weir 11.

次に、図10を参照して、カメラ24を備える遠隔操作システム27による無人自動走行式茶摘採機31、走行装置4の遠隔操作について説明する。カメラ24は、走行装置4の進行方向前方の映像撮影し、作業車から離れている監視者の端末26でその映像を確認することができる。近距離(300m程度以下)の場合には、Wi−Fi26bで、それ以上の遠距離の場合には、通信25a、26a、インターネット回線25を介して、端末とカメラ24は接続される。   Next, with reference to FIG. 10, remote control of the unmanned automatic traveling type tea-plucking machine 31 and the traveling device 4 by the remote control system 27 including the camera 24 will be described. The camera 24 can capture an image of an image in front of the traveling device 4 in the traveling direction, and confirm the image on the terminal 26 of the surveillance person away from the work vehicle. In the case of a short distance (about 300 m or less), the terminal and the camera 24 are connected via the Wi-Fi 26 b, and in the case of a longer distance, communication 25 a, 26 a and the Internet 25.

ここでは、カメラ24は、無人自動走行システム2を介してインターネット25、Wi−Fi26bで、端末26に接続するが、カメラ24から直接インターネット25、Wi−Fi26bに接続してもよい。緊急停止信号は、カメラ24から無人自動走行作業システム2へ信号24aを通じて指示することもできる。   Here, the camera 24 is connected to the terminal 26 via the unmanned automatic travel system 2 via the Internet 25 and Wi-Fi 26b, but may be directly connected to the Internet 25 and Wi-Fi 26b from the camera 24. The emergency stop signal can also be instructed from the camera 24 to the unmanned automatic traveling work system 2 through the signal 24 a.

端末26は、モバイルPC、スマートフォン、携帯電話などで、通信、インターネット、Wi−Fi接続ができ、映像表示できるものである。既存の電話会社回線を使用することができる。   The terminal 26 is a mobile PC, a smart phone, a mobile phone, etc., and can communicate, connect the Internet, Wi-Fi, and can display an image. The existing telephone company line can be used.

このようなネットワーク、映像監視システムを備えることで、無人搭乗の走行システムにおいても、カメラ24映像において、緊急事態が生じた場合、監視者が、端末26から無人自動走行作業システム2、制御信号2uを通じて、走行、機械作業を停止することができる。   By providing such a network and a video surveillance system, even in an unmanned traveling system, when an emergency situation occurs in the video of the camera 24, the supervisor can operate the unattended automated travel work system 2 from the terminal 26, the control signal 2u. You can stop driving and machine work through.

1 無人自動走行作業システムを備えた自動走行式茶摘採機
1a 開始位置
1b 走行方向
1c 終点位置
1d 旋回位置
1e 旋回軌道
1f 再開位置
1g 終了位置
2 無人自動走行作業システム
2a 制御部
2b 非常停止スイッチ
2c リモコン
2d 電波
2e スタートスイッチ
2f 方位センサ
2g 第五センサ
2h 第六センサ
2i 第七センサ
2k 第八センサ
2m 第九センサ
2n 第十センサ
2p 前進制御系
2q 旋回制御系
2r 機械停止
2s エンジン停止
2t 入力信号
2u 制御信号
3 載置部
3a 操作部
3b 搭乗部
3e ハンドル
3f 第一アクチュエータ
3g 固定シリンダ
3h ピストンロッド
3i 第二アクチュエータ
3j シリンダ
3k ピストンロッド
3l 弁
3m 弁
3n 切換スイッチ
4 走行装置
4a 左走行装置
4b 右走行装置
5 第一センサ
6 第二センサ
7 第三センサ
8 第四センサ
9 停止指示部材
9a 停止センサ
10 圃場
11 畝
11a 作業中の畝
11b 隣の畝
11c 最終畝
11d 接線
12 従来の自動走行式茶摘採機
12a 茶葉摘採部
13a 左感知板
13b 右感知板
14 駆動源
14a バッテリ
15 従来の乗用型農薬散布機
16 従来の乗用型茶木畝上面異物吸引装置
20 走行位置認知システム
21 左センサ
21a 超音波
21b 距離
21c 信号
22 右センサ
22a 超音波
22b 距離
22c 信号
22d 反射
22e 反射
22f 反射
22g 反射
23 計算機
24 カメラ
24a 信号
25 インターネット回線
25a 通信
26 端末
26a 通信
26b Wi−Fi
27 遠隔操作システム
30 自動走行式茶摘採機
31 無人自動走行式茶摘採機
40 畝
40a 上面
41 左畝高
42 右畝高
43 畝幅
44 略中心
50 畝
50a エッジ
50b エッジ
50c 平面
1 Automatic traveling type tea picking machine 1a equipped with an unmanned automatic traveling work system Start position 1b Driving direction 1c Ending point position 1d Turning position 1e Turning position 1e Revolving track 1f Restart position 1g End position 2 Unmanned automatic traveling work system 2a Control part 2b Emergency stop switch 2c Remote control 2d Electric wave 2e Start switch 2f Direction sensor 2g Fifth sensor 2h Sixth sensor 2i Seventh sensor 2k Eighth sensor 2m Nineth sensor 2n Tenth sensor 2n Forward control system 2q Turning control system 2r Machine stop 2r Engine stop 2s Input signal 2u Control Signal 3 Mounting Unit 3a Operating Unit 3b Boarding Unit 3e Handle 3f First Actuator 3g Fixed Cylinder 3h Piston Rod 3i Second Actuator 3j Cylinder 3k Piston Rod 3l Valve 3m Valve 3n Switching Switch 4 Drive 4a Left Drive 4b Right Traveling device 5 first sensor Second sensor 7 Third sensor 8 Fourth sensor 9 Stop indication member 9a Stop sensor 10 Field 11 畝 11a Working weir 11b Next weir 11c Final weir 11d Tangent line 12 Conventional automatic traveling type tea picking machine 12a Tea leaf picking part 13a Left sensing plate 13b Right sensing plate 14 Drive source 14a Battery 15 Conventional riding type pesticide sprayer 16 Conventional riding type tea tree top surface foreign object suction device 20 Driving position recognition system 21 Left sensor 21a Ultrasonic wave 21b Distance 21c Signal 22 Right sensor 22a Ultrasonic wave 22b Distance 22c Signal 22d Reflection 22e Reflection 22f Reflection 22g Reflection 23 Computer 24 Camera 24a Signal 25 Internet line 25a Communication 26 Terminal 26a Communication 26b Wi-Fi
27 remote control system 30 automatic traveling type tea picking machine 31 unmanned automatically traveling type tea picking machine 40 畝 40 a upper surface 41 left side height 42 right side height 43 side width 44 approximately center 50 畝 50 a edge 50 b edge 50 c flat surface

Claims (11)

畝に沿って走行する走行装置の前記畝の畝幅方向における走行位置を把握する走行位置認知システムであって、
前記走行装置の進行方向前方に配置され前記畝を検知する左右センサと、
前記左右センサで取得した左右センサと対象までの距離の差情報から前記畝幅方向における前記走行装置の走行位置を算出する計算機と、
からなることを特徴とする、走行位置認知システム。
A travel position recognition system for grasping a travel position in a heel width direction of the heel of a travel device traveling along a heel, the travel position recognition system comprising:
A left and right sensor disposed forward of the traveling device in the traveling direction to detect the wrinkles;
A computer that calculates the traveling position of the traveling device in the heel width direction from the difference information between the left and right sensors and the distance to the object acquired by the left and right sensors;
A traveling position recognition system characterized by comprising:
畝に沿って走行する走行装置の前記畝の畝幅方向における走行位置を制御する走行位置認知システムであって、
前記走行装置の進行方向前方に配置され前記畝を検知する左右センサと、
前記左右センサで取得した左右センサと対象の距離の差情報から前記畝幅方向における前記走行装置の走行位置を算出する計算機と、
さらに、算出された前記走行装置の走行位置に基づき、前記走行装置を前記畝幅における所望の位置に走行させる制御手段と、
からなることを特徴とする、走行位置認知システム。
A travel position recognition system for controlling a travel position in a heel width direction of the heel of a travel device traveling along a heel, the travel position recognition system comprising:
A left and right sensor disposed forward of the traveling device in the traveling direction to detect the wrinkles;
A computer for calculating the traveling position of the traveling device in the heel width direction from the difference information of the distance between the left and right sensors and the target acquired by the left and right sensors;
And control means for causing the traveling device to travel to a desired position on the heel width based on the calculated traveling position of the traveling device.
A traveling position recognition system characterized by comprising:
前記対象の距離は、所定時間に得られた対象と前記左右センサとの距離の平均値を用いることを特徴とする請求項1又は請求項2に記載の走行位置認知システム。 The travel position recognition system according to claim 1 or 2, wherein an average value of distances between the target and the left and right sensors obtained at a predetermined time is used as the distance of the target. 前記対象の距離は、前記左右センサが検知した前記左右センサと対象との最短距離値を用いることを特徴とする請求項1〜請求項3の何れか1項に記載の走行位置認知システム。 The travel position recognition system according to any one of claims 1 to 3, wherein the distance of the object is a shortest distance value between the left and right sensors detected by the left and right sensors and the object. 前記左右センサが、前記畝のエッジを検知することを特徴とする請求項1〜請求項4の何れか1項に記載の走行位置認知システム。 The travel position recognition system according to any one of claims 1 to 4, wherein the left and right sensors detect an edge of the eyelid. 前記左右センサが、前記畝表面に対して、前記左右センサの検知面を、反射を垂直に受ける向きに位置して配置されることを特徴とする請求項1〜請求項5の何れか1項に記載の走行位置認知システム。 The said left and right sensor is located in the direction which receives the detection surface of the said left and right sensor with respect to the said eyelid surface perpendicularly | vertically, and is arrange | positioned, The any one of the Claims 1-5 characterized by the above-mentioned. The travel position recognition system described in. さらに、カメラを搭載し、前記走行装置の走行を遠隔監視することを特徴とする請求項1〜請求項6の何れか1項に記載の走行位置認知システム。 The travel position recognition system according to any one of claims 1 to 6, further comprising a camera mounted thereon to remotely monitor traveling of the traveling device. 請求項1〜請求項7の何れか1項に記載の走行位置認知システムを搭載した、自動走行式であることを特徴とする農作業用走行車。 An agricultural traveling vehicle comprising an automatic traveling type equipped with the traveling position recognition system according to any one of claims 1 to 7. 請求項1〜請求項7の何れか1項に記載の走行位置認知システムを搭載したことを特徴とする無人自動走行作業車。 An unmanned automatic traveling working vehicle equipped with the traveling position recognition system according to any one of claims 1 to 7. 請求項1〜請求項7の何れか1項に記載の走行位置認知システムを搭載し、前記畝が茶木の畝で、前記走行装置が無人自動走行可能な茶摘採機であることを特徴とする無人自動走行式茶摘採機。 The travel position recognition system according to any one of claims 1 to 7, wherein the rattan is a brow of a tea tree, and the traveling device is an unmanned and automatically travelable tea picking machine. Unmanned automatic traveling type tea picking machine. 畝に沿って走行する走行装置の前記畝の畝幅方向における走行位置を制御する走行装置の走行位置制御方法であって、
前記走行装置の進行方向前方に配置された左右センサで、前記畝を検知し、取得した左右センサと対象までの距離の差情報から前記畝幅方向における前記走行装置の走行位置を把握し、前記走行装置を前記畝幅における所望の位置を走行させることを特徴とする、走行装置の走行位置制御方法。
A travel position control method of a travel device for controlling a travel position in a heel width direction of the heel of a travel device traveling along a heel, the method comprising:
The left and right sensors disposed forward in the traveling direction of the traveling device detect the heel and grasp the traveling position of the traveling device in the heel width direction from the acquired difference information of the distance to the left and right sensor and object A traveling position control method for a traveling device, comprising: traveling a traveling device to a desired position in the heel width.
JP2017192099A 2017-09-29 2017-09-29 Traveling position recognition system, agricultural traveling vehicle, and unmanned automated traveling vehicle Active JP6458258B1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2017192099A JP6458258B1 (en) 2017-09-29 2017-09-29 Traveling position recognition system, agricultural traveling vehicle, and unmanned automated traveling vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017192099A JP6458258B1 (en) 2017-09-29 2017-09-29 Traveling position recognition system, agricultural traveling vehicle, and unmanned automated traveling vehicle

Publications (2)

Publication Number Publication Date
JP6458258B1 JP6458258B1 (en) 2019-01-30
JP2019062816A true JP2019062816A (en) 2019-04-25

Family

ID=65228877

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017192099A Active JP6458258B1 (en) 2017-09-29 2017-09-29 Traveling position recognition system, agricultural traveling vehicle, and unmanned automated traveling vehicle

Country Status (1)

Country Link
JP (1) JP6458258B1 (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021016373A (en) * 2019-07-23 2021-02-15 株式会社 日本計器鹿児島製作所 Automatic rotation system and method for travel vehicle, travel vehicle for farm work employing the same, and unmanned automatic travel work vehicle
WO2021192624A1 (en) 2020-03-26 2021-09-30 株式会社レグミン Agricultural traveling vehicle, control device, and program
KR20220138892A (en) * 2021-04-06 2022-10-14 주식회사 영동농기계 Autonomous driving type electric convenience work machine

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4430849A (en) * 1981-11-03 1984-02-14 Powell Manufacturing Co. Harvester for tea or the like
JPH04141268A (en) * 1990-11-27 1992-05-14 Shota Hiyamuta Motor liquid sprinkler
JPH09233910A (en) * 1996-03-04 1997-09-09 Seibutsukei Tokutei Sangyo Gijutsu Kenkyu Suishin Kiko Carriage for harvesting work
JP2000316315A (en) * 1999-04-30 2000-11-21 Kawasaki Engineering Inc Steering structure in tea field-tending machine in tea ridge-straddling and traveling type
JP2001269013A (en) * 2000-03-28 2001-10-02 Kubota Corp Steering controller of reaping harvester
JP2005021090A (en) * 2003-07-03 2005-01-27 Ochiai Cutlery Mfg Co Ltd Self-propelled tea garden tending machine
JP2005065664A (en) * 2003-08-20 2005-03-17 Yasutoshi Iwase Agricultural managing robot
JP2007049927A (en) * 2005-08-17 2007-03-01 Iseki & Co Ltd Automatic travel-controlling device of working vehicle
JP2008287487A (en) * 2007-05-17 2008-11-27 Human Rinku:Kk Moving element and method for travel of moving element
JP2011234623A (en) * 2010-04-30 2011-11-24 National Agriculture & Food Research Organization Tea field management machine
JP2015181446A (en) * 2014-03-26 2015-10-22 株式会社 日本計器鹿児島製作所 Unmanned automatic traveling work system
CN106818047A (en) * 2017-02-24 2017-06-13 四川农业大学 A kind of efficient tealeaves tender shoots picking machine

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4430849A (en) * 1981-11-03 1984-02-14 Powell Manufacturing Co. Harvester for tea or the like
JPH04141268A (en) * 1990-11-27 1992-05-14 Shota Hiyamuta Motor liquid sprinkler
JPH09233910A (en) * 1996-03-04 1997-09-09 Seibutsukei Tokutei Sangyo Gijutsu Kenkyu Suishin Kiko Carriage for harvesting work
JP2000316315A (en) * 1999-04-30 2000-11-21 Kawasaki Engineering Inc Steering structure in tea field-tending machine in tea ridge-straddling and traveling type
JP2001269013A (en) * 2000-03-28 2001-10-02 Kubota Corp Steering controller of reaping harvester
JP2005021090A (en) * 2003-07-03 2005-01-27 Ochiai Cutlery Mfg Co Ltd Self-propelled tea garden tending machine
JP2005065664A (en) * 2003-08-20 2005-03-17 Yasutoshi Iwase Agricultural managing robot
JP2007049927A (en) * 2005-08-17 2007-03-01 Iseki & Co Ltd Automatic travel-controlling device of working vehicle
JP2008287487A (en) * 2007-05-17 2008-11-27 Human Rinku:Kk Moving element and method for travel of moving element
JP2011234623A (en) * 2010-04-30 2011-11-24 National Agriculture & Food Research Organization Tea field management machine
JP2015181446A (en) * 2014-03-26 2015-10-22 株式会社 日本計器鹿児島製作所 Unmanned automatic traveling work system
CN106818047A (en) * 2017-02-24 2017-06-13 四川农业大学 A kind of efficient tealeaves tender shoots picking machine

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021016373A (en) * 2019-07-23 2021-02-15 株式会社 日本計器鹿児島製作所 Automatic rotation system and method for travel vehicle, travel vehicle for farm work employing the same, and unmanned automatic travel work vehicle
WO2021192624A1 (en) 2020-03-26 2021-09-30 株式会社レグミン Agricultural traveling vehicle, control device, and program
JP2021153567A (en) * 2020-03-26 2021-10-07 株式会社レグミン Agricultural travel vehicle, control device and program
JP2021153466A (en) * 2020-03-26 2021-10-07 株式会社レグミン Agricultural travel vehicle, control device and program
KR20220138892A (en) * 2021-04-06 2022-10-14 주식회사 영동농기계 Autonomous driving type electric convenience work machine
KR102569580B1 (en) 2021-04-06 2023-08-24 주식회사 영동농기계 Autonomous driving type electric convenience work machine

Also Published As

Publication number Publication date
JP6458258B1 (en) 2019-01-30

Similar Documents

Publication Publication Date Title
JP6007440B2 (en) Unmanned automated traveling system
EP1419683B1 (en) Method of controlling an agricultural vehicle
RU2530509C2 (en) Automatic control system of moving grain based on real-time simulation of filling level for areas of receiving container
EP2338322B1 (en) Apparatus, computer program and method for controlling an agricultural implement
JP2019096342A (en) Automatic work system
CN105076099B (en) A kind of forest obstacle medicine band annular sprayer apparatus and method
JP2019062816A (en) Travel position recognition system, travel vehicle for farm work, and unmanned automatic travel work vehicle
JP2016007195A (en) Work vehicle
KR101312462B1 (en) The peopleless control system of insect pests
JP2018153103A (en) Work vehicle
CN114945886A (en) Vehicle control by remote operator
CN107046822A (en) Miniature tracked agricultural robot
JP2015146748A (en) Electric working vehicle
JP6651209B1 (en) Automatic rotation system and method for traveling vehicle, traveling vehicle for agricultural work equipped with the same, and unmanned automatic traveling vehicle
KR20100093761A (en) Unmanned automatic agricultural chemicals spreader
KR101309745B1 (en) Weeder using Side Weeding Unit
JP4973918B2 (en) Vehicle for automatic harvesting robot
JP2016010371A (en) Combine-harvester
WO2016034652A1 (en) Device for processing a surface
WO2021132355A1 (en) Work vehicle
KR100694894B1 (en) guidance pipeline following ginseng field sprayer
CN215123577U (en) Remote-controlled plant protection machine and remotely-controlled spraying equipment
KR20200057961A (en) Unmanned Working apparatus by remote control
US20230165188A1 (en) Method and appliance for lawn care with lane recognition
JP2000316315A (en) Steering structure in tea field-tending machine in tea ridge-straddling and traveling type

Legal Events

Date Code Title Description
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: 20181102

A711 Notification of change in applicant

Free format text: JAPANESE INTERMEDIATE CODE: A711

Effective date: 20181112

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20181127

R150 Certificate of patent or registration of utility model

Ref document number: 6458258

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250