JPS58166406A - 無人車輛誘導装置 - Google Patents

無人車輛誘導装置

Info

Publication number
JPS58166406A
JPS58166406A JP57048578A JP4857882A JPS58166406A JP S58166406 A JPS58166406 A JP S58166406A JP 57048578 A JP57048578 A JP 57048578A JP 4857882 A JP4857882 A JP 4857882A JP S58166406 A JPS58166406 A JP S58166406A
Authority
JP
Japan
Prior art keywords
zero
vehicle
point error
error voltage
output
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
JP57048578A
Other languages
English (en)
Other versions
JPS6232485B2 (ja
Inventor
Yasuhisa Iida
飯田 泰久
Shiyouji Doi
土井 祥爾
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.)
Mitsubishi Heavy Industries Ltd
Original Assignee
Mitsubishi Heavy Industries 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 Mitsubishi Heavy Industries Ltd filed Critical Mitsubishi Heavy Industries Ltd
Priority to JP57048578A priority Critical patent/JPS58166406A/ja
Publication of JPS58166406A publication Critical patent/JPS58166406A/ja
Publication of JPS6232485B2 publication Critical patent/JPS6232485B2/ja
Granted legal-status Critical Current

Links

Classifications

    • 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/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/027Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising intertial navigation means, e.g. azimuth detector

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Steering Controls (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 本発明は無人車輛誘導装置に関する。
工場内の物流自動化の丸めの無人台車中冷凍倉庫用の無
人フォークリフトの誘導手段としては、従来、床面に光
学反射テープを貼シ、付設され丸受光七ンナにてこれを
検知することによ〉無人車−をこれに沿りて走行畜せる
もの、光学反射テープ0代わ〕に、誘導電線を走行コー
ス下KJII殴し、ビ、クア、デコイルでその位置を検
知す纂ことによ〉、無人車−を誘導電線に沿って走行さ
せるも04Iが知られているが、このような手段は床上
に光学反射テープとか誘導電線を布設する工事が必要と
なるばかシでなく、無人車Wは床上を自−に走行できる
のではなく、設定コースの直上しか走行で11ないとい
う欠点があり九。
本発明上ζOような事情に鑑みて提案されたもので、地
上儒O駿備なしに自由に所望のコースを走行し得為無人
車1IIII導鋏置を提供することを目的とし、車輪に
付設され九センサの出カッ臂ルスをカウントすることに
よシ得られる走行距離と、車輛に付設され九レートジャ
イロの出力角適度を積分す為ことにより得られる炎勢角
とにより車輌の位置を検出しこれKよ)車Wを誘導する
ものにおいて、車輌の停止ごとにこれを検知しその都度
上記レートジャイa(Q零点誤差電圧なサンブリングす
る回路と、上記レートジャイロの出力角速度をデジタル
に変換し九のちラッチするう、子回路の出力よ〕上記レ
ートジャイロの零点誤差電圧を減算する減算回路と、上
記減算回路の出力を累積加算する加算回路とを具えたこ
とを特徴とする。
本発明の一実施例を図面について説明すると、3111
図に)、 all) 、 (C’)はそれぞれ公知のレ
ートジャイロの角度、角速度、ジャイロ出力を示すl1
図、第21!iは公知のレートジャイνの出力補正回路
図、113図は本発明の一実施例の系統図、114図は
第3図の位置検出N(01口、り線図、第S図(A)、
(6)はそれぞれ114図0JIIL積加算器の作用説
明図である。
本発明の実施例の説明に先立って、先ず本装置に使用す
るレートジャイaについて述べるとこれは入力となる軸
に対する自速[0に比例した電圧を出力するもので蛾近
では構造がシングルで軸受などのない比較的安価でかつ
耐久性に冨むガス方式の4のが入手できる。姿勢角θを
時JiT、における#&優角を求めるのでおるが第1図
に示す如く0=0すなわち静止時においても、誤211
11IC圧1が発生するので上記式で検分すかかわらず
時間とともに積分値が変化し、結局姿勢角0かに1/I
kシてしまう。
従来は第2図図示の如くこの積分回路に01回路を用い
てお9その検分特性及び−差電圧の補正法等線アナログ
回路をtill々のソヤイロ母に―整していた。
本発明はこの点を解決したレートジャイロを使用するこ
とによシ改良した無人車軸の$4装置を提案するもので
ある。
まず第3図において1は車輛、2はモータ4で駆動され
車輛1を前後進させる固定車輪、sri方向を変える為
のステアリング車輪、5は駆動車輪2の回転数もしくは
回転角を検出するためのセンサで一定角度毎に・−ルス
を発生させるものである。6は操舵用の篭−夕でステア
リング車輪Sの方向を変え進行方向を変更する。1は操
舵方向を検出する為の回転角センナである。
8はレートジャイロでこれKよプ車輛1の自速iを検出
する。9は位置検出部で、センt5、レートジャイロ8
からの出力がインデ、トされる。10は制御部で車輛1
の走行制御を行なうものである。11はモータのドライ
/4で制御部10の出力信号によシ前彼進、方向操舵が
行なわれる。
次に第4図において20はレートジャイロ8の角速度(
a)出力を増巾するアンプ、21はこの出力をデジタル
化するA/D変換器、22はこの出力を保持するう、チ
である。う、チ22の出力はう、チ24の出力とともに
減算器2Jに入れられ暮。減算器2Sの出力は累積加算
器25の一万の入力とな=、う、チ26の出力はフィ゛
−ドパッグして累積加算器25の他方の入力となる。2
4は零点誤差データのラッチである。27はクロック発
生部で上記A/D変換器21、う、チ22、減算器23
、累積加算器25、う、チ2IIのそれぞれのタイミン
グを作る。28はセンサ5の/fルスをカウントするカ
ウンタである。2りは単安定マルチバイブレータよυな
るリドリガーで・譬ルス列の1g蕪をチェ、りする、3
0はアンドff−ト、31Fiオアr−トである。
制御部10へは位置検出部9からう、チ26の出力即ち
姿勢角(方向)のデータθとカウンタ2′8の出力即ち
累積進行距離データが入力し、逆に制御1110かも位
置検出部9へは車輛1が原点にあるときに出力されるク
リア信号とモータ4を停止させている時の信号が入る一
0′このような装置においてまず車@1がフロアの基準
となる場所に停止している時を原点にいるとする。この
時原点クリア/母ルス信号が制御部10から位置検出W
A9に出される。これにより、角度データ(#)と進行
距離を保持するラッチ26、カウンタ28がそれぞれク
リアされ、またラッチ24の零点誤差データがクリアさ
れる。
この時モータ停止信号が出てお〉車輛1は停止している
のでセンサ5からのノ譬ルスが発生していない為リドリ
ガー29は停止信号を出している。よってアンドゲート
S0のr−)からクロック発生部21のノ臂ルスが通)
オアゲート31を通してう、チJ4にデータがラッチさ
れる。一方う、チ24のデータは、う、チ22にラッチ
されている車輛停止時のレートジャイロ8の出力を保持
する。これはすなわち車輛1が停止しているにもかかわ
らず発生するレートジャイロ8の零点誤差電圧Vヨであ
る。
以上の後、各モータ4.6が起動され走行が始1.1と
ラッチ22には時々刻々の角速度データ■(θ、t)が
う、チされる。このデータには起動直前に測定した零点
誤差電圧Vつが入りている九め、減算器23で零点電圧
が差し引かれる。
これによシ真の自速fv(i、t)データが減算器2J
よ〕出力される。j!5.26は累積加算器及びラッチ
で時々刻々(時刻JT間隔)に角速度データが加算され
る。仁の加算は次式で近似され積分をしたことになる。
J:v(j、5)tsJ v(j、N5)aT−θ1=
NjT(N=1.2.3・・・) これにより角度−が検出できる。次に車−1のモータ4
が停止した時慣性によシすぐに停止しなかったとしても
、讐トリガー19により完全停止を検知すると再び零点
誤差電圧vNが新たにラッチJ4rcffl#される。
ζOようにして、起動・停止を繰返すえびKそO郁駅零
点誤差電圧をラッチ24にう、チし、起動後は入力され
る角速度データからこれを毎回引き算して累積加算(積
分)することによシ高精度11C@勢角の検出が可能と
なる。
このような装置によれは下記の効果が奏せられる。
(1)  レートジャイロ毎にバラツキのある零点誤差
t−回wIlllIi豊勢を行うことなく自動補正でき
る。
(2)停止毎に誤差となる零点電圧をサンプリングして
いる為角度計算の誤差が累積せず高精度に計測できる。
零点誤差の時間的装動に4対応して補正できる。
(3)  レートジャイロ出力をアナログ方式で積分し
ていないため、積分定数CR低抵抗コンデンサ)の温度
ドリフト等による影響がまったくなく、安定した動作が
得られる。
なお、上記実施例においては車輛1として4輪を例にし
たが3輪でもよく、また駆動軸とステアリング輪とが同
一でも何ら差つかえない。
さらにう、チ22.減算器23、ラッチ24、累積加算
器25、ラッチ26、クロνり発生部27などはマイク
ロプロセッサを用いれば同郷の嶺能をプログラムで行な
うことができる。即ちソフトウェアで行うようにしても
よい。
要するに本発明によれば、車輪に付設されたセンサの出
力/IPルスをカウントすることによシ得られる走行距
離と、車輛に付設されたレートジャイロの出力角適度を
積分するととKより得られる喪勢角とによ)車輛の位置
を検出しこれによ〕車輪を誘導するものにおいて、車輛
の停止ごとにこれを検知しその都度上記レートジャイロ
の零点誤差電圧をサンプリングする回路と、上記レート
ジャイロの出力角速度をデジタルに変換したのちラッチ
する。う、ツチ回路の出力より上記レートジャイロの零
点誤差電圧を減算する減算回路と、上記減算回路の出力
を累積加算する加算回路とを異見えことにより、地上設
備なしに所望のコースを走行する無人車輛鱒導装置を得
るから、本発明は産業上極めて有益なものである。
【図面の簡単な説明】
第1図(A)、ω)、(匂はそれぞれ公知のレートジャ
イロの角度、角速度、ジャイロ出力を示す線図、812
図は公知のレートジャイロの出力補正回路図、第3図は
本発明の一実施例の系統図、第4図は43図の位置検出
部のプロ、り線図、第5図内、(狗はそれぞれ第4図の
累積加算器の作゛用説明図である。 1・・・車輛、2・・・駆動車輪、3・・・ステアリン
グ車輪、4・・・モータ、5・・・セ/す、6・・・モ
ータ、7・・・回転角センサ、8・・・レートジャイロ
、9・・・位置検出部、10・・・制御部、11・・・
ドライ・者、12・・・パワテリ、20・・・アンプ、
21・・・k/D変換器、22・・・う、チ、23・・
・減算器、24・・・ラッチ、25・・・累積加算器、
26・・・う、チ、27・・・クロ、り発生部、28・
・・カウンタ、211・・・リドリガー、30・・・ア
ンドゲート、31・・・オアゲート。 出願人復代理人  ff11士 鈴 江 武 彦第1図 第2図 第3図 1咀 第5図 土[」止■ロユ上し±−−−−

Claims (1)

  1. 【特許請求の範囲】 とによ)得られる姿勢角とKよ)車−の位置を検出しこ
    れにより車−を誘導するも□において、車NO停止ごと
    にこれを検知しその都度上記レト 一1゛ジャイロの零点誤差電圧をサンプリングすト る回路と、上記シーXジャイロの出力角速度をデジタル
    に変換したのち、う、チするラッチ回ト 路の出力より上記レーγジャイロの零点誤差電圧を減算
    する減算回路と、上記減算回路の出力を累積加算する加
    算回路とを具え九ことを特徴とする無人車輛誘導装置。
JP57048578A 1982-03-26 1982-03-26 無人車輛誘導装置 Granted JPS58166406A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP57048578A JPS58166406A (ja) 1982-03-26 1982-03-26 無人車輛誘導装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP57048578A JPS58166406A (ja) 1982-03-26 1982-03-26 無人車輛誘導装置

Publications (2)

Publication Number Publication Date
JPS58166406A true JPS58166406A (ja) 1983-10-01
JPS6232485B2 JPS6232485B2 (ja) 1987-07-15

Family

ID=12807278

Family Applications (1)

Application Number Title Priority Date Filing Date
JP57048578A Granted JPS58166406A (ja) 1982-03-26 1982-03-26 無人車輛誘導装置

Country Status (1)

Country Link
JP (1) JPS58166406A (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01148908A (ja) * 1987-12-04 1989-06-12 Japan Aviation Electron Ind Ltd 車両用レートセンサの較正方法
EP0366249A2 (en) * 1988-09-28 1990-05-02 Sumitomo Electric Industries Ltd Method for correcting zero point of gyro and apparatus therefor

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5515505A (en) * 1978-07-17 1980-02-02 Honda Motor Co Ltd Automotive present position indicator
JPS5599599A (en) * 1979-01-24 1980-07-29 Tokyo Shibaura Electric Co Flying body guiding controller
JPS56110200A (en) * 1980-02-05 1981-09-01 Honda Motor Co Ltd Running route indicator
JPS5746116A (en) * 1980-09-04 1982-03-16 Honda Motor Co Ltd Running cource indicator
JPS5748110A (en) * 1980-09-05 1982-03-19 Mitsubishi Electric Corp Unattended running car

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5515505A (en) * 1978-07-17 1980-02-02 Honda Motor Co Ltd Automotive present position indicator
JPS5599599A (en) * 1979-01-24 1980-07-29 Tokyo Shibaura Electric Co Flying body guiding controller
JPS56110200A (en) * 1980-02-05 1981-09-01 Honda Motor Co Ltd Running route indicator
JPS5746116A (en) * 1980-09-04 1982-03-16 Honda Motor Co Ltd Running cource indicator
JPS5748110A (en) * 1980-09-05 1982-03-19 Mitsubishi Electric Corp Unattended running car

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01148908A (ja) * 1987-12-04 1989-06-12 Japan Aviation Electron Ind Ltd 車両用レートセンサの較正方法
EP0366249A2 (en) * 1988-09-28 1990-05-02 Sumitomo Electric Industries Ltd Method for correcting zero point of gyro and apparatus therefor

Also Published As

Publication number Publication date
JPS6232485B2 (ja) 1987-07-15

Similar Documents

Publication Publication Date Title
CN106843214B (zh) 一种基于自抗扰控制的磁带导引agv循迹控制方法
CA2188078C (en) Motion tracking apparatus for driverless vehicle
Von Der Hardt et al. The dead reckoning localization system of the wheeled mobile robot ROMANE
EP1955936A1 (en) Fall-prevention control device
CN205655844U (zh) 一种基于ros的机器人里程计
JPS58166406A (ja) 無人車輛誘導装置
JPH0317082B2 (ja)
JP2006189450A (ja) ナビゲーション装置
JPH0443282B2 (ja)
EP2112464B1 (en) Tracking type laser interferometer
JPH1039927A (ja) 無人搬送車の自律運転時の位置演算方法
JPH01282615A (ja) 自走式無人車の位置補正方式
JPH0695733A (ja) 自走台車の絶対位置検出方法
JP2573135Y2 (ja) 移動距離検出器
JPH0329697Y2 (ja)
JPH0144606B2 (ja)
JP3075785B2 (ja) トンネルの位置計測方法
JP3238358B2 (ja) 構造物移動装置
JP3231340B2 (ja) 台車走行制御装置
JPH09145393A (ja) 自律走行式無人搬送車の位置検出装置
JPS62288909A (ja) 無人搬送車の距離測定装置
SE419583B (sv) Sjelvgaende vagn
JPH07281740A (ja) 無人走行体の位置検出方法及び装置
JP2556737B2 (ja) 車体位置検出装置
JPH06332531A (ja) 無人無軌道車