JPH0713625A - 作業車の操向制御装置 - Google Patents

作業車の操向制御装置

Info

Publication number
JPH0713625A
JPH0713625A JP5151728A JP15172893A JPH0713625A JP H0713625 A JPH0713625 A JP H0713625A JP 5151728 A JP5151728 A JP 5151728A JP 15172893 A JP15172893 A JP 15172893A JP H0713625 A JPH0713625 A JP H0713625A
Authority
JP
Japan
Prior art keywords
steering
state
control
manual
machine body
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
JP5151728A
Other languages
English (en)
Other versions
JP3236414B2 (ja
Inventor
Hiroto Kimura
木村  浩人
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kubota Corp
Original Assignee
Kubota Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Kubota Corp filed Critical Kubota Corp
Priority to JP15172893A priority Critical patent/JP3236414B2/ja
Publication of JPH0713625A publication Critical patent/JPH0713625A/ja
Application granted granted Critical
Publication of JP3236414B2 publication Critical patent/JP3236414B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

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

Abstract

(57)【要約】 【目的】 手動操縦の際の操作状態に基づいて、自動操
縦を作業状況に応じた適切な状態にさせる。 【構成】 走行機体の操向車輪1を駆動操作自在なステ
アリングシリンダCYと、走行機体の走行目標姿勢から
の変位を検出するジャイロセンサ4,5,6と、このジ
ャイロセンサ4,5,6の検出情報に基づいて、走行機
体の走行姿勢を目標姿勢に維持するべくステアリングシ
リンダCYを駆動制御する自動操縦状態と、ステアリン
グハンドル2の操作状況に基づいて駆動させる手動操縦
状態とに切り換え自在な制御装置3と、前記手動操縦状
態におけるステアリングハンドル2の操作状態を検出す
るポテンショメータ8と、このポテンショメータ8の検
出情報と、手動操縦状態におけるジャイロセンサ4,
5,6の検出結果に基づく情報との差が少なくなるよう
に、前記自動操縦状態における制御パラメータの補正量
をニューラルネットワーク9により演算するよう構成し
てある。

Description

【発明の詳細な説明】
【0001】
【産業上の利用分野】本発明は、例えば田植機等の作業
車の操向制御装置に関し、詳しくは、通常の作業走行中
は人為操縦により操向操作するようにしながら、例え
ば、作業に伴って消費される消費材を補給する等に際に
機体を自動で所望の方向に自動走行することができるよ
うにした作業車の操向制御装置に関する。
【0002】
【従来の技術】上記作業車の操向制御装置において、従
来では、例えば地磁気を利用した方位センサ又は圧電振
動ジャイロ等の機体方位の変位を角速度変位に基づいて
これを積分して検出するジャイロセンサ等を作業車に備
えて、このセンサが予め設定された基準方位になるよう
に、フィードバック制御系を構成して、ステアリングシ
リンダ等の車体操向用アクチュエータを自動制御駆動す
るよう構成したもの等が提案されている。
【0003】
【発明が解決しようとする課題】ところが、上記従来構
造においては、前記センサの検出誤差や積分誤差等が存
在し、このような検出誤差が作業走行に伴って累積され
誤差が大きくなってしまい、精度の高い自動操向制御が
行えないものであり、未だ、実用の域には達してしな
い。そこで本発明は、手動操縦においては、作業の状況
等に応じて常に適切な操縦操作が行われる点に着目し
て、この手動操縦の際の操作状態に基づいて、自動操縦
を作業状況に応じた適切な状態にさせることを目的とし
ている。
【0004】
【課題を解決するための手段】第1発明の特徴構成は、
走行機体の操向装置を駆動操作自在なアクチュエータ
と、走行機体の走行目標姿勢からの変位を検出する姿勢
変位検出手段と、この姿勢変位検出手段の検出情報に基
づいて、走行機体の走行姿勢を目標姿勢に維持するべく
前記アクチュエータを駆動制御する自動操縦状態と、手
動操作具の操作状況に基づいて駆動させる手動操縦状態
とに切り換え自在な操向制御手段と、前記手動操縦状態
における前記手動操作具の操作状態を検出する手動操縦
状態検出手段と、前記手動操縦状態検出手段の検出情報
と、前記手動操縦状態における前記姿勢変位検出手段の
検出結果に基づく情報との差が少なくなるように、前記
自動操縦状態における制御パラメータの補正量を演算す
る演算手段とを備えてある点にある。
【0005】第2発明の特徴構成は、前記演算手段が、
ニューラルネットワークで構成されるものである点にあ
る。
【0006】
【作用】第1発明の特徴構成によると、手動操縦の際に
機体の姿勢がどのように変位するかを前記姿勢変位検出
手段により検出し、この検出手段による検出結果と、そ
れに対して、人間の判断により理想的なステアリング状
況であるところの、手動操縦時における手動操作具の操
作結果とを比較して、その差が少なくなる、即ち、姿勢
変位検出手段の検出状況を理想状態にできるだけ近づけ
た状態になるように、操向制御手段によるアクチュエー
タの自動操縦制御の際の制御パラメータを演算するので
ある。
【0007】第2発明の特徴構成によると、姿勢変位検
出手段からの入力情報がニューラルネットワークの入力
層に与えられ、それらの出力層からの出力が、目標情報
であるところの手動操作具の操作結果との間のエラーが
少なくなるように、合理的に前記制御パラメータが演算
される。
【0008】
【発明の効果】第1発明の特徴構成によると、走行機体
の機械的姿勢変位を検出する姿勢変位検出手段の検出誤
差が、人為操作具の操作結果により修正され、姿勢変位
検出の精度が向上するとともに、自動操縦の際には常に
手動操縦の操作状況に出来るだけ近い理想状態で機体を
自動走行させることが可能となる。
【0009】第2発明の特徴構成によると、自動操縦の
際の制御パラメータが常に理想状態に近づくよう合理的
に演算されることになり、より精度よく走行機体を目標
姿勢に維持できるものとなる。
【0010】
【実施例】以下、実施例を図面に基いて説明する。図1
に、例えば乗用型田植機等の作業車における操向制御用
の制御ブロック図を示している。この作業車において
は、図示しない走行機体の操向装置である操向用車輪1
をステアリングシリンダCY〔アクチュエータの一例〕
により駆動操向揺動するよう構成するとともに、ステア
リングハンドル2〔手動操作具の一例〕の操作状況に基
づいてステアリングシリンダCYを駆動させる手動操縦
形態と走行機体の走行姿勢を目標姿勢に維持するべくス
テアリングシリンダを自動制御する自動操縦形態のいず
れの操縦形態にも設定可能に構成してある。
【0011】詳述すると、前記ステアリングシリンダC
Yに対する電磁式油圧制御弁Vをマイクロコンピュータ
を備えた制御装置3〔操向制御手段の一例〕によって切
り換え制御するよう構成するとともに、この制御装置3
は、前記手動操縦制御モードと前記自動操縦モードとに
切り換え自在に構成され、その切り換えは切換スイッチ
SWにより行われる。走行機体には、走行目標姿勢から
の姿勢変位を検出する3個のジャイロセンサ4,5,6
〔姿勢変位検出手段の一例〕を備えてある。こられのジ
ャイロセンサ4,5,6は、圧電振動型ジャイロセンサ
で構成され、夫々、走行機体の前後傾斜角〔ピッチング
角〕、左右傾斜角〔ローリング角〕、機体の向き変化角
〔ヨーイング角〕を、機体走行に伴って角速度変位に基
づいて検出するよう構成されている。このように各ジャ
イロセンサ4,5,6は角速度変位を検出するものであ
るから、それらの出力は積分器7を介して制御装置3に
姿勢変位データとして入力される。又、ステアリングハ
ンドル2の人為操作量〔操向角度〕をポテンショメータ
8〔手動操縦状態検出手段の一例〕により検出し、この
ポテンショメータ8の検出値が制御装置3に与えられ
る。
【0012】そして、前記切換スイッチSWを手動位置
に設定しておくと、制御装置3が前記ポテンショメータ
8の出力値に応じて、ステアリングハンドル2の人為操
作量に対応する切れ角となるよう電磁式油圧制御弁Vを
切り換え制御する。従って、手動操作に基づいて機体を
操向操作することができる。又、切換スイッチSWを自
動位置に切り換えると、制御装置3は、機体が直進状態
で自動走行するように、前記各ジャイロセンサ4,5,
6により検出される機体姿勢変位情報から機体姿勢が予
め設定された目標姿勢になるように電磁式油圧制御弁V
を切り換え制御するのである。
【0013】前記手動操縦状態におけるステアリングハ
ンドル2の操作状態を検出するポテンショメータ8の検
出結果と、手動操縦状態における前記各ジャイロセンサ
4,5,6の検出結果との差が少なくなるように、前記
自動操縦状態における制御パラメータの補正量を演算す
るニューラルネットワーク9〔演算手段の一例〕を備え
てある。詳述すると、各ジャイロセンサ4,5,6の直
接の出力値X1,Y1,Z1〔角速度情報〕とそれの積
分値X2,Y2,Z2〔角度情報〕の夫々の情報をニュ
ーラルネットワーク9の入力層に与え、このネットワー
ク9の出力層からの出力情報、つまり、機体のステアリ
ング操作用出力情報と、操縦者〔人間〕により実際に行
われたステアリング操作状況〔ポテンショメータ8の検
出情報〕との差e〔エラー〕が少なくなるように、ネッ
トワーク9内の各ユニット間の重み係数を変化させて
〔学習効果を発揮して〕、所定の範囲内にエラーが収束
すれば、そのときのステアリング制御用補正値Qを制御
装置3に与え、制御装置3は自動操縦形態に切り換えら
れた後に、この補正値Qに基づいて、制御パラメータを
補正してステアリング制御状態を理想状態に近づけるよ
う制御する。
【0014】尚、前記制御装置3は、前記各ジャイロセ
ンサ4,5,6の検出値、ニューラルネットワーク9の
出力値等が予期しない外乱に起因して通常では有り得な
い異常値であるときは、設定遅延時間経過後、自動操向
制御を停止して機体を強制的に走行停止させるよう構成
してある。
【0015】尚、特許請求の範囲の項に図面との対照を
容易にするために符号を記すが、該記入により本発明は
添付図面の構成に限定されるものではない。
【図面の簡単な説明】
【図1】制御ブロック図
【符号の説明】
1 操向装置 2 手動操作具 3 操向制御手段 4,5,6 姿勢変位検出手段 8 手動操縦状態検出手段 9 演算手段 CY アクチュエータ

Claims (2)

    【特許請求の範囲】
  1. 【請求項1】 走行機体の操向装置(1)を駆動操作自
    在なアクチュエータ(CY)と、 走行機体の走行目標姿勢からの変位を検出する姿勢変位
    検出手段(4),(5),(6)と、 この姿勢変位検出手段(4),(5),(6)の検出情
    報に基づいて、走行機体の走行姿勢を目標姿勢に維持す
    るべく前記アクチュエータ(CY)を駆動制御する自動
    操縦状態と、手動操作具(2)の操作状況に基づいて駆
    動させる手動操縦状態とに切り換え自在な操向制御手段
    (3)と、 前記手動操縦状態における前記手動操作具(2)の操作
    状態を検出する手動操縦状態検出手段(8)と、 前記手動操縦状態検出手段(8)の検出情報と、前記手
    動操縦状態における前記姿勢変位検出手段(4),
    (5),(6)の検出結果に基づく情報との差が少なく
    なるように、前記自動操縦状態における制御パラメータ
    の補正量を演算する演算手段(9)とを備えてある作業
    車の操向制御装置。
  2. 【請求項2】 前記演算手段(9)が、ニューラルネッ
    トワークで構成されるものである請求項1に記載の作業
    車の操向制御装置。
JP15172893A 1993-06-23 1993-06-23 乗用型水田作業車の操向制御装置 Expired - Fee Related JP3236414B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP15172893A JP3236414B2 (ja) 1993-06-23 1993-06-23 乗用型水田作業車の操向制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP15172893A JP3236414B2 (ja) 1993-06-23 1993-06-23 乗用型水田作業車の操向制御装置

Publications (2)

Publication Number Publication Date
JPH0713625A true JPH0713625A (ja) 1995-01-17
JP3236414B2 JP3236414B2 (ja) 2001-12-10

Family

ID=15524997

Family Applications (1)

Application Number Title Priority Date Filing Date
JP15172893A Expired - Fee Related JP3236414B2 (ja) 1993-06-23 1993-06-23 乗用型水田作業車の操向制御装置

Country Status (1)

Country Link
JP (1) JP3236414B2 (ja)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005199770A (ja) * 2004-01-13 2005-07-28 Iseki & Co Ltd 農作業車の旋回制御装置
CN1330933C (zh) * 2006-06-27 2007-08-08 北京航空航天大学 一种基于神经网络的开环光纤陀螺输出误差补偿方法
JP2010056568A (ja) * 2009-11-30 2010-03-11 Hitachi Kokusai Electric Inc 半導体製造装置、半導体製造装置における表示方法及び異常処理方法
JP4522507B2 (ja) * 1999-02-22 2010-08-11 株式会社日立国際電気 半導体製造装置及び半導体製造装置における加熱処理方法
JP2018174759A (ja) * 2017-04-07 2018-11-15 学校法人 芝浦工業大学 自走式作業装置
JP2019515821A (ja) * 2017-03-10 2019-06-13 バイドゥドットコム タイムズ テクノロジー (ベイジン) カンパニー リミテッドBaidu.com Times Technology (Beijing) Co., Ltd. 自律走行モードへ再進入する自律走行車の制御のための方法及びシステム
JP2020052975A (ja) * 2018-09-28 2020-04-02 光吉 俊二 演算処理システムおよび補助装置
JP2021052726A (ja) * 2019-10-02 2021-04-08 株式会社クボタ 作業車両及び作業管理システム

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4522507B2 (ja) * 1999-02-22 2010-08-11 株式会社日立国際電気 半導体製造装置及び半導体製造装置における加熱処理方法
JP2005199770A (ja) * 2004-01-13 2005-07-28 Iseki & Co Ltd 農作業車の旋回制御装置
CN1330933C (zh) * 2006-06-27 2007-08-08 北京航空航天大学 一种基于神经网络的开环光纤陀螺输出误差补偿方法
JP2010056568A (ja) * 2009-11-30 2010-03-11 Hitachi Kokusai Electric Inc 半導体製造装置、半導体製造装置における表示方法及び異常処理方法
JP2019515821A (ja) * 2017-03-10 2019-06-13 バイドゥドットコム タイムズ テクノロジー (ベイジン) カンパニー リミテッドBaidu.com Times Technology (Beijing) Co., Ltd. 自律走行モードへ再進入する自律走行車の制御のための方法及びシステム
JP2018174759A (ja) * 2017-04-07 2018-11-15 学校法人 芝浦工業大学 自走式作業装置
JP2020052975A (ja) * 2018-09-28 2020-04-02 光吉 俊二 演算処理システムおよび補助装置
JP2021052726A (ja) * 2019-10-02 2021-04-08 株式会社クボタ 作業車両及び作業管理システム

Also Published As

Publication number Publication date
JP3236414B2 (ja) 2001-12-10

Similar Documents

Publication Publication Date Title
US6505703B2 (en) Vehicle steering system control
JP3645038B2 (ja) 航空機の飛行制御装置
US5274555A (en) Controlling apparatus of steering angle of rear wheels of four-wheel steering vehicle
JP3201337B2 (ja) 移動体の操縦装置
JP2002096751A (ja) 車両の前後輪舵角制御装置
JP2007216834A (ja) 旋回挙動制御装置、自動車、及び旋回挙動制御方法
JPH0713625A (ja) 作業車の操向制御装置
JP2003026021A (ja) バイワイヤ方式の駆動制御装置
EP0363846B1 (en) Rear wheel-steering angle control-system for vehicle
WO2020183988A1 (ja) 作業車両
WO2020090862A1 (ja) ハンドル角制御装置
JP2021189909A (ja) 作業車両の自律走行システム
JP2003067053A (ja) 無人搬送車
JP2006020652A (ja) ラジコン模型のロール角制御装置及びラジコン模型二輪車
JPH04108081A (ja) 舵角制御装置
WO2010035324A1 (ja) 自走車とその制御装置及び制御方法
JPH0713626A (ja) 作業車の操向制御装置
JP3361280B2 (ja) 3輪操舵無人搬送車
JPH0446897A (ja) 無人ヘリコプタの操縦装置
JP2002108453A (ja) 無人搬送車
JPH1163218A (ja) 電子制御式hst装置
JP3838959B2 (ja) 農作業機のローリング制御装置
JP3198056B2 (ja) 荷役車両
JP3198040B2 (ja) 荷役車両
JPH0891238A (ja) 後輪操舵装置の制御方法

Legal Events

Date Code Title Description
LAPS Cancellation because of no payment of annual fees