[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

JP3266747B2 - 車両の誘導走行制御装置 - Google Patents

車両の誘導走行制御装置

Info

Publication number
JP3266747B2
JP3266747B2 JP27667094A JP27667094A JP3266747B2 JP 3266747 B2 JP3266747 B2 JP 3266747B2 JP 27667094 A JP27667094 A JP 27667094A JP 27667094 A JP27667094 A JP 27667094A JP 3266747 B2 JP3266747 B2 JP 3266747B2
Authority
JP
Japan
Prior art keywords
vehicle
steering angle
traveling
current
coordinate position
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
Application number
JP27667094A
Other languages
English (en)
Other versions
JPH08137549A (ja
Inventor
幸男 大川
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.)
Komatsu Ltd
Original Assignee
Komatsu 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 Komatsu Ltd filed Critical Komatsu Ltd
Priority to JP27667094A priority Critical patent/JP3266747B2/ja
Priority to AU38560/95A priority patent/AU687270B2/en
Priority to US08/836,133 priority patent/US5781870A/en
Priority to GB9709154A priority patent/GB2309556A/en
Priority to PCT/JP1995/002297 priority patent/WO1996015483A1/ja
Priority to CA002204857A priority patent/CA2204857A1/en
Publication of JPH08137549A publication Critical patent/JPH08137549A/ja
Application granted granted Critical
Publication of JP3266747B2 publication Critical patent/JP3266747B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D1/00Steering controls, i.e. means for initiating a change of direction of the vehicle
    • B62D1/24Steering controls, i.e. means for initiating a change of direction of the vehicle not vehicle-mounted
    • B62D1/28Steering controls, i.e. means for initiating a change of direction of the vehicle not vehicle-mounted non-mechanical, e.g. following a line or other known markers
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0891Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Traffic Control Systems (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Description

【発明の詳細な説明】
【0001】
【産業上の利用分野】本発明は、予定走行コースの位置
データを記憶し、この位置データに基づいて車両の操舵
角を制御して車両を予定走行コースに沿って誘導走行さ
せる車両の誘導走行制御装置に関する。
【0002】
【従来の技術および発明が解決しようとする課題】従来
より、車両を予定走行コースに沿って誘導走行させる装
置が種々開発され、特許出願等されている。
【0003】特公平5ー22925号ないし22926
号公報には、走行コースを複数の直線の結合で近似し
て、これら直線上に沿って車両を誘導走行させる技術が
開示されている。
【0004】これら公報記載の技術によれば、直進させ
るだけでよいので、車両の操舵角の演算等は簡易に行う
ことができるという利点はあるものの、走行コースが曲
線であったとしても、その経路を直線で近似してしまう
ため、車両は予定走行コースに沿って正確に走行するこ
とができないという欠点がある。
【0005】また、上記公報記載の技術によれば、車両
の操舵角は、車両の現在の速度とは無関係に設定され
る。
【0006】このため、車両の速度が高いときは、操舵
角が大きくなりすぎ、オーバーステアを招き、曲線の走
行コースから外れることがある。同様に、車両の速度が
低いときは、操舵角が小さくなりすぎ、アンダーステア
を招き、曲線の走行コースから外れることがある。
【0007】また、上記公報記載の技術によれば、操舵
角の演算処理上、直線のコースをずれなく走行している
場合、操舵角は零に設定される。
【0008】しかし、ダンプトラック等の車両の場合、
積荷や荷姿によって車両の四輪のアライメントが変化す
る。このようにアライメントが変化すると、操舵角を零
のままで走行を続けた場合には、車両は直線コースから
外れていくことがあり、実用上大きな問題となる。
【0009】また、特公平5ー503775号公報に
は、現在位置から走行コース上に滑らかにつながる5次
の多項式で表される経路を求めて、この経路に沿って車
両が走行されるように操舵角が演算される。
【0010】この公報記載の技術によれば、曲線の走行
コースに沿って走行させるための考慮がなされているも
のの、その演算は煩雑であり、時間を要するという欠点
がある。
【0011】また、上記公報記載の技術によれば、やは
り、前記特公平5ー22925号ないし22926号公
報の技術と同様に、車両の操舵角は、車両の現在の速度
とは無関係に設定される。このため、曲線の走行コース
から外れるという問題が招来する。
【0012】また、前記特公平5ー22925号ないし
22926号公報の技術と同様に、直線走行コースをず
れなく走行している場合には、操舵角は零に設定される
ので、車両の前後輪のアライメント調整が完璧でない
と、直線コース上をずれなく走行することがきわめて困
難となる。
【0013】以上のように、従来技術によれば、曲線走
行コース上を簡易な処理によって正確に走行することが
できないという問題がある。
【0014】また、車両の速度いかんによって曲線走行
コースから外れてしまうという問題がある。
【0015】また、車両のアライメントの変化によっ
て、たとえ直線走行コースであっても、予定コースから
外れてしまうという問題がある。
【0016】本発明は、これらの問題点を解決すること
ができる装置を提供することを目的とするものである。
【0017】
【課題を解決するための手段】そこで、この発明の第1
発明では、予定走行コースの位置データを記憶し、この
位置データに基づいて車両の操舵角を制御して車両を前
記予定走行コースに沿って誘導走行させる車両の誘導走
行制御装置において、前記予定走行コース上の各点ごと
に、当該点の座標位置と前記車両が進行すべき方向を示
すデータを記憶した記憶手段と、前記車両の現在の座標
位置を検出する位置検出手段と、前記車両の現在の走行
速度を検出する速度検出手段と、前記位置検出手段で検
出された現在の座標位置に最も近い、予定走行コース上
の点の座標位置データおよび当該最も近い点の進行方向
データを前記記憶手段の記憶内容から選択する選択手段
と、前記選択手段で選択された座標位置データおよび進
行方向データと前記位置検出手段で検出された現在座標
位置とに基づいて、車両進行方向に垂直な方向の車両位
置の現在のずれ量を演算するずれ量演算手段と、前記ず
れ量演算手段で演算されたずれ量と前記速度検出手段で
検出された現在の走行速度とに基づいて、前記ずれ量が
零となるように、前記検出走行速度が大きい程小さく車
両操舵角を演算する操舵角演算手段と、前記操舵角演算
手段で演算された車両操舵角に基づいて前記車両の操舵
角を制御する制御手段とを具えている。
【0018】また、この発明の第2発明では、上記第1
発明の構成に加えて、前記ずれ量演算手段で演算された
ずれ量を積分演算する積分演算手段を具えるとともに、
操舵角演算手段を、前記ずれ量演算手段で演算されたず
れ量と前記積分演算手段で演算された積分値と前記速度
検出手段で検出された現在の走行速度とに基づいて、前
記ずれ量が零となるように、前記検出走行速度が大きい
程小さく車両操舵角を演算するよう構成している。
【0019】また、この発明の第3発明では、上記第1
の発明の構成に加えて、前記ずれ量演算手段で演算され
たずれ量を積分演算する積分演算手段を具えるととも
に、操舵角演算手段の代わりに、前記ずれ量演算手段で
演算されたずれ量と前記積分演算手段で演算された積分
値と前記速度検出手段で検出された現在の走行速度とに
基づいて、前記ずれ量が零となるように、前記検出走行
速度が大きい程小さく第1の車両操舵角を演算する第1
の操舵角演算手段を具え、さらに、前記最も近い点にお
ける前記予定走行コースの曲率半径に基づいて第2の車
両操舵角を演算する第2の操舵角演算手段と、前記第1
の操舵角演算手段で演算された第1の車両操舵角と前記
第2の操舵角演算手段で演算された第2の車両操舵角と
に基づいて、第3の車両操舵角を演算する第3の操舵角
演算手段とを具え、制御手段を、前記第3の操舵角演算
手段で演算された第3の車両操舵角に基づいて前記車両
の操舵角を制御する制御手段と構成している。
【0020】
【作用】上記第1発明の構成によれば、選択手段で選択
された座標位置データおよび進行方向データと位置検出
手段で検出された現在座標位置とに基づいて、車両進行
方向に垂直な方向の車両位置の現在のずれ量が演算され
る。つまり、曲線走行コースからのずれ量が簡易に演算
される。
【0021】そして、ずれ量演算手段で演算されたずれ
量と速度検出手段で検出された現在の走行速度とに基づ
いて、ずれ量が零となるように、検出走行速度が大きい
程小さく車両操舵角が簡易に演算される。つまり、車両
の現在の速度に応じた車両操舵角が簡易かつ正確に演算
される。
【0022】そして、操舵角演算手段で演算された車両
操舵角に基づいて車両の操舵角が制御されて、車両は予
定走行コース上を精度よく誘導走行される。
【0023】また、上記第2発明の構成によれば、ずれ
量演算手段で演算されたずれ量が積分演算される。そし
て、ずれ量演算手段で演算されたずれ量と積分演算手段
で演算された積分値と速度検出手段で検出された現在の
走行速度とに基づいて、ずれ量が零となるように、検出
走行速度が大きい程小さく車両操舵角が演算される。つ
まり、ずれ量の積分値が考慮されて、操舵角が演算され
るので、車両のアライメントの変化を吸収、相殺できる
車両操舵角が正確に求められ、車両は予定走行コース上
を精度よく誘導走行される。
【0024】また、上記第3発明の構成によれば、車両
の現在位置に最も近い点における予定走行コースの曲率
半径に基づき第2の車両操舵角が演算される。そして、
上記ずれ量に基づく第1の車両操舵角と第2の車両操舵
角とに基づいて第3の車両操舵角が演算され、この第3
の車両操舵角に基づき車両の操舵角が制御される。この
結果、コースの曲率に基づく第2の操舵角をすばやく保
つことで、概略コースに沿って車両を誘導することがで
きるとともに、ずれ量に基づく第1の操舵角によってコ
ースからのずれが補正され、曲率半径が複雑に変化する
コースに沿って車両が精度よく誘導走行される。
【0025】
【実施例】以下、図面を参照して本発明に係る車両の誘
導走行制御装置の実施例について説明する。
【0026】図1は、実施例の誘導走行制御装置を示す
ブロック図であり、図2は、実際の誘導走行に先だって
行われるティーチングの内容を説明するブロック図であ
る。 ・予定走行コースのティーチング この実施例では、走行すべき車両として、図2に示され
る無人運転のダンプトラック(以下「車両」という)1
4を想定している。
【0027】車両14は、例えば、予定走行コースS上
を無人走行するものであり、この予定走行コースSを示
すデータが、ティーチング、つまり走行すべきコース上
を人間の運転で1周走行して教える作業によって、車両
14に設けられたメモリ5に設定、記憶される。
【0028】車両14には、進行方向を検出するジャイ
ロ1と、走行距離を検出する距離エンコーダ2と、これ
らジャイロ1、距離エンコーダ2を制御する位置計測コ
ントローラ3とが配設されている。ティーチング走行中
は、逐次の車両14の座標位置が、また逐次の車両14
の進行方向が、また逐次の車両14の速度が、ジャイロ
1、距離エンコーダ2から出力される検出信号に基づい
て、位置計測コントローラ3によって演算され、これら
が全コースデータ4として出力される。
【0029】ただし、全コースデータ4は1秒間に数回
〜数十回出力され、データサイズが大きいので、メモリ
5の記憶容量に適したサイズになるように、所定の時間
間隔τでサンプリングされる。サンプリングの間隔τ
は、粗にすぎず、密にすぎずの最適な間隔とされる。
【0030】こうしてサンプリングされた、逐次の車両
14の座標位置P1(X1、Y1)、P2(X2、Y2)…P
i(Xi、Yi)…、そして逐次の車両14の進行方向
(方位角)ψ1、ψ2…ψi…、そして逐次の車両14の
速度V1、V2…Vi…が、メモリ5にコースデータ6と
して記憶される。
【0031】このようにメモリ5には、予定走行コース
S上の各点P1、P2、…Pi…ごとに、車両14が位置
すべき座標位置(Xi、Xj)、車両14が進むべき進行
方向ψi、車両14が出すべき速度Viが記憶、格納され
る。
【0032】なお、この実施例では、コースデータ6を
ティーチング作業によって求めるようにしているが、求
める方法は任意であり、測量等によって求めるようにし
てもよい。
【0033】・自動誘導走行 つぎに、図4のフローチャートを参照して車両14を自
動誘導走行させるための処理手順について説明する。
【0034】ティーチング走行後、自動誘導走行(プレ
イバック)が開始されると、ジャイロ1、距離エンコー
ダ2から検出信号が出力され、車両14の逐次の現在の
位置Q(X、Y)が、位置計測コントローラ3によって
演算され、これが誘導コントローラ7に入力される(ス
テップ101)。
【0035】以下、誘導コントローラ7では、後述する
よう目標操舵角ζが演算され、操舵コントローラ8を介
して油圧サーボ系11によって、車両14の図示せぬス
テアリングが駆動され、上記目標操舵角ζが得られるよ
うに車両14の向きが変化される(ステップ102〜1
06)。
【0036】また、誘導コントローラ7では、後述する
よう車両14の目標速度が演算され、アクセルコントロ
ーラ9、ブレーキコントローラ10を介して機械サーボ
系12、空圧サーボ系13によって、車両14の図示せ
ぬアクセルおよびブレーキが駆動され、上記目標速度が
得られるように車両14の速度が変化される。
【0037】ここで、上記目標操舵角の演算についてよ
り詳しく説明する。
【0038】すなわち、車両14の進行方向前方にあっ
て、車両14の現在位置Q(X、Y)に最も近い走行コ
ースS上の点Piが選択される(ステップ102;図3
参照)。
【0039】そこで、この選択された点Piに対応する
位置座標データ(Xi、Yi)、方位角データψiがメモ
リ5から読み出される。
【0040】また、上記最も近い点Piにおける走行コ
ースSの曲率半径に対応する基本操舵角ζpが後述する
よう演算される(ステップ103)。
【0041】そして、こうして得られたコース上位置座
標(Xi、Yi)、方位角ψi、基本操舵角ζpと車両現在
位置Q(X、Y)とに基づいて下記(1)、(2)、
(3)式の演算が実行され、車両14の目標操舵角ζが
演算される。
【0042】 yi=ー(XーXi)sinψi+(YーYi)cosψi …(1) αs=ー(K4+K5・K6)yiーK4・K6∫yidtーK5dyi/dt …(2) ζ=tan-1(αsL/V2)+Kp・ζp …(3) ここで、K4、K5、K6、Kpは制御定数、Lは車両14
のホイールベース(前後車軸間距離)である。
【0043】Vは、車両14の現在速度であり、位置計
測コントローラ3を介して誘導コントローラ7に入力さ
れるものである。
【0044】上記(1)〜(3)式について説明する
と、まず(3)式に示される基本操舵角ζpは、下記
(4)〜(7)から求められる。
【0045】すなわち、予定走行コースS上の点Piと
つぎの点Pi+1とを結ぶコース上の円弧の長さGは、車
両14の現在の速度をV、サンプリング時間をτとすれ
ば、 G=V・τ …(4) と求められる。また、点Piとつぎの点Pi+1との間の円
弧の曲率半径をRiとすれば、円弧の長さGは、 G=Ri・(ψi+1ーψi) …(5) と求められる。これら(4)、(5)式から曲率半径R
iを下記(6)式によって求めることができる。
【0046】Ri=V・τ/(ψi+1ーψi) …(6) よって、こうして求めた曲率半径Riとホイールベース
Lを用いて、基本操舵角ζpを下記(7)式のごとく得
る。
【0047】ζp=arctan(L/Ri) …(7) さて、上記(1)式では、XーY固定座標系における車
両14のY軸方向座標位置Y(現在位置)が、ローカル
座標系xiーyi上のyiに座標変換される。
【0048】すなわち、図3に示されるように、予定走
行コースS上の点Piを原点とし、点Piにおいて車両1
4が出すべき速度Vi(ベクトル)の方向、つまり進行
方向ψiをxi軸とし、さらにコースSの法線方向にyi
軸をとったときのxiーyi座標系がローカル座標系とし
て設定される。したがって座標変換された座標位置yi
は、予定走行コースSの法線方向(進行方向に垂直な方
向)における車両14のずれ量を意味する。そして、こ
の法線方向ずれ量yiを零にするための目標操舵角ζが
(3)式において求められることになる。
【0049】因みに、XーY固定座標系における車両1
4のX軸方向座標位置X(現在位置)は、ローカル座標
系xiーyi上のxiに、下記(8)式のごとく座標変換
される。
【0050】 xi=(XーXi)cosψi+(YーYi)sinψi …(8) 上記(1)式で求められた法線方向ずれ量yiは上記
(2)式に代入され、車両14の横(法線)方向加速度
αsが求められ、この横方向加速度αsを上記(3)式に
代入することで、目標操舵角ζが演算される。
【0051】ここで、横方向加速度αsには、法線方向
ずれ量yiの積分値ーK4・K6∫yidtが含まれており、
この積分値が目標操舵角ζに加味される。
【0052】したがって、この目標操舵角ζが零となる
よう車両14のステアリングを制御すれば、たとえ車両
14のアライメントが狂っていたとしても、上記積分値
によってその狂いが吸収、相殺され、車両14は、直線
コース上をずれなく走行することが可能となる。
【0053】また、上記(3)式で求められる目標操舵
角ζは、1/V2に比例している。このため、車両14
の現在速度Vが高いほど、操舵角は小さくなり、速度V
が低いほど、操舵角は大きくなる。この結果、速度に応
じた適切な角度だけステアリングを切りことができ、車
両14がコースS上から外れることを防止することがで
きる。
【0054】また、以上の演算は、複雑な多項式を求め
るというような複雑な演算ではなく、簡易な演算であ
る。よって、煩雑な演算を要することなく簡易な処理に
よって車両14を曲線コース上に沿って正確に誘導走行
させることができる(ステップ103、104、10
5)。
【0055】ところで、位置計測コントローラ3では、
車両14の現在の方位角θが演算され、これが誘導コン
トローラ7に入力される。そしてこの現在方位角θと現
在速度Vと、点Piに対応する方位角ψiとに基づいて、
車両14の目標速度Vxi、Vyiが下記(9)、(1
0)、(11)式によって演算される。
【0056】θi=θーψi …(9) Vxi=Vcosθi …(10) Vyi=Vsinθi …(11) ただし、上記(9)式においてθとψiは同じであると
近似してもよいので、θiは零となり、横(法線)方向
速度Vyiは零となる。結局、(10)式に示される縦
(接線)方向速度Vxiだけを制御すればよいので、これ
が目標速度としてアクセルコントローラ9、ブレーキコ
ントローラ10に出力され、アクセル、ブレーキが制御
されることになる。
【0057】
【発明の効果】以上説明したように、本発明によれば、
車両の操舵角が簡易な演算によって求められるので、車
両を曲線の走行コース上を簡易な処理によって簡易に誘
導走行させることができる。
【0058】また、走行速度が大きい程小さく操舵角が
演算されるので、曲線の走行コース上をずれなく精度よ
く誘導走行させることができる。
【0059】また、走行コースの法線方向のずれ量の積
分値が考慮されて、操舵角が演算されるので、車両のア
ライメントが狂っていたとしても、車両を予定走行コー
スに沿って精度よく誘導走行させることができる。
【0060】また、走行コースの曲率に基づく基本操舵
角によって予め必要な操舵角が与えられ、さらにずれ量
に基づく操舵角が加味されてコースからのずれが修正さ
れるので、曲率半径が複雑に変化する曲線コースに対し
ても、追従の遅れがなく、精度よく誘導走行させること
ができる。
【図面の簡単な説明】
【図1】図1は本発明に係る車両の誘導走行制御装置の
実施例の構成を示すブロック図である。
【図2】図2は、ティーチングによって予定走行コース
のデータを取得するための処理を説明するブロック図で
ある。
【図3】図3は、車両の操舵角を演算する処理を説明す
るために用いた幾何学的関係図である。
【図4】図4は、車両の自動誘導走行の処理手順を示す
フローチャートである。
【符号の説明】
5 メモリ 7 誘導コントローラ 8 操舵コントローラ 14 車両

Claims (3)

    (57)【特許請求の範囲】
  1. 【請求項1】 予定走行コースの位置データを記憶
    し、この位置データに基づいて車両の操舵角を制御して
    車両を前記予定走行コースに沿って誘導走行させる車両
    の誘導走行制御装置において、 前記予定走行コース上の各点ごとに、当該点の座標位置
    と前記車両が進行すべき方向を示すデータを記憶した記
    憶手段と、 前記車両の現在の座標位置を検出する位置検出手段と、 前記車両の現在の走行速度を検出する速度検出手段と、 前記位置検出手段で検出された現在の座標位置に最も近
    い、予定走行コース上の点の座標位置データおよび当該
    最も近い点の進行方向データを前記記憶手段の記憶内容
    から選択する選択手段と、 前記選択手段で選択された座標位置データおよび進行方
    向データと前記位置検出手段で検出された現在座標位置
    とに基づいて、車両進行方向に垂直な方向の車両位置の
    現在のずれ量を演算するずれ量演算手段と、 前記ずれ量演算手段で演算されたずれ量と前記速度検出
    手段で検出された現在の走行速度とに基づいて、前記ず
    れ量が零となるように、前記検出走行速度が大きい程小
    さく車両操舵角を演算する操舵角演算手段と、 前記操舵角演算手段で演算された車両操舵角に基づいて
    前記車両の操舵角を制御する制御手段とを具えた車両の
    誘導走行制御装置。
  2. 【請求項2】 予定走行コースの位置データを記憶
    し、この位置データに基づいて車両の操舵角を制御して
    車両を前記予定走行コースに沿って誘導走行させる車両
    の誘導走行制御装置において、 前記予定走行コース上の各点ごとに、当該点の座標位置
    と前記車両が進行すべき方向を示すデータを記憶した記
    憶手段と、 前記車両の現在の座標位置を検出する位置検出手段と、 前記車両の現在の走行速度を検出する速度検出手段と、 前記位置検出手段で検出された現在の座標位置に最も近
    い、予定走行コース上の点の座標位置データおよび当該
    最も近い点の進行方向データを前記記憶手段の記憶内容
    から選択する選択手段と、 前記選択手段で選択された座標位置データおよび進行方
    向データと前記位置検出手段で検出された現在座標位置
    とに基づいて、車両進行方向に垂直な方向の車両位置の
    現在のずれ量を演算するずれ量演算手段と、 前記ずれ量演算手段で演算されたずれ量を積分演算する
    積分演算手段と、 前記ずれ量演算手段で演算されたずれ量と前記積分演算
    手段で演算された積分値と前記速度検出手段で検出され
    た現在の走行速度とに基づいて、前記ずれ量が零となる
    ように、前記検出走行速度が大きい程小さく車両操舵角
    を演算する操舵角演算手段と、 前記操舵角演算手段で演算された車両操舵角に基づいて
    前記車両の操舵角を制御する制御手段とを具えた車両の
    誘導走行制御装置。
  3. 【請求項3】 予定走行コースの位置データを記憶
    し、この位置データに基づいて車両の操舵角を制御して
    車両を前記予定走行コースに沿って誘導走行させる車両
    の誘導走行制御装置において、 前記予定走行コース上の各点ごとに、当該点の座標位置
    と前記車両が進行すべき方向を示すデータを記憶した記
    憶手段と、 前記車両の現在の座標位置を検出する位置検出手段と、 前記車両の現在の走行速度を検出する速度検出手段と、 前記位置検出手段で検出された現在の座標位置に最も近
    い、予定走行コース上の点の座標位置データおよび当該
    最も近い点の進行方向データを前記記憶手段の記憶内容
    から選択する選択手段と、 前記選択手段で選択された座標位置データおよび進行方
    向データと前記位置検出手段で検出された現在座標位置
    とに基づいて、車両進行方向に垂直な方向の車両位置の
    現在のずれ量を演算するずれ量演算手段と、 前記ずれ量演算手段で演算されたずれ量を積分演算する
    積分演算手段と、 前記ずれ量演算手段で演算されたずれ量と前記積分演算
    手段で演算された積分値と前記速度検出手段で検出され
    た現在の走行速度とに基づいて、前記ずれ量が零となる
    ように、前記検出走行速度が大きい程小さく第1の車両
    操舵角を演算する第1の操舵角演算手段と、 前記最も近い点における前記予定走行コースの曲率半径
    に基づいて第2の車両操舵角を演算する第2の操舵角演
    算手段と、 前記第1の操舵角演算手段で演算された第1の車両操舵
    角と前記第2の操舵角演算手段で演算された第2の車両
    操舵角とに基づいて、第3の車両操舵角を演算する第3
    の操舵角演算手段と、 前記第3の操舵角演算手段で演算された第3の車両操舵
    角に基づいて前記車両の操舵角を制御する制御手段とを
    具えた車両の誘導走行制御装置。
JP27667094A 1994-11-10 1994-11-10 車両の誘導走行制御装置 Expired - Fee Related JP3266747B2 (ja)

Priority Applications (6)

Application Number Priority Date Filing Date Title
JP27667094A JP3266747B2 (ja) 1994-11-10 1994-11-10 車両の誘導走行制御装置
AU38560/95A AU687270B2 (en) 1994-11-10 1995-11-10 Guidance system for vehicle
US08/836,133 US5781870A (en) 1994-11-10 1995-11-10 Vehicle steering angle control device
GB9709154A GB2309556A (en) 1994-11-10 1995-11-10 Guidance system for vehicle
PCT/JP1995/002297 WO1996015483A1 (fr) 1994-11-10 1995-11-10 Systeme de guidage pour vehicule
CA002204857A CA2204857A1 (en) 1994-11-10 1995-11-10 Guidance system for vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP27667094A JP3266747B2 (ja) 1994-11-10 1994-11-10 車両の誘導走行制御装置

Publications (2)

Publication Number Publication Date
JPH08137549A JPH08137549A (ja) 1996-05-31
JP3266747B2 true JP3266747B2 (ja) 2002-03-18

Family

ID=17572686

Family Applications (1)

Application Number Title Priority Date Filing Date
JP27667094A Expired - Fee Related JP3266747B2 (ja) 1994-11-10 1994-11-10 車両の誘導走行制御装置

Country Status (6)

Country Link
US (1) US5781870A (ja)
JP (1) JP3266747B2 (ja)
AU (1) AU687270B2 (ja)
CA (1) CA2204857A1 (ja)
GB (1) GB2309556A (ja)
WO (1) WO1996015483A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111966103A (zh) * 2020-08-18 2020-11-20 国以贤智能科技(上海)股份有限公司 无人驾驶叉车零偏角的动态修正方法、装置、设备及介质

Families Citing this family (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3642547B2 (ja) * 1997-08-22 2005-04-27 株式会社小松製作所 自走車両の車速制御装置
US5999865A (en) * 1998-01-29 1999-12-07 Inco Limited Autonomous vehicle guidance system
US6314348B1 (en) * 1998-02-11 2001-11-06 Trimble Navigation Limited Correction control for guidance control system
JP3869108B2 (ja) * 1998-02-23 2007-01-17 株式会社小松製作所 無人車両の干渉予測装置および無人車両の誘導走行方法
US6141613A (en) * 1998-03-18 2000-10-31 Caterpillar Inc. Apparatus and method for controlling the steering of a tracked machine
DE19822508A1 (de) * 1998-05-19 1999-12-02 Daimler Chrysler Ag Verfahren zur Generierung von Ankopplungsbahnen, verwendbar zur Führung eines Fahrzeugs zu einer vorgegebenen Zielbahn
DE10019011A1 (de) * 2000-04-17 2001-10-25 Geo Tec Electronics Gmbh Verfahren zum Steuern einer Maschine auf einem vorgegebenen Fahrweg und Vorrichtung zu dessen Durchführung
ES2339547T3 (es) * 2002-10-30 2010-05-21 Mitsubishi Heavy Industries, Ltd. Procedimiento y dispositivo para dirigir un vehiculo sin contacto con la via.
US7991521B2 (en) * 2006-02-01 2011-08-02 Jervis B. Webb Company Variable path automated guided vehicle
US8190330B2 (en) * 2009-03-06 2012-05-29 GM Global Technology Operations LLC Model based predictive control for automated lane centering/changing control systems
JP5332952B2 (ja) * 2009-06-26 2013-11-06 トヨタ車体株式会社 無人搬送車の走行制御装置
CN103236199B (zh) * 2013-04-09 2015-02-25 北京理工大学 一种行人横穿马路自动测试系统及其测试方法
CN105857389A (zh) * 2016-04-29 2016-08-17 百度在线网络技术(北京)有限公司 无人驾驶车辆的转向控制方法和装置
WO2018094647A1 (en) * 2016-11-24 2018-05-31 Baidu.Com Times Technology (Beijing) Co., Ltd. Method and system for steering control of an autonomous vehicle using proportional, integral, and derivative (pid) controller
JP7412071B2 (ja) 2017-11-30 2024-01-12 株式会社小松製作所 無人車両の制御装置及び無人車両の制御方法
CN108437981B (zh) * 2018-03-01 2020-02-21 东软集团股份有限公司 一种自动倒车方法及装置
JP7208804B2 (ja) * 2019-01-17 2023-01-19 株式会社小松製作所 無人車両の制御システム及び無人車両の制御方法
CN113433942B (zh) * 2021-06-30 2022-11-18 南京理工大学 一种基于最优航向角的长轴车辆路径跟踪控制方法

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5914711A (ja) * 1982-07-13 1984-01-25 株式会社クボタ 無人走行作業車
JPS5911409A (ja) * 1982-07-13 1984-01-21 Kubota Ltd 無人走行作業車
JPS60204012A (ja) * 1983-11-24 1985-10-15 Toyota Central Res & Dev Lab Inc 無人車の走行指令装置
US4700427A (en) * 1985-10-17 1987-10-20 Knepper Hans Reinhard Method of automatically steering self-propelled floor-cleaning machines and floor-cleaning machine for practicing the method
US4803640A (en) * 1986-05-12 1989-02-07 Matsushita Electric Industrial Co., Ltd. Control arrangement for an industrial robot
JPH07101369B2 (ja) * 1987-12-17 1995-11-01 日本輸送機株式会社 自動操舵制御方式
JP2579808B2 (ja) * 1988-10-14 1997-02-12 株式会社椿本チエイン 移動体の誘導方法及びその装置
JPH0517704A (ja) * 1991-07-16 1993-01-26 Nippon Steel Chem Co Ltd カーボンブラツク造粒品の製造方法
JP3001701B2 (ja) * 1991-12-25 2000-01-24 本田技研工業株式会社 移動体の操向制御装置

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111966103A (zh) * 2020-08-18 2020-11-20 国以贤智能科技(上海)股份有限公司 无人驾驶叉车零偏角的动态修正方法、装置、设备及介质
CN111966103B (zh) * 2020-08-18 2021-04-20 国以贤智能科技(上海)股份有限公司 无人驾驶叉车零偏角的动态修正方法、装置、设备及介质

Also Published As

Publication number Publication date
GB2309556A (en) 1997-07-30
AU687270B2 (en) 1998-02-19
GB9709154D0 (en) 1997-06-25
AU3856095A (en) 1996-06-06
US5781870A (en) 1998-07-14
CA2204857A1 (en) 1996-05-23
WO1996015483A1 (fr) 1996-05-23
JPH08137549A (ja) 1996-05-31

Similar Documents

Publication Publication Date Title
JP3266747B2 (ja) 車両の誘導走行制御装置
US6199011B1 (en) Navigation system and a vehicle control system
EP0346538A1 (en) Control method for an unmanned vehicle
JPH0646364B2 (ja) 自律走行車の誘導方法
JP6607865B2 (ja) 経路制御システムおよび経路制御方法
CN112896147B (zh) 用于矿用车辆的双向定位泊车控制方法及装置
JPH10302194A (ja) 自動走行車
US7308345B2 (en) Steering assistance method and device for a motor vehicle
JP2000172337A (ja) 自律移動ロボット
JP3034121B2 (ja) 無人車の制御装置
JPS61278912A (ja) 地点追従方式による無人移動機械の誘導方法
JPS6170618A (ja) 無人走行システム
CN114089730A (zh) 机器人的运动规划方法和自动引导车
JPS59111508A (ja) 点追従方式による車両の自動誘導方法
JPH03189805A (ja) 車両の自動操舵方法及びその自動操舵装置
JP2002108453A (ja) 無人搬送車
CN112947487A (zh) 一种自动引导车辆及其曲线路径跟踪方法、控制装置
JP2837986B2 (ja) 走行体の旋回制御システム
JPH01280807A (ja) 移動体の誘導方法
JPS59119417A (ja) 自走台車制御装置
JP3846828B2 (ja) 移動体の操舵角制御装置
JP2748002B2 (ja) 移動体の誘導走行装置
KR100199988B1 (ko) 무인차의 조향방법 및 조향장치
JP2001318718A (ja) 無軌道自動搬送車及び自動搬送車の制御方法
JP2640446B2 (ja) 地点追従方式による無人移動機械の誘導装置

Legal Events

Date Code Title Description
FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090111

Year of fee payment: 7

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090111

Year of fee payment: 7

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100111

Year of fee payment: 8

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20110111

Year of fee payment: 9

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20120111

Year of fee payment: 10

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20130111

Year of fee payment: 11

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20140111

Year of fee payment: 12

LAPS Cancellation because of no payment of annual fees