JP2023005475A - 車両制御装置 - Google Patents
車両制御装置 Download PDFInfo
- Publication number
- JP2023005475A JP2023005475A JP2021107413A JP2021107413A JP2023005475A JP 2023005475 A JP2023005475 A JP 2023005475A JP 2021107413 A JP2021107413 A JP 2021107413A JP 2021107413 A JP2021107413 A JP 2021107413A JP 2023005475 A JP2023005475 A JP 2023005475A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- radio
- vehicle position
- sensor
- deviation
- 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.)
- Pending
Links
- 238000001514 detection method Methods 0.000 abstract description 11
- 238000004891 communication Methods 0.000 abstract description 6
- 230000002708 enhancing effect Effects 0.000 abstract 1
- 238000012545 processing Methods 0.000 description 16
- 230000000694 effects Effects 0.000 description 11
- 230000006399 behavior Effects 0.000 description 8
- 240000004050 Pentaglottis sempervirens Species 0.000 description 7
- 235000004522 Pentaglottis sempervirens Nutrition 0.000 description 7
- 238000000034 method Methods 0.000 description 6
- 230000001133 acceleration Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 230000006870 function Effects 0.000 description 4
- 238000012937 correction Methods 0.000 description 3
- 230000015654 memory Effects 0.000 description 3
- 230000007423 decrease Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0205—Details
- G01S5/021—Calibration, monitoring or correction
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0257—Hybrid positioning
- G01S5/0258—Hybrid positioning by combining or switching between measurements derived from different systems
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0284—Relative positioning
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
- H04W4/023—Services making use of location information using mutual or relative location information between multiple location based services [LBS] targets or of distance thresholds
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/40—Services specially adapted for particular environments, situations or purposes for vehicles, e.g. vehicle-to-pedestrians [V2P]
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S2205/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S2205/01—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations specially adapted for specific applications
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Automation & Control Theory (AREA)
- Traffic Control Systems (AREA)
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
【課題】無線発信機の通信に対する障害による無線発信機の検出誤差を抑制するため、車両外部に設置された無線発信機と車両に搭載されたセンサを用いて算出した2種の車両位置を比較し、誤差を検出することで、遮蔽物に対するロバスト性を高め、さらに、事前に無線発信機からの受信電波を測定することがない、例えば自動運転制御を継続可能な車両制御装置を提供する。【解決手段】車両に搭載されたセンサおよび無線発信機を用いて算出した2種の車両位置を比較し、車両位置偏差の時間変化および/または無線発信機に基づく車両位置(第一の自車位置)の挙動変化を検出した場合に無線発信機が遮蔽物による影響を受けていると判断する。【選択図】図3
Description
本発明は、車両に無線受信機が備え付けられ、車両外部に設置された無線発信機からの受信電波の受信強度に基づく距離情報または位相差に基づく方位情報の少なくとも一つから車両の位置を推定する車両制御装置に関する。
2つ以上の無線発信機からの受信電波の組み合わせを事前に取得しており、この組み合わせに基づいて、無線受信機を搭載した移動体を測位するとともに、受信強度の変化に基づいて遮蔽物による受信電波への影響の有無を判定する方法が知られている(特許文献1参照)。
しかしながら、無線受信機から発信される電波は通信経路上の遮蔽物により信号強度が低下するだけでなく、回折により電波の進行方向が変わる。図18に示すように、車両外部に設置される無線発信機から車両に搭載される無線受信機で受信する無線発信機の距離および方位情報に基づいて車両を測位する場合、遮蔽物により無線発信機の見かけ位置(車両から見る無線発信機の位置)が変化する可能性がある。すなわち、無線発信機の位置および方位情報を誤検出する可能性がある。また、特許文献1では、2つ以上の無線発信機からの受信電波の組み合わせを事前に測定する必要があり、手間がかかる。
そこで、本発明の目的は、無線発信機の通信に対する障害による無線発信機の検出誤差を抑制するため、車両外部に設置された無線発信機と車両に搭載されたセンサを用いて算出した2種の車両位置を比較し、誤差を検出することで、遮蔽物に対するロバスト性を高め、さらに、事前に無線発信機からの受信電波を測定することがない、例えば自動運転制御を継続可能な車両制御装置を提供することにある。
上記目的を達成するために、本発明は、車両外部の任意の位置に設置された無線発信機からの電波を受信して前記車両と前記無線発信機の相対位置を算出する無線位置推定部と、前記車両に搭載されたセンサで取得する情報に基づいて前記車両の位置を算出する自車位置推定部と、前記無線位置推定部で取得された第一の自車位置と前記自車位置推定部で取得された第二の自車位置との比較に基づいて、受信電波が遮蔽物による影響を受けていることを判断する車両センサ誤差判定部と、を有することを特徴とする。
本発明によれば、車両に搭載されたセンサに対するスリップまたは段差または無線発信機に対する遮蔽物または電波干渉などの障害が生じた際に、検出誤差が発生していることを判断し、利用するセンサを決定することで、無線発信機を用いた自車位置推定において障害に対するロバスト性を高めることができる。また、カメラやソナーなどの外界認識センサを構成に組み込むことなく、車両に標準装備されているセンサを用いることで上記効果を得られる。
上記した以外の課題、構成及び効果は、以下の実施形態の説明により明らかにされる。
以下の実施の形態においては便宜上その必要があるときは、複数のセクションまたは実施の形態に分割して説明するが、特に明示した場合を除き、それらはお互いに無関係なものではなく、一方は他方の一部または全部の変形例、詳細、補足説明等の関係にある。
以下、本発明の実施の形態を図1~図17を用いて詳細に説明する。
(実施形態1)
まず、本発明の実施形態1を図1~図14を用いて詳細に説明する。
まず、本発明の実施形態1を図1~図14を用いて詳細に説明する。
まず初めに図1を用いて本発明の実施形態1による車両制御装置としての車両制御ECU(Electronic Control Unit)9を搭載した車両100の構成を説明する。本実施形態の車両制御ECU9は、車両(自車両)100に搭載され、車両100の自動運転制御を実行可能である。
車両100は、主に、右前車輪2FRの車輪速を検知する右前車輪速センサ3FR、右後車輪2RRの車輪速を検知する右後車輪速センサ3RR、左後車輪2RLの車輪速を検知する左後車輪速センサ3RL、左前車輪2FLの車輪速を検知する左前車輪速センサ3FL、車両100の運転室内に設けられたステアリングホイール11の操舵角に応じて各車輪2(2FR、2RR、2RL、2FL)の向きを変える電動パワーステアリング装置4、車両100外部の任意の位置に設置される無線発信機6が発信する電波に基づいて無線発信機6の距離および方位情報を取得する無線受信機5、加速度センサ7、GPS(Global Positioning System)8、車両制御ECU9、アクチュエータECU10等から構成される。無線受信機5が取得する距離情報は、例えば、受信強度(RSSI(Received Signal Strength Indicator))から伝搬距離に応じた減衰特性を用いて取得できる。また、方位情報は、例えば、無線受信機5に2つ以上のアンテナ12(図2)を備え、アンテナ間の位相差から取得できる。
次に、図2を用いて車両制御ECU9の内部構成を説明する。前記車両制御ECU9は、A/D変換器を含むI/O LSI9a、CPU9b等から構成される。前記したように、前記車両制御ECU9は、車輪速センサ3(3FR、3RR、3RL、3FL)、電動パワーステアリング装置4、無線受信機5、加速度センサ7、GPS8から信号が入力される。なお、これらの通信方式は限定されず、CAN(Car Aria Network)を介して直接接続してもよい。また、無線受信機5と複数のアンテナ12は、アンテナ間の受信電波のタイムスタンプが統一されるように、同じECUに備えることが望ましい。前記車両制御ECU9は、自車両100の走行状態および所定の経路に基づいて、各種アクチュエータの指令値をアクチュエータECU10に送信して、自車両100を制御する。
詳細には、図3に示されるように、車両制御ECU9は、基本的に、無線位置推定部301、自車位置推定部302、車両センサ誤差判定部303、車両制御部304を備える。なお、車両制御ECU9は、CPU(Central Processing Unit)等のプロセッサ、ROM(Read Only Memory)、RAM(Random Access Memory)、HDD(Hard Disk Drive)等のメモリ等を備えるコンピュータとして構成されている。車両制御ECU9の各機能は、ROMに記憶されたプログラムをプロセッサが実行することによって実現される。RAMは、プロセッサが実行するプログラムによる演算の中間データ等を含むデータを格納する。
前記無線位置推定部301では、前記無線受信機5で取得する無線発信機6の距離および/または方位情報から前記無線発信機6の位置を原点とする自車両100の第一の自車位置および第一の速度および第一の進行方向を演算する。前記無線位置推定部301は、演算した第一の自車位置および第一の速度および第一の進行方向を、自車位置推定部302および車両センサ誤差判定部303へ送信する。
前記自車位置推定部302では、車輪速センサ3から各車輪2の車輪速を取得し、電動パワーステアリング装置4の操舵角センサからステアリングホイール11の操舵角を取得し、加速度センサ7から自車両100に発生するヨーレートを取得し、無線位置推定部301から第一の自車位置を取得し、自車両100の第二の自車位置および第二の速度および第二の進行方向を演算する。前記自車位置推定部302は、演算した第二の自車位置および第二の速度および第二の進行方向を、車両センサ誤差判定部303へ送信する。
前記車両センサ誤差判定部303では、前記無線位置推定部301にて演算された自車両100の第一の自車位置および第一の速度および第一の進行方向と前記自車位置推定部302にて演算された自車両100の第二の自車位置および第二の速度および第二の進行方向とを比較し、車輪速センサ3および/または無線受信機5のどちらが誤差の影響を受けているかを判定し、判定結果に応じて、自車両100の自車位置を第一の自車位置と第二の自車位置から決定する。前記車両センサ誤差判定部303は、自車両100の自車位置および速度および進行方向を前記車両制御部304へ送信する。
前記車両制御部304では、前記車両センサ誤差判定部303にて演算された自車両100の自車位置および速度および進行方向に基づいて、所定の経路に沿って自車両100が走行(自律走行)するように各種アクチュエータの指令値を演算する。前記車両制御部304は、演算した各種アクチュエータの指令値を、前記アクチュエータECU10へ送信する。
前記アクチュエータECU10では、前記車両制御部304にて演算された各種アクチュエータの指令値に基づいて、アクチュエータを制御することにより、前記所定の経路に沿って自車両100が走行(自律走行)することができる。
次に、図4のフローを用いて車両制御ECU9による車両制御全体の概要について説明する。前記無線受信機5と前記無線発信機6の相対位置に基づいて自車両100の第一の自車位置を演算する無線位置推定S401を実施し(無線位置推定部301)、無線位置推定S401の自車両100の自車位置を初期位置として、車輪速センサ3から取得する情報等に基づいて自車両100の第二の自車位置を演算する自車位置推定S402を演算する(自車位置推定部302)。誤差状態判定S403にて第一の自車位置と第二の自車位置とを比較し、少なくとも「誤差が含まれない」もしくは「車輪速センサ3に段差またはスリップによる誤差が含まれる」もしくは「無線受信機5に遮蔽物または電波干渉による誤差が含まれる」を判定し(車両センサ誤差判定部303)、位置情報選択S404にて判定結果に応じて第一の自車位置と第二の自車位置のどちらを自車両100の自車位置とするかを決定する(車両センサ誤差判定部303)。アクチュエータ指令値演算S405にて自車両100の自車位置が所定の経路に沿って走行するように各種アクチュエータの指令値を演算する(車両制御部304)。これが車両制御ECU9にプログラミングされ、あらかじめ定められた周期で繰り返し実行される。
本実施形態の用途は限定されるものではなく、例えば、エリア限定の低速自動運転において、エリア内にIDで識別可能な無線発信機6を設置し、自車両100に設けた無線受信機5と無線発信機6の通信を開始し、自車両100を無線発信機6に基づいて所定の経路に沿って誘導する。自車両100を誘導する際、無線位置推定が苦手とするような、無線受信機5と無線発信機6の通信経路が他車両や柱(遮蔽物)によって遮蔽される状況や、自車位置推定が苦手とするような、段差や低摩擦などの路面状態によって車輪速センサ3に誤差が加わる状況において、車両100に搭載された無線受信機5が取得する情報と車輪速センサ3および/または電動パワーステアリング装置4が取得する情報を比較することで、検出誤差の識別が可能となる。
<無線位置推定S401(無線位置推定部301)>
次に図5を用いて、図4の無線位置推定S401の詳細を説明する。
次に図5を用いて、図4の無線位置推定S401の詳細を説明する。
S501では、無線受信機5で取得した受信強度および位相差に基づく無線発信機6の距離および方位情報を取得する。なお、距離および方位情報を取得できない場合、S502以降の処理を実行しないなど、無線発信機6の未検出に対する処理があってもよい。
S502では、無線発信機6の距離および方位情報から無線発信機6の位置を原点とする自車両100の第一の自車位置(Xt,Yt)を演算する。なお、第一の自車位置(Xt,Yt)の検出方法は、これに限定されない。例えば、2つ以上の前記無線受信機5を所定の位置に備え、無線受信機5で取得した方位情報に基づき三角測量によって第一の自車位置を演算してもよい。
S503では、第一の自車位置(Xt,Yt)の移動方向から自車両100の第一のヨー角Yawtを演算する。なお、第一のヨー角Yawtの検出方法は、これに限定されない。例えば、2つの識別可能な無線発信機6を所定の方向で備え、無線受信機5と2つの無線発信機6のそれぞれの相対位置から第一のヨー角を演算してもよい。
S504では、第一の自車位置(Xt,Yt)の移動距離の時間変化量から自車両100の第一の速度(車速)Vtを演算する。
<自車位置推定S402(自車位置推定部302)>
次に図6を用いて、図4の自車位置推定S402の詳細を説明する。
次に図6を用いて、図4の自車位置推定S402の詳細を説明する。
S601では、図5の第一の自車位置(Xt,Yt)および第一のヨー角Yawtを取得し、第二の自車位置の初期位置とする。なお、S601の処理は毎周期実行するものではなく、第一の自車位置および第一のヨー角を取得した初回のみ実行する、もしくは、図4のS403で車輪速センサ3に誤差が含まれると判定する場合に、初期化による補正のために実行する。
S602では、車輪速センサ3から各車輪2の車輪速を取得し、電動パワーステアリング装置4の操舵角センサからステアリングホイール11の操舵角を取得し、加速度センサ7から自車両100に発生するヨーレートを取得する。
S603では、車輪速から自車両100の第二の速度(車速)Vdを演算する。
S604では、操舵角および/またはヨーレートから自車両100の第二のヨー角Yawdを演算する。本実施形態において、第二のヨー角Yawdは操舵角センサまたはジャイロセンサまたは加速度センサ7に基づく転舵角の積和であり、スリップおよび/または段差の影響の大きい車輪速センサ3(の車輪速)は使用しない。
S605では、車輪速から移動距離を演算し、S601で取得した初期位置およびS604で取得した第二のヨー角から自車両100の第二の自車位置(Xd,Yd)を演算する。
<誤差状態判定S403(車両センサ誤差判定部303)>
次に図7を用いて、図4の誤差状態判定S403の詳細を説明する。
次に図7を用いて、図4の誤差状態判定S403の詳細を説明する。
S701では、車輪速センサ3または無線受信機5の少なくとも一つに誤差が含まれるかを判定するために、第一の自車位置(Xt,Yt)と第二の自車位置(Xd,Yd)のそれぞれの要素成分の偏差|Xt-Xd|または|Yt-Yd|の少なくとも一つが所定の閾値を超えるかを判定する。ここで、自車位置の偏差が所定の閾値以下であれば、車輪速センサ3および無線受信機5に誤差が含まれないと判断してS703を実行し、自車位置の偏差が所定の閾値を超えるのであれば、車輪速センサ3または無線受信機5の少なくとも一つに誤差が含まれると判断してS702を実行する。さらに、障害により無線発信機6をロストした場合は、無条件でS705を実行してもよい。なお、S701の判定は、誤判定防止のために、所定の判定時間もしくは判定距離の間、継続して条件を満たすことで判定してもよい。
S702では、車輪速センサ3もしくは無線受信機5のどちらに誤差が含まれるかを判定するために、第一の自車位置(Xt,Yt)と第二の自車位置(Xd,Yd)のそれぞれの要素成分の偏差の時間変化Δ|Xt-Xd|またはΔ|Yt-Yd|の少なくとも一つが所定の閾値を超えるかを判定する。ここで、自車位置の偏差の時間変化が所定の閾値以下であれば、段差やスリップなどによる一時的な影響であるとしてS704を実行し、自車位置の偏差の時間変化が所定の閾値を超えるのであれば、無線発信機6から見て自車両100が遮蔽物の影に入ったことによる影響であるとしてS705を実行する。なお、S702の判定は、誤判定防止のために、所定の判定時間もしくは判定距離の間、継続して条件を満たすことで判定してもよい。
S703では、誤差状態ERRSTSは、誤差がないことを示す0とする。
S704では、誤差状態ERRSTSは、車輪速センサ3(言い換えると、第二の自車位置)に誤差があることを示す1とする。
S705では、誤差状態ERRSTSは、無線受信機5(言い換えると、第一の自車位置)に誤差があることを示す2とする。
<位置情報選択S404(車両センサ誤差判定部303)>
図4の位置情報選択S404については、図8に示されるように誤差状態ERRSTSの値に応じた第一の自車位置または第二の自車位置のどちらかを自車両100の自車位置と決定する。つまり、誤差状態ERRSTSが0または1であれば、第一の自車位置(無線位置推定S401による自車位置)を自車両100の自車位置と決定し、誤差状態ERRSTSが2であれば、第二の自車位置(自車位置推定S402による自車位置)を自車両100の自車位置と決定する。なお、自車両100が2つ以上の無線受信機5を備える場合、認識不全となる無線受信機5が取得する無線発信機6の距離および方位情報を用いず、正常動作する無線受信機5が取得する無線発信機6の距離および方位情報から自車両100の自車位置を演算してもよい。
図4の位置情報選択S404については、図8に示されるように誤差状態ERRSTSの値に応じた第一の自車位置または第二の自車位置のどちらかを自車両100の自車位置と決定する。つまり、誤差状態ERRSTSが0または1であれば、第一の自車位置(無線位置推定S401による自車位置)を自車両100の自車位置と決定し、誤差状態ERRSTSが2であれば、第二の自車位置(自車位置推定S402による自車位置)を自車両100の自車位置と決定する。なお、自車両100が2つ以上の無線受信機5を備える場合、認識不全となる無線受信機5が取得する無線発信機6の距離および方位情報を用いず、正常動作する無線受信機5が取得する無線発信機6の距離および方位情報から自車両100の自車位置を演算してもよい。
図9では、本実施形態に係る自車両100が所定の経路1101を走行中に無線受信機5と無線発信機6の間にある遮蔽物1102の影1103中に自車両100が進入するシーンを俯瞰で示している。時刻t1では無線受信機5が影1103に進入するタイミングを示し、時刻t2では影1103が濃いため、無線受信機5が無線発信機6をロストするタイミングを示し、時刻t3では影1103が薄くなるため、無線受信機5が無線発信機6の電波を再受信するタイミングを示し、時刻t4では無線受信機5が影1103から退出するタイミングを示す。
次に図10を用いて、図9のシーンにおける無線位置推定S401から位置情報選択S404までの処理の一例を説明する。
時刻t1以前は、無線受信機5は影1103に進入する前であるため、位置偏差|Xt-Xd|および|Yt-Yd|は所定の閾値以下であり、誤差状態ERRSTSは0となり、無線位置推定により自車両100の自車位置を演算する。
時刻t1からt2の間では、無線受信機5は影1103に進入したことにより、影1103の濃い方へ自車両100が移動するほど位置偏差|Xt-Xd|および|Yt-Yd|は増加し、位置偏差|Yt-Yd|が所定の閾値2を超えたタイミングで、Y位置偏差時間変化量Δ|Yt-Yd|が所定の閾値4を超えているため、誤差状態ERRSTSは2となり、自車位置推定により自車両100の自車位置を演算する。
時刻t2からt3の間では、無線受信機5が無線発信機6をロストしているため、誤差状態ERRSTSは2を維持し、自車位置推定により自車両100の自車位置を演算する。
時刻t3以降では、無線受信機5が影1103の薄い方へ移動するほど位置偏差|Xt-Xd|および|Yt-Yd|は減少し、位置偏差|Yt-Yd|が所定の閾値2以下となるタイミングで、誤差状態ERRSTSは0となり、無線位置推定により自車両100の自車位置を演算する。
図11では、本実施形態に係る自車両100が所定の経路1301を走行中に右前車輪2FRと右後車輪2RRがぬかるみ1303上に乗ることでスリップしてしまうシーンを俯瞰で示している。時刻t2では右前車輪2FRがぬかるみ1303に乗るタイミングを示し、時刻t3では所定時間経過もしくは所定距離走行後に自車位置推定の初期位置を更新するタイミングを示す。
次に図12を用いて、図11のシーンにおける無線位置推定S401から位置情報選択S404までの処理の一例を説明する。
時刻t2以前は、右前車輪2FRがぬかるみ1303に乗る前であるため、位置偏差|Xt-Xd|および|Yt-Yd|は所定の閾値以下であり、誤差状態ERRSTSは0となり、無線位置推定により自車両100の自車位置を演算する。
時刻t2からt3の間、右前車輪2FRがぬかるみ1303によりスリップすることで、位置偏差|Xt-Xd|および|Yt-Yd|が一時的に増加し、位置偏差|Xt-Xd|が所定の閾値1を超えたタイミングで、X位置偏差時間変化量Δ|Xt-Xd|およびY位置偏差時間変化量Δ|Yt-Yd|は所定の閾値以下であるため、誤差状態ERRSTSは1となり、無線位置推定により自車両100の自車位置を演算する。
時刻t3以降は、誤差状態ERRSTSが1となってから所定時間経過もしくは所定距離走行後に、S601(図6)にて第二の自車位置を第一の自車位置に再設定することで、スリップの影響を抑制する。なお、第二の自車位置の補正時には各要素成分の変化量を制限することで、自車両100が急激な挙動をすることを防止してもよい。
図13では、本実施形態に係る自車両100が所定の経路1501を走行中に自車両100の前輪側に備える無線受信機5aおよび後輪側に備える無線受信機5bと無線発信機6の間にある遮蔽物1502の影1503中に自車両100が進入してしまうシーンを俯瞰で示している。このシーンでは、無線受信機5aおよび5bが取得する無線発信機6の方位情報および無線受信機5aと5bの既知の距離に基づく三角測量により無線発信機6と自車両100の相対位置を演算する。時刻t1では無線受信機5aが影1503に進入するタイミングを示し、時刻t2では無線受信機5aの位置で影1503が濃いため、無線受信機5aが無線発信機6をロストするタイミングを示し(図13には不図示、図14に図示)、時刻t3では影1503が薄くなるため、無線受信機5aが無線発信機6の電波を再受信するタイミングを示し、時刻t4では無線受信機5bの位置で影1503が濃いため、無線受信機5bが無線発信機6をロストするタイミングを示し(図13には不図示、図14に図示)、時刻t5では影1503が薄くなるため、無線受信機5bが無線発信機6の電波を再受信するタイミングを示し(図13には不図示、図14に図示)、時刻t6では無線受信機5aおよび5bが影1503から退出するタイミングを示す。
次に図14を用いて、図13のシーンにおける無線位置推定S401から位置情報選択S404までの処理の一例を説明する。
時刻t1以前は、無線受信機5aおよび5bは影1503に進入する前であるため、位置偏差|Xt-Xd|および|Yt-Yd|は所定の閾値以下であり、誤差状態ERRSTSは0となり、無線位置推定により自車両100の自車位置を演算する。
時刻t1からt2の間では、無線受信機5aは影1503に進入したことにより、影1503の濃い方へ自車両100が移動するほど位置偏差|Xt-Xd|および|Yt-Yd|は増加し、位置偏差|Yt-Yd|が所定の閾値2を超えたタイミングで、X位置偏差時間変化量Δ|Xt-Xd|が所定の閾値3を超えるか、または、Y位置偏差時間変化量Δ|Yt-Yd|が所定の閾値4を超えるか少なくとも一つを満たすため、誤差状態ERRSTSは2となり、自車位置推定により自車両100の自車位置を演算する。
時刻t2からt3の間では、無線受信機5aが無線発信機6をロストしているため、誤差状態ERRSTSは2となり、自車位置推定により自車両100の自車位置を演算する。なお、無線受信機5aが認識不全である間、もう一方の無線受信機5bが取得する無線発信機6の距離情報及び方位情報に基づき自車両100の自車位置を演算してもよい。
時刻t3からt4の間では、無線受信機5aが無線発信機6を検出するため、無線受信機5aおよび5bが影1503を移動するほどX位置偏差|Xt-Xd|は増加し、Y位置偏差|Yt-Yd|は一定の値でとどまり、Y位置偏差|Yt-Yd|が所定の閾値2を超え、X位置偏差時間変化量Δ|Xt-Xd|が所定の閾値3を超えるため、誤差状態ERRSTSは2となり、自車位置推定により自車両100の自車位置を演算する。
時刻t4からt5の間では、無線受信機5bが無線発信機6をロストしているため、誤差状態ERRSTSは2となり、自車位置推定により自車両100の自車位置を演算する。なお、無線受信機5bが認識不全である間、もう一方の無線受信機5aが取得する無線発信機6の距離情報及び方位情報に基づき自車両100の自車位置を演算してもよい。
時刻t5以降では、無線受信機5bが無線発信機6を検出するため、無線受信機5aおよび5bが影1503を退出する方向に移動するほど、位置偏差|Xt-Xd|および|Yt-Yd|は減少し、X位置偏差|Xt-Xd|が所定の閾値1以下かつY位置偏差|Yt-Yd|が所定の閾値2以下となるタイミングで、誤差状態ERRSTSは0となり、無線位置推定により自車両100の自車位置を演算する。
以上の構成により、第一の自車位置と第二の自車位置の自車位置偏差の時間変化に基づいて、無線受信機5の遮蔽物による影響を診断することで無線受信機5の誤差を検出し、車両100外部の任意の位置に設置された無線発信機6からの電波を受信する無線受信機5の検出誤差による影響を抑制することが可能となる。
<実施形態1の作用効果>
以上説明したように、本実施形態1による車両制御装置としての車両制御ECU9は、車両外部の任意の位置に設置された無線発信機6からの電波を受信して前記車両と前記無線発信機6の相対位置を算出する無線位置推定部301と、前記車両に搭載されたセンサで取得する情報に基づいて前記車両の位置を算出する自車位置推定部302と、前記無線位置推定部301で取得された第一の自車位置と前記自車位置推定部302で取得された第二の自車位置との比較に基づいて、受信電波が遮蔽物による影響を受けていることを判断する車両センサ誤差判定部303と、を有する。
以上説明したように、本実施形態1による車両制御装置としての車両制御ECU9は、車両外部の任意の位置に設置された無線発信機6からの電波を受信して前記車両と前記無線発信機6の相対位置を算出する無線位置推定部301と、前記車両に搭載されたセンサで取得する情報に基づいて前記車両の位置を算出する自車位置推定部302と、前記無線位置推定部301で取得された第一の自車位置と前記自車位置推定部302で取得された第二の自車位置との比較に基づいて、受信電波が遮蔽物による影響を受けていることを判断する車両センサ誤差判定部303と、を有する。
また、前記車両センサ誤差判定部303は、前記第一の自車位置と前記第二の自車位置との偏差の時間変化に基づいて、前記第一の自車位置または前記第二の自車位置に誤差が含まれることを判断する。
また、前記車両センサ誤差判定部303は、前記誤差の判断結果に基づいて前記第一の自車位置と前記第二の自車位置から前記車両の位置を決定する。
また、前記無線位置推定部301は、前記車両に搭載される少なくとも一つの無線受信機5で取得する距離情報または方位情報の少なくとも一つから前記車両と前記無線発信機6の相対位置を算出する。
すなわち、前記車両センサ誤差判定部303は、車両に搭載されたセンサおよび無線発信機6を用いて算出した2種の車両位置を比較し、車両位置偏差の時間変化を検出した場合に無線発信機6が遮蔽物による影響を受けていると判断する。
本実施形態1によれば、車両に搭載されたセンサに対するスリップまたは段差または無線発信機6に対する遮蔽物または電波干渉などの障害が生じた際に、検出誤差が発生していることを判断し、利用するセンサを決定することで、無線発信機6を用いた自車位置推定において障害に対するロバスト性を高めることができる。また、カメラやソナーなどの外界認識センサを構成に組み込むことなく、車両に標準装備されているセンサを用いることで上記効果を得られる。
(実施形態2)
本実施形態2は、実施形態1の図7に示す誤差状態判定S403の処理概要を変形したものである。以下、本発明の実施形態2を図15ならびに図9~図14を用いて詳細に説明する。
本実施形態2は、実施形態1の図7に示す誤差状態判定S403の処理概要を変形したものである。以下、本発明の実施形態2を図15ならびに図9~図14を用いて詳細に説明する。
まず初めに図15を用いて、実施形態1と異なる誤差状態判定S403の詳細を説明する。
S801では、車輪速センサ3または無線受信機5の少なくとも一つに誤差が含まれるかを判定するために、第一の自車位置(Xt,Yt)と第二の自車位置(Xd,Yd)のそれぞれの要素成分の偏差|Xt-Xd|または|Yt-Yd|の少なくとも一つが所定の閾値を超えるかを判定する。ここで、自車位置の偏差が所定の閾値以下であれば、車輪速センサ3および無線受信機5に誤差が含まれないと判断してS804を実行し、自車位置の偏差が所定の閾値を超えるのであれば、車輪速センサ3または無線受信機5の少なくとも一つに誤差が含まれると判断してS802を実行する。さらに、障害により無線発信機6をロストし第一の自車位置が取得できない場合は、無条件でS806を実行する。なお、S801の判定は、誤判定防止のために、所定の判定時間もしくは判定距離の間継続して条件を満たすことで判定してもよい。
S802では、無線受信機5に誤差が含まれるかを判定するために、第一のヨー角Yawtと第二のヨー角Yawdの偏差|Yawt-Yawd|が所定の閾値を超えるかを判定する。ここで、ヨー角偏差|Yawt-Yawd|が所定の閾値以下であれば、無線受信機5に誤差は含まれていない可能性があるとしてS803を実行し、ヨー角偏差|Yawt-Yawd|が所定の閾値を超えるのであれば、無線発信機6から見て無線受信機5が遮蔽物の影に入ったことによる影響であるとしてS806を実行する。なお、S802の判定は、誤判定防止のために、所定の判定時間もしくは判定距離の間、継続して条件を満たすことで判定してもよい。
S803では、さらに無線受信機5に誤差が含まれるかを判定するために、第一の速度(車速)Vtと第二の速度(車速)Vdの偏差|Vt-Vd|が所定の閾値を超えるかを判定する。ここで、車速偏差|Vt-Vd|が所定の閾値以下であれば、無線受信機5に誤差は含まれていない可能性があるとしてS805を実行し、車速偏差|Vt-Vd|が所定の閾値を超えるのであれば、無線発信機6から見て無線受信機5が遮蔽物の影に入ったことによる影響であるとしてS806を実行する。なお、S803の判定は、誤判定防止のために、所定の判定時間もしくは判定距離の間、継続して条件を満たすことで判定してもよい。
S804では、誤差状態ERRSTSは、誤差がないことを示す0とする。
S805では、誤差状態ERRSTSは、車輪速センサ3(言い換えると、第二の自車位置)に誤差があることを示す1とする。
S806では、誤差状態ERRSTSは、無線受信機5(言い換えると、第一の自車位置)に誤差があることを示す2とする。
次に図10を用いて、図9のシーンにおける無線位置推定S401から位置情報選択S404までの処理の一例を説明する。
時刻t1以前は、無線受信機5は遮蔽物の影1103に進入する前であるため、X位置偏差|Xt-Xd|は所定の閾値以下かつY位置偏差|Yt-Yd|は所定の閾値以下であり、誤差状態ERRSTSは0となり、無線位置推定により自車両100の自車位置を演算する。
時刻t1からt2の間では、無線受信機5は遮蔽物の影1103に進入したことにより、影1103の濃い方へ自車両100が移動するほど位置偏差|Xt-Xd|および|Yt-Yd|およびヨー角偏差|Yawt-Yawd|および速度偏差|Vt-Vd|は増加し、位置偏差|Xt-Xd|および/または|Yt-Yd|が所定の閾値を超えるかつヨー角偏差|Yawt-Yawd|および/または速度偏差|Vt-Vd|が所定の閾値を超えたタイミングで、誤差状態ERRSTSは2となり、自車位置推定により自車両100の自車位置を演算する。
時刻t2からt3の間では、無線受信機5が無線発信機6をロストしているため、誤差状態ERRSTSは2となり、自車位置推定により自車両100の自車位置を演算する。
時刻t3以降では、無線受信機5が影1103の薄い方へ移動するほど位置偏差|Xt-Xd|および|Yt-Yd|およびヨー角偏差|Yawt-Yawd|および速度偏差|Vt-Vd|は減少し、位置偏差|Xt-Xd|および|Yt-Yd|がそれぞれ所定の閾値以下となるタイミングで、誤差状態ERRSTSは0となり、無線位置推定により自車両100の自車位置を演算する。
次に図12を用いて、図11のシーンにおける無線位置推定S401から位置情報選択S404までの処理の一例を説明する。
時刻t2以前は、車輪2はぬかるみ1303に乗る前で走行距離に応じた回転をすることで、X位置偏差|Xt-Xd|は所定の閾値以下かつY位置偏差|Yt-Yd|は所定の閾値以下であるため、誤差状態ERRSTSは0となり、無線位置推定により自車両100の自車位置を演算する。
時刻t2からt3の間、右前車輪2FRがぬかるみ1303によりスリップすることで、位置偏差|Xt-Xd|および|Yt-Yd|および速度偏差|Vt-Vd|が一時的に増加し、位置偏差|Xt-Xd|および/または|Yt-Yd|が所定の閾値を超えたタイミングで、ヨー角偏差|Yawt-Yawd|は所定の閾値以下かつ速度偏差|Vt-Vd|は所定の閾値以下であるため、誤差状態ERRSTSは1となり、無線位置推定により自車両100の自車位置を演算する。
時刻t3以降は、誤差状態ERRSTSが1となってから所定時間経過もしくは所定距離走行後に、S601(図6)にて第二の自車位置を第一の自車位置に再設定することで、スリップの影響を抑制する。なお、第二の自車位置の補正時には各要素成分の変化量を制限することで、自車両100が急激な挙動をすることを防止してもよい。
次に図14を用いて、図13のシーンにおける無線位置推定S401から位置情報選択S404までの処理の一例を説明する。
時刻t1以前は、無線受信機5aおよび5bは影1503に進入する前であるため、位置偏差|Xt-Xd|および|Yt-Yd|は所定の閾値以下であり、誤差状態ERRSTSは0となり、無線位置推定により自車両100の自車位置を演算する。
時刻t1からt2の間では、無線受信機5aは影1503に進入したことにより、影1503の濃い方へ自車両100が移動するほど位置偏差|Xt-Xd|および|Yt-Yd|は増加し、位置偏差|Yt-Yd|が所定の閾値2を超えたタイミングで、ヨー角偏差|Yawt-Yawd|は所定の閾値を超える、または速度偏差|Vt-Vd|は所定の閾値を超えるか少なくとも一つを満たし、誤差状態ERRSTSは2となり、自車位置推定により自車両100の自車位置を演算する。
時刻t2からt3の間では、無線受信機5aが無線発信機6をロストしているため、誤差状態ERRSTSは2となり、自車位置推定により自車両100の自車位置を演算する。なお、無線受信機5aが認識不全である間、もう一方の無線受信機5bが取得する無線発信機6の距離情報及び方位情報に基づき自車両100の自車位置を演算してもよい。
時刻t3からt4の間では、無線受信機5aが無線発信機6を検出するため、無線受信機5aおよび5bが影1503を移動するほどX位置偏差|Xt-Xd|は増加し、Y位置偏差|Yt-Yd|は一定の値でとどまり、車速偏差|Vt-Vd|が所定の閾値を超えるため、誤差状態ERRSTSは2となり、自車位置推定により自車両100の自車位置を演算する。
時刻t4からt5の間では、無線受信機5bが無線発信機6をロストしているため、誤差状態ERRSTSは2となり、自車位置推定により自車両100の自車位置を演算する。なお、無線受信機5bが認識不全である間、もう一方の無線受信機5aが取得する無線発信機6の距離情報及び方位情報に基づき自車両100の自車位置を演算してもよい。
時刻t5以降では、無線受信機5bが無線発信機6を検出するため、無線受信機5aおよび5bが影1503を退出する方向に移動するほど、位置偏差|Xt-Xd|および|Yt-Yd|は減少し、X位置偏差|Xt-Xd|が所定の閾値1以下かつY位置偏差|Yt-Yd|が所定の閾値2以下となるタイミングで、誤差状態ERRSTSは0となり、無線位置推定により自車両100の自車位置を演算する。
以上の構成により、無線位置推定による無線発信機6の見かけ位置の挙動変化に基づいて、無線受信機5の遮蔽物による影響を診断することで無線受信機5の誤差を検出し、車両100外部の任意の位置に設置された無線発信機6からの電波を受信する無線受信機5の検出誤差による影響を抑制することが可能となる。
<実施形態2の作用効果>
以上説明したように、本実施形態2による車両制御装置としての車両制御ECU9において、前記車両センサ誤差判定部303は、さらに、受信電波の遮蔽により発生する前記第一の自車位置の挙動の変化を検出した場合に、受信電波が遮蔽物による影響を受けていることを判断する。
以上説明したように、本実施形態2による車両制御装置としての車両制御ECU9において、前記車両センサ誤差判定部303は、さらに、受信電波の遮蔽により発生する前記第一の自車位置の挙動の変化を検出した場合に、受信電波が遮蔽物による影響を受けていることを判断する。
また、前記挙動の変化は、前記第一の自車位置(無線発信機6)をロストする挙動、前記第一の自車位置に基づく前記車両の進行方向(第一のヨー角Yawt)が前記センサで取得する情報に基づく(前記第二の自車位置に基づく)前記車両の進行方向(第二のヨー角Yawd)と比べて所定の閾値よりも異なる挙動、前記第一の自車位置に基づく前記車両の車速(第一の速度Vt)が前記センサで取得する情報に基づく(前記第二の自車位置に基づく)前記車両の車速(第二の速度Vd)と比べて所定の閾値よりも異なる挙動、のうちの少なくとも一つを含む。
すなわち、前記車両センサ誤差判定部303は、車両に搭載されたセンサおよび無線発信機6を用いて算出した2種の車両位置を比較し、無線発信機6に基づく車両位置(第一の自車位置)の挙動変化を検出した場合に無線発信機6が遮蔽物による影響を受けていると判断する。
本実施形態2によれば、車両に搭載されたセンサに対するスリップまたは段差または無線発信機6に対する遮蔽物または電波干渉などの障害が生じた際に、検出誤差が発生していることを判断し、利用するセンサを決定することで、無線発信機6を用いた自車位置推定において障害に対するロバスト性を高めることができる。また、カメラやソナーなどの外界認識センサを構成に組み込むことなく、車両に標準装備されているセンサを用いることで上記効果を得られる。
(実施形態3)
本実施形態3は、実施形態2の図15に示す誤差状態判定S403の処理概要の一部を変形したものである。なお、実施形態1の図7に示す誤差状態判定S403の処理概要の一部を変形するようにしてもよいことは勿論である。以下、本発明の実施形態3を図16、図17を用いて詳細に説明する。本実施形態3において、図16に示されるように、前記車両センサ誤差判定部303には、GPS8から信号が入力される。
本実施形態3は、実施形態2の図15に示す誤差状態判定S403の処理概要の一部を変形したものである。なお、実施形態1の図7に示す誤差状態判定S403の処理概要の一部を変形するようにしてもよいことは勿論である。以下、本発明の実施形態3を図16、図17を用いて詳細に説明する。本実施形態3において、図16に示されるように、前記車両センサ誤差判定部303には、GPS8から信号が入力される。
まず初めに図17を用いて、実施形態2と異なる誤差状態判定S403のS901の処理に関して説明する。
S901では、さらに無線受信機5に誤差が含まれるかを判定するために、第一の自車位置とGPS自車位置(以降、GPS座標とも称する)との偏差が所定の閾値を超えるかを判定する。GPS座標は、人工衛星から取得した車両の絶対座標であり、初期位置を最初に取得した第一の自車位置とし、GPS8から取得する自車両100の自車位置の変化量を基に演算した自車両100の自車位置を差す。ここで、第一の自車位置とGPS座標との偏差が所定の閾値以下であれば、無線受信機5に誤差は含まれていないとしてS805を実行し、第一の自車位置とGPS座標との偏差が所定の閾値を超えるのであれば、無線発信機6から見て無線受信機5が遮蔽物の影に入ったことによる影響であるとしてS806を実行する。なお、S901の判定は、誤判定防止のために、所定の判定時間もしくは判定距離の間、継続して条件を満たすことで判定してもよい。
以上の構成により、GPS8から取得する自車位置(GPS座標)に基づいて、さらに無線受信機5の遮蔽物による影響を診断することで精度よく無線受信機5の誤差を検出し、車両100外部の任意の位置に設置された無線発信機6からの電波を受信する無線受信機5の検出誤差による影響を抑制することが可能となる。
<実施形態3の作用効果>
以上説明したように、本実施形態3による車両制御装置としての車両制御ECU9において、前記車両センサ誤差判定部303は、人工衛星から取得した前記車両の絶対座標(GPS座標)と前記第一の自車位置との偏差が所定の閾値よりも大きい場合、受信電波が遮蔽物による影響を受けていることを判断する。
以上説明したように、本実施形態3による車両制御装置としての車両制御ECU9において、前記車両センサ誤差判定部303は、人工衛星から取得した前記車両の絶対座標(GPS座標)と前記第一の自車位置との偏差が所定の閾値よりも大きい場合、受信電波が遮蔽物による影響を受けていることを判断する。
本実施形態3によれば、上記した実施形態1、2と同様に、車両に搭載されたセンサに対するスリップまたは段差または無線発信機6に対する遮蔽物または電波干渉などの障害が生じた際に、検出誤差が発生していることを判断し、利用するセンサを決定することで、無線発信機6を用いた自車位置推定において障害に対するロバスト性を高めることができる。また、カメラやソナーなどの外界認識センサを構成に組み込むことなく、車両に標準装備されているセンサを用いることで上記効果を得られる。
なお、本発明は上記した実施形態に限定されるものではなく、様々な変形形態が含まれる。例えば、上記した実施形態は本発明を分かりやすく説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。
また、前記の各構成、機能、処理部、処理手段等は、それらの一部又は全部を、例えば集積回路で設計する等により、ハードウェアで実現してもよく、プロセッサがそれぞれの機能を実現するプログラムを解釈し実行することにより、ソフトウェアで実現してもよい。
各機能を実現するプログラム、テーブル、ファイル等の情報は、メモリ、ハードディスク、SSD(Solid State Drive)等の記憶装置、又は、ICカード、SDカード、DVD等の記録媒体に格納することができる。
また、制御線や情報線は説明上必要と考えられるものを示しており、実装上必要な全ての制御線や情報線を示しているとは限らない。実際には、ほとんど全ての構成が相互に接続されていると考えてよい。
100・・・車両制御装置搭載車両
2・・・・・車輪
3・・・・・車輪速センサ
4・・・・・電動パワーステアリング装置
5・・・・・無線受信機
6・・・・・無線発信機
7・・・・・加速度センサ
8・・・・・GPS
9・・・・・車両制御ECU(車両制御装置)
10・・・・アクチュエータECU
9a・・・・I/O LSI
9b・・・・CPU
301・・・無線位置推定部
302・・・自車位置推定部
303・・・車両センサ誤差判定部
304・・・車両制御部
2・・・・・車輪
3・・・・・車輪速センサ
4・・・・・電動パワーステアリング装置
5・・・・・無線受信機
6・・・・・無線発信機
7・・・・・加速度センサ
8・・・・・GPS
9・・・・・車両制御ECU(車両制御装置)
10・・・・アクチュエータECU
9a・・・・I/O LSI
9b・・・・CPU
301・・・無線位置推定部
302・・・自車位置推定部
303・・・車両センサ誤差判定部
304・・・車両制御部
Claims (12)
- 車両外部の任意の位置に設置された無線発信機からの電波を受信して前記車両と前記無線発信機の相対位置を算出する無線位置推定部と、
前記車両に搭載されたセンサで取得する情報に基づいて前記車両の位置を算出する自車位置推定部と、
前記無線位置推定部で取得された第一の自車位置と前記自車位置推定部で取得された第二の自車位置との比較に基づいて、受信電波が遮蔽物による影響を受けていることを判断する車両センサ誤差判定部と、を有することを特徴とする車両制御装置。 - 前記車両センサ誤差判定部は、さらに、受信電波の遮蔽により発生する前記第一の自車位置の挙動の変化を検出した場合に、受信電波が遮蔽物による影響を受けていることを判断することを特徴とする請求項1に記載の車両制御装置。
- 前記挙動の変化は、
前記第一の自車位置をロストする挙動、
前記第一の自車位置に基づく前記車両の進行方向が前記センサで取得する情報に基づく前記車両の進行方向と比べて所定の閾値よりも異なる挙動、
前記第一の自車位置に基づく前記車両の車速が前記センサで取得する情報に基づく前記車両の車速と比べて所定の閾値よりも異なる挙動、
のうちの少なくとも一つを含むことを特徴とする請求項2に記載の車両制御装置。 - 前記車両センサ誤差判定部は、前記第一の自車位置と前記第二の自車位置との偏差の時間変化に基づいて、前記第一の自車位置または前記第二の自車位置に誤差が含まれることを判断することを特徴とする請求項1に記載の車両制御装置。
- 前記車両センサ誤差判定部は、前記偏差の時間変化が所定の閾値以下の場合に、前記第二の自車位置に誤差が含まれることを判断することを特徴とする請求項4に記載の車両制御装置。
- 前記車両センサ誤差判定部は、前記偏差の時間変化が所定の閾値よりも大きい場合に、前記第一の自車位置に誤差が含まれることを判断することを特徴とする請求項4に記載の車両制御装置。
- 前記車両センサ誤差判定部は、前記偏差の時間変化が所定の閾値以下の場合に、前記センサが段差またはスリップの少なくとも一つによる影響を受けていることを判断することを特徴とする請求項4に記載の車両制御装置。
- 前記車両センサ誤差判定部は、前記偏差の時間変化が所定の閾値よりも大きい場合に、受信電波が遮蔽物による影響を受けていることを判断することを特徴とする請求項4に記載の車両制御装置。
- 前記車両センサ誤差判定部は、前記センサが段差またはスリップの少なくとも一つによる影響を受けていることを判断してから所定時間経過もしくは所定距離走行後に、前記第二の自車位置を前記第一の自車位置に再設定することで、前記第二の自車位置の初期位置を更新することを特徴とする請求項7に記載の車両制御装置。
- 前記車両センサ誤差判定部は、人工衛星から取得した前記車両の絶対座標と前記第一の自車位置との偏差が所定の閾値よりも大きい場合、受信電波が遮蔽物による影響を受けていることを判断することを特徴とする請求項1に記載の車両制御装置。
- 前記車両センサ誤差判定部は、前記誤差の判断結果に基づいて前記第一の自車位置と前記第二の自車位置から前記車両の位置を決定することを特徴とする請求項4に記載の車両制御装置。
- 前記無線位置推定部は、前記車両に搭載される少なくとも一つの無線受信機で取得する距離情報または方位情報の少なくとも一つから前記車両と前記無線発信機の相対位置を算出することを特徴とする請求項1に記載の車両制御装置。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021107413A JP2023005475A (ja) | 2021-06-29 | 2021-06-29 | 車両制御装置 |
US18/559,369 US20240241209A1 (en) | 2021-06-29 | 2022-03-08 | Vehicle control device |
PCT/JP2022/009967 WO2023276286A1 (ja) | 2021-06-29 | 2022-03-08 | 車両制御装置 |
DE112022001327.3T DE112022001327T5 (de) | 2021-06-29 | 2022-03-08 | Fahrzeugsteuervorrichtung |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021107413A JP2023005475A (ja) | 2021-06-29 | 2021-06-29 | 車両制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2023005475A true JP2023005475A (ja) | 2023-01-18 |
Family
ID=84692262
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2021107413A Pending JP2023005475A (ja) | 2021-06-29 | 2021-06-29 | 車両制御装置 |
Country Status (4)
Country | Link |
---|---|
US (1) | US20240241209A1 (ja) |
JP (1) | JP2023005475A (ja) |
DE (1) | DE112022001327T5 (ja) |
WO (1) | WO2023276286A1 (ja) |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5326438B2 (ja) * | 2008-09-01 | 2013-10-30 | トヨタ自動車株式会社 | 位置検出装置及びアンテナ装置 |
JP6872959B2 (ja) * | 2017-04-20 | 2021-05-19 | パナソニック インテレクチュアル プロパティ コーポレーション オブ アメリカPanasonic Intellectual Property Corporation of America | 通信システム、車両搭載器及びプログラム |
JP2020169899A (ja) * | 2019-04-03 | 2020-10-15 | 株式会社東海理化電機製作所 | 位置判定システム及び位置判定方法 |
JP7459457B2 (ja) * | 2019-04-11 | 2024-04-02 | 日本電気株式会社 | 位置推定装置、移動体装置、空間データ提示装置、位置推定方法及びプログラム |
-
2021
- 2021-06-29 JP JP2021107413A patent/JP2023005475A/ja active Pending
-
2022
- 2022-03-08 US US18/559,369 patent/US20240241209A1/en active Pending
- 2022-03-08 DE DE112022001327.3T patent/DE112022001327T5/de active Pending
- 2022-03-08 WO PCT/JP2022/009967 patent/WO2023276286A1/ja active Application Filing
Also Published As
Publication number | Publication date |
---|---|
DE112022001327T5 (de) | 2024-01-04 |
US20240241209A1 (en) | 2024-07-18 |
WO2023276286A1 (ja) | 2023-01-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106053879B (zh) | 通过数据融合的失效操作的车辆速度估计 | |
KR101720692B1 (ko) | 차량-기반 포지셔닝 시스템 및 이를 이용한 방법 | |
EP2609396B1 (en) | Machine navigation system having integrity checking | |
JP6846630B2 (ja) | 走行レーン検出装置、走行レーン検出方法、併走車検出装置及び隣接するレーンを走行する併走車の検出方法 | |
EP2637149B1 (en) | Onboard device and control method | |
JP6404679B2 (ja) | 物体検知装置 | |
CN111352413B (zh) | 全向传感器融合***和方法及包括该融合***的车辆 | |
JP6249746B2 (ja) | 障害物検知装置 | |
US8862326B2 (en) | Vehicle travel assisting device | |
JP6167846B2 (ja) | 駐車支援装置 | |
JP2016080646A (ja) | 物体検知装置 | |
JP2016080645A (ja) | 物体検知装置 | |
JP2019096177A (ja) | 車群制御装置 | |
JP2016080643A (ja) | 物体検知装置 | |
US20190295418A1 (en) | Driving support device | |
MX2013000764A (es) | Sistema y metodo para determinar una direccion de orientacion inequivoca de un vehiculo. | |
CN106716176B (zh) | 用于对导航***进行调整的方法和*** | |
US8890747B2 (en) | Longitudinal and lateral velocity estimation using single antenna GPS and magnetic compass | |
WO2023276286A1 (ja) | 車両制御装置 | |
US11340357B2 (en) | Method and apparatus for detecting a position of a vehicle having a high level of automation | |
US20220281476A1 (en) | Aiming device, driving control system, and method for calculating correction amount for sensor data | |
US11142187B2 (en) | Parking assistance device | |
JP7204612B2 (ja) | 位置姿勢推定装置、位置姿勢推定方法及びプログラム | |
WO2024009560A1 (ja) | 車両制御装置 | |
US20200298838A1 (en) | Parking guidance apparatus and parking guidance system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A711 | Notification of change in applicant |
Free format text: JAPANESE INTERMEDIATE CODE: A711 Effective date: 20220606 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20240412 |