JP2021030980A - Travel support method and travel support apparatus - Google Patents
Travel support method and travel support apparatus Download PDFInfo
- Publication number
- JP2021030980A JP2021030980A JP2019155696A JP2019155696A JP2021030980A JP 2021030980 A JP2021030980 A JP 2021030980A JP 2019155696 A JP2019155696 A JP 2019155696A JP 2019155696 A JP2019155696 A JP 2019155696A JP 2021030980 A JP2021030980 A JP 2021030980A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- self
- target
- error
- detection
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 30
- 238000001514 detection method Methods 0.000 claims abstract description 290
- 238000004364 calculation method Methods 0.000 description 60
- 238000012937 correction Methods 0.000 description 18
- 230000001133 acceleration Effects 0.000 description 8
- 238000004891 communication Methods 0.000 description 8
- 230000009471 action Effects 0.000 description 5
- 230000006399 behavior Effects 0.000 description 5
- 239000000696 magnetic material Substances 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 239000004065 semiconductor Substances 0.000 description 2
- 230000001154 acute effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 230000001186 cumulative effect Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000013179 statistical model Methods 0.000 description 1
Images
Landscapes
- Navigation (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
Description
本発明は、走行支援方法及び走行支援装置に関する。 The present invention relates to a traveling support method and a traveling support device.
自車両の自己位置を検出し、自己位置に基づいて自車両の走行を支援する技術が提案されている。例えば特許文献1により提案される技術では、交通情報に基づいて走行経路上の区間ごとに設定速度を設定し、自車両の位置(自己位置)がいずれの区間内であるかに基づいて、自車の速度を現区間の設定速度で制御する。 A technique has been proposed in which the self-position of the own vehicle is detected and the running of the own vehicle is supported based on the self-position. For example, in the technique proposed by Patent Document 1, the set speed is set for each section on the traveling route based on the traffic information, and the vehicle itself is based on which section the position (self-position) of the own vehicle is within. The speed of the vehicle is controlled by the set speed of the current section.
自己位置の検出には誤差があるため、自己位置に基づいて自車両の走行を支援する際には、自己位置の検出誤差を推定して検出誤差に応じたマージンを設ける必要がある。
しかしながら、検出誤差の推定値が実際の検出誤差より大きいと不要にマージンが大きくなって過度に安全側に偏った走行支援となり、反対に検出誤差の推定値が実際の検出誤差より小さいと必要なマージンが確保されないおそれがある。
Since there is an error in detecting the self-position, when supporting the running of the own vehicle based on the self-position, it is necessary to estimate the detection error of the self-position and provide a margin according to the detection error.
However, if the estimated value of the detection error is larger than the actual detection error, the margin becomes unnecessarily large and the driving support is excessively biased toward the safe side. On the contrary, if the estimated value of the detection error is smaller than the actual detection error, it is necessary. Margin may not be secured.
例えば特許文献1の例において、現在走行中の区間の設定速度よりも次の区間の設定速度が低い場合に、検出誤差の推定値が実際の検出誤差より大きいと、不要に早く手前で減速して低い車速で走行する距離が長くなるおそれがある。反対に検出誤差の推定値が実際の検出誤差より小さいと、設定速度を超える速度で次の区間に進入してしまうおそれがある。
そこで本発明は、自車両が任意の目標地点に到達した時点における自己位置の検出誤差を閾値以下に抑えることを目的とする。
For example, in the example of Patent Document 1, when the set speed of the next section is lower than the set speed of the currently running section and the estimated value of the detection error is larger than the actual detection error, the vehicle decelerates unnecessarily quickly. There is a risk that the distance traveled at a low vehicle speed will be long. On the contrary, if the estimated value of the detection error is smaller than the actual detection error, the next section may be entered at a speed exceeding the set speed.
Therefore, an object of the present invention is to suppress the detection error of the self-position at the time when the own vehicle reaches an arbitrary target point to the threshold value or less.
本発明の一態様に係る走行支援方法では、自車両の地図上の現在位置である自己位置を検出し、自車両を到達させる目標地点を設定し、自己位置から目標地点まで自車両を走行させる複数の走行軌道候補を生成し、将来、目標地点に到達した時点において検出される自己位置の検出誤差を走行軌道候補毎に推定し、複数の走行軌道候補のうち検出誤差が閾値以下になる走行軌道候補のいずれかを目標走行軌道として選択し、選択された目標走行軌道を走行するよう自車両の走行を支援する。 In the traveling support method according to one aspect of the present invention, the self-position which is the current position on the map of the own vehicle is detected, a target point for reaching the own vehicle is set, and the own vehicle is traveled from the self-position to the target point. A plurality of travel track candidates are generated, the detection error of the self-position detected when the target point is reached in the future is estimated for each travel track candidate, and the detection error among the plurality of travel track candidates is equal to or less than the threshold value. One of the track candidates is selected as the target running track, and the running of the own vehicle is supported so as to run on the selected target running track.
本発明の一態様によれば、自車両が任意の目標地点に到達した時点における自己位置の検出誤差を閾値以下に抑えることができる。 According to one aspect of the present invention, the detection error of the self-position at the time when the own vehicle reaches an arbitrary target point can be suppressed to the threshold value or less.
(第1実施形態)
(構成)
以下、本発明の実施形態について、図面を参照しつつ説明する。なお、各図面は模式的なものであって、現実のものとは異なる場合がある。また、以下に示す本発明の実施形態は、本発明の技術的思想を具体化するための装置や方法を例示するものであって、本発明の技術的思想は、構成部品の構造、配置等を下記のものに特定するものではない。本発明の技術的思想は、特許請求の範囲に記載された請求項が規定する技術的範囲内において、種々の変更を加えることができる。
(First Embodiment)
(Constitution)
Hereinafter, embodiments of the present invention will be described with reference to the drawings. It should be noted that each drawing is a schematic one and may differ from the actual one. Further, the embodiments of the present invention shown below exemplify devices and methods for embodying the technical idea of the present invention, and the technical idea of the present invention includes the structure, arrangement, etc. of components. Is not specified as the following. The technical idea of the present invention may be modified in various ways within the technical scope specified by the claims stated in the claims.
自車両1は、自車両1の走行支援を行う走行支援装置10を備える。走行支援装置10は、自車両1の周囲の道路形状や地物、ランドマーク等の物標の検出結果や、オドメトリ、衛星測位システム等に基づいて自車両1の現在位置である自己位置を検出し、検出した自己位置に基づいて自車両1の走行を支援する。
なお、オドメトリによる自己位置の検出手法は、移動体の左右の車輪の回転角と回転角速度に応じて移動体の移動距離と方向を求めることにより移動体の自己位置を推定する公知の手法の1つである。
The own vehicle 1 includes a running
The method for detecting the self-position by odometry is one of the known methods for estimating the self-position of the moving body by obtaining the moving distance and direction of the moving body according to the rotation angle and the rotation angular velocity of the left and right wheels of the moving body. It is one.
例えば、走行支援装置10は、検出した自己位置と周辺の走行環境とに基づいて、運転者が関与せずに自車両1を自動で運転する自律走行制御を行うことによって運転を支援する。なお、推定した自己位置と周辺の走行環境とに基づいて操舵角のみあるいは加減速のみを制御するなど、自車両1の走行に関わる運転動作を部分的に支援してもよい。以下、走行支援として、運転者が関与せずに自車両1を自動で運転する自律走行制御を行って走行支援を行う例を記載する。
For example, the
走行支援装置10は、衛星測位装置11と、地図データベース12と、周囲環境センサ13と、車両センサ14と、既知領域データベース15と、コントローラ16と、ナビゲーションシステム17と、アクチュエータ18と、ユーザインタフェース装置19と、を備える。
図面において、地図データベース、既知領域データベース及びユーザインタフェース装置を、それぞれ「地図DB」、「既知領域DB」及び「ユーザI/F装置」と表記する。
The
In the drawings, the map database, the known area database, and the user interface device are referred to as "map DB", "known area DB", and "user I / F device", respectively.
衛星測位装置11は、衛星測位システムにより自車両1の現在位置を測定する。衛星測位装置11は、例えば全地球型測位システム(GNSS)受信機を備えてよい。GNSS受信機は、例えば地球測位システム(GPS)受信機等であり、複数の航法衛星から電波を受信して自車両1の現在位置を測定する。
地図データベース12は、フラッシュメモリ等の記憶装置に格納され、自車両1の自己位置の推定に必要な道路形状や地物、ランドマーク等の物標の位置及び種類などの地図情報を記憶している。
The
The
地図データベース12として、例えば、自律走行用の地図として好適な高精度地図データ(以下、単に「高精度地図」という。)を記憶してよい。高精度地図は、ナビゲーション用の地図データ(以下、単に「ナビ地図」という。)よりも高精度の地図データであり、道路単位の情報よりも詳細な車線単位の情報を含む。
例えば、高精度地図は車線単位の情報として、車線基準線(例えば車線内の中央の線)上の基準点を示す車線ノードの情報と、車線ノード間の車線の区間態様を示す車線リンクの情報を含む。
As the
For example, in a high-precision map, lane-based information includes lane node information indicating a reference point on a lane reference line (for example, a central line in a lane) and lane link information indicating a lane section mode between lane nodes. including.
車線ノードの情報は、その車線ノードの識別番号、位置座標、接続される車線リンク数、接続される車線リンクの識別番号を含む。車線リンクの情報は、その車線リンクの識別番号、車線の種類、車線の幅員、車線境界線の種類、車線の形状、車線区分線の形状、車線基準線の形状を含む。高精度地図は更に、車線上又はその近傍に存在する信号機、停止線、標識、建物、電柱、縁石、横断歩道等の地物やランドマークといった物標の種類及び位置座標と、これらの位置座標に対応する車線ノードの識別番号及び車線リンクの識別番号等の、物標の情報を含む。 The lane node information includes the identification number of the lane node, the position coordinates, the number of connected lane links, and the identification number of the connected lane links. The lane link information includes the identification number of the lane link, the type of lane, the width of the lane, the type of the lane boundary line, the shape of the lane, the shape of the lane dividing line, and the shape of the lane reference line. High-precision maps also include the types and position coordinates of traffic lights, stop lines, signs, buildings, utility poles, curbs, pedestrian crossings, and other landmarks and landmarks that exist on or near the lane, and their position coordinates. Includes information about the target, such as the identification number of the lane node and the identification number of the lane link corresponding to.
また、地図データベース12にはナビ地図が記憶されていてもよい。ナビ地図は道路単位の情報を含む。例えば、ナビ地図は道路単位の情報として、道路基準線(例えば道路の中央の線)上の基準点を示す道路ノードの情報と、道路ノード間の道路の区間態様を示す道路リンクの情報を含む。
なお、地図データベース12は、無線通信(路車間通信、または、車車間通信でも可)等の通信システムを介して外部から地図情報を取得してもよい。この場合、地図データベース12は、定期的に最新の地図情報を入手して、保有する地図情報を更新してもよい。また、地図データベース12は、自車両1が実際に走行した走路を、地図情報として蓄積してもよい。
Further, the navigation map may be stored in the
The
周囲環境センサ13は、自車両1の周囲環境についての様々な情報(周囲環境情報)、例えば自車両1の周辺の物標を検出する。周囲環境センサ13は、自車両1の周辺に存在する物標の存在、自車両1と物標との相対位置、自車両1と物標との距離、物標が存在する方向等の第1車両の周囲環境を検出する。
例えば周囲環境センサ13は、自車両1に対する自車両1周辺の物標の相対位置を検出する。ここで、物標とは、例えば、自車両1が走行する走行路面上の線(車線区分線等)や、路肩の縁石、ガードレール、あるいは建築物等の移動不能な静止物である。周囲環境センサ13は、特許請求の範囲に記載の物標検出センサの一例である。
The surrounding
For example, the
周囲環境センサ13は、レーザレンジファインダ(LRF)やレーダなどの測距装置や、カメラを備えてよい。カメラは、例えばステレオカメラであってよい。カメラは、単眼カメラであってもよく、単眼カメラにより複数の視点で同一の物標を撮影して、物標までの距離及び角度(すなわち物標の自車両1に対する相対位置)を計算してもよい。また、撮像画像から検出された物標の接地位置に基づいて、物標までの距離を計算してもよい。周囲環境センサ13は、少なくとも物標の自車両に対する相対位置が検出できる限りにおいては、種々の公知のセンサを適用することができる。
The
車両センサ14は、自車両1から得られる様々な情報(車両情報)を検出する。車両センサ14には、例えば、自車両1の走行速度(車速)を検出する車速センサ、自車両1が備える各タイヤの回転速度を検出する車輪速センサ、自車両1の3軸方向の加速度(減速度を含む)を検出する3軸加速度センサ(Gセンサ)、操舵角(転舵角を含む)を検出する操舵角センサ、自車両1に生じる角速度を検出するジャイロセンサ、ヨーレートを検出するヨーレートセンサ、自車両1のアクセル開度を検出するアクセルセンサと、運転者によるブレーキ操作量を検出するブレーキセンサが含まれる。
The
ナビゲーションシステム17は、衛星測位装置11により自車両1の現在位置を認識し、その現在位置における地図情報を地図データベース12から取得する。ナビゲーションシステム17は、乗員が入力した目的地までの走行予定経路を設定し、この走行予定経路に従って乗員に経路案内を行う。
またナビゲーションシステム17は、設定した走行予定経路の情報をコントローラ16へ出力する。自律走行制御時にコントローラ16は、ナビゲーションシステム17が設定した走行予定経路に沿って自律走行するように第1車両を自動で運転(運転行動を制御)する。
The
Further, the
ユーザインタフェース装置19は、乗員との間で情報を授受するヒューマン・マシン・インターフェイス(HMI:Human Machine Interface)であり、ユーザインタフェース装置19は、走行支援装置10とは別体の情報端末(例えば、スマートフォンやタブレット装置)であってもよい。なお、乗員には、運転者が含まれるほか、自車両1の自律走行制御に関する操作指示権限を有する乗員や同乗者が含まれる。
The
ユーザインタフェース装置19は、例えば音声情報を授受するスピーカとマイクロフォンを備えてもよい。また、ユーザインタフェース装置19は、表示情報を提供するディスプレイ装置を備えてもよい。ユーザインタフェース装置19は、乗員が物理的に操作するキーボード、ボタン、ダイヤル、スライダ、マウス、タッチパネル、レバー、ジョイスティック、タッチパッド等を備えてもよい。
The
コントローラ16は、自車両1の走行支援制御を行う電子制御ユニット(ECU:Electronic Control Unit)である。コントローラ16は、プロセッサ20と、記憶装置21等の周辺部品とを含む。プロセッサ20は、例えばCPU(Central Processing Unit)やMPU(Micro-Processing Unit)であってよい。
記憶装置21は、半導体記憶装置や、磁気記憶装置、光学記憶装置等を備えてよい。記憶装置21は、レジスタ、キャッシュメモリ、主記憶装置として使用されるROM(Read Only Memory)及びRAM(Random Access Memory)等のメモリを含んでよい。
以下に説明するコントローラ16の機能は、例えばプロセッサ20が、記憶装置21に格納されたコンピュータプログラムを実行することにより実現される。
The
The
The function of the
なお、コントローラ16を、以下に説明する各情報処理を実行するための専用のハードウエアにより形成してもよい。
例えば、コントローラ16は、汎用の半導体集積回路中に設定される機能的な論理回路を備えてもよい。例えばコントローラ16はフィールド・プログラマブル・ゲート・アレイ(FPGA:Field-Programmable Gate Array)等のプログラマブル・ロジック・デバイス(PLD:Programmable Logic Device)等を有していてもよい。
The
For example, the
コントローラ16は、自車両1の現在位置である自己位置を検出し、自己位置と、地図データベース12の道路の地図情報と、ナビゲーションシステム17から出力された経路情報と、周囲環境と、自車両1の走行状態に基づいて、自車両1を到達させる目標地点を設定し、現在位置から目標地点まで自車両1を走行させる目標走行軌道を設定する。コントローラ16は、目標走行軌道に基づいて自車両1の自律走行制御を行い、アクチュエータ18を駆動して自車両1の走行を制御する。
The
アクチュエータ18は、コントローラ16からの制御信号に応じて、自車両1のステアリングホイール、アクセル開度及びブレーキ装置を操作して、自車両1の車両挙動を発生させる。アクチュエータ18は、ステアリングアクチュエータと、アクセル開度アクチュエータと、ブレーキ制御アクチュエータを備える。ステアリングアクチュエータは、自車両1のステアリングの操舵方向及び操舵量を制御する。アクセル開度アクチュエータは、自車両1のアクセル開度を制御する。ブレーキ制御アクチュエータは、自車両1のブレーキ装置の制動動作を制御する。
The
以下、コントローラ16による走行支援制御についてより詳しく説明する。図2A及び図2Bを参照する。
まず、コントローラ16は、自車両1を到達させる目標地点を走行予定経路上に設定する。
Hereinafter, the traveling support control by the
First, the
目標地点は、例えば、交差点や横断歩道の停止線による停止地点や、カーブ路や交差点における旋回開始地点などであってよい。また、特許文献1のような設定速度の変化地点であってもよい。
なおコントローラ16は、目標地点を、走行予定経路に沿った1次元の線上の点として設定してよい。例えば、地図情報の車線リンク上の一点を目標地点として設定してよい。
The target point may be, for example, a stop point at an intersection or a pedestrian crossing stop line, a turning start point at a curved road or an intersection, or the like. Further, it may be a change point of the set speed as in Patent Document 1.
The
この場合、走行予定経路と直交する道幅方向における位置は特定されない。したがって2次元平面上では、図2Aに示すように道幅方向に延びる2点鎖線として目標地点が設定される。
これに代えてコントローラ16は、目標地点を2次元平面上の一点を示す2次元座標により設定してもよい。
In this case, the position in the road width direction orthogonal to the planned travel route is not specified. Therefore, on the two-dimensional plane, the target point is set as a two-dot chain line extending in the road width direction as shown in FIG. 2A.
Instead of this, the
次にコントローラ16は、現在の自己位置から目標地点まで自車両1を走行させる目標走行軌道を設定する。その際、コントローラ16は、目標走行軌道の候補となる複数の走行軌道候補を生成する。
図2A及び図2Bの例では、走行路25上で自車両1を走行させる複数の走行軌道候補T1、T2及びT3を生成する場合を想定する。
Next, the
In the examples of FIGS. 2A and 2B, it is assumed that a plurality of travel track candidates T1, T2, and T3 for traveling the own vehicle 1 on the
次にコントローラ16は、これらの走行軌道候補T1〜T3を自車両1が走行した場合に、コントローラ16が目標地点に到達した時点で自己位置を検出する場合の検出誤差を、走行軌道候補T1〜T3のそれぞれについて推定する。
ここで、走行路25上の部分領域R1〜R3においてコントローラ16による自己位置の検出精度が既知である場合を想定する。なお、コントローラ16による自己位置の検出精度が既知であるとは、過去に走行した際に自己位置の検出精度が特定されている、あるいは事前のシミュレーション等にて算出された自己位置の検出精度が特定されている等、今回走行する以前に何らかの手段によって自己位置の検出精度が特定されている事を意味する。
Next, when the own vehicle 1 travels on these traveling track candidates T1 to T3, the
Here, it is assumed that the detection accuracy of the self-position by the
走行軌道候補T1は、部分領域R2とそれ以外の領域を通過する。走行軌道候補T2は、部分領域R1及びR3と、それ以外の領域を通過する。走行軌道候補T3は、部分領域R1とそれ以外の領域を通過する。
以下、コントローラ16による自己位置の検出精度が既知である部分領域を「既知領域」と表記することがある。また、既知領域以外の領域、すなわちコントローラ16による自己位置の検出精度が未知である部分領域を「未知領域」と表記することがある。
The traveling track candidate T1 passes through the partial region R2 and the other regions. The traveling track candidate T2 passes through the partial regions R1 and R3 and other regions. The traveling track candidate T3 passes through the partial region R1 and the other regions.
Hereinafter, a partial region in which the detection accuracy of the self-position by the
コントローラ16が、自車両1の周囲の物標の検出結果に基づいて自己位置を検出する場合、自己位置の検出精度は、周囲環境センサ13により検出できる物標の数と検出方向に依存する。したがって、既知領域は、周囲環境センサ13により検出できる物標の数と検出方向が既知である領域であってよい。
すなわち、自車両1の周囲の物標を撮像し、撮像した画像に基づいて自車両1に対する物標の相対位置を算出し、自車両1に対する物標の相対位置と地図上の物標の位置に基づいて自車両の位置を検出する場合には、自車両1に対する物標の相対位置の検出精度が自己位置の検出精度に影響する。更に詳述すると、撮像した画像上における複数の物標の距離(画素数)及び位置に基づいて、自車両1に対する物標の相対位置を算出する事が知られているが、この場合には画像上における複数の物標の距離(画素数)が大きいほど、物標の数が多いほど自車両1に対する物標の相対位置の検出精度が高くなる。従って、周囲環境センサ13により検出できる物標の数と検出方向が既知であれば、自車両1に対する物標の相対位置の検出精度を推定する事が可能であるため、周囲環境センサ13により検出できる物標の数と検出方向が既知である領域を既知領域とすることができる。
When the
That is, the target around the own vehicle 1 is imaged, the relative position of the target with respect to the own vehicle 1 is calculated based on the captured image, and the relative position of the target with respect to the own vehicle 1 and the position of the target on the map. When the position of the own vehicle is detected based on the above, the detection accuracy of the relative position of the target with respect to the own vehicle 1 affects the detection accuracy of the own position. More specifically, it is known that the relative position of the target with respect to the own vehicle 1 is calculated based on the distance (number of pixels) and the position of the plurality of targets on the captured image. The larger the distance (the number of pixels) of the plurality of targets on the image and the larger the number of targets, the higher the accuracy of detecting the relative position of the targets with respect to the own vehicle 1. Therefore, if the number of targets that can be detected by the
例えば、2つの物標の間の距離が観測できる領域を既知領域として設定してよい。また例えば、3つ以上の物標の位置が観測できる領域を既知領域として設定してもよい。また例えば、直線上に並ばない3つ以上の物標の位置が観測できる領域を既知領域として設定してもよい。また例えば、2次曲線上に並ばない3つ以上の物標の位置が観測できる領域を、既知領域として設定してもよい。
また例えば、所定閾値以上の解像度で物標を撮影できる領域を既知領域として設定してもよい。例えば、撮影された物標の形状に基づいてコントローラ16が所定の誤差範囲で自己位置を検出できる解像度で物標を撮影できる領域を、既知領域として設定してもよい。
For example, a region where the distance between two targets can be observed may be set as a known region. Further, for example, a region in which the positions of three or more targets can be observed may be set as a known region. Further, for example, a region in which the positions of three or more targets that do not line up on a straight line can be observed may be set as a known region. Further, for example, a region in which the positions of three or more targets that do not line up on the quadratic curve can be observed may be set as a known region.
Further, for example, a region in which a target can be photographed at a resolution equal to or higher than a predetermined threshold value may be set as a known region. For example, a region in which the
コントローラ16が、オドメトリによって自己位置を検出する場合、自己位置の検出精度は走行路の路面状態に依存する。例えば、検出精度は路面μ(路面の摩擦係数)や路面勾配に依存する。したがって、既知領域は、路面μや路面勾配などの路面状態が既知である領域であってよい。
すなわち、オドメトリによって自己位置を検出する場合は通常、車輪速に基づいて算出された単位時間当たり移動距離や車輪の転舵角に基づいて算出される移動方向等を累積して、例えば前回検出された自己位置などの所定の基準位置から現在までの自車両1の移動距離及び移動方向を算出して現在の自己位置を検出するが、この場合には車輪速に基づく移動距離や転舵角に基づく移動方向は路面μ(路面の摩擦係数)や路面勾配などの路面状態に影響される。従って、路面μや路面勾配などの路面状態が既知であれば、車輪速に基づく移動距離や転舵角に基づく移動方向の算出精度を推定することが可能であるため、路面μや路面勾配などの路面状態が既知である領域を既知領域とすることができる。
また例えば、路面μが高い領域や路面勾配が少ない領域、水たまりが発生しにくい領域を既知領域として設定してもよい。
When the
That is, when the self-position is detected by odometry, the movement distance per unit time calculated based on the wheel speed, the movement direction calculated based on the wheel steering angle, etc. are usually accumulated, and for example, the previous detection is performed. The current self-position is detected by calculating the moving distance and moving direction of the own vehicle 1 from a predetermined reference position such as the self-position to the present. In this case, the moving distance and steering angle based on the wheel speed are used. The moving direction is influenced by the road surface condition such as the road surface μ (coefficient of friction of the road surface) and the road surface gradient. Therefore, if the road surface conditions such as the road surface μ and the road surface gradient are known, it is possible to estimate the calculation accuracy of the moving distance based on the wheel speed and the moving direction based on the steering angle. A region in which the road surface condition of the vehicle is known can be set as a known region.
Further, for example, a region where the road surface μ is high, a region where the road surface gradient is small, and a region where puddles are unlikely to occur may be set as known regions.
コントローラ16が、衛星測位装置11によって自己位置を検出する場合、既知領域は、衛星測位システムによる自己位置の検出精度が既知である領域であってよい。例えば既知領域R2は、周囲に高い建物や高架線、磁性体が無いために測位衛星からの信号を受信しやすく、衛星測位システムが保証する検出精度で自己位置を検出できる領域であってもよい。以下、高い建物、高架線や磁性体を総称して「高い建物等」と表記することがある。
When the
図1を参照する。既知領域データベース15は、フラッシュメモリ等の記憶装置に格納され、既知領域に関する既知領域情報を記憶している。
既知領域情報は、既知領域それぞれの範囲を表す位置情報と、既知領域それぞれにおける自己位置の検出精度、例えば既知領域それぞれにおいて発生する検出誤差を特定可能な情報を含む。
See FIG. The known
The known area information includes position information representing the range of each known area and information capable of identifying the detection accuracy of the self-position in each known area, for example, the detection error occurring in each known area.
例えば既知領域情報は、物標の検出結果に基づく自己位置の検出精度を特定可能な情報として、既知領域において検出可能な物標の位置や、数、検出方向の情報を含んでよい。
また例えば既知領域情報は、オドメトリによる自己位置の検出精度を特定可能な情報として、既知領域の路面μや路面勾配などの路面状態の情報を含んでよい。
また例えば既知領域情報は、衛星測位システムによる検出精度を特定可能な情報として、高い建物等の不在情報を含んでよい。
For example, the known area information may include information on the position, number, and detection direction of the target that can be detected in the known area as information that can specify the detection accuracy of the self-position based on the detection result of the target.
Further, for example, the known region information may include information on the road surface condition such as the road surface μ and the road surface gradient in the known region as information that can specify the detection accuracy of the self-position by the odometry.
Further, for example, the known area information may include absent information such as a tall building as information that can specify the detection accuracy by the satellite positioning system.
これらの既知領域情報は、例えば自車両1で実際に当該領域を走行して自己位置を検出し、その際に検出した物標の位置、数、検出方向の情報や、路面状態の情報、周囲の高い建物等の不在を記録することによって取得してよい。また、同一の自己位置検出性能を有する他車両が実際に当該領域を走行して収集した既知領域情報を、無線通信(路車間通信、または、車車間通信でも可)等の通信システムを介して外部から取得してもよい。 These known area information includes, for example, information on the position, number, and detection direction of the target that was detected when the vehicle 1 actually traveled in the area and detected its own position, information on the road surface condition, and surroundings. It may be obtained by recording the absence of tall buildings, etc. In addition, known area information collected by another vehicle having the same self-position detection performance actually traveling in the area is transmitted via a communication system such as wireless communication (road-to-vehicle communication or vehicle-to-vehicle communication is also possible). It may be obtained from the outside.
図2A及び図2Bを参照する。コントローラ16は、走行軌道候補T1〜T3が通過する既知領域R1〜R3のそれぞれにおいて発生する自己位置の検出誤差を、既知領域情報に含まれている検出精度を特定可能な情報に応じて推定する。
例えばコントローラ16は、既知領域において検出できることが既知である物標の位置、数、検出方向に応じて検出誤差を推定する。
See FIGS. 2A and 2B. The
For example, the
また例えばコントローラ16は、既知領域の既知の路面状態に応じて、既知領域におけるオドメトリで累積する自己位置の検出誤差を推定する。
また例えばコントローラ16は、高い建物等がない既知領域の検出誤差を、衛星測位システムが保証する検出精度に応じて推定する。
Further, for example, the
Further, for example, the
さらにコントローラ16は、既知領域以外の未知領域において発生する検出誤差を算出する。例えばコントローラ16は、所定の路面状態を仮定して、未知領域におけるオドメトリで累積する検出誤差を算出してもよい。
コントローラ16は、これら算出した既知領域R1〜R3における検出誤差と未知領域における検出誤差に基づいて、走行軌道候補T1〜T3においてそれぞれ発生する検出誤差を推定する。
Further, the
The
コントローラ16は、走行軌道候補T1〜T3の検出誤差のそれぞれと、所定の閾値とを比較し、検出誤差が所定の閾値以下となるいずれかの走行軌道候補を、目標走行軌道として設定する。
これにより、将来の目標地点における自車両1の自己位置の検出誤差を閾値以下に抑えることができる。また、既知領域情報に基づいて検出誤差を推定することにより目標地点における検出誤差を向上することができる。
The
As a result, the detection error of the self-position of the own vehicle 1 at the future target point can be suppressed to the threshold value or less. Further, the detection error at the target point can be improved by estimating the detection error based on the known area information.
以下、図3を参照してコントローラ16の動作を詳述する。コントローラ16は、第1自己位置推定部30と、第2自己位置推定部31と、自己位置検出部32と、誤差検出部33と、軌道候補生成部34と、軌道候補選択部35と、第1区間誤差算出部36と、第2区間誤差算出部37と、軌道誤差算出部38と、走行軌道設定部39と、走行制御部40とを備える。
Hereinafter, the operation of the
第1自己位置推定部30は、周囲環境センサ13が検出した自車両1と物標との相対位置と、地図データベース12に記憶されている物標の地図上の位置とに基づいて、自車両1の自己位置を推定する。
例えば、第1自己位置推定部30は、自己位置を前回推定した時点からの自車両1の移動量及び移動方向を算出し、これらの移動量及び移動方向により前回検出した自己位置を更新することにより、地図上の仮の自己位置を推定する。
The first self-
For example, the first self-
第1自己位置推定部30は、地図上の仮の自己位置に基づいて、周囲環境センサ13が検出した物標の相対位置の座標を地図上の座標に変換する。第1自己位置推定部30は、座標変換後の物標の位置と地図データベース12に記憶されている物標の位置とを照合し、その誤差が最小となる自車両1の位置及び姿勢を自己位置と推定する。
または、第1自己位置推定部30は、衛星測位装置11による測位結果に応じて自車両1の自己位置を推定する。
The first self-
Alternatively, the first self-
第2自己位置推定部31は、車両センサ14の検出結果に基づいてオドメトリにより自車両1の自己位置を推定する。すなわち、車両センサ14の検出結果に基づいて、前回自己位置を推定した時点からの自車両1の移動量及び移動方向を算出し、これら移動量及び移動方向により前回検出した自己位置を更新することにより、自車両1の自己位置を推定する。
The second self-
自己位置検出部32は、第1自己位置推定部30及び第2自己位置推定部31による推定結果に基づいて、自車両1の自己位置を検出する。
例えば自車両1の周囲の物標の検出結果に基づく自己位置検出が可能である場合には、自己位置検出部32は、第1自己位置推定部30が物標に基づいて推定した自己位置を、自車両1の自己位置として検出する。
The self-
For example, when self-position detection based on the detection result of the target around the own vehicle 1 is possible, the self-
また、物標の検出結果に基づいて自己位置が検出できず、また、衛星測位装置11による測位が可能である場合には、自己位置検出部32は、衛星測位装置11による測位結果を自己位置として検出する。
また、物標に基づく自己位置検出も衛星測位装置11による測位もできない場合には、自己位置検出部32は、第2自己位置推定部31のオドメトリによる推定結果を自己位置として検出する。
Further, when the self-position cannot be detected based on the detection result of the target and the positioning by the
Further, when neither the self-position detection based on the target nor the positioning by the
誤差検出部33は、自己位置検出部32による自己位置の検出誤差を検出する。
図4を参照する。誤差検出部33は、第1誤差検出部50と、第2誤差検出部51と、第3誤差検出部52と、誤差補正部53を備える。
第1誤差検出部50は、第2自己位置推定部31が推定した自己位置情報と、地図データベース12に記憶された地図情報を入力し、第2自己位置推定部31のオドメトリにおいて累積する自己位置の検出誤差を推定する。
The
See FIG. The
The first
例えば第1誤差検出部50は、自車両1の車速や旋回曲率に応じてオドメトリで発生する検出誤差を推定してよい。
また第1誤差検出部50は、自車両1の車速と車輪速に基づいてスリップ率を算出し、スリップ率と前後方向加速度に基づいて自車両1の走行路の路面μを推定してよい。また第1誤差検出部50は、自車両1の車速の微分値と3軸加速度センサの検出信号に基づいて自車両1の走行路の路面勾配を検出してよい。
第1誤差検出部50は、路面μや路面勾配などの路面状態に基づいてオドメトリで発生する検出誤差を推定してよい。
For example, the first
Further, the first
The first
第1誤差検出部50は、今回推定した検出誤差を、誤差補正部53から前回出力した自己位置の検出誤差に加算することにより、現在の自己位置まで累積した検出誤差を算出し、誤差補正部53へ出力する。
また、第1誤差検出部50は、検出誤差を推定した地点の位置情報と、推定した路面μや検出した路面勾配などの路面状態の情報を、既知領域情報として既知領域データベース15に記憶する。
The first
Further, the first
第2誤差検出部51は、第1自己位置推定部30が物標の検出結果により自己位置を検出した際の検出誤差を検出して、誤差補正部53へ出力する。例えば、第2誤差検出部51は、検出された自車両1の周囲の物標の位置、数、検出方向に基づいて第1自己位置推定部30による検出誤差を検出する。
その際に第2誤差検出部51は、周囲環境センサ13の検出誤差を正規分布に当てはめた際の共分散行列に応じて第1自己位置推定部30による検出誤差を検出してよい。
The second
At that time, the second
第2誤差検出部51は、周囲環境センサ13の検出結果の尤度に応じて第1自己位置推定部30による検出誤差を検出してよい。第2誤差検出部51は、周囲環境センサ13が検出した白線などの物標位置と地図データベース12の物標位置とを照合した際の誤差の分布に応じて周囲環境センサ13の検出結果の尤度を求めてよい。
第2誤差検出部51は、検出誤差を推定した地点の位置情報と、この地点で検出した物標の位置、数、検出方向の情報を、既知領域情報として既知領域データベース15に記憶する。
The second
The second
第3誤差検出部52は、衛星測位装置11における衛星信号の受信状態に応じて衛星測位装置11による自己位置の検出誤差を検出し、誤差補正部53へ出力する。
また、第3誤差検出部52は、周囲環境センサ13が検出した周囲環境情報に基づいて、自車両1の周囲の高い建物の有無を判定する。自車両1の周囲に高い建物がない場合、第3誤差検出部52は、検出誤差を推定した地点の位置情報を既知領域情報として既知領域データベース15に記憶する。
The third
Further, the third
また、第3誤差検出部52は、衛星信号の信号強度に基づいて自車両1の周囲の高架線や磁性体の有無を判定する。自車両1の周囲に高架線や磁性体がない場合、第3誤差検出部52は、検出誤差を推定した地点の位置情報を既知領域情報として既知領域データベース15に記憶する。
Further, the third
誤差補正部53は、第1自己位置推定部30が自車両1の周囲の物標に基づいて自己位置を検出した場合には、第1誤差検出部50により累積される検出誤差を、第2誤差検出部51が検出した検出誤差に修正(リセット)して、現在の自己位置までの検出誤差として第1誤差検出部50、第1区間誤差算出部36、第2区間誤差算出部37へ出力する。
The
また、衛星測位装置11により自己位置を検出した場合には、誤差補正部53は第1誤差検出部50により累積される検出誤差を、第3誤差検出部52が検出した検出誤差に修正(リセット)して、現在の自己位置までの検出誤差として第1誤差検出部50、第1区間誤差算出部36、第2区間誤差算出部37へ出力する。
第1自己位置推定部30及び衛星測位装置11が自己位置を検出しない場合には、第1誤差検出部50により累積される検出誤差を、現在の自己位置までの検出誤差として第1誤差検出部50、第1区間誤差算出部36、第2区間誤差算出部37へ出力する。
Further, when the self-position is detected by the
When the first self-
図3を参照する。軌道候補生成部34は、自己位置検出部32が検出した自己位置から自車両1を走行させる複数の走行軌道候補を生成する。
軌道候補生成部34は、ナビゲーションシステム17により設定された走行予定経路と、経路空間マップ及びリスクマップに基づいて、走行予定経路上を自動で自車両1に走行させるための運転行動計画を生成する。
運転行動計画とは、自車両1を走行させるレーン(車線)と、このレーンを走行させるのに要する運転行動とを定めた、中長距離の範囲におけるレーンレベル(車線レベル)での運転行動の計画である。
See FIG. The track
The track
The driving action plan is a driving action at a lane level (lane level) in a medium- to long-distance range, which defines a lane (lane) in which the own vehicle 1 is driven and a driving action required to drive this lane. It is a plan.
このような運転行動には、停止線での停止や、交差点の右折、左折、直進や、所定曲率以上のカーブ路での走行、合流区間や複数車線を走行する際の車線変更が含まれる。
軌道候補生成部34は、運転行動計画、自車両1の運動特性、経路空間マップに基づいて、自車両1を到達させる目標地点を設定し、自己位置から目標地点まで自車両1を走行させる複数の走行軌道の候補を生成する。
Such driving behavior includes stopping at a stop line, turning right, left, or going straight at an intersection, traveling on a curved road having a predetermined curvature or more, and changing lanes when traveling in a merging section or a plurality of lanes.
The track
軌道候補生成部34が生成した走行軌道の候補を「走行軌道候補」と表記する。走行軌道候補は、自己位置から目標地点までの速度プロファイルを含んでもよい
軌道候補生成部34は、複数の走行軌道候補を軌道候補選択部35と走行軌道設定部39へ出力する。
軌道候補選択部35は、軌道候補生成部34が生成した複数の走行軌道候補を順次選択して、第1区間誤差算出部36と、第2区間誤差算出部37と、軌道誤差算出部38へ出力する。
The running track candidate generated by the track
The track
第1区間誤差算出部36は、既知領域データベース15を参照して、軌道候補選択部35により選択された走行軌道候補上であって自己位置よりも前方に、既知領域があるか否かを判定する。
既知領域がある場合に、第1区間誤差算出部36は、既知領域における自己位置検出部32による自己位置検出の検出誤差を推定する。
The first section
When there is a known area, the first section
図5Aを参照する。第1区間誤差算出部36は、第1誤差推定部60と、第2誤差推定部61と、誤差補正部62を備える。
第1区間誤差算出部36は、走行軌道候補に沿って既知領域内を走行する自車両1が通る各々の地点について、路面状態に関する既知領域情報、当該地点で検出可能な物標に関する既知領域情報、高い建物等の不在を示す既知領域情報のいずれが記憶されているか判定する。
See FIG. 5A. The first section
The first section
路面状態に関する既知領域情報が記憶された地点では、第1誤差推定部60は、第2自己位置推定部31がオドメトリで自己位置を検出する際の自己位置の検出誤差を推定する。
第1誤差推定部60は、当該地点における路面μや路面勾配などの路面状態の情報を、既知領域情報として既知領域データベース15から読み込む。第1誤差推定部60は、当該地点を走行する際の自車両1の車速や旋回曲率と路面状態とに基づいてオドメトリで発生する検出誤差を推定する。
At the point where the known area information regarding the road surface condition is stored, the first
The first
第1誤差推定部60は、走行軌道候補に沿った地点の各々においてオドメトリで発生する検出誤差を順次算出し、これらを累積して誤差補正部62へ出力する。
例えば、第1誤差推定部60は、走行軌道候補に沿った地点の各々において、当該地点で発生する検出誤差を算出し、当該地点の直前の地点までに累積した検出誤差を誤差補正部62から入力して加算することにより、当該位置までに累積される検出誤差を算出してよい。
その際に第1誤差推定部60は、図5Bに示すように自車両1が前方の既知領域にまだ進入していないか、又は図5Cに示すように既に進入しているかを判定する。
The first
For example, the first
At that time, the first
自車両1が前方の既知領域にまだ進入していない場合(図5B)には、第1誤差推定部60は、既知領域の進入地点から累積する検出誤差の増加量を推定する。
一方で、自車両1が前方の既知領域にすでに進入している場合(図5C)には、第1誤差推定部60は、誤差検出部33が検出した現在の自己位置の検出誤差に、自車両1の前方の既知領域で累積する検出誤差を加えた検出誤差を推定する。
When the own vehicle 1 has not yet entered the known area ahead (FIG. 5B), the first
On the other hand, when the own vehicle 1 has already entered the known area ahead (FIG. 5C), the first
一方で、物標に関する既知領域情報が記憶された地点では、第2誤差推定部61が、第1自己位置推定部30が物標に基づいて自車両1の自己位置を検出する際の検出誤差を推定する。
第2誤差推定部61は、既知領域において検出可能な物標の位置、数、検出方向の情報を、既知領域情報として既知領域データベース15から読み込む。
第2誤差推定部61は、既知領域情報に基づいて第1自己位置推定部30による検出誤差を推定する。その際、周囲環境センサ13の検出誤差の共分散行列に応じて検出誤差を推定してもよい。
On the other hand, at the point where the known area information about the target is stored, the second
The second
The second
また、高い建物等の不在を示す既知領域情報が記憶された地点では、第2誤差推定部61は、衛星測位システムが保証する検出誤差を、第1自己位置推定部30による自己位置の検出誤差の推定値として算出する。
第2誤差推定部61は、第1自己位置推定部30による自己位置の検出誤差の推定値を、誤差補正部62へ出力する。
Further, at a point where known area information indicating the absence of a tall building or the like is stored, the second
The second
誤差補正部62は、第2誤差検出部51が検出誤差を推定した地点(すなわち物標や、高い建物等の既知領域情報が記憶された地点)で、第1誤差推定部60が累積する検出誤差の推定値を、第2誤差検出部51が検出した検出誤差に修正(リセット)して出力する。
一方で、第2誤差検出部51が検出誤差を推定しない地点では、誤差補正部62は、第1誤差推定部60から出力される検出誤差の推定値をそのまま出力する。
以上により、既知領域の進出地点まで検出誤差の算出が完了すると、誤差補正部62は、以下のいずれかの値を既知領域における検出誤差の推定値として出力する。
The
On the other hand, at a point where the second
As described above, when the calculation of the detection error is completed up to the advance point of the known region, the
(図5B)自車両1が前方の既知領域にまだ進入しておらず、物標や高い建物等の既知領域情報が記憶された地点が既知領域内に存在しない場合には、既知領域の進入地点から進出地点までにオドメトリで累積する検出誤差の増加量(すなわち既知領域において累積される検出誤差の増加量)が出力される。
(図5C)自車両1が前方の既知領域にすでに進入しており、物標や高い建物等の既知領域情報が記憶された地点が既知領域内に存在しない場合には、誤差検出部33が検出した現在の自己位置の検出誤差に、現在の自己位置から進出地点までにオドメトリで累積する検出誤差を加えた値が、進出位置における検出誤差として出力される。
(FIG. 5B) If the own vehicle 1 has not yet entered the known area ahead and there is no point in the known area where the known area information such as a target or a tall building is stored, the known area is entered. The amount of increase in detection error accumulated in odometry from the point to the point of advance (that is, the amount of increase in detection error accumulated in the known area) is output.
(FIG. 5C) When the own vehicle 1 has already entered the known area ahead and the point where the known area information such as a target or a tall building is stored does not exist in the known area, the
(図5D)物標に関する既知領域情報が記憶された地点(図にて「物標検出地点」と表記する)が既知領域内に存在する場合には、物標検出地点において物標による自己位置検出を行った場合に発生すると推定される検出誤差に、物標検出地点から進出地点までにオドメトリで累積する検出誤差を加えた値が、進出位置における検出誤差として出力される。
同様に、高い建物等の不在を示す既知領域情報が記憶された地点が既知領域内に存在する場合には、この地点から進出地点までにオドメトリで累積する検出誤差を、衛星測位システムが保証する検出誤差に加算することにより、進出位置における検出誤差を出力する。
図3を参照する。誤差補正部62が出力した検出誤差の推定値は、軌道誤差算出部38へ出力される。
(Fig. 5D) When a point (denoted as "target detection point" in the figure) in which the known area information about the target is stored exists in the known area, the self-position by the target at the target detection point. The value obtained by adding the detection error estimated to occur when the detection is performed and the detection error accumulated in the odometry from the target detection point to the advance point is output as the detection error at the advance position.
Similarly, if there is a point in the known area where known area information indicating the absence of a tall building or the like is stored, the satellite positioning system guarantees the detection error accumulated in odometry from this point to the advance point. By adding to the detection error, the detection error at the advance position is output.
See FIG. The estimated value of the detection error output by the
第2区間誤差算出部37は、軌道候補選択部35により選択された走行軌道候補上であって自己位置よりも前方に、未知領域があるか否かを判定する。
未知領域がある場合に、第2区間誤差算出部37は、未知領域における自己位置検出部32による自己位置検出の検出誤差を推定し、軌道誤差算出部38へ出力する。
第2区間誤差算出部37は、走行軌道候補に沿って未知領域内を走行する際の自車両1の車速や旋回曲率と、予め統計モデルなどを用いて設定した所定の路面状態とに基づいてオドメトリで発生する検出誤差を推定する。
The second section
When there is an unknown region, the second section
The second section
その際に第2区間誤差算出部37は、図6Aに示すように自車両1が前方の未知領域にまだ進入していないか、又は図6Bに示すように既に進入しているかを判定する。
自車両1が前方の未知領域にまだ進入していない場合(図6A)には、第2区間誤差算出部37は、未知領域の進入地点から進出地点までにオドメトリで累積する検出誤差の増加量(すなわち未知領域において累積される検出誤差の増加量)を、未知領域における検出誤差の推定値として出力する。
At that time, the second section
When the own vehicle 1 has not yet entered the unknown area in front (FIG. 6A), the second section
一方で、自車両1が前方の未知領域にすでに進入している場合(図6B)には、第2区間誤差算出部37は、誤差検出部33が検出した現在の自己位置の検出誤差に、現在の自己位置から進出地点までにオドメトリで累積する検出誤差を加えた値を、未知領域の進出位置における検出誤差として出力する。
軌道誤差算出部38は、第1区間誤差算出部36が算出した既知領域における検出誤差の推定値と、第2区間誤差算出部37が算出した未知領域における検出誤差の推定値に基づいて、軌道候補選択部35が選択した走行軌道候補に沿って目標地点に到達した時点における自己位置検出部32による自己位置検出の検出誤差を推定する。
On the other hand, when the own vehicle 1 has already entered the unknown area ahead (FIG. 6B), the second section
The trajectory
その際に、軌道誤差算出部38は、自車両1が前方の既知領域のいずかに、物標や高い建物等の既知領域情報が記憶された地点が存在するか否かを判定する。
図7Aは、自車両1が前方の既知領域のいずれにも、物標や高い建物等の既知領域情報が記憶された地点がしない場合を示す。参照符号P0は、自車両1が走行中の領域の進出地点を示す。
At that time, the track
FIG. 7A shows a case where the own vehicle 1 does not have a point in which known area information such as a target or a tall building is stored in any of the known areas in front of the vehicle 1. Reference numeral P0 indicates an advance point in the area where the own vehicle 1 is traveling.
進出地点P0における検出誤差の推定値e0は、図6Bを参照して説明したように第2区間誤差算出部37によって算出される。自車両1が走行中の領域が既知領域であった場合には、図5Cを参照して説明したように第1区間誤差算出部36によって算出される。
また、進出地点P0よりも前方の各領域において累積する検出誤差の増加量Δe1、Δe2、Δe3、Δe4は、図5B及び図6Aを参照して説明したように第1区間誤差算出部36及び第2区間誤差算出部37によって算出される。
軌道誤差算出部38は、これらの和(e0+Δe1+Δe2+Δe3+Δe4)を目標地点に到達した時点における検出誤差の推定値として算出する。
The estimated value e0 of the detection error at the advance point P0 is calculated by the second section
Further, the increased amounts of detection errors Δe1, Δe2, Δe3, and Δe4 accumulated in each region in front of the advance point P0 are the first section
The orbital
図7Bは、物標や高い建物等の既知領域情報が記憶された地点(図にて「物標検出地点」と表記する)が存在する場合を示す。軌道誤差算出部38は、物標検出地点が存在する既知領域のうち、最も目標地点に近い既知領域を選択する。参照符号P1は、選択した既知領域の進出地点を示す。
進出地点P1における検出誤差の推定値e1は、図5Dを参照して説明したように第1区間誤差算出部36によって算出される。
FIG. 7B shows a case where there is a point (denoted as a “target detection point” in the figure) in which known area information such as a target or a tall building is stored. The orbit
The estimated value e1 of the detection error at the advance point P1 is calculated by the first section
軌道誤差算出部38は、進出地点P1における検出誤差の推定値e1に、進出地点P1よりも前方の各領域において累積する検出誤差の増加量Δe5、Δe6、Δe7を加算した和(e1+Δe5+Δe6+Δe7)を、目標地点に到達した時点における検出誤差の推定値として算出する。
軌道誤差算出部38は、算出した推定値を走行軌道設定部39へ出力する。
The orbital
The track
走行軌道設定部39は、軌道候補生成部34が生成した複数の走行軌道候補のそれぞれについて軌道誤差算出部38が算出した検出誤差の推定値に基づいて、これら複数の走行軌道候補のうち何れかを目標走行軌道として設定する。
具体的には、複数の走行軌道候補のうち検出誤差の推定値が所定の閾値以下になる走行軌道候補のいずれかを目標走行軌道として設定する。検出誤差の推定値が所定の閾値以下になる走行軌道候補が複数ある場合には、例えば検出誤差の推定値が最小となる走行軌道候補を選んでよい。
The traveling
Specifically, one of the plurality of travel track candidates whose estimated value of the detection error is equal to or less than a predetermined threshold value is set as the target travel track. When there are a plurality of traveling track candidates whose estimated detection error value is equal to or less than a predetermined threshold value, for example, the traveling track candidate having the smallest estimated detection error value may be selected.
走行制御部40は、走行軌道設定部39が設定した目標走行軌道に含まれる速度プロファイルに従う速度で自車両1が目標走行軌道を走行するように、アクチュエータ18を駆動することにより、自車両1が走行予定経路に沿って自律走行するように自車両1の運転行動を制御する。
The
(動作)
次に、図8を参照して実施形態における走行支援方法の一例を説明する。
ステップS1において自己位置検出部32は、自車両1の現在位置である自己位置を検出する。
ステップS2において誤差検出部33は、自己位置検出部32による自己位置の検出誤差を検出する。
ステップS3において軌道候補生成部34は、自己位置検出部32が検出した自己位置から自車両1を走行させる複数の走行軌道候補を生成する。
(motion)
Next, an example of the traveling support method in the embodiment will be described with reference to FIG.
In step S1, the self-
In step S2, the
In step S3, the track
ステップS4において軌道候補選択部35は、軌道候補生成部34が生成した複数の走行軌道候補を順次選択する。
ステップS5において第1区間誤差算出部36は、軌道候補選択部35が選択した走行軌道候補上であって自己位置よりも前方にある既知領域における自己位置検出部32による自己位置の検出誤差を推定する。
In step S4, the track
In step S5, the first section
ステップS6において第2区間誤差算出部37は、軌道候補選択部35が選択した走行軌道候補上であって自己位置よりも前方にある未知領域における自己位置検出部32による自己位置の検出誤差を推定する。
ステップS7において軌道誤差算出部38は、ステップS5及びS6で推定した検出誤差に基づいて、軌道候補選択部35が選択した走行軌道候補に沿って目標地点に到達した時点における自己位置検出部32による自己位置検出の検出誤差を推定する。
In step S6, the second section
In step S7, the track
ステップS8において走行軌道設定部39は、軌道候補生成部34が生成した全ての走行軌道候補が軌道候補選択部35により選択されたか否かを判定する。未選択の走行軌道候補が残っている場合(ステップS8:N)、処理はステップS4に戻り、未選択の走行軌道候補のいずれかを選択してステップS5〜S8を繰り返す。
全ての走行軌道候補が選択済の場合(ステップS8:Y)、処理はステップS9に進む。
ステップS9において走行軌道設定部39は、軌道候補生成部34が生成した複数の走行軌道候補のうち、軌道誤差算出部38が算出した検出誤差の推定値が所定の閾値以下になる走行軌道候補のいずれかを目標走行軌道として設定する。
ステップS10において走行制御部40は、走行軌道設定部39が設定した目標走行軌道に含まれる速度プロファイルに従う速度で自車両1が目標走行軌道を走行するように、アクチュエータ18を駆動することにより、自車両1が走行予定経路に沿って自律走行するように自車両1の運転行動を制御する。
In step S8, the traveling
When all the traveling track candidates have been selected (step S8: Y), the process proceeds to step S9.
In step S9, the traveling
In step S10, the
(第1実施形態の効果)
(1)自己位置検出部32は、自車両1の現在位置である自己位置を検出する。軌道候補生成部34は、自車両1を到達させる目標地点を設定し、自己位置から目標地点まで自車両1を走行させる複数の走行軌道候補を生成する。軌道誤差算出部38は、将来、目標地点に到達した時点において検出される自己位置の検出誤差を走行軌道候補毎に推定する。走行軌道設定部39は、複数の走行軌道候補のうち検出誤差が閾値以下になる走行軌道候補のいずれかを目標走行軌道として選択する。走行制御部40は、選択された目標走行軌道を走行するように自車両1の走行を支援する。
これにより、目標地点における自車両1の自己位置の検出誤差を閾値以下に抑えることができる。
(Effect of the first embodiment)
(1) The self-
As a result, the detection error of the self-position of the own vehicle 1 at the target point can be suppressed to the threshold value or less.
(2)誤差検出部33は、自車両1の周囲の物標を検出する物標検出センサが物標を検出している場合には、物標の検出結果と物標の地図情報に基づいて自己位置を検出し、物標検出センサが物標を検出していない場合には、自車両1のオドメトリ又は衛星測位システムに基づいて自己位置を検出する。
これにより物標検出センサが物標を検出している場合には高精度の自己位置を検出することができるとともに、物標を検出していない場合においても自己位置の検出を継続することができる。
(2) When the target detection sensor that detects the target around the own vehicle 1 detects the target, the
As a result, when the target detection sensor detects the target, the self-position can be detected with high accuracy, and even when the target is not detected, the self-position can be continuously detected. ..
(3)軌道候補生成部34は、自車両1の走行路上の領域のうち自己位置の検出精度が既知である既知領域を通る走行軌道を、走行軌道候補として生成する。
これにより、走行軌道候補上で発生する検出誤差を予め知ることができるので、目標地点における検出誤差を向上することができる。
(4)第1区間誤差算出部36は、既知領域における自己位置の検出誤差を、既知の検出精度に応じて推定する。
これにより、既知領域内の走行軌道候補上で発生する検出誤差を予め知ることができるの。
(3) The track
As a result, the detection error that occurs on the traveling track candidate can be known in advance, so that the detection error at the target point can be improved.
(4) The first section
This makes it possible to know in advance the detection error that occurs on the traveling track candidate in the known region.
(5)既知領域は、当該領域において検出できる物標が既知である領域であってよい。また既知領域は、当該領域における路面状態が既知である領域であってもよい。また既知領域は、衛星測位システムによる自己位置の検出精度が既知な領域であってもよい。これにより、既知領域における自己位置の検出誤差をより正確に推定できる。 (5) The known region may be an region in which a target that can be detected in the region is known. Further, the known region may be a region in which the road surface condition in the region is known. Further, the known region may be a region in which the detection accuracy of the self-position by the satellite positioning system is known. As a result, the detection error of the self-position in the known region can be estimated more accurately.
(6)誤差検出部33は、自己位置の検出誤差を、物標検出センサの検出誤差の分散値又は物標の検出結果の尤度に応じて算出する。
物標検出センサの検出誤差の分散値に応じて検出誤差を算出することにより、解析的な計算により少ない処理量で高速に誤差を算出できる。白線などの検出しやすい物標の検出結果の尤度に応じて検出誤差を算出することにより、誤差推定のロバスト性を向上できる。
(6) The
By calculating the detection error according to the variance value of the detection error of the target detection sensor, the error can be calculated at high speed with a small amount of processing by analytical calculation. By calculating the detection error according to the likelihood of the detection result of a target that is easy to detect such as a white line, the robustness of the error estimation can be improved.
(第2実施形態)
次に、第2実施形態について説明する。第2実施形態の走行支援装置10は、走行支援装置10による自車両1の運転方法に関する乗員の要望を受け付ける。
運転方法に関する乗員の要望として、例えば走行支援装置10は、目標地点までの到達予定時間が早い運転の実施や、目標地点までの到達予定時間が遅くてもより安全な運転の実施を受け付けてよい。また走行支援装置10は、スポーティな運転の実施や、静穏で円滑な運転の実施を要望として受け付けてもよい。
走行支援装置10は、例えばユーザインタフェース装置19を介してこれらの要望を受け付ける。
(Second Embodiment)
Next, the second embodiment will be described. The traveling
As a request of the occupant regarding the driving method, for example, the driving
The
走行軌道設定部39は、軌道誤差算出部38が算出した検出誤差が閾値以下になる複数の走行軌道候補のうち、乗員の要望に応じたいずれかの走行軌道候補を、目標走行軌道として選択する。
例えば、到達予定時間が早い運転を乗員が要望する場合、走行軌道設定部39は、目標地点までの軌道長がより短く、車速も早く、加減速の滑らかさが少ない走行軌道候補を選択する。
The traveling
For example, when the occupant requests driving with an early arrival time, the traveling
また例えば、目標地点までの到達予定時間が遅くてもより安全な運転を要望する場合、走行軌道設定部39は、速度を落として目標地点までの区間を長い時間をかけて通過するような走行軌道候補を選択する。
また例えば、スポーティな運転を要望する場合には、走行軌道設定部39は、コーナリングを鋭角に旋回したり、より高い車速で走行したり、加減速の滑らかさが低い走行軌道候補を選択する。
また例えば、静穏で円滑な運転を要望する場合には、走行軌道設定部39は、コーナリングを鈍角に旋回したり、加減速の滑らかさが高い走行軌道候補を選択する。また、砂利道などの走行音が大きくなる領域やマンホールの上や、上下振動が発生する領域を避ける走行軌道候補を選択する。
Further, for example, when requesting safer driving even if the estimated time to reach the target point is late, the traveling
Further, for example, when sporty driving is desired, the traveling
Further, for example, when quiet and smooth driving is desired, the traveling
(第2実施形態の効果)
走行支援装置10は、自車両1の運転方法に関する乗員の要望を受け付ける。走行軌道設定部39は、軌道誤差算出部38が算出した検出誤差が閾値以下になる複数の走行軌道候補のうち、乗員の要望に応じたいずれかの走行軌道候補を、前記目標走行軌道として選択する。
これにより、目標地点における検出誤差が閾値以下になり、かつ乗員の嗜好性に合った運転を実現することができる。
(Effect of the second embodiment)
The
As a result, the detection error at the target point becomes equal to or less than the threshold value, and the driving can be realized according to the preference of the occupant.
(第3実施形態)
図9を参照する。自車両1の走行路25の傍に物標L1及びL2が存在し、物標L1及びL2の検出結果に基づいて自己位置を検出する場合を想定する。
この場合、走行軌道候補T2に沿って自車両1を走行させると、走行軌道候補T1に沿って走行する場合よりも物標L1とL2を検出する方角の間隔が狭くなり、自己位置の検出誤差が大きくなる。
したがって、走行軌道候補T2に沿って走行する自車両1の自己位置の検出誤差を抑えるには、車速を低下させて物標L1とL2の観察回数を増やす必要がある。この結果、不要に低速で走行する距離が長くなる。
(Third Embodiment)
See FIG. It is assumed that the targets L1 and L2 exist near the traveling
In this case, when the own vehicle 1 is driven along the traveling track candidate T2, the distance between the directions for detecting the targets L1 and L2 is narrower than when traveling along the traveling track candidate T1, and the detection error of the self-position is narrowed. Becomes larger.
Therefore, in order to suppress the detection error of the self-position of the own vehicle 1 traveling along the traveling track candidate T2, it is necessary to reduce the vehicle speed and increase the number of observations of the targets L1 and L2. As a result, the distance traveled at an unnecessarily low speed becomes long.
このため、第3実施形態における軌道候補生成部34は、自車両1の現在の自己位置から目標地点までの間に検出できる複数の物標の位置に応じて走行軌道候補を生成する。例えば、軌道候補生成部34は、複数の物標を検出する方角の間隔が所定の閾値よりも広くなる地点を通過するように走行軌道候補を生成してよい。
軌道候補生成部34は、自車両1の現在の自己位置において検出している複数の物標を検出する方角の間隔が所定の閾値よりも広くなる地点を通過するように走行軌道候補を生成してよく、既知領域情報に基づいて、自己位置よりも前方の既知領域で検出できる複数の物標の位置を判断し、これらの物標を検出する方角の間隔が所定の閾値よりも広くなる地点を通過するように走行軌道候補を生成してもよい。
Therefore, the track
The track
(第3実施形態の効果)
第3実施形態の軌道候補生成部34は、自車両1の現在の自己位置から目標地点までの間に検出できる複数の物標の位置に応じて走行軌道候補を生成する。
このため、自己位置の検出誤差が抑制される走行軌道候補を生成することが可能になり、不要に低速で走行する距離を短くすることができる。
(Effect of Third Embodiment)
The track
Therefore, it is possible to generate a traveling track candidate in which the detection error of the self-position is suppressed, and it is possible to shorten the traveling distance at an unnecessarily low speed.
1…自車両、10…走行支援装置、11…衛星測位装置、12…地図データベース、13…周囲環境センサ、14…車両センサ、15…既知領域データベース、16…コントローラ、17…ナビゲーションシステム、18…アクチュエータ、19…ユーザインタフェース装置、20…プロセッサ、21…記憶装置、25…走行路、30…第1自己位置推定部、31…第2自己位置推定部、32…自己位置検出部、33…誤差検出部、34…軌道候補生成部、35…軌道候補選択部、36…第1区間誤差算出部、37…第2区間誤差算出部、38…軌道誤差算出部、39…走行軌道設定部、40…走行制御部、50…第1誤差検出部、51…第2誤差検出部、52…第3誤差検出部、53…誤差補正部、60…第1誤差推定部、61…第2誤差推定部、62…誤差補正部 1 ... own vehicle, 10 ... driving support device, 11 ... satellite positioning device, 12 ... map database, 13 ... ambient environment sensor, 14 ... vehicle sensor, 15 ... known area database, 16 ... controller, 17 ... navigation system, 18 ... Actuator, 19 ... User interface device, 20 ... Processor, 21 ... Storage device, 25 ... Travel path, 30 ... First self-position estimation unit, 31 ... Second self-position estimation unit, 32 ... Self-position detection unit, 33 ... Error Detection unit, 34 ... Track candidate generation unit, 35 ... Track candidate selection unit, 36 ... First section error calculation unit, 37 ... Second section error calculation unit, 38 ... Track error calculation unit, 39 ... Travel track setting unit, 40 ... Travel control unit, 50 ... 1st error detection unit, 51 ... 2nd error detection unit, 52 ... 3rd error detection unit, 53 ... Error correction unit, 60 ... 1st error estimation unit, 61 ... 2nd error estimation unit , 62 ... Error correction unit
Claims (10)
前記自車両を到達させる目標地点を設定して前記自己位置から前記目標地点まで前記自車両を走行させる複数の走行軌道候補を生成し、
将来、前記目標地点に到達した時点において検出される前記自己位置の検出誤差を前記走行軌道候補毎に推定し、
前記複数の走行軌道候補のうち前記検出誤差が閾値以下になる前記走行軌道候補のいずれかを目標走行軌道として選択し、
選択された前記目標走行軌道を走行するように前記自車両の走行を支援する、
ことを特徴とする走行支援方法。 Detects the self-position, which is the current position of the own vehicle,
A target point to reach the own vehicle is set, and a plurality of travel track candidates for traveling the own vehicle from the self-position to the target point are generated.
In the future, the detection error of the self-position detected when the target point is reached is estimated for each traveling track candidate.
Among the plurality of travel track candidates, one of the travel track candidates whose detection error is equal to or less than the threshold value is selected as the target travel track.
Supporting the traveling of the own vehicle so as to travel on the selected target traveling track.
A driving support method characterized by that.
前記検出誤差が閾値以下になる複数の前記走行軌道候補のうち、前記乗員の要望に応じたいずれかの前記走行軌道候補を、前記目標走行軌道として選択する、
ことを特徴とする請求項1〜8のいずれか一項に記載の走行支援方法。 Accepting the occupant's request regarding the driving method of the own vehicle,
Among the plurality of traveling track candidates whose detection error is equal to or less than the threshold value, any of the traveling track candidates according to the request of the occupant is selected as the target traveling track.
The traveling support method according to any one of claims 1 to 8, wherein the driving support method is characterized by the above.
前記自車両を到達させる目標地点を設定し、前記自己位置から前記目標地点まで前記自車両を走行させる複数の走行軌道候補を生成する軌道候補生成手段と、
前記目標地点に到達した時点において前記自己位置検出手段によって検出される前記自己位置の検出誤差を前記走行軌道候補毎に推定する誤差検出手段と、
前記複数の走行軌道候補のうち前記検出誤差が閾値以下になる前記走行軌道候補のいずれかを目標走行軌道として選択する走行軌道選択手段と、
選択された前記目標走行軌道を走行するように前記自車両の走行を支援する走行支援手段と、
を備えることを特徴とする走行支援装置。 Self-position detecting means for detecting the self-position, which is the current position of the own vehicle,
A track candidate generation means for setting a target point for reaching the own vehicle and generating a plurality of travel track candidates for traveling the own vehicle from the self-position to the target point.
An error detecting means for estimating the detection error of the self-position detected by the self-position detecting means at the time of reaching the target point for each traveling track candidate, and an error detecting means.
A traveling track selection means for selecting one of the plurality of traveling track candidates whose detection error is equal to or less than a threshold value as a target traveling track.
A traveling support means for supporting the traveling of the own vehicle so as to travel on the selected target traveling track, and
A traveling support device characterized by being equipped with.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019155696A JP7321034B2 (en) | 2019-08-28 | 2019-08-28 | Driving support method and driving support device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019155696A JP7321034B2 (en) | 2019-08-28 | 2019-08-28 | Driving support method and driving support device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2021030980A true JP2021030980A (en) | 2021-03-01 |
JP7321034B2 JP7321034B2 (en) | 2023-08-04 |
Family
ID=74675117
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019155696A Active JP7321034B2 (en) | 2019-08-28 | 2019-08-28 | Driving support method and driving support device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7321034B2 (en) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018031678A1 (en) * | 2016-08-09 | 2018-02-15 | Nauto Global Limited | System and method for precision localization and mapping |
JP2018055141A (en) * | 2016-09-26 | 2018-04-05 | 日立オートモティブシステムズ株式会社 | Moving body track prediction system |
JP2018203103A (en) * | 2017-06-06 | 2018-12-27 | トヨタ自動車株式会社 | Lane change support device |
JP2019127098A (en) * | 2018-01-23 | 2019-08-01 | 本田技研工業株式会社 | Driving reference line determination device, and automatic driving device |
-
2019
- 2019-08-28 JP JP2019155696A patent/JP7321034B2/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018031678A1 (en) * | 2016-08-09 | 2018-02-15 | Nauto Global Limited | System and method for precision localization and mapping |
JP2018055141A (en) * | 2016-09-26 | 2018-04-05 | 日立オートモティブシステムズ株式会社 | Moving body track prediction system |
JP2018203103A (en) * | 2017-06-06 | 2018-12-27 | トヨタ自動車株式会社 | Lane change support device |
JP2019127098A (en) * | 2018-01-23 | 2019-08-01 | 本田技研工業株式会社 | Driving reference line determination device, and automatic driving device |
Also Published As
Publication number | Publication date |
---|---|
JP7321034B2 (en) | 2023-08-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10520319B2 (en) | Data driven map updating system for autonomous driving vehicles | |
RU2737874C1 (en) | Method of storing information of vehicle, method of controlling movement of vehicle and device for storing information of vehicle | |
RU2645388C2 (en) | Device for identifying wrong recognition | |
US11313976B2 (en) | Host vehicle position estimation device | |
EP3342670B1 (en) | Method to dynamically adjusting speed control rates of autonomous vehicles | |
JP6972150B2 (en) | Pedestrian probability prediction system for self-driving vehicles | |
US11055540B2 (en) | Method for determining anchor boxes for training neural network object detection models for autonomous driving | |
CN110621541B (en) | Method and system for generating trajectories for operating an autonomous vehicle | |
JP7035945B2 (en) | Map information system | |
KR102086270B1 (en) | Control method and traveling control device of the traveling control device | |
US11613253B2 (en) | Method of monitoring localization functions in an autonomous driving vehicle | |
JP7469896B2 (en) | Periphery recognition device, surroundings recognition method, and program | |
WO2021205193A1 (en) | Map information correction method, driving assistance method, and map information correction device | |
JP2022022287A (en) | Map making device, method for control, program, and storage medium | |
JP6943127B2 (en) | Position correction method, vehicle control method and position correction device | |
JP7321035B2 (en) | OBJECT POSITION DETECTION METHOD AND OBJECT POSITION DETECTION DEVICE | |
JP7202982B2 (en) | Driving support method and driving support device | |
JP7147448B2 (en) | map information system | |
JP2021060941A (en) | Object recognition method and object recognition system | |
JP7276112B2 (en) | Lane change decision device | |
JP7321034B2 (en) | Driving support method and driving support device | |
JP7031748B2 (en) | Self-position estimation method and self-position estimation device | |
JP2018185156A (en) | Target position estimation method and target position estimation device | |
JP2022146256A (en) | Track estimation method and track estimation device | |
JP2018146248A (en) | Target position estimation method and target position estimation device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20220510 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20230209 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20230221 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20230421 |
|
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: 20230627 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230725 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7321034 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |