JPS61221804A - 無人搬送車の走行制御装置 - Google Patents

無人搬送車の走行制御装置

Info

Publication number
JPS61221804A
JPS61221804A JP60062437A JP6243785A JPS61221804A JP S61221804 A JPS61221804 A JP S61221804A JP 60062437 A JP60062437 A JP 60062437A JP 6243785 A JP6243785 A JP 6243785A JP S61221804 A JPS61221804 A JP S61221804A
Authority
JP
Japan
Prior art keywords
detector
output
circuit
steering angle
steering
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.)
Pending
Application number
JP60062437A
Other languages
English (en)
Inventor
Yuji Nagano
永野 優治
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.)
NEC Corp
Original Assignee
NEC 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 NEC Corp filed Critical NEC Corp
Priority to JP60062437A priority Critical patent/JPS61221804A/ja
Publication of JPS61221804A publication Critical patent/JPS61221804A/ja
Pending 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/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means

Landscapes

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

Abstract

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

Description

【発明の詳細な説明】 (産業上の利用分骨) 本発明は走行経路からの車体の左右への変位を検出し、
操舵輪の車体に対する操舵角を制御して走行する無人搬
送車、移動ロボット等の走行制御装置に関する。
(従来技術とその問題点) 車体に備えた操舵輪の操舵角を制御して操舵を行なう無
人搬送車では、その走行制御装置としては、簡単なもの
では車体の進行方向前部に走行経路からの左右への変位
を検出する検出器を備え、この検出器の出力により操舵
角を制御するものがある。また走行経路への追従性を向
上させるために進行方向前部および後部にそれぞれ検出
器を備えることにより、左右への位置変位のみならず、
前後の位置変位の差と前後の検出器間の距離とから方向
変位角をも計算し操舵を行なうもΩがある。
しかしながら方向変位角の計算忙は三角関数の演算が必
要であり、走行制御装置、が複雑になり、方向変位角の
演算に時間がかかるという欠点があった。
また方向変位をも検出するために検出器をさらに追加し
て備えた走行制御装置が知られている。
例えば特公昭59−7964の搬舵制御装置では車体の
進行方向前部に左右1対の検出器を2組設け、そのうち
1対を走行路面および車体中心線に対し斜めに設置し、
車体の右側、左側各々の検出器について出力電圧の比を
用いて位置変位と方向変位角とが結合された操舵信号を
得ている。しかしこの操舵制御装置では、方向変位角を
検出するために新之に検出器を設ける必要がある、方向
変位角に対する操舵量と位置変位に対する操舵量との割
合社検出器の取付高さおよび走行路面、車体中心線に対
する傾斜角度によって定まってしまうため制約があり、
調整が難しいなどの欠点があった。
ま、た段階的な変位出力しか得られなψ検出器では上記
の出力電圧の比が正しく求められず、適用出来ないとい
う欠点があった。
(発明の目的) 本発明の目的は上記のような問題点を解決し、簡単な検
出器および制御回路で車体の位置変位および方向変位を
修正することが可能で、段階的な出力しか得られない位
置変位検出器でも適用可能な無人搬送車の走行制御装置
を提供することにある。
(発明の構成) 本発明によれば、走行経路からの左右への位置変位を検
出する検出器を備え、前記検出器の出力信号により操舵
輪の操舵角を制御して走行する無人搬送車において、車
体の進行方向前部および後部にそれぞれ走行経路からの
左右への位置変位を検出する第1および第2の検出器を
備えるとともに、進行方向前部の前記第1の検出器の出
力と、進行方向後部の前記第2の検出器の出力との差を
計算する減算回路と、前記減算回路の出力を定められた
係数倍に増幅する増幅回路と、上記第1の検出器の出力
と前記増幅回路の出力との和を計算し、操舵角信号とし
て出力する加算回路とを備え、前記操舵角信号により操
舵輪の操舵角を制御して走行することを特徴とする無人
搬送車の走行制御装置が得られる。
(構成の詳細な説明) 本発明では、通常車体の前進時用および後進時用として
車体の前部および後部にそれぞれ設けられている左右へ
の位置変位検出器を、前進(および後進)時に同時に使
用し、前部の位置変位検出器の出力から走行経路に対す
る車体前部の左右方向への位置変位を検出し、また前後
の位置変位検出器の出力の差から走行経路に対する車体
の方向変位に対応する出力を得ている。そしてこれらの
位置変位出力および方向変位に対応する出力とから、車
体の走行位置が走行経路に沿うように車体を回転させる
ための操舵角信号を得て、操舵輪の操舵を行なう。
すなわち、車体の進行方向前部の位置変位検出器の出力
をS2、進行方向後部の位置変位検出器の出力を8.と
すると、車体前部の位置変位S、を車体の位置変位を修
正するための操舵量とする。
また車体の方向変位が増加すると前後の検出器出力の差
が増加するため、減算回路によりその差By  amを
求め、その値に一定の係数Aを掛けた値A(at−am
)を増幅回路により求めて車体の方向変位に対応する操
舵量とする。車体の走行位置を修正するための操舵角信
号Vcは、これらの操舵量の和、すなわち Vc = SF + A (19r  Sm )   
     (1)として加算回路により求められる。係
数Aの値は、径などにより最適な値が求められる。
(実施例) 以下、本発明の実施例について図面により説明する。
第1図は本発明の一実施例を示すプロ、り図、第2図は
本発明の走行制御装置を適用した無人搬送車の一例を示
す説明図である。第2図の無人搬送車社車体1に駆動輪
3as 3bNおよび操舵輪4をもつ三輪車である。駆
動輪3a、3bを図示しないモータで駆動して走行し、
操舵輪4で操舵を行なう。車体1の進行方向前部に、規
定の走行経路18からの車体前部の位置変位y1を検出
して位置変位信号S、を出力する検出器2aを備え、ま
た車体1/の進行方向後部には走行経路18からの車体
後部の位置変位ylIを検出して位置変位信号S、を出
力する検出器2bを備えている。検出器2 a s2b
の出力S2、Slは、第1図に示すように減算回路20
に入力されてその差By  Smが求められ、さらに増
幅回路21により係数Aか乗ぜられA(8t−8,)が
求められる。そして検出器2aの出力S。
と、増幅回路21の出力A(ay−81)が加算回路2
2によって加えられて(1)式に示した操舵角信号(v
c)7#得られる。操舵角信号(Va ) 7は操舵モ
ータ9の駆動回路8に入力され、操舵輪の操舵角が制御
される。駆動回路8以降は従来の走行制御装置と同様で
ある。駆動回路8としては位置サーボ回路等が用いられ
るが、実際の操舵角ヂを駆動回路8にフィードパ、りす
る部分は第1図および以降の第5図では図示を省略して
いる。
車体IIが走行経路18に対して第2図忙示すような位
置変位y?、ym(yr>3’m>0)をもつときに検
出器2a、2bの出力S2、Ssが正として得られると
するとsr ) am ) Oとなるため、第1図の検
出器2aの出力S、は正となり、増幅回路21の増幅率
Aが正のとき増幅回路21の出力A(SF  8m )
も正となる。よって加算細路22の出力として得られる
(1)式の操舵角信号Veは正となる。このとき第2図
において、車体1の位置変位y2、y、および方向変位
0を修正するためには図中操舵角ゲで示した方向に操舵
を行なう必要があるため、操舵角信号Vcは図中の操舵
角yで示した方向を正と考えれはよいことになる。
なお、増幅回路21として増幅率Aか負となるものを使
用するときには、減算回路20の正負入力を入れ換えて
Ss  Byを求めて増幅回路21に入力すればよいこ
とは明ら必である。
本発明に使用する位置変位の検出器2a% 2bとして
は、第3図に示すように位置変位7y 、Vaに比例し
た直線的な位置変位信号ay、8mが得られる検出器の
ほか、第4図に示すように位置変位yν、’/mに対し
段階的な位置変位信号S2、S、が得られる検出器を用
いてもよい。第4図のような検出器を用いた場合、車体
IIの位置変位y2、y3、および方向変位θに対応す
る操舵角信号Vcが段階的に変化することになるが、操
舵角信号Vcによりこれらが修正される方向に正しく操
舵される。また、方向変位に対応する操舵量は増幅回路
21の増幅率Aの調整により容易に調節可能である。従
って本発明では、検出器2a、2bとして例えば誘導線
の発生する磁界を検出する方式、床面の反射テープから
の反射光を一列に設置したセンサで検出する方式、磁気
標識体をセンサで検出する方式など多種の方式の検出器
が使用可能である。
なお、第1図の実施例においては検出器2aの走行経路
18への収れん性によっては、例えば第5図のように増
幅率Bの増幅回路23により増幅して加算回路22に入
力してもよい。この場合(1)式の操舵角信号70社 Vc = B−8,+A (8F  81 )    
  (1)’となる。また第6図に主要部を示すように
加算回路22の出力側に増幅率Cの増幅回路24を挿入
して操舵角信号Vcを Vc = 0 (at + A (SF  Sm ) 
)     (1)”としてもよい。
また、第2図の実施例では駆動輪が2輪、操舵輪が1輪
の三輪車について示したが、車輪構成幼木実施例に限定
されるものではない。本発明社操舵輪をもつ他の車輪構
成の無人搬送車や移動ロボ、ト、例えば前2輪で操舵を
行なう四輪車、車体の前後方向中央部に駆動輪を2輪も
ち、前後に操舵輪を1輪ずつもつ菱形四輪車などにも適
用可能である。さらに操舵輪が駆動輪も兼ねる形式であ
っても適用可能である。
(発明の効果) 本発明によれば車体の進行方行前部の位置変位U   
       により車体の位置変位を、また前部と後
部の位置変位の差により車体の方向変位を、それぞれ修
正するようにしたので、車体の走行速度の影響を受けず
に方向変位を修正することが可能となる。特に走行速度
が低い時、例えぐ発進時などでも、方向変位に対応する
修正操舵が可能となる。また車体の方向変位角度を求め
る必要がないため、方向変位角計算に必要な三角関数の
演算あるいは新たな検出器の追加が不要であり、走行制
御装置が加算回路、減算回路、および増幅回路のみで構
成でき、簡単な回路で実現可能となる。さらに本発明で
は位置変位に対して直線的な出力の得られる検出器、段
階的な出力が得られる検出器いずれでも使用可能であり
、位置変位の検出方法、および検出器に対する制限が緩
和されるとともに方向変位に対応する操舵量の調整が容
易であり、多種の方式の検出器に対して適用可能である
という効果を有する。
【図面の簡単な説明】
第1図は本発明の一実施例を示すプロ、り図、第2図は
本発明の一実施例を採用した無人搬送車を示す説明図、
第3図および第4図は位置変位量と検出器出力の関係を
示す関係図、第5図および第6図はそれぞれ本発明の他
の実施例を示すプロ、り図である。 図において、2as 2b・・・検出器、3a−,3b
・・・駆動輪、4・・・操舵輪、8・・・駆動回路、9
・・・操舵モータ、18・・・走行経路、22・・・加
算回路、20・・・減算回路、21.23.24・・・
増幅回路。 第1図 第2図 検出器  駆動輪 第3図   第4図 1−5  図 第6図 減算回路

Claims (1)

    【特許請求の範囲】
  1. 規定された走行経路からの左右への位置変位を検出する
    検出器および車体の操舵を行なう操舵輪を備え、前記検
    出器の出力信号により前記操舵輪の操舵角を制御して操
    舵を行ない走行する無人搬送車において、車体の進行方
    向前部および後部にそれぞれ走行経路からの左右への位
    置変位を検出する第1および第2の検出器を備えるとと
    もに、進行方向前部の前記第1の検出器の出力と、進行
    方向後部の前記第2の検出器の出力との差を計算する減
    算回路と、前記減算回路の出力を定められた係数倍に増
    幅する増幅回路と、上記第1の検出器の出力と前記増幅
    回路の出力との和を計算し、操舵輪の操舵角信号として
    出力する加算回路とを備え、前記操舵角信号により上記
    操舵輪の操舵角を制御して走行することを特徴とする無
    人搬送車の走行制御装置。
JP60062437A 1985-03-27 1985-03-27 無人搬送車の走行制御装置 Pending JPS61221804A (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP60062437A JPS61221804A (ja) 1985-03-27 1985-03-27 無人搬送車の走行制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP60062437A JPS61221804A (ja) 1985-03-27 1985-03-27 無人搬送車の走行制御装置

Publications (1)

Publication Number Publication Date
JPS61221804A true JPS61221804A (ja) 1986-10-02

Family

ID=13200167

Family Applications (1)

Application Number Title Priority Date Filing Date
JP60062437A Pending JPS61221804A (ja) 1985-03-27 1985-03-27 無人搬送車の走行制御装置

Country Status (1)

Country Link
JP (1) JPS61221804A (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63153605A (ja) * 1986-12-17 1988-06-27 Kubota Ltd 自動走行作業車の操向制御装置
JPH0358104A (ja) * 1989-07-27 1991-03-13 Mitsubishi Electric Corp 車両の自動操縦走行装置

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS63153605A (ja) * 1986-12-17 1988-06-27 Kubota Ltd 自動走行作業車の操向制御装置
JPH0358104A (ja) * 1989-07-27 1991-03-13 Mitsubishi Electric Corp 車両の自動操縦走行装置

Similar Documents

Publication Publication Date Title
JPH0324605A (ja) 移動ロボットの走行制御方法
US5781870A (en) Vehicle steering angle control device
JPS61221804A (ja) 無人搬送車の走行制御装置
JP3361280B2 (ja) 3輪操舵無人搬送車
JPS61228509A (ja) 無人搬送車の走行制御装置
KR100198023B1 (ko) 무인반송차의 조타각 제어장치
JPS61221805A (ja) 無人搬送車の走行制御装置
JP3628405B2 (ja) 走行車の方向補正方法及びその装置
JPS6165318A (ja) 無人搬送車の走行制御装置
JP3144122B2 (ja) 無人搬送車のステアリング速度制御装置
JP3846828B2 (ja) 移動体の操舵角制御装置
JPH0313768Y2 (ja)
JP2517221B2 (ja) 無人搬送車の制御装置
JPH03127105A (ja) 磁気誘導式無人搬送車の操舵装置
JP3134551B2 (ja) 無人搬送車の走行制御方法
KR0170344B1 (ko) 무인차의 조향 방법
JPH0512803Y2 (ja)
JPH0348307A (ja) 磁気誘導式無人搬送車の操舵装置
JPH0196706A (ja) 無人搬送車
JPH0981240A (ja) 自律走行式無人搬送車における走行制御方法
KR100198024B1 (ko) 무인반송차의 속도제어장치
JPH01240910A (ja) 操舵制御装置
JP2000122722A (ja) 移動体の操舵角制御装置
JPH06149375A (ja) 無人搬送車の誘導装置
JPS60262220A (ja) 無人搬送車の操舵装置