JP2011207407A - Drive device for automatically steering running vehicle - Google Patents

Drive device for automatically steering running vehicle Download PDF

Info

Publication number
JP2011207407A
JP2011207407A JP2010078715A JP2010078715A JP2011207407A JP 2011207407 A JP2011207407 A JP 2011207407A JP 2010078715 A JP2010078715 A JP 2010078715A JP 2010078715 A JP2010078715 A JP 2010078715A JP 2011207407 A JP2011207407 A JP 2011207407A
Authority
JP
Japan
Prior art keywords
steering
automatic
automatic steering
traveling vehicle
electromagnetic clutch
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
JP2010078715A
Other languages
Japanese (ja)
Other versions
JP5560844B2 (en
Inventor
Eiji Makino
英二 牧野
Yasuyuki Hamada
安之 濱田
Keiji Hanawa
圭二 塙
Takashi Nagai
永井  隆
Yutaka Kajino
楫野  豊
Masayuki Chikamoto
正幸 近本
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.)
Iseki and Co Ltd
National Agriculture and Food Research Organization
Iseki Agricultural Machinery Mfg Co Ltd
Original Assignee
Iseki and Co Ltd
National Agriculture and Food Research Organization
Iseki Agricultural Machinery Mfg Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Iseki and Co Ltd, National Agriculture and Food Research Organization, Iseki Agricultural Machinery Mfg Co Ltd filed Critical Iseki and Co Ltd
Priority to JP2010078715A priority Critical patent/JP5560844B2/en
Publication of JP2011207407A publication Critical patent/JP2011207407A/en
Application granted granted Critical
Publication of JP5560844B2 publication Critical patent/JP5560844B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

PROBLEM TO BE SOLVED: To provide an automatic steering drive device of high versatility adapted to different traveling vehicles, and to provide an automatic steering drive device capable of executing manual steering wheel operation at an emergency.SOLUTION: An automatic steering control means for performing the drive control of a steering shaft in an automatic steering mode by performing the operational control of a forward/reverse motor for driving an intermediate shaft by turning on/off an electromagnetic clutch. The automatic steering control means secures traveling safety by performing the control of prohibiting an automatic steering mode by the forward/reverse motor when executing any behavior operation of the traveling vehicle such as the turn-on of a clutch pedal, the turn-on of a left or right brake pedal, or the movement of a forward/reverse lever to a forward side or a reverse side.

Description

本発明は、農業用走行車両等のステアリングハンドル部に装着する走行車両自動操舵用駆動装置に関する。   The present invention relates to a traveling vehicle automatic steering drive device mounted on a steering handle portion of an agricultural traveling vehicle or the like.

外部からの遠隔操舵信号の出力に基づき、ステッピングモータからの動力をベルトまたはチェンによりステアリングシャフトに伝動してステアリングハンドルを操舵する自動操舵用駆動装置を装着した走行車両が知られている(特許文献1)。   A traveling vehicle equipped with an automatic steering drive device that transmits power from a stepping motor to a steering shaft by a belt or chain based on an output of a remote steering signal from the outside to steer a steering handle is known (Patent Document) 1).

米国特許第7349779号明細書US Pat. No. 7,349,795

上記特許文献1記載の自動操舵のために操舵駆動装置を設ける構成においては、自動操舵駆動装置を作動中にもオペレータによって手動でステアリングハンドルの操舵を行うことがあるが、上記特許文献1記載の自動操舵駆動装置は、ステアリングハンドルを手動操作する場合についての配慮がなく、ベルトまたはチェーンによる動力伝達系の動力に逆らって手動によりステアリングハンドルを操作する必要があった。   In the configuration in which the steering drive device is provided for automatic steering described in Patent Document 1, the steering handle may be manually operated by the operator even while the automatic steering drive device is operating. The automatic steering drive device has no consideration for manually operating the steering handle, and it is necessary to manually operate the steering handle against the power of the power transmission system by the belt or chain.

本発明の課題は、異なる走行車両に対応する汎用性の高い自動操舵駆動装置を提供するとともに、緊急時の手動ハンドル操作を可能にする自動操舵駆動装置を提供することである。   An object of the present invention is to provide a highly versatile automatic steering drive device corresponding to different traveling vehicles, and to provide an automatic steering drive device that enables manual steering operation in an emergency.

本発明は、上記の課題を解決するために次の構成を有する。
請求項1記載の発明は、走行車両の操舵をするステアリングハンドル(9)と、該ステアリングハンドル(9)に連動して正転と逆転をするステアリングシャフト(15)と、走行車両の操舵方向を検出する操舵方向検出手段(49)と、ステアリングシャフト(15)に回転駆動力を伝達するための正逆転モータ(20)と、該正逆転モータ(20)の回転駆動力をステアリングシャフト(15)に伝達するための電磁クラッチ(22)を有する連動機構と、該電磁クラッチ(22)の作動/非作動を司る自動スイッチ(24)と、
走行車両の挙動を検出する挙動検出手段(K)と、前記自動スイッチ(24)の操作により前記電磁クラッチ(22)が作動する自動モード中には前記操舵方向検出手段(49)の検出結果に基づいて前記正逆転モータ(20)の正逆転方向の出力によりステアリングシャフト(15)の自動操舵制御を行い、また前記挙動検出手段(K)の検出結果に基づいて前記電磁クラッチ(22)を非作動とする自動操舵制御手段(100)と
を備えた走行車両自動操舵装置である。
The present invention has the following configuration in order to solve the above problems.
According to the first aspect of the present invention, there is provided a steering handle (9) for steering the traveling vehicle, a steering shaft (15) for forward and reverse rotation in conjunction with the steering handle (9), and a steering direction of the traveling vehicle. A steering direction detecting means (49) for detecting, a forward / reverse motor (20) for transmitting the rotational driving force to the steering shaft (15), and the rotational driving force of the forward / reverse motor (20) for the steering shaft (15). An interlocking mechanism having an electromagnetic clutch (22) for transmission to an automatic switch (24), an automatic switch (24) for controlling the operation / non-operation of the electromagnetic clutch (22),
During the automatic mode in which the electromagnetic clutch (22) is operated by operation of the automatic switch (24) and the behavior detection means (K) for detecting the behavior of the traveling vehicle, the detection result of the steering direction detection means (49) Based on the output in the forward / reverse direction of the forward / reverse rotation motor (20), automatic steering control of the steering shaft (15) is performed, and the electromagnetic clutch (22) is turned off based on the detection result of the behavior detection means (K). It is a traveling vehicle automatic steering apparatus provided with the automatic steering control means (100) to operate | move.

請求項2記載の発明は、走行車両の旋回動作または旋回開始点を検出する検出手段(49,50,52)を設け、前記自動操舵制御手段(100)は走行車両が旋回動作または旋回開始点検出手段の検出結果に基づいて前記電磁クラッチ(22)によるステアリングシャフト(15)への動力を非伝達とすることを特徴とする請求項1記載の走行車両自動操舵装置である。   The invention according to claim 2 is provided with detection means (49, 50, 52) for detecting the turning operation or turning start point of the traveling vehicle, and the automatic steering control means (100) checks whether the traveling vehicle is turning operation or turning start. 2. The traveling vehicle automatic steering apparatus according to claim 1, wherein power to the steering shaft (15) by the electromagnetic clutch (22) is not transmitted based on a detection result of the output means.

請求項3記載の発明は、ステアリングハンドル(9)をオペレータが握り操作することを検出するステアリング握り検出手段(54,55)を設け、前記自動操舵制御手段(100)は前記ステアリング握り検出手段(54,55)の検出結果に基づいて前記電磁クラッチ(22)によるステアリングシャフト(15)への動力を非伝達とすることを特徴とする請求項1記載の走行車両自動操舵装置である。   According to a third aspect of the present invention, there is provided steering grip detection means (54, 55) for detecting that an operator grips the steering handle (9), and the automatic steering control means (100) is provided with the steering grip detection means ( 54. The traveling vehicle automatic steering apparatus according to claim 1, wherein power to the steering shaft (15) by the electromagnetic clutch (22) is not transmitted based on the detection results of 54, 55).

請求項4記載の発明は、走行車両の車速を検出する車速検出手段(57)を設け、前記自動操舵制御手段(100)は車速検出手段(57)の検出結果に基づき車速が規定車速以上または車両停止状態を検出すると前記電磁クラッチ(22)によるステアリングシャフト(15)への動力を非伝達とすること特徴とする請求項1記載の走行車両自動操舵装置である。   According to a fourth aspect of the present invention, vehicle speed detecting means (57) for detecting the vehicle speed of the traveling vehicle is provided, and the automatic steering control means (100) is based on a detection result of the vehicle speed detecting means (57), or the vehicle speed is equal to or higher than a specified vehicle speed. 2. The traveling vehicle automatic steering device according to claim 1, wherein when the vehicle stop state is detected, power to the steering shaft (15) by the electromagnetic clutch (22) is not transmitted.

請求項1記載の発明によれば、電磁クラッチ22の伝達又は非伝達により正逆転モータ20がステアリングシャフト15を自動操舵制御手段100により駆動制御する自動操舵モードのときに、挙動検出手段Kが、例えはクラッチペダルのオン、左又は右のブレーキペダルのオン又は前後進レバーが前進側又は後進側に移動されるなどの何らかの走行走行車両の挙動操作が行われると、電磁クラッチ22の伝達又は非伝達用正逆転モータ20による自動操舵モードを禁止する制御とすることができ、また、緊急時にステアリングハンドル9の手動操作に切替ができるので車両の走行安全性が確保できる。   According to the first aspect of the present invention, when the forward / reverse rotation motor 20 is in the automatic steering mode in which the steering shaft 15 is driven and controlled by the automatic steering control means 100 by transmission or non-transmission of the electromagnetic clutch 22, the behavior detection means K is For example, when the behavior of the traveling vehicle is performed, such as when the clutch pedal is turned on, the left or right brake pedal is turned on, or the forward / reverse lever is moved forward or backward, the transmission or non-transmission of the electromagnetic clutch 22 is performed. It is possible to control to prohibit the automatic steering mode by the transmission forward / reverse rotation motor 20, and to switch to manual operation of the steering handle 9 in an emergency, it is possible to secure the traveling safety of the vehicle.

請求項2記載の発明によれば、請求項1記載の発明の効果に加えて、走行車両の旋回動作または旋回開始点を検出する検出手段(ステアリング切れ角センサ49,リフトアーム傾斜角センサ50,カメラコントローラ52)を設け、該検出手段(49,50,52)により検出された旋回動作または旋回開始点の検出結果に基づいて電磁クラッチ22を非伝動として自動的に手動操舵操作に戻す制御を行うこともでき、自動操舵モードを解除等の操作を運転者がすることなく操舵制御が簡単にできる。   According to the second aspect of the present invention, in addition to the effect of the first aspect, the detecting means (steering angle sensor 49, lift arm inclination angle sensor 50, A camera controller 52) is provided, and based on the detection result of the turning operation or the turning start point detected by the detecting means (49, 50, 52), the electromagnetic clutch 22 is controlled to return to manual steering operation automatically without transmission. The steering control can be easily performed without the driver performing an operation such as canceling the automatic steering mode.

請求項3記載の発明によれば、請求項1記載の発明の効果に加えて、ステアリング握り検出手段(ステアリング歪みセンサ54,静電容量型検出センサ55)によるステアリング9の握り検出があるとステアリングハンドル9を手動に切り替えることができるので、ステアリングハンドル9に触れたときの自動解除を防ぐことができる。   According to the invention described in claim 3, in addition to the effect of the invention described in claim 1, if there is a grip detection of the steering wheel 9 by the steering grip detection means (the steering distortion sensor 54, the capacitance type detection sensor 55), the steering wheel is detected. Since the handle 9 can be switched to manual, automatic release when the steering handle 9 is touched can be prevented.

請求項4記載の発明によれば、請求項1記載の発明の効果に加えて、車速が規定車速以上または走行停止状態であるとる自動操舵モードを解除して安全性を従来より高くすることができる。   According to the invention described in claim 4, in addition to the effect of the invention described in claim 1, it is possible to release the automatic steering mode in which the vehicle speed is equal to or higher than the specified vehicle speed or in the travel stop state, thereby improving safety. it can.

農用作業走行車両の一例としての農用トラクタの右側面図である。It is a right view of the agricultural tractor as an example of an agricultural work traveling vehicle. 図1の農用トラクタの前部側面図である。It is a front part side view of the agricultural tractor of FIG. 図1のトラクタのステアリングハンドルの自動操舵用駆動装置の概略構成である。It is a schematic structure of the drive device for automatic steering of the steering handle of the tractor of FIG. 図3の矢印A方向からの矢視略図である。FIG. 4 is a schematic view from the direction of arrow A in FIG. 3. 図1のトラクタの自動操舵用駆動装置の制御構成図である。It is a control block diagram of the drive device for automatic steering of the tractor of FIG. 図1のトラクタの自動操舵用駆動装置の制御ブロック図である。FIG. 2 is a control block diagram of the automatic steering drive device for the tractor of FIG. 1. 図6の自動操舵用駆動装置の自動モード、手動モード、中立復帰モード及び通常モードへそれぞれ移行するためのモード変更のためのフローチャートである。FIG. 7 is a flowchart for mode change for shifting to an automatic mode, a manual mode, a neutral return mode, and a normal mode of the automatic steering drive device of FIG. 6. 図1のトラクタに搭載したカメラから目標Xと走行車両の直進方向からのズレ角度の説明図Explanatory drawing of deviation angle from target X and straight direction of traveling vehicle from camera mounted on tractor of FIG. 図6の自動操舵モードを含むフローチャートである。It is a flowchart including the automatic steering mode of FIG. 図6の自動操舵モードを含むローチャートである。7 is a flowchart including the automatic steering mode of FIG. 6. 図6の自動操舵モードを含むローチャートである。7 is a flowchart including the automatic steering mode of FIG. 6. 図6の自動操舵モードを含むフローチャート(図12(a)、(b))である。It is a flowchart (FIG. 12 (a), (b)) including the automatic steering mode of FIG. 図6の自動操舵モードを含むフローチャート(図13(a)、(b))である。It is a flowchart (FIG. 13 (a), (b)) including the automatic steering mode of FIG. 図6の自動操舵モードを含むフローチャートである。It is a flowchart including the automatic steering mode of FIG. 図6の自動操舵モードを含むフローチャート(図13(a))と走行車両の走行時の説明図(図15(b))である。FIG. 15 is a flowchart including the automatic steering mode in FIG. 6 (FIG. 13A) and an explanatory diagram when the traveling vehicle is traveling (FIG. 15B). 図6の自動操舵モードの遠目標の認識して走行制御する制御ブロック図である。FIG. 7 is a control block diagram for performing travel control by recognizing a far target in the automatic steering mode of FIG. 6. 図16の制御ブロック図に基づく制御のフローチャート(図17(a))と走行車両走行時の説明図(図17(b))である。FIG. 17 is a control flowchart (FIG. 17A) based on the control block diagram of FIG. 16 and an explanatory diagram (FIG. 17B) during traveling of the traveling vehicle.

この発明の一実施例を図面に基づき説明する。
図1と図2に農用作業走行車両の一例としての農用トラクタの右側面図とその前部側面図を示す。走行車両1の前後部に前輪2と後輪3とを備え、ボンネット4内に装着されるエンジン5の回転動力をミッションケース6内の変速装置で適宜減速し、減速した回転動力を当該前輪2,後輪3に伝達すべく構成している。
An embodiment of the present invention will be described with reference to the drawings.
1 and 2 show a right side view and a front side view of an agricultural tractor as an example of an agricultural work traveling vehicle. A front wheel 2 and a rear wheel 3 are provided at the front and rear portions of the traveling vehicle 1, and the rotational power of the engine 5 mounted in the bonnet 4 is appropriately decelerated by a transmission in the transmission case 6, and the reduced rotational power is transmitted to the front wheel 2. , To be transmitted to the rear wheel 3.

機体中央部の運転者席7の前方には、ハンドルポスト8を設け、ステアリングハンドル9を旋回操作可能に設けている。このステアリングハンドル9の旋回操作は操舵機構を介して左右前輪2,2を操向連動する構成としている。なお、ステアリングハンドル9の近傍にはアクセルレバー10を、ハンドルポスト8の下部側には左右独立するブレーキペダル11,11を配設すると共に、上記運転者席7とこのハンドルポスト8間には走行用変速レバー(図示せず)を配設している。   A handle post 8 is provided in front of the driver's seat 7 in the center of the fuselage so that the steering handle 9 can be turned. The turning operation of the steering handle 9 is configured such that the left and right front wheels 2 and 2 are steered and linked via a steering mechanism. An accelerator lever 10 is disposed near the steering handle 9, and left and right independent brake pedals 11, 11 are disposed on the lower side of the handle post 8, and the vehicle travels between the driver's seat 7 and the handle post 8. A transmission lever (not shown) is provided.

上記機体1の後部には耕耘作業機12が装着されており、該耕耘作業機12はリフトアーム13とロアリンク14,14とからなる3点リンク機構を介して上下昇降可能に装着している。油圧シリンダ機構(図示せず)はポジションレバー(図示せず)の回動操作によって伸縮してリフトアーム13を上下回動し、これによりリフトロッド13aを介してロアリンク14,14を上下動させることにより作業機12を昇降連動する構成である。   A tilling work machine 12 is attached to the rear part of the machine body 1, and the tilling work machine 12 is attached so as to be movable up and down through a three-point link mechanism including a lift arm 13 and lower links 14 and 14. . A hydraulic cylinder mechanism (not shown) expands and contracts by rotating a position lever (not shown) to vertically move the lift arm 13, thereby moving the lower links 14 and 14 up and down via the lift rod 13 a. Thus, the working machine 12 is configured to move up and down.

前記エンジン5から出力された回転動力は、図示しない主クラッチ、前後進切替機構を経由し主変速機構、副変速機構で適宜変速されて後輪デフ機構へ伝達される構成である。また、副変速機構からの回転動力は前輪駆動軸32へ伝達可能の構成である。   The rotational power output from the engine 5 is transmitted through the main clutch and forward / reverse switching mechanism (not shown) to the rear wheel differential mechanism after being appropriately shifted by the main transmission mechanism and the auxiliary transmission mechanism. Further, the rotational power from the auxiliary transmission mechanism can be transmitted to the front wheel drive shaft 32.

前輪駆動軸32は前輪デフ機構33に連動連結される。この前輪デフ機構33はアクスルブラケット35に前後軸心回りに左右揺動自在に支承されるものである。ステアリングハンドル9に連動する伝動軸37は自在継手36を介して前輪2、2の操舵機構(パワステユニット)39(図5)に連結している。   The front wheel drive shaft 32 is linked to the front wheel differential mechanism 33. The front wheel differential mechanism 33 is supported on the axle bracket 35 so as to be able to swing left and right about the front and rear axis. A transmission shaft 37 interlocked with the steering handle 9 is connected to a steering mechanism (power steering unit) 39 (FIG. 5) of the front wheels 2 and 2 via a universal joint 36.

図3にステアリングハンドル9の自動操舵用駆動装置の概略構成図を示し、図4に図3の矢印A方向からの矢視図を示す。
ステアリングハンドル9のシャフト15の軸心周りに該シャフト15と一体的に従動スプロケット16を設ける。またステアリングシャフト15を支持するハンドルポスト8に対して着脱自在に運転席側に張り出すようカバー部材8aを構成し、該カバー部材8a内にはステアリングシャフト15の軸方向に平行する方向に配置した中間軸17を配置している。
FIG. 3 shows a schematic configuration diagram of a drive device for automatic steering of the steering handle 9, and FIG. 4 shows an arrow view from the direction of arrow A in FIG.
A driven sprocket 16 is provided integrally with the shaft 15 around the axis of the shaft 15 of the steering handle 9. Further, a cover member 8a is formed so as to detachably attach to the driver's seat side with respect to the handle post 8 that supports the steering shaft 15, and is disposed in the cover member 8a in a direction parallel to the axial direction of the steering shaft 15. An intermediate shaft 17 is arranged.

中間軸17と一体である駆動スプロケット21と従動スプロケット16の間にタイミングベルト27を掛けられているので、正逆転モータ20により駆動スプロケット21が駆動されると、その駆動力が従動スプロケット16を経由してステアリングハンドル9のシャフト15が回動する。   Since the timing belt 27 is hung between the driving sprocket 21 and the driven sprocket 16 integrated with the intermediate shaft 17, when the driving sprocket 21 is driven by the forward / reverse motor 20, the driving force passes through the driven sprocket 16. As a result, the shaft 15 of the steering handle 9 rotates.

駆動スプロケット21より下方には電磁コイル22aを有する電磁クラッチ22が取り付けられており、該電磁クラッチ22の近傍に正逆転モータ20及び該モータ20のモータ連動軸20aと一体の第1ギヤ19が配置されている。   An electromagnetic clutch 22 having an electromagnetic coil 22a is attached below the drive sprocket 21, and a forward / reverse motor 20 and a first gear 19 integrated with the motor interlocking shaft 20a of the motor 20 are disposed in the vicinity of the electromagnetic clutch 22. Has been.

図4に示すように、中間軸17に遊嵌状態にアーマチュア29とロータリング28が取り付けられ、ロータリング28側には第2ギヤ18が形成され、前記第1ギア19と該第2ギア18が常時噛合している。アーマチュア29は前記駆動スプロケット21を縦方向ボルト等の伝達部材を介して一体的に設けられている。   As shown in FIG. 4, an armature 29 and a rotor ring 28 are attached to the intermediate shaft 17 in a loosely fitted state, a second gear 18 is formed on the rotor ring 28 side, and the first gear 19 and the second gear 18 are formed. Always mesh. The armature 29 is integrally provided with the drive sprocket 21 via a transmission member such as a longitudinal bolt.

上記構成で、電磁クラッチ22がオン(作動)のとき、即ち電磁コイル22aに通電すると、ロータリング28にアーマチュア29が吸引され付着する。また、正逆転モータ20の駆動で、その連動軸20aに連動した第1ギヤ19が駆動し、該第1ギヤ19に噛合する第2ギヤ18が駆動し、該第2ギヤ18の駆動に伴ない回転するロータリング28の駆動で、前記吸着状態のアーマチュア29が駆動し、アーマチュア29と一体の駆動スプロケット21が回転する。なお、駆動スプロケット21は前記アーマチュア29、ロータリング28を遊嵌支持する中間軸17に固着されている。   With the above configuration, when the electromagnetic clutch 22 is on (actuated), that is, when the electromagnetic coil 22a is energized, the armature 29 is attracted and attached to the rotor ring. Further, when the forward / reverse motor 20 is driven, the first gear 19 interlocked with the interlocking shaft 20 a is driven, the second gear 18 meshing with the first gear 19 is driven, and the second gear 18 is driven. When the rotating rotor ring 28 is not driven, the attracted armature 29 is driven, and the drive sprocket 21 integrated with the armature 29 rotates. The drive sprocket 21 is fixed to the intermediate shaft 17 that loosely supports the armature 29 and the rotor ring 28.

電磁クラッチ22がオフのときには、電磁コイル22aが非通電となるため、ロータリング28がアーマチュア29から離れる。正逆転モータ20が駆動中であっても、第1ギヤ19から第2ギヤ18を経由してロータリング28までが回転駆動力が伝達されるだけである。   When the electromagnetic clutch 22 is off, the electromagnetic coil 22a is de-energized, so that the rotor ring 28 is separated from the armature 29. Even when the forward / reverse motor 20 is being driven, only the rotational driving force is transmitted from the first gear 19 to the rotor ring 28 via the second gear 18.

なお、カバー部材8aは、ステアリングポスト8に対して適宜の手段で着脱自在に取り付けられる側面視逆L型のモータ取付ベースプレート59を介して着脱自在に固着されている。なお、前記電磁クラッチ22の下面を受けるためのベースプレート62を支持すべくステアリングポスト8側から延出されたベースプレートブラケット34がステアリングポスト8に取り付けられている。   Note that the cover member 8a is detachably fixed to the steering post 8 via a side-view reverse L-type motor mounting base plate 59 that is detachably mounted by appropriate means. A base plate bracket 34 extending from the steering post 8 side is attached to the steering post 8 so as to support the base plate 62 for receiving the lower surface of the electromagnetic clutch 22.

前記モータ20のフランジ56には水平方向に配置される正逆転モータ20の本体軸(図示せず)から第1ギヤ19に変換するベベルギヤ群を収容するギア伝動部31a,31bが設けられている。   The flange 56 of the motor 20 is provided with gear transmission portions 31a and 31b that house a bevel gear group that converts the main shaft (not shown) of the forward / reverse rotation motor 20 disposed in the horizontal direction into the first gear 19. .

また、本実施例の運転者席7のある操縦部には図示しないが、電磁クラッチ22のオン、オフを司る自動スイッチ24(図6参照)、ブレーキモードスイッチ25、正逆転モータ20を手動で所定量作動させるためのモータ手動ダイヤル26、ブレーキ圧調整ダイヤル44、左ブレーキペダルスイッチ42、右ブレーキペダルスイッチ43、クラッチペダルスイッチ45、前後進レバー中立位置スイッチ46、モニタ(自動モニタ47a,受信モニタ47b)等は配置されている。なお、自動モニタ47aはモータ20による自動操舵モードに入っていることを知らせる手段であり、受信モニタ47bはカメラ53からの受信信号が正常に自動操舵を司る状態のときを知らせる手段である。   Although not shown in the control section with the driver's seat 7 of the present embodiment, the automatic switch 24 (see FIG. 6) for controlling on / off of the electromagnetic clutch 22, the brake mode switch 25, and the forward / reverse motor 20 are manually operated. Motor manual dial 26 for operating a predetermined amount, brake pressure adjustment dial 44, left brake pedal switch 42, right brake pedal switch 43, clutch pedal switch 45, forward / reverse lever neutral position switch 46, monitor (automatic monitor 47a, reception monitor) 47b) etc. are arranged. The automatic monitor 47a is a means for notifying that the automatic steering mode by the motor 20 has been entered, and the reception monitor 47b is a means for notifying when the received signal from the camera 53 is normally in a state of controlling automatic steering.

本実施例では前記中間軸17と前記正逆転モータ20との間の動力の伝達又は非伝達用の電磁クラッチ22と駆動スプロケット21と動力伝達部材27を既存ステアリングハンドル部に外付け可能なため汎用性の高い自動操舵装置が得られる。   In this embodiment, the electromagnetic clutch 22 for transmitting or not transmitting power between the intermediate shaft 17 and the forward / reverse motor 20, the drive sprocket 21, and the power transmission member 27 can be externally attached to the existing steering handle portion. A highly automatic steering device can be obtained.

この自動操舵用駆動装置の制御構成図を図5に示す。
操舵用制御装置(コントローラ)100はドライバユニット23を経由して正逆転モータ20への出力を行い、駆動スプロケット21、従動スプロケット16、ステアリングシャフト15、パワステユニット39、前輪操舵部48を経由して、ハンドル9の操舵角に応じて前輪2が操舵される。前輪操舵角度は操舵角センサ41により検出され、操舵用コントローラ100にフィードバックされる。
また、車両の直進支援用のカメラコントローラ52を操舵用コントローラ100とは別に設けておき、カメラ53からの撮像信号に基づき、またはナビゲーションコントローラ30からの情報に基づき操舵用コントローラ100により車両の操舵を行うこともできる。
FIG. 5 shows a control configuration diagram of the automatic steering drive device.
The steering control device (controller) 100 outputs to the forward / reverse motor 20 via the driver unit 23, and passes through the drive sprocket 21, the driven sprocket 16, the steering shaft 15, the power steering unit 39, and the front wheel steering unit 48. The front wheel 2 is steered according to the steering angle of the handle 9. The front wheel steering angle is detected by the steering angle sensor 41 and fed back to the steering controller 100.
Further, a camera controller 52 for supporting the vehicle going straight is provided separately from the steering controller 100, and the steering controller 100 steers the vehicle based on an imaging signal from the camera 53 or based on information from the navigation controller 30. It can also be done.

操舵用コントローラ100には操作パネル38上に配置した前記自動操舵用駆動装置の制御を開始させるための自動スイッチ24、オペレータによるハンドル操作量をステアリングシャフト15に連動させるために、ハンドル操作量を可変抵抗器の抵抗値として出力して、ステアリングハンドル9の中立位置の調整を前記自動操舵中でも行うことができるトリムスイッチ、ステアリングハンドル9を中立位置に戻すための中立復帰スイッチ、左側又は右側に傾倒自在に設けられたモータ手動ダイヤル26等を接続し、さらに作業車両の各種作業などの操作指令、走行速度の制御指令などを発信するための操作パネル38と通信が出来る構成になっている。   The steering controller 100 includes an automatic switch 24 for starting control of the automatic steering drive device disposed on the operation panel 38, and the handle operation amount is variable in order to link the handle operation amount by the operator to the steering shaft 15. A trim switch that can output the resistance value of the resistor and adjust the neutral position of the steering wheel 9 even during the automatic steering, a neutral return switch for returning the steering wheel 9 to the neutral position, and can be tilted to the left or right The motor manual dial 26 and the like provided in the vehicle are connected, and further, communication with an operation panel 38 for transmitting operation commands for various operations of the work vehicle, control commands for the traveling speed, and the like is possible.

また図6の制御ブロック図に示すように、走行車両の適所にはステアリング切れ角センサ(方向操舵検出手段)49、リフトアーム傾斜角センサ50、傾斜地走行時に車両の傾斜角度を検出する車両傾斜角度センサ51、耕耘作業機12を昇降させるトップリンクの傾斜角度検出センサ51、カメラ53による目標地点までの距離を計測できる距離センサを含むカメラコントローラ52、ステアリングハンドル9を運転者が把持することを検出できるステアリングハンドル歪みセンサ54又はステアリングハンドル9の外周に設ける静電容量型検出センサ55、走行車両の車速を検出する車速センサ57、後述するように車両の直進走行性を維持するための角速度センサ58、エンジン回転軸の回転の有無を検出することによりエンジン回転停止を検出するエンジン回転停止センサ60(車速センサ57とは別にある)、傾斜地走行時に進行方向を補正する傾斜時補正ダイヤル61等を設けている。   As shown in the control block diagram of FIG. 6, a steering angle sensor (direction steering detection means) 49, a lift arm inclination angle sensor 50, and a vehicle inclination angle for detecting the inclination angle of the vehicle when traveling on an inclined ground are provided at appropriate positions of the traveling vehicle. Detects that the driver holds the steering handle 9, the sensor 51, the tilt angle detection sensor 51 of the top link that raises and lowers the tillage work machine 12, the camera controller 52 including the distance sensor that can measure the distance to the target point by the camera 53. A steering handle distortion sensor 54 or a capacitive detection sensor 55 provided on the outer periphery of the steering handle 9, a vehicle speed sensor 57 for detecting the vehicle speed of the traveling vehicle, and an angular velocity sensor 58 for maintaining the straight traveling performance of the vehicle as will be described later. , Engine rotation by detecting the presence or absence of rotation of the engine rotation shaft An engine rotation stop sensor 60 for detecting the stop (the vehicle speed sensor 57 is separately) is provided with inclined time correction dial 61 for correcting the traveling direction at the time of slope running.

そして、図7には本実施例の自動操舵用駆動装置の制御フローチャートを示す。
まず各種センサ、スイッチの作動状態を読み込み、次いでステップ(Sa)で自動スイッチ24がオフなら正逆転モータ20をモータ手動ダイヤル26により左右に所定量回して、その分、旋回方向を決めて旋回ができる。正逆転モータ20の手動ダイヤル26の操作位置が中立位置であればそのまま本制御フローは終了し、正逆転モータ20の手動ダイヤル26が中立位置以外のハンドル切れ角(θm)に相当する位置に作動されると、電磁クラッチ22をオンとし、同時に正逆転モータ20も作動し、その後ステアリングハンドル切れ角センサ49が切れ角θmを検出すると正逆転モータ20の出力をオフとして前記切れ角θmでスタリングシャフト9を手動旋回操作させる。
FIG. 7 shows a control flowchart of the automatic steering drive device of this embodiment.
First, read the operating states of various sensors and switches. Then, if the automatic switch 24 is turned off in step (Sa), the forward / reverse motor 20 is turned to the left and right by the motor manual dial 26, and the turning direction is determined accordingly. it can. If the operation position of the manual dial 26 of the forward / reverse rotation motor 20 is the neutral position, this control flow is terminated, and the manual dial 26 of the forward / reverse rotation motor 20 operates to a position corresponding to the steering angle (θm) other than the neutral position. Then, the electromagnetic clutch 22 is turned on, and the forward / reverse rotation motor 20 is also operated at the same time. Thereafter, when the steering handle turning angle sensor 49 detects the turning angle θm, the output of the forward / reverse rotation motor 20 is turned off and the stirling is performed at the turning angle θm. The shaft 9 is manually turned.

また、ステップ(Sa)で自動スイッチ24がオンなら電磁クラッチ22と自動モニタ47aをオンとし、カメラ53の受信データを読み込む。次いで、図8に示すように走行車両に搭載したカメラ53から複数のLEDの発光体でできた目標Xと走行車両の直進方向からのズレ角度(Δθ)を算出する。   If the automatic switch 24 is turned on in step (Sa), the electromagnetic clutch 22 and the automatic monitor 47a are turned on, and the received data of the camera 53 is read. Next, as shown in FIG. 8, the deviation X (Δθ) from the target X made of a plurality of LED light emitters and the straight traveling direction of the traveling vehicle is calculated from the camera 53 mounted on the traveling vehicle.

さらにステップ(Sb)で走行車両が傾斜地を走行であるかどうか車両の傾斜角度を車両傾斜角度センサ51で検出する。傾斜地を走行中であることが分かれば、そのまま走行車両を前進させると傾斜地をずれ落ちる方向に進行するので走行車両の前進方向を所定角度(θ’)だけ上向きにハンドル切れ角度を変えて目標Xに向かって走行車両を直進走行させる必要がある。   Further, in step (Sb), the vehicle inclination angle sensor 51 detects the inclination angle of the vehicle whether or not the traveling vehicle is traveling on an inclined ground. If it is known that the vehicle is traveling on a sloping ground, if the traveling vehicle is moved forward as it is, it will travel in the direction of falling off the sloping ground. It is necessary to drive the traveling vehicle straight toward the vehicle.

従って走行車両は前記ズレ角度(Δθ)と所定角度(θ’)の和(Δθ+θ’)に対応するハンドル切れ角で前進させるために正逆転モータ20の駆動量を決めて、該駆動量に対応したハンドル切れ角が得られるように、該モータ20を正逆回転方向に回転させる。なお、正逆転モータ20を適切な正逆回転方向に回転させるときに左右ブレーキのいずれか片方だけを作動させて走行車両の前進方向を調整しても良い。   Therefore, the traveling vehicle determines the driving amount of the forward / reverse motor 20 in order to move forward with the steering angle corresponding to the sum (Δθ + θ ′) of the deviation angle (Δθ) and the predetermined angle (θ ′), and corresponds to the driving amount. The motor 20 is rotated in the forward and reverse rotation directions so that the handle turning angle is obtained. Note that when the forward / reverse rotation motor 20 is rotated in an appropriate forward / reverse rotation direction, only one of the left and right brakes may be operated to adjust the forward direction of the traveling vehicle.

その後ステップ(Sc)でスタリングハンドル切れ角(θn)を読み込み、次の数式の関係が成り立つと、
|θn−(Δθ+θ’)|<δ
ステップ(Sd)で正逆転モータ20の出力をオフとし、スタリングハンドル切れ角(θn)で目標Xに向かって走行車両を直進走行させる。次いで自動スイッチ24がオフであれば、電磁クラッチ22と自動モニタ47aをオフとして自動操舵用駆動装置の制御を終了する。
After that, in step (Sc), the Stirling handle turning angle (θn) is read, and when the relationship of the following equation is established,
| Θn− (Δθ + θ ′) | <δ
In step (Sd), the output of the forward / reverse rotation motor 20 is turned off, and the traveling vehicle is made to travel straight toward the target X at the stalling handle turning angle (θn). Next, if the automatic switch 24 is off, the electromagnetic clutch 22 and the automatic monitor 47a are turned off and the control of the automatic steering drive device is terminated.

なお、前記走行車両に搭載したカメラ53に角速度センサ58を設けてき、前記ズレ角度(Δθ)を算出する際に前記角速度センサ58の検出値が所定範囲を超えたときに始めて前記モータ20の駆動により走行車両の直進走行を行うようにすると、角速度センサ検出値の不感帯ができるので畝越え時などにおける直進性が従来より向上する。   Note that the angular velocity sensor 58 is provided in the camera 53 mounted on the traveling vehicle, and the motor 20 is driven only when the detected value of the angular velocity sensor 58 exceeds a predetermined range when calculating the deviation angle (Δθ). When the vehicle travels straight ahead, the dead zone of the detected value of the angular velocity sensor is created, so that the straight traveling performance at the time of over the heel is improved as compared with the prior art.

ここで図7のステップ(Sb)からステップ(Sd)の直前までの各ステップは、正逆転モータ20による自動操舵モードに対応しているが、ここで走行車両がそのまま自動操舵モードで走行中に、何らかの操作がなされる(これを走行走行車両の挙動ということにする)と、その操作に応じて図9のフローチャートに示すステップe(Se)ように作動中の電磁クラッチ22をオフにしてステアリングハンドルの手動操作を行う構成にしても良い。   Here, each step from step (Sb) to immediately before step (Sd) in FIG. 7 corresponds to the automatic steering mode by the forward / reverse rotation motor 20, but here the traveling vehicle is traveling in the automatic steering mode as it is. When some operation is performed (this is referred to as the behavior of the traveling vehicle), the operating electromagnetic clutch 22 is turned off in accordance with the operation, as shown in step e (Se) shown in the flowchart of FIG. A configuration in which the handle is manually operated may be adopted.

例えば、クラッチペダル(図示せず)がオンとなったとき、左又は右のブレーキペダルスイッチ42,43がオンとなったとき又は前後進レバーが前進側又は後進側に移動してオンとなったときには正逆転モータ20による自動操舵モードが作動しないような制御とすることで走行安全性が確保できる。   For example, when a clutch pedal (not shown) is turned on, when the left or right brake pedal switches 42 and 43 are turned on, or when the forward / reverse lever is moved forward or backward, the clutch pedal (not shown) is turned on. In some cases, driving safety can be ensured by controlling the automatic steering mode by the forward / reverse motor 20 not to operate.

このように電磁クラッチ22をオン・オフに切り替えることにより緊急時にステアリングハンドルを手動操作できる。
また、本実施例の制御装置は、走行車両の旋回動作または旋回開始点を検出する検出手段を設け、該検出手段により検出された旋回動作または旋回開始点の検出結果に基づいて電磁クラッチ22をオフとする制御を行うこともできる。
In this way, the steering handle can be manually operated in an emergency by switching the electromagnetic clutch 22 on and off.
Further, the control device of the present embodiment is provided with detection means for detecting the turning operation or turning start point of the traveling vehicle, and the electromagnetic clutch 22 is turned on based on the detection result of the turning action or turning start point detected by the detection means. Control to turn off can also be performed.

前記旋回動作の検出手段は、例えばリフトアーム13の傾斜角度センサ50が、リフトアーム13の傾斜角度が所定の上昇側の傾斜角度になることを検出したとき、又はステアリングハンドル切り角センサ49がステアリングハンドル9が所定の旋回角度以上の旋回角度で旋回していることを検出したときであり、また旋回開始点は、例えば畦際に達してカメラ53によりカメラコントローラ52が測定される目標Xまでの距離が所定値以下であること(遠目標手前規定距離)を検出した場合である。   For example, when the tilt angle sensor 50 of the lift arm 13 detects that the tilt angle of the lift arm 13 becomes a predetermined upward tilt angle, or the steering handle turning angle sensor 49 detects the turning motion detection means. This is a time when it is detected that the handle 9 is turning at a turning angle greater than or equal to a predetermined turning angle, and the turning start point reaches, for example, the target X at which the camera controller 52 is measured by the camera 53 when the camera controller 52 is measured. This is a case where it is detected that the distance is equal to or less than a predetermined value (a prescribed distance before the far target).

この場合の制御フローチャートは、図7のステップ(Sb)からステップ(Sd)の直前までの各ステップにある正逆転モータ20による自動操舵モードに対応しているが、ここで走行車両がそのまま自動操舵モードで走行中に旋回動作の検出または旋回開始点の検出があると、その操作に応じて図10のフローチャートに示す自動操舵モードのステップ(Sf)のように作動中の電磁クラッチ22をオフにして、自動操舵モードを終了してステアリングハンドルの手動操作を行う構成にしても良い。   The control flowchart in this case corresponds to the automatic steering mode by the forward / reverse rotation motor 20 in each step from step (Sb) to step (Sd) in FIG. 7. If the turning operation or the turning start point is detected while traveling in the mode, the electromagnetic clutch 22 in operation is turned off in accordance with the operation as shown in the step (Sf) of the automatic steering mode shown in the flowchart of FIG. Thus, the automatic steering mode may be terminated and the steering wheel may be manually operated.

上記制御により、例えば畦際に(圃場端)に走行車両が到達したときなど、耕耘作業機12が上昇したときには自動的に電磁クラッチ22がオフとなるので、自動操舵モードを解除等の操作を運転者がすることなく、走行車両の手動による旋回動作に入ることができるメリットがある。   By the above control, the electromagnetic clutch 22 is automatically turned off when the tilling work machine 12 is lifted up, for example, when the traveling vehicle reaches the edge (farm field end), so that an operation such as releasing the automatic steering mode is performed. There is an advantage that it is possible to enter a turning operation manually by the traveling vehicle without the driver.

また、図11のフローチャートに示すように、図7のステップ(Sb)からステップ(Sd)の直前までの各ステップにある正逆転モータ20による自動操舵モードに対応しているが、ここでステアリングハンドル9をオペレータが握り操作すると、ステアリングハンドル握り操作の検出結果に基づいて前記電磁クラッチ22をオフとする出力する構成にしても良い。   Further, as shown in the flowchart of FIG. 11, it corresponds to the automatic steering mode by the forward / reverse rotation motor 20 in each step from step (Sb) to step (Sd) in FIG. When the operator grips 9, the electromagnetic clutch 22 may be turned off based on the detection result of the steering wheel grip operation.

なお、ステアリング握りの検出は、例えばステアリングハンドル基部のステアリング軸に歪みセンサ54を設け、該センサ54の歪み検出でオペレータのステアリングハンドル9の押し作動を検出する。また、ステアリングハンドル9の外周に静電容量型検出センサ55を設けてオペレータのハンドルの握り検出をすることもできる。   For the detection of the steering grip, for example, a distortion sensor 54 is provided on the steering shaft of the steering handle base, and the operator's pushing operation of the steering handle 9 is detected by detecting the distortion of the sensor 54. Further, it is possible to detect the grip of the operator's handle by providing a capacitance type detection sensor 55 on the outer periphery of the steering handle 9.

上記制御構成でステアリングハンドル9をオペレータが握ったことを検出して一定時間が経過したらステアリングハンドル9を手動に切り替えるようにしても良い。   The steering handle 9 may be switched to manual operation after a predetermined time has elapsed after detecting that the operator has grasped the steering handle 9 with the above control configuration.

こうしてスイッチ操作を行うことなく自動操舵を解除することができ、操作性が従来より向上するとともに、一定時間の経過後に自動操舵解除をすることにより、誤操作でステアリングハンドル9に触れたときの自動解除を防ぐことができる。   In this way, automatic steering can be canceled without operating the switch, and the operability is improved compared to the prior art, and automatic steering is canceled after a certain period of time, so that automatic cancellation when the steering handle 9 is touched by mistake is performed. Can be prevented.

図12(a)のフローチャートに示すように自動スイッチ24をオンして後に、車速が規定車速より小さな車速で走行中は、初めて電磁クラッチ22を作動させて前述の自動操舵モードで走行制御を始める。しかし、車速が規定車速以上であると電磁クラッチ22を非作動として自動操舵モードによる走行を停止させる制御を行うことができる。   As shown in the flowchart of FIG. 12A, after the automatic switch 24 is turned on and the vehicle is traveling at a vehicle speed that is lower than the specified vehicle speed, the electromagnetic clutch 22 is operated for the first time and the traveling control is started in the above-described automatic steering mode. . However, when the vehicle speed is equal to or higher than the specified vehicle speed, it is possible to perform control for stopping the traveling in the automatic steering mode by disabling the electromagnetic clutch 22.

また、図12(b)のフローチャートに示すように自動スイッチ24をオンして後にすぐに自動操舵モードで自動操舵を行う場合にも規定車速以上で走行中は、通電されることによりエンジン5を運転可能にすると共に通電を遮断されることにより燃料カット機構を作動してエンジン停止させるキーストップソレノイド(図示せず)を作動させて、走行車両の走行を停止させる。   Also, as shown in the flowchart of FIG. 12B, when the automatic switch 24 is turned on and the automatic steering is immediately performed in the automatic steering mode, the engine 5 is energized while the vehicle is traveling at the specified vehicle speed or higher. A key stop solenoid (not shown) for operating the fuel cut mechanism and stopping the engine by operating the fuel cut-off and stopping the energization is operated to stop the traveling of the traveling vehicle.

図13(a)のフローチャートに示すように自動スイッチ24をオンして後に、電磁クラッチ22を作動させて、前述のように自動操舵モードで走行制御をするが、自動操舵モードに入る前にエンジン回転センサ60によりエンジンが作動していないことが検出されると、前記自動操舵モードに入らないで電磁クラッチ22を作動させない制御構成とする。こうして正逆転モータ20等の操舵機構に不必要な負荷がかかるのを防止することができる。   As shown in the flowchart of FIG. 13A, after the automatic switch 24 is turned on, the electromagnetic clutch 22 is operated to control the traveling in the automatic steering mode as described above. When it is detected by the rotation sensor 60 that the engine is not operating, the electromagnetic clutch 22 is not operated without entering the automatic steering mode. In this way, it is possible to prevent an unnecessary load from being applied to the steering mechanism such as the forward / reverse motor 20.

また、図13(b)のフローチャートに示すように走行開始前の走行停止時にステアリングハンドル9の自動スイッチ24をオンして後に電磁クラッチ22を作動させ、走行前にステアリングハンドル9の操作を自動操舵に切り替え、車両が走行を開始したらステアリングハンドル9の正逆転モータ20による自動操舵を開始するが、車速が「0」のときは自動操舵処理を行わない制御構成とすることもできる。なお、この制御構成の意義は、走行停止中にハンドル9を操作することはまずあり得ないので、電磁クラッチ22を作動させる必要性がないにも拘わらず通電状態のままで操舵信号によって正逆転モータ20が起動し不必要な負荷を引起す可能性を無くすためである。   Further, as shown in the flowchart of FIG. 13 (b), the automatic switch 24 of the steering handle 9 is turned on when the travel is stopped before the travel is started, and then the electromagnetic clutch 22 is operated to automatically steer the operation of the steering handle 9 before the travel. When the vehicle starts traveling, automatic steering by the forward / reverse motor 20 of the steering handle 9 is started. However, when the vehicle speed is “0”, a control configuration in which automatic steering processing is not performed may be adopted. The significance of this control configuration is that it is unlikely that the steering wheel 9 will be operated while the vehicle is stopped. This is to eliminate the possibility that the motor 20 is activated and causes an unnecessary load.

こうして、走行開始前の走行停止時にステアリングハンドル9の駆動を行わないため、正逆転モータ20の負荷を軽くすることが可能となる。   Thus, since the steering handle 9 is not driven when the travel is stopped before the travel is started, the load on the forward / reverse rotation motor 20 can be reduced.

図14のフローチャートに示すように自動スイッチ24をオンして後に、電磁クラッチ22を作動させて自動操舵モードで走行制御をするが、自動操舵モードに入るに当たって、前方に設置した遠目標(ランプ)X1をカメラ53で検出して直進走行を行うシステムに用いるカメラ53のコントローラ52からの受信データが入力できないとき又はカメラ53からの受信信号が途絶えた時はブザー63を鳴らし、自動操舵モードに入らないでステアリングハンドル9の操作を手動に切り替える。   As shown in the flowchart of FIG. 14, after the automatic switch 24 is turned on, the electromagnetic clutch 22 is operated to control the traveling in the automatic steering mode. When the received data from the controller 52 of the camera 53 used in the system that detects X1 with the camera 53 and goes straight ahead cannot be input or when the received signal from the camera 53 is interrupted, the buzzer 63 is sounded and the automatic steering mode is entered. Without switching the operation of the steering handle 9 to manual.

カメラコントローラ52からの受信データが制御装置100に入力できないとき又はカメラ53からの受信信号が途絶えた時はブザー63を鳴らし、自動操舵モードに入らないでステアリングハンドル9の操作を手動に切り替える制御構成にする。   A control configuration in which the buzzer 63 is sounded when the data received from the camera controller 52 cannot be input to the control device 100 or when the signal received from the camera 53 is interrupted, and the operation of the steering handle 9 is switched to manual operation without entering the automatic steering mode. To.

こうして本自動操舵システムの異常によりカメラ53からのデータが受信できないときに、確実にステアリングハンドル9を手動操作できる。   Thus, when the data from the camera 53 cannot be received due to an abnormality in the automatic steering system, the steering handle 9 can be reliably manually operated.

また、カメラ53からの受信信号が途絶えた時から一定時間内であればモータ20の出力制御を中断し、通信データが受信を待って一定時間が経過したらブザー63をオンし、手動に切り替える制御構成とすると、本システムが異常になっても短時間で復帰したときは、継続して自動操舵を行うことができ、ステアリングハンドル9の操作性が従来より向上する。   Also, if the received signal from the camera 53 is interrupted within a certain time, the output control of the motor 20 is interrupted, and the buzzer 63 is turned on when the communication data waits to be received and a certain time elapses. With this configuration, even if the present system becomes abnormal, when it returns in a short time, automatic steering can be continued, and the operability of the steering handle 9 is improved as compared with the conventional system.

また、図15(a)のフローチャートと図15(b)の走行車両の走行時の説明図に示すように自動スイッチ24をオンして後に、電磁クラッチ22を作動させて、前述のように自動操舵モードで走行制御をするが、自動操舵モードに入るに当たって、前方に設置した遠目標(ランプ)X1をカメラ53で検出して直進走行を行う自動操舵システムにおいてカメラ53のコントローラ52からの受信データが制御装置100に入力できないとき又はカメラ53からの受信信号が途絶えた時に、自動操舵モードに入らないでステアリングハンドル9の操作を手動に切り替えたら、走行行程の遠目的ランプX1を消灯する。   Further, as shown in the flowchart of FIG. 15A and the explanatory diagram at the time of traveling of the traveling vehicle of FIG. 15B, after the automatic switch 24 is turned on, the electromagnetic clutch 22 is operated and the automatic operation is performed as described above. Data is received from the controller 52 of the camera 53 in an automatic steering system in which traveling control is performed in the steering mode, but when the automatic steering mode is entered, a far target (ramp) X1 installed in front is detected by the camera 53 and travels straight ahead. When the operation of the steering wheel 9 is switched to manual operation without entering the automatic steering mode when the signal cannot be input to the control device 100 or when the received signal from the camera 53 is interrupted, the far purpose lamp X1 for the travel stroke is turned off.

こうして必要時にだけ遠目標を点灯することができ、点灯に必要な電池容量を節約することができ、省エネ運転が可能となる。   Thus, the far target can be lit only when necessary, the battery capacity required for lighting can be saved, and energy saving operation is possible.

さらに、図16の制御ブロック図と図17(a)のフローチャートと図17(b)の走行車両走行時の説明図に示すように、自動スイッチ24をオンして後に、電磁クラッチ22を作動させて、前述のように自動操舵モードで走行制御をするが、自動操舵モードに入るに当たって、前方に設置した遠目標(ランプ)X1をカメラ53で検出して直進走行を行う。そして走行車両旋回などにより、カメラ53からの受信信号が途絶えたらステアリングハンドル9の操作を手動に切り替え、次いで、次の走行行程の遠目的X2のランプを点灯させる構成としても良い。   Further, as shown in the control block diagram of FIG. 16, the flowchart of FIG. 17A and the explanatory view of the traveling vehicle of FIG. 17B, the electromagnetic clutch 22 is operated after the automatic switch 24 is turned on. As described above, the traveling control is performed in the automatic steering mode. When the automatic steering mode is entered, the far target (lamp) X1 installed in the front is detected by the camera 53 and the vehicle travels straight. Then, when the received signal from the camera 53 is interrupted due to turning of the traveling vehicle or the like, the operation of the steering handle 9 may be switched to manual, and then the far-distance X2 lamp for the next traveling stroke may be turned on.

なお、図16の制御ブロック図を示すように、遠目標X1,X2の点灯出力は送信回路で変調されて電波で遠目標X1又は遠目標X2の受信回路に出力される。   As shown in the control block diagram of FIG. 16, the lighting outputs of the far targets X1 and X2 are modulated by the transmission circuit and output to the receiving circuit of the far target X1 or the far target X2 by radio waves.

こうして、必要時にだけ遠目標X1又は遠目標X2を点灯することができ、点灯に必要な電池容量を節約することができ省エネルギー効果が大となる。また、車両の旋回後の次行程の遠目標X2を自動で点灯させることにより操作性が向上する。   Thus, the far target X1 or the far target X2 can be lit only when necessary, and the battery capacity required for lighting can be saved, resulting in a great energy saving effect. In addition, the operability is improved by automatically lighting the far target X2 in the next stroke after the vehicle turns.

本発明は、汎用自動操舵用駆動装置として利用可能性が高い。   The present invention is highly applicable as a general-purpose automatic steering drive device.

1 走行車両 2 前輪
3 後輪 4 ボンネット
5 エンジン 6 ミッションケース
7 運転者席 8 ハンドルポスト
8a カバー部材 9 ステアリングハンドル
10 アクセルレバー 11 ブレーキペダル
12 耕耘作業機 13 トップリンク
13a リフトロッド 14 ロアリンク
15 ステアリングシャフト
16 従動スプロケット 17 中間軸
18 第2ギア 19 第1ギヤ
20 正逆転モータ 20a モータ駆動軸
21 駆動スプロケット 22 電磁クラッチ
23 ドライバユニット 24 自動スイッチ
25 ブレーキモードスイッチ
26 モータ手動ダイヤル
27 タイミングベルト 27a ベースプレート
28 ロータリング 29 アーマチュア
30 ナビゲーションコントローラ
31a,31b ギア伝動部
32 前輪駆動軸 33 前輪デフ機構
34 ベースプレートブラケット
35 アクスルブラケット
36 自在継手 37 伝動軸
38 操作パネル 39 パワステユニット
40 中央基準値補正ダイヤル
41 操舵角センサ
42 左ブレーキペダルスイッチ
43 右ブレーキペダルスイッチ
44 ブレーキ圧調整ダイヤル
45 クラッチペダルスイッチ
46 前後進レバー中立位置スイッチ
47a 自動モニタ 47b 受信モニタ
48 前輪操舵部
49 ステアリング切れ角センサ(方向操舵検出手段)
50 リフトアーム傾斜角センサ
51 車両傾斜角度センサ
52 距離センサ(カメラコントローラ)
53 カメラ
54 ステアリングハンドル歪みセンサ
55 静電容量型検出センサ
56 フランジ 57 車速センサ
58 角速度センサ
59 モータ取付ベースプレート
60 エンジン回転センサ
61 傾斜時補正ダイヤル 62 ベースプレート
100 操舵用コントローラ
DESCRIPTION OF SYMBOLS 1 Traveling vehicle 2 Front wheel 3 Rear wheel 4 Bonnet 5 Engine 6 Mission case 7 Driver's seat 8 Handle post 8a Cover member 9 Steering handle 10 Accelerator lever 11 Brake pedal 12 Tillage working machine 13 Top link 13a Lift rod 14 Lower link 15 Steering shaft 16 driven sprocket 17 intermediate shaft 18 second gear 19 first gear 20 forward / reverse motor 20a motor drive shaft 21 drive sprocket 22 electromagnetic clutch 23 driver unit 24 automatic switch 25 brake mode switch 26 motor manual dial 27 timing belt 27a base plate 28 rotor ring 29 Armature 30 Navigation controllers 31a, 31b Gear transmission section 32 Front wheel drive shaft 33 Front wheel differential mechanism 34 Base plate Bracket 35 axle bracket 36 universal joint 37 transmission shaft 38 operation panel 39 power steering unit 40 central reference value correction dial 41 steering angle sensor 42 left brake pedal switch 43 right brake pedal switch 44 brake pressure adjustment dial 45 clutch pedal switch 46 forward / reverse lever neutral Position switch 47a Automatic monitor 47b Reception monitor 48 Front wheel steering section 49 Steering angle sensor (direction steering detection means)
50 Lift arm tilt angle sensor 51 Vehicle tilt angle sensor
52 Distance sensor (camera controller)
53 Camera 54 Steering handle distortion sensor 55 Capacitance type detection sensor 56 Flange 57 Vehicle speed sensor 58 Angular speed sensor 59 Motor mounting base plate 60 Engine rotation sensor 61 Tilt correction dial 62 Base plate 100 Steering controller

Claims (4)

走行車両の操舵をするステアリングハンドル(9)と、
該ステアリングハンドル(9)に連動して正転と逆転をするステアリングシャフト(15)と、
走行車両の操舵方向を検出する操舵方向検出手段(49)と、
ステアリングシャフト(15)に回転駆動力を伝達するための正逆転モータ(20)と、
該正逆転モータ(20)の回転駆動力をステアリングシャフト(15)に伝達するための電磁クラッチを有する連動機構と、
該電磁クラッチ(22)の作動/非作動を司る自動スイッチ(24)と、
走行車両の挙動を検出する挙動検出手段(K)と、
前記自動スイッチ(24)の操作により前記電磁クラッチ(22)が作動する自動モード中には前記操舵方向検出手段(49)の検出結果に基づいて前記正逆転モータ(20)の正逆転方向の出力によりステアリングシャフト(15)の自動操舵制御を行い、また前記挙動検出手段(K)の検出結果に基づいて前記電磁クラッチ(22)を非作動とするする自動操舵制御手段(100)と
を備えた走行車両自動操舵装置。
A steering handle (9) for steering the traveling vehicle;
A steering shaft (15) that rotates forward and backward in conjunction with the steering handle (9);
Steering direction detection means (49) for detecting the steering direction of the traveling vehicle;
A forward / reverse motor (20) for transmitting a rotational driving force to the steering shaft (15);
An interlocking mechanism having an electromagnetic clutch for transmitting the rotational driving force of the forward / reverse motor (20) to the steering shaft (15);
An automatic switch (24) for controlling the operation / non-operation of the electromagnetic clutch (22);
Behavior detecting means (K) for detecting the behavior of the traveling vehicle;
During the automatic mode in which the electromagnetic clutch (22) is operated by the operation of the automatic switch (24), the forward / reverse rotation direction output of the forward / reverse rotation motor (20) is based on the detection result of the steering direction detection means (49). And an automatic steering control means (100) for performing automatic steering control of the steering shaft (15) and deactivating the electromagnetic clutch (22) based on the detection result of the behavior detection means (K). Traveling vehicle automatic steering device.
走行車両の旋回動作または旋回開始点を検出する検出手段(49,50,52)を設け、前記自動操舵制御手段(100)は走行車両が旋回動作または旋回開始点検出手段の検出結果に基づいて前記電磁クラッチ(22)によるステアリングシャフト(15)への動力を非伝達とすることを特徴とする請求項1記載の走行車両自動操舵装置。   Detection means (49, 50, 52) for detecting the turning operation or turning start point of the traveling vehicle is provided, and the automatic steering control means (100) is based on the detection result of the turning operation or turning start point detection means by the traveling vehicle. The traveling vehicle automatic steering apparatus according to claim 1, wherein power to the steering shaft (15) by the electromagnetic clutch (22) is not transmitted. ステアリングハンドル(9)をオペレータが握り操作することを検出するステアリング握り検出手段(54,55)を設け、前記自動操舵制御手段(100)は前記ステアリング握り検出手段(54,55)の検出結果に基づいて前記電磁クラッチ(22)によるステアリングシャフト(15)への動力を非伝達とすることを特徴とする請求項1記載の走行車両自動操舵装置。   Steering grip detection means (54, 55) for detecting that the operator grips the steering handle (9) is provided, and the automatic steering control means (100) detects the detection result of the steering grip detection means (54, 55). 2. The traveling vehicle automatic steering apparatus according to claim 1, wherein power to the steering shaft (15) by the electromagnetic clutch (22) is not transmitted based on the electromagnetic clutch (22). 走行車両の車速を検出する車速検出手段(57)を設け、前記自動操舵制御手段(100)は車速検出手段(57)の検出結果に基づき車速が規定車速以上または車両停止状態を検出すると前記電磁クラッチ(22)によるステアリングシャフト(15)への動力を非伝達とすること特徴とする請求項1記載の走行車両自動操舵装置。   Vehicle speed detection means (57) for detecting the vehicle speed of the traveling vehicle is provided, and the automatic steering control means (100) detects the electromagnetic wave when the vehicle speed is higher than a specified vehicle speed or the vehicle is stopped based on the detection result of the vehicle speed detection means (57). 2. The traveling vehicle automatic steering apparatus according to claim 1, wherein power to the steering shaft (15) by the clutch (22) is not transmitted.
JP2010078715A 2010-03-30 2010-03-30 Driving device for automatic steering of traveling vehicle Expired - Fee Related JP5560844B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2010078715A JP5560844B2 (en) 2010-03-30 2010-03-30 Driving device for automatic steering of traveling vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2010078715A JP5560844B2 (en) 2010-03-30 2010-03-30 Driving device for automatic steering of traveling vehicle

Publications (2)

Publication Number Publication Date
JP2011207407A true JP2011207407A (en) 2011-10-20
JP5560844B2 JP5560844B2 (en) 2014-07-30

Family

ID=44938949

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2010078715A Expired - Fee Related JP5560844B2 (en) 2010-03-30 2010-03-30 Driving device for automatic steering of traveling vehicle

Country Status (1)

Country Link
JP (1) JP5560844B2 (en)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013154822A (en) * 2012-01-31 2013-08-15 Iseki & Co Ltd Traveling vehicle
JP2015174536A (en) * 2014-03-14 2015-10-05 国立研究開発法人農業・食品産業技術総合研究機構 Work vehicle steering device
JP2016011024A (en) * 2014-06-27 2016-01-21 株式会社クボタ Planting and seeding system farm field working machine
JP2019022524A (en) * 2018-11-06 2019-02-14 株式会社クボタ Working machine
JP2020162605A (en) * 2020-04-06 2020-10-08 株式会社クボタ Implement
KR20210098358A (en) * 2020-01-31 2021-08-10 도요타 지도샤(주) Vehicle
KR20210098853A (en) * 2020-01-31 2021-08-11 도요타 지도샤(주) Vehicle

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0374256A (en) * 1989-06-08 1991-03-28 Fuji Heavy Ind Ltd Electric power steering and concurrently automatic steering device for automobile
JPH0550932A (en) * 1991-08-22 1993-03-02 Mazda Motor Corp Automatic steering device of vehicle
JPH05284804A (en) * 1992-04-08 1993-11-02 Kubota Corp Mechanism for steering agricultural working machine
JPH1029547A (en) * 1996-07-15 1998-02-03 Nissan Motor Co Ltd Steering controller
JPH10258756A (en) * 1997-03-19 1998-09-29 Koyo Seiko Co Ltd Steering device for vehicle
JP2001310748A (en) * 2000-04-27 2001-11-06 Bio Oriented Technol Res Advancement Inst Steering device for agricultural work machine
JP2003048564A (en) * 2001-08-07 2003-02-18 Nissan Motor Co Ltd Vehicular steering control system
JP2007060982A (en) * 2005-08-31 2007-03-15 Iseki & Co Ltd Automatic steering system for working vehicle
US7349779B2 (en) * 2004-12-21 2008-03-25 Deere & Company Automatic steering system

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0374256A (en) * 1989-06-08 1991-03-28 Fuji Heavy Ind Ltd Electric power steering and concurrently automatic steering device for automobile
JPH0550932A (en) * 1991-08-22 1993-03-02 Mazda Motor Corp Automatic steering device of vehicle
JPH05284804A (en) * 1992-04-08 1993-11-02 Kubota Corp Mechanism for steering agricultural working machine
JPH1029547A (en) * 1996-07-15 1998-02-03 Nissan Motor Co Ltd Steering controller
JPH10258756A (en) * 1997-03-19 1998-09-29 Koyo Seiko Co Ltd Steering device for vehicle
JP2001310748A (en) * 2000-04-27 2001-11-06 Bio Oriented Technol Res Advancement Inst Steering device for agricultural work machine
JP2003048564A (en) * 2001-08-07 2003-02-18 Nissan Motor Co Ltd Vehicular steering control system
US7349779B2 (en) * 2004-12-21 2008-03-25 Deere & Company Automatic steering system
JP2007060982A (en) * 2005-08-31 2007-03-15 Iseki & Co Ltd Automatic steering system for working vehicle

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013154822A (en) * 2012-01-31 2013-08-15 Iseki & Co Ltd Traveling vehicle
JP2015174536A (en) * 2014-03-14 2015-10-05 国立研究開発法人農業・食品産業技術総合研究機構 Work vehicle steering device
JP2016011024A (en) * 2014-06-27 2016-01-21 株式会社クボタ Planting and seeding system farm field working machine
JP2019022524A (en) * 2018-11-06 2019-02-14 株式会社クボタ Working machine
KR20210098853A (en) * 2020-01-31 2021-08-11 도요타 지도샤(주) Vehicle
KR20210098358A (en) * 2020-01-31 2021-08-10 도요타 지도샤(주) Vehicle
JP2021123146A (en) * 2020-01-31 2021-08-30 トヨタ自動車株式会社 vehicle
JP2021123140A (en) * 2020-01-31 2021-08-30 トヨタ自動車株式会社 vehicle
JP7255507B2 (en) 2020-01-31 2023-04-11 トヨタ自動車株式会社 vehicle
US11628880B2 (en) 2020-01-31 2023-04-18 Toyota Jidosha Kabushiki Kaisha Vehicle and autonomous driving kit
KR102594560B1 (en) 2020-01-31 2023-10-26 도요타 지도샤(주) Vehicle
KR102594569B1 (en) 2020-01-31 2023-10-27 도요타 지도샤(주) Vehicle
JP7459532B2 (en) 2020-01-31 2024-04-02 トヨタ自動車株式会社 vehicle
JP2020162605A (en) * 2020-04-06 2020-10-08 株式会社クボタ Implement

Also Published As

Publication number Publication date
JP5560844B2 (en) 2014-07-30

Similar Documents

Publication Publication Date Title
JP5560844B2 (en) Driving device for automatic steering of traveling vehicle
US20190241213A1 (en) Method for controlling a steer-by-wire steering system with a reduced feedback in automatic drive mode
KR102113415B1 (en) Work vehicle control system
CN103963783A (en) Steering system for an autonomously driven vehicle and methods of steering the same
EP2837277B1 (en) Positioning system of an agricultural tractor
JP2021087384A (en) Work vehicle
JP2009006843A (en) Steering mechanism of working vehicle
JPH08255020A (en) Automatic traveling vehicle
JP6777499B2 (en) Work vehicle
JP5108585B2 (en) Combine
JP2004338636A (en) Travel support device
JP2010195252A (en) Driving device for automatic steering
JP2017108687A (en) Work vehicle
JP7181959B2 (en) Steering system for self-driving vehicles
JP2007195492A (en) Automatic rotary control type seedling transplanter
WO2020012931A1 (en) Work vehicle
JPH08255019A (en) Automatic traveling vehicle
JP7167865B2 (en) work vehicle
JP7233000B2 (en) aircraft ground support vehicle
JP2013029069A (en) Working vehicle
JP6785151B2 (en) Work vehicle
JP6129102B2 (en) Working machine
JP2006258060A (en) Farm working machinery
JP2022095323A (en) Work vehicle
JP5278755B2 (en) Vehicle steering system

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20130121

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20130121

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20131010

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20131022

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20131220

A711 Notification of change in applicant

Free format text: JAPANESE INTERMEDIATE CODE: A711

Effective date: 20140110

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20140110

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20140526

R150 Certificate of patent or registration of utility model

Ref document number: 5560844

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

LAPS Cancellation because of no payment of annual fees