JP2017223483A - 自車位置推定装置 - Google Patents

自車位置推定装置 Download PDF

Info

Publication number
JP2017223483A
JP2017223483A JP2016117583A JP2016117583A JP2017223483A JP 2017223483 A JP2017223483 A JP 2017223483A JP 2016117583 A JP2016117583 A JP 2016117583A JP 2016117583 A JP2016117583 A JP 2016117583A JP 2017223483 A JP2017223483 A JP 2017223483A
Authority
JP
Japan
Prior art keywords
vehicle position
vehicle
sensor information
position estimation
gnss
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2016117583A
Other languages
English (en)
Other versions
JP6738656B2 (ja
Inventor
正史 斉藤
Masashi Saito
正史 斉藤
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hitachi Astemo Ltd
Original Assignee
Hitachi Automotive Systems Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Hitachi Automotive Systems Ltd filed Critical Hitachi Automotive Systems Ltd
Priority to JP2016117583A priority Critical patent/JP6738656B2/ja
Publication of JP2017223483A publication Critical patent/JP2017223483A/ja
Application granted granted Critical
Publication of JP6738656B2 publication Critical patent/JP6738656B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Navigation (AREA)
  • Traffic Control Systems (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

【課題】GNSS衛星からの測位信号に基ついて自車両の位置を高精度に推定し、かつ、推定結果の確からしさを出力する自車位置推定装置を得ること。【解決手段】自車位置推定装置104は、GNSS衛星補足状態および自装置内に実装されたセンサのセンサ情報により、自車位置推定結果の確からしさを出力する。【選択図】図4

Description

本発明は、測位信号に基ついて自車両の位置を推定する自車位置推定装置に関する。
GNSS衛星からの測位信号は、自ユニットが正常にもかかわらず、自車両の周辺物によりマルチパスが発生した場合など、測位信号の偏差が大きくなる傾向があり、測位信号の確からしさを高精度に判定する方法が必要であった。
特開2016−20812号公報
前述した特許文献1に記載の技術は、2つのGNSS(特許文献中ではGPSと記載)アンテナを用いているが、自車周囲環境によるマルチパスが発生した場合については、当該2つのGNSSアンテナが共に影響を受ける事が想定される。また、2つの異なるGNSSアンテナの使用を前提とする為、車両内における設置場所の確保、互いのアンテナによる電波干渉、および、受信感度低下の懸念も想定され得る。
本発明は、上記の点に鑑みてなされたものであり、その目的とするところは、GNSS衛星からの測位信号に基ついて自車両の位置を高精度に推定し、かつ、推定結果の確からしさを出力する自車位置推定装置を提供することである。
上記課題を解決する本発明の自車位置推定装置は、1つのGNSSアンテナを用い、その測位状態の確からしさを高精度に推定する為、自ユニット内のセンサ信号や車両から得られる情報を利用する技術を提供する。具体的には、GNSS衛星補足状態および自装置内に実装されたセンサのセンサ情報により、自車位置推定結果の確からしさを出力する事を特徴とする。
本発明によれば、GNSS衛星からの測位信号に基ついて自車両の位置を高精度に推定し、かつ、推定結果の確からしさを出力することができる。
本発明に関連する更なる特徴は、本明細書の記述、添付図面から明らかになるものである。また、上記した以外の、課題、構成及び効果は、以下の実施形態の説明により明らかにされる。
自車位置推定装置のブロック図および周辺システムの結線を示す図。 自車両の走行レーンを変更する動作を示す図。 測位信号の変動が大きい場合に自車位置の誤検知を示す図。 自車位置情報の確定処理を示すフローチャート。
以下、本発明が適用された実施形態について、図面を用いて説明する。
図1は、自車位置推定装置のブロック図および周辺システムの結線を示す図である。
図1に示す自車位置推定装置104(以下自ユニット104)は、車両(図示せず)に搭載された1つのGNSSアンテナ101から測位信号を処理するGNSS処理部102、2つの互いに独立した加速度検出センサ(112および114)、2つの互いに独立した角速度検出センサ(111、113)、マイコン110、電源および通信部109、メモリ103から構成される。
また、自装置である自ユニット104はCAN(ControllerAreaNetwork)等の車両通信インターフェースを介してカメラユニット105や他制御装置107、ステアリング角度検出部108と接続される。
ここで、カメラ106およびカメラユニット105は、道路上に描かれた白線情報(センサ情報)を認識する機能を有する事を前提とする。また、ステアリング角度検出部は車両のハンドルの操舵角度(センサ情報)を検出する機能を有する事を前提とする。加速検出センサ112、114と角速度検出センサ111、113は、車両の所定方向における加速度と角速度(センサ情報)を検出する。
図2は、自車両の走行レーンを変更する動作を示す図である。図2には、左側路肩201、左端白線202、中央白線203、右端白線204、中央分離帯205、他車両206、走行レーン変更後の自車推定位置207、走行レーン変更前の自車位置208、緊急車両通行帯209、左レーン210、右レーン211が示されている。
図2を参照し、ここでは自車両208の前方に他車両206が走行しており、自車両208が追い越し車線に車線変更し、他車両206を追い越しする場合を説明する。自ユニット104によって、自車走行レーンが左レーン210であり、かつ右レーン211上に他車両含む障害物が居なく安全と判断された場合、他制御装置107は左レーン210から右レーン211への車線変更処理を実行する。
図3は、測位信号の変動が大きい場合に自車位置の誤検知を示す図である。図3には、他車両206、実際の自車両の位置301、GNSS測位信号の変動302、GNSS測位信号の変動302に基づいて自ユニットが誤検知した自車両の位置303が示されている。ここでは、実際には自車両は右レーンを走行しているが、GNSS測位信号のマルチパスの影響等により、GNSS測位信号に変動が発生し、自車両の走行レーンを左レーンと誤検知する可能性を図示している。
図4は、自車位置情報の確定処理を示すフローチャートである。
図4の自車位置情報の確定処理401では、GNSS衛星補足状態および自ユニット内に実装されたセンサのセンサ情報により、自車位置推定結果の確からしさを出力する処理が行われる。センサ情報には、例えばカメラ106で検出した白線認識の情報や、加速度検出センサ112、114で検出した加速度情報や、角速度検出センサ111、113で検出した角速度情報が含まれている。ここでは、最初にGNSS衛星の捕捉状態を判定し(402)、判定結果が良好の場合には、各種センサの検出状態を判定する処理(403以降の処理)に移行する。
まず、GNSS衛星補足状態を判定する(402)。ここでは、1つのGNSSアンテナ101から得られる測位信号を元に、GNSS処理部102にて衛星捕捉数や受信感度を算出する。そして、あらかじめ定められた判定閾値を比較する事により、GNSS衛星の補足状態が良好かそれ以外かを判別する。
GNSS衛星の補足状態が良好以外と判別された場合(402でNO)、トンネル内や遮蔽物によりGNSS測位信号が十分な確度にて受信できていない可能性があり、この為、自車位置情報を不定(407)とし、他制御装置107に送信する。他制御装置107では、自車位置情報が不定の場合、その情報を車両の制御に使用しないなどの、フェールセール処理を実行する。
一方、GNSS衛星の補足状態が良好と判別された場合(402でYES)、次処理として、カメラ106による白線認識結果の判定処理403を実行する。ここでは、カメラ106により認識した走行道路の白線情報をセンサ情報として用い、自車位置情報が不定であるか否かが判断される。例えば、カメラ106による白線認識結果の判定処理403にて、白線位置の変動量小以外と判定された場合(403でNO)、逆光による路面の反射、白線のかすれ・消え等による白線の誤認識の可能性があり、この為、自車位置情報を不定(407)とし、他制御装置107に送信する。他制御装置107では、自車位置情報が不定の場合、その情報を車両の制御に使用しないなどの、フェールセール処理を実行する。
一方、カメラ106による白線認識結果の判定処理403にて、白線位置の変動量小と判定された場合(403でYES)、次処理として、加速度・角速度の安定性判定処理404を実行する。ここでは、加速度検出センサ112、114あるいは角速度センサ111、113により検出された車両の加速度・角速度の情報をセンサ情報として用い、自車位置情報が不定であるか否かが判断される。例えば、加速度・角速度の安定性判定処理404にて異常変動無し以外と判定された場合(404でNO)、加速度検出センサ(112および114)、角速度検出センサ(111、113)速度センサのいずれかに安定性がなく、異常変動が発生しており、素子の短絡(ショート)や開放(オープン)故障が想定される。この為、自車位置情報を不定(407)とし、他制御装置107に送信する。他制御装置107では、自車位置情報が不定の場合、その情報を車両の制御に使用しないなどの、フェールセール処理を実行する。
一方、加速度・角速度の安定性判定処理404にて異常変動無しと判定された場合(404でYES)、次処理として、冗長化された加速度・角速度センサの一致性判定処理405を実行する。ここでも、加速度検出センサ112、114あるいは角速度センサ111、113により検出された車両の加速度・角速度の情報をセンサ情報として用い、自車位置情報が不定であるか否かが判断される。例えば、冗長化された加速度・角速度センサの一致性判定処理405にて、偏差量小以外と判定された場合(405でNO)、加速度検出センサ(112および114)と、角速度検出センサ(111、113)速度センサの検出結果に一致性がなく、いずれかに、短絡や開放の様な明らかな異常出力ではないが、誤差が増大しており、本来の出力とは異なる値を出力するなど、正しくセンサとして機能していない可能性が想定される。この為、自車位置情報を不定(407)とし、他制御装置107に送信する。他制御装置107では、自車位置情報が不定の場合、その情報を車両の制御に使用しないなどの、フェールセール処理を実行する。
一方、冗長化された加速度・角速度センサの一致性判定処理405にて、偏差量小と判定された場合(405でYES)、各センサは正常に動作していると判定し、自車位置情報を確定とし(406)、他制御装置107に送信する。他制御装置107では、自車位置情報が確定した場合に限り、車両の走行制御等にその情報を適用する。
本発明によれば、GNSS衛星補足状態および自ユニット内に実装されたセンサ情報により、測位信号に基づいて自車両の位置を高精度に推定し、かつ、推定結果の確からしさを出力することができる。
以上、本発明の実施形態について詳述したが、本発明は、前記の実施形態に限定されるものではなく、特許請求の範囲に記載された本発明の精神を逸脱しない範囲で、種々の設計変更を行うことができるものである。例えば、前記した実施の形態は本発明を分かりやすく説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。また、ある実施形態の構成の一部を他の実施形態の構成に置き換えることが可能であり、また、ある実施形態の構成に他の実施形態の構成を加えることも可能である。さらに、各実施形態の構成の一部について、他の構成の追加・削除・置換をすることが可能である。
101 GNSSアンテナ
102 GNSS処理部
103 メモリ
104 自車位置推定装置
105 カメラユニット
106 カメラ
107 他制御装置
108 ステアリング角度検出部

Claims (7)

  1. 自車位置推定装置において、GNSS衛星補足状態および自装置内に実装されたセンサのセンサ情報により、自車位置推定結果の確からしさを出力する事を特徴とする自車位置推定装置。
  2. 請求項1記載のセンサ情報が車両の加速度あるいは角速度に基づくセンサ情報である事を特徴とする自車位置推定装置。
  3. 請求項1記載のセンサ情報が走行道路の白線情報に基づくセンサ情報である事を特徴とする自車位置推定装置。
  4. 請求項1記載のセンサ情報がステアリングの操舵角度に基づくセンサ情報である事を特徴とする自車位置推定装置。
  5. 請求項1記載のセンサ情報が互いに独立し、かつ、冗長化された構成のセンサ情報である事を特徴とする自車位置推定装置。
  6. 自車位置情報を確定とする確定処理手段を備え、
    該確定処理手段は、
    GNSS衛星の捕捉状態が良好と判定され、かつ、
    カメラの白線認識により白線位置の変動量が閾値よりも小さいと判定され、かつ、
    加速度・各速度センサの安定性判定により異常変動の発生なしと判定され、かつ、
    冗長化された加速度・角速度センサの一致性判定により偏差量が閾値よりも小さいと判定された場合に、自車位置情報を確定とすることを特徴とする請求項1に記載の自車位置推定装置。
  7. GNSS衛星捕捉状態を判定するGNSS処理部を備え、
    該GNSS処理部は、1つのGNSSアンテナから得られる測位信号に基づいて、衛星捕捉数と受信感度を算出し、予め設定された判定閾値と比較することによってGNSS衛星の捕捉状態が良好か否かを判定することを特徴とする請求項1に記載の自車位置推定装置。
JP2016117583A 2016-06-14 2016-06-14 自車位置推定装置 Active JP6738656B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2016117583A JP6738656B2 (ja) 2016-06-14 2016-06-14 自車位置推定装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2016117583A JP6738656B2 (ja) 2016-06-14 2016-06-14 自車位置推定装置

Publications (2)

Publication Number Publication Date
JP2017223483A true JP2017223483A (ja) 2017-12-21
JP6738656B2 JP6738656B2 (ja) 2020-08-12

Family

ID=60687973

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2016117583A Active JP6738656B2 (ja) 2016-06-14 2016-06-14 自車位置推定装置

Country Status (1)

Country Link
JP (1) JP6738656B2 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2022022715A (ja) * 2020-07-02 2022-02-07 三菱ロジスネクスト株式会社 位置推定装置、車両、位置推定方法およびプログラム

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01500714A (ja) * 1986-08-20 1989-03-09 グラマン エアロスペース コーポレーション 分散型カルマンフィルタ
JPH07286853A (ja) * 1994-04-15 1995-10-31 Nissan Motor Co Ltd 車両用位置検出装置
JPH11296799A (ja) * 1998-04-09 1999-10-29 Fujitsu Ten Ltd 走行路形状認識装置
JP2001296138A (ja) * 2000-04-13 2001-10-26 Honda Motor Co Ltd 走行路の曲率算出装置
JP2003057064A (ja) * 2001-07-27 2003-02-26 Sin Etke Technology Co Ltd Gps運転制御システム及びその方法
JP2008249555A (ja) * 2007-03-30 2008-10-16 Mitsubishi Electric Corp 位置特定装置、位置特定方法および位置特定プログラム
JP2011122996A (ja) * 2009-12-14 2011-06-23 Sony Corp 高度出力装置、高度出力方法及びプログラム
US20150292891A1 (en) * 2014-04-11 2015-10-15 Nissan North America, Inc Vehicle position estimation system

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01500714A (ja) * 1986-08-20 1989-03-09 グラマン エアロスペース コーポレーション 分散型カルマンフィルタ
JPH07286853A (ja) * 1994-04-15 1995-10-31 Nissan Motor Co Ltd 車両用位置検出装置
JPH11296799A (ja) * 1998-04-09 1999-10-29 Fujitsu Ten Ltd 走行路形状認識装置
JP2001296138A (ja) * 2000-04-13 2001-10-26 Honda Motor Co Ltd 走行路の曲率算出装置
JP2003057064A (ja) * 2001-07-27 2003-02-26 Sin Etke Technology Co Ltd Gps運転制御システム及びその方法
JP2008249555A (ja) * 2007-03-30 2008-10-16 Mitsubishi Electric Corp 位置特定装置、位置特定方法および位置特定プログラム
JP2011122996A (ja) * 2009-12-14 2011-06-23 Sony Corp 高度出力装置、高度出力方法及びプログラム
US20150292891A1 (en) * 2014-04-11 2015-10-15 Nissan North America, Inc Vehicle position estimation system

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2022022715A (ja) * 2020-07-02 2022-02-07 三菱ロジスネクスト株式会社 位置推定装置、車両、位置推定方法およびプログラム
JP7167097B2 (ja) 2020-07-02 2022-11-08 三菱ロジスネクスト株式会社 位置推定装置、車両、位置推定方法およびプログラム

Also Published As

Publication number Publication date
JP6738656B2 (ja) 2020-08-12

Similar Documents

Publication Publication Date Title
US20230137183A1 (en) Vehicular environment estimation device
US12013694B2 (en) Operation-security system for an automated vehicle
CN107490794B (zh) 物体辨识处理装置、物体辨识处理方法及自动驾驶***
US9731728B2 (en) Sensor abnormality detection device
EP2637149B1 (en) Onboard device and control method
JP5713106B2 (ja) 車両特定システム及び車両特定装置
KR102075110B1 (ko) V2v 통신 기반 차량 식별 장치 및 그 식별 방법
CN109219536B (zh) 用于自动化车辆的v2x物***置验证***
JP4752669B2 (ja) 車両同定装置、位置算出装置
CN107571866B (zh) 用于分析传感器数据的方法
US20190061748A1 (en) Collision prediction apparatus
KR20200123505A (ko) 군집 주행 제어 장치, 그를 포함한 시스템 및 그 방법
US11340357B2 (en) Method and apparatus for detecting a position of a vehicle having a high level of automation
JP6738656B2 (ja) 自車位置推定装置
CN109932721B (zh) 应用于多感测器融合的误差及侦测机率分析方法
JP2015031607A (ja) 物体認識装置
CN114902071A (zh) 用于抑制环境传感器的不确定性测量数据的方法
JP2022098635A (ja) 自車位置信頼度演算装置、自車位置信頼度演算方法、車両制御装置、及び車両制御方法
KR102203947B1 (ko) 차선 유지 보조 시스템 및 그의 차선 유지 제어 방법
JP7482440B2 (ja) 情報処理装置、情報処理方法及びプログラム
US20230168352A1 (en) Method for assessing a measuring inaccuracy of an environment detection sensor
CN117901786A (zh) 验证目标对象的存在的***和方法、车辆以及程序产品
CN115867822A (zh) 车辆用***和物标识别程序

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20160615

RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20170120

RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20170126

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20180803

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20180806

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20190717

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20190806

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20191004

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200303

RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20200417

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200424

RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20200424

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: 20200630

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20200720

R150 Certificate of patent or registration of utility model

Ref document number: 6738656

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

S533 Written request for registration of change of name

Free format text: JAPANESE INTERMEDIATE CODE: R313533

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350