JP2704266B2 - 無人搬送車の走行制御装置 - Google Patents
無人搬送車の走行制御装置Info
- Publication number
- JP2704266B2 JP2704266B2 JP63127299A JP12729988A JP2704266B2 JP 2704266 B2 JP2704266 B2 JP 2704266B2 JP 63127299 A JP63127299 A JP 63127299A JP 12729988 A JP12729988 A JP 12729988A JP 2704266 B2 JP2704266 B2 JP 2704266B2
- Authority
- JP
- Japan
- Prior art keywords
- automatic guided
- guided vehicle
- acceleration
- drive
- time
- 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 124
- 238000004364 calculation method Methods 0.000 claims description 25
- 230000008929 regeneration Effects 0.000 claims description 9
- 238000011069 regeneration method Methods 0.000 claims description 9
- 238000010586 diagram Methods 0.000 description 18
- 238000005259 measurement Methods 0.000 description 10
- 238000000034 method Methods 0.000 description 9
- 230000003287 optical effect Effects 0.000 description 7
- 238000012888 cubic function Methods 0.000 description 6
- 230000008859 change Effects 0.000 description 4
- 230000010354 integration Effects 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000009467 reduction Effects 0.000 description 2
- 230000001172 regenerating effect Effects 0.000 description 2
- 239000003638 chemical reducing agent Substances 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000003252 repetitive effect Effects 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
【発明の詳細な説明】 (産業上の利用分野) 本発明は、無人搬送車の走行制御装置に係わり、特に
2点間の走行に関する情報から両者の間の駆動パターン
を生成し、その駆動パターンに基づき無人搬送車を走行
させる制御装置に関する。
2点間の走行に関する情報から両者の間の駆動パターン
を生成し、その駆動パターンに基づき無人搬送車を走行
させる制御装置に関する。
(従来の技術) 従来より、走行路の地図を予め記憶し、走行路の要所
に設置された目標点を検知、あるいは走行距離を演算す
ることにより、前記地図上で自らの位置を確認しながら
走行する無人搬送車がある。この無人搬送車が、目標点
付近から目標点上を通過、あるいは目標の停止位置へ位
置決めする場合、従来は目標位置と無人搬送車との位置
関係から、両者の間の走行経路を、直線と円弧の結合
した軌道、または、クロソイド関数あるいはスプライ
ン関数等の補間関数で表された曲線の軌道として生成
し、生成した軌道上を走行する様に無人搬送車の駆動手
段を制御していた。
に設置された目標点を検知、あるいは走行距離を演算す
ることにより、前記地図上で自らの位置を確認しながら
走行する無人搬送車がある。この無人搬送車が、目標点
付近から目標点上を通過、あるいは目標の停止位置へ位
置決めする場合、従来は目標位置と無人搬送車との位置
関係から、両者の間の走行経路を、直線と円弧の結合
した軌道、または、クロソイド関数あるいはスプライ
ン関数等の補間関数で表された曲線の軌道として生成
し、生成した軌道上を走行する様に無人搬送車の駆動手
段を制御していた。
(発明が解決しようとする問題点) しかし、前記の生成軌道の場合、直線と円弧の結合
点は曲率変化が連続ではなく、従って前記結合点で駆動
手段への駆動指令値が不連続に変化してしまい、駆動手
段が追従することが困難となり、結果的に目標点に到達
できないという問題があった。
点は曲率変化が連続ではなく、従って前記結合点で駆動
手段への駆動指令値が不連続に変化してしまい、駆動手
段が追従することが困難となり、結果的に目標点に到達
できないという問題があった。
また、前記の生成軌道の場合、軌道曲率は連続に変
化するものの、軌道生成には駆動手段の加減速時の能力
を考慮せず、従って車輪の加減速を伴う実走行時には目
標とする軌道上を正確に走行することは困難であった。
さらに、複雑な補間操作に繰り返し演算を含むため、軌
道生成の演算に多大な時間を必要とし、目標位置付近で
の状況に応じた軌道生成をリアルタイムに行うのは困難
があった。
化するものの、軌道生成には駆動手段の加減速時の能力
を考慮せず、従って車輪の加減速を伴う実走行時には目
標とする軌道上を正確に走行することは困難であった。
さらに、複雑な補間操作に繰り返し演算を含むため、軌
道生成の演算に多大な時間を必要とし、目標位置付近で
の状況に応じた軌道生成をリアルタイムに行うのは困難
があった。
本発明は、前記従来技術の問題点に鑑み、曲率変化が
連続、かつ駆動系の能力を考慮した軌道を、リアルタイ
ムで生成することを可能にした無人搬送車の走行制御装
置を提供することを目的とする。
連続、かつ駆動系の能力を考慮した軌道を、リアルタイ
ムで生成することを可能にした無人搬送車の走行制御装
置を提供することを目的とする。
(第1の発明の説明) 本第1発明は、第1図に示すように、無人搬送車が走
行する平面上のX方向に関する無人搬送車の制御開始位
置における位置および速度および加速度情報と、制御終
了位置において無人搬送車がとるべき前記X方向に関す
る位置および速度および加速度情報と、前記X方向とは
異なる方向であるY方向に関する無人搬送車の制御開始
位置における位置および速度および加速度情報と、制御
終了位置において無人搬送車がとるべき前記Y方向に関
する位置および速度および加速度情報と、前記2つの位
置における制御開始および制御終了時刻とを記憶し出力
する走行情報記憶手段Iと;前記X方向について予め定
めた連続な時間関数に基づき、前記走行情報記憶手段I
より出力される前記2つの位置における無人搬送車のX
方向に関する走行情報を用いて、前記2つの位置の間の
X方向の駆動パターンを生成するX方向駆動パターン生
成手段II1と;前記Y方向について予め定めた連続な時
間関数に基づき、前記走行情報記憶手段Iより出力され
る前記2つの位置における無人搬送車のY方向に関する
走行情報を用いて、前記2つの位置の間のY方向の駆動
パターンを生成するY方向駆動パターン生成手段II
2と;無人搬送車の車輪を駆動する駆動手段IVと;前記
X方向およびY方向駆動パターン生成手段II1、II2で各
々生成されたX方向およびY方向の駆動パターンに基づ
き、前記駆動手段IVに対する駆動指令値を演算する駆動
指令値演算手段IIIと、からなり、走行平面上の相異な
るXおよびY方向について、各々独立に定めた時間関数
と2つの位置での走行情報とにより、XおよびY方向の
各々の連続な駆動パターンを生成することにより、目標
となる制御終了位置まで無人搬送車をスムーズに走行さ
せ、かつ目標位置へ精度良く誘導することを特徴とする
無人搬送車の制御装置とからなることを特徴とする。
行する平面上のX方向に関する無人搬送車の制御開始位
置における位置および速度および加速度情報と、制御終
了位置において無人搬送車がとるべき前記X方向に関す
る位置および速度および加速度情報と、前記X方向とは
異なる方向であるY方向に関する無人搬送車の制御開始
位置における位置および速度および加速度情報と、制御
終了位置において無人搬送車がとるべき前記Y方向に関
する位置および速度および加速度情報と、前記2つの位
置における制御開始および制御終了時刻とを記憶し出力
する走行情報記憶手段Iと;前記X方向について予め定
めた連続な時間関数に基づき、前記走行情報記憶手段I
より出力される前記2つの位置における無人搬送車のX
方向に関する走行情報を用いて、前記2つの位置の間の
X方向の駆動パターンを生成するX方向駆動パターン生
成手段II1と;前記Y方向について予め定めた連続な時
間関数に基づき、前記走行情報記憶手段Iより出力され
る前記2つの位置における無人搬送車のY方向に関する
走行情報を用いて、前記2つの位置の間のY方向の駆動
パターンを生成するY方向駆動パターン生成手段II
2と;無人搬送車の車輪を駆動する駆動手段IVと;前記
X方向およびY方向駆動パターン生成手段II1、II2で各
々生成されたX方向およびY方向の駆動パターンに基づ
き、前記駆動手段IVに対する駆動指令値を演算する駆動
指令値演算手段IIIと、からなり、走行平面上の相異な
るXおよびY方向について、各々独立に定めた時間関数
と2つの位置での走行情報とにより、XおよびY方向の
各々の連続な駆動パターンを生成することにより、目標
となる制御終了位置まで無人搬送車をスムーズに走行さ
せ、かつ目標位置へ精度良く誘導することを特徴とする
無人搬送車の制御装置とからなることを特徴とする。
この様な構成を有する本第1発明の作用について説明
する。
する。
走行情報記憶手段Iは、軌道生成による走行制御する
ための制御開始位置および制御終了位置における時刻と
無人搬送車の位置および速度および加速度情報と相異な
るXおよびY方向の2つの方向の各々に関して記憶して
いる。
ための制御開始位置および制御終了位置における時刻と
無人搬送車の位置および速度および加速度情報と相異な
るXおよびY方向の2つの方向の各々に関して記憶して
いる。
X方向駆動パターン生成手段II1は、X方向について
予め定めた連続な時間関数に基づいて、走行情報記憶手
段IからのX方向に関する走行情報、すなわち、制御開
始位置および制御終了位置における無人搬送車の位置、
速度、加速度情報と前記2つの位置での時刻を用いて、
前記2つの位置の間の駆動パターンを時間の関数として
生成する。同時に、Y方向駆動パターン生成手段II2も
X方向駆動パターン生成手段II1と同様にして、予め定
めた連続な時間関数に基づいて、走行情報記憶手段Iか
らのY方向に関する走行情報を用いて、前記2つの位置
の間の駆動パターンを時間関数として生成する。
予め定めた連続な時間関数に基づいて、走行情報記憶手
段IからのX方向に関する走行情報、すなわち、制御開
始位置および制御終了位置における無人搬送車の位置、
速度、加速度情報と前記2つの位置での時刻を用いて、
前記2つの位置の間の駆動パターンを時間の関数として
生成する。同時に、Y方向駆動パターン生成手段II2も
X方向駆動パターン生成手段II1と同様にして、予め定
めた連続な時間関数に基づいて、走行情報記憶手段Iか
らのY方向に関する走行情報を用いて、前記2つの位置
の間の駆動パターンを時間関数として生成する。
駆動指令値演算手段IIIでは、X方向およびY方向駆
動パターン生成手段II1、II2で生成されたX方向および
Y方向の駆動パターンに基づいて、無人搬送車の車輪を
駆動する駆動手段IVに指令を与える。そして駆動手段IV
が、駆動指令値演算手段IIIから与えられる指令値に基
づいて車輪を駆動し、結果として制御開始および制御終
了位置の間の走行経路上を走行し、目標となる位置へ到
達する。
動パターン生成手段II1、II2で生成されたX方向および
Y方向の駆動パターンに基づいて、無人搬送車の車輪を
駆動する駆動手段IVに指令を与える。そして駆動手段IV
が、駆動指令値演算手段IIIから与えられる指令値に基
づいて車輪を駆動し、結果として制御開始および制御終
了位置の間の走行経路上を走行し、目標となる位置へ到
達する。
本第1発明では、制御開始位置および制御終了位置に
おける位置、速度、加速度、時間などの走行情報より、
相異なる2つの方向について、各々連続な時間関数に基
づいて駆動パターンを生成しているため、制御開始位置
より制御終了位置に至る滑らかに時間変化する無人搬送
車の軌道、速度、加速度をリアルタイムに同時に決定す
ることができ、従って無人搬送車を目標とする位置にス
ムーズにかつ正確に到達させることができる。
おける位置、速度、加速度、時間などの走行情報より、
相異なる2つの方向について、各々連続な時間関数に基
づいて駆動パターンを生成しているため、制御開始位置
より制御終了位置に至る滑らかに時間変化する無人搬送
車の軌道、速度、加速度をリアルタイムに同時に決定す
ることができ、従って無人搬送車を目標とする位置にス
ムーズにかつ正確に到達させることができる。
前記第1発明をさらに具体化した、前記X方向駆動パ
ターンは、前記X方向について予め定めた連続な時間関
数の各係数を、前記X方向に関する走行情報すなわちX
方向の前記2つの位置における位置および速度および加
速度情報と、前記2つの位置における時刻とを境界条件
として決定することにより生成されるX方向の加速度の
時間パターンであり;前記Y方向駆動パターンは、前記
Y方向について予め定めた連続な時間関数の各係数を、
前記Y方向に関する走行情報すなわちY方向の前記2つ
の位置における位置および速度および加速度と、前記2
つの位置における時刻とを境界条件として決定すること
により生成されるY方向の加速度の時間パターンであ
り;前記駆動指令値が、前記X方向およびY方向の加速
度および速度の値より決定される無人搬送車の車体速度
および軌道曲率であることを特徴とする第2発明を採用
することができる。
ターンは、前記X方向について予め定めた連続な時間関
数の各係数を、前記X方向に関する走行情報すなわちX
方向の前記2つの位置における位置および速度および加
速度情報と、前記2つの位置における時刻とを境界条件
として決定することにより生成されるX方向の加速度の
時間パターンであり;前記Y方向駆動パターンは、前記
Y方向について予め定めた連続な時間関数の各係数を、
前記Y方向に関する走行情報すなわちY方向の前記2つ
の位置における位置および速度および加速度と、前記2
つの位置における時刻とを境界条件として決定すること
により生成されるY方向の加速度の時間パターンであ
り;前記駆動指令値が、前記X方向およびY方向の加速
度および速度の値より決定される無人搬送車の車体速度
および軌道曲率であることを特徴とする第2発明を採用
することができる。
また、前記第1発明は、第2図に示すように、前記X
方向及びY方向の駆動パターンにより、目標軌道上の無
人搬送車が存在すべき位置を演算する目標軌道演算手段
VI2と;無人搬送車が実際に存在する現在の位置を計測
する位置計測手段Vと;前記位置計測手段Vからの無人
搬送車の現在の位置と前記目標軌道演算手段VI2からの
無人搬送車の目標軌道上の位置との偏差を演算し、該偏
差が予め定めたしきい値を越えた場合に、前記X方向お
よびY方向駆動パターン生成手段II1、II2に各々再生成
指令を出力する比較手段IV1とを具備するとともに、前
記X方向およびY方向駆動パターン生成手段II1、II
2が、前記比較手段VI1からの再生成指令の入力により、
各々X方向およびY方向駆動パターンを再生成すること
を特徴とする第3発明を採用することができる。すなわ
ち、実走行時には、走行床面の凹凸、駆動輪と走行床面
との間の滑り、演算時間による遅れ、積載荷重変化によ
る無人搬送車の走行特性の変化等種々の誤差要因が存在
する。このため生成した駆動パターンによる走行中に、
目標軌道からの誤差が累積する。
方向及びY方向の駆動パターンにより、目標軌道上の無
人搬送車が存在すべき位置を演算する目標軌道演算手段
VI2と;無人搬送車が実際に存在する現在の位置を計測
する位置計測手段Vと;前記位置計測手段Vからの無人
搬送車の現在の位置と前記目標軌道演算手段VI2からの
無人搬送車の目標軌道上の位置との偏差を演算し、該偏
差が予め定めたしきい値を越えた場合に、前記X方向お
よびY方向駆動パターン生成手段II1、II2に各々再生成
指令を出力する比較手段IV1とを具備するとともに、前
記X方向およびY方向駆動パターン生成手段II1、II
2が、前記比較手段VI1からの再生成指令の入力により、
各々X方向およびY方向駆動パターンを再生成すること
を特徴とする第3発明を採用することができる。すなわ
ち、実走行時には、走行床面の凹凸、駆動輪と走行床面
との間の滑り、演算時間による遅れ、積載荷重変化によ
る無人搬送車の走行特性の変化等種々の誤差要因が存在
する。このため生成した駆動パターンによる走行中に、
目標軌道からの誤差が累積する。
本第3発明ではこの誤差を比較手段VI1により検知す
る。すなわち、目標軌道演算手段VI2が演算した無人搬
送車が存在すべき目標軌道上での位置と、位置計測手段
Vが計測した無人搬送車の現在位置との偏差として表わ
し、その偏差が予め定めたしきい値を越えた場合に、比
較手段VI1からX方向およびY方向駆動パターン生成手
段II1、II2へそれぞれ再生成指令が出力される。一方、
X方向およびY方向駆動パターン生成手段II1、II2は、
比較手段VI1から再生成指令が入力されると、その時の
無人搬送車の位置および無人搬送車が到達すべき目標位
置をそれぞれ制御開始位置および制御終了位置として走
行情報記憶手段から新たな走行情報を入力し、その走行
情報に基づいてX方向およびY方向駆動パターンを再生
成する。
る。すなわち、目標軌道演算手段VI2が演算した無人搬
送車が存在すべき目標軌道上での位置と、位置計測手段
Vが計測した無人搬送車の現在位置との偏差として表わ
し、その偏差が予め定めたしきい値を越えた場合に、比
較手段VI1からX方向およびY方向駆動パターン生成手
段II1、II2へそれぞれ再生成指令が出力される。一方、
X方向およびY方向駆動パターン生成手段II1、II2は、
比較手段VI1から再生成指令が入力されると、その時の
無人搬送車の位置および無人搬送車が到達すべき目標位
置をそれぞれ制御開始位置および制御終了位置として走
行情報記憶手段から新たな走行情報を入力し、その走行
情報に基づいてX方向およびY方向駆動パターンを再生
成する。
駆動指令値演算手段IIIおよび駆動手段IVは、再生成
されたX方向およびY方向駆動パターンに基づいて動作
し、その結果無人搬送車は目標軌道上からずれた位置よ
り、到達すべき目標位置へ正確に誘導される。
されたX方向およびY方向駆動パターンに基づいて動作
し、その結果無人搬送車は目標軌道上からずれた位置よ
り、到達すべき目標位置へ正確に誘導される。
本第3発明によれば、X方向およびY方向駆動パター
ンに基づいて制御された実走行中に、種々の誤差要因に
より目標軌道から走行経路がずれても、走行中にX方向
およびY方向駆動パターンを再生成するので、容易に軌
道修正が可能となり、無人搬送車を正確に目標位置へ到
達させることができる。
ンに基づいて制御された実走行中に、種々の誤差要因に
より目標軌道から走行経路がずれても、走行中にX方向
およびY方向駆動パターンを再生成するので、容易に軌
道修正が可能となり、無人搬送車を正確に目標位置へ到
達させることができる。
さらに、前記走行情報記憶手段が、前記2つの位置に
おける時刻を前記2つの位置関係に応じて決定する時間
パラメータ調整手段を有することを特徴とする第4発明
を採用することができる。
おける時刻を前記2つの位置関係に応じて決定する時間
パラメータ調整手段を有することを特徴とする第4発明
を採用することができる。
この時間パラメータ調整手段は、制御開始位置および
制御終了位置における走行情報に応じて、両者における
時刻すなわち制御開始時刻および制御終了時刻を決める
ものである。すなわち、前記時刻を用いてX方向および
Y方向駆動パターン生成手段が生成する駆動パターン
は、制御開始時刻と制御終了時刻との時間間隔を変更す
ることにより、時間に対するパターンの振幅を変えるこ
とができる。従って、例えば制御開始時刻と制御終了時
刻とが比較的接近している場合には、前記時間間隔をよ
り大きく変更することにより、駆動パターンはゆるやか
な変化となり、無人搬送車は急激な駆動を強いられるこ
となくスムーズかつ正確に目標位置に到達することがで
きる。さらに、制御開始時刻または制御終了時刻をX方
向とY方向とで異ならせることにより、無人搬送車が平
面上でX方向またはY方向のみに走行する状態を形成す
ることができ、従って、より正確な目標位置での姿勢制
御を可能にする。
制御終了位置における走行情報に応じて、両者における
時刻すなわち制御開始時刻および制御終了時刻を決める
ものである。すなわち、前記時刻を用いてX方向および
Y方向駆動パターン生成手段が生成する駆動パターン
は、制御開始時刻と制御終了時刻との時間間隔を変更す
ることにより、時間に対するパターンの振幅を変えるこ
とができる。従って、例えば制御開始時刻と制御終了時
刻とが比較的接近している場合には、前記時間間隔をよ
り大きく変更することにより、駆動パターンはゆるやか
な変化となり、無人搬送車は急激な駆動を強いられるこ
となくスムーズかつ正確に目標位置に到達することがで
きる。さらに、制御開始時刻または制御終了時刻をX方
向とY方向とで異ならせることにより、無人搬送車が平
面上でX方向またはY方向のみに走行する状態を形成す
ることができ、従って、より正確な目標位置での姿勢制
御を可能にする。
本第4発明によれば、X方向およびY方向駆動パター
ン生成手段に与える制御開始位置および制御終了位置に
おける走行情報に応じて決定するので、目標位置へ状況
に応じて正確に誘導することができる。
ン生成手段に与える制御開始位置および制御終了位置に
おける走行情報に応じて決定するので、目標位置へ状況
に応じて正確に誘導することができる。
(実施例) 以下図面を参照して、本発明の実施例を詳細に説明す
る。
る。
第1実施例 第1実施例は第2発明をさらに具体化したものであ
る。第3図は、本第1実施例に係わる走行制御装置を適
用した無人搬送車の概略構成図である。
る。第3図は、本第1実施例に係わる走行制御装置を適
用した無人搬送車の概略構成図である。
本実施例の無人搬送車1は、光学式センサ13、14と、
位置計測コンピュータ15と、走行制御位置12と、駆動装
置10、11と、モータ8、9と、減速機6、7と、駆動輪
2、3と、駆動輪2、3と各々同軸に配設した計測輪2
5、25と、計測輪25、25の回転数を検出するエンコーダ2
6、26と、蓄電池20と、キャスタ16、17、18、19とから
なる。
位置計測コンピュータ15と、走行制御位置12と、駆動装
置10、11と、モータ8、9と、減速機6、7と、駆動輪
2、3と、駆動輪2、3と各々同軸に配設した計測輪2
5、25と、計測輪25、25の回転数を検出するエンコーダ2
6、26と、蓄電池20と、キャスタ16、17、18、19とから
なる。
駆動輪2、3は、車体の前後方向の中心軸上にあって
車体の中心から左右に等距離の位置において、車体に固
定されたモータ8、9によりモータ8、9に付設された
減速機6、7および減速機6、7の出力軸4、5を介し
て各々独立に回転駆動され、車体の四隅に配設されたキ
ャスタ16、17、18、19とによって無人車1を平面上のあ
らゆる方向に走行可能としている。
車体の中心から左右に等距離の位置において、車体に固
定されたモータ8、9によりモータ8、9に付設された
減速機6、7および減速機6、7の出力軸4、5を介し
て各々独立に回転駆動され、車体の四隅に配設されたキ
ャスタ16、17、18、19とによって無人車1を平面上のあ
らゆる方向に走行可能としている。
光学式センサ13、14は、車体の前後に配設され、目標
となる停止マークまでの距離を測定する。光学式センサ
を車体前後に配設することにより、無人搬送車1は前後
どちらの方向にも走行制御可能である。
となる停止マークまでの距離を測定する。光学式センサ
を車体前後に配設することにより、無人搬送車1は前後
どちらの方向にも走行制御可能である。
位置計測コンピュータ15は、光学式センサ13、14から
の距離情報と、左右の計測輪25、25の回転数の積算によ
って得られる移動距離とによって目標位置および方位に
対する無人搬送車1の現在の位置、方位を算出する。
の距離情報と、左右の計測輪25、25の回転数の積算によ
って得られる移動距離とによって目標位置および方位に
対する無人搬送車1の現在の位置、方位を算出する。
走行制御装置12は、位置計測コンピュータ15からの無
人搬送車の現在の位置、方位情報に基づいて無人搬送車
の走行軌道を生成し、左右の駆動輪2、3の時々刻々の
速度指令を演算し、駆動装置10、11へ出力する。駆動装
置10、11は走行制御装置12からの速度指令に基づいて、
モータ8、9を回転速度制御する。その結果無人搬送車
1は所定の軌道を走行して目標位置へ到達する。
人搬送車の現在の位置、方位情報に基づいて無人搬送車
の走行軌道を生成し、左右の駆動輪2、3の時々刻々の
速度指令を演算し、駆動装置10、11へ出力する。駆動装
置10、11は走行制御装置12からの速度指令に基づいて、
モータ8、9を回転速度制御する。その結果無人搬送車
1は所定の軌道を走行して目標位置へ到達する。
第4図は、走行制御装置12のシステムブロック図を示
す。走行制御装置12は、走行情報記憶装置24と、X方向
およびY方向加速度生成装置21、22と、時計38と、制御
指令値演算装置23とからなる。なおX方向およびY方向
加速度生成装置21、22はともに同一の構成をなして、各
々X方向およびY方向の情報を扱っており、以下の説明
ではY方向加速度生成装置22については省略する。
す。走行制御装置12は、走行情報記憶装置24と、X方向
およびY方向加速度生成装置21、22と、時計38と、制御
指令値演算装置23とからなる。なおX方向およびY方向
加速度生成装置21、22はともに同一の構成をなして、各
々X方向およびY方向の情報を扱っており、以下の説明
ではY方向加速度生成装置22については省略する。
走行情報記憶装置24は、前記位置計測コンピュータ15
から出力される無人搬送車1の現在位置におけるX方向
の加速度αxs、速度vxs、位置座標xs、時刻txsと、目標
停止位置におけるX方向の加速度αxd、速度vxd、位置
座標xd、時刻txeと、現在位置および目標停止位置にお
けるY方向の加速度αys、αyd、速度vys、vyd、位置座
標ys、yd、時刻tys、tyeとを記憶している。
から出力される無人搬送車1の現在位置におけるX方向
の加速度αxs、速度vxs、位置座標xs、時刻txsと、目標
停止位置におけるX方向の加速度αxd、速度vxd、位置
座標xd、時刻txeと、現在位置および目標停止位置にお
けるY方向の加速度αys、αyd、速度vys、vyd、位置座
標ys、yd、時刻tys、tyeとを記憶している。
X方向加速度生成装置21は、走行情報記憶装置24から
X方向に関する走行情報αxs、αxd、vxs、vxd、xs、
xd、txs、txeを入力し、現在位置から目標位置に到達す
るのに必要な連続な加速度パターンを3次の時間関数fx
(t)として生成するX方向加速度パターン生成器32
と、前記X方向加速度パターン生成器32で生成されたX
方向の加速度パターンfx(t)と時計38より順次出力さ
れる時刻t1とから、時々刻々X方向方向の加速度指令値
αxを出力するX方向加速度演算器36とからなる。
X方向に関する走行情報αxs、αxd、vxs、vxd、xs、
xd、txs、txeを入力し、現在位置から目標位置に到達す
るのに必要な連続な加速度パターンを3次の時間関数fx
(t)として生成するX方向加速度パターン生成器32
と、前記X方向加速度パターン生成器32で生成されたX
方向の加速度パターンfx(t)と時計38より順次出力さ
れる時刻t1とから、時々刻々X方向方向の加速度指令値
αxを出力するX方向加速度演算器36とからなる。
制御指令値演算装置23は、X方向およびY方向加速度
演算器36、37より出力される時々刻々のX方向およびY
方向加速度指令値αx、αyを入力し、時々刻々の車体
速度のベクトル指令値vsdを積分演算するベクトル積分
器39と、X方向およびY方向加速度演算器36、37より出
力されるX方向およびY方向加速度指令値αx、αyと
ベクトル積分器39より出力される車体速度のベクトル指
令値xx、vyとを入力し、無人搬送車の車速|▲▼
|と曲率fdを演算するベクトル演算器40と、ベクトル演
算器40より出力される車速および曲率に基づいて左右の
駆動輪2、3の速度指令値を演算する駆動輪速度演算器
41とからなる。
演算器36、37より出力される時々刻々のX方向およびY
方向加速度指令値αx、αyを入力し、時々刻々の車体
速度のベクトル指令値vsdを積分演算するベクトル積分
器39と、X方向およびY方向加速度演算器36、37より出
力されるX方向およびY方向加速度指令値αx、αyと
ベクトル積分器39より出力される車体速度のベクトル指
令値xx、vyとを入力し、無人搬送車の車速|▲▼
|と曲率fdを演算するベクトル演算器40と、ベクトル演
算器40より出力される車速および曲率に基づいて左右の
駆動輪2、3の速度指令値を演算する駆動輪速度演算器
41とからなる。
無人搬送車1は、前記光学式センサー13、14により目
標停止位置および予め設定された位置に置かれた停止マ
ークを計測する。位置計測コンピュータ15はこのセンサ
情報に基づいて、目標停止位置の位置および方位と現在
の無人搬送車の位置および方位を算出し、走行制御装置
12へ出力する。
標停止位置および予め設定された位置に置かれた停止マ
ークを計測する。位置計測コンピュータ15はこのセンサ
情報に基づいて、目標停止位置の位置および方位と現在
の無人搬送車の位置および方位を算出し、走行制御装置
12へ出力する。
この演算は次のように行う。位置計測コンピュータ15
は、光学式センサ13、14が停止マークを検知すると、予
め記憶しているその停止マークと目標の停止位置および
方位との間の相対的な位置(xm,ym)および方位θmに
基づき、まず線形独立の関係にあるX方向およびY方向
を設定する。この2方向は任意にとることができるが、
本実施例では第5図のような目標停止位置47を原点(0,
0)にとり、停止次の目標方位44を基準となるX軸に、
またX軸に対し90゜の方向45をY軸にとったX−Y直交
座標系を走行平面41上に設定する。なお、以後の実施例
の説明において、単にX方向、Y方向というのは、目標
停止位置において上述第5図に示す方向を言う。
は、光学式センサ13、14が停止マークを検知すると、予
め記憶しているその停止マークと目標の停止位置および
方位との間の相対的な位置(xm,ym)および方位θmに
基づき、まず線形独立の関係にあるX方向およびY方向
を設定する。この2方向は任意にとることができるが、
本実施例では第5図のような目標停止位置47を原点(0,
0)にとり、停止次の目標方位44を基準となるX軸に、
またX軸に対し90゜の方向45をY軸にとったX−Y直交
座標系を走行平面41上に設定する。なお、以後の実施例
の説明において、単にX方向、Y方向というのは、目標
停止位置において上述第5図に示す方向を言う。
次に、無人搬送車1が停止マークの真横に来たとき、
光学式センサ13、14からの距離情報により得られる無人
搬送車1と停止マークとの間の相対的な距離1および方
位角θrとを用いて、無人搬送車の目標停止位置に対す
る現在の位置(xs,ys)および方位θsを次の式により
演算する。
光学式センサ13、14からの距離情報により得られる無人
搬送車1と停止マークとの間の相対的な距離1および方
位角θrとを用いて、無人搬送車の目標停止位置に対す
る現在の位置(xs,ys)および方位θsを次の式により
演算する。
θs=θm+θr xs=xm+1・sin θm ys=ym−1・cos θm さらに、無人搬送車の現在の車体速度vsは、エンコー
ダ26、26からの出力である左右の計測輪25、25の速度v
cL、vcrより、 vs=(vcL+vcr)/2 によって得られる。
ダ26、26からの出力である左右の計測輪25、25の速度v
cL、vcrより、 vs=(vcL+vcr)/2 によって得られる。
従って、XおよびY方向の制御開始位置での速度
vxs、vysは、 vxs=vs・cos θs vys=vs・sin θs で得ることができる。
vxs、vysは、 vxs=vs・cos θs vys=vs・sin θs で得ることができる。
ここで、駆動輪の滑り等による誤差が小さい場合は、
計測輪の速度vcL、vcrのかわりに、左右の駆動輪への速
度指令値vL、vrを用いて次の式で得られる。
計測輪の速度vcL、vcrのかわりに、左右の駆動輪への速
度指令値vL、vrを用いて次の式で得られる。
vxs=((vL+vr)・cos θs)/2 vys=((vL+vr)・sin θs)/2 一方、XおよびY方向の制御開始位置での加速度
αxs、αysは、上記速度vxs、vysの時間微分により得ら
れ、さらに方位の角度誤差が小さい場合には駆動系への
指令値αx、αyを用いることもできる。
αxs、αysは、上記速度vxs、vysの時間微分により得ら
れ、さらに方位の角度誤差が小さい場合には駆動系への
指令値αx、αyを用いることもできる。
次に、走行制御装置12内部の演算手順を示す。
X方向および方向加速度生成装置21、22は、Xおよび
Y方向について無人搬送車が目標停止位置に到達するた
めに必要な加速度を各々演算する。すなわち、X方向加
速度生成装置21は、停止時目標方位方向である、X方向
の加速度を、またY方向の加速度生成装置22では、停止
時目標方位に直交する方向である、Y方向の加速度を演
算する。
Y方向について無人搬送車が目標停止位置に到達するた
めに必要な加速度を各々演算する。すなわち、X方向加
速度生成装置21は、停止時目標方位方向である、X方向
の加速度を、またY方向の加速度生成装置22では、停止
時目標方位に直交する方向である、Y方向の加速度を演
算する。
次にX方向加速度生成装置21での演算手順を示す。
先ず、位置計測コンピュータ15で得られた目標停止位
置47の位置および方位情報と、現在の無人搬送車の位置
および方向情報と、駆動装置10、11が、現在、駆動輪
2、3へ出力している車速とから、X方向加速度パター
ン生成器32で加速度パターン生成を行うためにX−Y直
交座標系上でのX方向44の位置速度情報を得なければな
らない。そのために、走行情報記憶装置24により、X方
向44の無人搬送車の現在のX方向位置座標値xsとX方向
速度vxs、無人搬送車のX方向目標位置座標値xdとX方
向目標速度vxdが演算される。このとき、目標停止位置4
7を原点にとっているため無人搬送車のX方向目標位置
座標値xd=0であり、また、停止時位置決めを行うため
のX方向目標速度vxd=0である。
置47の位置および方位情報と、現在の無人搬送車の位置
および方向情報と、駆動装置10、11が、現在、駆動輪
2、3へ出力している車速とから、X方向加速度パター
ン生成器32で加速度パターン生成を行うためにX−Y直
交座標系上でのX方向44の位置速度情報を得なければな
らない。そのために、走行情報記憶装置24により、X方
向44の無人搬送車の現在のX方向位置座標値xsとX方向
速度vxs、無人搬送車のX方向目標位置座標値xdとX方
向目標速度vxdが演算される。このとき、目標停止位置4
7を原点にとっているため無人搬送車のX方向目標位置
座標値xd=0であり、また、停止時位置決めを行うため
のX方向目標速度vxd=0である。
次に、X方向加速度パターン生成器32で、以上のよう
に求めた走行情報記憶装置24からのX方向の位置速度情
報より、目標位置へ到達するのに必要な連続な加速度パ
ターンを3次の時間関数で生成する。演算は、次のよう
に行う。また、第6図(a)に演算過程を示す。
に求めた走行情報記憶装置24からのX方向の位置速度情
報より、目標位置へ到達するのに必要な連続な加速度パ
ターンを3次の時間関数で生成する。演算は、次のよう
に行う。また、第6図(a)に演算過程を示す。
無人搬送車のX方向加速度パターンを次のような時間
tの三次関数fx(t)で生成する。
tの三次関数fx(t)で生成する。
fx(t)=ax・t3+bx・t2+cx・t+dx 従って、無人搬送車のX方向速度パターンFx(t)
は、前記X方向加速度パターンfx(t)を積分した となる。また、無人搬送車が前記X方向加速度パターン
fx(t)とX方向速度パターンFx(t)に基づいて制御
された場合、その無人搬送車の目標軌道のX方向成分
は、速度パターンFx(t)を積分した となる。ここで、C1、C2は積分定数である。
は、前記X方向加速度パターンfx(t)を積分した となる。また、無人搬送車が前記X方向加速度パターン
fx(t)とX方向速度パターンFx(t)に基づいて制御
された場合、その無人搬送車の目標軌道のX方向成分
は、速度パターンFx(t)を積分した となる。ここで、C1、C2は積分定数である。
無人搬送車は現在の位置方位速度から停止目標位置方
位速度へ連続的に滑らかに走行移動していかなければな
らない。そのため、加速度、速度、位置のパターン関数
fx(t)、Fx(t)、Gx(t)は、制御開始時刻txsか
ら制御終了時刻txeまでを連続的に結合しなければなら
ない。そのために、走行情報記憶装置24から出力される
無人搬送車の現在のX方向位置座標値xsとX方向速度v
xsとX方向加速度αxs及び、無人搬送車のX方向目標位
置座標値xdとX方向目標速度vxdとX方向加速度αxdを
境界条件として、加速度、速度、位置のパタン関数f
x(t)、Fx(t)、Gx(t)を解く。本実施例では、
制御終了時刻t=txs=tyeに無人搬送車は目標停止位置
(xd,yd)=(0,0)に到達する。またこの場合、制御開
始時刻txsに於ける加速度αxs、制御終了時刻txeに於け
る加速度αxsは、加速度パターンfx(t)に連続性を与
えるため、0と設定する。加速度、速度、位置のパター
ン関数fx(t)、Fx(t)、Gx(t)の他の境界条件は
以下のようになる。
位速度へ連続的に滑らかに走行移動していかなければな
らない。そのため、加速度、速度、位置のパターン関数
fx(t)、Fx(t)、Gx(t)は、制御開始時刻txsか
ら制御終了時刻txeまでを連続的に結合しなければなら
ない。そのために、走行情報記憶装置24から出力される
無人搬送車の現在のX方向位置座標値xsとX方向速度v
xsとX方向加速度αxs及び、無人搬送車のX方向目標位
置座標値xdとX方向目標速度vxdとX方向加速度αxdを
境界条件として、加速度、速度、位置のパタン関数f
x(t)、Fx(t)、Gx(t)を解く。本実施例では、
制御終了時刻t=txs=tyeに無人搬送車は目標停止位置
(xd,yd)=(0,0)に到達する。またこの場合、制御開
始時刻txsに於ける加速度αxs、制御終了時刻txeに於け
る加速度αxsは、加速度パターンfx(t)に連続性を与
えるため、0と設定する。加速度、速度、位置のパター
ン関数fx(t)、Fx(t)、Gx(t)の他の境界条件は
以下のようになる。
fx(txs)=αxs=0 fx(txe)=αxe=0 Fx(txs)=vxs Fx(txe)=vxe=0 Gx(txs)=xs Gx(txe)=xd=0 このとき、制御終了時刻txeは、走行情報記憶装置24
より、パラメータとしてX方向加速度パターン生成器32
へ供給される。以上の条件から、6元連立方程式の解と
して、fx(t)の係数ax、bx、cx、dxを算出する。ま
た、同時に、Fx(t)、Gx(t)の各係数も得られる。
より、パラメータとしてX方向加速度パターン生成器32
へ供給される。以上の条件から、6元連立方程式の解と
して、fx(t)の係数ax、bx、cx、dxを算出する。ま
た、同時に、Fx(t)、Gx(t)の各係数も得られる。
一方、Y方向加速度パターン生成器33においても、Y
方向加速度パターンを表す第3次の時間関数fx(t)=
ayt3+byt2+cyt+dyの係数ay、by、cy、dyを走行情報
記憶装置24からのY方向に関する走行情報を境界条件と
して、第6図(b)に示すように、前記X方向加速度パ
ターンの生成と同じ方法で決定する。
方向加速度パターンを表す第3次の時間関数fx(t)=
ayt3+byt2+cyt+dyの係数ay、by、cy、dyを走行情報
記憶装置24からのY方向に関する走行情報を境界条件と
して、第6図(b)に示すように、前記X方向加速度パ
ターンの生成と同じ方法で決定する。
以上から、目標停止位置に到達するまでの必要なX方
向44およびY方向45各々の全時刻の加速度、速度、及び
位置を全て決定したことになる。
向44およびY方向45各々の全時刻の加速度、速度、及び
位置を全て決定したことになる。
次に、X方向およびY方向加速度演算器36、37におい
て、時計38から指示される現在時刻t=t1を、X方向お
よびY方向加速度パターン生成器32、33でそれぞれ求め
た時刻tに関するX方向およびY方向加速度パターンfx
(t)、fy(t)へ代入することにより、目標位置に到
達するために必要な現在の時刻t1に於けるX方向および
Y方向の加速度αx、αyをそれぞれ順次、制御周期毎
に、以下のように演算する。
て、時計38から指示される現在時刻t=t1を、X方向お
よびY方向加速度パターン生成器32、33でそれぞれ求め
た時刻tに関するX方向およびY方向加速度パターンfx
(t)、fy(t)へ代入することにより、目標位置に到
達するために必要な現在の時刻t1に於けるX方向および
Y方向の加速度αx、αyをそれぞれ順次、制御周期毎
に、以下のように演算する。
αx=fx(t1);txs<t1<txe =0 ;t1≧txe αy=fy(t1);tys<t1<tye =0 ;t1≧tye 次に、制御指令値演算装置23は、X方向およびY方向
加速度生成装置21、22で制御周期毎に演算された加速度
指令値αx、αyを、駆動装置10、11に対する制御指令
値へ順次、変換する。その演算手順を以下に示す。
加速度生成装置21、22で制御周期毎に演算された加速度
指令値αx、αyを、駆動装置10、11に対する制御指令
値へ順次、変換する。その演算手順を以下に示す。
先ず、ベクトル積分器39では、X方向およびY方向加
速度演算器36、37により入力された時刻t1に於けるX方
向およびY方向加速度指令値αx、αyから、時刻t1の
車体速度のベクトル指定値(vx、vy)を順次、制御周期
毎に演算する。すなわち、演算は次のようになる。
速度演算器36、37により入力された時刻t1に於けるX方
向およびY方向加速度指令値αx、αyから、時刻t1の
車体速度のベクトル指定値(vx、vy)を順次、制御周期
毎に演算する。すなわち、演算は次のようになる。
また、このとき、前記積分を行う替わりに、X方向お
よびY方向加速度パターン生成器32、33で加速度パター
ン関数fx(t)、fy(t)を求める際に、同時に、その
積分した速度パターン関数Fx(t)、Fx(t)を求めて
おくことが可能である。その場合は、時刻t=t1を速度
パターン関数Fx(t)、Fy(t)に代入することで、車
体速度のベクトル指令値(vx、vy)を次のように直接得
ることができる。
よびY方向加速度パターン生成器32、33で加速度パター
ン関数fx(t)、fy(t)を求める際に、同時に、その
積分した速度パターン関数Fx(t)、Fx(t)を求めて
おくことが可能である。その場合は、時刻t=t1を速度
パターン関数Fx(t)、Fy(t)に代入することで、車
体速度のベクトル指令値(vx、vy)を次のように直接得
ることができる。
vx=Fx(t1) vy=Fy(t1) ベクトル演算器40では、X方向およびY方向加速度パ
ターン生成装置21、22から制御周期毎に順次入力される
X方向およびY方向の加速度指令値αx、αyとベクト
ル演算器40から制御周期毎に順次入力されるX方向およ
びY方向の車体速度指令値vx、vyより、無人搬送車の走
行制御に必要な時刻t1の無人搬送車の車速vsdと曲率半
径の指令値rdを求め、制御周期毎に順次駆動輪速度演算
器41へ出力する。これらの演算手順を、第7図のベクト
ル図を参照して説明する。
ターン生成装置21、22から制御周期毎に順次入力される
X方向およびY方向の加速度指令値αx、αyとベクト
ル演算器40から制御周期毎に順次入力されるX方向およ
びY方向の車体速度指令値vx、vyより、無人搬送車の走
行制御に必要な時刻t1の無人搬送車の車速vsdと曲率半
径の指令値rdを求め、制御周期毎に順次駆動輪速度演算
器41へ出力する。これらの演算手順を、第7図のベクト
ル図を参照して説明する。
先ず、時刻t1に於いて無人搬送車に指令される車体加
速度ベクトル▲▼車速ベクトル▲▼を加速
度指令値αx、αyと車体速度指令値vx、vy、を用いて
次式で定義する。
速度ベクトル▲▼車速ベクトル▲▼を加速
度指令値αx、αyと車体速度指令値vx、vy、を用いて
次式で定義する。
この車体加速度ベクトル▲▼、車速ベクトル▲
▼を用いて、時刻t1の車速の大きさ|▲▼
|、車体横方向速度ベクトル▲▼、曲率半径rdは
次のように演算される。
▼を用いて、時刻t1の車速の大きさ|▲▼
|、車体横方向速度ベクトル▲▼、曲率半径rdは
次のように演算される。
駆動輪速度演算器41では、ベクトル演算器40で制御周
期毎に順次演算される時刻t1での車速の大きさ|▲
▼|と曲率半径rdによって、左と右の駆動輪への速度
指令値vL、vrを演算し、駆動装置10、11へ出力する。無
人搬送車は2輪独立駆動式であるため、曲率半径rd、駆
動輪トレッドw、走行軌道71に対して、第8図に示す幾
何的関係がある。従って、以下のように左右駆動輪速度
指令値vL、vrを演算することができる。
期毎に順次演算される時刻t1での車速の大きさ|▲
▼|と曲率半径rdによって、左と右の駆動輪への速度
指令値vL、vrを演算し、駆動装置10、11へ出力する。無
人搬送車は2輪独立駆動式であるため、曲率半径rd、駆
動輪トレッドw、走行軌道71に対して、第8図に示す幾
何的関係がある。従って、以下のように左右駆動輪速度
指令値vL、vrを演算することができる。
ただし、正負符号の上側は無人搬送車が時計回りに旋
回する場合を示し、下側は無人搬送車が逆時計回りに旋
回する場合を示す。
回する場合を示し、下側は無人搬送車が逆時計回りに旋
回する場合を示す。
以上のように、演算された速度指令値vL、vrを無人搬
送車の走行速度として実現するために、駆動装置10、11
でモータ8、9をフィードバック制御する。このフィー
ドバック信号としては、図に記載されていないが、モー
タ8、9に接続されているタコジェネレータ(以後、T.
G.と呼ぶ)の出力である速度分に比例した電圧を使用
し、サーボ回路で構成した駆動装置10、11は、前記T.G.
の出力電圧により、モータ8、9の速度を制御して、左
右駆動輪速度をvL、vrに一致させる。このモータ8、9
による出力トルクは減速機6、7及び、その出力軸4、
5を介して、駆動輪2、3へ伝達される。以上のような
速度指令値vL、vrを制御周期毎に順次出力し、制御終了
時刻txe、tyeまで続けられる。
送車の走行速度として実現するために、駆動装置10、11
でモータ8、9をフィードバック制御する。このフィー
ドバック信号としては、図に記載されていないが、モー
タ8、9に接続されているタコジェネレータ(以後、T.
G.と呼ぶ)の出力である速度分に比例した電圧を使用
し、サーボ回路で構成した駆動装置10、11は、前記T.G.
の出力電圧により、モータ8、9の速度を制御して、左
右駆動輪速度をvL、vrに一致させる。このモータ8、9
による出力トルクは減速機6、7及び、その出力軸4、
5を介して、駆動輪2、3へ伝達される。以上のような
速度指令値vL、vrを制御周期毎に順次出力し、制御終了
時刻txe、tyeまで続けられる。
第9図に本実施例の走行制御装置による走行軌跡例を
示す。制御開始位置66から制御終了位置63まで前記制御
手段によって、軌道67上を走行させた場合である。この
とき、上述したように停止時目標方位64を基準にとって
X軸62、Y軸63を設定しており、車体68はY軸方向の制
御が終了した場合を表している。図示するように、本実
施例により従来困難であった目標停止位置へ円滑連続に
結合する軌道パターンと速度パターンと加速度パターン
をリアルタイムで生成することを可能とした。また、上
記速度および上記加速度パターンから駆動指令値を生成
することによりスムーズな走行を実現することを可能と
した。以上より、無人搬送車の精度良い停止時位置決め
を可能とする。
示す。制御開始位置66から制御終了位置63まで前記制御
手段によって、軌道67上を走行させた場合である。この
とき、上述したように停止時目標方位64を基準にとって
X軸62、Y軸63を設定しており、車体68はY軸方向の制
御が終了した場合を表している。図示するように、本実
施例により従来困難であった目標停止位置へ円滑連続に
結合する軌道パターンと速度パターンと加速度パターン
をリアルタイムで生成することを可能とした。また、上
記速度および上記加速度パターンから駆動指令値を生成
することによりスムーズな走行を実現することを可能と
した。以上より、無人搬送車の精度良い停止時位置決め
を可能とする。
第2実施例 第10図は、第2実施例のシステムブロック図である。
本第2実施例は前記第1実施例に目標軌道演算器69と比
較器70を付加したもので、上述した第3発明に属するも
のである。すなわち、目標軌道演算器69は、ベクトル積
分器40より、時刻t1におけるX方向およびY方向の速度
指令Vx、Vyを入力し、既に生成された駆動パターンによ
る目標軌道上の現在の時刻t=t1における無人搬送車が
存在すべき位置(xt、yt)および方位θtを演算する。
本第2実施例は前記第1実施例に目標軌道演算器69と比
較器70を付加したもので、上述した第3発明に属するも
のである。すなわち、目標軌道演算器69は、ベクトル積
分器40より、時刻t1におけるX方向およびY方向の速度
指令Vx、Vyを入力し、既に生成された駆動パターンによ
る目標軌道上の現在の時刻t=t1における無人搬送車が
存在すべき位置(xt、yt)および方位θtを演算する。
この演算は、制御を開始した位置(xs,ys)および時
刻txs、tysと車体速度指令値vx、vyとにより次のように
演算する。
刻txs、tysと車体速度指令値vx、vyとにより次のように
演算する。
θt=tan-1(vy/vx) ;Vx≠0 =π/2・sgnVy ;vx=0 このとき、前記積分によって目標軌道上の位置(xt,y
t)を算出するかわりに、X方向およびY方向加速度パ
ターン生成器32、33で加速度パターン関数fx(t)、fy
(t)の各係数を得る際に同時に決定される軌道のパタ
ーン関数Gx(t)に、Gx(t)、時刻t1を代入すること
により、直接、位置(xt,yt)を得ることも可能であ
る。比較器70は、位置計測コンピュータ15によって算出
された時刻t1における無人搬送車が実際に存在する位置
(x,y)および方位θと、目標軌道演算器69からの目標
軌道上の位置(xt,yt)および方位θtとを入力し、両
位置の距離又は両者の方位差がそれぞれのしきい値A、
Bより大きい場合にX方向およびY方向加速度パターン
生成器32、33へ再生成指令を出力する。
t)を算出するかわりに、X方向およびY方向加速度パ
ターン生成器32、33で加速度パターン関数fx(t)、fy
(t)の各係数を得る際に同時に決定される軌道のパタ
ーン関数Gx(t)に、Gx(t)、時刻t1を代入すること
により、直接、位置(xt,yt)を得ることも可能であ
る。比較器70は、位置計測コンピュータ15によって算出
された時刻t1における無人搬送車が実際に存在する位置
(x,y)および方位θと、目標軌道演算器69からの目標
軌道上の位置(xt,yt)および方位θtとを入力し、両
位置の距離又は両者の方位差がそれぞれのしきい値A、
Bより大きい場合にX方向およびY方向加速度パターン
生成器32、33へ再生成指令を出力する。
すなわち、 (x−xt)2+(y−yt)2>A2 又は、 |θ−θt|>B が成立する場合に再生成指令を出力す
る。X方向およびY方向加速度パターン生成器32、33は
再生成指令の入力した時刻を新たな制御開始時刻txs、t
ysとして、第1実施例と同じ操作によりX方向およびY
方向加速度パターンfx(t)、fx(t)を再生成する。
そして、無人搬送車はこの再生成された加速度パターン
に基づき、駆動装置10、11により新たな軌道上を目標位
置まで走行する。
る。X方向およびY方向加速度パターン生成器32、33は
再生成指令の入力した時刻を新たな制御開始時刻txs、t
ysとして、第1実施例と同じ操作によりX方向およびY
方向加速度パターンfx(t)、fx(t)を再生成する。
そして、無人搬送車はこの再生成された加速度パターン
に基づき、駆動装置10、11により新たな軌道上を目標位
置まで走行する。
第11図(a)、(b)に、以上述べた駆動パターンの
生成および再生成による走行制御のフローチャートを示
す。
生成および再生成による走行制御のフローチャートを示
す。
以上のように、目標軌道からの無人搬送車の位置方位
誤差に応じて目標軌道を繰り返し生成し直すことによっ
て、目標停止位置への精度良い停止を実現することがで
きる。これを第12図によって説明する。停止目標位置82
に至る滑らかに結合する目標軌道84をX方向およびY方
向加速度生成装置21、22によって生成する。そして、前
記目標軌道上を走行するように制御指令値演算装置23に
よって駆動指令値が演算され、駆動装置10、11へ送られ
る。ところで、走行床面の凹凸、駆動輪と走行床面との
間の滑り、各種演算時間による遅れ、負荷重量等による
無人搬送車の動特性の変動等の各種誤差要因が存在する
場合には、実際の走行軌道83は目標軌道84からずれ、誤
差を生じてくる。従って、目標軌道84上を走行させるた
めの駆動指令値を全て出力し終えた時点に於て、停止目
標位置に到達できなくなってしまう。それを防ぐため、
比較器70によって目標軌道上の無人搬送車の位置方位と
実際の無人搬送車の位置方位を比較し、その間の差が設
定しきい値を越えた時81に、X方向およびY方向加速度
パターン生成器32、33によって新たに目標軌道85を生成
し直す。それによって、過去の目標軌道84上で生じる可
能性のあった停止目標位置82付近での誤差を消去して、
精度良い停止目標82への制御を可能とする。
誤差に応じて目標軌道を繰り返し生成し直すことによっ
て、目標停止位置への精度良い停止を実現することがで
きる。これを第12図によって説明する。停止目標位置82
に至る滑らかに結合する目標軌道84をX方向およびY方
向加速度生成装置21、22によって生成する。そして、前
記目標軌道上を走行するように制御指令値演算装置23に
よって駆動指令値が演算され、駆動装置10、11へ送られ
る。ところで、走行床面の凹凸、駆動輪と走行床面との
間の滑り、各種演算時間による遅れ、負荷重量等による
無人搬送車の動特性の変動等の各種誤差要因が存在する
場合には、実際の走行軌道83は目標軌道84からずれ、誤
差を生じてくる。従って、目標軌道84上を走行させるた
めの駆動指令値を全て出力し終えた時点に於て、停止目
標位置に到達できなくなってしまう。それを防ぐため、
比較器70によって目標軌道上の無人搬送車の位置方位と
実際の無人搬送車の位置方位を比較し、その間の差が設
定しきい値を越えた時81に、X方向およびY方向加速度
パターン生成器32、33によって新たに目標軌道85を生成
し直す。それによって、過去の目標軌道84上で生じる可
能性のあった停止目標位置82付近での誤差を消去して、
精度良い停止目標82への制御を可能とする。
第3実施例 第3実施例は、走行情報記憶装置24が、制御時間調整
機能を有して、さらに精密な走行制御を行うもので、上
述した第4発明に属するものである。以下図面を参照し
てX方向を例にとって説明する。
機能を有して、さらに精密な走行制御を行うもので、上
述した第4発明に属するものである。以下図面を参照し
てX方向を例にとって説明する。
第13図は本第3実施例の走行制御装置12のシステムブ
ロック図である。
ロック図である。
走行情報記憶装置24は、X方向およびY方向加速度パ
ターン生成器32、33より、既に生成したX方向およびY
方向の加速度パターン関数fx(t)、fy(t)を入力し
て、新たに制御終了時刻txe、tyeを補正演算し、再びX
方向およびY方向加速度パターン生成器32、33へ出力す
る。このとき、走行情報記憶装置24では、駆動手段の駆
動能力の加速度制限内に加速度パターンの最大値および
最小値を抑えるように制御終了時刻txe、tyeを生成し、
駆動手段の動特性が駆動指令値に追従できないことに起
因する軌道ずれを防止するばかりではなく、また無理な
加減速による走行床面と駆動輪との間の滑りや無人搬送
車に加わる遠心力による軌道ずれを防止する。
ターン生成器32、33より、既に生成したX方向およびY
方向の加速度パターン関数fx(t)、fy(t)を入力し
て、新たに制御終了時刻txe、tyeを補正演算し、再びX
方向およびY方向加速度パターン生成器32、33へ出力す
る。このとき、走行情報記憶装置24では、駆動手段の駆
動能力の加速度制限内に加速度パターンの最大値および
最小値を抑えるように制御終了時刻txe、tyeを生成し、
駆動手段の動特性が駆動指令値に追従できないことに起
因する軌道ずれを防止するばかりではなく、また無理な
加減速による走行床面と駆動輪との間の滑りや無人搬送
車に加わる遠心力による軌道ずれを防止する。
前述のようにX方向加速度パターンはX方向加速度パ
ターン生成器32に於て、X方向の制御開始時および制御
終了時に於ける位置、速度、加速度と両者の時刻とか
ら、次のような時間の三次関数fx(t)の係数ax、bx、
cx、dxとして生成される。
ターン生成器32に於て、X方向の制御開始時および制御
終了時に於ける位置、速度、加速度と両者の時刻とか
ら、次のような時間の三次関数fx(t)の係数ax、bx、
cx、dxとして生成される。
fx(t)=ax・t3+bx・t2+cx・t+dx このとき、時間の三次関数fx(t)は制御開始時刻t
xsから制御終了時刻txeまで連続となるように、加速度
についてfx(txs)=0、fx(txe)=0という境界条件
を満たすように生成しているので、時間の三次関数f
x(t)の最大値および最小値は、0か、または、制御
開始時刻txsから制御終了時刻txeまでの間に存在する三
次の時間関数fx(t)の極値fmxである。この極値f
mxは、次のように演算される。
xsから制御終了時刻txeまで連続となるように、加速度
についてfx(txs)=0、fx(txe)=0という境界条件
を満たすように生成しているので、時間の三次関数f
x(t)の最大値および最小値は、0か、または、制御
開始時刻txsから制御終了時刻txeまでの間に存在する三
次の時間関数fx(t)の極値fmxである。この極値f
mxは、次のように演算される。
fmx=ax・tm 3+bx・tm 2+cx・tm +dx このとき、tmは、方程式3ax・tm 2+2bx・tm+cx=0
の解として求められ、 tm={−bx±(bx 2−3・ax・cx)1/2}/(3・ax) である。従って、極値fmxと予め設定された駆動手段に
於ける駆動能力の加速度制限値αmaxが次式を満たすよ
うな制御終了時刻txeを求める。
の解として求められ、 tm={−bx±(bx 2−3・ax・cx)1/2}/(3・ax) である。従って、極値fmxと予め設定された駆動手段に
於ける駆動能力の加速度制限値αmaxが次式を満たすよ
うな制御終了時刻txeを求める。
|fmx|≦αmax この様に求められたX方向の制御終了時刻txeをX方
向加速度パターン生成器32へ出力し、時間の3次関数fx
(t)の係数ax、bx、cx、dxを前記演算方法で生成させ
る。
向加速度パターン生成器32へ出力し、時間の3次関数fx
(t)の係数ax、bx、cx、dxを前記演算方法で生成させ
る。
第14図は、横軸に時間を、縦軸に加速度をとった一定
方向の加速度パターンの一例を表すグラフである。加速
度パターン74は制御開始時刻78から制御終了時刻79まで
連続になるようにX方向又はY方向加速度パターン生成
器32、33で生成させる。このとき、加速度パターンの最
大値75および最小値76は、制御終了時刻79によって決定
される。例えば、制御終了時刻79を早めると、短時間
で、より急激な加速減速を行う必要があるため、加速度
パターンの最大値75および最小値76が、より増大する傾
向が出てくる。また、制御終了時刻79を遅くすると、長
時間で、緩い加速減速を行う必要があるため、加速度パ
ターンの最大値75、最小値76が、より減少する傾向が出
てくる。従って、加速度パターンの最大値75、最小値76
を指定してやることによって、逆に、制御終了時刻79を
決定することが可能となる。本第3実施例は、駆動手段
の能力の制限内77に加速度パターンの最大値75、最小値
76を抑えるように制御終了時刻79を生成している。
方向の加速度パターンの一例を表すグラフである。加速
度パターン74は制御開始時刻78から制御終了時刻79まで
連続になるようにX方向又はY方向加速度パターン生成
器32、33で生成させる。このとき、加速度パターンの最
大値75および最小値76は、制御終了時刻79によって決定
される。例えば、制御終了時刻79を早めると、短時間
で、より急激な加速減速を行う必要があるため、加速度
パターンの最大値75および最小値76が、より増大する傾
向が出てくる。また、制御終了時刻79を遅くすると、長
時間で、緩い加速減速を行う必要があるため、加速度パ
ターンの最大値75、最小値76が、より減少する傾向が出
てくる。従って、加速度パターンの最大値75、最小値76
を指定してやることによって、逆に、制御終了時刻79を
決定することが可能となる。本第3実施例は、駆動手段
の能力の制限内77に加速度パターンの最大値75、最小値
76を抑えるように制御終了時刻79を生成している。
同様に、Y方向制御終了時刻tyeも走行情報記憶手段2
4で生成してY方向加速度パターン生成器33へ出力し、
時間の3次関数fy(t)の係数ay、by、cy、dyを生成さ
せる。
4で生成してY方向加速度パターン生成器33へ出力し、
時間の3次関数fy(t)の係数ay、by、cy、dyを生成さ
せる。
次に、制御指令値演算装置23に於て、X方向およびY
方向加速度演算器36、37で、制御周期毎に演算された信
号を駆動装置10、11への制御指令値へ順次、変換する。
方向加速度演算器36、37で、制御周期毎に演算された信
号を駆動装置10、11への制御指令値へ順次、変換する。
以上のように駆動指令を制御周期毎に順次、制御終了
時刻txe、tyeまで出力し続ければ、滑らかで連続的な軌
道上を走行して、停止時位置決めが可能となる。また、
駆動手段の駆動能力による加速度制限内に加速度パター
ンの最大、最小を抑えているので、駆動手段の動特性が
駆動指令値に追従できないこと起因する軌道ずれを抑え
ることができ、さらに、無理な加減速による走行床面と
駆動輪との間の滑りや無人搬送車に加わる遠心力による
軌道ずれを防止することが可能である。
時刻txe、tyeまで出力し続ければ、滑らかで連続的な軌
道上を走行して、停止時位置決めが可能となる。また、
駆動手段の駆動能力による加速度制限内に加速度パター
ンの最大、最小を抑えているので、駆動手段の動特性が
駆動指令値に追従できないこと起因する軌道ずれを抑え
ることができ、さらに、無理な加減速による走行床面と
駆動輪との間の滑りや無人搬送車に加わる遠心力による
軌道ずれを防止することが可能である。
第4実施例 第4実施例は第4発明に属し、前記第3実施例の走行
情報記憶手段24が有する制御時間調整機能により、X方
向とY方向とで制御終了時刻txe、tyeを異ならせて設定
するものである。以下、演算手順を説明する。
情報記憶手段24が有する制御時間調整機能により、X方
向とY方向とで制御終了時刻txe、tyeを異ならせて設定
するものである。以下、演算手順を説明する。
簡単のためX方向およびY方向制御開始時刻をtxs=t
ys=0とする。
ys=0とする。
また、前記第1実施例と同様に、目標停止位置47を原
点にとり、停止時目標方位44を基準となるX軸に、ま
た、方向45をY軸に設定したX−Y直交座標系を走行平
面41上にとる。無人搬送車を目標停止位置47に於て、目
標停止方向に合わせるためには、先ず、目標停止位置に
到達する以前にまずY方向の誤差を収束させて、その後
X方向軸上を走行させるようにするのが望ましい。その
ためには、Y方向制御開始時刻tyeをX方向制御開始時
刻txeよりも後になるように、即ち、 txe>tye となるように設定する必要がある。これは、次の手順で
実行する。
点にとり、停止時目標方位44を基準となるX軸に、ま
た、方向45をY軸に設定したX−Y直交座標系を走行平
面41上にとる。無人搬送車を目標停止位置47に於て、目
標停止方向に合わせるためには、先ず、目標停止位置に
到達する以前にまずY方向の誤差を収束させて、その後
X方向軸上を走行させるようにするのが望ましい。その
ためには、Y方向制御開始時刻tyeをX方向制御開始時
刻txeよりも後になるように、即ち、 txe>tye となるように設定する必要がある。これは、次の手順で
実行する。
もし、 txe・const<tye ならば、txeの値を、 txe=tye/const とするように置き換える。但し、constは、軌道の形を
決定する定数であり、const<1を満足する様に設定す
る。これによって、Y方向制御開始時刻tyeをX方向制
御開始時刻txeよりも後になるように設定できる。
決定する定数であり、const<1を満足する様に設定す
る。これによって、Y方向制御開始時刻tyeをX方向制
御開始時刻txeよりも後になるように設定できる。
以上のようにX方向、Y方向制御終了時刻txe、tyeを
調整することによって、無人搬送車を停止目標方向に合
うような停止時位置決めが可能になる。
調整することによって、無人搬送車を停止目標方向に合
うような停止時位置決めが可能になる。
次に、制御指令値演算器23において、X方向およびY
方向加速度演算器36、37で、制御周期毎に演算された加
速度指令αx、αyを、駆動装置10、11への制御指令値
に順次、変換する。
方向加速度演算器36、37で、制御周期毎に演算された加
速度指令αx、αyを、駆動装置10、11への制御指令値
に順次、変換する。
以上のように速度指令値vx、vyを制御周期毎に順次、
制御終了時刻txe、tyeまで出力し続ければ、滑らかで連
続的な軌道上を走行して、停止時位置決めが可能とな
る。
制御終了時刻txe、tyeまで出力し続ければ、滑らかで連
続的な軌道上を走行して、停止時位置決めが可能とな
る。
以上のように目標軌道の形を調整し、速度指令値vL、
vrを制御周期毎に順次、制御終了時刻txe、tyeまで出力
し続ければ、滑らかで連続的な軌道上を走行して、か
つ、停止時に於て無人搬送車の車体方向が停止目標横行
に合うような停止時位置決めが可能になる。
vrを制御周期毎に順次、制御終了時刻txe、tyeまで出力
し続ければ、滑らかで連続的な軌道上を走行して、か
つ、停止時に於て無人搬送車の車体方向が停止目標横行
に合うような停止時位置決めが可能になる。
以上を第15図によって説明する。第15図は、無人搬送
車を、制御開始位置86から目標の停止位置87および停止
方位88まで制御した場合の目標軌道の例89、90、91を示
している。目標軌道89は、X方向制御開始時刻txeとY
方向制御開始時刻tyeがほぼ等しい時刻に設定された場
合を示している。修正した目標軌道90は、走行情報記憶
装置24において、定数const<1と置いて、Y方向制御
終了時刻tyeよりもX方向制御終了時刻txeが後になるよ
うに設定した場合を示している。目標軌道89および90を
比較すると、時間パラメータの調整を行った目標軌道90
の方が、停止目標位置よりも手前で無人搬送車の車体方
向が停止目標方向に一致し、停止目標位置方位へ無人搬
送車がより滑らかに連なっている。図示されるように上
記走行制御装置によって、無人搬送車の停止目標位置で
の方位角精度向上が可能となる。
車を、制御開始位置86から目標の停止位置87および停止
方位88まで制御した場合の目標軌道の例89、90、91を示
している。目標軌道89は、X方向制御開始時刻txeとY
方向制御開始時刻tyeがほぼ等しい時刻に設定された場
合を示している。修正した目標軌道90は、走行情報記憶
装置24において、定数const<1と置いて、Y方向制御
終了時刻tyeよりもX方向制御終了時刻txeが後になるよ
うに設定した場合を示している。目標軌道89および90を
比較すると、時間パラメータの調整を行った目標軌道90
の方が、停止目標位置よりも手前で無人搬送車の車体方
向が停止目標方向に一致し、停止目標位置方位へ無人搬
送車がより滑らかに連なっている。図示されるように上
記走行制御装置によって、無人搬送車の停止目標位置で
の方位角精度向上が可能となる。
変形例 次に、無人搬送車の駆動手段として、三輪車を使用し
た場合の変形例を第16図によって示す。三輪の無人搬送
車92は、操蛇輪93をその中心軸94を中心にしてステアリ
ング角θstを切り換え、指令された曲率半径r、中心99
の円弧上を無人搬送車の中心98が通るように制御する。
同時に左駆動輪95、右駆動輪96を指令された車速を実現
する。97は左駆動輪95、右駆動輪96を結ぶ線の中点であ
る。
た場合の変形例を第16図によって示す。三輪の無人搬送
車92は、操蛇輪93をその中心軸94を中心にしてステアリ
ング角θstを切り換え、指令された曲率半径r、中心99
の円弧上を無人搬送車の中心98が通るように制御する。
同時に左駆動輪95、右駆動輪96を指令された車速を実現
する。97は左駆動輪95、右駆動輪96を結ぶ線の中点であ
る。
従って、前記第1実施例において、走行制御装置の演
算を次のように変形することによって、三輪車型無人搬
送車の制御が可能になる。
算を次のように変形することによって、三輪車型無人搬
送車の制御が可能になる。
本変形例では、前記駆動輪速度演算器41での演算を次
のように変更する。ベクトル演算器40によって、制御周
期毎に逐次演算される時刻t1での車速の大きさ|▲
▼|と曲率半径rdによって、操蛇輪93のステアリング
角指令値θstと駆動輪95、96への速度強値vL、vrを以下
に示す手順により演算し、駆動装置へ出力する。
のように変更する。ベクトル演算器40によって、制御周
期毎に逐次演算される時刻t1での車速の大きさ|▲
▼|と曲率半径rdによって、操蛇輪93のステアリング
角指令値θstと駆動輪95、96への速度強値vL、vrを以下
に示す手順により演算し、駆動装置へ出力する。
三輪型無人搬送車は、円弧の中心99を中心として、操
蛇輪94の中心93は半径r1の円弧上を移動し、車体の中心
98は半径rの円弧上を移動し、駆動輪95、96の中点97は
半径r2の円弧上を移動している。従って、ベクトル演算
器40に於て演算された曲率半径rdを車体中心98に於て与
える場合には、次の演算式によって無人搬送車のステア
リング角θstを決定できる。
蛇輪94の中心93は半径r1の円弧上を移動し、車体の中心
98は半径rの円弧上を移動し、駆動輪95、96の中点97は
半径r2の円弧上を移動している。従って、ベクトル演算
器40に於て演算された曲率半径rdを車体中心98に於て与
える場合には、次の演算式によって無人搬送車のステア
リング角θstを決定できる。
θst=tan-1{L1/(rd 2−L2 2)1/2} また、ベクトル演算器40で演算された車速の大きさ|
▲▼|は、そのまま駆動輪95、96への指令速度Vs
とすれば良い。
▲▼|は、そのまま駆動輪95、96への指令速度Vs
とすれば良い。
以上のように、演算された操蛇輪93のステアリング角
指令値θstと駆動輪95、96への速度指令値Vsを制御周期
毎に順次、制御終了時刻txe、tyeまで出力する。
指令値θstと駆動輪95、96への速度指令値Vsを制御周期
毎に順次、制御終了時刻txe、tyeまで出力する。
上記手順によって、三輪型無人搬送車においても、目
標停止位置へ円滑連続に結合する軌道パターンと速度パ
ターンと加速度パターンをリアルタイムで生成すること
ができるので、スムーズな走行を実現でき、精度良い停
止時位置決めを可能としている。
標停止位置へ円滑連続に結合する軌道パターンと速度パ
ターンと加速度パターンをリアルタイムで生成すること
ができるので、スムーズな走行を実現でき、精度良い停
止時位置決めを可能としている。
これ以外にも、上述した発明は、特許請求の範囲の精
神に反しない限りにおいて、幾多の設計変更および付加
変更が可能である。
神に反しない限りにおいて、幾多の設計変更および付加
変更が可能である。
【図面の簡単な説明】 第1図は、第1発明の基本的構成を示すブロック図であ
る。第2図は、第3発明の基本的構成を示すブロック図
である。第3図は、本発明の実施例に係わる無人搬送車
の概略構成図である。第4図は、第1実施例における走
行制御装置のシステムブロック図である。第5図は、制
御開始および制御終了位置とX−Y座標系の関係を示す
図である。第6図は、生成された駆動パターンを示す図
である。第7図は、車体の加速度および速度のベクトル
図である。第8図は、曲率半径と駆動輪トレッドとの関
係を示す図である。第9図は、第1実施例における走行
制御による走行軌跡を示す図である。第10図は、第2実
施例における走行制御装置のシステムブロック図であ
る。第11図は、駆動パターンの生成および再構成による
走行制御動作のフローチャートである。第12図は、第2
実施例における目標軌道と再生成された軌道との関係を
示す図である。第13図は、第3実施例における走行制御
装置のシステムブロック図である。第14図は、制御時間
設定による加速度制限を示す図である。第15図は、第4
実施例における走行軌道を示す図である。第16図は、変
形例における曲率半径と操蛇輪の関係を示す図である。 I……走行情報記憶手段、 II1……X方向駆動パターン生成手段、 II2……Y方向駆動パターン生成手段、 III……駆動指令値演算手段、IV……駆動手段、 V……位置計測手段、VI1……比較手段、 VI2……目標軌道演算手段、 1……無人搬送車、10、11……駆動装置、 12……走行情報記憶装置、 15……位置計測コンピュータ、 21、22……X方向およびY方向加速度パターン生成装
置、 23……駆動指令値演算装置、 24……走行情報記憶装置、 26……エンコーダ、38……時計、 69……目標軌道演算器、70……比較器
る。第2図は、第3発明の基本的構成を示すブロック図
である。第3図は、本発明の実施例に係わる無人搬送車
の概略構成図である。第4図は、第1実施例における走
行制御装置のシステムブロック図である。第5図は、制
御開始および制御終了位置とX−Y座標系の関係を示す
図である。第6図は、生成された駆動パターンを示す図
である。第7図は、車体の加速度および速度のベクトル
図である。第8図は、曲率半径と駆動輪トレッドとの関
係を示す図である。第9図は、第1実施例における走行
制御による走行軌跡を示す図である。第10図は、第2実
施例における走行制御装置のシステムブロック図であ
る。第11図は、駆動パターンの生成および再構成による
走行制御動作のフローチャートである。第12図は、第2
実施例における目標軌道と再生成された軌道との関係を
示す図である。第13図は、第3実施例における走行制御
装置のシステムブロック図である。第14図は、制御時間
設定による加速度制限を示す図である。第15図は、第4
実施例における走行軌道を示す図である。第16図は、変
形例における曲率半径と操蛇輪の関係を示す図である。 I……走行情報記憶手段、 II1……X方向駆動パターン生成手段、 II2……Y方向駆動パターン生成手段、 III……駆動指令値演算手段、IV……駆動手段、 V……位置計測手段、VI1……比較手段、 VI2……目標軌道演算手段、 1……無人搬送車、10、11……駆動装置、 12……走行情報記憶装置、 15……位置計測コンピュータ、 21、22……X方向およびY方向加速度パターン生成装
置、 23……駆動指令値演算装置、 24……走行情報記憶装置、 26……エンコーダ、38……時計、 69……目標軌道演算器、70……比較器
Claims (4)
- 【請求項1】無人搬送車が走行する平面上のX方向に関
する無人搬送車の制御開始位置における位置および速度
および加速度情報と、制御終了位置において無人搬送車
がとるべき前記X方向に関する位置および速度および加
速度情報と、前記X方向とは異なる方向であるY方向に
関する無人搬送車の制御開始位置における位置および速
度および加速度情報と、制御終了位置において無人搬送
車がとるべき前記Y方向に関する位置および速度および
加速度情報と、前記2つの位置における制御開始および
制御終了時刻とを記憶し出力する走行情報記憶手段と、 前記X方向について予め定めた連続な時間関数に基づ
き、前記走行情報記憶手段より出力される前記2つの位
置における無人搬送車のX方向に関する走行情報を用い
て、前記2つの位置の間のX方向の駆動パターンを生成
するX方向駆動パターン生成手段と、 前記Y方向について予め定めた連続な時間関数に基づ
き、前記走行情報記憶手段により出力される前記2つの
位置における無人搬送車のY方向に関する走行情報を用
いて、前記2つの位置の間のY方向の駆動パターンを生
成するY方向駆動パターン生成手段と、 無人搬送車の車輪を駆動する駆動手段と、 前記X方向およびY方向駆動パターン生成手段で各々生
成されたX方向およびY方向の駆動パターンに基づき、
前記駆動手段に対する駆動指令値を演算する駆動指令値
演算手段と、 からなり、走行平面上の相異なるXおよびY方向につい
て、各々独立に定めた時間関数と2つの位置での走行情
報とにより、XおよびY方向の各々の連続な駆動パター
ンを生成することにより、目標となる制御終了位置まで
無人搬送車をスムーズに走行させ、かつ目標位置へ精度
良く誘導することを特徴とする無人搬送車の制御装置。 - 【請求項2】前記X方向駆動パターンは、前記X方向に
ついて予め定めた連続な時間関数の各係数を、前記X方
向に関する走行情報すなわちX方向の前記2つの位置に
おける位置および速度および加速度情報と、前記2つの
位置における時刻とを境界条件として決定することによ
り生成されるX方向の加速度の時間パターンであり、 前記Y方向駆動パターンは、前記Y方向について予め定
めた連続な時間関数を各係数を、前記Y方向に関する走
行情報すなわちY方向の前記2つの位置における位置お
よび速度および加速度と、前記2つの位置における時刻
とを境界条件として決定することにより生成されるY方
向の加速度の時間パターンであり、 前記駆動指令値が、前記X方向およびY方向の加速度お
よび速度の値より決定される無人搬送車の車体速度およ
び軌道曲率であることを特徴とする請求項(1)記載の
無人搬送車の走行制御装置。 - 【請求項3】請求項(1)記載の無人搬送車の走行制御
装置が、 前記X方向及びY方向の駆動パターンより、目標軌道上
の無人搬送車が存在すべき位置を演算する目標軌道演算
手段と、 無人搬送車が実際に存在する現在の位置を計測する位置
計測手段と、 前記位置計測手段からの無人搬送車の現在の位置と前記
目標軌道演算手段からの無人搬送車の目標軌道上の位置
との偏差を演算し、該偏差が予め定めたしきい値を越え
た場合に、前記X方向およびY方向駆動パターン生成手
段に各々再生成指令を出力する比較手段とを具備すると
ともに、前記X方向およびY方向駆動パターン生成手段
が、前記比較手段からの再生成指令の入力により、各々
X方向およびY方向駆動パターンを再生成することを特
徴とする無人搬送車の走行制御装置。 - 【請求項4】前記走行情報記憶手段が、前記2つの位置
における時刻を前記2つの位置関係に応じて決定する時
間パラメータ調整手段を有することを特徴とする請求項
(2)記載の無人搬送車の走行制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP63127299A JP2704266B2 (ja) | 1988-05-25 | 1988-05-25 | 無人搬送車の走行制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP63127299A JP2704266B2 (ja) | 1988-05-25 | 1988-05-25 | 無人搬送車の走行制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH01296318A JPH01296318A (ja) | 1989-11-29 |
JP2704266B2 true JP2704266B2 (ja) | 1998-01-26 |
Family
ID=14956526
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP63127299A Expired - Fee Related JP2704266B2 (ja) | 1988-05-25 | 1988-05-25 | 無人搬送車の走行制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2704266B2 (ja) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2696724B2 (ja) * | 1990-02-27 | 1998-01-14 | 株式会社小松製作所 | 走行車両の自動走行システム |
JP2010134961A (ja) * | 1998-02-13 | 2010-06-17 | Komatsu Ltd | 車両の誘導装置 |
JP4737179B2 (ja) | 2007-11-02 | 2011-07-27 | トヨタ自動車株式会社 | 車両制御装置及び車両制御方法 |
US10048692B2 (en) | 2013-12-12 | 2018-08-14 | Hitachi Construction Machinery Co., Ltd. | Vehicle travel system |
JP2016120896A (ja) * | 2014-12-25 | 2016-07-07 | 株式会社アドヴィックス | 車両の走行制御装置 |
CN111399489B (zh) * | 2018-12-14 | 2023-08-04 | 北京京东乾石科技有限公司 | 用于生成信息的方法和装置 |
JP7294179B2 (ja) * | 2020-02-18 | 2023-06-20 | 株式会社豊田自動織機 | 自律移動体 |
-
1988
- 1988-05-25 JP JP63127299A patent/JP2704266B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JPH01296318A (ja) | 1989-11-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2572968B2 (ja) | 自律走行車の誘導方法 | |
KR100903665B1 (ko) | 가가속도 정보를 이용한 차량의 운동 제어장치 | |
JP4760162B2 (ja) | 移動台車の制御方法及び移動台車 | |
Borenstein et al. | Motion control analysis of a mobile robot | |
CN109144078B (zh) | 一种基于二维码导航共线双舵轮agv路线纠偏方法及*** | |
CN111497637B (zh) | 一种四舵轮agv的运动控制方法 | |
JPH0646364B2 (ja) | 自律走行車の誘導方法 | |
KR20060049149A (ko) | 이동 로봇 | |
KR101915887B1 (ko) | 주행 장치, 주행 장치의 제어 방법, 및 주행 장치의 제어 프로그램 | |
JPH05170120A (ja) | 車両のヨー運動量検出装置及びその方法、並びにこれを利用した車両の運動制御装置 | |
JP3266747B2 (ja) | 車両の誘導走行制御装置 | |
CN110244718B (zh) | 一种可自动避障的巡视智能小车 | |
JP2704266B2 (ja) | 無人搬送車の走行制御装置 | |
JPH0895638A (ja) | 移動作業ロボットの走行制御装置 | |
JP5907037B2 (ja) | 移動体 | |
JP3267323B2 (ja) | 無人車の制御装置 | |
JPH075922A (ja) | 無人作業車の操舵制御方法 | |
JP3034121B2 (ja) | 無人車の制御装置 | |
JPH07284938A (ja) | 升目溶接ロボット | |
JP2000153988A (ja) | 無軌道路面走行体およびコンテナターミナル | |
JPH0591607A (ja) | 車輪駆動モータの制御装置 | |
JP3952548B2 (ja) | 無人走行車の制御方法及びその装置 | |
JP4135158B2 (ja) | 車両の前後輪舵角制御装置 | |
JPH0144606B2 (ja) | ||
KR20010099139A (ko) | 고속회전아크센서를 적용한 격자형 용접로봇의 주행 및토치 슬라이더 제어 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
LAPS | Cancellation because of no payment of annual fees |