JP2696724B2 - 走行車両の自動走行システム - Google Patents
走行車両の自動走行システムInfo
- Publication number
- JP2696724B2 JP2696724B2 JP2044534A JP4453490A JP2696724B2 JP 2696724 B2 JP2696724 B2 JP 2696724B2 JP 2044534 A JP2044534 A JP 2044534A JP 4453490 A JP4453490 A JP 4453490A JP 2696724 B2 JP2696724 B2 JP 2696724B2
- Authority
- JP
- Japan
- Prior art keywords
- traveling
- vehicle
- speed
- detecting means
- detecting
- 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.)
- Expired - Fee Related
Links
- 230000001133 acceleration Effects 0.000 claims description 16
- 238000001514 detection method Methods 0.000 description 4
- 238000013459 approach Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
【発明の詳細な説明】 〔産業上の利用分野〕 本発明は、走行車両を設定した方向に自動的に走行さ
せる自動走行システムに関する。
せる自動走行システムに関する。
走行車両の自動走行システムとしては、走行路に敷設
された電磁ケーブルや光反射テープを検出しながらその
電磁ケーブルや反射テープに沿って自動的に走行するシ
ステム、 走行車両の走行速度、走行方向、現在位置を検出手段
により検出し、その検出した値と設定値とを比較して、
その差を補正するように走行制御して自動的に走行する
システム などが知られている。
された電磁ケーブルや光反射テープを検出しながらその
電磁ケーブルや反射テープに沿って自動的に走行するシ
ステム、 走行車両の走行速度、走行方向、現在位置を検出手段
により検出し、その検出した値と設定値とを比較して、
その差を補正するように走行制御して自動的に走行する
システム などが知られている。
前者の自動走行システムであると、電磁ケーブルの敷
設が面倒で走行方向の変更が面倒となったり、光反射テ
ープは汚れると機能しなくなるから屋外では利用できな
い。
設が面倒で走行方向の変更が面倒となったり、光反射テ
ープは汚れると機能しなくなるから屋外では利用できな
い。
これに対して後者の自動走行システムであれば前述の
課題を解消できるが、この自動走行システムは例えば、
コンピュータのメモリに走行すべき走行方向に沿ったい
くつかの位置をX−Y座標として記憶しておき、検出手
段で検出した走行車両の現在位置により前記記憶した位
置を通るように走行制御するシステムであり、具体的に
は第4図に示すように記憶した多数の位置A1,A2,A3…に
おける隣接した位置A1,A2を結ぶ直線Bに沿うように走
行制御するので、走行車両の走行方向が前記直線Bから
僅かでも外れると操向輪が操舵され、操向輪の操舵が繁
多となり滑らかな走行制御ができない。
課題を解消できるが、この自動走行システムは例えば、
コンピュータのメモリに走行すべき走行方向に沿ったい
くつかの位置をX−Y座標として記憶しておき、検出手
段で検出した走行車両の現在位置により前記記憶した位
置を通るように走行制御するシステムであり、具体的に
は第4図に示すように記憶した多数の位置A1,A2,A3…に
おける隣接した位置A1,A2を結ぶ直線Bに沿うように走
行制御するので、走行車両の走行方向が前記直線Bから
僅かでも外れると操向輪が操舵され、操向輪の操舵が繁
多となり滑らかな走行制御ができない。
そこで、本発明は前述の課題を解決できるようにした
走行車両の自動走行システムを提供することを目的とす
る。
走行車両の自動走行システムを提供することを目的とす
る。
本発明は、駆動輪2の回転数と駆動輪径より車両の速
度を検出する速度検出手段4と、車両の方向を検出する
方向検出手段5と、車両の位置を検出する位置検出手段
6と、コンピュータ7とを備え、 前記コンピュータ7に車両の目標位置をX−Y座標と
して記憶し、かつその目標位置における車両の速度、車
両の方位をそれぞれ記憶する走行車両において、 前記速度検出手段4で検出した速度と方向検出手段5
で検出した方向と位置検出手段6により検出した現在位
置により走行車両の現在の横加速度と前後加速度の合成
加速度のX軸方向成分、Y軸方向成分を演算し、 その演算した値に基づいて操向輪の舵角と前後加速度
を求め、 操向輪の舵角とアクセル、ブレーキを制御することで
コンピュータ7に記憶した目標位置に向けて自動走行さ
せることを特徴とする走行車両の自動走行システムであ
る。
度を検出する速度検出手段4と、車両の方向を検出する
方向検出手段5と、車両の位置を検出する位置検出手段
6と、コンピュータ7とを備え、 前記コンピュータ7に車両の目標位置をX−Y座標と
して記憶し、かつその目標位置における車両の速度、車
両の方位をそれぞれ記憶する走行車両において、 前記速度検出手段4で検出した速度と方向検出手段5
で検出した方向と位置検出手段6により検出した現在位
置により走行車両の現在の横加速度と前後加速度の合成
加速度のX軸方向成分、Y軸方向成分を演算し、 その演算した値に基づいて操向輪の舵角と前後加速度
を求め、 操向輪の舵角とアクセル、ブレーキを制御することで
コンピュータ7に記憶した目標位置に向けて自動走行さ
せることを特徴とする走行車両の自動走行システムであ
る。
これにより舵角の制御要因入力が多くなるから制御ゲ
インの取り方の自由度が大きくなり、目標位置に向けて
滑らかに走行制御できる。
インの取り方の自由度が大きくなり、目標位置に向けて
滑らかに走行制御できる。
第2図に示すように、走行車両Cは車体1に駆動輪2
と操向輪3を備え、操向輪3を操舵して走行方向を変え
るようになり、走行車両Cには速度検出手段4、方向検
出手段5、位置検出手段6が設けてあると共に、コンピ
ュータ7を備えている。
と操向輪3を備え、操向輪3を操舵して走行方向を変え
るようになり、走行車両Cには速度検出手段4、方向検
出手段5、位置検出手段6が設けてあると共に、コンピ
ュータ7を備えている。
前記速度検出手段4は例えば、駆動輪2の回転数を検
出する回転センサの検出値と駆動輪径より速度を演算す
るものであり、前記方向検出手段5は例えば、ジャイロ
コンパスとなり、前記位置検出手段6は速度と方向より
現在位置をX−Y座標として算出するものである。
出する回転センサの検出値と駆動輪径より速度を演算す
るものであり、前記方向検出手段5は例えば、ジャイロ
コンパスとなり、前記位置検出手段6は速度と方向より
現在位置をX−Y座標として算出するものである。
第3図のように、前記コンピュータ7のメモリ8には
目標位置がX−Y座標として入力され、その位置におけ
る車両の方位と速度が記憶されている。その目標位置方
位、速度と前記検出した速度、方向、現在位置に基づい
てCPU9が演算してブレーキ10、エンジン出力制御手段1
1、操舵手段12にブレーキ量指令、エンジン出力指令、
舵角指令をそれぞれ出力する。
目標位置がX−Y座標として入力され、その位置におけ
る車両の方位と速度が記憶されている。その目標位置方
位、速度と前記検出した速度、方向、現在位置に基づい
てCPU9が演算してブレーキ10、エンジン出力制御手段1
1、操舵手段12にブレーキ量指令、エンジン出力指令、
舵角指令をそれぞれ出力する。
次に第1図に基づいて走行制御を説明する。
第1図に実線で示す位置の走行車両を仮想線で示すよ
うに目標位置まで走行する場合について説明する。
うに目標位置まで走行する場合について説明する。
まず、コンピュータ7のメモリ8内には目標位置がX
−Y座標(0,0)として記憶され、速度がV0、方位がゼ
ロ度として記憶される。ここで、方位ゼロ度はX軸方向
に走行することである。
−Y座標(0,0)として記憶され、速度がV0、方位がゼ
ロ度として記憶される。ここで、方位ゼロ度はX軸方向
に走行することである。
他方、走行車両Cの現在の速度V、方位θ、位置(x,
y)が前記各検出手段で検出されてCPU9に入力される。
y)が前記各検出手段で検出されてCPU9に入力される。
これらの条件により操向輪3の舵角ζを次のようにし
て決定する。
て決定する。
速度VのX軸、Y軸方向成分Vx,Vyは方位θによりVx
=Vcosθ、Vy=Vsinθで与えられ、走行車両は操向輪3
を左右に操作することで横加速度αs、エンジン出力制
御手段11、ブレーキ10を操作して加速・減速することで
前後加速度αlが作用し、横加速度αsと舵角ζの関係
は となる。ここで、lはホイールベースである。
=Vcosθ、Vy=Vsinθで与えられ、走行車両は操向輪3
を左右に操作することで横加速度αs、エンジン出力制
御手段11、ブレーキ10を操作して加速・減速することで
前後加速度αlが作用し、横加速度αsと舵角ζの関係
は となる。ここで、lはホイールベースである。
前後横加速度αsと前後加速度αlの合成加速度αの
X軸、Y軸方向成分をαx,αyとすると、αx=αlcos
θ−αssinθ、αy=αlsinθ+αscosθで与えられ
る。
X軸、Y軸方向成分をαx,αyとすると、αx=αlcos
θ−αssinθ、αy=αlsinθ+αscosθで与えられ
る。
他方、走行車両の運動方程式は の4式で与えられるので、周知のように αx=−{k1x+k2y+k3(Vx−V0)+k4Vy}…(1) αy=−{k5x+k6y+k7(Vx−V0)+k8Vy}…(2) というフィードバックを行なえば制御できる αx,αyが与えられれば前述の(1)式、(2)式を
解いてζとαlを求めることができるので、検出した速
度、方位、位置によりαx,αyを演算し、それに基づい
てζとαlを求めて操向輪3の舵角ζを決定する。
解いてζとαlを求めることができるので、検出した速
度、方位、位置によりαx,αyを演算し、それに基づい
てζとαlを求めて操向輪3の舵角ζを決定する。
ここで、k1〜k8を決定するために J=C1 x2+C2 y2+C3(Vx−V0)2+C4V2 y+C5αx2+C6αy2 …(3) という評価関数を決め、これを数学的に最小になるよ
うにk1〜k8を選択する。
うにk1〜k8を選択する。
前記C1〜C6を調節することにより走行車両の応答が変
化するが(3)式の式の形から判るようにC1〜C2を大き
くすれば目標位置に早く到達するようになりC3,C4を大
きくすれば方位角θが速くゼロに近ずき、C5,C6を大き
くすると加速度が小さくなるように操向輪2の舵角を小
さくおさえるようになる。
化するが(3)式の式の形から判るようにC1〜C2を大き
くすれば目標位置に早く到達するようになりC3,C4を大
きくすれば方位角θが速くゼロに近ずき、C5,C6を大き
くすると加速度が小さくなるように操向輪2の舵角を小
さくおさえるようになる。
このように、走行車両Cの位置、速度のX軸、Y軸方
向成分に基づいて舵角、速度、を制御するので、制御要
因入力が4となって制御ゲインの取り方の自由度が大き
く滑らかに走行制御できるばかりか、制御特性、例えば
方位、加速度、舵角の大きさなどが希望する特性とする
ことができる。
向成分に基づいて舵角、速度、を制御するので、制御要
因入力が4となって制御ゲインの取り方の自由度が大き
く滑らかに走行制御できるばかりか、制御特性、例えば
方位、加速度、舵角の大きさなどが希望する特性とする
ことができる。
舵角の制御要因入力が多くなるから制御ゲインの取り
方の自由度が大きくなり、目標位置に向けて滑らかに走
行制御できるばかりか、制御特性を希望する値とするこ
とができる。
方の自由度が大きくなり、目標位置に向けて滑らかに走
行制御できるばかりか、制御特性を希望する値とするこ
とができる。
第1図は本発明の実施例を示す走行制御動作の説明図、
第2図は走行車両の説明図、第3図は制御回路図、第4
図は従来例の説明図である。 1は車体、2は駆動輪、3は操向輪。
第2図は走行車両の説明図、第3図は制御回路図、第4
図は従来例の説明図である。 1は車体、2は駆動輪、3は操向輪。
Claims (1)
- 【請求項1】駆動輪2の回転数と駆動輪径より車両の速
度を検出する速度検出手段4と、車両の方向を検出する
方向検出手段5と、車両の位置を検出する位置検出手段
6と、コンピュータ7とを備え、 前記コンピュータ7に車両の目標位置をX−Y座標とし
て記憶し、かつその目標位置における車両の速度、車両
の方位をそれぞれ記憶する走行車両において、 前記速度検出手段4で検出した速度と方向検出手段5で
検出した方向と位置検出手段6により検出した現在位置
により走行車両の現在の横加速度と前後加速度の合成加
速度のX軸方向成分、Y軸方向成分を演算し、 その演算した値に基づいて操向輪の舵角と前後加速度を
求め、 操向輪の舵角とアクセル、ブレーキを制御することでコ
ンピュータ7に記憶した目標位置に向けて自動走行させ
ることを特徴とする走行車両の自動走行システム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2044534A JP2696724B2 (ja) | 1990-02-27 | 1990-02-27 | 走行車両の自動走行システム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2044534A JP2696724B2 (ja) | 1990-02-27 | 1990-02-27 | 走行車両の自動走行システム |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH03248210A JPH03248210A (ja) | 1991-11-06 |
JP2696724B2 true JP2696724B2 (ja) | 1998-01-14 |
Family
ID=12694177
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2044534A Expired - Fee Related JP2696724B2 (ja) | 1990-02-27 | 1990-02-27 | 走行車両の自動走行システム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2696724B2 (ja) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2732161B2 (ja) * | 1991-11-27 | 1998-03-25 | 新キャタピラー三菱株式会社 | 車輛の位置検出装置 |
WO1997036217A1 (fr) * | 1996-03-22 | 1997-10-02 | Hitachi, Ltd. | Technique permettant de commander le fonctionnement d'un mecanisme en mouvement et appareil correspondant |
JP4213518B2 (ja) * | 2003-05-27 | 2009-01-21 | 川崎重工業株式会社 | 移動体の制御方法及び制御装置 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2704266B2 (ja) * | 1988-05-25 | 1998-01-26 | 株式会社豊田中央研究所 | 無人搬送車の走行制御装置 |
-
1990
- 1990-02-27 JP JP2044534A patent/JP2696724B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JPH03248210A (ja) | 1991-11-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Dickmanns et al. | A curvature-based scheme for improving road vehicle guidance by computer vision | |
US5350912A (en) | System for controlling movement of a mobile body along a target path | |
JP3002206B2 (ja) | 移動ロボットの走行制御方法 | |
JP2001255937A (ja) | 車両用自動走行制御装置 | |
JPH0434773B2 (ja) | ||
JPS6319011A (ja) | 地点追従方式による無人移動機械の誘導方法 | |
JP3359008B2 (ja) | 無人搬送車の走行制御システム | |
US11912360B2 (en) | Vehicle control method, vehicle control system, and vehicle | |
JPH08137549A (ja) | 車両の誘導走行制御装置 | |
JP2696724B2 (ja) | 走行車両の自動走行システム | |
JP6776543B2 (ja) | 車両制御システム | |
JP2002213959A (ja) | 角速度検出装置および車両用ナビゲーション装置 | |
JP2658056B2 (ja) | 自律走行車両制御装置 | |
JPS6170618A (ja) | 無人走行システム | |
JP2518300B2 (ja) | 車両の誘導方法 | |
JP2819551B2 (ja) | 自律走行車両制御装置 | |
JPS59119417A (ja) | 自走台車制御装置 | |
JPH0772926A (ja) | 推測航法における推測位置修正方法 | |
JPH11134031A (ja) | 移動ロボットの軌道制御方法 | |
JP3846829B2 (ja) | 移動体の操舵角制御装置 | |
JPH0519853A (ja) | 車両用誘導駐車装置 | |
TWI708129B (zh) | 自動導引車輛聯動系統與控制方法 | |
JP2728392B2 (ja) | ハンドル制御装置 | |
JPH04102104A (ja) | 無人走行車の走行制御システム | |
JPS60122409A (ja) | 車両の自動運転制御方式 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080919 Year of fee payment: 11 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090919 Year of fee payment: 12 |
|
LAPS | Cancellation because of no payment of annual fees |