Links

Images

Abstract

PROBLEM TO BE SOLVED: To perform stable tracking, even under an environment where GPS cannot be utilized.

SOLUTION: A leading vehicle 1 estimates a position and an attitude from a certain original point, on the basis of a predetermined arithmetic expression by using the number of rotations and a steering angle of a wheel as parameters, creates an environment map, based on the estimated position and the attitude and environment information around own vehicle 1 and transmits the map to the succeeding vehicle 2. The succeeding vehicle 2 estimates the position and attitude from a certain original point on the basis of the predetermined arithmetic expression, by using the number of rotations and a steering angle of a wheel as parameters; estimates the position and the attitude of own vehicle by checking the surrounding environment information with the environment map from the leading vehicle 1; and determines the final own position and the attitude, on the basis of own position and the attitude, estimated on the basis of the number of the rotations and the steering angle of the wheel and own position, and the attitude estimated on the basis of the environment map.

COPYRIGHT: (C)2009,JPO&INPIT

Description

Translated from Japanese

本発明は、追尾システム及びその方法および追尾システムに適用される車両に関するものである。 The present invention relates to a vehicle that is applied to the tracking system and method and tracking system.

従来、運転手により運転される先導車両と、該先導車両に自動追尾して縦列走行する複数の後続車両とからなる自動追尾走行システムが提案されている（例えば、特許文献１参照）。 Conventionally, a leading vehicle that is operated by the driver, the automatic tracking travel system comprising a plurality of succeeding vehicles tandem runs by automatic tracking is proposed to said leading vehicle (e.g., see Patent Document 1).特許文献１には、ＧＰＳにより得られる現在位置情報に基づいて生成される走行軌跡情報と、運転者による操舵量やスロットル開度等の運転操作量を先導車両において作成し、これらの軌跡情報と運転操作量とを後続車両に送信し、後続車両において、先導車両からの軌跡情報及び運転操作量を参照しながら後続車両の運転を行うことが開示されている。 Patent Document 1, a traveling locus information generated based on the current position information obtained by GPS, to create the leading vehicle driving operation quantity such as the steering amount or the throttle opening degree by the driver, and these trajectory information sending a driving operation amount in the following vehicles, the following vehicle, to perform the operation of the following vehicle is disclosed with reference to the locus information and the driving operation amount from the leading vehicle.特許第３５９４４９８号公報 Patent No. 3594498 Publication

しかしながら、上記特許文献１の発明では、ＧＰＳを用いて自己位置を検出し、これに基づいて走行軌跡情報を生成している。 However, in the invention of Patent Document 1, to detect its own position using a GPS, which generates traveling locus information based on this.したがって、例えば、トンネルの中や木が生い茂っている場所などのように、ＧＰＳが利用できない環境下においては、自己位置の特定ができず、走行軌跡情報を生成することができない。 Thus, for example, such as locations that overgrown trees or in tunnels, in an environment where GPS is not available can not identify self-position, it is impossible to generate a traveling locus information.この結果、後続車両に追尾走行のための有効な情報を送信することができず、後続車両の追尾運転が不可能となるおそれがある。 As a result, it is impossible to transmit the useful information for tracking traveling to the following vehicle, there is a possibility that the tracking operation of the following vehicle becomes impossible.

本発明は、上記問題を解決するためになされたもので、ＧＰＳが利用できない環境下であっても安定した追尾走行を実現することの可能な追尾システムおよびその方法並びに車両を提供することを目的とする。 The present invention, the problem which has been made to solve the aims to provide a possible tracking system and method as well as a vehicle that GPS is to realize a tracking driving that even under environments stable unavailable to.

上記課題を解決するために、本発明は以下の手段を採用する。 In order to solve the above problems, the present invention employs the following means.本発明は、先導車両から与えられる情報に基づいて後続車両が追尾走行を行う追尾システムであって、先導車両は、周辺の環境情報を取得する環境情報取得手段と、前記環境情報と自己位置及び姿勢とに基づいて、環境マップを作成する環境マップ作成手段と、前記環境マップを送信する通信手段とを備え、前記後続車両は、前記先導車両によって作成された前記環境マップを受信する通信手段と、周辺の環境情報を取得する環境情報取得手段と、前記環境情報取得手段により取得された環境情報と、前記先導車両によって作成された環境マップとを照合することにより、自己の位置及び姿勢を推定する地図照合手段と、前記地図照合手段によって推定された自己の位置及び姿勢を参照して、最終的な自己の位置及び姿勢を決定する位置姿勢 The present invention provides a tracking system which following vehicles on the basis of the information given from the leading vehicle performs tracking driving, leading vehicle, an environment information obtaining means for obtaining the surrounding environment information, the environment information and the self-position and based on the attitude, the environment map generating means for generating environmental map, and a communication means for transmitting the environment map, the following vehicle includes a communication means for receiving the environment map created by said leading vehicle , estimation and information acquisition means for acquiring surrounding environment information, the environment information acquired by the environment information acquiring means, by collating the environmental map created by the leading vehicle, the own position and orientation position and orientation and the map matching means, with reference to the position and orientation of the self-estimated by the map matching means, for determining the position and orientation of the final self to定手段とを備える追尾システム。 Tracking system and a constant section.

このような構成によれば、後続車両においては、先導車両から受信した環境マップに基づいて推定された位置及び姿勢を考慮して、最終的な自己の位置及び姿勢を特定するので、ＧＰＳを用いることなく、容易に、かつ、十分な精度をもって自己位置及び姿勢を推定することが可能となる。 According to such a configuration, in the following vehicle, taking into account the estimated position and orientation based on the environment map received from the lead vehicle, so identifying the position and orientation of the final self, using GPS without easily, and it is possible to estimate its own position and orientation with sufficient accuracy.これにより、ＧＰＳが利用できない環境下においても安定した追尾走行を実現させることが可能となる。 Thus, it is possible also to realize a stable tracking traveling in an environment where GPS is not available.先導車両の自己位置及び姿勢については、ＧＰＳ、IMU,或いは先導車両の行動を監視する他の監視装置等から自己位置及び姿勢を取得してもよいし、また、オドメトリを用いて自己位置及び姿勢を推定してもよい。 For the self-position and orientation of the leading vehicle, GPS, IMU, or the behavior of the leading vehicle may obtain its own position and orientation from the other monitoring devices such as monitors, also self-position and orientation using the odometry it may be estimated.先導車両の行動を監視する他の監視装置等とは、例えば、先導車両が通過しそうな道にカメラ等を配置しておき、カメラによって先導車両が通過したことが確認された場合に、その位置を記憶することで、先導車両の位置や走行経路を管理するものが挙げられる。 Like other monitoring apparatus for monitoring the behavior of the leading vehicle and, for example, should be placed in the camera or the like on the road leading vehicle is likely to pass, when lead vehicle is confirmed that passes by the camera, its position by storing, include those for managing the position and the travel path of the leading vehicle.また、後続車両は、自己の位置及び姿勢を推定する位置姿勢推定手段を備えていてもよい。 Further, the following vehicle may be provided with a position and orientation estimation means for estimating its own position and orientation.位置姿勢推定手段は、例えば、ＧＰＳや後続車両の行動を監視する他の監視装置等から自己位置及び姿勢を取得してもよいし、オドメトリを用いてある原点からの位置と姿勢とを推定することとしてもよい。 Position and orientation estimation means, for example, may acquire its own position and orientation from the other monitoring devices such as monitoring the behavior of the GPS and the following vehicle, and estimates the position and orientation from the origin that is using the odometry it is also possible.オドメトリを用いる場合には、例えば、位置姿勢推定手段は、車輪の回転数と操舵角とを用いてオドメトリにより自己位置及び姿勢の推定を行ってもよいし、車輪の回転速度やステアリングを用いてオドメトリにより自己位置及び姿勢の推定を行ってもよい。 When using odometry, for example, the position and orientation estimating means may perform the self-position and orientation estimation by odometry using a rotating speed of the wheel and the steering angle, by using the rotational speed and the steering wheel it may be carried out its own position and orientation estimation of the odometry.このように、オドメトリに用いられるパラメータとしては、特に限定されない。 Thus, as the parameters used in the odometry it is not particularly limited.また、後続車両が位置姿勢推定手段を備える場合において、上記位置姿勢決定手段は、位置姿勢推定手段によって推定された位置及び姿勢と前記地図照合手段によって推定された自己の位置及び姿勢とから最終的な自己の位置及び姿勢を決定することとしてもよい。 Further, when the following vehicle is provided with a position and orientation estimation means, the position and orientation determining means, ultimately from the own position and orientation estimated by the estimated position and orientation and the map matching means by the position and orientation estimating means it may determine the position and orientation of a self.

上記追尾システムにおいて、前記先導車両は、前記環境情報取得手段によって取得された環境情報の中から、物体の属性に関する所定の条件を満たす物体をランドマークとして抽出するランドマーク抽出手段を更に備え、前記環境マップ作成手段は、前記ランドマーク抽出手段によって抽出された前記ランドマークの位置と、前記環境情報が取得されたときの自己の位置及び姿勢とに基づいて前記環境マップを作成することとしてもよい。 In the tracking system, said leading vehicle, from the environment information acquired by the environment information acquisition unit further comprises a landmark extracting means for extracting a predetermined condition is satisfied object about attributes of the object as a landmark, the environment map generating means, the position of the landmark extracted by the landmark extraction unit, it is also possible to create the environment map based on the own position and orientation at which the environmental information has been acquired .

このような構成によれば、環境情報取得手段によって取得された環境情報の中から位置を特定するのに適した物体のみをランドマークとして抽出し、このランドマークに基づいて環境マップを作成するので、位置姿勢の特定に効果的な環境マップを作成することが可能となる。 According to such a configuration, only the object that is suitable to identify the location from the environment information acquired by the environment information acquiring means extracts landmark, so creating an environment map based on the landmark , it is possible to create an effective environment map to a particular position and orientation.物体の属性としては、例えば、物体の形状、物体の性質、温度、色、テクスチャー、シール、バーコード、反射材等が一例として挙げられる。 The attributes of an object, e.g., object shape, object properties, temperature, color, texture, seals, bar code, reflective material, and the like as an example.

上記追尾システムにおいて、前記環境情報取得手段は、例えば、レーザレーダである。 In the tracking system, the environment information obtaining means, for example, a laser radar.上記追尾システムにおいて、前記環境情報取得手段は例えば、カメラである。 In the tracking system, the environmental information obtaining means for example, a camera.

環境情報取得手段としてカメラを採用することにより、広範囲にわたる周囲環境の情報取得が可能となるとともに、色の情報も取得することが可能となる。 By employing the camera as the environmental information acquisition unit, it becomes possible to obtain information surrounding environment extensive, it is possible to acquire color information.これにより、レーザレーダに比べてより多くの周囲の環境情報を取得することが可能となる。 Thus, it is possible to get more environmental information around compared to laser radar.更に、カメラはパッシブ式であるので、周囲の相手に認識されることなく、情報を取得することができるという利点がある。 Furthermore, the camera because it is passive type, there is an advantage that it is possible to obtain the no information is recognized around the opponent.

上記追尾システムにおいて、前記先導車両は、自己の位置と姿勢とに基づいて作成された走行軌跡データを送信し、前記後続車両は、前記位置姿勢決定手段によって決定された最終的な自己の位置及び姿勢と、前記先導車両の走行軌跡データとに基づいて経路計画を作成する経路計画手段と、前記経路計画手段によって作成された経路計画に基づいて自律走行を制御する走行制御手段とを更に備えることとしてもよい。 In the tracking system, it said leading vehicle transmits the travel locus data created based on the own position and orientation, the following vehicle, the final own position and determined by the position and orientation determining means an attitude, a route planning means for creating a route plan on the basis of the traveling locus data of said leading vehicle, further comprise a running control means for controlling the autonomous driving based on the route plan created by the path planning means it may be.

このような構成によれば、先導車両が通過した走行軌跡データについても後続車両に送信されるので、上述した環境マップと走行軌跡データとに基づいて先導車両の走行経路をより高い精度で求めることが可能となり、追尾走行の精度を高めることが可能となる。 According to this structure, since it is transmitted to the following vehicle also travel locus data leading vehicle has passed, it is more accurately determined a travel route leading vehicle based on the traveling locus data and environment maps described above becomes possible, it becomes possible to improve the accuracy of tracking travel.上記走行軌跡データは、後続車両に対して直接的に送信されてもよいし、他の装置を経由して最終的に後続車両によって受信されることとしてもよい。 The traveling locus data can be sent directly for subsequent vehicles, it may be received by finally following vehicle via another device.

上記追尾システムにおいて、前記後続車両は、自己が通過不可能な経路と、その経路の迂回経路とが対応付けられている地図情報を予め保有しており、前記先導車両が自己の通過不可能な経路を通過した場合には、その迂回経路として登録されている経路を前記地図情報から取得し、取得した前記迂回経路を走行することとしてもよい。 In the tracking system, the following vehicle is a route self is not passed, and pre-stores the map information and detour route of the path is associated, said leading vehicle is self impassable when passing through the path obtains the route which is registered as a detour route from the map information, it is also possible to travel the acquired detour path.

例えば、先導車両と後続車両とが大きさや重量の面で異なる場合には、先導車両と後続車両とが同じ経路（例えば、高さ制限、重量制限のある経路）を走行できないという場合が生ずる。 For example, if the leading vehicle and the following vehicle are different size and weight of the face, the leading vehicle and following vehicle and the same route (e.g., height limit, the path with a weight limit) when occurs can not travel.このような場合でも、後続車両は通過不可能な経路に代わる他の経路の情報を有しているので、速やかに対応することが可能となる。 Even in such a case, since the following vehicle has information of another route alternatives to non path passes, it is possible to respond promptly.

上記追尾システムにおいて、前記後続車両は、自己が駐車不可能な駐車場所と、その駐車場所に代わる他の駐車場所とが対応付けられている地図情報を予め保有しており、前記先導車両が自己の駐車不可能な駐車場所に停止した場合には、その駐車場所に代わる他の駐車場所を前記地図情報から取得し、取得した前記駐車場所に駐車することとしてもよい。 In the tracking system, the following vehicle includes a parking place itself not parked, and pre-stores the map information and other parking places in place of the parking place is associated, said leading vehicle is self If you stop the car impossible parking spot obtains other parking places in place of the parking place from the map information, it may be parked in the parking place acquired.

例えば、先導車両と後続車両とが高さや重量の面で異なる場合には、先導車両と後続車両とが同じ駐車位置に駐車できないという場合が生ずる。 For example, if the leading vehicle and the following vehicle are different height and weight of the surface, if that the leading vehicle and the following vehicle can not be parked in the same parking position is generated.このような場合でも、後続車両は駐車不可能な駐車場所に代わる他の駐車場所の情報を有しているので、速やかに対応することが可能となる。 Even in such a case, since the following vehicle has information of another parking spot in place of the parking impossible parking places, it is possible to respond promptly.

上記追尾システムにおいて、前記先導車両及び前記後続車両には、互いを連結するための連結機構が設けられていることとしてもよい。 In the tracking system, wherein the leading vehicle and the following vehicle, may be coupling mechanism is provided for connecting each other.

このような構成によれば、先導車両と後続車両とを連結することが可能となる。 According to such a configuration, it is possible to connect the leading vehicle and following vehicle.これにより、連結中においては先導車両及び後続車両において追尾走行のために必要となる処理を行うことなく、追尾走行が可能となる。 Thus, without performing the processing necessary for tracking traveling in the leading vehicle and following vehicle is in a connection, it is possible to track cars.

上記追尾システムにおいて、前記後続車両がｎ（ｎは２以上の整数）台存在し、隊列走行する場合において、ｎ−１番目までの前記後続車両は、前記先導車両から受信した環境マップを、自己が備える前記環境情報取得手段により取得された環境情報に基づいて更新する環境マップ更新手段を備え、更新後の前記環境マップを自己よりも後方に位置する前記後続車両に送信することとしてもよい。 In the tracking system, said following vehicle is n (n is an integer of 2 or more) stage exists, in the case of row running, the following vehicle to n-1 th, the environment map received from said leading vehicle, self comprising an environment map updating means for updating, based on the environment information acquired by the environment information acquiring means provided in, the environment map after update may be transmitted to the following vehicle located behind the self.

このような構成とすることで、先導車両が通過するときと後続車両が通過するときとで周囲の環境状況が変化した場合でも、後続車両は、環境状況の変化が反映された環境マップを取得することが可能となるので、安定した追尾走行を実現することが可能となる。 With such a configuration, even when the environmental conditions around between when a subsequent vehicle passes is changed and when the leading vehicle passes, subsequent vehicle acquires the environmental map changes in environmental conditions is reflected since it becomes possible to, it is possible to realize a stable tracking driving.

更に、上記追尾システムにおいて、前記更新後の前記環境マップは、自己よりも前方に位置する前記後続車両及び前記先導車両にも送信されることとしてもよい。 Further, in the tracking system, wherein the environment map after update may be also transmitted to the following vehicle and the leading vehicle is positioned in front of the self.このようにすることで、先導車両或いは環境マップを更新した後続車両よりも前方に位置する後続車両が行き止まりに到達し、これらの車両が今まで通った道を引き返すような場合に、更新環境マップを参照することで、より効果的に位置推定を行うことが可能となる。 In this way, when the following vehicle is positioned in front of the following vehicle updating a leading vehicle or environment map reaches a dead end, as turn back the way these vehicles is through ever updated environment map by reference to the, it is possible to perform more effectively position estimation.

本発明は、先導車両から与えられる情報に基づいて後続車両が追尾走行を行う追尾システムに用いられる車両であって、周辺の環境情報を取得する環境情報取得手段と、前記環境情報と自己の位置及び姿勢に基づいて、環境マップを作成する環境マップ作成手段と、 The present invention is a vehicle for use in tracking system following vehicle based on information provided from the leading vehicle performs tracking driving, and environment information obtaining means for obtaining the surrounding environment information, the position of the environmental information and self and on the basis of attitude, and the environment map creating means to create an environment map,前記環境マップを送信する通信手段とを備える車両を提供する。 To provide a vehicle and a communication means for transmitting the environment map.

本発明は、先導車両から与えられる情報に基づいて後続車両が追尾走行を行う追尾システムに用いられる車両であって、他の車両において作成された環境マップを受信する通信手段と、周辺の環境情報を取得する環境情報取得手段と、前記環境情報取得手段により取得された環境情報と、前記他の車両において作成された環境マップとを照合することにより、自己位置及び姿勢を推定する地図照合手段と、前記地図照合手段によって推定された自己の位置及び姿勢を参照して、最終的な自己の位置及び姿勢を決定する位置姿勢決定手段とを備える車両を提供する。 The present invention, the following vehicle is a vehicle for use in tracking system for tracking traveling based on information provided from the leading vehicle, a communication unit for receiving the environment map created in another vehicle, the surrounding environment information an environment information obtaining means for obtaining, and the environment information acquired by the environment information acquiring means, by collating the environmental map created in the other vehicle, a map matching means for estimating its own position and orientation , with reference to its position and orientation estimated by the map matching means, to provide a vehicle and a position and orientation determining means for determining the position and orientation of the final self.

本発明は、先導車両から与えられる情報に基づいて後続車両が追尾走行を行う追尾方法であって、先導車両は、周辺の環境情報を取得し、前記環境情報と自己位置及び姿勢とに基づいて、環境マップを作成し、前記環境マップを送信し、前記後続車両は、前記先導車両によって作成された前記環境マップを受信し、周辺の環境情報を取得し、取得した周辺の環境情報と前記先導車両によって作成された環境マップとを照合することにより、自己の位置及び姿勢を推定し、推定した自己の位置及び姿勢を参照して、最終的な自己の位置及び姿勢を決定する追尾方法を提供する。 The present invention relates to a tracking method following vehicle based on information provided from the leading vehicle performs tracking driving, leading vehicle acquires the surrounding environment information, based on said environment information and own position and orientation , creates an environment map, and transmitting the environment map, the following vehicle receives the environmental map created by the leading vehicle, acquires the surrounding environment information, said leading and acquired surrounding environment information by collating the environmental map created by the vehicle, and estimates its own position and orientation, with reference to the position and orientation of the estimated self, provides a tracking method for determining the position and orientation of the final self to.また、上記構成は、可能な範囲で組み合わせて利用することができるものである。 Further, the configuration is one that can be utilized in combination to the extent possible.

本発明によれば、ＧＰＳが利用できない環境下においても安定した追尾走行を実現することができるという効果を奏する。 According to the present invention, an effect that it is possible to realize a stable tracking traveling in an environment where GPS is not available.

以下に、本発明に係る追尾システムおよびその方法ならびに車両の各実施形態について、図面を参照して説明する。 Hereinafter, the tracking system and the embodiments of the method and vehicle according to the present invention will be described with reference to the drawings.

〔第１の実施形態〕 First Embodiment図１は、本発明の第１の実施形態に係る追尾システムの全体構成を示した図である。 Figure 1 is a diagram showing the overall structure of a tracking system according to a first embodiment of the present invention.図１に示した追尾システムは、先導車両１から与えられる情報に基づいて後続車両２が追尾走行を行う追尾システムである。 Tracking system shown in Figure 1, the following vehicle 2 is a tracking system for tracking traveling based on information provided from the leading vehicle 1.本実施形態では、先導車両１は、人が運転する有人車両であり、後続車両２は無人走行を可能とする自律走行車両である。 In the present embodiment, the leading vehicle 1 is a manned vehicle for human operation, the following vehicle 2 is autonomous vehicle to enable unmanned running.なお、これらは一例であり、例えば、先導車両１および後続車両２の両方を自律走行車両としてもよい。 Note that these are examples, for example, both of the leading vehicle 1 and the following vehicle 2 may be autonomous vehicle.

図２は、先導車両１の全体構成の概略図である。 Figure 2 is a schematic diagram of the overall configuration of the leading vehicle 1.図２に示すように、先導車両１は、車速センサ１１、ＩＭＵ（Inertial Measurement As shown in FIG. 2, the leading vehicle 1, a vehicle speed sensor 11, IMU (Inertial MeasurementUnit：慣性測定装置）１２、レーザレーダ（環境情報取得手段）１３、制御装置１４、及び通信装置（通信手段）１５を主な構成として備えている。 Unit: includes inertial measurement unit) 12, a laser radar (environment information obtaining means) 13, a control unit 14, and a communication device (communication unit) 15 as main components.

上記車速センサ１１及びＩＭＵ１２は自己位置及び姿勢を推定するための情報を取得するための手段である。 The vehicle speed sensor 11 and IMU12 is a means for obtaining the information for estimating its own position and orientation.車速センサ１１は、車速を検出して制御装置１４に出力する。 Vehicle speed sensor 11 outputs to the control unit 14 detects the vehicle speed.ＩＭＵ１２は、車両の姿勢を検出するものであり、直交する３軸（Ｘ，Ｙ，Ｚ）に各々一個設置された３つの加速度計と３つのジャイロスコープから構成されている。 IMU12 is for detecting the posture of the vehicle, three orthogonal axes (X, Y, Z) are constituted each from a single installed three accelerometers and three gyroscopes.ＩＭＵ１２は、加速度計により検出された車両の３方向の加速度と、ジャイロスコープにより検出される当該ＩＭＵの中心を原点とする３軸回りの角速度とを車両の姿勢データとして制御装置１４に出力する。 IMU12 outputs the three directions of the acceleration of the vehicle detected by the accelerometer, the angular velocities about three axes whose origin the center of the IMU detected to the control unit 14 as the posture data of the vehicle by the gyroscope.レーザレーダ１３は、周辺の環境情報を取得するものであり、取得した周囲環境の情報を制御装置１４に出力する。 Laser radar 13 is for obtaining the surrounding environment information, and outputs the obtained information of the surrounding environment to the control unit 14.

制御装置１４は、車速センサ１１により検出される車速、ＩＭＵ１２により検出される姿勢データ、及びレーザレーダ１３により検出される環境情報に基づいて、走行軌跡データ及び環境マップを作成し、これを通信装置１５に出力する。 Controller 14, the vehicle speed detected by the vehicle speed sensor 11, the posture data detected by IMU12, and based on the environment information detected by the laser radar 13, to create a travel locus data and environment maps, communication device which and outputs it to the 15.通信装置１５は、後続車両２が備える通信装置２５（図３参照）との間で双方向通信を可能とする。 Communication device 15 allows for two-way communication with the communication device 25 (see FIG. 3) of the following vehicle 2 is provided.

図３は後続車両２の全体構成の概略図である。 Figure 3 is a schematic diagram of the overall configuration of a following vehicle 2.図３に示すように、後続車両２は、上述した先導車両１と同様に、車速センサ２１、ＩＭＵ２２、レーザレーダ２３、制御装置２４、及び通信装置２５を備えている。 As shown in FIG. 3, the following vehicle 2, similarly to the leading vehicle 1 described above, and a vehicle speed sensor 21, IMU22, laser radar 23, the controller 24, and a communication device 25.更に、後続車両２は、自律走行を実現するための走行駆動機構として、例えば、ステアリング駆動用のステアリングアクチュエータ２６、アクセル・ブレーキ操作用のアクセルブレーキアクチュエータ２７等を備えている。 Additionally, following vehicle 2 includes a travel driving mechanism for achieving autonomous, for example, a steering actuator 26 for steering drive, the accelerator brake actuator 27 or the like for the accelerator and brake operations.

後続車両２において、車速センサ２１、ＩＭＵ２２、及びレーザレーダ２３により検出された情報、並びに、通信装置２５により受信された先導車両１からの走行軌跡データ並びに環境マップは、制御装置２４に入力される。 In the following vehicle 2, the vehicle speed sensor 21, IMU22, and information detected by the laser radar 23, as well as travel locus data and environmental map from the received led vehicle 1 by the communication device 25 is input to the controller 24 .制御装置２４は、これらの情報に基づいてステアリングアクチュエータ２６およびアクセルブレーキアクチュエータ２７を駆動制御する制御指令を生成することにより、後続車両２の安定した走行を実現させる。 Controller 24, by generating a control command for driving and controlling the steering actuator 26 and the accelerator pedal brake actuator 27 based on the information, thereby realizing a stable traveling of the following vehicle 2.

次に、先導車両１の制御装置１４によって実現される処理について図４及び図５を参照して説明する。 Will now be described with reference to FIGS. 4 and 5 for the process implemented by the control unit 14 of the leading vehicle 1.図４は、制御装置の機能を展開して示した機能ブロック図である。 Figure 4 is a functional block diagram showing expand the functions of the control device.制御装置１４は、例えば、ＣＰＵ（中央演算装置）、ＲＯＭ（Read Only Memory）、ＲＡＭ（Random Controller 14, for example, CPU (central processing unit), ROM (Read Only Memory), RAM (RandomAccess Memory）等から構成されている。 And an Access Memory) and the like.図４に示した各種機能を実現するための一連の処理の過程は、プログラムの形式でＲＯＭ等に記録されており、このプログラムをＣＰＵがＲＡＭ等に読み出して、情報の加工・演算処理を実行することにより、各種機能が実現される。 Process of the series of processing for realizing the various functions shown in FIG. 4 is recorded in a ROM or the like in the form of a program, this program the CPU reads the RAM, executes the processing and arithmetic processing of information by, various functions are realized.

図４に示されるように、制御装置１４は、位置姿勢推定部（位置姿勢推定手段）４１と、ランドマーク抽出部（ランドマーク抽出手段）４２と、環境マップ作成部（環境マップ作成手段）４３とを備えている。 As shown in FIG. 4, the control unit 14, a position and orientation estimation unit (position and orientation estimation means) 41, the landmark extraction section (landmark extracting means) 42, environmental map creation unit (environmental map creation means) 43 It is equipped with a door.位置姿勢推定部４１は、車速センサ１１から入力される車速とＩＭＵ１２から入力される姿勢データとをパラメータとし、ある原点からの位置と姿勢とを推定し、推定した位置及び姿勢（ｘ，ｙ，θ）を出力する。 Position and orientation estimation unit 41, and a posture data input from vehicle speed and IMU12 inputted from the vehicle speed sensor 11 as a parameter to estimate the position and orientation from one origin, estimated position and orientation (x, y, and it outputs the θ).位置姿勢推定部４１は、例えば、オドメトリを用いて自己の位置及び姿勢を推定する。 Position and orientation estimation unit 41, for example, to estimate its own position and orientation using odometry.オドメトリとは、例えば、車輪の回転数と操舵角とを累積することにより、ある原点に対する位置及び姿勢を追跡するという原理に基づくものであり、例えば、日本ロボット学会誌５巻５号、1987年10月、”自律移動ロボットの機構と移動制御技術”、５２頁から５８頁に開示されている。 The odometry, for example, by accumulating the engine speed and the steering angle of the wheel is based on the principle that track the position and orientation for a home, for example, Journal of the Robotics Society of Japan Vol. 5 No. 5, 1987 October, "mechanism and movement control technology of the autonomous mobile robot", is disclosed in page 58 of 52 pages.例えば、以下の（１）式を時間積分することで自己の位置及び姿勢を推定することが可能である。 For example, it is possible to estimate its own position and orientation by integrating the following formula (1) time.なお、オドメトリに用いられるパラメータは、上記車輪の回転数や操舵角に制約されるものではなく、これに関連する情報、例えば、車輪の回転速度やステアリング角度等を用いることとしてもよい。 The parameter used for odometry is not intended to be restricted to the speed and steering angle of the wheel, information related thereto, for example, may be used a rotational speed and a steering angle of the wheels.

この（１）式は、上記論文”自律移動ロボットの機構と移動制御技術”の５３頁の（４）式記載の式となる。 The equation (1), the above-mentioned article formula 53 pages (4), wherein the "mechanism and movement control technology of the autonomous mobile robot".ランドマーク抽出部４２は、レーザレーダ１３によって取得された環境情報から物体形状に関する所定の条件を満たす物体をランドマークとして抽出する。 Landmark extracting unit 42 extracts from the environment information acquired by the laser radar 13 satisfies a predetermined condition object relative to the object shape as a landmark.ランドマークとして抽出される物体は、例えば、ビルや木などのように直線部分を多く含み、ある程度の大きさがあるような認識されやすい物体であることが好ましい。 The object to be extracted as landmarks, for example, contains a large amount of linear portions, such as buildings and trees, it is preferred that a recognized easily object such as a certain degree of size.ランドマークの抽出については、ランドマークとして登録された物体の形状に関する特徴量を予め保有しており、これらの特徴量を所定値以上含む物体をランドマークとして抽出する。 For extraction of the landmarks, and pre-stores a feature quantity relating to the shape of the registered object as a landmark, and extracts an object comprising these feature amount greater than a predetermined value as a landmark.なお、レーザレーダ１３によって検出されたデータを数学的に解析することにより数値化し、この数値が予め設定されている閾値以上の物体をランドマークとして抽出することとしてもよい。 Incidentally, quantified by mathematically analyzing the data detected by the laser radar 13, the object above the threshold this number is set in advance may be extracted as landmarks.

ランドマーク抽出部４２は、ランドマークを抽出すると、抽出したランドマークの位置（Ｘｓ １ ，Ｙｓ １ ），・・・，（Ｘｓ ｎ ，Ｙｓ ｎ ）を出力する。 Landmark extracting unit 42, extracting landmark extracted location of the landmark (Xs 1, Ys 1), ···, and outputs a (Xsn, Ys n).このときのランドマークの位置は、先導車両１において予め設定されている基準点、例えば、レーザレーダ１３の設置位置を基準とした位置座標とされる。 Position of the landmark at this time, the reference point is preset in the leading vehicle 1, for example, be the position coordinates based on the installation position of the laser radar 13.

環境マップ作成部４３には、位置姿勢推定部４１からの自己の位置姿勢（ｘ，ｙ，θ）と、ｎ個のランドマーク位置（Ｘｓ １ ，Ｙｓ １ ），・・・，（Ｘｓ ｎ ，Ｙｓ ｎ ）とが入力される。 In the environment map creation unit 43, the self of the position and orientation of the position and orientation estimation unit 41 (x, y, θ) and, n-number of landmark position (Xs 1, Ys 1), ···, (Xs n, Ys n) and is input.環境マップ作成部４３は、ランドマーク抽出部４２によって抽出されたランドマークの位置（Ｘｓ １ ，Ｙｓ １ ），・・・，（Ｘｓ ｎ ，Ｙｓ ｎ ）と、そのランドマークが環境情報として取得されたときの自己の位置姿勢（ｘ，ｙ，θ）とに基づいて環境マップを作成する。 Environment map creation unit 43, the position of the landmark extracted by the landmark extracting unit 42 (Xs 1, Ys 1) , ···, (Xs n, Ys n) and is acquired the landmark as the environment information to create an environment map on the basis of self of the position and orientation (x, y, θ) and the time was.具体的には、環境マップ作成部４３は、自己の位置姿勢（ｘ，ｙ，θ）に基づいて、ランドマークの位置座標（Ｘｓ １ ，Ｙｓ １ ），・・・，（Ｘｓ ｎ ，Ｙｓ ｎ ）を変換することにより、車両の位置座標軸とランドマークの位置座標軸とを一致させ、車両とランドマークとの位置関係を示す環境マップを作成する。 Specifically, the environment map creation unit 43, based on its position and orientation (x, y, theta), the position coordinates of the landmark (Xs 1, Ys 1), ···, (Xs n, Ys n ) by converting, the position coordinate of the position coordinate and the landmark of the vehicle are matched to create an environment map showing the positional relationship between the vehicle and the landmark.

図５は、環境マップの一例を示した図である。 Figure 5 is a diagram showing an example of the environment map.このように、環境マップは、同じ位置座標軸（本実施形態ではＸ−Ｙ座標で表している）に対する先導車両１の自己の位置姿勢（ｘ，ｙ，θ）とランドマークの位置（Ｘ １ ，Ｙ １ ），・・・，（Ｘ ｎ ，Ｙ ｎ ）とが示された情報である。 Thus, the environment map is the same position coordinate position and orientation of the self leading vehicle 1 with respect to (and has expressed in the present embodiment in X-Y coordinates) (x, y, theta) and the position of the landmark (X 1, Y 1), ···, a (X n, Y n) and showed information.

制御装置１４において、位置姿勢推定部４１によって推定された自己の位置姿勢は累積されることにより、先導車両１の走行軌跡データが作成される。 In the control unit 14, the position and orientation of the self-estimated by the position and orientation estimation unit 41 by being accumulated, the traveling locus data of the leading vehicle 1 is created.制御装置１４において作成された上記環境マップと走行軌跡データとは、通信装置１５を介して後続車両２に送信される。 And the environmental map created in the control device 14 and the travel locus data is transmitted to the following vehicle 2 via the communication device 15.

次に、後続車両２が備える制御装置２４について図６を参照して説明する。 It will now be described with reference to FIG. 6 the control device 24 the following vehicle 2 is provided.図６は、制御装置２４の機能を展開して示した機能ブロック図である。 Figure 6 is a functional block diagram showing expand the functions of the control unit 24.制御装置２４は、上述した制御装置１４と同様に、ＣＰＵ（中央演算装置）、ＲＯＭ（Read Only Memory）、ＲＡＭ（Random The controller 24, in the same manner as the control device 14 described above, CPU (central processing unit), ROM (Read Only Memory), RAM (RandomAccess Memory）等から構成されている。 And an Access Memory) and the like.図６に示した各種機能を実現するための一連の処理の過程は、プログラムの形式でＲＯＭ等に記録されており、このプログラムをＣＰＵがＲＡＭ等に読み出して情報の加工・演算処理を実行することにより、各種機能が実現される。 Process of the series of processing for realizing the various functions shown in FIG. 6 is recorded in a ROM or the like in the form of a program, the program CPU executes processing and calculation processing of the information is read in the RAM or the like by various functions are realized.

図６に示すように、制御装置２４は、位置姿勢推定部（位置姿勢推定手段）５１と、地図照合部（地図照合手段）５２と、位置姿勢決定部（位置姿勢決定部）５３と、経路計画部（経路計画手段）５４と、走行制御部（走行制御手段）５５とを備えている。 As shown in FIG. 6, the controller 24 includes a position and orientation estimation unit (position and orientation estimation means) 51, a map matching section (map matching means) 52, and a position and orientation determination section (position and orientation determining unit) 53, route a planning unit (route planner) 54, the travel control unit (driving control means) and a 55.

上記位置姿勢推定部５１については、先導車両１の制御装置１４が備える位置姿勢推定部４１と同様であるので、説明を省略する。 For the position and orientation estimation unit 51 is the same as the position and orientation estimation unit 41 by the control unit 14 of the leading vehicle 1 is provided, the description thereof is omitted.地図照合部５２は、レーザレーダ（環境情報取得手段）２３により取得された周囲の環境情報と、先導車両１から受信した環境マップとを照合することにより、自己位置及び姿勢を推定する。 Map matching unit 52 by collating the surrounding environment information acquired by the laser radar (environment information obtaining means) 23, and the environment map received from the leading vehicle 1, to estimate the self-position and orientation.具体的には、地図照合部５２は、レーザレーダ２３により取得された環境情報の中から上述したランドマーク抽出部４２と同様にランドマークを抽出する。 Specifically, the map matching unit 52 extracts a landmark like the landmark extracting unit 42 described above from the environment information acquired by the laser radar 23.続いて、抽出したランドマークと先導車両１から受信した複数の環境マップとを照合することにより、自己のレーザレーダ２３によって取得されたランドマークに一致する環境マップのランドマークを特定する。 Then, by collating the plurality of environment map received extracted landmark from the leading vehicle 1, to identify landmarks in the environment map to match landmarks acquired by its own laser radar 23.そして、後続車両２からみたときのランドマークの位置、本実施形態では、ランドマークまでの距離ｒ n及び車両進行方向からの角度Ψ nと、環境マップにおける当該ランドマークの位置（ｘ ｎ 、ｙ ｎ ）とに基づいて、自己の位置姿勢（ｘ，ｙ，θ）を推定する。 The position of the landmarks when viewed from following vehicle 2, in this embodiment, the angle [psi n from the distance r n and the vehicle traveling direction to the landmark, the position of the landmark in the environment map (x n, y based on the n), and estimates its own position and orientation (x, y, θ).位置姿勢の推定には、例えば、最小二乗法が用いられる。 The estimation of the position and orientation, for example, the least squares method is used.具体的には、地図照合部５２は、以下に示す（１）式を用いて、自己の位置姿勢（ｘ，ｙ，θ）を推定する。 Specifically, the map matching unit 52, using the following equation (1), estimates its own position and orientation (x, y, theta).

図７に示されるように、上記（２）式において、Ψ ｉ （ｉ＝１，２，・・・ｎ）は車両進行方向からの角度、（ｘ ｉ 、ｙ ｉ ）は先導車両１にて得られたランドマークｉの位置である。 As shown in FIG. 7, in the above equation (2), Ψ i (i = 1,2, ··· n) is the angle from the vehicle traveling direction at (x i, y i) is the leading vehicle 1 obtained is the position of the landmark i.位置姿勢推定部５１は、レーザレーダ２３により得られたランドマークまでの距離ｒ i及び車両進行方向からの角度Ψ iと、環境マップから得られたランドマークの位置（ｘ i 、ｙ i ）とを上記（２）式に代入することにより、左辺の自己位置姿勢（ｘ，ｙ，θ）を得る。 Position and orientation estimation unit 51, the angle [psi i from the distance r i and the vehicle traveling direction to landmarks obtained by the laser radar 23, the position of the landmarks obtained from the environment map (x i, y i) and the by substituting the equation (2) above, to obtain a left side of the own position and orientation (x, y, theta).ここで、θ＝ａｔａｎ２（ｓｉｎθ，ｃｏｓθ）である。 Here, it is θ = atan2 (sinθ, cosθ).ａｔａｎ２（ｙ，ｘ）関数は、二つの変数ｘとｙに対する逆正接（アークタンジェント）を計算する。 atan2 (y, x) function computes the arctangent for the two variables x and y.これは、ｙ／ｘの逆正接を計算し、二つの引数の符号は結果の象限を決定するために用いられる。 It computes the arctangent of y / x, the sign of the two arguments are used to determine the quadrant of the result.

位置姿勢推定部５１によって推定された自己の位置姿勢（ｘｋ，ｙｋ，θｋ）及び地図照合部５２によって推定された自己の位置姿勢（ｘ，ｙ，θ）は、位置姿勢決定部５３に出力される。 Position and orientation estimation unit own position and orientation estimated by 51 (xk, yk, θk) and its position and orientation estimated by the map matching unit 52 (x, y, θ) is output to the position and orientation determination section 53 that.位置姿勢補正部５３は、位置姿勢推定部５１によって推定された自己の位置姿勢（ｘｋ，ｙｋ，θｋ）と地図照合部５２によって求められた自己の位置姿勢（ｘ，ｙ，θ）とをカルマンフィルタを用いて融合し、車両モデルを考慮した自己の位置姿勢を求め、これを最終的な自己の位置姿勢（Ｘ、Ｙ、Ｚ）として、経路計画部５４に出力する。 Position and orientation correcting unit 53, the position and orientation own position and orientation estimated by the estimator 51 (xk, yk, θk) and its position and orientation determined by the map matching unit 52 (x, y, θ) and the Kalman filter fused with, seek its own position and orientation in consideration of the vehicle model, which final own position and orientation (X, Y, Z) as the outputs to the path planner 54.経路計画部５４は、先導車両１から受信した走行軌跡データと位置姿勢決定部５３から入力された自己の位置姿勢（Ｘ，Ｙ，Ｚ）に基づいて先導車両１に追尾する走行経路を計画し、この走行経路を走行制御部５５に出力する。 Path planning unit 54, the position and orientation of the self input from the travel locus data and the position and orientation determination unit 53 received from the leading vehicle 1 (X, Y, Z) a travel route to track the leading vehicle 1 on the basis of the planned , and it outputs the travel route to the travel control unit 55.

走行制御部５５は、経路計画部５４によって作成された走行経路に基づいて、ステアリングアクチュエータ２６を制御するためのステアリング回転指令およびアクセルブレーキアクチュエータ２７を制御するためのアクセルブレーキ操作指令等を作成する。 Travel control unit 55 based on the travel route created by the route planning unit 54 generates an accelerator braking operation command or the like for controlling the steering rotation command and an accelerator brake actuator 27 for controlling the steering actuator 26.これにより、ステアリングアクチュエータ２６及びアクセルブレーキアクチュエータ２７が図示しない走行駆動用の制御部によって駆動制御されることにより、後続車両２の自動追尾走行が実現される。 Thus, by the steering actuator 26 and accelerator brake actuator 27 is driven and controlled by the control unit for the traveling drive (not shown), automatic tracking travel of the following vehicle 2 is achieved.

次に、本実施形態に係る追尾システムの作用について説明する。 Next, the operation of the tracking system according to this embodiment.まず、先導車両１において、人の運転により走行が開始されると、制御装置１４には、車速センサ１１、ＩＭＵ１２から車速、姿勢データが入力されるとともに、レーザレーダ１３から周囲の環境情報が入力される。 First, in the leading vehicle 1, when the running by the operation of the human is started, the control unit 14, a vehicle speed from the vehicle speed sensor 11, IMU12, along with orientation data is input, environmental information around the laser radar 13 is input It is.

制御装置１４において、位置姿勢推定部４１によりオドメトリを用いて自己の位置姿勢が推定される。 The control apparatus 14, its position and orientation is estimated by using the odometry the position and orientation estimation unit 41.また、ランドマーク抽出部４２によって環境情報からランドマークが抽出され、その位置情報が環境マップ作成部４３に出力される。 Moreover, the landmark from the environment information by the landmark extraction unit 42 is extracted, the position information is output to the environment map generating unit 43.環境マップ作成部ではランドマークの位置と位置姿勢推定部からの位置及び姿勢情報に基づいて環境マップが作成される。 The environment map creation unit environment map is created based on the position and orientation information from the position and the position and orientation estimation unit landmarks.環境マップ作成部４３によって作成された環境マップ、及び位置姿勢推定部によって推定される位置姿勢を累積することで求められる走行軌跡情報は、通信装置１５を介して後続車両に送信される。 Environment map created by the environment map generating unit 43, and the traveling locus information determined by accumulating the position and orientation estimated by the position and orientation estimation unit is transmitted to the following vehicles via the communication device 15.

後続車両２では、位置姿勢推定部５１により後続車両２の位置姿勢が推定されるとともに、地図照合部５２により環境マップとレーザレーダ２３により取得された周囲の環境情報に基づいて自己の位置姿勢が推定される。 In the following vehicle 2, together with the position and orientation of the following vehicle 2 is estimated by the position and orientation estimation unit 51, the own position and orientation based on the surrounding environment information acquired by the environment map and the laser radar 23 by the map matching unit 52 Presumed.位置姿勢推定部５１により推定された位置姿勢及び地図照合部５２により推定された位置姿勢とは、位置姿勢決定部５３に入力され、これらの位置姿勢を融合することで、より精度の高い位置姿勢が求められる。 The position and orientation estimated by the position and orientation estimation unit position and orientation and the map matching unit 52 estimated by 51, is input to the position and orientation determination unit 53, by fusing these position and orientation, a more accurate position and orientation is required.この位置姿勢は経路計画部５４に出力され、この位置姿勢に基づく走行経路が生成され、この走行経路に基づく駆動制御指令が走行制御部５５によって生成される。 The position and orientation is output to the path planner 54, the travel route based on the position and orientation is generated, the driving control command based on the travel route is generated by the travel control unit 55.これにより、ステアリングアクチュエータ２６およびアクセルブレーキアクチュエータ２７が走行制御部５５により与えられた走行指令に基づいて駆動することにより、後続車両２の追尾走行を可能とする。 Thus, by the steering actuator 26 and the accelerator pedal brake actuator 27 is driven based on the travel command given by the travel control unit 55, to allow tracking movement of the following vehicle 2.

以上説明してきたように、本実施形態に係る追尾システムによれば、先導車両１及び後続車両２ともに、ＧＰＳを用いずに車速と姿勢データとに基づいて自己の位置姿勢を推定するので、ＧＰＳが利用できない環境下であっても安定した位置姿勢推定を行うことが可能となる。 As described above, according to the tracking system of the present embodiment, the leading vehicle 1 and the following vehicle 2 together, so estimates its own position and orientation based on without using the GPS on the vehicle speed and the attitude data, GPS there even in an environment that is not available it is possible to perform a stable position and orientation estimation.これにより、後続車両２の安定した追尾走行が可能となる。 This enables stable tracking travel of the following vehicle 2.

〔第２の実施形態〕 Second Embodiment次に、本発明の第２の実施形態に係る追尾システムについて説明する。 Next, a description will be given tracking system according to a second embodiment of the present invention.第２の実施形態に係る追尾システムは、上述したレーザレーダ１３、２３に代えて、カメラを備える点で上述した第１の実施形態に係る追尾システムと異なる。 Tracking system according to the second embodiment, instead of the laser radar 13 and 23 described above, different from the tracking system according to the first embodiment described above in that it includes a camera.

本実施形態に係る追尾システムの先行車両１においては、カメラによって取得された画像情報がランドマーク抽出部４２に出力されることとなる。 In preceding vehicle 1 of the tracking system according to the present embodiment, so that the image information acquired by the camera is outputted to the landmark extracting unit 42.ランドマーク抽出部４２は、画像処理を行うことにより予め登録されている特徴量、例えば、カラー、エッジ等を抽出し、これらをランドマークとして抽出する。 Landmark extracting unit 42, the amount of features registered in advance by performing image processing, for example, to extract color, edges, etc., to extract them as landmarks.また、ランドマークの位置については、カメラの設置位置及び設置角度を予め登録しておくことにより推定が可能である。 Also, the position of the landmarks can be estimated by registering the installation position and installation angle of the camera in advance.環境マップ作成部４３では、カメラによって取得された画像情報に基づく環境マップが作成され、この環境マップが後続車両３に送信される。 In the environment map creation unit 43, the environment map is created based on the image information acquired by the camera, the environment map is transmitted to the following vehicle 3.

また、後続車両３においても、レーザレーダ２３に代えてカメラが設置されている。 Also in the following vehicle 3, a camera is installed in place of the laser radar 23.したがって、後続車両３の地図照合部５２は、カメラによって取得された周囲の画像情報と先導車両１から受信した環境マップとを照合することにより、自己の位置姿勢を推定し、この情報を位置姿勢決定部５３に出力する。 Thus, the map matching unit 52 of the following vehicle 3, by collating the environment map received image information of the surrounding acquired by the camera from the leading vehicle 1, and estimates its position and orientation, the information position and orientation and it outputs the determination section 53.環境マップに基づく自己の位置姿勢の推定等の手順については上述した第１の実施形態と同様である。 The procedure for estimating of treasury of the position and orientation based on the environment map is the same as the first embodiment described above.

本実施形態によれば、周辺の環境情報を取得する手段としてカメラを採用するので、レーザレーダ１３，２３を採用する場合と比較して、色情報の取得が可能となるとともに、広範囲による撮影が可能となるという利点がある。 According to this embodiment, since employing the camera as a means for obtaining the surrounding environment information, as compared with the case of adopting the laser radar 13 and 23, together with the acquisition of the color information can be, shooting by extensive It can become an advantage that.また、レーザレーダ１３，２３は、自己から信号を発するために相手に認識されてしまうが、カメラはパッシブタイプであることから相手に認識されずに周囲の環境情報を取得することができるという利点がある。 Further, an advantage that the laser radar 13 and 23, but would be recognized by the other party in order to generate a signal from the self, the camera can acquire the environmental information around without being recognized by the opponent from being a passive there is.

〔第３の実施形態〕 Third Embodiment次に、本発明の第３の実施形態に係る追尾システムについて説明する。 Next, a description will be given tracking system according to a third embodiment of the present invention.上述した第１及び第２の実施形態においては、図１に示したように、先導車両１が後続車両に対して環境マップと走行軌跡データとを送信し、各後続車両２はこの環境マップと走行軌跡データとに基づいて先導車両１の追尾走行をそれぞれ行っていた。 In the first and second embodiments described above, as shown in FIG. 1, the leading vehicle 1 transmits the environment map and the travel locus data to a following vehicle, the following vehicle 2 and the environment map traveling locus data and tracking travel of the leading vehicle 1 on the basis of the has been performed, respectively.本実施形態に係る追尾システムでは、図８に示すように、後続車両２ａにおいて、当該後続車両２ａが備えるレーザレーダ２３或いはカメラによって取得されたランドマークの情報に基づいて先導車両１から受信した環境マップを更新し、更新後の環境マップを自己よりも後方に位置する後続車両２ｂに送信することとしている。 The tracking system according to this embodiment, as shown in FIG. 8, the following vehicle 2a, is received from the leading vehicle 1 based on the following vehicles 2a laser radar 23 or the information of the landmark obtained by a camera provided in the environment update the map is set to be transmitted to the following vehicle 2b located behind the self environment map after update.

例えば、先導車両１が通過したときと後続車両が同じ場所を通過したときとで、周囲の環境が変化している場合がある。 For example, in a case where the following vehicle and when the leading vehicle 1 has passed has passed through the same place, there is a case where the surrounding environment is changing.例えば、ビルが取り壊されたり、木が倒れたりすることが考えられる。 For example, or a building is demolished, it is conceivable to or fallen trees.このような場合、先導車両１により作成される環境マップに示されているランドマークと後続車両２のレーザレーダ１３またはカメラによって取得される環境情報のランドマークとは一致しないこととなる。 In this case, so that it does not coincide with landmark environmental information obtained by the laser radar 13 or the camera of the following vehicle 2 and the landmark shown on the environment map created by the leading vehicle 1.

本実施形態に係る追尾システムでは、先導車両１からの環境マップにおけるランドマークと後続車両２ａにおいて撮影・抽出されたランドマークとが一致しなかった場合に、その不一致のランドマークを環境マップから削除することで、環境マップを更新する環境マップ更新機能（環境マップ更新手段）を地図照合部５２が備える。 Remove the tracking system according to this embodiment, when a landmark in the environment map from the leading vehicle 1 and Landmark taken-extracted in the following vehicle 2a do not coincide, the landmark of the discrepancy from the environment map by includes environmental map updating function for updating the environment map (environment map updating means) the map matching unit 52.そして、更新後の環境マップを自己よりも後方に位置する後続車両２ｂに対して送信する。 Then, the environment maps updated is transmitted to the following vehicle 2b located behind the self.これにより、後続車両２ｂはより新規な環境マップに基づく追尾走行が可能となり、追尾走行の精度を向上させることが可能となる。 Thus, the following vehicle 2b becomes possible more tracking travel based on a novel environment maps, it is possible to improve the accuracy of tracking travel.

〔第４の実施形態〕 Fourth Embodiment次に、本発明の第４の実施形態に係る追尾システムについて説明する。 Next, a description will be given tracking system according to a fourth embodiment of the present invention.本実施形態に係る追尾システムは、上述した各実施形態に係る追尾システムと略同様の構成を備えるが、先導車両１と後続車両２とが大きさや重量の面で異なる場合には、先導車両１と後続車両２とが同じ経路（例えば、高さ制限、重量制限のある経路）を走行できないという場合が考えられる。 Tracking system according to this embodiment has a tracking system substantially similar to the configuration according to the embodiments described above, when the leading vehicle 1 and the following vehicle 2 is different from the size and weight of the face, the leading vehicle 1 and the following vehicle 2 and the same path (e.g., height limit, there path of weight limit) cases can be considered that it can not travel.

このような場合に備えて、本実施形態に係る追尾システムの後続車両２は、自己が通過不可能な経路と、その経路の迂回経路とが対応付けられている地図情報を予め保有している。 In preparation for such a case, the following vehicle 2 tracking system according to this embodiment is pre-stores the path of self impassable, the map information and detour route of the path is associated with .そして、先導車両１が自己の通過不可能な経路を通過した場合には、その迂回経路として登録されている経路を保有している地図情報から取得し、取得した迂回経路を走行する。 When the leading vehicle 1 has passed through the passage impossible path of self acquires from the map information that hold path is registered as the detour path, it travels the obtained detour path.このように、自己が通過不可能な経路に代わる他の経路の情報を地図情報として有していることで、安定した追尾走行を続行することが可能となる。 By thus has information of another route in place of the self is not possible passage path as the map information, it is possible to continue a stable tracking driving.

また、上記通過不可能な経路だけでなく、例えば、駐車場等で先導車両と同じ場所に駐車できないような場合も考えられる。 Further, not only the path of the impassable, e.g., when in a parking lot or the like which can not be parked in the same place as the leading vehicle is also contemplated.このような場合に備えて、後続車両２は、自己が駐車不可能な駐車場所と、その駐車場所に代わる他の駐車場所とが対応付けられている地図情報を予め保有していてもよい。 In preparation for such a case, the following vehicle 2, and parking places itself impossible parking may be pre-stores the map information and other parking places in place of the parking place is associated.先導車両１が自己の駐車不可能な駐車場所に停止した場合には、その駐車場所に代わる他の駐車場所をこの地図情報から取得することで、このような場合にも対応することが可能となる。 When the leading vehicle 1 is stopped in the parking impossible parking places self, by acquiring other parking places in place of the parking place from the map information, and can cope with such a case Become.

以上、本発明の実施形態について図面を参照して詳述してきたが、具体的な構成はこの実施形態に限られるものではなく、本発明の要旨を逸脱しない範囲の設計変更等も含まれる。 Have been described above in detail with reference to the accompanying drawings, embodiments of the present invention, the specific configuration is not limited to this embodiment, design changes without departing from the scope of the present invention are also included.

〔変形例１〕 Modification 1]例えば、上述した各実施形態においては、先導車両１において、レーザレーダ１３またはカメラにより取得された周囲の環境情報の中から物体形状に関する所定の条件を満たすものをランドマークとして抽出し、このランドマークを用いて環境マップを作成していたが、このようなランドマークの抽出を省略し、レーザレーダ１３またはカメラにより検出された全ての物体の情報とその位置情報とに基づいて環境マップを作成することとしてもよい。 For example, in the above-described embodiments, the leading vehicle 1, a predetermined condition is satisfied regarding the object shape from the environmental information around obtained by the laser radar 13 or the camera is extracted as landmarks, the landmark using had created an environment map, omitting the extraction of such landmark, create an environment map based on all the object information detected by the laser radar 13 or the camera and its position information it is also possible.このように、検出された全ての物体の情報に基づいて環境マップを作成することで、周辺環境に関するより多くの情報を後続車両２に与えることが可能となる。 Thus, by creating an environment map based on the information of all detected objects it has been, it is possible to give more information about the surrounding environment to the following vehicle 2.

〔変形例２〕 Modification 2]上述した各実施形態における追尾システムにおいて、図９に示すように、先導車両１と後続車両２とを連結させる連結機構１００を先導車両１及び各後続車両２にそれぞれ設けることとしてもよい。 In the tracking system in each embodiment described above, as shown in FIG. 9, may be provided, respectively a connecting mechanism 100 for connecting the leading vehicle 1 and the following vehicle 2 to the leading vehicle 1 and the following vehicle 2.そして、通常の状態においては連結機構により先導車両１に後続車両２を連結させた状態で走行を行い、連結させた状態での走行が不可能な場合に限って各車両を分離させ、上述したような追尾走行を行うこととしてもよい。 Then, in the normal state perform traveling while being connected to the following vehicle 2 to the leading vehicle 1 by coupling mechanism, only if that can not be run in a state of being coupled to separate the vehicle, the above-described it may perform the tracking driving like.このように、必要な場合に限って追尾走行をさせることにより、先導車両１及び後続車両２における制御装置１４，２４の処理負担を軽減させることが可能となる。 In this way, by tracking travel only if necessary, it is possible to reduce the processing load of the control device 14, 24 in the leading vehicle 1 and the following vehicle 2.また、先導車両１と後続車両２とがそれほど距離を開けずに追尾走行するような場合には、後続車両２は長距離レーザレーダを搭載する必要がないために、精度の高くない廉価なセンサを利用することが可能となる。 Further, when the leading vehicle 1 and the following vehicle 2, such as to track the travel without opening the less distance is inexpensive sensor following vehicle 2 is not because there is no need to mount a long range laser radar, high accuracy it is possible to use.これにより、コスト面についても利点がある。 This has the advantage for the cost.

〔変形例３〕 [Modification 3]また、上述した各実施形態においては、先導車両１から後続車両２に対して走行軌跡データを送信することとしたが、走行軌跡データを省略し、環境マップのみを送信することとしてもよい。 Further, in the embodiments described above, it is assumed that transmitting the traveling locus data to the following vehicles 2 from the leading vehicle 1, omitting the traveling locus data, may be transmitted only environment map.この場合、走行軌跡データが送信されるのに比べて追尾走行の精度が低下することが予想されるが、追尾走行を実現するのに十分な精度は確保可能である。 In this case, the traveling locus data the accuracy of tracking travel compared to being sent is expected to be reduced, sufficient precision to achieve the tracking driving are possible ensured.

〔変形例４〕 [Modification 4]また、上記実施形態においては、ＧＰＳを用いずに位置姿勢を推定していたが、ＧＰＳを用いた位置姿勢の検出と組み合わせることとしてもよい。 Further, in the above-described embodiment, it was estimated position and orientation without a GPS, may be combined with the detection of the position and orientation using GPS.例えば、ＧＰＳによる位置情報の取得が可能な領域においては、ＧＰＳによる位置検出を優先させ、ＧＰＳによる位置情報の取得が不可能な領域においては、速度及び姿勢データに基づく位置姿勢推定を行う。 For example, in the area capable of acquiring positional information by the GPS is to prioritize the position detection by the GPS, the area acquisition is impossible for GPS location makes the location and orientation estimation based on the speed and orientation data.このようにすることで、位置姿勢の推定精度を向上させることが可能となり、この結果、追尾走行の精度を高めることが可能となる。 In this way, it is possible to improve the estimation accuracy of the position and orientation, as a result, it is possible to improve the accuracy of tracking travel.

〔変形例５〕 [Modification 5]また、上述した各実施形態においては、先導車両１のみが環境マップを作成し、後続車は先導車両１によって作成された環境マップに基づいて追尾走行を行うこととして説明したが、これに代えて、後続車両２が先導車両１の制御装置１４が備える機能を更に有していてもよい。 Further, in the above embodiments, only the leading vehicle 1 creates an environment map, although following vehicle has been described as performing the tracking driving based on the environmental map created by the leading vehicle 1, in place of this , the following vehicle 2 may further have a function provided in the control unit 14 of the leading vehicle 1.このように、後続車両２が先導車両１の備える機能を併せ持つことで、例えば、自己よりも前方を走行する車両と後方に位置する車両との両方が存在する場合に、先行する車両に対しては自己が後続車両２として機能することにより、先行する車両の追尾走行を行い、自己よりも後方に位置する車両に対しては先導車両１として振舞うことが可能となる。 Thus, by following vehicle 2 combines functions of the leading vehicle 1, for example, if both of the vehicle located in the vehicle and a rear running ahead than the self exists, against the preceding vehicle is by itself functions as a following vehicle 2 performs tracking driving of the preceding vehicle, it is possible to act as a lead vehicle 1 relative to the vehicle located behind the self.なお、制御装置１４と制御装置２４の機能を併せ持つ場合には、重複する機能について併用することとすればよい。 In the case where both the functions of the control unit 14 and the control unit 24 may be the be used together for the overlapping functions.

〔変形例６〕 [Modification 6]また、上述の各実施形態においては、先導車両１と後続車両２とが異なる車両である場合について説明したが、先導車両１と後続車両２とは同一の車両であってもよい。 Further, in the above embodiments, a case has been described in the leading vehicle 1 and the following vehicle 2 is different from the vehicle may be the same vehicle to the leading vehicle 1 and the following vehicle 2.例えば、車両が、一度走行した走行経路を、再度走行する場合がこれに該当する。 For example, the vehicle, once traveling the travel route, when traveling corresponds to this again.この場合、初回の走行において作成された走行軌跡データと環境マップとを記憶しておき、２度目以降の走行時においては、記憶しておいた走行軌跡データと環境マップとを読み出し、これらの情報に基づいて走行すればよい。 In this case, it stores the traveling locus data and the environmental map created in the running of the first, at the time of the second and subsequent run, reads the traveling locus data and the environmental map that has been stored, the information it may be traveling on the basis of.なお、この場合には、他の車両と通信を行う必要がないので、通信装置１５，２５を不要とすることができる。 In this case, since there is no need to communicate with other vehicles, it is possible to make the communication device 15, 25 is unnecessary.

〔変形例７〕 Modification 7]また、上記各実施形態においては、先導車両１と後続車両２とが直接的に通信を行うこととしたが、この態様に限らず、他の装置を経由して最終的に情報が後続車両２に届けられることとしてもよい。 In the above embodiments, it is assumed that a leading vehicle 1 and the following vehicle 2 communicates directly, not limited to this embodiment, eventually information following vehicle 2 via other devices it is also possible to be delivered to.

〔変形例８〕 Modification 8]上記各実施形態においては、先導車両１、後続車両２が自己の位置及び姿勢を推定する位置姿勢推定部４１，５１を備えていたが、これに代えて、他の方法により自己位置及び姿勢を推定することとしてもよい。 In the above embodiments, the leading vehicle 1, but the following vehicle 2 is equipped with a position and orientation estimation unit 41, 51 for estimating the position and orientation of the self, instead of this, the self-position and orientation by other methods it may be estimated.例えば、自己位置及び姿勢の取得については、ＧＰＳ、IMU,或いは先導車両、後続車両の行動を監視する他の監視装置等から自己位置及び姿勢を取得してもよい。 For example, for obtaining the self-position and orientation, GPS, IMU, or leading vehicle may acquire its own position and orientation from the other monitoring devices such as monitoring the behavior of the following vehicle.先導車両、後続車両の行動を監視する他の監視装置等とは、例えば、先導車両や後続車両が通過しそうな道に車両を特定するセンサを配置しておき、センサによって先導車両や後続車両が通過したことが確認された場合に、その位置及び姿勢を記憶することで、先導車両及び後続車両の位置及び姿勢や走行経路を管理するものが挙げられる。 Leading vehicle, such as other monitoring apparatus for monitoring the behavior of the following vehicle, for example, it should be placed in a sensor lead vehicle and the following vehicle to identify the vehicle likely road passes, the lead vehicle and the following vehicle by a sensor when it has passed is confirmed, by storing the position and orientation, include those for managing the position and orientation and travel path of the leading vehicle and following vehicle.より具体的には、センサを用いて車両を特徴付ける属性（例えば、形状、性質、温度、色、テクスチャー、シール、バーコード、反射材等）を捕らえ、位置姿勢を推定する。 More specifically, the attribute characterizing the vehicle using a sensor (e.g., shape, nature, temperature, color, texture, seals, bar code, reflective material, or the like) captures, to estimate the position and orientation.センサとしては、カメラ、レーザレーダ、磁気センサ、超音波センサ等が挙げられる。 The sensor, camera, laser radar, magnetic sensors, ultrasonic sensors, and the like.具体的な態様としては、例えば、車両にマーカ等を貼り付け、カメラによってこのマーカを検出することで車両の位置検出を行う。 Specific embodiments, for example, paste the marker or the like on the vehicle, detecting the position of the vehicle by detecting the marker by the camera.このように、他の装置から自己位置及び姿勢を取得することにより、先導車両及び後続車両において、位置姿勢推定部４１，５１並びに位置姿勢の推定に必要とされるセンサ類を省略することが可能となる。 Thus, by acquiring its own position and orientation from the other device, can be in the leading vehicle and following vehicle, to omit the sensors required for the estimation of the position and orientation estimation unit 41, 51 as well as the position and orientation to become.

本発明の第１の実施形態に係る追尾システムの全体構成を示した図である。 Is a diagram showing the overall structure of a tracking system according to a first embodiment of the present invention.図１に示した先導車両の全体概略構成を示した図である。 Is a diagram showing an overall schematic configuration of a leading vehicle shown in FIG.図１に示した後続車両の全体概略構成を示した図である。 Is a diagram showing an overall schematic configuration of a following vehicle shown in FIG.図２に示した先導車両の制御装置が備える機能を展開して示した機能ブロック図である。 It is a functional block diagram showing expand the control functions provided for leading vehicle shown in FIG.環境マップの一例を示した図である。 Is a diagram showing an example of the environment map.図３に示した後続車両の制御装置が備える機能を展開して示した機能ブロック図である。 It is a functional block diagram showing expand the control functions provided for the following vehicle shown in FIG.地図照合部による自己の位置姿勢推定について説明するための図である。 Is a diagram for describing its position and orientation estimation by the map matching unit.本発明の第３の実施形態に係る追尾システムについて示した図である。 Is a diagram showing the tracking system according to a third embodiment of the present invention.本発明の変形例２に係る追尾システムの全体構成について示した図である。 Is a diagram showing the overall structure of a tracking system according to Modification 2 of the present invention.

Claims (13)

Translated from Japanese

先導車両から与えられる情報に基づいて後続車両が追尾走行を行う追尾システムであって、 Following vehicle is a tracking system for tracking traveling based on information provided from the leading vehicle,先導車両は、 The leading vehicle,周辺の環境情報を取得する環境情報取得手段と、 And environmental information acquisition means for acquiring the environment information around,前記環境情報と自己位置及び姿勢とに基づいて、環境マップを作成する環境マップ作成手段と、 Based on the own position and orientation and the environment information, the environment map generating means for generating an environmental map,前記環境マップを送信する通信手段と を備え、 And a communication means for transmitting the environment map,前記後続車両は、 Said subsequent vehicle,前記先導車両によって作成された前記環境マップを受信する通信手段と、 Communication means for receiving the environment map created by the leading vehicle,周辺の環境情報を取得する環境情報取得手段と、 And environmental information acquisition means for acquiring the environment information around,前記環境情報取得手段により取得された環境情報と、前記先導車両によって作成された環境マップとを照合することにより、自己の位置及び姿勢を推定する地図照合手段と、 And environment information acquired by the environment information acquiring means, by collating the environmental map created by the leading vehicle, a map matching means for estimating its own position and orientation,前記地図照合手段によって推定された自己の位置及び姿勢を参照して、最終的な自己の位置及び姿勢を決定する位置姿勢決定手段と を備える追尾システム。 Tracking system comprising with reference to the position and orientation of the self-estimated by the map matching means, and a position and orientation determining means for determining the position and orientation of the final self.

前記先導車両は、前記環境情報取得手段によって取得された環境情報の中から、物体の属性に関する所定の条件を満たす物体をランドマークとして抽出するランドマーク抽出手段を更に備え、 It said leading vehicle, from the environment information acquired by the environment information acquisition unit further comprises a landmark extracting means for extracting a predetermined condition is satisfied object about attributes of the object as a landmark,前記環境マップ作成手段は、前記ランドマーク抽出手段によって抽出された前記ランドマークの位置と、前記環境情報が取得されたときの自己の位置及び姿勢とに基づいて前記環境マップを作成する請求項１に記載の追尾システム。 The environment map generating means, the position of the landmark extracted by the landmark extraction unit, according to claim 1 of generating the environment map on the basis of the own position and orientation at which the environmental information has been acquired tracking system as claimed in.

前記環境情報取得手段は、レーザレーダである請求項１または請求項２に記載の追尾システム。 The environment information acquisition means, a tracking system according to claim 1 or claim 2 is a laser radar.

前記環境情報取得手段はカメラである請求項１または請求項２に記載の追尾システム。 Tracking system according to claim 1 or claim 2 wherein the environment information obtaining means is a camera.

前記先導車両は、 Said leading vehicle,自己の位置と姿勢とに基づいて作成された走行軌跡データを送信し、 Sending the travel locus data created based on the own position and orientation,前記後続車両は、 Said subsequent vehicle,前記位置姿勢決定手段によって決定された最終的な自己の位置及び姿勢と、前記先導車両の走行軌跡データとに基づいて経路計画を作成する経路計画手段と、 And the final own position and orientation determined by the position and orientation determining means, route planning means for creating a route plan on the basis of the traveling locus data of said leading vehicle,前記経路計画手段によって作成された経路計画に基づいて自律走行を制御する走行制御手段と を更に備える請求項１から請求項４のいずれかに記載の追尾システム。 Tracking system according to any of claims 1 to 4, further comprising a running control means for controlling the autonomous driving based on the route planning by the path planning means.

前記後続車両は、自己が通過不可能な経路と、その経路の迂回経路とが対応付けられている地図情報を予め保有しており、前記先導車両が自己の通過不可能な経路を通過した場合には、その迂回経路として登録されている経路を前記地図情報から取得し、取得した前記迂回経路を走行する請求項１から請求項５のいずれかに記載の追尾システム。 The following vehicle is a route self is not passed, and pre-stores the map information and detour route of the path is associated, when the leading vehicle has passed the passage impossible route self , the tracking system according to any one of claims 1 to 5 which obtains the route which is registered as a detour route from the map information, traveling the acquired detour path.

前記後続車両は、自己が駐車不可能な駐車場所と、その駐車場所に代わる他の駐車場所とが対応付けられている地図情報を予め保有しており、前記先導車両が自己の駐車不可能な駐車場所に停止した場合には、その駐車場所に代わる他の駐車場所を前記地図情報から取得し、取得した前記駐車場所に駐車する請求項１から請求項６のいずれかに記載の追尾システム。 Said subsequent vehicle includes a parking place itself not parked, and pre-stores the map information and other parking places in place of the parking place is associated, said leading vehicle is self parking impossible If you stop the parking location, tracking system according to any one of claims 1 to 6 which acquires other parking places in place of the parking place from the map information, to park in the acquired parking place.

前記先導車両及び前記後続車両には、互いを連結するための連結機構が設けられている請求項１から請求項７のいずれかに記載の追尾システム。 It said leading the vehicle and the following vehicle, tracking system according to any one of claims 1 to 7 in which coupling mechanism for coupling each other are provided.

前記後続車両がｎ（ｎは２以上の整数）台存在し、隊列走行する場合において、 When said following vehicle is n to (n is an integer of 2 or more) stage exists, to row running,ｎ−１番目までの前記後続車両は、前記先導車両から受信した環境マップを、自己が備える前記環境情報取得手段により取得された環境情報に基づいて更新する環境マップ更新手段を備え、 Said subsequent vehicle until the (n-1) th has a environment map updating means for said environment map received from the leading vehicle is updated based on the obtained environment information to the environment information acquisition unit that itself comprises,更新後の前記環境マップを自己よりも後方に位置する前記後続車両に送信する請求項１から請求項８のいずれかに記載の追尾システム。 Tracking system according to any one of claims 1 to 8 to be transmitted to the following vehicle is located the environment map after update to the rear than the self.

前記更新後の前記環境マップは、自己よりも前方に位置する前記後続車両及び前記先導車両にも送信される請求項９に記載の追尾システム。 Wherein said environmental map after update, the following vehicle and tracking system of claim 9 is also transmitted to the leading vehicle than the self located in front.

先導車両から与えられる情報に基づいて後続車両が追尾走行を行う追尾システムに用いられる車両であって、 Following vehicle based on information provided from the leading vehicle is a vehicle for use in tracking system for tracking traveling,周辺の環境情報を取得する環境情報取得手段と、 And environmental information acquisition means for acquiring the environment information around,前記環境情報と自己の位置及び姿勢に基づいて、環境マップを作成する環境マップ作成手段と、 Based on the position and orientation of the environmental information and self, and the environment map creating means for creating an environmental map,前記環境マップを送信する通信手段と を備える車両。 Vehicle and a communication means for transmitting the environment map.

先導車両から与えられる情報に基づいて後続車両が追尾走行を行う追尾システムに用いられる車両であって、 Following vehicle based on information provided from the leading vehicle is a vehicle for use in tracking system for tracking traveling,他の車両において作成された環境マップを受信する通信手段と、 Communication means for receiving the environment map created in other vehicles,周辺の環境情報を取得する環境情報取得手段と、 And environmental information acquisition means for acquiring the environment information around,前記環境情報取得手段により取得された環境情報と、前記他の車両において作成された環境マップとを照合することにより、自己位置及び姿勢を推定する地図照合手段と、 By matching the environment information acquired by the environment information acquiring means, and the environment map created in the other vehicle, a map matching means for estimating its own position and orientation,前記地図照合手段によって推定された自己の位置及び姿勢を参照して、最終的な自己の位置及び姿勢を決定する位置姿勢決定手段と を備える車両。 Vehicle provided with reference to the position and orientation of the self-estimated by the map matching means, and a position and orientation determining means for determining the position and orientation of the final self.

先導車両から与えられる情報に基づいて後続車両が追尾走行を行う追尾方法であって、 Following vehicle is a tracking method for performing tracking travel on the basis of the information given from the leading vehicle,先導車両は、 The leading vehicle,周辺の環境情報を取得し、 To get the environmental information,前記環境情報と自己位置及び姿勢とに基づいて、環境マップを作成し、 It said environmental information and on the basis of the own position and orientation, creates an environment map,前記環境マップを送信し、 Transmitting the environment map,前記後続車両は、 Said subsequent vehicle,前記先導車両によって作成された前記環境マップを受信し、 Receiving the environment map created by the leading vehicle,周辺の環境情報を取得し、取得した周辺の環境情報と前記先導車両によって作成された環境マップとを照合することにより、自己の位置及び姿勢を推定し、 Acquires environmental information, by collating the environment maps created by the acquired surrounding environment information and the leading vehicle, and estimates its own position and orientation,推定した自己の位置及び姿勢を参照して、最終的な自己の位置及び姿勢を決定する追尾方法。 Tracking method with reference to the position and orientation of the estimated self, to determine the position and orientation of the final self.

JP2007328546A2007-12-202007-12-20 Tracking system and method as well as the vehicle ActiveJP5249577B2
(en)