JP6972528B2 - Self-position estimation method, mobile vehicle travel control method, self-position estimation device, and mobile vehicle travel control device - Google Patents
Self-position estimation method, mobile vehicle travel control method, self-position estimation device, and mobile vehicle travel control device Download PDFInfo
- Publication number
- JP6972528B2 JP6972528B2 JP2016195692A JP2016195692A JP6972528B2 JP 6972528 B2 JP6972528 B2 JP 6972528B2 JP 2016195692 A JP2016195692 A JP 2016195692A JP 2016195692 A JP2016195692 A JP 2016195692A JP 6972528 B2 JP6972528 B2 JP 6972528B2
- Authority
- JP
- Japan
- Prior art keywords
- moving body
- self
- traveling
- map
- track
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims description 32
- 238000012545 processing Methods 0.000 description 25
- 238000012937 correction Methods 0.000 description 8
- 238000001514 detection method Methods 0.000 description 7
- 230000002093 peripheral effect Effects 0.000 description 6
- 238000005259 measurement Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
Images
Landscapes
- Instructional Devices (AREA)
- Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
本発明は、自己位置推定方法、移動体の走行制御方法、自己位置推定装置、及び移動体の走行制御装置に関するものである。 The present invention relates to a self-position estimation method, a traveling control method for a moving body, a self-position estimation device, and a traveling control device for a moving body.
少ないデータ量で、精度よく、車両が走行した経路(走行軌跡)を再現する技術が知られている(特許文献1参照)。特許文献1では、走行軌跡を追従する際に、その経路が部分的に存在しない際は、中間点を打つことで補完している。
A technique for accurately reproducing a route (traveling locus) on which a vehicle has traveled with a small amount of data is known (see Patent Document 1). In
しかし、特許文献1では、走行軌跡を追従する際に、経路に対する車両の相対位置のズレは考慮していないため、相対位置のズレが発生した場合、追従制御が大きく乱れてしまう、という問題点があった。
However, in
本発明は、上記課題に鑑みて成されたものであり、その目的は、移動体の自己位置を正確に推定する自己位置推定方法、移動体の走行制御方法、自己位置推定装置、及び移動体の走行制御装置を提供することである。 The present invention has been made in view of the above problems, and an object thereof is a self-position estimation method for accurately estimating the self-position of a moving body, a traveling control method for the moving body, a self-position estimation device, and a moving body. Is to provide a traveling control device.
本発明の一態様に係わる自己位置推定方法は、地図上の走路に対する走行軌跡を記憶装置に予め登録し、移動体が現在走行している地図上の走路を判定し、現在走行している地図上の走路に対応した走行軌跡に対して、移動体の現在位置が所定範囲内に無い場合、移動体の現在位置を走行軌跡に近づける方向へ補正して、移動体の自己位置を推定する。 In the self-position estimation method according to one aspect of the present invention, a travel locus with respect to a track on a map is registered in advance in a storage device, a track on a map on which a moving object is currently traveling is determined, and a map currently traveled. If the current position of the moving body is not within a predetermined range with respect to the running locus corresponding to the upper running path, the current position of the moving body is corrected in a direction closer to the running locus, and the self-position of the moving body is estimated.
本発明の一態様によれば、移動体の自己位置を正確に推定することができる。 According to one aspect of the present invention, the self-position of the moving body can be accurately estimated.
図面を参照して、実施形態を説明する。図面の記載において同一部分には同一符号を付して説明を省略する。 An embodiment will be described with reference to the drawings. In the description of the drawings, the same parts are designated by the same reference numerals and the description thereof will be omitted.
(第1実施形態)
図1を参照して、第1実施形態に係る自己位置推定装置及び移動体(例えば、車両)の走行制御装置の構成を説明する。本実施形態に係る自己位置推定装置は、周囲センサ群1と、処理装置3(制御部)と、記憶装置4と、車両センサ群5とを備える。本実施形態に係る走行制御装置は、自己位置推定装置と、アクチュエータ群6とを備える。本実施形態に係る自己位置推定装置は、車両V(図2参照)に搭載され、車両Vの自己位置を推定する。走行制御装置は、自己位置推定装置が推定した自己位置に基づいて、登録されている走行軌跡に沿って車両Vを走行させる。
(First Embodiment)
With reference to FIG. 1, the configuration of the self-position estimation device and the travel control device of a moving body (for example, a vehicle) according to the first embodiment will be described. The self-position estimation device according to the present embodiment includes a
周囲センサ群1は、例えば、複数のレーザレンジファインダ(LRF)101、102と、複数のカメラ201、202とを備える。レーザレンジファインダ(LRF)101、102は、それぞれ照射したレーザ光の物標による反射光を受光することにより物標までの距離及び方位を検出する。カメラ201、202は、車両Vの周囲を撮像し、画像処理可能なデジタル画像を取得する。このように、周囲センサ群1は、車両Vの周囲に存在する物標をそれぞれ検出する複数のセンサからなる。周囲センサ群1には、このほかに、ソナー、レーダーが含まれていてもよい。車両Vの周囲に存在する物標には、車両Vの周囲の走路上に存在する白線、縁石、中央分離帯、ガードレール、リフレクタ等の走路境界を示す物標、停止線、横断歩道、制限速度等の路面標示、標識、信号機、電柱、歩道上の樹木などの道路構造物などの、地図上の自己位置を推定するために、手がかりとなる全てのものが含まれる。
The
図2は、周囲センサ群1が車両Vに搭載された状態を図示した一例である。LRF101、102は、例えば、車両Vの左右両側のフロントフェンダー近傍にそれぞれ搭載可能である。LRF101、102は、例えば、車両Vの前後方向Dに沿う回転軸として、照射するレーザ光の軌跡が路面に対する垂直面をなすように所定の走査角(例えば90°)でレーザ光を走査する。これにより、LRF101、102は、車両Vの左右方向に存在する縁石等の物標を検出することができる。LRF101、102は、逐次、検出した物標の形状を検出結果として処理装置3に出力する。
FIG. 2 is an example showing a state in which the
カメラ201、202は、例えば、車両Vの左右両側のドアミラーにそれぞれ搭載可能である。カメラ201、202は、例えば、CCD、CMOS等の固体撮像素子により画像を撮影する。カメラ201、202は、例えば、車両Vの側方の路面を撮影する。カメラ201、202は、逐次、撮影した画像を処理装置3に出力する。
The
記憶装置4は、車両Vが走行可能な走路をノード及びノード間を接続するリンクの組合せとして記憶している。更に、前記した走路に対する走行軌跡40を示す情報と、走路上又は走路周辺に存在する物標の位置情報を含む地図情報41とを記憶する。「走行軌跡40」とは、車両Vが実際に走行可能な軌跡であって、ノードとリンクの組合せにより表現される走路とは異なる概念である。
The
第1実施形態において「走行軌跡40」には、例えば、過去に車両V(自車)又は他車が実際に走行した軌跡及び、設計者が設計した軌跡が含まれる。記憶装置4には、車両Vの移動量から求められた車両Vが実際に走行した軌跡が、走行軌跡40として保存されている。また、他車が実際に走行した軌跡は、通信装置(図示せず)を介して受信され、走行軌跡40として記憶装置4に保存される。このように、記憶装置4には、地図上の走路に対して、実際に車両Vが走行可能な走行軌跡40が予め登録されている。
In the first embodiment, the "
記憶装置4は、半導体メモリ、磁気ディスク等から構成可能である。地図情報41に記録される物標(ランドマーク)は、例えば、停止線、横断歩道、横断歩道予告、区画線等を示す道路標示や、縁石等の構造物の他、周囲センサ群1により検出可能な種々の設備等を含む。
The
車両センサ群5は、GPS受信機51、アクセルセンサ52、ステアリングセンサ53、ブレーキセンサ54、車速センサ55、加速度センサ56、車輪速センサ57、及びヨーレートセンサなどのその他のセンサを備える。各センサ51〜57は処理装置3に接続され、逐次、各種の検出結果を処理装置3に出力する。処理装置3は、車両センサ群5の各検出結果を用いて、地図上の車両Vの位置を算出したり、単位時間における車両Vの移動量を示すオドメトリを算出したりすることができる。例えば、車両Vの移動量は、タイヤの回転数によるオドメトリ計測、ジャイロ、加速度センサを用いた慣性計測、GNSS(汎地球航法衛星システム)など衛星からの電波を受信する方法、さらに外界センサの計測値の変化から移動量の推定を行なうSLAM(Simultaneous Localization and Mapping)などさまざまな方策が考えられるが、いずれの方法を用いても構わない。
The
アクチュエータ群6は、パワーステアリングアクチュエータ61と、ブレーキアクチュエータ62と、アクセルペダルアクチュエータ63とを備える。パワーステアリングアクチュエータ61は、例えば、パワーステアリングの駆動モータであって、車両Vの操舵量を制御する。アクセルペダルアクチュエータ63は、アクセルペダルの踏み込み量を制御することにより、車両を駆動するモータ又はエンジンが生成するトルクを調整する。ブレーキアクチュエータ62は、ブレーキペダルの踏み量を調整する。
The actuator group 6 includes a
処理装置3は、周囲認識部31と、走行軌跡上位置推定部32(走路判定回路、走行軌跡上位置推定回路)と、地図上位置推定部33(地図上位置推定回路)と、自己位置補正部34と、走行制御部35(走行制御回路)とを有する。処理装置3は、例えば、中央演算処理装置(CPU)、メモリ、及び入出力I/F等を備える集積回路であるマイクロコントローラにより構成可能である。この場合、マイクロコントローラに予めインストールされたコンピュータプログラムをCPUが実行することにより、処理装置3を構成する複数の情報処理部(31〜35)が実現される。処理装置3を構成する各部は、一体のハードウェアから構成されてもよく、別個のハードウェアから構成されてもよい。マイクロコントローラは、例えば自動運転制御等の車両Vに関わる他の制御に用いる電子制御ユニット(ECU)と兼用されてもよい。
The processing device 3 includes a surrounding
周囲認識部31は、周囲センサ群1の検出結果に基づいて、車両Vの周囲に存在する物標と車両Vとの相対位置を検出する。
The
地図上位置推定部33は、物標と車両Vとの相対位置と、地図情報41における物標の位置とを照合する。換言すれば、地図情報41における物標の位置データと、周囲認識部31により検出された物標の相対位置データとをマッチングする。地図上位置推定部33は、上記した物標の位置の照合(マップ・マッチング)により、車両Vの地図上の自己位置を推定する。すなわち、車両Vの東西方向の位置(X座標)と、南北方向の位置(Y座標)と、方位角(ヨー角θ)とからなる合計3自由度の位置と姿勢角を推定する。自己位置を推定には様々なアルゴリズムが考案されており、本実施形態においては、その方法は限定しない。例えば、認識された物標(白線、停止線、走路境界)の線分情報、とそれに対応するマップの白線、停止線、走路境界の線分情報を元にして、これらの位置がなるべく合わさるよう誤差を最小化する方法が考えられる。
The position estimation unit 33 on the map collates the relative position between the target and the vehicle V with the position of the target in the
走行軌跡上位置推定部32は、記憶装置4に記憶された走行軌跡40上の自己位置を推定する。例えば、走行軌跡上位置推定部32は、GPS受信機51で受信した信号から得られるGPS位置情報と、現在走行している地図上の走路に対応した走行軌跡とを比較する。走行軌跡上位置推定部32は、先ず、車両Vが現在走行している地図上の走路を判定する。判定した走路に対応した走行軌跡に対して、GPSによる車両Vの現在位置が所定範囲内に無い場合、車両Vの現在位置を走行軌跡に近づける方向へ補正する。そして、走行軌跡上に垂線をおろした点を走行軌跡上の始点(自己位置)として推定する。例えば、「所定範囲」は、車線内の位置が大幅に変わらない程度の15cm以内と設定する。
The
例えば、走行軌跡上位置推定部32は、GPSによる車両Vの現在位置を、走行軌跡に対して垂直方向に補正する。走行軌跡上の自己位置は、通常の軌跡推定と異なり、原理的に方位角(ヨー角θ)の誤差は発生せず、走行軌跡に沿った方向にのみ誤差が発生する。よって、走行軌跡に沿った方向の誤差の影響を受けないようにするため、走行軌跡に対して垂直な方向に対してのみ、補正をおこなう。これにより、直線路などで、走行軌跡に対して垂直な方向の基準物標が少なく、走行軌跡に対して平行な方向に対して誤差が発生していた際、平行方向の誤差の影響を抑えて、補正を正確に実施することが可能となる。
For example, the
走行軌跡上位置推定部32は、走行軌跡に対してGPSによる車両Vの現在位置が所定範囲内に無く、且つ車両Vが直進している時に、車両Vの現在位置を走行軌跡に近づける方向へ補正してもよい。ここで、走行軌跡上の自己位置が仮に走行軌跡に沿った方向(進行方向)にずれ、且つ車両Vが交差点などで旋回動作を行っていた場合、方位角も含めて車両Vの自己位置に大きな誤差が発生することが考えられる。そこで、方位角の誤差を回避するため、直進時のみ補正をおこなう。これにより、車両Vの現在位置が走行軌跡に対して所定範囲内に近づくので、進行方向の位置ズレの影響を低減することが可能となる。
The
自己位置補正部34は、車両Vは必ず走行軌跡上を移動するという前提の元で、走行軌跡上位置推定部32により推定された走行軌跡上の自己位置から、車両Vの移動量分だけ、走行軌跡上を進めた点を最終的な自己位置の推定結果として算出する。具体的には、自己位置補正部34は、自己位置検出の処理サイクルにおいて、最後に採択された結果(走行軌跡上の自己位置)に、当該結果を観測した時刻から現在の時刻までの車両Vの移動量を加えることにより、最終的な車両Vの自己位置として算出する。
The self-
ここで、走行軌跡上位置推定部32により推定された走行軌跡上の自己位置、地図上位置推定部33により推定された地図上の自己位置は、車両の位置情報としてはそれぞれ誤差を含んでいる。走行軌跡上の自己位置は、それほど正確ではないが、大きくずれることがないという誤差の特徴を有する。地図上の自己位置は、正確であるが、時々大きくずれることがあるという誤差の特徴を有する。地図上の自己位置が大きくずれると、自動運転において、走行制御に大きな影響を与えるため、これをそのまま採用しないことが望ましい。
Here, the self-position on the travel locus estimated by the
そこで、処理装置3は、地図上位置推定部33により推定された地図上の自己位置と、走行軌跡上位置推定部32により推定された走行軌跡上の自己位置とを比較する。地図上の自己位置と走行軌跡上の自己位置との距離(ずれ量)が所定の閾値以下の場合、地図上の自己位置は大きくずれていない、と判断する。この場合、処理装置3は、地図上位置推定部33により推定された地図上の自己位置を、最終的な車両Vの自己位置として出力する。一方、距離が所定の閾値よりも大きい場合、照合の不具合により地図上の自己位置は大きくずれていると判断する。この場合、処理装置3は、自己位置補正部34により補正された走行軌跡上の自己位置を、最終的な車両Vの自己位置として出力する。
Therefore, the processing device 3 compares the self-position on the map estimated by the position estimation unit 33 on the map with the self-position on the travel locus estimated by the
走行制御部35は、アクチュエータ群6を制御することにより、最終的な車両Vの自己位置に基づいて、記憶装置4に登録されている走行軌跡40に沿って車両Vを走行させる。具体的には、走行制御部35は、周囲認識部31で得られた情報(レーンの位置、障害物の位置)と、処理装置3により算出された最終的な車両Vの自己位置と、地図情報41とから車両Vが走行する走行軌跡40を算出する。そして、パワーステアリングアクチュエータ61、ブレーキアクチュエータ62、アクセルペダルアクチュエータ63を制御して、算出した走行軌跡40に沿って車両Vを走行させる。
By controlling the actuator group 6, the
図3を参照して、図1の自己位置推定装置及び走行制御装置を用いた自己位置推定方法及び走行制御方法の一例を説明する。先ず、ステップS101において、自己位置推定装置は、周囲センサ群1を用いて車両Vの周囲を計測する。そして、周囲認識部31は、アクチュエータ群6の検出結果に基づいて、車両Vの周囲に存在する物標と車両Vとの相対位置を検出する。
An example of the self-position estimation method and the travel control method using the self-position estimation device and the travel control device of FIG. 1 will be described with reference to FIG. First, in step S101, the self-position estimation device measures the surroundings of the vehicle V using the surrounding
ステップS102に進み、走行軌跡上位置推定部32は、記憶装置4に記憶された走行軌跡40上の自己位置を推定する。具体的には、走行軌跡上位置推定部32は、先ず、車両Vが現在走行している地図上の走路を判定する。判定した走路に対応した走行軌跡に対して、GPSによる車両Vの現在位置が所定範囲内に無い場合、車両Vの現在位置を走行軌跡に近づける方向へ補正する。そして、走行軌跡上に垂線をおろした点を走行軌跡上の自己位置として推定する。このとき、車両Vの現在位置を走行軌跡に対して垂直方向に補正してもよい。更に、車両Vが直進している時に限り、車両Vの現在位置を補正してもよい。
Proceeding to step S102, the
ステップS103に進み、地図上位置推定部33は、物標と車両Vとの相対位置と、地図情報41における物標の位置とを照合することにより、車両Vの地図上の自己位置を推定する。
Proceeding to step S103, the position estimation unit 33 on the map estimates the self-position of the vehicle V on the map by collating the relative position between the target and the vehicle V with the position of the target in the
ステップS104に進み、処理装置3は、ステップS103で推定された地図上の自己位置と、ステップS102で推定された走行軌跡上の自己位置とを比較する。地図上の自己位置と走行軌跡上の自己位置との距離(ずれ量)が所定の閾値以下の場合(ステップS104でNO)、地図上の自己位置は大きくずれていないと判断する。そして、ステップS103で推定された地図上の自己位置を、最終的な車両Vの自己位置として採用する。 Proceeding to step S104, the processing apparatus 3 compares the self-position on the map estimated in step S103 with the self-position on the traveling locus estimated in step S102. When the distance (deviation amount) between the self-position on the map and the self-position on the traveling locus is equal to or less than a predetermined threshold value (NO in step S104), it is determined that the self-position on the map is not significantly deviated. Then, the self-position on the map estimated in step S103 is adopted as the final self-position of the vehicle V.
一方、地図上の自己位置と走行軌跡上の自己位置との距離が所定の閾値より大きい場合(ステップS104でYES)、地図上の自己位置は大きくずれていると判断して、ステップS105へ進む。 On the other hand, when the distance between the self-position on the map and the self-position on the traveling locus is larger than a predetermined threshold value (YES in step S104), it is determined that the self-position on the map is significantly deviated, and the process proceeds to step S105. ..
ステップS105において、自己位置補正部34は、ステップS102で推定された走行軌跡上の自己位置から、車両Vの移動量分だけ走行軌跡上を進めることにより、走行軌跡上の自己位置を補正する。処理装置3は、補正後の走行軌跡上の自己位置を、最終的な車両Vの自己位置として採用する。
In step S105, the self-
ステップS106に進み、走行制御部35は、アクチュエータ群6を制御することにより、最終的な車両Vの自己位置に基づいて、記憶装置4に登録されている走行軌跡40に沿って車両Vの駆動制御及び操舵制御を行う。
Proceeding to step S106, the
なお、車両Vが現在走行している地図上の走路のレーン情報を取得している場合に、第1実施形態に係わる自己位置推定方法を適用することができる。具体的に、車両V自らが、周囲センサ群1の検出結果に基づいて、車両Vが走行しているレーンを判定してもよい。或いは、車両Vが走行している走路を撮像する路上カメラにより取得された画像データに基づいて判定されたレーン情報を取得してもよい。
When the vehicle V has acquired the lane information of the track on the map where the vehicle V is currently traveling, the self-position estimation method according to the first embodiment can be applied. Specifically, the vehicle V itself may determine the lane in which the vehicle V is traveling based on the detection result of the surrounding
この場合、走行軌跡上位置推定部32は、GPSによる車両Vの現在位置を、車両Vが現在走行しているレーン内の位置へ補正することができる。
In this case, the
さらに、車両Vが車線逸脱防止支援システムによるレーンキープ制御を実施している場合においても、同様にして、第1実施形態に係わる自己位置推定方法を適用することができる。具体的には、車両Vがレーン内を走行するように車両Vが制御されている場合に、走行軌跡上位置推定部32は、GPSによる車両Vの現在位置を、車両Vが現在走行しているレーン内の位置へ補正することができる。
Further, even when the vehicle V implements the lane keep control by the lane departure prevention support system, the self-position estimation method according to the first embodiment can be applied in the same manner. Specifically, when the vehicle V is controlled so that the vehicle V travels in the lane, the
もし、地図上の自己位置が、レーンをまたぐほどの大きな誤差を含む場合においても、レーン内に収まるように、地図上の自己位置を補正できる。よって、たとえ、地図上の自己位置が信頼できない状況でも、レーンキープ制御によって自動運転を継続することが可能となる。このように、走行レーン情報を反映し、走行しているレーン内に現在位置を補正することで、レーンをまたぐ大きな誤差を補正することが可能となる。 Even if the self-position on the map contains a large error that crosses the lane, the self-position on the map can be corrected so that it fits within the lane. Therefore, even if the self-position on the map is unreliable, the automatic operation can be continued by the lane keep control. In this way, by reflecting the traveling lane information and correcting the current position in the traveling lane, it is possible to correct a large error across the lanes.
なお、前述したように、レーン情報を取得できていれば、レーンキープ制御していない場合であっても、レーン内に収まるように自己位置を補正することができる。これにより、自己位置の推定結果が信頼できない状況でも、レーンキープ制御を開始することができる。 As described above, if the lane information can be acquired, the self-position can be corrected so as to be within the lane even when the lane keep control is not performed. As a result, the lane keep control can be started even in a situation where the estimation result of the self-position is unreliable.
以上説明したように、第1実施形態によれば、センサを用いて得られた地図上の現在位置情報にずれがあったとしても、登録されている走行軌跡に対する誤差を縮小できるので、車両Vの自己位置を正確に推定することができる。 As described above, according to the first embodiment, even if there is a deviation in the current position information on the map obtained by using the sensor, the error with respect to the registered traveling locus can be reduced, so that the vehicle V can be used. The self-position of can be estimated accurately.
地図上の現在位置情報にずれがあったとしても、登録されている走行軌跡に対する誤差を縮小できるので、補正された現在位置に基づいて、登録されている走行軌跡に沿って車両Vを正確に走行させることができる。 Even if there is a deviation in the current position information on the map, the error with respect to the registered travel locus can be reduced, so the vehicle V can be accurately set along the registered travel locus based on the corrected current position. It can be run.
(第2実施形態)
第1実施形態では、車両V(自車)又は他車が実際に走行した軌跡を走行軌跡40の一例として説明した。第2実施形態では、走行軌跡40の他の例として、走路基準線を説明する。「走路基準線」とは、車両Vが実際に走行可能な線であって、当該線に沿って車両Vが走行するように、自動走行制御を行うことが可能な線である。つまり、実際に走行した軌跡の代わりに、実際に走行できると推測される予想軌跡線(走路基準線)を、走行軌跡40として、記憶装置4に予め記憶しておく。
(Second Embodiment)
In the first embodiment, the locus actually traveled by the vehicle V (own vehicle) or another vehicle has been described as an example of the
例えば、走路基準線は、地図情報41に含まれている、各走行レーンの幅方向の中心を示す線である。
For example, runway reference line are included in the
走行軌跡上位置推定部32は、現在走行している地図上の走路に対応した走路基準線に対して、車両Vの現在位置が所定範囲内に無い場合、車両Vの現在位置を走路基準線に近づける方向へ補正して、車両Vの自己位置を推定する。更に、走行軌跡上位置推定部32は、更に、現在走行している走路に対応した走行軌跡と、地図上の走路基準線とが所定偏差内にある場合に限り、車両Vの現在位置を補正してもよい。自己位置推定方法、移動体の走行制御方法の手順、自己位置推定装置、及び移動体の走行制御装置の構成は、第1実施形態と同じであり、説明を省略する。
When the current position of the vehicle V is not within a predetermined range with respect to the track reference line corresponding to the track on the map currently being traveled, the
実際に車両Vが走行した軌跡に誤差があり、正確に登録されていない場合でも、走行軌跡として、走路基準線を用いることで、軌跡に誤差に影響を受けずに現在位置の補正を行うことが可能となる。実際に走行した軌跡に含まれるノイズや不確実性を排除することが可能となり、ロバストネス(ロバスト性)の高い自己位置推定を行うことができる。 Even if there is an error in the locus on which the vehicle V actually travels and it is not registered accurately, the current position can be corrected without being affected by the error by using the track reference line as the travel locus. Is possible. It is possible to eliminate noise and uncertainty contained in the track actually traveled, and it is possible to estimate the self-position with high robustness (robustness).
上記のように、本発明の実施形態を記載したが、この開示の一部をなす論述及び図面はこの発明を限定するものであると理解すべきではない。この開示から当業者には様々な代替実施の形態、実施例及び運用技術が明らかとなろう。 As mentioned above, embodiments of the invention have been described, but the statements and drawings that form part of this disclosure should not be understood to limit the invention. This disclosure will reveal to those skilled in the art various alternative embodiments, examples and operational techniques.
実施形態では、最終的な車両Vの自己位置を算出する自己位置推定装置を、含む走行制御装置について説明したが、自己位置推定装置と走行制御装置とは異なるハードウェア(車載ECU)から構成されていてもよい。更に、スマートフォンなどの移動端末を用いて、自己位置推定装置を実現してもよい。具体的には、移動端末を車両Vのネットワーク(CAN)に接続して、図1の処理装置3内の機能ブロック(31〜34)を実現することも可能である。 In the embodiment, the travel control device including the self-position estimation device for calculating the final self-position of the vehicle V has been described, but the self-position estimation device and the travel control device are composed of different hardware (vehicle-mounted ECU). May be. Further, a self-position estimation device may be realized by using a mobile terminal such as a smartphone. Specifically, it is also possible to connect the mobile terminal to the network (CAN) of the vehicle V to realize the functional block (31 to 34) in the processing device 3 of FIG.
移動体には、陸上を移動する移動物体としての車両Vに限定されず、船舶、航空機、宇宙機、その他の移動物体が含まれる。 The moving body is not limited to the vehicle V as a moving object moving on land, and includes a ship, an aircraft, a spacecraft, and other moving objects.
上述の各実施形態で示した各機能は、1又は複数の処理回路により実装され得る。処理回路は、電気回路を含む処理装置等のプログラムされた処理装置を含む。処理装置は、また、実施形態に記載された機能を実行するようにアレンジされた特定用途向け集積回路(ASIC)や従来型の回路部品のような装置を含む。 Each function shown in each of the above embodiments may be implemented by one or more processing circuits. The processing circuit includes a programmed processing device such as a processing device including an electric circuit. Processing devices also include devices such as application specific integrated circuits (ASICs) and conventional circuit components arranged to perform the functions described in the embodiments.
1 周囲センサ群(センサ)
3 処理装置(制御部)
4 記憶装置
5 車両センサ群(センサ)
32 走行軌跡上位置推定部(走路判定回路、走行軌跡上位置推定回路)
33 地図上位置推定部(地図上位置推定回路)
35 走行制御部(走行制御回路)
40 走行軌跡
V 車両(移動体)
1 Peripheral sensor group (sensor)
3 Processing device (control unit)
4
32 Track position estimation unit (track determination circuit, track position estimation circuit)
33 Map position estimation unit (Map position estimation circuit)
35 Driving control unit (driving control circuit)
40 Travel locus V Vehicle (moving body)
Claims (9)
地図上の走路に対する走行軌跡を記憶装置に予め登録し、
前記制御部は、前記移動体が現在走行している地図上の走路を判定し、
前記制御部は、前記現在走行している地図上の走路に対応した前記走行軌跡に対して、前記移動体の現在位置が所定範囲内に無い場合、前記現在位置を走行軌跡に近づける方向へ補正して、前記移動体の自己位置を推定する
ことを特徴とする自己位置推定方法。 In the self-position estimation method using a control unit that estimates the self-position of the moving body based on the current position information on the map of the moving body obtained by using the sensor mounted on the moving body.
The track for the track on the map is registered in the storage device in advance, and the track is registered in the storage device.
The control unit determines the track on the map on which the moving body is currently traveling, and determines the track on the map.
When the current position of the moving body is not within a predetermined range, the control unit corrects the current position toward the traveling locus with respect to the traveling locus corresponding to the running track on the currently traveling map. A self-position estimation method comprising estimating the self-position of the moving body.
前記現在位置を、前記移動体が現在走行しているレーン内の位置へ補正する
ことを特徴とする請求項1〜3のいずれか一項に記載の自己位置推定方法。 The control unit acquires lane information of the track on the map on which the moving body is currently traveling, and obtains lane information.
The self-position estimation method according to any one of claims 1 to 3, wherein the current position is corrected to a position in a lane in which the moving body is currently traveling.
前記現在走行している地図上の走路に対応した前記走路基準線に対して、前記移動体の現在位置が所定範囲内に無い場合、前記現在位置を前記走路基準線に近づける方向へ補正して、前記移動体の自己位置を推定する
ことを特徴とする請求項1〜5のいずれか一項に自己位置推定方法。 The travel locus is a track reference line on which a moving body can actually travel.
If the current position of the moving body is not within a predetermined range with respect to the track reference line corresponding to the track on the currently traveling map, the current position is corrected in a direction closer to the track reference line. The self-position estimation method according to any one of claims 1 to 5, wherein the self-position of the moving body is estimated.
前記移動体が現在走行している地図上の走路を判定し、
前記現在走行している地図上の走路に対応した前記走行軌跡に対して、前記移動体の現在位置が所定範囲内に無い場合、前記現在位置を走行軌跡に近づける方向へ補正し、
補正された現在位置に基づいて、登録されている走行軌跡に沿って移動体を走行させる
ことを特徴とする移動体の走行制御方法。 In a traveling control method of a moving body using a traveling control device in which a traveling locus for a running path on a map is registered in advance and the moving object is traveled along the registered traveling locus, the traveling control device is used.
The track on the map on which the moving object is currently traveling is determined, and the track is determined.
If the current position of the moving body is not within a predetermined range with respect to the traveling locus corresponding to the traveling track on the map currently traveling, the current position is corrected in a direction closer to the traveling trajectory.
A running control method for a moving body, which comprises running the moving body along a registered running locus based on the corrected current position.
予め地図上の走路に対する走行軌跡を登録する記憶装置と、
前記移動体が現在走行している地図上の走路を判定し、前記現在走行している地図上の走路に対応した前記走行軌跡に対して、前記移動体の現在位置が所定範囲内に無い場合、前記現在位置を走行軌跡に近づける方向へ補正して、前記移動体の自己位置を推定する制御部と、
を備えることを特徴とする自己位置推定装置。 A sensor mounted on the moving body and measuring the current position information on the map of the moving body is provided, and the self-position of the moving body is determined based on the current position information on the map of the moving body obtained from the sensor. In the self-position estimation device for estimation
A storage device that registers the travel trajectory for the track on the map in advance,
When the current position of the moving body is not within a predetermined range with respect to the running track corresponding to the running path on the map on which the moving body is currently traveling by determining the running path on the map where the moving body is currently traveling. , A control unit that estimates the self-position of the moving body by correcting the current position in a direction closer to the traveling locus.
A self-position estimation device characterized by comprising.
前記移動体が現在走行している地図上の走路を判定する走路判定回路と、
前記現在走行している地図上の走路に対応した前記走行軌跡に対して、前記移動体の現在位置が所定範囲内に無い場合、前記現在位置を走行軌跡に近づける方向へ補正する走行軌跡上位置推定回路と、
補正された現在位置に基づいて、登録されている走行軌跡に沿って移動体を走行させる走行制御回路と
を有することを特徴とする移動体の走行制御装置。 In a traveling control device for a moving body, which registers a traveling locus for a track on a map in advance and causes the moving object to travel along the registered traveling locus.
A track determination circuit that determines the track on the map on which the moving object is currently traveling, and a track determination circuit.
When the current position of the moving body is not within a predetermined range with respect to the running locus corresponding to the running track on the map currently running, the position on the running locus that corrects the current position in a direction closer to the running locus. The estimation circuit and
A traveling control device for a moving body, which comprises a traveling control circuit for traveling the moving object along a registered traveling locus based on a corrected current position.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016195692A JP6972528B2 (en) | 2016-10-03 | 2016-10-03 | Self-position estimation method, mobile vehicle travel control method, self-position estimation device, and mobile vehicle travel control device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016195692A JP6972528B2 (en) | 2016-10-03 | 2016-10-03 | Self-position estimation method, mobile vehicle travel control method, self-position estimation device, and mobile vehicle travel control device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2018059742A JP2018059742A (en) | 2018-04-12 |
JP6972528B2 true JP6972528B2 (en) | 2021-11-24 |
Family
ID=61907533
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2016195692A Active JP6972528B2 (en) | 2016-10-03 | 2016-10-03 | Self-position estimation method, mobile vehicle travel control method, self-position estimation device, and mobile vehicle travel control device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6972528B2 (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2022151005A (en) | 2021-03-26 | 2022-10-07 | トヨタ自動車株式会社 | Driving road identification device, driving road identification method, and computer program for driving road identification |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01213514A (en) * | 1988-02-20 | 1989-08-28 | Matsushita Electric Ind Co Ltd | On-vehicle navigator |
JP4680131B2 (en) * | 2006-05-29 | 2011-05-11 | トヨタ自動車株式会社 | Own vehicle position measuring device |
JP4794384B2 (en) * | 2006-07-26 | 2011-10-19 | アルパイン株式会社 | Vehicle position correcting apparatus and vehicle position correcting method |
JP4553033B2 (en) * | 2008-05-15 | 2010-09-29 | 株式会社デンソー | Current position calculation device and program |
JP5506339B2 (en) * | 2009-11-19 | 2014-05-28 | 三菱重工業株式会社 | Direction control device and direction control method |
US8442763B2 (en) * | 2010-04-16 | 2013-05-14 | CSR Technology Holdings Inc. | Method and apparatus for geographically aiding navigation satellite system solution |
-
2016
- 2016-10-03 JP JP2016195692A patent/JP6972528B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2018059742A (en) | 2018-04-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP7301909B2 (en) | Determination of yaw error from map data, lasers, and cameras | |
Tao et al. | Mapping and localization using GPS, lane markings and proprioceptive sensors | |
US10384679B2 (en) | Travel control method and travel control apparatus | |
CN108628324B (en) | Unmanned vehicle navigation method, device, equipment and storage medium based on vector map | |
US20200018852A1 (en) | System and method for calibrating a lidar and a camera together using semantic segmentation | |
RU2668459C1 (en) | Position evaluation device and method | |
JP6881464B2 (en) | Self-position estimation method and self-position estimation device | |
Cui et al. | Real-time global localization of robotic cars in lane level via lane marking detection and shape registration | |
US11015940B2 (en) | Systems and methods for longitudinal position correction of a vehicle using mapped landmarks | |
KR20220033477A (en) | Appratus and method for estimating the position of an automated valet parking system | |
US11761787B2 (en) | Map information correction method, driving assistance method, and map information correction device | |
JP6989284B2 (en) | Vehicle position estimation device and program | |
JP7418196B2 (en) | Travel trajectory estimation method and travel trajectory estimation device | |
JP6943127B2 (en) | Position correction method, vehicle control method and position correction device | |
JP7321035B2 (en) | OBJECT POSITION DETECTION METHOD AND OBJECT POSITION DETECTION DEVICE | |
JP6838365B2 (en) | Self-position estimation method and self-position estimation device | |
JP6834401B2 (en) | Self-position estimation method and self-position estimation device | |
US11619495B2 (en) | Position estimating apparatus and position estimating method | |
JP6972528B2 (en) | Self-position estimation method, mobile vehicle travel control method, self-position estimation device, and mobile vehicle travel control device | |
JP2018159752A (en) | Method and device for learning map information | |
CN113375679A (en) | Lane level positioning method, device and system and related equipment | |
JP6848531B2 (en) | Target position estimation method and target position estimation device | |
JP7084792B2 (en) | Travel locus estimation method and travel locus estimation device | |
US20240067211A1 (en) | Method and apparatus for operating a vehicle for highly automated driving, and vehicle for highly automated driving | |
JP2020008376A (en) | Travel trajectory estimating method and travel trajectory estimating device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20190826 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20200728 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20200908 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20210126 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20210318 |
|
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: 20211005 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20211018 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 6972528 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |