JPH0529924B2

JPH0529924B2 -

Info

Publication number: JPH0529924B2
Application number: JP59203326A
Authority: JP
Inventors: Yutaka Kanayama
Original assignee: Glory Ltd
Current assignee: Glory Ltd
Priority date: 1984-09-28
Filing date: 1984-09-28
Publication date: 1993-05-06
Also published as: GB8508253D0; US4875172A; GB8810753D0; GB2202651B; DE3534183C2; GB2180958A; JPS6180410A; GB2202651A; FR2571158A1; DE3534183A1; GB2180958B; FR2571158B1

Description

【発明の詳細な説明】（発明の技術分野）この発明は、無人走行車等の移動ロボツトの走
行指令方式に関する。

（発明の技術的背景とその問題点）従来、移動ロボツトの走行方式としては、ある
特定の周波数の誘導電波を誘導電線から放射し、
その誘導電波を移動ロボツトが受信し、誘導電線
の成す経路に沿つて走行する方式、また誘導電線
の代りに光学反射テープを用い、光電検出器を利
用して走行するものがある。しかしながら、この
ような移動ロボツトはいずれも床面に敷設された
誘導電線もしくは光学反射テープからのずれ量を
検出し、ずれを補正するように操舵制御するもの
で、上記誘導体が必要不可欠であつた。したがつ
て、例えば工場内の工作設備や倉庫設備等のレイ
アウトが変更になつた場合には、各設備間の搬送
経路も当然変更しなければならず、誘導体の再敷
設をもしなければならない。さらに、誘導電線を
使用する場合にはその埋設工事に手間がかかり、
光学反射テープを用いる場合は塵埃に弱く、汚損
し易い等の欠点がある。

このような欠点を解決した走行指令方式とし
て、特開昭57−62424号公報に示されるものがあ
る。この走行指令方式は移動物体が進行すべき経
路を複数点の座標位置で表わし、この複数の座標
位置をデイジタル情報として発生し、この座標位
置に関連して領域を想定し、この領域と移動物体
の進行方向前方の仮想位置とに基づいて、移動物
体が次に進むべき領域を特定すると共に、その特
定された領域内に含まれる少なくとも２つの点を
結ぶ線上の点と移動物体の進行方向前方の仮想位
置とに基づいて操舵信号を発生するようにしてい
る。しかしながら、この走行指令方式では、進行
すべき経路を複数点の座標位置で表わすようにし
ているので、たとえば第１図Ａに示すように平行
な経路１，２の間で走行レーンを変更する場合
や、同図Ｂに示すように経路３をＵターンして同
一路を戻るような場合、いずれも円滑な経路指定
及び制御を行ない得ない欠点がある。

（発明の目的）この発明の目的は、床面に誘導電線や光学反射
テープを敷設することなく移動ロボツトを自由に
走行するための走行指令方式を提供することにあ
る。

この発明の目的は、走行レーンの変更やＵター
ンをも簡単に行ない得ると共に、任意な経路を走
行し得る簡易な指令方式を提供することにある。

この発明の他の目的は、移動ロボツトを自由に
かつ簡単な手段で走行させ、指令部とロボツトと
の間の通信制御を効率的に行なう走行指令方式を
提供することにある。

（発明の概要）この発明は、指令部と走行部を有し、指令部か
ら走行部へコマンドを送ることにより走行経路を
指定する移動ロボツトの走行指令方式に関するも
ので、与えられた有向直線上を前記移動ロボツト
が走行することを基本の動作とし、座標値XY
と、自身及びＸ軸のなす角度値θとを常時計算
し、指定された前記有向直線上を走行するために
利用するようにし、前記有向直線の位置、方向及
び向きを変えるコマンドを送ることにより前記走
行経路を任意に指定し得るようにし、現在の有向
直線及び次の有向直線の位置関係を座標変換を利
用したコマンドにより指定するようにすると共
に、前記コマンドが他の走行直線への過渡状態の
遷移点を指示する座標値を含んでいるものであ
る。

走行部自体が走行制御を行なうためのフイード
バツク制御時間と、指令部からのコマンドを実行
制御するコマンド実行制御時間とを所定時間ずつ
交互に割当てたものである。

（発明の実施例）先ずこの発明の原理を、第２図を参照して説明
する。

第２図において、移動ロボツトＲ（ｘ，ｙ）は
有向な走行直線Ｘの上を矢印方向に走行してお
り、移動ロボツトＲはわずかに走行直線Ｘ上をＹ
方向に外れることはあるが、大きく外れることが
ないようにサーボ機構で位置制御されている。つ
まり、常にｙ＝０となるようにサーボ制御されて
いる。そして、移動ロボツトＲをターンないしは
方向変換する場合には、他の走行直線X′を与え
ると共に、直線Ｘから直線X′への過渡状態の開
始点Ｅ（ｅ，ｏ）を遷移点として指定する。これ
により、移動ロボツトＲは遷移点Ｅまでは定速走
行し、その後新しい走行直線X′へ乗り移るよう
に制御される。ここに、走行直線ＸはXY座標系
のＸ軸であり、原点０（０，０）が決められてお
り、移動ロボツトＲがｘ≧ｅのときに原点0′（０，
０）のX′Y′座標系へ乗り移るための過渡状態の
制御に入り、X′軸上のある点で完全にX′軸上に
乗り移る。その点をＦとする。移動ロボツトＲは
遷移点Ｅに達するまでは自己の中で位置（ｘ，
ｙ）と方向θを有しており、検出器等で常に現在
値を変更している。方向θはＸ軸と移動ロボツト
Ｒがなす角度で、CCW方向を正にとり、（ｘ，
ｙ，θ）を移動ロボツトＲの姿勢とし、定常状態
ではｙ＝０を目標値とする制御機能が作用する。
遷移点Ｅ以後、移動ロボツトＲの姿勢（ｘ，ｙ，
θ）は新しいX′Y′座標系における姿勢（x′，y′，
θ′）で管理されるように座標変換される。

ここで、上記XY座標系からX′Y′座標系への座
標変換を第３図の座標を参照して説明すると、旧
座標系XYに対して〈go〉コマンド（後述する）
により新座標系X′Y′が指定されたとし、ロボツ
トＲの姿勢が旧座標系では（ｘ，ｙ，θ）であ
り、新座標系では（x′，y′，θ′）であるとする。
このとき両者の間には、ｘｙ＝cosθ₁−sinθ₁ sinθ₁ cosθ₁×x′ y′＋x₁ y₁θ＝θ′＋θ₁ ……(1) なる関係が成立する。したがつて、上記(1)式より x′ y′＝ cosθ₁ sinθ₁ −sinθ₁ cosθ₁ ×ｘｙ−x₁ y₁ ＝ cosθ₁ sinθ₁ −sinθ₁ cosθ₁ｘ−x₁ ｙ−y₁ θ′＝θ−θ₁ ……(2) が導かれ、〈go〉コマンド等が実行されるときに
は、最初に上記(2)式の座標変換、つまり（ｘ，
ｙ，θ）→（x′，y′，θ′）が行なわれる。

移動ロボツトの走行部等とこれに指令を与える
コンピユータ等で成る指令部との関係は第４図及
び第５図に示すようになつており、指令部１０に
は外界を識別するためセンサ等の視覚手段１１や
マニピユレータ等で成る手・腕機構１２その他が
接続されており、走行部２０と指令部１０との間
ではコマンド（Command）Ｃとこれに応じた応
答（Reply）RPとによる通信が後述するタイミ
ングで行なわれるようになつている。コマンドＣ
は指令部１０から走行部２０へ１バイト毎に送ら
れ、コマンドとコマンドとの間にはセパレータ
（たとえばコードや；）が挿入され、コマンドＣ
には一旦バツフアメモリに蓄積された後に先着順
に実行されるスローコマンド（Slow Command）
SCと、直ちに実行されるフアーストコマンド
（First Command）FSとがありスローコマンド
SCは一旦バツフアメモリBMに記憶された後、
先着順（first−in，first−out）で実行され、フ
アーストコマンドFSはバツフアメモリBMを通
さずに直ちに実行される。ここに、走行部２０は
待機（wait）状態と動作（active）状態との２つ
の状態を有しており、待機状態ではバツフアメモ
リBM中のコマンドは実行されず、後述する
〈start〉コマンドなるフアーストコマンドが指令
部１０から入力されたときに作動状態になる。走
行部２０は初期化された初期状態にはこの待機状
態になつている。また、動作状態では走行部２０
はバツフアメモリBM中のコマンドを先着順に実
行する。各コマンドＣの実行は、その次のコマン
ド（例えばC1）の遷移点に到達したときに終了
し、次のコマンドC1の実行が開始される。ある
コマンド（例えばC0）の実行中に次のコマンド
が存在しないとき、つまりバツフアメモリBMが
空であるとき、コマンドC0の実行は終了しない。
ただし、〈go〉，〈stop0〉，〈sdjust〉等のコマンド
を送ることによつて、このコマンドC0の実行を
終了させることは常に可能である。なお、動作状
態から待機状態に移行するのは、後述する
〈wait〉コマンドが実行されたときであり、これ
自身はスローコマンドであり、動作状態のときの
みに受付けられる。また、応答RPにはロボツト
自体の姿勢データを示す〈posture〉と、ロボツ
トが遷移点Ｅを過ぎて次の座標のＦ点に達してい
ない過渡状態であることを示す〈transient〉と、
定常状態であることを示す〈stationary〉と、長
時間定常状態に戻らないような事故発生を示す
〈error〉とがある。

ところで、〈go〉，〈spin〉，〈stop〉，〈adjsut〉
，
〈stop0〉などのコマンド実行に際しての制御アル
ゴリズムの一例を示す。ここでは、移動ロボツト
の速度Ｖ及び角速度ωを目標値に追従させるよう
に、CPUとROM，RAMに記憶されたプログラ
ム、データとによつてソフトウエアサーボを行な
う。

ロボツトに対して目標位置xdを停止点とする
〈goコマンド〉が指令された場合、定速モードに
よる速度制御を行ない、所定状態となつた時に減
速モードで速度制御を行ない、更に減速モードに
よる制御の結果が所定値となつた時に位置制御モ
ードに切換え、最終的に停止モードに切換えるよ
うになつている。すなわち、コマンド実行のため
には現在位置ｘ（ｔ）に応じて減速するような目
標速度Vr（ｔ）を与え、実際の速度Ｖ（ｔ）≒０
でｘ（ｔ）≒xdとなつた時にサーボループを速度
サーボから位置サーボに切換える。Ｘ軸上を一定
速度で目標位置xdまで行つて丁度停止するため
には、ｘ点の速度Ｖ（ｘ）をＶ（ｘ）＝kl・sign（xd−ｘ）・ √｜−｜ ……(3) とする。なお、減速度をAvとすれば係数klは kl＝√２・ ……(4) である。また、コマンド実行中に Vr（ｔ）≧Ｖ（ｘ（ｔ））−ε ……(5) となつた時に減速モードに入るようにする。な
お、εは非常に小さい値とする。

減速モードに入つたらコマンド制御のうち、角
速度ωの制御についてはｆ（ｒ，θ，ω）を fo（ｒ，θ，ω）＝k2・θ−k3・ω ……(6) に変更し、この制御を位置制御モードでも継続す
る。また、速度Ｖの制御はVr−Δt・ｇ＜−
Vmaxのとき Vr（ｔ＋Δt）＝−Vmax ……(7) とし、Vmax＜Vr＋Δt・ｇのとき Vr（ｔ＋Δt）＝Vmax ……(8) とし、−Vmax≦Vr＋Δt・ｇ≦Vmaxのとき Vr（ｔ＋Δt）＝Vr（ｔ）＋Δt・go ×（Ｖ（ｔ），ｘ（ｔ）） ……(9) とする。なお、goは−Av又はAvである。そし
て、減速モードによる制御の結果｜ｘ−xd｜＜ε′ Ｖ（ｔ）＜ε ……(10) となつた時に制御系を位置制御モードに切換え、
位置制御モードでは Vr（ｔ）ｘ＝k4・（xd−ｘ（ｔ）） ……(11) で制御する。この位置制御の結果ｘ（ｔ）≒xd Ｖ（ｔ）≒０ θ ≒０ ω ≒０ ……(12) となつた時に目標位置xdに停止したと判断し、
停止モードに切換える。

第６図はこの発明を動輪操舵方式の移動ロボツ
トに適用した例の外観を示すもので、底部には走
行用の左右１対の間隔の車輪１０１及び１０２
が設けられており、頂部には超音波距離測定装置
１０３が設けられている。また、指令部１０から
のコマンドＣを解析したり、車輪１０１，１０２
を駆動したりする走行部はラツク１０４内にプリ
ント板等に装着されて収納されており、この走行
部は上述走行部２０の一部を構成しており、その
詳細は第７図のような構成となつている。すなわ
ち、走行部はマイクロコンピユータ等のCPU
（Central Processing Uuit）１１０を有してお
り、CPU１１０には指令部との間で通信を行な
うための通信制御部１１１が接続されると共に、
プログラムやパラメータ等を格納するROM
（Read Only Memory）１１２及び制御に必要
なデータを一時的に記憶するRAM（Random
Access Memory）１１３が接続されている。ま
た、CPU１１０にはロボツト左側の車輪１０１
を駆動制御するためのコントローラ１１４Ｌと、
ロボツト右側の車輪１０２を駆動制御するための
コントローラ１１４Ｒとが接続され、コントロー
ラ１１４Ｌ及び１１４Ｒはそれぞれモータ１１５
Ｌ及び１１５Ｒを介して車輪１０１及び１０２を
駆動制御するようになつており、車輪１０１及び
１０２にはそれぞれシヤフトエンコーダ１１７Ｌ
及び１１７Ｒが接続され、シヤフトエンコーダ１
１７Ｌ及び１１７Ｒのパルス出力PRL及びPRR
はそれぞれCPU１１０を介してコントローラ１
１４Ｌ及び１１４Ｒに入力され、ブレーキ１１６
Ｌ及び１１６ＲはCPU１１０からのブレーキ制
御信号Ｂで、コントローラ１１４Ｌ及び１１４Ｒ
を介して駆動される駆動モータ１１８Ｌ及び１１
８Ｒによつて制御される。

このような構成において、CPU１１０はコン
トローラ１１４Ｌ及び１１４Ｒに対して目標速度
VrL及びVrRを与えるが、先ず目標速度VrL及び
VrRの決定法を説明する。移動ロボツト１００
の速度をＶ、角速度をωとするとＶ＝（VL＋VR）／２ ω＝（VR−VL）／ ……(13) が成立するので、この（13）式より VL＝Ｖ−／２・ω VR＝Ｖ＋／２・ω ……(14) となる。したがつて、ロボツト１００の速度Ｖ及
び角速度ωが与えられると、上記（14）式に従つ
て左右車輪の速度VL及びVRを計算し、これを
目標速度VrL及びVrRとしてそれぞれコントロー
ラ１１４Ｌ及び１１４Ｒに与える。左右車輪１０
１及び１０２の速度VL及びVRはそれぞれシヤ
フトエンコーダ１１７Ｌ及び１１７Ｒで計測さ
れ、その出力PRL及びPRRがそれぞれCPU１１
０を介してコントローラ１１４Ｌ及び１１４Ｒに
入力されているので、速度VL及びVRは最終的
に目標速度VrL及びVrRと一致するように制御さ
れる。

なお、ここでは動輪操舵方式の移動ロボツトに
おける制御方式について述べたが、前輪操舵・後
輪駆動による方式などについても、この制御方式
を適用することは同様に可能である。

一方、第８図は走行部の動作タイミングと動作
モードを示すものであり、電源投入時等の時点t1
にロボツト１００は初期化されて、所定時間To
が経過するまで初期化モードを継続し、この間に
現在位置（ｘ，ｙ）を（０，０）にセツトした
り、θ＝０にセツトすると共に、必要な制御パラ
メータ等を自動設定する。時間Toが経過した時
点t2以後、時間T1のフイードバツク制御モード
と時間T2のコマンド実行制御モードとを周期Ｔ
で繰返す。フイードバツク制御モードは第７図の
制御系で上述したような速度制御や位置制御を行
なうために割当てられており、コマンド実行制御
モードは指令部から通信制御部１１１を介して受
信したコマンドの内容を解析し、解析結果を実行
するように割当てられており、いずれも十分に余
裕のある時間が割当てられている。走行部は時間
Ｔの周期でフイードバツク制御モードとコマンド
実行制御モードとを順次繰返すが、指令部から必
要な場合に所定の応答要求信号が伝送されて来る
と直ちに通信制御モードとなつて必要な通信を所
定時間内に行なうようになつている。この通信方
式は、常に走行部の状態を指令部へ送るのに比
べ、通信量が過大にならないという利点を有す
る。所定の時間が経過すると元のモードに復帰し
て、当該モードを継続する。第８図ではフイード
バツク制御モードの途中の時点t3に通信要求信号
が伝送された場合と、コマンド実行制御モードの
途中の時点t4に通信要求信号が伝送された場合と
を示し、いずれも通信制御モードの終了後は直ち
に元のモードに復帰している。これにより、走行
部の走行動作と通信動作を見かけ上同時並行して
実行することが可能となる。

第９図は指令部と走行部との通信の動作を示す
フローチヤートである。ロボツト１００のCPU
１１０は常に指令部からの応答要求信号があるか
否かを判断しており（ステツプS1）、応答要求信
号が入力されて受信要求のある場合は１バイト単
位のコマンドを指令部から通信制御部１１１を介
して入力し（ステツプS2）、入力されているコマ
ンドデータが完全に入力されるのを待つ（ステツ
プS3）。コマンドが確定した後、入力されたコマ
ンドがフアーストコマンドであるか否かを判断し
（ステツプS4）、フアーストコマンドである場合
には直ちに当該コマンドを実行し（ステツプ
S5）、フアーストコマンドでない場合はスローコ
マンドであるのでこれをバツフアメモリBMに蓄
積して登録する（ステツプS6）。そして、指令部
にデータを伝送する要求があるか否かを判断し
（ステツプS7）、送信要求がある場合は１バイト
単位のデータ、たとえばロボツト１００の現在姿
勢を示すデータを指令部に送つて終了となる（ス
テツプS8）。

第１０図はフイードバツク制御モードの動作例
を示すフローチヤートであり、CPU１１０は常
に指令部からのデータ伝送要求があるか否かを判
断しており（ステツプS10）、要求がある場合は
パルスエンコーダ１１７Ｌ及び１１７Ｒからのパ
ルスデータPRL及びPRRを読取つて速度データ
を入力する（ステツプS11）。その後、走行部が
動作状態となつているか否かを判断し（ステツプ
S12）、動作状態の場合には現在位置ｘ（ｔ）、目
標位置xd等から演算された制御量VrL，VrRを
出力し（ステツプS13）、現在位置（ｘ（ｔ），ｙ
（ｔ），θ（ｔ））を更新する（ステツプS14）。そ
して、更に走行部が動作状態であるか否かを判断
し（ステツプS15）、動作状態でない場合はブレ
ーキ制御信号BCをオンしてブレーキをかける
（ステツプS16）。また、動作状態の場合は〈go〉
コマンドであるか否かを判断し（ステツプS20）、
〈go〉コマンドの場合は更に現在位置ｘ（ｔ）と
目標位置xdの比較を行なう（ステツプS21）。
〈go〉コマンドでない場合及び〈go〉コマンドで
あつて目標位置xd（たとえばＥ点）が現在位置ｘ
（ｔ）より大きい場合は、過渡状態か定常状態か
を判断して（ステツプS22）からコマンドが終了
となつたか否かを判断する（ステツプS23）。コ
マンド終了でない場合にはそのまま、コマンド終
了である場合はバツフアメモリBMに格納されて
いるスローコマンドを実行（ステツプS24）して
後に、次回の目標速度を計算する（ステツプ
S25）。また、上記ステツプS21で現在位置ｘ（ｔ）
が目標位置xd以上の場合は、前述した如き座標
変換を行なつて終了となる（ステツプS26）。

さらに、第１１図はコマンド実行制御モードの
動作例を示すフローチヤートであり、コマンド制
御（ステツプS30）になると先ずコマンドの形式
的なチエツクを行なつて誤りがないか否かを判断
し（ステツプS31，S32）、誤りがある場合はコマ
ンドエラーとする（ステツプS33）。誤りがない
場合は更に最終的なチエツク（ステツプS34）を
行なつて後、実行に適した内部形式にコマンドを
変換し（ステツプS35）、スローコマンドである
か否かを判断する（ステツプS36）。スローコマ
ンドの場合には当該スローコマンドをバツフアメ
モリBMに蓄積し（ステツプS37）、スローコマン
ドでない場合、つまりフアーストコマンドである
場合はフアーストコマンドの場合分けを行なつて
実行する（ステツプS40）。

次にこの発明に用いるコマンドＣの種類とその
内容について説明する。

コマンドＣには、スローコマンドSCとフアー
ストコマンドFCの２種類があり、スローコマン
ドSCには〈go〉コマンド、〈stop〉コマンド、
〈wait〉コマンド、〈reverse〉，〈velocity〉コマ
ンド、〈control〉コマンド、〈set brake〉コマン
ド及び〈reset brake〉コマンドがあり、フアー
ストコマンドFCには〈go ０〉コマンド、
〈start〉コマンド、〈stop ０〉コマンド、
〈adjust〉コマンド、〈velocity ０〉コマンド、
〈get〉コマンド、〈cancel〉コマンド、〈free
motor〉コマンド、〈servo〉コマンドがある。こ
こで、各コマンドの内容を説明する。

(1) 〈go〉コマンド→Ge，ｘ，ｙ，θ；新しい座標系X′Y′は現在の座標系XYを（ｘ，
ｙ）だけ平行移動し、θだけ回転移動したもので
あり、移動ロボツト１００は新しいX′軸へ乗り、
その遷移点Ｅは旧座標系におけるＸ＝ｅつまり点
（ｅ，ｏ）である。停止状態において、指令部１
０から各種〈go〉コマンドが指令された場合の
移動ロボツト１００の経路を第１２Ａ〜Ｃ図に示
して説明する。

“G0，０，０，０；”は方向変更もないので
第１２図Ａのように走行直線Ｘ（＝X′）上をその
まま走行し、コマンド“G0，50，０，45；”は
点（50，０）を原点とするX′Y′座標系を指定し、
その回転角θが45°であるので同図Ｂのようにし
てX′軸に乗り移る。また、コマンド“G0，０，
０，180；”は原点（０，０）での方向転換を意
味しており、第１２図Ｃに示すように逆方向に走
行する。次に、走行中に〈go〉コマンドを受け
たときの移動ロボツト１００のターンの様子につ
いて説明する。コマンド“G60，100，０，30；”
は新座標X′Y′の原点を（100，０）として傾斜を
30°とし、遷移点Ｅを（60，０）としているので
移動ロボツト１００の走行経路は同図Ｄのように
なり、遷移点Ｅを（50，０）として傾斜角度θを
140°とした場合には同図Ｅのようになる。さら
に、コマンド“G110，100，０，90；”が指令さ
れた場合は新しい原点（100，０）を通り過ぎた
位置Ｅ（110，０）を遷移点としているので、移動
ロボツト１００の走行路は第１２図Ｆのようにな
り、回転角θ＝90°で走行移動する。コマンド
“G100，０，40，０；”が入力されると、遷移点
Ｅ（100，０）から移動ロボツト１００は新しい
X′軸に乗り移るので、同図Ｇのようになり、Ｕ
ターンを意味するθ＝180°が指令され、コマンド
“G100，０，−50，180；”が入力されると同図Ｈ
のようになる。

(2) 〈spin〉コマンド→Nθ；このコマンドは停止状態にあるときにのみ機能
し、それ以外のときは無視され、θで示される角
度だけスピン（信地旋回）し、実行後は停止す
る。なお、このコマンドでは座標変換を行なわな
い。

(3) 〈stop〉コマンド→Ps；このコマンドは移動ロボツト１００をＸ軸上の
点（ｓ，ｏ）に停止させるもので、行き過ぎたと
きは後退して上記点（ｓ，ｏ）に停止する。この
コマンドは移動ロボツト１００の停止中には無視
される。

(4) 〈wait〉コマンド→Ｗ；移動ロボツト１００を待機状態とするコマンド
である。

(5) 〈reverse〉コマンド→Re；これ以後走行ロボツト１００は前面と後面とを
変えて走行し始めるが、経路そのものの定義は
〈reverse〉コマンドの前後で変化はない。

(6) 〈velocity〉コマンド→Vv；定常状態での走行速度を変化するコマンドであ
り、これ以後に現われる〈go〉コマンドと
〈spin〉コマンドの速度が決められる。

(7) 〈control〉コマンド→Cpl，p2；サーボループで制御パラメータを変更するスロ
ーコマンドであり、過渡状態での移動ロボツト１
００の経路や所要時間等を制御する。plはパラメ
ータの種類、p2はその値を示している。

(8) 〈set brake〉コマンド→Ｂ；移動ロボツト１００のブレーキ１１６Ｌ，１１
６Ｒに対してブレーキをかけるコマンドである。

(9) 〈reset brake〉コマンド→Ｋ移動ロボツト１００のブレーキ解除を行なうコ
マンドである。

(10) 〈start〉コマンド→Ｓ；待機状態にある移動ロボツト１００を、動作状
態へ変化させることにより走行開始させるための
コマンドである。

(11) 〈stop ０〉コマンド→Ｑ；ロボツト１００を非常停止させるコマンドであ
り、〈stop〉コマンドと異なつてｓの指定はない。

(12) 〈adjust〉コマンド→Ax，ｙ，θ；新しい座標系へ移行する点では前述の〈go〉
コマンドと同一であるが、進路の微調整や原点位
置の修正等のために、他の〈go〉コマンドの実
行中に用いられる。よつて、遷移点Ｅの指定はな
い。

(13) 〈velocity ０〉コマンド→Uv；ある１つのコマンドの実行中に、移動ロボツト
１００の速度を変えるものである。

(14) 〈get〉コマンド→Ｔ；ロボツト１００に対して現在の状態のデータの
送信を要求するコマンドであり、これに対してロ
ボツト１００はリプライRPを送る。

(15) 〈cancel〉コマンド→Ｌ；バツフアメモリBMに蓄えられたスローコマン
ドSCをキヤンセルして実行しないようにするコ
マンドである。

(16) 〈free motor〉コマンド→Ｆ；手動でロボツト１００を走行させるようにする
コマンドである。

(17) 〈servo〉コマンド→Ｅ；ロボツト１００をサーボ機構で作動させるコマ
ンドである。

第１３図に示すように、位置P1に停止してい
る移動ロボツト１００をP2位置まで、走行させ
た後、後退してP3位置に走行させる場合のコマ
ンド列は次のようになる。

G0，０，０； P350；Ｒ； G350，０ 180； G100，100，０，−90；Ｓ；最後の〈start〉コマンドＳによつて移動ロボ
ツト１００の走行が開始される。

（発明の効果）以上のようにこの発明によれば、簡単な指令コ
マンドでロボツトを自由に走行させることがで
き、効率的なロボツト制御を実現することができ
る。また、走行部が独立しており、無線等によつ
てコマンドが送られて来るときも同様の効果が得
られる。

【図面の簡単な説明】

第１図Ａ及びＢは移動ロボツトの走行例を示す
図、第２図及び第３図はそれぞれこの発明の原理
を説明するための図、第４図はこの発明の移動ロ
ボツトにおける走行部と指令部との関係を示すブ
ロツク図、第５図は指令部と走行部との間の通信
の様子を示す図、第６図はこの発明の移動ロボツ
トの一例を示す外観図、第７図はその制御系を示
すブロツク構成図、第８図は動作状態のタイミン
グを示す図、第９図〜第１１図はそれぞれその動
作例を示すフローチヤート、第１２図Ａ〜Ｈは
〈go〉コマンドによる移動ロボツトの移動の様子
を示す図、第１３図は移動ロボツト走行例を示す
図である。１０……指令部、２０……走行部、Ｒ，１００
……移動ロボツト、１０１，１０２……車輪、１
１０……CPU、１１１……通信制御部、１１４
Ｌ，１１４Ｒ……コントローラ。

Claims

【特許請求の範囲】１指令部と走行部を有し、前記指令部から前記
走行部へコマンドを送ることにより走行経路を指
定するようになつている移動ロボツトの走行指令
方式において、与えられた有向直線上を前記移動
ロボツトが走行することを基本の動作とし、座標
値XYと、自身及びＸ軸のなす角度値θとを常時
計算し、指定された前記有向直線上を走行するた
めに利用するようにし、前記有向直線の位置、方
向及び向きを変えるコマンドを送ることにより前
記走行経路を任意に指定し得るようにし、現在の
有向直線及び次の有向直線の位置関係を座標変換
を利用したコマンドにより指定するようにすると
共に、前記コマンドが他の走行直線への過渡状態
の遷移点を指示する座標値を含んでいることを特
徴とする移動ロボツトの走行指令方式。２前記指令部からのコマンドにより、前記走行
部が座標値XY，Ｘ軸となす角度θ、あるいは走
行状態を前記指令部へ返答として返信するように
なつている特許請求の範囲第１項に記載の移動ロ
ボツトの走行指令方式。３前記指令部と前記走行部との間で更に通信を
行ないながら前記移動ロボツトが動作し、前記移
動ロボツト自体が走行制御を行なうためのフイー
ドバツク制御時間と、前記指令部からのコマンド
を実行制御するコマンド実行制御時間とが所定時
間ずつ交互に割当てられている特許請求の範囲第
１項に記載の移動ロボツトの走行指令方式。４前記コマンドが、一旦バツフアメモリに蓄積
された後に先着順に実行されるスローコマンド
と、直ちに実行されるフアーストコマンドとで形
成されている特許請求の範囲第３項に記載の記載
の移動ロボツトの走行指令方式。５前記走行部から前記指令部への応答を前記指
令部から応答要求コマンドが送られた場合にのみ
行なうようにした特許請求の範囲第３項に記載の
移動ロボツトの走行指令方式。６前記応答要求コマンドを前記移動ロボツトの
フイードバツク制御時間又はコマンド実行制御時
間の任意時間に伝送できるようになつている特許
請求の範囲第５項に記載の移動ロボツトの走行指
令方式。７前記指令部と前記走行部との間で通信を行な
いながら動作するようになつており、前記走行部
は、走行部自体が走行制御を行うためのフイード
バツク制御モードと、前記指令部からのコマンド
を実行制御するコマンド実行制御モードとを有
し、前記指令部からのコマンドとして前記走行部
の走行直線の位置及び方向を座標変換を用いて指
定し、前記指令部から与えられたコマンドを前記
コマンド実行制御モードで解析し、この解析され
た結果に従つて前記フイードバツク制御モードで
走行制御する特許請求の範囲第１項に記載の移動
ロボツトの走行指令方式。