JP2008191800A - Follow-up vehicle - Google Patents

Follow-up vehicle Download PDF

Info

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
Application number
JP2007023713A
Other languages
Japanese (ja)
Other versions
JP4351261B2 (en
Inventor
Yukihiko Ono
幸彦 小野
Yuji Hosoda
祐司 細田
Osamu Akimoto
修 秋本
Masayuki Oshiro
昌之 大城
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.)
Hitachi Ltd
Original Assignee
Hitachi Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Hitachi Ltd filed Critical Hitachi Ltd
Priority to JP2007023713A priority Critical patent/JP4351261B2/en
Publication of JP2008191800A publication Critical patent/JP2008191800A/en
Application granted granted Critical
Publication of JP4351261B2 publication Critical patent/JP4351261B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

<P>PROBLEM TO BE SOLVED: To provide a follow-up vehicle allowing a leading person to freely access the follow-up vehicle during stable follow-up operation wherein acceleration/deceleration or stop is not frequently repeated and to control motion of the follow-up vehicle. <P>SOLUTION: A target follow-up position for the follow-up control of follow-up vehicle 1 is designated from the leading person by use of a follow-up control designation device with a distance 101 and an angle 102 in a leading-person central coordinate system 103 wherein the origin is defined as a present position of the leading-person and wherein an X<SB>L</SB>axis is defined as a travel direction of the leading person. The angle 102 and the distance 101 are limited within a range of sensing surroundings or a distance allowing a safe stop without colliding the person from behind even when the person suddenly stops. When specifying the target follow-up position, it is also specified whether the vehicle 1 follows the person forward or backward. The forward or backward motion is specified, so that all the possible motion of the follow-up vehicle can be operated. <P>COPYRIGHT: (C)2008,JPO&INPIT

Description

本発明は、先導者に追従する先導者追従車両に関する。   The present invention relates to a leader following vehicle that follows a leader.

特定の人物(先導者)に追従しつつ走行する先導者追従車両には、特許文献1に記載されているように、先導者との間の距離を計測し、その距離を一定に保ちながら移動するものがあった。   As described in Patent Document 1, a vehicle following a specific person (leader) travels while measuring the distance to the leader and keeps the distance constant. There was something to do.

また、特許文献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.

特開2006−134221号公報JP 2006-134221 A 特開2006−48666号公報JP 2006-48666 A

しかしながら、従来技術にあっては、先導者と先導者追従車両との間の距離を一定に保ったり、先導者の移動軌跡をトレースしたりする追従方法が取られていたため、先導者にとって先導者追従車両が存在する方向は必ずしも一定ではなく、先導者が先導者追従車両にアクセスできる先導者追従車両の位置も同様に一定ではなかった。   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 leader following vehicle 1 includes a communication device 11, an external sensor 12, an internal sensor 13, an environment information recording device 14, a vehicle state estimation device 15, a control amount calculation device 16, a vehicle control device 17, A front wheel steering motor 18 and a rear wheel drive motor 19 are provided.

先導者追従車両1に搭載された外界センサ12、内界センサ13及びそれらの情報を処理する車両状態推定装置15について図2を用いて説明する。図2において、外界センサ12としてパン、チルトが可能なテレビカメラ31、絶対位置検出装置32、先導者追従車両の前方に取り付けられた路肩観測装置33、先導者追従車両の前後左右4箇所に取り付けられた周囲観測装置34、35、36、37を用いている。また、内界センサ13として、エンコーダ41、車両姿勢センサ42、操舵角検出装置43を用いている。   The outside world sensor 12, the inside world sensor 13 and the vehicle state estimation device 15 that process the information mounted on the leader following vehicle 1 will be described with reference to FIG. In FIG. 2, a TV camera 31 capable of panning and tilting as an external sensor 12, an absolute position detection device 32, a road shoulder observation device 33 attached in front of the leader following vehicle, and attached to four places on the front, rear, left and right of the leader following vehicle. The surrounding observation devices 34, 35, 36, and 37 are used. Further, as the inner sensor 13, an encoder 41, a vehicle attitude sensor 42, and a steering angle detection device 43 are used.

図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 leader following vehicle 1 from data obtained by using the external sensor 12 and the internal sensor 13. It is a device provided to do.

図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 observation devices 34 to 37 shown in FIG. 2 is relative to the obstacles 111, 112, 113 existing in a certain range in front of the following vehicle 1. This is performed by detecting the distance (Ro) 114 and the relative orientation (θo) 115. Based on the position information of the obstacle thus obtained, the control amount calculation device 16 shown in FIG. 1 creates a track for avoiding the obstacle and performs traveling control to follow the track.

図2において、テレビカメラ31は、先導者の認識のほか、先導者および障害物の位置検出の精度を向上させるために用いる。   In FIG. 2, the television camera 31 is used to improve the accuracy of the position detection of the leader and obstacles in addition to the recognition of the leader.

路肩観測装置33は、先導者追従車両1の前方の路肩位置を観測する手段である。路肩観測装置33が発見した路肩が、先導者追従車両1に近い場合、路肩観測装置33が求めた路肩の位置情報に基づいて、制御量演算装置16が先導者追従車両1の操舵角を計算し、路肩を避ける方向に操舵する。   The road shoulder observation device 33 is means for observing the road shoulder position ahead of the leader following vehicle 1. When the road shoulder discovered by the road shoulder observation device 33 is close to the leader following vehicle 1, the control amount calculation device 16 calculates the steering angle of the leader following vehicle 1 based on the road shoulder position information obtained by the road shoulder observation device 33. Steer in a direction that avoids the shoulder.

車両制御装置17は、制御量演算装置16から出力された車速命令値および操舵命令値に対応した速度で前輪操舵モータ18と後輪駆動モータ19とを回転させる。   The vehicle control device 17 rotates the front wheel steering motor 18 and the rear wheel drive motor 19 at a speed corresponding to the vehicle speed command value and the steering command value output from the control amount calculation device 16.

次に、制御量演算装置16について説明する。本発明の第1の実施形態における先導者追従車両1は、先導者に追従するための車両速度、操舵角を演算し、その結果に応じて各モータドライバを含む車両制御装置17により前輪操舵モータ18、後輪駆動モータ19を制御する。   Next, the control amount calculation device 16 will be described. The leader following vehicle 1 according to the first embodiment of the present invention calculates a vehicle speed and a steering angle for following the leader, and a front wheel steering motor by a vehicle control device 17 including each motor driver according to the result. 18. Control the rear wheel drive motor 19.

環境情報記録装置14は、図1に示すように制御量演算装置16が先導者追従車両1の制御量を演算する際に必要とされる経路情報を記録している。この経路情報には走行許可路面の情報などが含まれ、先導者追従車両1は路肩の場合と同様に走行を許可されていない路面を避けるように走行する。   As shown in FIG. 1, the environmental information recording device 14 records route information required when the control amount calculation device 16 calculates the control amount of the leader following vehicle 1. This route information includes information on the travel-permitted road surface, etc., and the leader following vehicle 1 travels so as to avoid a road surface that is not permitted to travel as in the case of the road shoulder.

この他、制御量演算装置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 shoulder detection device 33 and the surrounding observation devices 34, 35, 36, and 37 and estimated by the vehicle state estimation device 15. Create an avoidance route that can pass between objects.

以上のように、制御量演算装置16は、先導者追従車両1の制御において中心的な役割を担うものであり、先導者追従車両1の制御量演算を行うほかに障害物回避経路を作成する。   As described above, the control amount calculation device 16 plays a central role in the control of the leader following vehicle 1 and creates an obstacle avoidance route in addition to performing the control amount calculation of the leader following vehicle 1. .

図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 control instruction device 60 that is mounted on the leader follow-up vehicle 1 and designates parameters such as direction and distance. In FIG. 3, the follow-up control instruction device 60 includes a follow-up direction lever 61 and follow-up distance setting buttons 64 and 65 for setting the azimuth of the vehicle coordinate origin when the leader's traveling direction is a reference direction, and the distance to the vehicle coordinate origin. A tracking ON / OFF button 62 for instructing start and stop of the tracking operation, a tracking direction switching button 63 for switching whether the tracking of the tracking target position by the leading tracking vehicle 1 is performed forward or backward, and a leader And a communication device 66 between the vehicle and the leader following vehicle 1, and a speaker 67 and a display device 68 that inform the leader of information from the leader following vehicle 1 by voice or display.

次に、本発明の第1の実施形態における一連の動作について説明する。   Next, a series of operations in the first embodiment of the present invention will be described.

まず、先導者追従車両1が追従制御を行う追従目標位置は、図5に示すような原点が先導者の現在位置、X軸が先導者の進行方向として定義された先導者中心座標系103において、距離(d)101、角度(θ)102で、追従制御指示装置60を用いて先導者から指定され、車両制御装置17が備える記憶手段に記憶される。 First, following the target position leader following vehicle 1 performs the following control, the current position of the origin as shown in FIG. 5 leader, leader X L axis is defined as the traveling direction of the leader-centered coordinate system 103 The distance (d) 101 and the angle (θ) 102 are designated by the leader using the follow-up control instruction device 60 and stored in the storage means included in the vehicle control device 17.

このうち、角度102は、追従方向レバー61を倒す方向で指示し、距離101は、追従距離設定ボタン64を押すと大きくなり、追従距離設定ボタン65を押すと小さくなる。ただし、角度102、距離101は、先導者が突然立ち止まった場合にも先導者に追突することなく安全に停止できる距離や、周囲環境のセンシング範囲に制限される。   Of these, the angle 102 is designated in the direction in which the follow direction lever 61 is tilted, and the distance 101 increases when the follow distance setting button 64 is pressed, and decreases when the follow distance setting button 65 is pressed. However, the angle 102 and the distance 101 are limited to a distance that can be safely stopped without colliding with the leader even when the leader suddenly stops, and a sensing range of the surrounding environment.

ここで、先導者の進行方向を表すX軸は、先導者の向きではなく、先導者の移動軌跡から求めた先導者の移動方向に一致する。これは、先導者中心座標系103のX軸と先導者の向きとを一致させた場合には、先導者の姿勢の変化により先導者追従車両が加減速を繰返すため、これを防ぐ意味がある。 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-centered coordinate system 103, to repeat the leader follow the vehicle acceleration and deceleration by the change of leader in position, meaning to prevent this is there.

また、追従目標位置の指定の際には、先導者追従車両1が先導者に対して前進しながら追従するか、後進しながら追従するかも追従方向切替ボタン63で指定する。前進か後進かを指定できる機能を持たせることで、先導者によって、先導者追従車両にとって可能な動きの全てを操作することが可能となる。これにより、後進させながら先導者追従車両1を車庫に入れることなども可能となる。   Further, when the follow target position is designated, the follow direction switching button 63 designates whether the leader follow vehicle 1 follows the leader while moving forward or follows backward. By providing a function that can specify whether the vehicle is moving forward or backward, it is possible for the leader to operate all possible movements for the leader following vehicle. Thereby, it is also possible to put the leader following vehicle 1 into the garage while moving backward.

図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 step 201 of FIG. 6, the position of the leader following vehicle in the global coordinate system 105 shown in FIG. 5 is acquired. Here, the global coordinate system 105 is a coordinate system having a predetermined fixed position as an origin, and is, for example, a coordinate system having the center position of the floor as an origin in a shopping center or factory. By referring to the global coordinate position, for example, it is possible to recognize its own position in a shopping center or a factory.

車両状態推定装置15は、先導者追従車両1の起動時に絶対位置検出装置32から先導者追従車両1のグローバル座標系105での初期位置を取得した後、一定時間間隔で測定した先導者追従車両1の車速と車両姿勢センサ42により得た方位から、車両本体1の移動量を演算し、この演算結果に基づいて先導者追従車両1の現在位置を更新する。車両本体の移動制御に際しては、先導者と車両1との間にある地点116を目標追従点として追従していくように行うことができる。   The vehicle state estimation device 15 acquires the initial position in the global coordinate system 105 of the leader follower vehicle 1 from the absolute position detection device 32 when the leader follower vehicle 1 is started, and then measures the leader follower vehicle measured at regular time intervals. The movement amount of the vehicle main body 1 is calculated from the vehicle speed of 1 and the orientation obtained by the vehicle attitude sensor 42, and the current position of the leader following vehicle 1 is updated based on the calculation result. In the movement control of the vehicle main body, it is possible to follow the point 116 between the leader and the vehicle 1 as a target follow-up point.

なお、先導者追従車両1の現在位置については、絶対位置検出装置32による補正を行う。以上のように、先導者追従車両1は、常に自己位置を把握している。   The current position of the leader following vehicle 1 is corrected by the absolute position detection device 32. As described above, the leader following vehicle 1 always grasps its own position.

次に、ステップ202では、外界センサ12で取得した先導者の画像から先導者追従車両1に対する先導者の相対位置を求める。先導者の相対位置は、周囲観測装置34〜37で先導者を観測することで求めることができる。さらに、先導者追従車両1に対する先導者の相対位置に、テレビカメラ31の情報や先導者の体格などに関する事前情報を融合することで、相対位置検出精度を高めることができる。   Next, in step 202, the relative position of the leader with respect to the leader following vehicle 1 is obtained from the image of the leader acquired by the external sensor 12. The relative position of the leader can be obtained by observing the leader with the surrounding observation devices 34 to 37. Furthermore, the relative position detection accuracy can be improved by fusing the information on the television camera 31 and the prior information on the physique of the leader, etc., with the relative position of the leader with respect to the leader following vehicle 1.

続いて、ステップ203において、グローバル座標系105における先導者の移動軌跡を更新し、先導者中心座標系103からグローバル座標系105への変換を行う。   Subsequently, in step 203, the movement trajectory of the leader in the global coordinate system 105 is updated, and conversion from the leader center coordinate system 103 to the global coordinate system 105 is performed.

次に、ステップ204では、ステップ203におけるグローバル座標系105への変換を使用して、グローバル座標系105における追従目標位置を計算する。そして、ステップ205で、制御量演算装置16により先導者追従車両1が追従目標位置へ追従するための制御量が算出され、ステップ206で車両制御装置17により前輪操舵モータ18、後輪駆動モータ19を制御する。   Next, in step 204, the follow target position in the global coordinate system 105 is calculated using the transformation to the global coordinate system 105 in step 203. In step 205, a control amount for the leader following vehicle 1 to follow the follow target position is calculated by the control amount calculation device 16, and in step 206, the front wheel steering motor 18 and the rear wheel drive motor 19 are calculated by the vehicle control device 17. To control.

制御量演算装置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 vehicle 1 and the direction of the leading vehicle 1, the leading vehicle 1 and the tracking target. The steering command value r according to the distance (D) 106 between the position and the position. And the vehicle speed command value V. And

例えば、簡単に、操舵命令値については、r。=−KθΔθ、車速命令値についてはV。=KDとすることもできる。ここで、Kθ、Kは正の定数である。なお、追従方向切替ボタン63を用いて、後進での追従が選択された場合には、図5に示すように、車両座標系を180度回転させた上で、偏差量Δθと距離Dを検出し、r。=KθΔθ、V。=−KDとする。 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 direction switch button 63, the deviation amount Δθ and the distance D are detected after the vehicle coordinate system is rotated 180 degrees as shown in FIG. And r. = K θ Δθ, V. = −K d D.

各制御サイクルにおいて、操舵命令値γ。及び車速命令値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 shoulder observation device 33 detects the road shoulder, the steering angle r is set so that the control amount calculation device 16 avoids the road shoulder based on the position information of the road shoulder. Correct.

以上では、周囲に障害物がなく、先導者が比較的ゆっくりと真っ直ぐに移動しており、先導者追従車両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 leader following vehicle 1 is not limited by the surrounding environment.

次に、周囲の環境、および、先導者の歩行速度等によって、先導者追従車両1が先導者への追従動作を停止する条件を次の(1)から(4)に挙げる。   Next, the following conditions (1) to (4) describe conditions under which the leader following vehicle 1 stops following the leader according to the surrounding environment and the walking speed of the leader.

(1)まず、先導者追従車両1が周囲の障害物に衝突する可能性がある場合について図7に示したフローチャートを参照して説明する。   (1) First, a case where the leader following vehicle 1 may collide with surrounding obstacles will be described with reference to the flowchart shown in FIG.

周囲観測装置34〜37により車両前方の障害物を検出し(ステップ301)、先導者追従車両1が追従動作を継続することで障害物に衝突する可能性があるか否かを判断しステップ302)、衝突する可能性が無ければ、処理は終了となる(ステップ301に戻る)。   Obstacles in front of the vehicle are detected by the surrounding observation devices 34 to 37 (step 301), and it is determined whether or not the leader following vehicle 1 may collide with the obstacle by continuing the following operation. ) If there is no possibility of collision, the process ends (returns to step 301).

ステップ302で、衝突する可能性があると判断した場合は、スピーカ67、表示装置68を用いて先導者に音声や表示等で報知した後(ステップ303)、制御量演算装置16は車両制御装置17に伝える車速命令値を強制的に0とし、先導者追従車両を一旦停止させる(ステップ304)。   When it is determined in step 302 that there is a possibility of a collision, the leader 67 is notified by voice or display using the display device 68 (step 303), and then the control amount calculation device 16 is the vehicle control device. The vehicle speed command value transmitted to 17 is forcibly set to 0, and the leader following vehicle is temporarily stopped (step 304).

停止した先導者追従車両1は、周囲観測装置34〜37を用いて障害物の位置を再検知する(ステップ305)。続いて、障害物への衝突可能性があるか否かを判断し(ステップ306)、先導者が障害物のない領域方向に進路を変更した場合や障害物が検出されない場合には、追従動作を再開する。再度、衝突可能性のある障害物が検出されれば、ステップ307で障害物の回避経路を発見したか否か、つまり、追従目標位置と先導者追従車両1の位置との間に先導者追従車両1が通過できる経路を探索し、障害物回避経路を見つけたか否かを判断し、見つけた場合には、その経路に沿った障害物回避走行を開始し(ステップ308)、衝突可能性のある障害物の回避後に追従動作に復帰する。   The stopped leader following vehicle 1 detects the position of the obstacle again using the surrounding observation devices 34 to 37 (step 305). Subsequently, it is determined whether or not there is a possibility of collision with an obstacle (step 306), and when the leader changes the course in the direction of the area where there is no obstacle or when no obstacle is detected, a follow-up operation is performed. To resume. If an obstacle with a possibility of collision is detected again, whether or not an obstacle avoidance route has been found in step 307, that is, between the follow target position and the position of the leader follow vehicle 1. A route through which the vehicle 1 can pass is searched and it is determined whether or not an obstacle avoidance route has been found. If found, obstacle avoidance traveling along the route is started (step 308), and the possibility of collision is determined. After avoiding a certain obstacle, it returns to the tracking operation.

ここで、制御量演算装置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 surrounding observation devices 34 to 37. If no obstacle avoidance route is found in step 307, the leader is notified (step 309), and the leader following vehicle 1 waits in a stopped state until a start instruction is issued from the leader (step 307). 310). At this time, after the leader moves to a position where the leader following vehicle 1 can follow, the follow-up operation can be resumed by pressing the follow-on ON-OFF button 62 (return to step 301).

(2)次に、先導者が突然止まり、先導者追従車両1に衝突する可能性がある場合について述べる。   (2) Next, the case where the leader suddenly stops and may collide with the leader following vehicle 1 will be described.

目標追従位置として先導者の後方を指示され、さらに、先導者が突然立ち止まったときなど先導者追従車両1が先導者に衝突する可能性があると判断された場合にも、先導者追従車両1が先導者に音声等で報知した後、車両1は一旦停止する。そして、先導者追従車両1と先導者との間に距離101以上の距離が開いたときには、追従動作を再開する。   The leader following vehicle 1 is also indicated when it is determined that there is a possibility that the leader following vehicle 1 may collide with the leader, such as when the leader is suddenly stopped as a target following position. After notifying the leader by voice or the like, the vehicle 1 temporarily stops. Then, when a distance of 101 or more is opened between the leader following vehicle 1 and the leader, the following operation is resumed.

(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 leader following vehicle 1 to the prohibited travel area is detected by the vehicle state estimation device 15, the leader following vehicle 1 is temporarily informed after notifying the leader by voice or the like. Stop. Then, when the follow target position moves away from the travel prohibited area, the follow operation is resumed.

(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 leader following vehicle 1 is informed to the leader by voice or the like. Will stop. Thereafter, when the moving speed of the tracking target point falls below the tracking limit speed, the tracking operation is resumed.

また、先導者追従車両1が追従限界速度を超えた場合に、上記のように停止させるのではなく、先導者に音声で報知しつつ追従目標位置の軌跡上を追従限界速度で走行してもよい。   In addition, when the leader follower vehicle 1 exceeds the follow-up limit speed, instead of stopping as described above, even if the leader follows the trajectory of the follow-up target position while notifying the leader by voice, the vehicle follows the limit speed limit. Good.

これにより、先導者の歩行速度が比較的速いときに、先導者追従車両が頻繁に停止することを防ぐことができる。   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-OFF button 62. In this case, the leader follow-up vehicle 1 stops on the spot. The tracking can be resumed by pressing the tracking ON-OFF button 52 again.

本発明の第1の実施形態によれば、先導者からみた先導者追従車両1の追従位置を指定することが可能となり、さらに、先導者への追従動作を介して、先導者追従車両1にとって可能な動きの全てを先導者により操作することができるようになる。   According to the first embodiment of the present invention, it is possible to specify the follow position of the leader following vehicle 1 as viewed from the leader, and for the leader following vehicle 1 through the follow operation to the leader. All possible movements can be controlled by the leader.

したがって、追従動作中にも先導者による先導者追従車両1の各部へのアクセスを実現することが可能となる。このことは、例えば、ショッピングセンターにおいて、図8に示すように、買物客904を先導者とし、買物客904が購入品905を搭載する先導者追従車両903の端末902を操作して商品陳列棚906に陳列された商品901に関する情報を得ながら買い物を楽しむことができる。   Therefore, it is possible to realize access to each part of the leader following vehicle 1 by the leader even during the following operation. For example, in a shopping center, as shown in FIG. 8, a shopper 904 is a leader, and the shopper 904 operates a terminal 902 of a leader following vehicle 903 on which the purchased item 905 is mounted to operate a product display shelf. Shopping can be enjoyed while obtaining information about the product 901 displayed in 906.

また、工場等において、先導者追従車両に装備された端末を操作しつつ歩きながら、先導者追従車両に搭載された検査装置を用いて製品の検査をすることができる。これにより、検査作業を効率的に実施できるといった効果がある。   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 vehicle 1 change frequently in response to sudden meandering, and a phenomenon of frequent running and stopping occurs.

そこで、予め、常に人間の動きを計測する手段を有することで、結果として、先導者の移動軌跡の曲率半径を常時検出して、その変化率を一つの基準として使用する。この基準変化率が閾値以上となったときには、図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 leader following vehicle 1 is following, as shown in the following method switching point B152, the tracking target point designated by the leader is indicated. The control is switched to follow-up control (follow-up control similar to the first embodiment).

ここで、上述した、従来の追従方法というのは、図10に示すように、操舵命令値r。、車速命令値V。を、先導者追従車両1から見た先導者の偏差角Δθ、距離Dを用いて、r。=−KθLΔθ、V。=KdL(D−d)と与えるフィードバック則を用いることで、先導者に安定に追従するという制御を実現する。ここで、KθL、KdLは正の定数である。dは先導者と車両との指定間隔である。 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 leader following vehicle 1 and the distance D L , r. = −K θL Δθ L , V. By using the feedback law given as = K dL (D L −d L ), the control of stably following the leader is realized. Here, K θL and K dL are positive constants. d L is a designated interval between the leader and the vehicle.

図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 step 401, the position of the leader following vehicle 1 in the global coordinate system 105 is acquired, and in step 402, the leader follows from the image of the leader acquired by the external sensor 12. The relative position of the leader with respect to the vehicle 1 is obtained.

次に、ステップ403において、グローバル座標系105における先導者の移動軌跡を更新する。そして、ステップ404において、先導者移動軌跡の単位時間当たりの曲率変化量が閾値を超えたか否かを判断する。そして、図9に示した追従方法切替点A151のように、先導者移動軌跡の単位時間当たりの曲率変化量が小さければ、図6のフローチャートと同様に、追従目標点に追従する制御を行い(ステップ405)、ステップ401に戻る。   Next, in step 403, the movement trajectory of the leader in the global coordinate system 105 is updated. In step 404, it is determined whether or not the amount of curvature change per unit time of the leader movement trajectory exceeds a threshold value. And if the amount of curvature change per unit time of the leader movement trajectory is small like the tracking method switching point A151 shown in FIG. 9, control is performed to follow the tracking target point as in the flowchart of FIG. Step 405), returning to Step 401.

ステップ404において、曲率変化量がある閾値を超えたときには(ステップ404でYESの場合)、第1の実施形態のように停止させるのではなく、先導者と先導者追従車両1との間の距離を一定値dに保つように操舵角と車速を制御する方法に追従制御方法を切り換える(ステップ406)。そして、ステップ401A、402A、403Aを実行する。 In Step 404, when the curvature change amount exceeds a certain threshold value (in the case of YES in Step 404), the distance between the leader and the leader following vehicle 1 is not stopped as in the first embodiment. The tracking control method is switched to a method of controlling the steering angle and the vehicle speed so as to keep the value d L constant (step 406). Then, steps 401A, 402A, and 403A are executed.

例えば、簡単に車両制御装置17に与える操舵命令値r。は、先導者追従車両1の現在位置からみた先導者の方向と先導者追従車両1の進行方位との間の偏差量をΔθとして、r。=−KθLΔθとし、車速命令値V。は、先導者追従車両と先導者との間の距離をDとして、V。=KdL(D−d)とする。ここで、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 vehicle 1 and the direction of the leader as viewed from the current position of the leader following vehicle 1 as [Delta] [theta] L, r. = −K θL Δθ L , vehicle speed command value V. Is the distance between the leader following vehicle and leader as D L, V. = K dL (D L -d L ). Here, K θL and K dL are positive constants.

ステップ403Aを実行した後、ステップ407において、先導者軌跡の単位時間当たりの曲率変化量が閾値を一定時間下回ったか否かを判断する。一定時間、先導者移動軌跡の単位時間当たりの曲率変化量が閾値を下回ったときには、ステップ401に戻り、追従目標点に追従する制御に復帰する(図9の追従方法切替点B152)。   After executing step 403A, in step 407, it is determined whether or not the amount of curvature change per unit time of the leader track has fallen below a threshold value for a certain time. When the curvature change amount per unit time of the leader movement trajectory falls below the threshold for a certain time, the process returns to step 401 to return to the control to follow the target target point (following method switching point B152 in FIG. 9).

ステップ407において、先導者移動軌跡の単位時間当たりの曲率変化量が閾値を下回らないときには、ステップ406に戻る。   In Step 407, when the curvature change amount per unit time of the leader movement trajectory does not fall below the threshold value, the process returns to Step 406.

図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の実施例形態である先導者追従車両の機能構成図である。It is a functional lineblock diagram of the leader follower vehicle which is the 1st example form of the present invention. 周囲環境と車両状態の認識手段及び車両の制御手段の配置を説明する図である。It is a figure explaining arrangement | positioning of the recognition means of a surrounding environment and a vehicle state, and the control means of a vehicle. 先導者追従車両に搭載される追従制御指示装置の概略構成図である。It is a schematic block diagram of the tracking control instruction | indication apparatus mounted in a leader tracking vehicle. 周囲観測装置による先導者および障害物の位置検出の説明図である。It is explanatory drawing of the position detection of a leader and an obstruction by a surrounding observation apparatus. 先導者追従車両が追従制御を行う追従目標位置の指定方法の説明図である。It is explanatory drawing of the designation | designated method of the tracking target position which a leader tracking vehicle performs tracking control. 第1の実施形態における追従目標位置への追従制御の動作フローチャートである。It is an operation | movement flowchart of the tracking control to the tracking target position in 1st Embodiment. 第1の実施形態において、障害物を検出した場合の追従制御のフローチャートである。5 is a flowchart of tracking control when an obstacle is detected in the first embodiment. 本発明の第1の実施形態を適用した一例であり、ショッピングセンターにおいて買い物客へ追従するショッピングカートの説明図である。It is an example which applied the 1st Embodiment of this invention and is explanatory drawing of the shopping cart which tracks a shopper in a shopping center. 本発明の第2の実施形態における追従制御方法切替え点の説明図である。It is explanatory drawing of the tracking control method switching point in the 2nd Embodiment of this invention. 本発明の第2の実施形態において用いられる追従制御の説明図である。It is explanatory drawing of the follow-up control used in the 2nd Embodiment of this invention. 本発明の第2の実施形態における追従制御の動作フローチャートである。It is an operation | movement flowchart of the follow-up control in the 2nd Embodiment of this invention.

符号の説明Explanation of symbols

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 SYMBOLS 1 ... Following vehicle main body, 11 ... Communication apparatus (vehicle main body), 12 ... External field sensor, 13 ... Internal field sensor, 14 ... Environmental information recording device, 15 ... Vehicle state estimation Device ... 16 Control amount calculation device, 17 ... Vehicle control device, 18 ... Front wheel steering motor, 19 ... Rear wheel drive motor, 31 ... TV camera, 32 ... Absolute position detection Device: 33 ... Road shoulder observation device, 34-37 ... Ambient observation device, 41 ... Encoder, 42 ... Vehicle attitude sensor, 43 ... Steering angle detection device, 51 ... Front wheel steering motor 52 ... Rear wheel drive motor, 60 ... Follow-up control instruction device, 61 ... Follow-up direction lever, 62 ... Follow-up ON-OFF button, 63 ... Follow-up direction switch button, 64, 65 ..Following distance setting button, 101 ... ahead of the leader Distance to the vehicle following the vehicle, 102... Direction angle θ of the leader, 103... Center coordinate system of the leader, 104... Center coordinate system of the vehicle following the leader, 105. 111-113 ... obstacle, 114 ... distance Ro from the leader following vehicle to the obstacle, 115 ... direction θo of the obstacle as seen from the leader following vehicle, 151, 152 ... of the following method Switching point

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:
請求項1記載の先導者追従車両において、上記追従制御指示手段により、さらに、追従動作の開始及び停止と、先導者追従車両が先導者を前進して追従するか後進して追従するかの選択とを設定することを特徴とする先導者追従車両。   2. The leader following vehicle according to claim 1, wherein the follow control instruction means further selects start and stop of the follow-up operation and whether the leader follow vehicle follows the leader forward or backward. And a leader following vehicle characterized by setting. 請求項1記載の先導者追従車両において、上記先導者追従車両の方位、及び先導者と先導者追従車両との間の距離は、先導者が急停止した場合でも、先導者と追従車両とが衝突することなく、安全に停止することができる範囲に制限されていることを特徴とする先導者追従車両。   The leader follower vehicle according to claim 1, wherein the direction of the leader follower vehicle and the distance between the leader and the leader follower vehicle are such that the leader and the follower vehicle are in a state where the leader suddenly stops. A leader following vehicle characterized by being limited to a range where it can be safely stopped without colliding. 請求項1記載の先導者追従車両において、所定の固定位置を原点とするグローバル座標系での先導者追従車両の現在位置を計測する手段と、先導者の存在位置を原点とする先導者中心座標での先導者追従車両からみた先導者の相対位置を計測する手段とを備え、上記車両制御手段は、先導者中心座標系で定義された先導者追従車両の先導者の位置である追従目標位置をグローバル座標系に変換し、変換した追従目標位置に車両を追従させることを特徴とする先導者追従車両。   2. The leader following vehicle according to claim 1, wherein means for measuring a current position of the leader following vehicle in a global coordinate system having a predetermined fixed position as an origin, and leader center coordinates having the leader existing position as an origin. Means for measuring the relative position of the leader as viewed from the leader following vehicle at the vehicle, and the vehicle control means is a follow target position that is the position of the leader of the leader following vehicle defined by the leader central coordinate system. A leader following vehicle characterized by converting the vehicle to a global coordinate system and causing the vehicle to follow the converted target position. 請求項4記載の先導者追従車両において、上記車両制御手段は、上記グローバル座標系で定義された先導者の位置を記憶手段に記憶させ、記憶させた先導者の移動軌跡から先導者の進行方向を推定し、移動軌跡に沿って先導者を追従することを特徴とする先導者追従車両。   5. The leader following vehicle according to claim 4, wherein the vehicle control means stores the position of the leader defined in the global coordinate system in the storage means, and the traveling direction of the leader from the stored movement trajectory of the leader. And following the leader along the movement trajectory. 請求項5記載の先導者追従車両において、上記車両制御手段は、先導者移動軌跡の単位時間当たりの曲率変化量を算出し、算出した曲率変化量が閾値を越えたときには、移動軌跡に沿って先導者を追従する追従制御から、先導者から先導者追従車両までの距離を先導者が指定した値に保つ追従制御に切替えることを特徴とする先導者追従車両。   6. The leader following vehicle according to claim 5, wherein the vehicle control means calculates a curvature change amount per unit time of the leader movement trajectory, and when the calculated curvature change amount exceeds a threshold, along the movement trajectory. A leader following vehicle characterized in that the tracking control for following the leader is switched to the tracking control for maintaining the distance from the leader to the leader following vehicle at a value designated by the leader. 請求項1記載の先導者追従車両において、障害物を検出する手段と、グローバル座標系での自己位置を計測する手段と、許容走行領域の情報を有し走行経路上の障害物や先導者との衝突や許容走行領域からの逸脱を推定する手段とを備え、上記推定手段が、障害物との衝突や逸脱の発生を推定したとき、上記車両制御手段は、車両の停止又は障害物との衝突回避動作を行うことを特徴とする先導者追従車両。   In the leader following vehicle according to claim 1, the means for detecting the obstacle, the means for measuring the self position in the global coordinate system, the obstacle on the travel route and the leader having the information on the allowable travel area, Means for estimating the occurrence of a collision or deviation from an obstacle, and when the estimation means estimates the occurrence of a collision or deviation with an obstacle, the vehicle control means A leader following vehicle characterized by performing a collision avoidance operation. 請求項7記載の先導者追従車両において、先導者に警告を発する警告手段を備え、上記車両制御手段は、追従目標位置への追従動作を維持できないと推定するか維持できなくなった場合、上記警告手段により先導者に警告することを特徴とする先導者追従車両   The leader following vehicle according to claim 7, further comprising warning means for issuing a warning to the leader, wherein the vehicle control means estimates that the tracking operation to the tracking target position cannot be maintained or cannot be maintained. Leader-following vehicle characterized by warning a leader by means 請求項7記載の先導者追従車両において、上記車両制御手段は、先導者追従車両が追従目標位置への追従動作を維持できなくなった場合、先導者から先導者追従車両までの距離を先導者が指定した値に保つのみの追従制御に切替えることを特徴とする先導者追従車両。   8. The leader following vehicle according to claim 7, wherein, when the leader following vehicle cannot maintain the follow operation to the follow target position, the vehicle control means determines the distance from the leader to the leader following vehicle. A leader-following vehicle characterized by switching to follow-up control that only maintains a specified value.
JP2007023713A 2007-02-02 2007-02-02 Leader following vehicle Active JP4351261B2 (en)

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)

* Cited by examiner, † Cited by third party
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

Cited By (32)

* Cited by examiner, † Cited by third party
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