JP2008191800A - Follow-up vehicle - Google Patents
Follow-up vehicle Download PDFInfo
- Publication number
- JP2008191800A JP2008191800A JP2007023713A JP2007023713A JP2008191800A JP 2008191800 A JP2008191800 A JP 2008191800A JP 2007023713 A JP2007023713 A JP 2007023713A JP 2007023713 A JP2007023713 A JP 2007023713A JP 2008191800 A JP2008191800 A JP 2008191800A
- Authority
- JP
- Japan
- Prior art keywords
- leader
- vehicle
- follow
- following vehicle
- following
- 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
Links
- 230000008859 change Effects 0.000 claims description 12
- 230000001133 acceleration Effects 0.000 abstract description 4
- 238000000034 method Methods 0.000 description 17
- 238000001514 detection method Methods 0.000 description 11
- 238000010586 diagram Methods 0.000 description 5
- 230000008569 process Effects 0.000 description 4
- 238000003825 pressing Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 2
- 238000007689 inspection Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000004091 panning Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Abstract
Description
本発明は、先導者に追従する先導者追従車両に関する。 The present invention relates to a leader following vehicle that follows a leader.
特定の人物(先導者)に追従しつつ走行する先導者追従車両には、特許文献1に記載されているように、先導者との間の距離を計測し、その距離を一定に保ちながら移動するものがあった。
As described in
また、特許文献2に記載されているように、先導者の移動軌跡を記録しておき、その軌跡をトレースしつつ走行したり、追従する際に、先導者の後方ではなく前方を先導者の移動にあわせて走行するものもある。 In addition, as described in Patent Document 2, the movement trajectory of the leader is recorded, and when traveling while following the trajectory or following, the front of the leader is not located behind the leader. Some run along with the movement.
しかしながら、従来技術にあっては、先導者と先導者追従車両との間の距離を一定に保ったり、先導者の移動軌跡をトレースしたりする追従方法が取られていたため、先導者にとって先導者追従車両が存在する方向は必ずしも一定ではなく、先導者が先導者追従車両にアクセスできる先導者追従車両の位置も同様に一定ではなかった。 However, in the prior art, a follow-up method has been adopted in which the distance between the leader and the leader-following vehicle is kept constant or the movement trajectory of the leader is traced. The direction in which the follower vehicle exists is not necessarily constant, and the position of the leader follower vehicle where the leader can access the leader follower vehicle is also not constant.
そのため、追従動作中に、車両に何らかの物品を積載したり、先導者追従車両上の端末を操作したりすることは困難であった。 Therefore, it is difficult to load some articles on the vehicle or operate the terminal on the leader following vehicle during the following operation.
本発明の目的は、頻繁に加減速や走行停止を繰り返すことのない安定した追従を行いながら先導者が先導者追従車両に自由にアクセスでき、先導者追従車両の動きを操作できる先導者追従車両を実現することである。 An object of the present invention is a leader following vehicle in which the leader can freely access the leader following vehicle and can control the movement of the leader following vehicle while performing stable follow without frequently repeating acceleration / deceleration and running stop. Is to realize.
本発明の先導者追従車両は、先導者の進行方向を基準方向とした先導者追従車両の方位及び先導者と先導者追従車両との間の距離をパラメータとして追従制御指示手段により設定し、追従制御指示手段により設定されたパラメータを記憶手段に記憶させ、車両制御手段が、記憶手段に記憶されたパラメータに従って先導者追従車両の先導者追従動作を制御する。 The leader following vehicle of the present invention sets the direction of the leader following vehicle and the distance between the leader and the leader following vehicle with the following direction as the reference direction based on the traveling direction of the leader as parameters, and follows the follow control instruction means. The parameter set by the control instruction means is stored in the storage means, and the vehicle control means controls the leader following operation of the leader following vehicle according to the parameters stored in the storage means.
本発明によれば、先導者からみた先導者追従車両の追従位置を指定することが可能となる。 ADVANTAGE OF THE INVENTION According to this invention, it becomes possible to designate the follow-up position of the leader following vehicle seen from the leader.
さらに、先導者への追従動作を介して、先導者追従車両にとって可能な動きの全てを先導者により操作することができるようになる。 Furthermore, all the possible movements for the leader following vehicle can be operated by the leader through the following action to the leader.
また、頻繁に加減速を繰返したり停止したりすることのない安定した追従が実現され、これらにより、追従動作中にも先導者による先導者追従車両の各部へのアクセスが可能となる。 In addition, stable tracking without repeatedly accelerating or decelerating or stopping is realized, and thereby, it is possible for the leader to access each part of the leading vehicle following the tracking operation.
以下、本発明の実施形態について添付図面を参照して説明する。
(第1の実施形態)
本発明の第1の実施形態を図1〜図8を参照して説明する。
Embodiments of the present invention will be described below with reference to the accompanying drawings.
(First embodiment)
A first embodiment of the present invention will be described with reference to FIGS.
図1は、本発明の第1の実施例形態である先導者追従車両の機能構成図であり、図2は、周囲環境と車両状態の認識手段及び車両の制御手段の配置を説明する図である。 FIG. 1 is a functional configuration diagram of a leader following vehicle according to a first embodiment of the present invention, and FIG. 2 is a diagram for explaining the arrangement of surrounding environment and vehicle state recognition means and vehicle control means. is there.
図1に示すように、先導者追従車両1は、通信装置11、外界センサ12、内界センサ13、環境情報記録装置14、車両状態推定装置15、制御量演算装置16、車両制御装置17、前輪操舵モータ18、後輪駆動モータ19を備えている。
As shown in FIG. 1, the
先導者追従車両1に搭載された外界センサ12、内界センサ13及びそれらの情報を処理する車両状態推定装置15について図2を用いて説明する。図2において、外界センサ12としてパン、チルトが可能なテレビカメラ31、絶対位置検出装置32、先導者追従車両の前方に取り付けられた路肩観測装置33、先導者追従車両の前後左右4箇所に取り付けられた周囲観測装置34、35、36、37を用いている。また、内界センサ13として、エンコーダ41、車両姿勢センサ42、操舵角検出装置43を用いている。
The
図1において、車両状態推定装置15は、外界センサ12、内界センサ13を使用して得たデータから、先導者追従車両1の位置、方位、速度、路肩の位置、障害物の位置を推定するために設けられた装置である。
In FIG. 1, the vehicle state estimation device 15 estimates the position, direction, speed, road shoulder position, and obstacle position of the
図2に示した周囲観測装置34〜37による先導者および障害物の位置検出は、図4に示すように、追従車両1前方の一定範囲内に存在する障害物111、112、113までの相対距離(Ro)114と相対方位(θo)115を検出することで行う。このようにして求めた障害物の位置情報に基づいて、図1に示す制御量演算装置16が障害物を回避するための軌道を作成し、その軌道へ追従する走行制御を行う。
As shown in FIG. 4, the position detection of the leader and the obstacle by the surrounding
図2において、テレビカメラ31は、先導者の認識のほか、先導者および障害物の位置検出の精度を向上させるために用いる。
In FIG. 2, the
路肩観測装置33は、先導者追従車両1の前方の路肩位置を観測する手段である。路肩観測装置33が発見した路肩が、先導者追従車両1に近い場合、路肩観測装置33が求めた路肩の位置情報に基づいて、制御量演算装置16が先導者追従車両1の操舵角を計算し、路肩を避ける方向に操舵する。
The road
車両制御装置17は、制御量演算装置16から出力された車速命令値および操舵命令値に対応した速度で前輪操舵モータ18と後輪駆動モータ19とを回転させる。
The vehicle control device 17 rotates the front
次に、制御量演算装置16について説明する。本発明の第1の実施形態における先導者追従車両1は、先導者に追従するための車両速度、操舵角を演算し、その結果に応じて各モータドライバを含む車両制御装置17により前輪操舵モータ18、後輪駆動モータ19を制御する。
Next, the control amount calculation device 16 will be described. The
環境情報記録装置14は、図1に示すように制御量演算装置16が先導者追従車両1の制御量を演算する際に必要とされる経路情報を記録している。この経路情報には走行許可路面の情報などが含まれ、先導者追従車両1は路肩の場合と同様に走行を許可されていない路面を避けるように走行する。
As shown in FIG. 1, the environmental
この他、制御量演算装置16は、路肩検出装置33、周囲観測装置34、35、36、37で観測して車両状態推定装置15で推定した路肩と障害物の位置に基づいて、路肩および障害物の間を通過することが可能な回避経路を作成する。
In addition, the control amount calculation device 16 is based on the position of the road shoulder and obstacles observed by the road
以上のように、制御量演算装置16は、先導者追従車両1の制御において中心的な役割を担うものであり、先導者追従車両1の制御量演算を行うほかに障害物回避経路を作成する。
As described above, the control amount calculation device 16 plays a central role in the control of the
図3は、先導者追従車両1に搭載され、方位、距離等のパラメータを指定する追従制御指示装置60の概略構成図である。図3において、追従制御指示装置60は、先導者の進行方向を基準方向としてみた車両座標原点の方位と、車両座標原点までの距離を設定する追従方向レバー61及び追従距離設定ボタン64、65と、追従動作の開始及び停止を指示する追従ON−OFFボタン62と、先導者追従車両1による追従目標位置への追従を前進で行うか後進で行うかを切替える追従方向切替ボタン63と、先導者と先導者追従車両1との間の通信装置66と、先導者追従車両1からの情報を音声や表示によって先導者に知らせるスピーカ67及び表示装置68とを備える。
FIG. 3 is a schematic configuration diagram of a follow-up
次に、本発明の第1の実施形態における一連の動作について説明する。 Next, a series of operations in the first embodiment of the present invention will be described.
まず、先導者追従車両1が追従制御を行う追従目標位置は、図5に示すような原点が先導者の現在位置、XL軸が先導者の進行方向として定義された先導者中心座標系103において、距離(d)101、角度(θ)102で、追従制御指示装置60を用いて先導者から指定され、車両制御装置17が備える記憶手段に記憶される。
First, following the target position
このうち、角度102は、追従方向レバー61を倒す方向で指示し、距離101は、追従距離設定ボタン64を押すと大きくなり、追従距離設定ボタン65を押すと小さくなる。ただし、角度102、距離101は、先導者が突然立ち止まった場合にも先導者に追突することなく安全に停止できる距離や、周囲環境のセンシング範囲に制限される。
Of these, the
ここで、先導者の進行方向を表すXL軸は、先導者の向きではなく、先導者の移動軌跡から求めた先導者の移動方向に一致する。これは、先導者中心座標系103のXL軸と先導者の向きとを一致させた場合には、先導者の姿勢の変化により先導者追従車両が加減速を繰返すため、これを防ぐ意味がある。
Here, X L axis representing the traveling direction of the leader is not a leader orientation coincides with the direction of movement of leader determined from the movement locus of the leader. This is because when is matched with the leader of the orientation as X L axis of leader-
また、追従目標位置の指定の際には、先導者追従車両1が先導者に対して前進しながら追従するか、後進しながら追従するかも追従方向切替ボタン63で指定する。前進か後進かを指定できる機能を持たせることで、先導者によって、先導者追従車両にとって可能な動きの全てを操作することが可能となる。これにより、後進させながら先導者追従車両1を車庫に入れることなども可能となる。
Further, when the follow target position is designated, the follow
図6は、第1の実施形態における追従目標位置への追従制御の動作フローチャートである。図6のステップ201では、図5に示すグローバル座標系105での先導者追従車両の位置を取得する。ここで、グローバル座標系105とは、所定固定位置を原点とする座標系であり、例えば、ショッピングセンターや工場内で、そのフロアーの中心位置を原点とする座標系である。グローバル座標位置を参照すれば、例えば、ショッピングセンターや工場内における自己の位置を認識することが可能となる。
FIG. 6 is an operation flowchart of the follow-up control to the follow-up target position in the first embodiment. In
車両状態推定装置15は、先導者追従車両1の起動時に絶対位置検出装置32から先導者追従車両1のグローバル座標系105での初期位置を取得した後、一定時間間隔で測定した先導者追従車両1の車速と車両姿勢センサ42により得た方位から、車両本体1の移動量を演算し、この演算結果に基づいて先導者追従車両1の現在位置を更新する。車両本体の移動制御に際しては、先導者と車両1との間にある地点116を目標追従点として追従していくように行うことができる。
The vehicle state estimation device 15 acquires the initial position in the
なお、先導者追従車両1の現在位置については、絶対位置検出装置32による補正を行う。以上のように、先導者追従車両1は、常に自己位置を把握している。
The current position of the
次に、ステップ202では、外界センサ12で取得した先導者の画像から先導者追従車両1に対する先導者の相対位置を求める。先導者の相対位置は、周囲観測装置34〜37で先導者を観測することで求めることができる。さらに、先導者追従車両1に対する先導者の相対位置に、テレビカメラ31の情報や先導者の体格などに関する事前情報を融合することで、相対位置検出精度を高めることができる。
Next, in
続いて、ステップ203において、グローバル座標系105における先導者の移動軌跡を更新し、先導者中心座標系103からグローバル座標系105への変換を行う。
Subsequently, in
次に、ステップ204では、ステップ203におけるグローバル座標系105への変換を使用して、グローバル座標系105における追従目標位置を計算する。そして、ステップ205で、制御量演算装置16により先導者追従車両1が追従目標位置へ追従するための制御量が算出され、ステップ206で車両制御装置17により前輪操舵モータ18、後輪駆動モータ19を制御する。
Next, in
制御量演算装置16は、先導者追従車両1の現在位置からみた追従目標位置の方向と先導者追従車両1の方位との間の偏差量(Δθ)107と、先導者追従車両1と追従目標位置との間の距離(D)106とに応じて、操舵命令値r。と、車速命令値V。とを演算する。
The control amount calculation device 16 includes a deviation amount (Δθ) 107 between the direction of the tracking target position viewed from the current position of the leading
例えば、簡単に、操舵命令値については、r。=−KθΔθ、車速命令値についてはV。=KdDとすることもできる。ここで、Kθ、Kdは正の定数である。なお、追従方向切替ボタン63を用いて、後進での追従が選択された場合には、図5に示すように、車両座標系を180度回転させた上で、偏差量Δθと距離Dを検出し、r。=KθΔθ、V。=−KdDとする。
For example, simply, r for the steering command value. = −K θ Δθ, V for vehicle speed command value. = K d D. Here, K θ and K d are positive constants. In addition, when reverse tracking is selected using the tracking
各制御サイクルにおいて、操舵命令値γ。及び車速命令値V。が求められ車両制御装置17に伝えられることで追従制御が行われる。ただし、路肩観測装置33が路肩を検知した場合には、路肩の位置情報に基づいて制御量演算装置16が路肩を避けるように操舵角r。を補正する。
Steering command value γ in each control cycle. And vehicle speed command value V. Is obtained and transmitted to the vehicle control device 17 so that follow-up control is performed. However, when the road
以上では、周囲に障害物がなく、先導者が比較的ゆっくりと真っ直ぐに移動しており、先導者追従車両1による先導者への追従動作が周囲の環境によって制限されないケースについて述べた。
In the above, there has been described a case where there are no obstacles in the surroundings, the leader is moving relatively slowly and straightly, and the following operation to the leader by the
次に、周囲の環境、および、先導者の歩行速度等によって、先導者追従車両1が先導者への追従動作を停止する条件を次の(1)から(4)に挙げる。
Next, the following conditions (1) to (4) describe conditions under which the
(1)まず、先導者追従車両1が周囲の障害物に衝突する可能性がある場合について図7に示したフローチャートを参照して説明する。
(1) First, a case where the
周囲観測装置34〜37により車両前方の障害物を検出し(ステップ301)、先導者追従車両1が追従動作を継続することで障害物に衝突する可能性があるか否かを判断しステップ302)、衝突する可能性が無ければ、処理は終了となる(ステップ301に戻る)。
Obstacles in front of the vehicle are detected by the surrounding
ステップ302で、衝突する可能性があると判断した場合は、スピーカ67、表示装置68を用いて先導者に音声や表示等で報知した後(ステップ303)、制御量演算装置16は車両制御装置17に伝える車速命令値を強制的に0とし、先導者追従車両を一旦停止させる(ステップ304)。
When it is determined in
停止した先導者追従車両1は、周囲観測装置34〜37を用いて障害物の位置を再検知する(ステップ305)。続いて、障害物への衝突可能性があるか否かを判断し(ステップ306)、先導者が障害物のない領域方向に進路を変更した場合や障害物が検出されない場合には、追従動作を再開する。再度、衝突可能性のある障害物が検出されれば、ステップ307で障害物の回避経路を発見したか否か、つまり、追従目標位置と先導者追従車両1の位置との間に先導者追従車両1が通過できる経路を探索し、障害物回避経路を見つけたか否かを判断し、見つけた場合には、その経路に沿った障害物回避走行を開始し(ステップ308)、衝突可能性のある障害物の回避後に追従動作に復帰する。
The stopped
ここで、制御量演算装置16は、周囲観測装置34〜37を使用して検出した車両前方所定範囲内の障害物の位置から、障害物を避けて通る経路を求める。なお、ステップ307で障害物回避経路が見つからない場合には、先導者に通知し(ステップ309)、先導者からの開始指示があるまで、先導者追従車両1は停止状態のまま待機する(ステップ310)。このとき、先導者追従車両1が追従可能となる位置まで先導者が移動した上で、追従ON−OFFボタン62を押すことにより追従動作を再開させることができる(ステップ301に戻る)。
Here, the control amount calculation device 16 obtains a route that avoids the obstacle from the position of the obstacle within the predetermined range in front of the vehicle detected by using the
(2)次に、先導者が突然止まり、先導者追従車両1に衝突する可能性がある場合について述べる。
(2) Next, the case where the leader suddenly stops and may collide with the
目標追従位置として先導者の後方を指示され、さらに、先導者が突然立ち止まったときなど先導者追従車両1が先導者に衝突する可能性があると判断された場合にも、先導者追従車両1が先導者に音声等で報知した後、車両1は一旦停止する。そして、先導者追従車両1と先導者との間に距離101以上の距離が開いたときには、追従動作を再開する。
The
(3)次に、先導者が車両走行禁止区域に侵入した場合について述べる。 (3) Next, a case where the leader enters the vehicle travel prohibited area will be described.
先導者が道路から外れて走行禁止領域への先導者追従車両1の進入が車両状態推定装置15によって検出された場合にも、先導者に音声等で報知した後、先導者追従車両1は一旦停止する。そして、追従目標位置が走行禁止領域から離れたときには追従動作を再開する。
Even when the leader deviates from the road and the approach of the
(4)最後に、先導者の歩行速度が、追従限界値を超えた場合について述べる。 (4) Finally, the case where the walking speed of the leader exceeds the tracking limit value will be described.
先導者の歩行速度が速いときや先導者が急に進路を変更したときなど、予め定められた追従限界速度を超えた場合にも、先導者に音声等で報知した後、先導者追従車両1は一旦停止する。その後、追従目標点の移動速度が追従限界速度よりも下回った場合には追従動作を再開する。
Even when the predetermined walking limit speed is exceeded, such as when the leader's walking speed is fast or when the leader suddenly changes the course, the
また、先導者追従車両1が追従限界速度を超えた場合に、上記のように停止させるのではなく、先導者に音声で報知しつつ追従目標位置の軌跡上を追従限界速度で走行してもよい。
In addition, when the
これにより、先導者の歩行速度が比較的速いときに、先導者追従車両が頻繁に停止することを防ぐことができる。 Thereby, when a leader's walking speed is comparatively high, it can prevent that a leader following vehicle stops frequently.
追従動作は、追従ON−OFFボタン62を押すことで解除することができ、その場合、先導者追従車両1はその場で停止する。また、もう一度、追従ON−OFFボタン52を押すことで追従を再開することができる。
The follow-up operation can be canceled by pressing the follow-up ON-
本発明の第1の実施形態によれば、先導者からみた先導者追従車両1の追従位置を指定することが可能となり、さらに、先導者への追従動作を介して、先導者追従車両1にとって可能な動きの全てを先導者により操作することができるようになる。
According to the first embodiment of the present invention, it is possible to specify the follow position of the
したがって、追従動作中にも先導者による先導者追従車両1の各部へのアクセスを実現することが可能となる。このことは、例えば、ショッピングセンターにおいて、図8に示すように、買物客904を先導者とし、買物客904が購入品905を搭載する先導者追従車両903の端末902を操作して商品陳列棚906に陳列された商品901に関する情報を得ながら買い物を楽しむことができる。
Therefore, it is possible to realize access to each part of the
また、工場等において、先導者追従車両に装備された端末を操作しつつ歩きながら、先導者追従車両に搭載された検査装置を用いて製品の検査をすることができる。これにより、検査作業を効率的に実施できるといった効果がある。 Further, in a factory or the like, a product can be inspected using an inspection device mounted on the leader following vehicle while walking while operating a terminal equipped on the leader following vehicle. Thereby, there exists an effect that inspection work can be carried out efficiently.
(第2の実施形態)
次に、本発明の第2の実施形態について、図9、図10、図11を参照して説明する。
(Second Embodiment)
Next, a second embodiment of the present invention will be described with reference to FIG. 9, FIG. 10, and FIG.
まず、図9に示すように、先導者の動きは滑らかな動きの場合もあれば、蛇行して非常に急激な運動をする場合もある。この場合、上述した第1の実施形態による追従方法では、急激な蛇行に応じて先導者追従車両1の車速や方向が頻繁に変わって、頻繁に、走行及び停止を繰返す現象が生じる。
First, as shown in FIG. 9, the movement of the leader may be a smooth movement or may meander and make a very abrupt movement. In this case, in the follow-up method according to the first embodiment described above, the vehicle speed and direction of the leader follow-up
そこで、予め、常に人間の動きを計測する手段を有することで、結果として、先導者の移動軌跡の曲率半径を常時検出して、その変化率を一つの基準として使用する。この基準変化率が閾値以上となったときには、図9における追従方法切替点A151に示すように、従来の追従方法を実行する。これにより、さらに安定した追従動作を実現することができる。 Therefore, by previously having means for always measuring human movement, the radius of curvature of the leader's movement trajectory is always detected, and the rate of change is used as one reference. When the reference change rate is equal to or greater than the threshold value, the conventional tracking method is executed as indicated by the tracking method switching point A151 in FIG. As a result, a more stable follow-up operation can be realized.
また、先導者追従車両1が追従走行をしているうちに、先導者の移動の変動が安定した場合には、追従方法切替点B152に示すように、先導者が指示した追従目標点への追従制御(第1の実施形態と同様な追従制御)に切替える。
Further, when the movement of the leader is stable while the
ここで、上述した、従来の追従方法というのは、図10に示すように、操舵命令値r。、車速命令値V。を、先導者追従車両1から見た先導者の偏差角ΔθL、距離DLを用いて、r。=−KθLΔθL、V。=KdL(DL−dL)と与えるフィードバック則を用いることで、先導者に安定に追従するという制御を実現する。ここで、KθL、KdLは正の定数である。dLは先導者と車両との指定間隔である。
Here, the conventional follow-up method described above is a steering command value r as shown in FIG. , Vehicle speed command value V. Using the deviation angle Δθ L of the leader viewed from the
図11は、上述した動作について説明するフローチャートである。まずは、第1の実施形態と同様に、ステップ401で、グローバル座標系105での先導者追従車両1の位置を取得し、ステップ402で、外界センサ12で取得した先導者の画像から先導者追従車両1に対する先導者の相対位置を求める。
FIG. 11 is a flowchart for explaining the above-described operation. First, as in the first embodiment, in
次に、ステップ403において、グローバル座標系105における先導者の移動軌跡を更新する。そして、ステップ404において、先導者移動軌跡の単位時間当たりの曲率変化量が閾値を超えたか否かを判断する。そして、図9に示した追従方法切替点A151のように、先導者移動軌跡の単位時間当たりの曲率変化量が小さければ、図6のフローチャートと同様に、追従目標点に追従する制御を行い(ステップ405)、ステップ401に戻る。
Next, in
ステップ404において、曲率変化量がある閾値を超えたときには(ステップ404でYESの場合)、第1の実施形態のように停止させるのではなく、先導者と先導者追従車両1との間の距離を一定値dLに保つように操舵角と車速を制御する方法に追従制御方法を切り換える(ステップ406)。そして、ステップ401A、402A、403Aを実行する。
In
例えば、簡単に車両制御装置17に与える操舵命令値r。は、先導者追従車両1の現在位置からみた先導者の方向と先導者追従車両1の進行方位との間の偏差量をΔθLとして、r。=−KθLΔθLとし、車速命令値V。は、先導者追従車両と先導者との間の距離をDLとして、V。=KdL(DL−dL)とする。ここで、KθL、KdLは正の定数である。
For example, the steering command value r simply given to the vehicle control device 17. Is the amount of deviation between the traveling direction of the leader follow the
ステップ403Aを実行した後、ステップ407において、先導者軌跡の単位時間当たりの曲率変化量が閾値を一定時間下回ったか否かを判断する。一定時間、先導者移動軌跡の単位時間当たりの曲率変化量が閾値を下回ったときには、ステップ401に戻り、追従目標点に追従する制御に復帰する(図9の追従方法切替点B152)。
After executing step 403A, in
ステップ407において、先導者移動軌跡の単位時間当たりの曲率変化量が閾値を下回らないときには、ステップ406に戻る。
In
図11に示すような動作制御を行うことにより、頻繁に加減速を繰返したり停止したりすることのない安定した追従を実現することができる。 By performing the operation control as shown in FIG. 11, it is possible to realize stable follow-up without frequently repeating acceleration and deceleration or stopping.
なお、本発明は、上述した例の他、被災地における救助活動用の追従車両や、乗用車に適用することも可能である。乗用車に適用する場合は、車両外に位置する操作者に追従することにより、車庫に入れたり、駐車場へ駐車させることができる。 In addition to the example described above, the present invention can also be applied to a follow-up vehicle for rescue activities in a disaster area or a passenger car. When applied to a passenger car, by following an operator located outside the vehicle, it can be put in a garage or parked in a parking lot.
1・・・追従車両本体、11・・・通信装置(車両本体)、12・・・外界センサ、13・・・内界センサ、14・・・環境情報記録装置、15・・・車両状態推定装置、16・・・制御量演算装置、17・・・車両制御装置、18・・・前輪操舵モータ、19・・・後輪駆動モータ、31・・・テレビカメラ、32・・・絶対位置検出装置、33・・・路肩観測装置、34〜37・・・周囲観測装置、41・・・エンコーダ、42・・・車両姿勢センサ、43・・・操舵角検出装置、51・・・前輪操舵モータ、52・・・後輪駆動モータ、60・・・追従制御指示装置、61・・・追従方向レバー、62・・・追従ON−OFFボタン、63・・・追従方向切替ボタン、64、65・・・追従距離設定ボタン、101・・・先導者から先導者追従車両までの距離、102・・・先導者の進行方向角度θ、103・・・先導者中心座標系、104・・・先導者追従車両中心座標系、105・・・グローバル座標系)、111〜113・・・障害物、114・・・先導者追従車両から障害物までの距離Ro、115・・・先導者追従車両からみた障害物の方向θo、151、152・・・追従方法の切替点
DESCRIPTION OF
Claims (9)
先導者の進行方向を基準方向とした先導者追従車両の方位、及び先導者と先導者追従車両との間の距離をパラメータとして設定する追従制御指示手段と、
上記追従制御指示手段により設定されたパラメータを記憶する記憶手段と、
上記記憶手段に記憶された上記パラメータに従って、上記先導者追従車両の先導者追従動作を制御する車両制御手段と、
を備えることを特徴とする先導者追従車両。 In a leader following vehicle that follows the leader,
Tracking control instruction means for setting the azimuth of the leader following vehicle with the traveling direction of the leader as a reference direction, and the distance between the leader and the leader following vehicle as parameters,
Storage means for storing parameters set by the follow-up control instruction means;
Vehicle control means for controlling the leader following operation of the leader following vehicle according to the parameters stored in the storage means;
A leader following vehicle characterized by comprising:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007023713A JP4351261B2 (en) | 2007-02-02 | 2007-02-02 | Leader following vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007023713A JP4351261B2 (en) | 2007-02-02 | 2007-02-02 | Leader following vehicle |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2008191800A true JP2008191800A (en) | 2008-08-21 |
JP4351261B2 JP4351261B2 (en) | 2009-10-28 |
Family
ID=39751865
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007023713A Active JP4351261B2 (en) | 2007-02-02 | 2007-02-02 | Leader following vehicle |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4351261B2 (en) |
Cited By (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104471624A (en) * | 2012-05-16 | 2015-03-25 | 大陆-特韦斯贸易合伙股份公司及两合公司 | Method and system for autonomous tracking of a following vehicle on the track of a leading vehicle |
WO2017030188A1 (en) * | 2015-08-19 | 2017-02-23 | Cyberdyne株式会社 | Autonomously moving body and operation system for managing inside of facility |
KR101751864B1 (en) * | 2015-09-09 | 2017-06-28 | 선종현 | Smart device for controling unmanned moving object and method for controling unmanned moving object and recording medium storing program for executing the same, and recording medium storing program for executing the same |
WO2018074069A1 (en) * | 2016-10-20 | 2018-04-26 | アイシン精機株式会社 | Mobile body tracking control device |
JP2018085065A (en) * | 2016-11-25 | 2018-05-31 | 株式会社竹中工務店 | Electrically-driven travel base |
JP2019079248A (en) * | 2017-10-24 | 2019-05-23 | アイシン精機株式会社 | Information processing device and program |
JP2019109774A (en) * | 2017-12-19 | 2019-07-04 | 株式会社ダイヘン | Moving object |
WO2019212240A1 (en) * | 2018-05-04 | 2019-11-07 | Lg Electronics Inc. | A plurality of robot cleaner and a controlling method for the same |
KR20190134970A (en) * | 2018-05-04 | 2019-12-05 | 엘지전자 주식회사 | A plurality of robot cleaner and a controlling method for the same |
EP3472030A4 (en) * | 2016-08-17 | 2020-03-11 | Kennesaw State University Research And Service Foundation, Inc. | Vehicle with non-physically coupled sections |
JP2020158032A (en) * | 2019-03-27 | 2020-10-01 | トヨタ自動車株式会社 | Automatic driving system |
TWI733105B (en) * | 2018-05-04 | 2021-07-11 | 南韓商Lg電子股份有限公司 | A plurality of mobile robots and a controlling method for the same |
JP2021108228A (en) * | 2017-03-31 | 2021-07-29 | カシオ計算機株式会社 | Mobile device, method for controlling mobile device and program |
WO2021201163A1 (en) * | 2020-03-31 | 2021-10-07 | 株式会社エクォス・リサーチ | Mobile body control device, mobile body control program, and mobile body |
US11148290B2 (en) | 2018-05-04 | 2021-10-19 | Lg Electronics Inc. | Plurality of robot cleaner and a controlling method for the same |
JP2021536637A (en) * | 2018-09-06 | 2021-12-27 | エルジー エレクトロニクス インコーポレイティドLg Electronics Inc. | Multiple autonomous mobile robots |
US11209829B2 (en) | 2018-06-05 | 2021-12-28 | Kabushiki Kaisha Toyota Jidoshokki | Tracking vehicle control system |
CN113885517A (en) * | 2021-10-26 | 2022-01-04 | 吉林大学 | Luggage carrying vehicle, luggage carrying system and method |
US11409308B2 (en) | 2018-09-06 | 2022-08-09 | Lg Electronics Inc. | Robot cleaner and a controlling method for the same |
US11432697B2 (en) | 2018-09-06 | 2022-09-06 | Lg Electronics Inc. | Robot cleaner and a controlling method for the same |
JP7320565B2 (en) | 2021-07-06 | 2023-08-03 | 株式会社関電工 | Building material transport robot and building material transport system |
-
2007
- 2007-02-02 JP JP2007023713A patent/JP4351261B2/en active Active
Cited By (32)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104471624A (en) * | 2012-05-16 | 2015-03-25 | 大陆-特韦斯贸易合伙股份公司及两合公司 | Method and system for autonomous tracking of a following vehicle on the track of a leading vehicle |
WO2017030188A1 (en) * | 2015-08-19 | 2017-02-23 | Cyberdyne株式会社 | Autonomously moving body and operation system for managing inside of facility |
JPWO2017030188A1 (en) * | 2015-08-19 | 2018-07-05 | Cyberdyne株式会社 | Autonomous mobile and facility management system |
KR101751864B1 (en) * | 2015-09-09 | 2017-06-28 | 선종현 | Smart device for controling unmanned moving object and method for controling unmanned moving object and recording medium storing program for executing the same, and recording medium storing program for executing the same |
EP3472030A4 (en) * | 2016-08-17 | 2020-03-11 | Kennesaw State University Research And Service Foundation, Inc. | Vehicle with non-physically coupled sections |
WO2018074069A1 (en) * | 2016-10-20 | 2018-04-26 | アイシン精機株式会社 | Mobile body tracking control device |
JP2018085065A (en) * | 2016-11-25 | 2018-05-31 | 株式会社竹中工務店 | Electrically-driven travel base |
JP2021108228A (en) * | 2017-03-31 | 2021-07-29 | カシオ計算機株式会社 | Mobile device, method for controlling mobile device and program |
JP2022118200A (en) * | 2017-03-31 | 2022-08-12 | カシオ計算機株式会社 | Mobile device, method for controlling mobile device and program |
JP2019079248A (en) * | 2017-10-24 | 2019-05-23 | アイシン精機株式会社 | Information processing device and program |
JP2019109774A (en) * | 2017-12-19 | 2019-07-04 | 株式会社ダイヘン | Moving object |
JP7018303B2 (en) | 2017-12-19 | 2022-02-10 | 株式会社ダイヘン | Mobile |
WO2019212240A1 (en) * | 2018-05-04 | 2019-11-07 | Lg Electronics Inc. | A plurality of robot cleaner and a controlling method for the same |
US11934200B2 (en) | 2018-05-04 | 2024-03-19 | Lg Electronics Inc. | Plurality of robot cleaner and a controlling method for the same |
TWI733105B (en) * | 2018-05-04 | 2021-07-11 | 南韓商Lg電子股份有限公司 | A plurality of mobile robots and a controlling method for the same |
KR20190134970A (en) * | 2018-05-04 | 2019-12-05 | 엘지전자 주식회사 | A plurality of robot cleaner and a controlling method for the same |
US11148290B2 (en) | 2018-05-04 | 2021-10-19 | Lg Electronics Inc. | Plurality of robot cleaner and a controlling method for the same |
US11150668B2 (en) | 2018-05-04 | 2021-10-19 | Lg Electronics Inc. | Plurality of robot cleaner and a controlling method for the same |
KR102067603B1 (en) | 2018-05-04 | 2020-01-17 | 엘지전자 주식회사 | A plurality of robot cleaner and a controlling method for the same |
US11209829B2 (en) | 2018-06-05 | 2021-12-28 | Kabushiki Kaisha Toyota Jidoshokki | Tracking vehicle control system |
US11432697B2 (en) | 2018-09-06 | 2022-09-06 | Lg Electronics Inc. | Robot cleaner and a controlling method for the same |
JP2021536637A (en) * | 2018-09-06 | 2021-12-27 | エルジー エレクトロニクス インコーポレイティドLg Electronics Inc. | Multiple autonomous mobile robots |
US11409308B2 (en) | 2018-09-06 | 2022-08-09 | Lg Electronics Inc. | Robot cleaner and a controlling method for the same |
JP7165259B2 (en) | 2018-09-06 | 2022-11-02 | エルジー エレクトロニクス インコーポレイティド | Multiple autonomous mobile robots |
US11906979B2 (en) | 2018-09-06 | 2024-02-20 | Lg Electronics Inc. | Plurality of autonomous mobile robots and controlling method for the same |
JP7172794B2 (en) | 2019-03-27 | 2022-11-16 | トヨタ自動車株式会社 | Autonomous driving system |
JP2020158032A (en) * | 2019-03-27 | 2020-10-01 | トヨタ自動車株式会社 | Automatic driving system |
JP2021163216A (en) * | 2020-03-31 | 2021-10-11 | 株式会社エクォス・リサーチ | Moving body control device, moving body control program and moving body |
WO2021201163A1 (en) * | 2020-03-31 | 2021-10-07 | 株式会社エクォス・リサーチ | Mobile body control device, mobile body control program, and mobile body |
JP7232210B2 (en) | 2020-03-31 | 2023-03-02 | 株式会社アイシン | Mobile body control device, mobile body control program, and mobile body |
JP7320565B2 (en) | 2021-07-06 | 2023-08-03 | 株式会社関電工 | Building material transport robot and building material transport system |
CN113885517A (en) * | 2021-10-26 | 2022-01-04 | 吉林大学 | Luggage carrying vehicle, luggage carrying system and method |
Also Published As
Publication number | Publication date |
---|---|
JP4351261B2 (en) | 2009-10-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4351261B2 (en) | Leader following vehicle | |
JP4316477B2 (en) | Tracking method of mobile robot | |
KR101503418B1 (en) | Semiautomatic parking machine | |
EP2251758B1 (en) | Autonomous mobile body, and method and system for controlling the same | |
JP5262855B2 (en) | Parking assistance device and parking assistance method | |
JP5130638B2 (en) | Avoidance operation calculation device, avoidance control device, vehicle including each device, avoidance operation calculation method, and avoidance control method | |
JP4451858B2 (en) | Unmanned vehicle | |
KR101664575B1 (en) | Method to obstacle avoidance for wheeled mobile robots | |
JP6771588B2 (en) | Moving body and control method of moving body | |
KR20100027013A (en) | Autonomously moving robot device and method of the device for avoiding sudden collision | |
JP5366711B2 (en) | Semi-autonomous vehicle remote control system | |
JP2008142841A (en) | Mobile robot | |
US11634118B2 (en) | Parking control method and parking control apparatus | |
WO2017050357A1 (en) | Virtual line-following and retrofit method for autonomous vehicles | |
JP4670807B2 (en) | Travel route creation method, autonomous mobile body, and autonomous mobile body control system | |
JP4552869B2 (en) | Tracking method for moving objects | |
JP2010076488A (en) | Vehicle | |
JP4467533B2 (en) | Folding line following mobile robot and control method of broken line following mobile robot | |
JP2011141663A (en) | Automated guided vehicle and travel control method for the same | |
CN112631269A (en) | Autonomous mobile robot and control program for autonomous mobile robot | |
JP7276471B2 (en) | Vehicle remote control method and vehicle remote control device | |
JP2017151499A (en) | Obstacle avoidance method and device | |
KR101633890B1 (en) | Apparatus and method for controlling navigation based on collision prediction | |
JP2020004144A (en) | Obstacle map generation device and autonomous mobile body | |
JP6399436B2 (en) | Route planning method and apparatus for moving body |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20081031 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20081209 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090206 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20090721 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20090723 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120731 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 4351261 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130731 Year of fee payment: 4 |