JP6717115B2 - Position estimation device - Google Patents
Position estimation device Download PDFInfo
- Publication number
- JP6717115B2 JP6717115B2 JP2016163018A JP2016163018A JP6717115B2 JP 6717115 B2 JP6717115 B2 JP 6717115B2 JP 2016163018 A JP2016163018 A JP 2016163018A JP 2016163018 A JP2016163018 A JP 2016163018A JP 6717115 B2 JP6717115 B2 JP 6717115B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- parking
- road
- information
- map
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Landscapes
- Navigation (AREA)
- Traffic Control Systems (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Description
この明細書による開示は、駐車場における車両の駐車位置を推定する位置推定装置に関する。 The disclosure of this specification relates to a position estimation device that estimates a parking position of a vehicle in a parking lot.
例えばユーザは、広い駐車場において、車両を駐車した位置を失念する場合がある。こうしたシーンにてユーザに駐車位置情報を提供するために、車両の駐車位置を特定する技術には、高いニーズがある。しかし、例えば屋内の駐車場等では、GNSS(Global Navigation Satellite System)の測位衛星からの測位信号の受信が困難となるため、駐車位置の測位が困難になり得た。 For example, the user may forget the position where the vehicle is parked in a large parking lot. There is a high need for a technique for identifying the parking position of a vehicle in order to provide the parking position information to the user in such a scene. However, for example, in an indoor parking lot or the like, it is difficult to receive a positioning signal from a positioning satellite of a GNSS (Global Navigation Satellite System), and thus positioning of a parking position may be difficult.
こうした測位信号に依らない位置推定技術の一種として、例えば特許文献1に開示の車両測位システムでは、車両に搭載された車載器が、駐車場に設置された三つの受信局へ向けて周波数の異なる二つの電波を発信する。各受信局では、車載器から送信された電波の周波数スペクトルの差の周波数成分を位相差が測定される。そして、各受信局にて測定された位相差に基づき各受信局から車両までの距離が算出されることで、車両の駐車位置が特定される。
As a type of position estimation technology that does not rely on such positioning signals, for example, in the vehicle positioning system disclosed in
しかし、特許文献1に開示の車両測位システムでは、駐車場に設置された複数の受信局が必須となっている。こうした技術では、屋内においても高精度に車両の位置が測位できる一方で、受信局等のインフラストラクチャ(以下、「インフラ」)を多数整備する必要があった。
However, the vehicle positioning system disclosed in
本開示は、上記問題点に鑑みてなされたものであり、その目的は、測位用の特別なインフラが多数整備されていなくても、車両の駐車位置を把握可能な位置推定装置を提供することにある。 The present disclosure has been made in view of the above problems, and an object thereof is to provide a position estimation device that can grasp a parking position of a vehicle even if a large number of special positioning infrastructures are not provided. It is in.
上記目的を達成するため、開示された第一の態様は、車両(A)に搭載され、駐車場(IDP)における車両の駐車位置を推定する位置推定装置であって、駐車場に設定された複数の車室及び当該車室の周囲の車路の地図情報であって環境中に存在する環境電波の受信強度と車路上の位置とを紐付けた電波マップを含む地図情報と、車両の移動に関連したセンシング情報とを少なくとも取得し、地図情報及びセンシング情報を用いて車両が走行している車路を判定し、判定した車路上における位置を推定する車路上位置推定部(22,34,222,234)と、車路上の走行によって変動する環境電波の受信強度の推移を受信軌跡として生成する受信軌跡生成部(21)と、車両の駐車に関連した車両情報を取得し、取得した車両情報に基づいて車両の駐車動作を検出する駐車動作検出部(23)と、車両の駐車位置(PP)を推定する駐車位置推定部(35)と、を備え、車路上位置推定部は、受信軌跡生成部にて生成された受信軌跡と電波マップとの照合結果を用いて車路の判定と車路上の位置推定とを行い、駐車位置推定部は、照合結果を用いて推定された車路上の位置であり且つ駐車動作が検出されたときの位置と、駐車動作の内容とを用いて、地図情報にある複数の車室の一つを、車両の駐車位置(PP)とする位置推定装置とされる。
また開示された第二の態様は、車両(A)に搭載され、駐車場(IDP)における車両の駐車位置を推定する位置推定装置であって、駐車場に設定された車路の地図情報であって環境中に存在する環境電波の受信強度と車路上の位置とを紐付けた電波マップを含む地図情報と、車両の移動に関連したセンシング情報とを少なくとも取得し、地図情報及びセンシング情報を用いて車両が走行している車路を判定し、判定した車路上における位置を推定する車路上位置推定部(22,34,222,234)と、車路上の走行によって変動する環境電波の受信強度の推移を受信軌跡として生成する受信軌跡生成部(21)と、車両の駐車に関連した車両情報を取得し、取得した車両情報に基づいて車両の駐車動作を検出する駐車動作検出部(23)と、駐車動作検出部にて駐車動作が検出されたときの車路上での位置と、駐車動作の内容とを用いて、車両の駐車位置(PP)を推定する駐車位置推定部(35)と、を備え、車路に存在する分岐位置(BP)を通過する複数方向について、当該分岐位置の位置情報を含む複数方向毎の電波マップが予め生成されており、車路上位置推定部は、複数方向毎の電波マップを取得し、受信軌跡生成部にて生成された受信軌跡と電波マップとの照合結果を、車路の判定と車路上の位置推定とに用いる位置推定装置とされる。
また開示された第三の態様は、車両(A)に搭載され、駐車場(IDP)における車両の駐車位置を推定する位置推定装置であって、駐車場に設定された車路の地図情報であって環境中に存在する環境電波の受信強度と車路上の位置とを紐付けた電波マップを含む地図情報と、車両の移動に関連したセンシング情報とを少なくとも取得し、地図情報及びセンシング情報を用いて車両が走行している車路を判定し、判定した車路上における位置を推定する車路上位置推定部(22,34,222,234)と、車路上の走行によって変動する環境電波の受信強度の推移を受信軌跡として生成する受信軌跡生成部(21)と、車両の駐車に関連した車両情報を取得し、取得した車両情報に基づいて車両の駐車動作を検出する駐車動作検出部(23)と、駐車動作検出部にて駐車動作が検出されたときの車路上での位置と、駐車動作の内容とを用いて、車両の駐車位置(PP)を推定する駐車位置推定部(35)と、を備え、電波マップは、駐車場に設定された停止線(SL)の位置情報を含んでおり、電波マップにおける停止線の位置は、電波マップの生成に際して停止線での車両の一時停止が検出されたときの受信強度と紐付くように補正されており、車路上位置推定部は、受信軌跡生成部にて生成された受信軌跡と電波マップとの照合結果を、車路の判定と車路上の位置推定とに用いる位置推定装置とされる。
また開示された第四の態様は、車両(A)に搭載され、駐車場(IDP)における車両の駐車位置を推定する位置推定装置であって、駐車場に設定された車路の地図情報であって環境中に存在する環境電波の受信強度と車路上の位置とを紐付けた電波マップを含む地図情報と、車両の移動に関連したセンシング情報とを少なくとも取得し、地図情報及びセンシング情報を用いて車両が走行している車路を判定し、判定した車路上における位置を推定する車路上位置推定部(22,34,222,234)と、車路上の走行によって変動する環境電波の受信強度の推移を受信軌跡として生成する受信軌跡生成部(21)と、車両の駐車に関連した車両情報を取得し、取得した車両情報に基づいて車両の駐車動作を検出する駐車動作検出部(23)と、駐車動作検出部にて駐車動作が検出されたときの車路上での位置と、駐車動作の内容とを用いて、車両の駐車位置(PP)を推定する駐車位置推定部(35)と、を備え、電波マップは、駐車場において車両が方向転換を行う転回位置(TP)の位置情報を含んでおり、電波マップにおける転回位置は、電波マップの生成に際して転回位置での方向転換を検出したときの受信強度と紐付くように補正され、車路上位置推定部は、受信軌跡生成部にて生成された受信軌跡と電波マップとの照合結果を、車路の判定と車路上の位置推定とに用いる位置推定装置とされる。
また開示された第五の態様は、車両(A)に搭載され、駐車場(IDP)における車両の駐車位置を推定する位置推定装置であって、駐車場に設定された車路の地図情報であって環境中に存在する環境電波の受信強度と車路上の位置とを紐付けた電波マップを含む地図情報と、車両の移動に関連したセンシング情報とを少なくとも取得し、地図情報及びセンシング情報を用いて車両が走行している車路を判定し、判定した車路上における位置を推定する車路上位置推定部(22,34,222,234)と、車路上の走行によって変動する環境電波の受信強度の推移を受信軌跡として生成する受信軌跡生成部(21)と、車両の駐車に関連した車両情報を取得し、取得した車両情報に基づいて車両の駐車動作を検出する駐車動作検出部(23)と、駐車動作検出部にて駐車動作が検出されたときの車路上での位置と、駐車動作の内容とを用いて、車両の駐車位置(PP)を推定する駐車位置推定部(35)と、を備え、電波マップは、駐車場の出入口(GP)の位置情報を含んでおり、電波マップにおける出入口の位置は、電波マップの生成に際して車両の出入口の通過又は出入口での車両の一時停止を検出したときの受信強度と紐付くように補正されており、車路上位置推定部は、受信軌跡生成部にて生成された受信軌跡と電波マップとの照合結果を、車路の判定と車路上の位置推定とに用いる位置推定装置とされる。
In order to achieve the above object, the disclosed first aspect is a position estimation device which is installed in a vehicle (A) and estimates the parking position of the vehicle in a parking lot (IDP), and is set in the parking lot. Map information of a plurality of passenger compartments and roads around the passenger compartments, including a radio wave map that links the reception intensity of environmental radio waves existing in the environment and the position on the road, and movement of the vehicle at least it obtains the related sensing information to, to determine the vehicle path which the vehicle is traveling using the map information and the sensing information, vehicle road position estimation unit for estimating the position of the determined vehicle road (22, 34, 222, 234), a reception locus generation unit (21) that generates a transition of the reception intensity of environmental radio waves that fluctuates due to traveling on the road as a reception locus, and vehicle information related to parking of the vehicle and acquires the acquired vehicle. parking operation detecting unit for detecting the parking operation of the vehicle based on the information (23), parking position estimation unit that estimates a parking position of the vehicle (PP) and (35), comprising a vehicle road position estimation unit receives The road position is estimated and the position on the road is estimated by using the matching result between the reception trajectory generated by the trajectory generating unit and the radio wave map, and the parking position estimating unit is used on the road estimated by using the matching result. the position at which the position in it and the parking operation has been detected, by using the contents of the parking operation, one of a plurality of passenger compartment in the map information, the position estimation shall be the parking position of the vehicle (PP) The device.
A second aspect disclosed is a position estimation device which is mounted on a vehicle (A) and estimates a parking position of the vehicle in a parking lot (IDP), and which is map information of a roadway set in the parking lot. Therefore, at least the map information including the radio wave map that links the reception intensity of the environmental radio waves existing in the environment and the position on the road, and the sensing information related to the movement of the vehicle are acquired, and the map information and the sensing information are acquired. A roadside position estimation unit (22, 34, 222, 234) that determines the roadway on which the vehicle is traveling using and estimates the position on the determined roadway, and reception of environmental radio waves that fluctuate due to traveling on the roadway A reception locus generation unit (21) that generates a transition of strength as a reception locus, and a parking motion detection unit (23) that acquires vehicle information related to parking of the vehicle and detects a parking motion of the vehicle based on the acquired vehicle information. ), the position on the road when the parking operation is detected by the parking operation detection unit, and the content of the parking operation, the parking position estimation unit (35) that estimates the parking position (PP) of the vehicle. And a plurality of directions passing through a branch position (BP) existing in the road, a radio wave map for each of the plurality of directions including position information of the branch position is generated in advance, and the road position estimation unit A position estimation device that acquires a radio wave map for each of a plurality of directions and uses the comparison result between the reception locus generated by the reception locus generation unit and the radio wave map for the road determination and the position estimation on the road.
A third aspect disclosed is a position estimation device which is mounted on a vehicle (A) and estimates a parking position of the vehicle in a parking lot (IDP), and which is map information of a roadway set in the parking lot. Therefore, at least the map information including the radio wave map that links the reception intensity of the environmental radio waves existing in the environment and the position on the road, and the sensing information related to the movement of the vehicle are acquired, and the map information and the sensing information are acquired. A roadside position estimation unit (22, 34, 222, 234) that determines the roadway on which the vehicle is traveling using and estimates the position on the determined roadway, and reception of environmental radio waves that fluctuate due to traveling on the roadway A reception locus generation unit (21) that generates a transition of strength as a reception locus, and a parking motion detection unit (23) that acquires vehicle information related to parking of the vehicle and detects a parking motion of the vehicle based on the acquired vehicle information. ), the position on the road when the parking operation is detected by the parking operation detection unit, and the content of the parking operation, the parking position estimation unit (35) that estimates the parking position (PP) of the vehicle. And the radio wave map includes position information of the stop line (SL) set in the parking lot, and the position of the stop line in the radio wave map is a temporary stop of the vehicle at the stop line when the radio wave map is generated. Is corrected so as to be associated with the reception intensity at the time when is detected, and the on-road position estimation unit determines the matching of the reception locus generated by the reception locus generation unit and the radio wave map with the determination of the road. The position estimation device is used for position estimation on the road.
A fourth aspect disclosed is a position estimation device which is mounted on a vehicle (A) and estimates a parking position of the vehicle in a parking lot (IDP), and which is map information of a roadway set in the parking lot. Therefore, at least the map information including the radio wave map that links the reception intensity of the environmental radio waves existing in the environment and the position on the road, and the sensing information related to the movement of the vehicle are acquired, and the map information and the sensing information are acquired. A roadside position estimation unit (22, 34, 222, 234) that determines the roadway on which the vehicle is traveling using and estimates the position on the determined roadway, and reception of environmental radio waves that fluctuate due to traveling on the roadway A reception locus generation unit (21) that generates a transition of strength as a reception locus, and a parking motion detection unit (23) that acquires vehicle information related to parking of the vehicle and detects a parking motion of the vehicle based on the acquired vehicle information. ), the position on the road when the parking operation is detected by the parking operation detection unit, and the content of the parking operation, the parking position estimation unit (35) that estimates the parking position (PP) of the vehicle. The radio wave map includes position information of a turning position (TP) at which a vehicle turns in a parking lot. The turning position in the radio wave map indicates the turning direction at the turning position when the radio wave map is generated. It is corrected so as to be associated with the reception intensity at the time of detection, and the on-road position estimation unit determines the road and the position on the road by comparing the reception locus generated by the reception locus generation unit with the radio wave map. The position estimation device is used for estimation.
A fifth aspect disclosed is a position estimation device which is mounted on a vehicle (A) and estimates a parking position of the vehicle in a parking lot (IDP), and which is map information of a roadway set in the parking lot. Therefore, at least the map information including the radio wave map that links the reception intensity of the environmental radio waves existing in the environment and the position on the road, and the sensing information related to the movement of the vehicle are acquired, and the map information and the sensing information are acquired. A roadside position estimation unit (22, 34, 222, 234) that determines the roadway on which the vehicle is traveling using and estimates the position on the determined roadway, and reception of environmental radio waves that fluctuate due to traveling on the roadway A reception locus generation unit (21) that generates a strength transition as a reception locus, and a parking motion detection unit (23) that acquires vehicle information related to parking of the vehicle and detects a parking motion of the vehicle based on the acquired vehicle information. ), the position on the road when the parking operation is detected by the parking operation detection unit, and the content of the parking operation, the parking position estimation unit (35) that estimates the parking position (PP) of the vehicle. The radio wave map includes position information of the entrance/exit (GP) of the parking lot, and the position of the entrance/exit in the radio wave map is the passage of the entrance/exit of the vehicle or the temporary stop of the vehicle at the entrance/exit when the radio wave map is generated. Is corrected so as to be associated with the reception intensity at the time of detection, and the on-road position estimation unit compares the reception locus generated by the reception locus generation unit with the radio wave map to determine the road and the vehicle. The position estimation device is used for position estimation on the road.
これらの態様のように、駐車場に設定された車路の地図情報と車両の移動に関連したセンシング情報とを組み合わせれば、車路上での車両の位置が推定され得る。加えて、駐車に関連した車両情報に基づく駐車動作を用いることで、駐車に伴う車両の移動方向又は移動距離が推定され得る。その結果、駐車動作が検出されたときの車路上での推定位置に、駐車動作に伴う移動分を組み合わせれば、位置推定装置は、測位用の特別なインフラが多数整備されていなくても、車両の駐車位置を精度良く把握できる。 As in these embodiments, by combining the sensing information related to movement of the map information and the vehicle car path set in the parking lot, the position of the vehicle in the vehicle path can be estimated. In addition, the moving direction or the moving distance of the vehicle associated with parking can be estimated by using the parking operation based on the vehicle information related to parking. As a result, if the estimated position on the road when the parking operation is detected is combined with the amount of movement associated with the parking operation, the position estimation device can operate even if a large number of special positioning infrastructures are not provided. Accurately grasp the parking position of the vehicle.
尚、上記括弧内の参照番号は、後述する実施形態における具体的な構成との対応関係の一例を示すものにすぎず、技術的範囲を何ら制限するものではない。 It should be noted that the reference numerals in the above parentheses only show an example of a correspondence relationship with a specific configuration in the embodiment described later, and do not limit the technical scope at all.
以下、本開示の複数の実施形態を図面に基づいて説明する。尚、各実施形態において対応する構成要素には同一の符号を付すことにより、重複する説明を省略する場合がある。各実施形態において構成の一部分のみを説明している場合、当該構成の他の部分については、先行して説明した他の実施形態の構成を適用することができる。また、各実施形態の説明において明示している構成の組み合わせばかりではなく、特に組み合わせに支障が生じなければ、明示していなくても複数の実施形態の構成同士を部分的に組み合わせることができる。そして、複数の実施形態及び変形例に記述された構成同士の明示されていない組み合わせも、以下の説明によって開示されているものとする。 Hereinafter, a plurality of embodiments of the present disclosure will be described with reference to the drawings. In addition, in each embodiment, the corresponding components may be denoted by the same reference numerals, and duplicate description may be omitted. When only a part of the configuration is described in each embodiment, the configurations of the other embodiments described above can be applied to the other part of the configuration. Further, not only the combination of the configurations explicitly described in the description of each embodiment, but the configuration of a plurality of embodiments can be partially combined even if not explicitly stated, unless there is a problem in the combination. Then, a combination in which the configurations described in the plurality of embodiments and the modifications are not explicitly disclosed is also disclosed by the following description.
(第一実施形態)
図1及び図2に示す本開示の第一実施形態による位置推定装置100は、車両Aに搭載され、車両Aと共に移動可能である。位置推定装置100は、車両Aを駐車した駐車位置PPを、車両Aのユーザに通知する駐車位置リマインダの機能を有する。駐車位置リマインダの利用によれば、ユーザは、大規模な屋内駐車場IDP等で自車両(車両A)の正しい位置情報を得ることができ、自車両の駐車位置PPに迷うことなく戻ることができる。位置推定装置100は、屋内駐車場IDPのように、GNSSの測位信号が届かいない又は届き難い環境においても、車両Aの駐車位置を推定可能な構成とされている。
(First embodiment)
The
車両Aには、衛星信号受信器11、無線測定器12、車載センサ群13、地図データベース14、及び車載通信ネットワーク15等が位置推定装置100と共に搭載されている。これらの構成により、車両Aは、移動端末10として機能する。加えて移動端末10には、例えばブルートゥース(登録商標)等の近距離通信又はLTE等の広域通信の機能を備えた外部通信手段が設けられている。外部通信手段は、位置推定装置100にて推定された駐車位置PPの情報を、ユーザの所持する携帯端末110、例えばスマートフォンやウェアラブル端末等に送信可能である。
The vehicle A is equipped with a
位置推定装置100は、衛星信号受信器11、無線測定器12、車載センサ群13、地図データベース14、及び車載通信ネットワーク15と電気的に接続されており、各構成から情報を取得する。
The
衛星信号受信器11は、GNSS(例えばGPS(Global Positioning System)等)の複数の測位衛星から送信された測位信号を受信する。衛星信号受信器11は、受信した測位信号を衛星測位処理部32へ向けて逐次出力する。
The
無線測定器12は、立体駐車場である屋内駐車場IDPの各フロアの環境中に存在する環境電波の強度を計測する。無線測定器12は、一例として、路側器120から送信される無線電波を、環境電波として受信する。路側器120は、例えば複数のフロアを有する屋内駐車場IDPにおいて、特定のフロア(例えば、二階フロア)に設置され、無線信号を送信する基地局として機能している。無線測定器12は、路側器120から送信される無線電波の受信強度(RSSI:Received Signal Strength Indicator)を継続的に計測する。無線測定器12は、計測した受信強度を、軌跡生成部21へ向けて逐次出力する。
The
尚、屋内駐車場IDPの各フロアの環境中に無線電波を届けることができれば、路側器120は、屋内駐車場IDPの屋上又は各フロア外等に設置されていてもよい。また、路側器120は、一箇所だけでなく、複数の箇所に設置されていてもよく、屋内駐車場IDPの内外又は各フロアに設けられていてもよい。
The
車載センサ群13は、車両Aの移動に関連したセンシング情報及び車両Aの駐車に関連した車両情報を検出する多数のセンサである。車載センサ群13には、一例としてジャイロセンサ13a、車速センサ13b、加速度センサ、及び地磁気センサ等が含まれている。車載センサ群13には、車両Aの周囲を探索するカメラ又はライダ等の光学センサが含まれていてもよい。
The on-
車載センサ群13では、センシング情報の一例として、車両Aの移動距離及び車速、ヨー角の角速度(ヨーレート)、並びにヨー角から算出する操舵角等の情報が検出される。これらのセンシング情報は、軌跡生成部21及び推測航法処理部33へ向けて逐次出力される。加えて車載センサ群13では、駐車に関連した車両情報の一例として、操舵角の変化情報及び車速の変化情報等が取得される。これらの車両情報は、駐車動作検出部23へ向けて逐次出力される。また車載センサ群13は、車両Aの移動距離を示す情報を、駐車動作検出部23へ向けて出力する。
The in-
地図データベース14は、フラッシュメモリ又はハードディスクドライブ等の不揮発性の記憶媒体に構築されている。記憶媒体は、位置推定装置100と一体的に設けられた構成であってもよく、又はメモリカード等の形態で提供され、位置推定装置100に設けられたカードスロットに挿入される構成であってもよい。地図データベース14に格納された情報は、予め記憶媒体に保持された情報であってもよく、又はネットワーク経由で情報配信用のサーバ又は路側器120から取得された情報であってもよい。
The
地図データベース14には、屋内駐車場IDPの外部の地図情報だけでなく、屋内駐車場IDPの内部の地図情報も格納されている。具体的に、地図データベース14には、路面に描かれた駐車枠によって区切られる個々の駐車スペース(以下、「車室」)の位置及び形状情報と、屋内駐車場IDPに設定された車路の地図情報(以下、「車路地図情報」)とが保持されている。車路は、複数の車室の周囲に設定された道路部分である。車路地図情報には、一つ一つの車路が線状に規定された車路リンクPLとして登録されている。各車路リンクPLには、各車路を区別するための固有の番号が設定されている。車路地図情報では、多数の車路リンクPLを互いに結合させる形態により、各駐車場における車路の全体形状が再現されている。
The
加えて車路地図情報には、無線測定器12にて測定される環境電波の受信強度と、車路上の位置とを紐付けた電波マップが含まれている。屋内駐車場IDPに設定された電波マップは、二階のフロアの路側器120から発信された無線電波の受信強度を車路上の位置と紐付けた内容とされている。電波マップには、各車路についての基準軌跡(図3参照)が含まれている。各基準軌跡は、屋内駐車場IDPの全ての車路を巡るように、基準となる基準移動端末を走行させることによって予め生成されている。一つの車路が特定の一方向でなく、複数の方向(例えば往復方向)への車両Aの走行を許容している場合、電波マップの基準軌跡は、車路上を走行する車両Aの走行方向毎に、予め生成されている。
In addition, the road map information includes a radio map that associates the reception intensity of the environmental radio waves measured by the
また屋内駐車場IDPのように複数のフロアが設けられている場合、フロア毎に生成された電波マップが地図データベース14に格納されている。さらに、車路に存在する分岐位置BPの位置情報、駐車場に設定された停止線SLの位置情報、駐車場において車両Aが左右等への方向転換を行う転回位置TPの位置情報、及び駐車場又は各フロアの出入口GPの位置情報等が電波マップには記憶されている。電波マップを含む車路地図情報は、車路判定部22に直接的に提供されると共に、車路判定部22を経由して車路上位置推定部34にも間接的に提供される。
When a plurality of floors are provided as in an indoor parking lot IDP, the
さらに、電波マップにおける車両の相対位置(移動距離)と電波強度との関係は、上述したように、基準移動端末が車路上を一度走行することにより、規定されている。こうした電波マップの生成に際し、移動距離を算出するセンサとして基準移動端末にPOS−LVが非搭載の場合、推測航法の累積誤差に起因し、分岐位置BP、停止線SL、転回位置TP、及び出入口GP等の各位置情報は、正確な絶対位置に対してずれ得る。 Furthermore, the relationship between the relative position (movement distance) of the vehicle in the radio wave map and the radio wave intensity is defined by the reference mobile terminal traveling once on the road as described above. When the POS-LV is not installed in the reference mobile terminal as a sensor for calculating the travel distance when generating such a radio wave map, the branch position BP, the stop line SL, the turning position TP, and the entrance/exit are caused by the accumulated error of dead reckoning. Each position information such as GP may be displaced from an accurate absolute position.
こうしたずれを低減するために、電波マップにおける上記の各位置は、電波マップの生成に際して、基準移動端末の一時停止等、特徴的な挙動が検出されたときの受信強度と紐付くように補正されている。例えば、電波マップにおける停止線SLの位置は、電波マップの生成に際して、基準移動端末の停止線SLでの一時停止を検出したときの受信強度と紐付くように補正されている。同様に、電波マップにおける転回位置TPは、電波マップの生成に際して、基準移動端末の転回位置TPでの方向転換を検出したときの受信強度と紐付くように補正されている。さらに、電波マップにおける駐車場又は各フロアの出入口GPの位置は、電波マップの生成に際して、基準移動端末の出入口GPの通過又は一時停止を検出したときの受信強度と紐付くように補正されている。 In order to reduce such a shift, each of the above positions in the radio map is corrected so as to be associated with the reception intensity when a characteristic behavior such as a temporary stop of the reference mobile terminal is detected when the radio map is generated. ing. For example, the position of the stop line SL in the radio wave map is corrected so as to be associated with the reception intensity when the temporary stop on the stop line SL of the reference mobile terminal is detected in generating the radio wave map. Similarly, the turning position TP in the radio wave map is corrected so as to be associated with the reception intensity when the direction change at the turning position TP of the reference mobile terminal is detected when the radio wave map is generated. Further, the position of the entrance/exit GP of the parking lot or each floor in the radio wave map is corrected so as to be associated with the reception intensity when the passage or suspension of the entrance/exit GP of the reference mobile terminal is detected in generating the radio wave map. ..
車載通信ネットワーク15は、車両Aに搭載された多数の制御装置を、通信バスを介して相互に通信可能に接続した構成である。車載通信ネットワーク15の通信バスには、各制御装置から種々の情報が出力される。車載通信ネットワーク15は、例えば駐車動作検出部23に、センシング情報及び駐車に関連した車両情報等を提供可能である。具体的に、車載通信ネットワーク15から駐車動作検出部23へは、車両Aのシフトポジションの変化情報が車両情報として提供される。加えて車載通信ネットワーク15は、車載センサ群13に替わって又は車載センサ群13と共に、操舵角及び車速の各変化を示す車両情報を駐車動作検出部23へ提供可能である。
The in-
位置推定装置100は、軌跡生成部21、車路判定部22、駐車動作検出部23、及び測位処理回路30等によって構成されている。これらの構成は、例えば個別に設けられた回路部であってもよく、一つ以上のプロセッサに構築される機能ブロックであってもよい。位置推定装置100は、衛星測位機能に加えて、測位信号の受信が不可能な場合に推測航法によって車両Aの位置を推定する測位機能を備えている。こうした推測航法では、誤差が累積して屋内駐車場IDPでの位置推定の精度が悪化し易くなる。そこで位置推定装置100は、測位信号の受信不可時における測位精度の低下を抑えるために、推測航法による測位を補完する機能を備えている。
The
軌跡生成部21は、無線測定器12にて計測された無線電波の受信強度を取得する。車両Aが走行している場合、受信強度は、車路上の走行によって変動する。軌跡生成部21は、車速及び角速度等のセンシング情報を車載センサ群13から取得することで、車路上を移動する車両Aにおいて、位置変化に伴う受信強度の変動の推移を受信軌跡として記録する。軌跡生成部21は、生成した受信軌跡を、車載センサ群13から取得したセンシング情報と共に車路判定部22へ向けて出力する。
The
車路判定部22は、屋内駐車場IDP内等の測位信号が受信困難なシーンにおいて、受信軌跡及びセンシング情報を軌跡生成部21から取得する。加えて車路判定部22は、電波マップを含む車路地図情報を地図データベース14から取得する。電波マップにおける基準軌跡は、上述したように各フロアの車路リンクPL毎に生成されており、且つ、駐車場内において車両Aの挙動に変化が生じるポイントの位置情報と関連付けられている。車路判定部22は、センシング情報、各駐車場に設定された車路地図情報、及び軌跡生成部21にて生成された受信軌跡を用いて、車両Aが走行している車路を判定する。
The
詳記すると、図2及び図3に示すように、軌跡生成部21にて生成の受信軌跡(図3 g(s)参照)と、電波マップに含まれる多数の基準軌跡(図3 f1(s)及びf2(s)参照)との照合結果が、走行中の車路の判定と車路上の位置の推定に用いられる。受信軌跡と各基準軌跡との照合には、例えば下記の数式1によって算出される一致度Rfg(τ)が用いられる。
車路判定部22は、電波マップにある多数の基準軌跡の中から、上記の数式1によって算出される受信軌跡との一致度Rfg(τ)が最大となる基準軌跡を探索する。一致度の最大値が所定の閾値以上場合、車路判定部22は、車両Aが車路上にいると判定する。加えて車路判定部22は、一致度が最大となった一つの基準軌跡と紐付けされた車路を、車両Aが現在走行している特定の車路であると判定する(図3 f1(s)参照)。車路判定部22は、取得した車路地図情報及び受信軌跡を、車路上位置推定部34へ提供する。
The
一方で、一致度の最大値が所定の閾値未満であった場合、車路判定部22は、車両Aが車路上から外れていると判定する。また、車路判定部22は、一致度の絶対値と所定の閾値を比較することで特定の車路上か否かを判定しているが、例えば分岐位置BP等で複数の車路に分岐した場合、複数の車路における一致度の相対値により、車路上か否かを判定してもよい。
On the other hand, when the maximum value of the degree of coincidence is less than the predetermined threshold value, the
詳記すると、図4に示すように、車路に存在する分岐位置BPを通過する複数方向についての各電波マップは、それぞれ分岐位置BPを跨いだ前後を含むように受信強度の推移を規定されている。こうした分岐位置BPを車両Aが通過した場合、車路判定部22は、複数方向毎の電波マップを取得する。そして、車路判定部22は、分岐位置BPを通過した後の受信強度の推移が複数の電波マップのうちで最も一致度の高くなる一つの車路に、車両Aが存在していると判定する。
More specifically, as shown in FIG. 4, each radio wave map in a plurality of directions passing through the branch position BP existing on the road is defined as a transition of the reception intensity so as to include the front and back of the branch position BP. ing. When the vehicle A passes through such a branch position BP, the
駐車動作検出部23は、車載センサ群13及び車載通信ネットワーク15から提供される車両情報に基づき、後述する車両Aの駐車ステータスの判定を実施する。具体的に、駐車動作検出部23は、車両Aのシフトポジションの変化情報、操舵角の変化情報、及び車速の変化情報を組み合わせることにより、車両Aの駐車動作の検出と、駐車位置PPが確定したか否かの判定を行う(図7及び図10参照)。
The parking
加えて駐車動作検出部23は、車両Aの駐車動作の検出後に車両Aが移動した移動距離を、車載センサ群13又は車載通信ネットワーク15から取得する。駐車動作検出部23は、車両Aの駐車動作が検出された場合、取得される駐車動作の内容及び駐車動作検出後の移動距離を、駐車位置推定部35へ向けて出力する。
In addition, the parking
測位処理回路30は、複数の測位処理のうちで、現在のシーンに適した測位処理を選択的に実施することにより、車両Aの現在位置を取得する構成である。測位処理回路30は、衛星測位処理部32、推測航法処理部33、車路上位置推定部34、駐車位置推定部35、過去位置記憶部36、及び統合測位処理部31を機能ブロックとして有している。
The
衛星測位処理部32は、位置推定装置100の衛星測位機能を実現する機能ブロックである。衛星測位処理部32は、測位衛星から受信した測位信号を衛星信号受信器11から取得する。衛星測位処理部32は、衛星測位処理の実施により、受信している複数の測位信号から車両Aの現在位置を演算する。衛星測位処理部32は、車両Aの現在位置を示す測位結果と、測位信号の受信状態の良否を示す情報とを、統合測位処理部31へ向けて出力する。
The satellite
推測航法処理部33は、測位信号の受信が不可能な場合に、推測航法による測位機能を実現する機能ブロックである。推測航法処理部33は、車載センサ群13からセンシング情報を取得し、車両Aの移動方向及び移動距離を演算する。推測航法処理部33は、衛星測位処理部32によって測位可能であった最終位置に、センシング情報に基づく移動方向及び移動距離の情報を加えることにより、車両Aの現在位置を推定する。推測航法処理部33は、車両Aの現在位置を示す測位結果を、統合測位処理部31へ向けて出力する。
The dead
車路上位置推定部34は、推測航法処理部33の推測航法による測位機能を補完する機能ブロックである。車路上位置推定部34は、車路判定部22にて車両Aが車路上を走行していると判定された場合に、センシング情報、車路地図情報、及び受信軌跡を車路判定部22から取得する。車路上位置推定部34は、車路上位置推定処理の実施により、取得した各情報に基づき、車路上における車両Aの位置を推定する。
The on-road
具体的に、車路上位置推定部34は、上記の数式1に基づき、一致度が最も高い特定の基準軌跡と受信軌跡とを照合させることで、車路上での車両Aの位置(縦位置τ)を探索する。電波マップによれば、基準軌跡上の特定の位置に対応する受信強度が一意に定まり得る。故に、車路上位置推定部34は、受信軌跡と特定の基準軌跡の照合により、車路上の縦位置τから、精度良く自車位置を推定できる。車路上位置推定部34は、マッチング処理によって得られた現在位置の推定結果を、統合測位処理部31へ向けて出力する。
Specifically, the on-road
駐車位置推定部35は、駐車動作検出部23によって駐車動作が検出された場合に、駐車位置推定処理を行う。駐車位置推定処理では、車路上位置推定部34にて推定された車路上での車両Aの位置(縦位置τ)と、駐車動作の内容とを用いて、車両Aの駐車位置PPが推定される。駐車位置推定部35は、後述するように、駐車動作検出部23にて駐車動作が検出されたときに、左右の操舵方向及び操舵角の大きさ等の駐車動作の内容を用いて、車両Aの駐車が予測される駐車位置PPを推定する。
The parking
加えて駐車位置推定部35は、駐車動作が検出された後に車両Aが移動した移動距離を駐車動作検出部23から取得している。駐車位置推定部35は、駐車動作検出部23によって駐車位置PPの確定判定が実施されると、駐車動作の検出時に推定した駐車位置PPを、取得した移動距離によって補正することができる。
In addition, the parking
過去位置記憶部36は、例えば位置推定装置100が前回作動していたときに衛星測位処理部32によって測位された最後の位置情報を保持している。過去位置記憶部36は、位置推定装置100の起動開始後、測位信号の受信が可能になるまでの間に、前回の最後の位置情報を、過去位置として統合測位処理部31へ向けて出力する。
The past position storage unit 36 holds, for example, the last position information measured by the satellite
統合測位処理部31は、衛星測位処理部32、推測航法処理部33、車路上位置推定部34、及び駐車位置推定部35を統合的に制御することで、車両Aの現在位置を取得する処理部である。統合測位処理部31は、測位信号の受信状態及び車路地図情報の有無等に基づき、各機能ブロック(32〜35)のうちで、現在のシーンにて最も高精度な測位を実施可能なブロックを機能させて、車両Aの現在位置を取得する。統合測位処理部31は、取得した車両Aの現在位置を、外部通信手段を通じて携帯端末110に提供する。
The integrated
以上の測位処理回路30によって実施される測位処理の詳細を、図5に基づき、図1及び図2を参照しつつ説明する。図5に示す測位処理は、位置推定装置100に電力が供給されることによって開始され、電力供給が終了されるまで繰り返し実施される。
The details of the positioning process performed by the
S101では、後述する複数の測位処理のいずれかによって測位された初期位置の有無を判定する。例えば、位置推定装置100の起動直後等、いずれの測位も行っておらず、前回終了時の位置も記憶領域に記憶されていない場合には初期位置がないと判定され、S101からS102に進む。一例として、屋内駐車場IDP内でイグニッションがオン状態とされた場合等では、S102に進む。S102では、測位信号が受信可能な状態か否かを判定する。測位に必要な複数の測位信号の受信が不可能である場合、S102からS103に進む。S103では、過去位置記憶部36に保存されていた過去位置情報を出力し、S101に戻る。
In S101, it is determined whether or not there is an initial position positioned by any of a plurality of positioning processes described later. For example, immediately after the
一方、S102にて、複数の測位信号の受信が可能であると判定した場合、S105に進む。S105では、衛星測位処理を衛星測位処理部32に実施させることで、測位信号に基づく現在位置を取得して、S101に戻る。尚、S105による衛星測位処理が最初に実施されるまで、S103による過去位置情報の出力が継続される。
On the other hand, when it is determined in S102 that a plurality of positioning signals can be received, the process proceeds to S105. In S105, the satellite positioning process is performed by the satellite
S101にて、初期位置があると判定した場合、S104に進む。S104では、測位信号の受信状態に基づき、現在位置を示す解が算出可能な状態か否かを判定する。S104にて、解を定めることができる状態(fix)と判定した場合、S105に進み、衛星測位処理部32に衛星測位処理を実施させる。一方で、S104にて、解が定まらない状態(float)であると判定した場合、S106に進む。
If it is determined in S101 that there is an initial position, the process proceeds to S104. In S104, it is determined whether the solution indicating the current position can be calculated based on the reception state of the positioning signal. When it is determined in S104 that the solution can be determined (fix), the process proceeds to S105, and the satellite
S106では、現在位置の周囲の車路地図情報があるか否か、即ち、予め生成された基準軌跡が地図データベース14に格納されているか否かを判定する。S106にて、車路地図情報が無いと判定した場合、S107に進む。S107では、推測航法処理部33に推定航法処理を実施させることで、センシング情報に基づく現在位置の推定結果を取得し、S101に戻る。
In S106, it is determined whether or not there is road map information around the current position, that is, whether or not the reference trajectory generated in advance is stored in the
一方、S106にて、車路地図情報があると判定した場合、S108に進む。S108では、車両Aが特定の車路上にいるか否かを示す車路判定部22の判定結果を参照する。車路判定部22にて、閾値以上の一致度を示す基準軌跡が探索されず、車両Aが特定の車路上にいないと判定されていた場合、S108からS109に進む。尚、S108にて用いられる閾値は、例えば線状に規定された車路リンクPLを中心に所定の車路幅分だけ確保された範囲から車両Aがはみ出した場合に、一致度が閾値未満となるよう予め設定されている(図6参照)。
On the other hand, if it is determined in S106 that there is road map information, the process proceeds to S108. In S108, the determination result of the
S109では、駐車動作検出部23による駐車動作の検出結果を参照する。駐車動作検出部23にて、駐車動作が検出されていない場合、即ち、駐車動作の検出待ちの状態である場合、S109からS107に進み、推測航法処理部33に推定航法処理を実施させる。一方で、駐車動作検出部23にて駐車動作が検出されたと判定されている場合、S110に進む。S110では、駐車位置推定部35に駐車位置推定処理を実施させることで、駐車位置PPの推定結果又は補正結果を取得し、S101に戻る。
In S109, the detection result of the parking operation by the parking
一方、車路判定部22にて、閾値以上の一致度を示す基準軌跡が探索され、特定の車路上に車両Aがいると判定されていた場合、S108からS111に進む。S111では、車路上位置推定部34に車路上位置推定処理を実施させることで、特定の車路上における車両Aの現在位置(縦位置τ)を推定し、S101に戻る。
On the other hand, when the
ここまで説明した測位処理の各ステップのうちで、S108〜S111が屋内駐車場IDPにて実施される測位処理に相当する。こうした屋内駐車場IDPでの測位処理の繰り返し実施により、駐車動作検出部23にて判定される車両Aの駐車ステータスは、駐車動作の検出待ちの状態から、駐車動作を検出した状態、さらに駐車位置PPを確定した状態へと、順に遷移する。以下、車両Aの駐車に伴う駐車ステータスの遷移の詳細を、図6〜図11に基づいて説明する。
Among the steps of the positioning process described so far, S108 to S111 correspond to the positioning process performed in the indoor parking lot IDP. By repeatedly performing the positioning processing in the indoor parking lot IDP, the parking status of the vehicle A determined by the parking
まず図6〜図8に基づき、図2を参照しつつ、車両Aがバック駐車される際の状態遷移の詳細を説明する。特定の車路上を走行する車両Aは、空いている車室を通り過ぎた地点C(図6参照)にて、駐車のための方向転換を行う。このとき、車両Aは、車路上から僅かに外れた位置に停止すると共に、ステアリングの回転角度(ハンドル角)を概ね最大にした状態で後退方向への移動を開始し、空いている車室に駐車される(図6の太い実線参照)。 First, based on FIGS. 6 to 8, the details of the state transition when the vehicle A is back parked will be described with reference to FIG. 2. A vehicle A traveling on a specific road changes the direction for parking at a point C (see FIG. 6) that has passed through an empty vehicle cabin. At this time, the vehicle A stops at a position slightly deviated from the road, and starts moving in the backward direction with the rotation angle (steering wheel angle) of the steering wheel substantially maximized to move to the vacant cabin. It is parked (see the thick solid line in Fig. 6).
駐車動作検出部23は、上述したように、操舵角、車速、及びシフトポジションの各変化を示す車両情報を、駐車ステータスの判定に用いる。駐車動作検出部23は、これらの車両情報のうちで該当する項目の多数決により、バック駐車時における駐車ステータスを遷移させる。尚、以下の説明における操舵角は、例えば車路リンクPLに対する車両Aの向きθとして算出される。こうした対地の操舵角は、例えば駐車枠に対する方向として算出されてもよい。
As described above, the parking
駐車動作検出部23は、車速が実質的に0となり、且つシフトポジションがリバース(R)に切り替えられたことに基づき、バック駐車の駐車動作の検出を判定する。また駐車動作検出部23は、操舵角が所定の値(例えば±75°)以上とされたこと、車速が実質的に0とされたこと、及びシフトポジションがパーキング(P)又はニュートラル(N)に切り替えられたことに基づき、駐車位置PPの確定判定を行う。
The parking
以上の駐車動作検出部23の判定方法によれば、駐車のために特定の車路上から外れたC地点にて(図6の実線参照)、図8に示す車両Aの駐車ステータスは、初期状態から駐車動作の検出待ちの状態に遷移する(図5 S108「NO」及びS109「NO」)。駐車検出の待ちの状態では、推測航法処理部33による推定航法処理(図5 S107)が繰り返し実施される。
According to the above-described determination method of the parking
車路上から外れた車両Aにて、シフトポジションがリバース(R)に切り替えられると、上記の多数決によって駐車動作が検出されたと判定される(図5 S109「YES」)。その結果、車両Aの駐車ステータスは、駐車検出待ちの状態から、駐車動作を検出した状態へと遷移する。尚、車両が後退前に車路リンクPLに沿った姿勢で停止した場合でも(図6の長い破線参照)、リバース(R)へ切り替えられたタイミングにて、駐車ステータスは、駐車動作を検出した状態へと遷移する。 When the shift position is switched to reverse (R) in the vehicle A that is off the road, it is determined that the parking operation has been detected by the above-mentioned majority decision (S109 “YES” in FIG. 5). As a result, the parking status of the vehicle A transits from the parking detection waiting state to the parking operation detected state. Even when the vehicle is stopped in the posture along the road link PL before moving backward (see the long broken line in FIG. 6), the parking status is detected as the parking operation at the timing when the vehicle is switched to the reverse (R). Transition to the state.
そして、駐車動作を検出した状態に駐車ステータスが遷移したタイミングにて、駐車位置推定部35による駐車位置推定処理(図5 S110)が実施される。このとき駐車位置PPは、車両Aの後退方向の範囲(図6の点線範囲を参照)にあると推定され得る。そのため、駐車位置PPの推定処理の一例では、駐車動作の検出されたC地点から最小回転半径で後退方向に移動した場合の仮想軌跡円が用いられる。駐車位置推定部35は、最小回転半径を示す仮想軌跡円よりも大回りした方向(外周側)に中心がある複数の車室のうちで、仮想軌跡円に最近傍となる駐車枠の車室を、駐車位置PPとする。
Then, at the timing when the parking status transitions to the state in which the parking operation is detected, the parking position estimation processing by the parking position estimation unit 35 (S110 in FIG. 5) is performed. At this time, the parking position PP can be estimated to be in the range in the backward direction of the vehicle A (see the dotted line range in FIG. 6). Therefore, in an example of the estimation process of the parking position PP, a virtual locus circle when moving in the backward direction at the minimum turning radius from the point C where the parking operation is detected is used. The parking
また、シフトポジションをリバース(R)とドライブ(D)との間で複数回切り替えるような切り返しの動作が行われた場合(図6の短い破線参照)、駐車ステータスは、駐車動作の検出待ちの状態に戻る。このような切り返しが実施されると、駐車位置推定部35は、上記の仮想軌跡円の内周側に位置する複数の車室のうちで、仮想軌跡円に最近傍の駐車枠の車室を、駐車位置PPとして推定する。
In addition, when the switching operation is performed such that the shift position is switched between the reverse (R) and the drive (D) multiple times (see the short dashed line in FIG. 6 ), the parking status indicates that the parking operation is waiting for detection. Return to the state. When such turning back is performed, the parking
上記の多数決に基づき駐車位置PPが確定したと判定されると、駐車ステータスは、駐車動作を検出した状態から、駐車位置PPを確定した状態に遷移する。以上の状態遷移に基づき、駐車位置推定部35(図5参照)は、C地点(図6参照)からの移動距離を用いて、駐車動作の検出時に推定した駐車位置PPを補正し、正式な駐車位置PPを確定する処理を行うことができる。尚、駐車位置推定部35は、確定判定に基づく駐車位置PPの補正を省略し、駐車動作の検出時に推定した位置を正式な駐車位置PPとして確定してもよい。さらに、駐車位置PPを確定した状態への状態遷移自体が省略されてもよい。
When it is determined that the parking position PP has been determined based on the majority decision described above, the parking status transitions from the state in which the parking operation has been detected to the state in which the parking position PP has been determined. Based on the above state transition, the parking position estimating unit 35 (see FIG. 5) corrects the parking position PP estimated at the time of detecting the parking operation by using the movement distance from the point C (see FIG. 6), and officially The process of determining the parking position PP can be performed. The parking
次に図9〜図11に基づき、図2を参照しつつ、車両Aが前向き駐車される際の状態遷移の詳細を説明する。特定の車路上を走行する車両Aは、図9に示すように、空いている車室へ向けて進行方向を変更する。このとき、車両Aは、大きな操舵角が与えられることによって車路(車路リンクPL)上から外れつつ、空いた車室に駐車される。 Next, based on FIGS. 9 to 11, the details of the state transition when the vehicle A is parked forward will be described with reference to FIG. 2. As shown in FIG. 9, the vehicle A traveling on a specific road changes its traveling direction toward an empty vehicle interior. At this time, the vehicle A is parked in the vacant vehicle compartment while being disengaged from the road (the road link PL) by being given a large steering angle.
駐車動作検出部23は、前向き駐車の場合でも、操舵角、車速、及びシフトポジションの各変化を示す車両情報を、駐車ステータスの判定に用いる。駐車動作検出部23は、これらの車両情報のうちで該当する項目の多数決により、前向き駐車時における駐車ステータスを遷移させる。
The parking
駐車動作検出部23は、図10の示すように、操舵角が所定の値(例えば±60°)以上となったことに基づき、前向き駐車の駐車動作を検出したと判定する。また駐車動作検出部23は、操舵角が別の所定の値(例えば±75°)以上とされたこと、車速が実質的に0とされたこと、及びシフトポジションがパーキング(P)又はニュートラル(N)に切り替えられたことに基づき、駐車位置PPの確定判定を行う。
As shown in FIG. 10, the parking
以上の駐車動作検出部23の判定方法によれば、操舵操作によって操舵角の絶対値が60°以上とされ、車両Aが車路上から外れたタイミングにて、図11に示す車両Aの駐車ステータスは、初期状態から駐車動作の検出待ちの状態に遷移する。このタイミングにて、駐車位置推定部35による駐車位置推定処理(図5 S110)が実施される。一例として駐車位置推定部35は、駐車動作を検出した地点(例えば図9のC地点)から、駐車動作の検出時の操舵角に対応した仮想軌跡円に最も近い車室を、駐車位置PPとして推定する。
According to the above determination method of the parking
そして、上記の多数決に基づき駐車ステータスが駐車位置PPを確定した状態に遷移すると、駐車位置推定部35は、バック駐車の場合と同様に、駐車動作を検出したC地点からの移動距離を用いて、駐車動作の検出時に推定した駐車位置PPを補正する。例えば、駐車動作の検出されたC地点からの移動距離が大きくなるほど、駐車位置推定部35は、C地点から遠い車室を駐車位置PPとする補正を実施する。
Then, when the parking status transitions to the state in which the parking position PP has been determined based on the majority decision, the parking
ここまで説明したバック駐車及び前向き駐車の各駐車ステータスの遷移は、例えば車両Aが使用される地域に応じて使い分けられてもよい。例えば、日本ではバック駐車が一般的であり、欧米では前向き駐車が一般的である。故に、車両Aが使用される地域をGNSSの受信情報に基づいて推定し、駐車ステータスを切り替える条件(図7及び図10参照)が補正されてもよい。 The transitions of the respective parking statuses of the back parking and the forward parking described so far may be selectively used according to the area in which the vehicle A is used, for example. For example, back parking is common in Japan, and forward parking is common in Europe and the United States. Therefore, the area in which the vehicle A is used may be estimated based on the reception information of the GNSS, and the condition for switching the parking status (see FIGS. 7 and 10) may be corrected.
さらに、図12に示すように、車路上に他の車両A1が存在する場合、車両A(自車両)は、他の車両A1を回避するようにして、特定の車路上から外れる。このような挙動が車両Aに生じた場合でも、図13及び図14に示すように、駐車ステータスは、駐車動作の検出待ちの状態に維持される。 Further, as shown in FIG. 12, when another vehicle A1 exists on the road, the vehicle A (own vehicle) deviates from the specific road so as to avoid the other vehicle A1. Even if such a behavior occurs in the vehicle A, as shown in FIGS. 13 and 14, the parking status is maintained in the waiting state for detecting the parking operation.
また、図15に示すように、車路上の前方に他の車両A1が存在する場合、車両A(自車両)は、車路上にて一時停止する。こうした挙動が車両Aに生じて、仮に駐車ステータスが推定された場合でも、図16及び図17に示すように、駐車ステータスは、駐車動作の検出待ちの状態に維持される。 Further, as shown in FIG. 15, when another vehicle A1 is present in front of the road, the vehicle A (own vehicle) temporarily stops on the road. Even when such a behavior occurs in the vehicle A and the parking status is estimated, the parking status is maintained in the waiting state for the parking operation detection, as shown in FIGS. 16 and 17.
ここまで説明した第一実施形態のように、屋内駐車場IDP等に設定された車路地図情報と、車両Aの移動に関連したセンシング情報とを組み合わせれば、車路上での車両Aの位置が推定され得る。加えて、駐車に関連した車両情報に基づく駐車動作を用いることで、駐車に伴う車両Aの移動方向又は移動量が推定され得る。その結果、駐車動作が検出されたときの車路上での推定位置に、駐車動作に伴う移動分を組み合わせれば、位置推定装置100は、測位用の特別なインフラが多数整備されていなくても、車両Aの駐車位置PPを精度良く把握できる。
If the road map information set in the indoor parking lot IDP or the like and the sensing information related to the movement of the vehicle A are combined as in the first embodiment described so far, the position of the vehicle A on the road. Can be estimated. In addition, the movement direction or the movement amount of the vehicle A associated with parking can be estimated by using the parking operation based on the vehicle information related to parking. As a result, if the estimated position on the road when the parking operation is detected is combined with the movement amount associated with the parking operation, the
加えて第一実施形態のように、駐車の際に変化し易いシフトポジション、操舵角、及び車速の各変化情報が駐車動作の検出に用いられれば、車路上位置推定部34は、駐車動作の開始を誤判定することなく検出可能となる。以上によれば、駐車位置推定部35による駐車位置PPの推定も、精度良く実施され得る。
In addition, as in the first embodiment, if each change information of the shift position, the steering angle, and the vehicle speed that is likely to change during parking is used to detect the parking operation, the on-road
また第一実施形態の駐車位置推定部35は、駐車が検出されたタイミングでの駐車動作の内容に基づいて、駐車位置PPを推定する。例えば、運転者によって切り返しの操作が繰り返されると、主に操舵角に関連した移動方向の推定誤差が増大する。故に、駐車動作の検出時に駐車位置PPを概ね特定する処理の実施によれば、推定誤差の累積に起因して駐車位置PPの推定が大きくずれる事態は、防がれる。
Further, the parking
さらに第一実施形態では、駐車動作を検出した際に推定した駐車位置PPが、駐車動作の検出後の移動距離によって補正される。操舵角と関連する移動方向とは異なり、移動距離には大きな誤差が生じ難い。故に、移動距離を取得して駐車位置PPを補正すれば、駐車位置PPの推定精度が向上し得る。 Further, in the first embodiment, the parking position PP estimated when the parking operation is detected is corrected by the moving distance after the detection of the parking operation. Unlike the moving direction related to the steering angle, a large error is unlikely to occur in the moving distance. Therefore, if the moving distance is acquired and the parking position PP is corrected, the estimation accuracy of the parking position PP can be improved.
加えて第一実施形態では、電波マップの各基準軌跡と受信軌跡との照合結果が、走行中の車路の判定と車路上の位置推定に用いられる。このように、環境中に存在する環境電波の受信状態は、例え屋内であっても、走行によって変化する。故に、車路判定部22及び車路上位置推定部34は、電波マップと受信軌跡との照合結果を用いることで、車路の判定と車路上位置の推定とを共に高精度に実施できる。
In addition, in the first embodiment, the comparison result between each reference trajectory of the radio wave map and the reception trajectory is used for determination of the traveling road and position estimation on the road. In this way, the reception state of the environmental radio waves existing in the environment changes due to traveling even inside the room. Therefore, the vehicle
また第一実施形態では、路側器120から発信された電波の受信強度を車路上の位置と紐付けた内容の電波マップが用いられている。このように、路側器120の電波を用いる前提であれば、多数のインフラの整備は、確実に不要となる。加えて路側器120は、送信する電波のペイロード部分に、駐車場に関連した情報、例えば空いている車室の位置情報及び運転支援情報等を載せて、各車両に配信可能である。以上によれば、路側器120は、駐車位置リマインダの機能以上の付加価値を、屋内駐車場IDPの利用者に提供できる。
Further, in the first embodiment, a radio wave map is used in which the reception intensity of the radio wave transmitted from the
ここで、図18に示す実線は、屋内駐車場IDPの入口から三階まで上り、三階のフロアを1周して、屋内駐車場IDPの出口まで走行した場合の受信軌跡である。一方、図18の破線は、屋内駐車場IDPの入口から四階まで上り、四階のフロアを1周して、屋内駐車場IDPの出口まで走行した場合の受信軌跡である。路側器120が二階に設置されているため、二階から離れた四階を走行した受信軌跡における受信強度の値は、三階を走行した値よりも低くなる。
Here, the solid line shown in FIG. 18 is a reception locus when traveling from the entrance of the indoor parking lot IDP to the third floor, traveling around the floor of the third floor once, and traveling to the exit of the indoor parking lot IDP. On the other hand, the broken line in FIG. 18 is a reception locus when traveling from the entrance of the indoor parking lot IDP to the fourth floor, traveling around the floor of the fourth floor once, and traveling to the exit of the indoor parking lot IDP. Since the
以上のように、路側器120の無線信号の電波強度は、同じ経路を辿っている場合には再現するものの、異なるフロアを走行した場合には、確実に異なった推移を示す。そのため第一実施形態では、複数のフロアを有する屋内駐車場IDPに合わせて、各フロアについての電波マップが予め生成されている。このように、フロア毎の電波マップあれば、車路上位置推定部34は、車両Aがどのフロアの車路を走行しているのかを正確に識別して、現在位置を精度良く推定できる。
As described above, the radio field intensity of the radio signal of the
加えて第一実施形態にて用いられる電波マップは、車路上を走行する車両Aの走行方向毎に予め生成されている。このように、同一の車路を走行していても、進行方向が異なれば、受信強度の推移も異なってくる。故に、走行方向毎に詳細な電波マップが事前に生成されていれば、車路上位置推定部34は、車路上における車両Aの位置をさらに精度良く推定し得る。
In addition, the radio wave map used in the first embodiment is generated in advance for each traveling direction of the vehicle A traveling on the road. As described above, even if the vehicle travels on the same road, if the traveling direction is different, the transition of the reception intensity is also different. Therefore, if a detailed radio wave map is generated in advance for each traveling direction, the on-road
さらに、分岐位置BPを通過する複数方向の各電波マップは、分岐位置BPとその前後を含むように受信強度の推移を保持している。故に、分岐位置BPを通過した直後においても、一定距離以上のマッチング長D(図4参照)を確保することが可能となる。その結果、分岐位置BPを過ぎた直後でも、車路判定部22は、迅速に正しい車路を判定できる。
Further, each radio wave map passing through the branch position BP in a plurality of directions holds the transition of the reception intensity so as to include the branch position BP and its front and rear. Therefore, even after passing through the branch position BP, it is possible to secure the matching length D (see FIG. 4) of a certain distance or more. As a result, even immediately after passing the branch position BP, the
また第一実施形態の電波マップには、停止線SL、転回位置TP、出入口GP等の位置情報が予め記録されている。加えて、電波マップにおけるこれらの位置は、基準移動端末に特徴的な車両挙動が検出されたときの受信強度と紐付くように、予め補正されている。以上による電波マップの精度の向上によれば、車路上位置推定部34は、車路上における車両Aの位置をさらに精度良く推定し得る。
Further, in the radio wave map of the first embodiment, position information such as the stop line SL, the turning position TP, and the entrance/exit GP is recorded in advance. In addition, these positions on the radio wave map are corrected in advance so as to be associated with the reception intensity when the characteristic vehicle behavior of the reference mobile terminal is detected. According to the improvement in the accuracy of the radio wave map as described above, the on-road
また、電波マップの生成時に位置補正が行われれば、例えば複数回の計測によって異なる結果が取得された場合でも、後処理により、正確と推定される位置に停止線SL等の位置を補正することが可能となる。加えて、例えば屋内駐車場IPDの入口と出口とにおいて、測位信号がfixできた場合、屋内駐車場IPDでの移動距離と、地図上における正確な距離との比較により、移動距離の補正値が算出され得る。こうして算出した補正値を用いて移動距離を補正すれば、位置推定の精度は、さらに向上可能となる。 Further, if the position correction is performed when the radio wave map is generated, the position of the stop line SL or the like can be corrected to a position estimated to be accurate by post-processing even if different results are obtained by multiple measurements. Is possible. In addition, for example, when a positioning signal can be fixed at the entrance and the exit of the indoor parking lot IPD, the moving distance correction value is calculated by comparing the moving distance at the indoor parking lot IPD with the accurate distance on the map. Can be calculated. If the moving distance is corrected using the correction value calculated in this way, the accuracy of position estimation can be further improved.
尚、第一実施形態において、軌跡生成部21が「受信軌跡生成部」に相当し、車路判定部22及び車路上位置推定部34が共に「車路上位置推定部」に相当する。
In the first embodiment, the
(第二実施形態)
図19及び図20に示す本発明の第二実施形態は、第一実施形態の変形例である。第二実施形態の地図データベース214に格納された車路地図情報には、電波マップが記憶されていない。加えて、第二実施形態の位置推定装置200からは、第一実施形態の軌跡生成部21(図2)に相当する構成が省略されている。以上の構成により、車路判定部222及び車路上位置推定部234は、受信軌跡と各基準軌跡とのマッチング処理を行うことなく、車両Aが走行している特定の車路を判定すると共に、特定の車路上における車両Aの位置を推定する。
(Second embodiment)
The second embodiment of the present invention shown in FIGS. 19 and 20 is a modification of the first embodiment. A radio wave map is not stored in the road map information stored in the
車路判定部222は、車載センサ群13からセンシング情報を取得すると共に、地図データベース214から車路地図情報を取得する。第二実施形態でも、車両挙動に特徴的な変化が生じる分岐位置BP、停止線SL、転回位置TP、及び出入口GP(図1等参照)の各位置情報が各車路リンクPLに紐付けられている。車路判定部222は、センシング情報にある操舵角及び車速の情報等を用いて、車両Aの移動方向及び移動距離を算出する。車路判定部222は、例えば出入口GP等の特定の位置を起点として、算出した車両Aの移動分を加えて、各車路リンクPLの情報とマッチングさせる処理により、車両Aが車路上にいるか否かの判定と、車両Aが走行している車路の判定とを実施する。
The
車路上位置推定部234は、車路判定部222にて車両Aが車路上を走行していると判定された場合に、センシング情報及び車路地図情報を車路判定部222から取得し、車路上位置推定処理を実施する。車路上位置推定部234は、車路判定部222と同様に、特定の起点位置に、センシング情報に基づく移動分を加えることにより、現在の車両Aの位置を推定する。起点位置は、衛星測位処理によって測位された位置、又は出入口GP及び分岐位置BP等に設定される。
When the vehicle
次に、第二実施形態の測位処理回路230によって実施される測位処理の詳細を、図20に基づき、図19を参照しつつ説明する。尚、第二実施形態の測位処理におけるS201〜S207は、第一実施形態のS101〜S107と実質同一の内容であるため、説明を省略する。
Next, details of the positioning processing performed by the
S208では、車両Aが特定の車路上にいるか否かを示す車路判定部222の判定結果を参照する。車路判定部222にて、センシング情報と車路地図情報との照合の結果、車両Aが特定の車路上にいないと判定されていた場合、S208からS209に進む。S209では、駐車動作検出部23による駐車動作の検出結果を参照し、駐車ステータスに応じて、S207による推定航法処理又はS210による駐車位置推定処理に移行する。
In S208, the determination result of the
一方、車路判定部222にて車両Aが特定の車路上のいると判定されていた場合、S208からS211に進む。S211では、車路上位置推定部234に車路上位置推定処理を実施させることで、特定の車路上における車両Aの現在位置(縦位置τ)を推定し、S201に戻る。
On the other hand, when the vehicle
ここまで説明した第二実施形態でも、第一実施形態と同様に、車路地図情報とセンシング情報とを組み合わせることで、車路上での車両Aの位置が推定される。したがって、位置推定装置200は、測位用の多数のインフラを要することなく、車両Aの駐車位置PP(図1等参照)を精度良く把握できる。加えて第二実施形態では、無線信号の受信軌跡すら用いることなく、車両Aの現在位置が推定可能である。このように、位置推定装置200は、実質的にインフラレスで車両Aの駐車位置PPを特定できる。尚、第二実施形態では、車路判定部222及び車路上位置推定部234が共に「車路上位置推定部」に相当する。
In the second embodiment described so far, as in the first embodiment, the position of the vehicle A on the road is estimated by combining the road map information and the sensing information. Therefore, the
(他の実施形態)
以上、本開示による複数の実施形態について説明したが、本開示は、上記実施形態に限定して解釈されるものではなく、本開示の要旨を逸脱しない範囲内において種々の実施形態及び組み合わせに適用することができる。
(Other embodiments)
Although a plurality of embodiments according to the present disclosure have been described above, the present disclosure should not be construed as being limited to the above embodiments and applied to various embodiments and combinations without departing from the scope of the present disclosure. can do.
上記第一実施形態の変形例1では、電波マップの各基準軌跡は、放送波の受信強度を車路上の位置と紐付けた内容とされている。放送波は、例えばAMラジオ放送、FMラジオ放送、及びテレビ放送等である。軌跡生成部は、車両Aの移動に伴う放送波の受信強度の推移を受信軌跡として記録し、車路判定部に提供する。このように、放送波を利用した電波マップを利用することによれば、路側器の設置、維持、及び管理が全て不要となる。故に、実質的にインフラレスでの車両の駐車位置の特定が可能になる。 In the first modified example of the first embodiment, each reference locus of the radio wave map has a content in which the reception intensity of the broadcast wave is associated with the position on the road. The broadcast wave is, for example, AM radio broadcast, FM radio broadcast, television broadcast, or the like. The trajectory generation unit records the transition of the reception intensity of the broadcast wave accompanying the movement of the vehicle A as a reception trajectory, and provides it to the road determination unit. As described above, by using the radio wave map using the broadcast wave, it is not necessary to install, maintain, and manage the roadside device. Therefore, it becomes possible to specify the parking position of the vehicle substantially without infrastructure.
上記実施形態のセンシング情報を取得する構成及び手法は、適宜変更されてよい。例えば車速は、車速センサから取得したものに限定されず、各車輪のハブ部分に設置された車輪速センサの変化量から算出してもよい。又は、衛星測位に基づく絶対位置の変化量から、車速が算出されてもよい。さらに、自動駐車機能を実現するための周辺監視センサ(例えばカメラ等)により取得される相対位置の変化量から、車速が算出されてもよい。 The configuration and method of acquiring the sensing information in the above embodiment may be changed as appropriate. For example, the vehicle speed is not limited to that acquired from the vehicle speed sensor, and may be calculated from the amount of change of the wheel speed sensor installed in the hub portion of each wheel. Alternatively, the vehicle speed may be calculated from the amount of change in absolute position based on satellite positioning. Further, the vehicle speed may be calculated from the amount of change in the relative position acquired by the surroundings monitoring sensor (for example, a camera) for realizing the automatic parking function.
さらに、操舵角は、ジャイロセンサのヨー角から取得したものに限定されず、ステアリングセンサによって検出されるハンドル角に基づいて取得されてもよい。さらに、図21に示すように、操舵角は、非操舵輪(例えば後輪)の左右の車輪速センサの計測値VOUT,Vinとトレッドの値Tと用いて、下記の数式2によって算出される回転半径rにより、代用されてもよい。上述したように、操舵角よりも移動距離の方が検出精度が良好なため、駐車位置を移動距離のみ用いて補正すれば、高精度な駐車位置の推定が実現される。
上記第一実施形態では、主に運転者が駐車場の場内にて空いている車室を探索して、駐車動作を行う場合が説明されていた。しかし、車両は、自動駐車システムを搭載しており、自動運転システムによって自ら駐車位置PPまで移動してもよい。さらに、バレットパーキング等でユーザ以外が駐車位置PPに車両Aを駐車させてもよい。これらの場合では、駐車位置PPをユーザに通知する駐車位置リマインダの機能は、ユーザにとっていっそう利便性の高い機能となる。 In the above-described first embodiment, a case has been described in which the driver mainly searches for a vacant vehicle compartment in the parking lot and performs the parking operation. However, the vehicle may be equipped with an automatic parking system, and may move itself to the parking position PP by the automatic driving system. Further, a vehicle other than the user may park the vehicle A at the parking position PP by valet parking or the like. In these cases, the function of the parking position reminder for notifying the user of the parking position PP becomes a more convenient function for the user.
さらに、自動駐車システムを搭載した車両であれば、車路上であるか否かの判定や駐車動作の検出に、自動駐車システムの制御情報が用いられてもよい。システムの情報が直接的に提供されれば、例えば駐車ステータスの遷移は、誤りなく判定され得る。 Furthermore, in the case of a vehicle equipped with an automatic parking system, control information of the automatic parking system may be used to determine whether the vehicle is on the road or detect a parking operation. If the system information is provided directly, for example, parking status transitions can be determined without error.
また、位置推定装置によって推定された位置情報は、ユーザだけでなく、駐車場の管理者又は管理サーバに提供されてよい。こうした情報提供によれば、管理側は、各車両の正確な駐車位置情報を把握して、空き情報等を推定できる。さらに、位置推定装置によって推定される位置情報は、自動駐車システムに提供されてよい。こうした情報提供によれば、自動駐車システムは、周辺監視センサに頼ることなく、又は周辺監視センサの検出情報と組み合わせて、例えば駐車枠が描かれていないような駐車スペースにも円滑に車両を駐車させることができる。 Further, the position information estimated by the position estimation device may be provided to not only the user but also the parking lot manager or the management server. According to such information provision, the management side can grasp the accurate parking position information of each vehicle and estimate the vacant information and the like. Further, the position information estimated by the position estimation device may be provided to the automatic parking system. According to such information provision, the automatic parking system smoothly parks the vehicle in the parking space where the parking frame is not drawn, for example, without relying on the peripheral monitoring sensor or in combination with the detection information of the peripheral monitoring sensor. Can be made.
上記実施形態では、シフトポジション、車速、及び操舵角の各車両情報を用いた多数決によって、駐車動作の検出等が判定されていた。しかし、駐車動作の検出等に用いられる車両情報は、適宜変更可能である。また、駐車動作の検出に基づく駐車位置の推定は、実施されなくてもよい。 In the above-described embodiment, the detection of the parking operation or the like is determined by the majority decision using the vehicle information of each of the shift position, the vehicle speed, and the steering angle. However, the vehicle information used for detecting the parking operation or the like can be changed as appropriate. Further, the estimation of the parking position based on the detection of the parking operation may not be performed.
上記実施形態の位置推定装置における軌跡生成部、車路判定部、駐車動作検出部、及び測位処理回路等の構成は、種々のハードウェア及びソフトウェア、或いはこれらの組み合わせによって提供されてよい。また、位置推定装置は、車両に搭載された他の車載装置の一部であってもよい。或いは、複数の車載装置によって位置推定装置の機能が実現されていてもよい。また、位置推定装置を搭載する車両の形態は、一般的な乗用車に限定されず、貨物自動車(トラック)、バス、二輪車等であってもよい。 The configurations of the trajectory generation unit, the roadway determination unit, the parking operation detection unit, the positioning processing circuit, and the like in the position estimation device of the above embodiment may be provided by various hardware and software, or a combination thereof. Further, the position estimation device may be a part of another in-vehicle device mounted on the vehicle. Alternatively, the function of the position estimation device may be realized by a plurality of vehicle-mounted devices. The form of the vehicle equipped with the position estimation device is not limited to a general passenger car, and may be a lorry (truck), a bus, a two-wheeled vehicle, or the like.
A 車両、IDP 屋内駐車場(駐車場)、PP 駐車位置、BP 分岐位置、SL 停止線、TP 転回位置、GP 出入口、21 軌跡生成部(受信軌跡生成部)、22,222 車路判定部(車路上位置推定部)、23 駐車動作検出部、34,234 車路上位置推定部、35 駐車位置推定部、100,200 位置推定装置 A vehicle, IDP indoor parking lot (parking lot), PP parking position, BP branch position, SL stop line, TP turning position, GP entrance/exit, 21 locus generation unit (reception locus generation unit), 22, 222 roadway determination unit ( Road position estimation unit), 23 Parking motion detection unit, 34,234 Road position estimation unit, 35 Parking position estimation unit, 100,200 Position estimation device
Claims (16)
前記駐車場に設定された複数の車室及び当該車室の周囲の車路の地図情報であって環境中に存在する環境電波の受信強度と前記車路上の位置とを紐付けた電波マップを含む地図情報と、前記車両の移動に関連したセンシング情報とを少なくとも取得し、前記地図情報及び前記センシング情報を用いて前記車両が走行している前記車路を判定し、判定した前記車路上における位置を推定する車路上位置推定部(22,34,222,234)と、
前記車路上の走行によって変動する前記環境電波の受信強度の推移を受信軌跡として生成する受信軌跡生成部(21)と、
前記車両の駐車に関連した車両情報を取得し、取得した前記車両情報に基づいて前記車両の駐車動作を検出する駐車動作検出部(23)と、
前記車両の駐車位置(PP)を推定する駐車位置推定部(35)と、を備え、
前記車路上位置推定部は、前記受信軌跡生成部にて生成された前記受信軌跡と前記電波マップとの照合結果を用いて前記車路の判定と前記車路上の位置推定とを行い、
前記駐車位置推定部は、前記照合結果を用いて推定された前記車路上の位置であり且つ前記駐車動作が検出されたときの位置と、前記駐車動作の内容とを用いて、前記地図情報にある複数の前記車室の一つを、前記車両の駐車位置(PP)とする位置推定装置。 A position estimation device which is mounted on a vehicle (A) and estimates a parking position of the vehicle in a parking lot (IDP),
A radio wave map that associates the reception intensity of environmental radio waves existing in the environment and the position on the road, which is map information of a plurality of vehicle interiors set in the parking lot and roads around the interior of the vehicle interior. wherein the map information, and a sensing information related to the movement of the front Symbol vehicle to get at least, before Symbol locations diagram information and using the sensing information to determine the vehicle path in which the vehicle is traveling, it is determined that includes An on-road position estimation unit (22, 34, 222, 234) for estimating a position on the road,
A reception locus generation unit (21) that generates, as a reception locus, a transition of the reception intensity of the environmental radio waves that fluctuates as the road travels;
A parking operation detector (23) that acquires vehicle information related to parking of the vehicle and detects a parking operation of the vehicle based on the acquired vehicle information;
Before SL parking position estimation unit that estimates a parking position of the vehicle (PP) and (35), provided with,
The on-road position estimation unit performs the determination of the road and the position estimation on the road by using the matching result of the reception locus generated by the reception locus generation unit and the radio wave map,
The parking position estimation unit is a position on the road that is estimated using the comparison result, and a position when the parking operation is detected, and the contents of the parking operation, to the map information. one of a plurality of said casing, shall be the parking position of the vehicle (PP) position estimation device.
前記車路上位置推定部は、複数方向毎の前記電波マップを取得する請求項1に記載の位置推定装置。 For a plurality of directions passing through a branch position (BP) existing on a road, the radio wave maps for each of the plurality of directions including position information of the branch position are generated in advance,
The position estimation device according to claim 1 , wherein the on-road position estimation unit acquires the radio wave map for each of a plurality of directions.
前記駐車場に設定された車路の地図情報であって環境中に存在する環境電波の受信強度と前記車路上の位置とを紐付けた電波マップを含む地図情報と、前記車両の移動に関連したセンシング情報とを少なくとも取得し、前記地図情報及び前記センシング情報を用いて前記車両が走行している前記車路を判定し、判定した前記車路上における位置を推定する車路上位置推定部(22,34,222,234)と、
前記車路上の走行によって変動する前記環境電波の受信強度の推移を受信軌跡として生成する受信軌跡生成部(21)と、
前記車両の駐車に関連した車両情報を取得し、取得した前記車両情報に基づいて前記車両の駐車動作を検出する駐車動作検出部(23)と、
前記駐車動作検出部にて前記駐車動作が検出されたときの前記車路上での位置と、前記駐車動作の内容とを用いて、前記車両の駐車位置(PP)を推定する駐車位置推定部(35)と、を備え、
前記車路に存在する分岐位置(BP)を通過する複数方向について、当該分岐位置の位置情報を含む複数方向毎の前記電波マップが予め生成されており、
前記車路上位置推定部は、複数方向毎の前記電波マップを取得し、前記受信軌跡生成部にて生成された前記受信軌跡と前記電波マップとの照合結果を、前記車路の判定と前記車路上の位置推定とに用いる位置推定装置。 A position estimation device which is mounted on a vehicle (A) and estimates a parking position of the vehicle in a parking lot (IDP),
And map information including a radio map said parking a map information of the set vehicle path and environmental radio wave reception intensity present in the environment linked with the position of the vehicle path, the movement of the front Symbol vehicle Related least obtains the sensing information, to determine the pre-Symbol locations diagram information and the vehicle path in which the vehicle by using the sensing information is running, vehicle road position estimation for estimating the position of the vehicle path which is determined Part (22, 34, 222, 234),
A reception locus generation unit (21) that generates, as a reception locus, a transition of the reception intensity of the environmental radio waves that fluctuates due to traveling on the road,
A parking operation detector (23) that acquires vehicle information related to parking of the vehicle and detects a parking operation of the vehicle based on the acquired vehicle information;
Wherein at parking operation detecting unit and the position in the vehicle path when the parking operation is detected, the parking by using the contents of the operation, the parking position estimating unit that estimates a parking position of the vehicle (PP) ( and 35), with a,
With respect to a plurality of directions passing through a branch position (BP) existing on the road, the radio wave map for each of the plurality of directions including position information of the branch position is generated in advance,
The on-road position estimation unit acquires the radio wave maps for each of a plurality of directions, and compares the reception locus generated by the reception locus generation unit with the radio wave map to determine the road and the vehicle. position estimation device Ru used for the position estimation of the road.
前記電波マップにおける前記停止線の位置は、前記電波マップの生成に際して前記停止線での車両の一時停止が検出されたときの受信強度と紐付くように補正されている請求項1〜3のいずれか一項に記載の位置推定装置。 The radio wave map includes position information of a stop line (SL) set in the parking lot,
Position of the stop line in the radio wave map any of claims 1 to 3 which is corrected to stick receive strength and cord when the temporary stop of the vehicle at the stop line in generating the radio map is detected The position estimation device according to claim 1.
前記駐車場に設定された車路の地図情報であって環境中に存在する環境電波の受信強度と前記車路上の位置とを紐付けた電波マップを含む地図情報と、前記車両の移動に関連したセンシング情報とを少なくとも取得し、前記地図情報及び前記センシング情報を用いて前記車両が走行している前記車路を判定し、判定した前記車路上における位置を推定する車路上位置推定部(22,34,222,234)と、
前記車路上の走行によって変動する前記環境電波の受信強度の推移を受信軌跡として生成する受信軌跡生成部(21)と、
前記車両の駐車に関連した車両情報を取得し、取得した前記車両情報に基づいて前記車両の駐車動作を検出する駐車動作検出部(23)と、
前記駐車動作検出部にて前記駐車動作が検出されたときの前記車路上での位置と、前記駐車動作の内容とを用いて、前記車両の駐車位置(PP)を推定する駐車位置推定部(35)と、を備え、
前記電波マップは、前記駐車場に設定された停止線(SL)の位置情報を含んでおり、
前記電波マップにおける前記停止線の位置は、前記電波マップの生成に際して前記停止線での前記車両の一時停止が検出されたときの受信強度と紐付くように補正されており、
前記車路上位置推定部は、前記受信軌跡生成部にて生成された前記受信軌跡と前記電波マップとの照合結果を、前記車路の判定と前記車路上の位置推定とに用いる位置推定装置。 A position estimation device which is mounted on a vehicle (A) and estimates a parking position of the vehicle in a parking lot (IDP),
And map information including a radio map said parking a map information of the set vehicle path and environmental radio wave reception intensity present in the environment linked with the position of the vehicle path, the movement of the front Symbol vehicle Related least obtains the sensing information, to determine the pre-Symbol locations diagram information and the vehicle path in which the vehicle by using the sensing information is running, vehicle road position estimation for estimating the position of the vehicle path which is determined Part (22, 34, 222, 234),
A reception locus generation unit (21) that generates, as a reception locus, a transition of the reception intensity of the environmental radio waves that fluctuates as the road travels;
A parking operation detector (23) that acquires vehicle information related to parking of the vehicle and detects a parking operation of the vehicle based on the acquired vehicle information;
Wherein at parking operation detecting unit and the position in the vehicle path when the parking operation is detected, the parking by using the contents of the operation, the parking position estimating unit that estimates a parking position of the vehicle (PP) ( and 35), with a,
The radio wave map includes position information of a stop line (SL) set in the parking lot,
The position of the stop line in the radio wave map is corrected so as to be associated with the reception intensity when the temporary stop of the vehicle on the stop line is detected in the generation of the radio wave map,
The vehicle road position estimation unit, a comparison result between the received trajectory generated by the receiver trajectory generation section and the radio map, the vehicle path determined position estimation and position estimation device Ru used for the vehicle path ..
前記電波マップにおける前記転回位置は、前記電波マップの生成に際して前記転回位置での前記方向転換を検出したときの受信強度と紐付くように補正されている請求項1〜5のいずれか一項に記載の位置推定装置。 The radio wave map includes position information of a turning position (TP) at which the vehicle turns around in the parking lot,
The turning position in the radio map is in any one of the receiving intensity and claims are cord attached as correct 1-5 when detecting the direction change at the turning position in generating said radio map The position estimation device described.
前記駐車場に設定された車路の地図情報であって環境中に存在する環境電波の受信強度と前記車路上の位置とを紐付けた電波マップを含む地図情報と、前記車両の移動に関連したセンシング情報とを少なくとも取得し、前記地図情報及び前記センシング情報を用いて前記車両が走行している前記車路を判定し、判定した前記車路上における位置を推定する車路上位置推定部(22,34,222,234)と、
前記車路上の走行によって変動する前記環境電波の受信強度の推移を受信軌跡として生成する受信軌跡生成部(21)と、
前記車両の駐車に関連した車両情報を取得し、取得した前記車両情報に基づいて前記車両の駐車動作を検出する駐車動作検出部(23)と、
前記駐車動作検出部にて前記駐車動作が検出されたときの前記車路上での位置と、前記駐車動作の内容とを用いて、前記車両の駐車位置(PP)を推定する駐車位置推定部(35)と、を備え、
前記電波マップは、前記駐車場において前記車両が方向転換を行う転回位置(TP)の位置情報を含んでおり、
前記電波マップにおける前記転回位置は、前記電波マップの生成に際して前記転回位置での前記方向転換を検出したときの受信強度と紐付くように補正され、
前記車路上位置推定部は、前記受信軌跡生成部にて生成された前記受信軌跡と前記電波マップとの照合結果を、前記車路の判定と前記車路上の位置推定とに用いる位置推定装置。 A position estimation device which is installed in a vehicle (A) and estimates a parking position of the vehicle in a parking lot (IDP),
And map information including a radio map said parking a map information of the set vehicle path and environmental radio wave reception intensity present in the environment linked with the position of the vehicle path, the movement of the front Symbol vehicle Related least obtains the sensing information, to determine the pre-Symbol locations diagram information and the vehicle path in which the vehicle by using the sensing information is running, vehicle road position estimation for estimating the position of the vehicle path which is determined Part (22, 34, 222, 234),
A reception locus generation unit (21) that generates, as a reception locus, a transition of the reception intensity of the environmental radio waves that fluctuates due to traveling on the road.
A parking operation detection unit (23) that acquires vehicle information related to parking of the vehicle and detects a parking operation of the vehicle based on the acquired vehicle information;
Wherein at parking operation detecting unit and the position in the vehicle path when the parking operation is detected, the parking by using the contents of the operation, the parking position estimating unit that estimates a parking position of the vehicle (PP) ( and 35), with a,
The radio wave map includes position information of a turning position (TP) at which the vehicle turns around in the parking lot,
The turning position in the radio wave map is corrected so as to be associated with the reception intensity when the direction change at the turning position is detected when the radio wave map is generated,
The vehicle road position estimation unit, a comparison result between the received trajectory generated by the receiver trajectory generation section and the radio map, the vehicle path determined position estimation and position estimation device Ru used for the vehicle path ..
前記電波マップにおける前記出入口の位置は、前記電波マップの生成に際して前記車両の前記出入口の通過又は前記出入口での前記車両の一時停止を検出したときの受信強度と紐付くように補正されている請求項1〜7のいずれか一項に記載の位置推定装置。 The radio wave map includes position information of an entrance (GP) of the parking lot,
The location of the doorway in the radio wave map claims are corrected to stick receive strength and cord upon detection of a pause of the vehicle in the pass or the entrance of the entrance of the vehicle during the generation of the radio map The position estimation device according to any one of items 1 to 7 .
前記駐車場に設定された車路の地図情報であって環境中に存在する環境電波の受信強度と前記車路上の位置とを紐付けた電波マップを含む地図情報と、前記車両の移動に関連したセンシング情報とを少なくとも取得し、前記地図情報及び前記センシング情報を用いて前記車両が走行している前記車路を判定し、判定した前記車路上における位置を推定する車路上位置推定部(22,34,222,234)と、
前記車路上の走行によって変動する前記環境電波の受信強度の推移を受信軌跡として生成する受信軌跡生成部(21)と、
前記車両の駐車に関連した車両情報を取得し、取得した前記車両情報に基づいて前記車両の駐車動作を検出する駐車動作検出部(23)と、
前記駐車動作検出部にて前記駐車動作が検出されたときの車路上での位置と、前記駐車動作の内容とを用いて、前記車両の駐車位置(PP)を推定する駐車位置推定部(35)と、を備え、
前記電波マップは、前記駐車場の出入口(GP)の位置情報を含んでおり、
前記電波マップにおける前記出入口の位置は、前記電波マップの生成に際して前記車両の前記出入口の通過又は前記出入口での前記車両の一時停止を検出したときの受信強度と紐付くように補正されており、
前記車路上位置推定部は、前記受信軌跡生成部にて生成された前記受信軌跡と前記電波マップとの照合結果を、前記車路の判定と前記車路上の位置推定とに用いる位置推定装置。 A position estimation device which is mounted on a vehicle (A) and estimates a parking position of the vehicle in a parking lot (IDP),
And map information including a radio map said parking a map information of the set vehicle path and environmental radio wave reception intensity present in the environment linked with the position of the vehicle path, the movement of the front Symbol vehicle Related least obtains the sensing information, to determine the pre-Symbol locations diagram information and the vehicle path in which the vehicle by using the sensing information is running, vehicle road position estimation for estimating the position of the vehicle path which is determined Part (22, 34, 222, 234),
A reception locus generation unit (21) that generates, as a reception locus, a transition of the reception intensity of the environmental radio waves that fluctuates as the road travels;
A parking operation detector (23) that acquires vehicle information related to parking of the vehicle and detects a parking operation of the vehicle based on the acquired vehicle information;
A parking position estimation unit (35) that estimates the parking position (PP) of the vehicle by using the position on the road when the parking motion detection unit detects the parking motion and the content of the parking motion. ) and, with a,
The radio wave map includes position information of an entrance (GP) of the parking lot,
The position of the entrance and exit in the radio wave map is corrected so as to be associated with the reception intensity when the passage of the entrance or exit of the vehicle or the temporary stop of the vehicle at the entrance and exit is detected in the generation of the radio wave map,
The vehicle road position estimation unit, a comparison result between the received trajectory generated by the receiver trajectory generation section and the radio map, the vehicle path determined position estimation and position estimation device Ru used for the vehicle path ..
前記受信軌跡生成部は、前記路側器の電波の受信強度の推移を前記受信軌跡として記録する請求項1〜11のいずれか一項に記載の位置推定装置。 The radio wave map is a content that associates the reception intensity of radio waves transmitted from one or more roadside devices with the position on the road,
The position estimation device according to any one of claims 1 to 11, wherein the reception trajectory generation unit records the transition of the reception intensity of the radio wave of the roadside device as the reception trajectory.
前記受信軌跡生成部は、前記放送波の受信強度の推移を前記受信軌跡として記録する請求項1〜11のいずれか一項に記載の位置推定装置。 The radio wave map is a content in which the reception intensity of the broadcast wave is associated with the position on the road,
The position estimation device according to any one of claims 1 to 11, wherein the reception trajectory generation unit records the transition of the reception intensity of the broadcast wave as the reception trajectory.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016163018A JP6717115B2 (en) | 2016-08-23 | 2016-08-23 | Position estimation device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016163018A JP6717115B2 (en) | 2016-08-23 | 2016-08-23 | Position estimation device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2018032160A JP2018032160A (en) | 2018-03-01 |
JP6717115B2 true JP6717115B2 (en) | 2020-07-01 |
Family
ID=61303617
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2016163018A Active JP6717115B2 (en) | 2016-08-23 | 2016-08-23 | Position estimation device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6717115B2 (en) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2020004317A (en) * | 2018-07-02 | 2020-01-09 | 本田技研工業株式会社 | Parking system |
JP7446644B2 (en) | 2020-07-28 | 2024-03-11 | マプサス テクノロジー ホールディング リミテッド | Positioning methods, devices, mobile terminals, storage media |
JP2022028553A (en) * | 2020-08-03 | 2022-02-16 | トヨタ自動車株式会社 | Server, program, communication device, and vehicle |
CN114495515B (en) * | 2021-12-23 | 2023-01-17 | 江苏宁沪高速公路股份有限公司无锡管理处 | Road operation vehicle safety monitoring and early warning method and system |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000310541A (en) * | 1999-04-28 | 2000-11-07 | Daihatsu Motor Co Ltd | Navigation system for automobile |
JP5220797B2 (en) * | 2010-04-19 | 2013-06-26 | 富士通テン株式会社 | Vehicle driving support device |
JP2013170458A (en) * | 2012-02-17 | 2013-09-02 | Toyota Motor Corp | Control device of internal combustion engine |
JP6330471B2 (en) * | 2014-05-16 | 2018-05-30 | 株式会社デンソー | Wireless positioning device |
-
2016
- 2016-08-23 JP JP2016163018A patent/JP6717115B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2018032160A (en) | 2018-03-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10847032B2 (en) | Apparatus for informing parking position and method thereof | |
US9903723B2 (en) | System and method for storing and recalling location data | |
JP6717115B2 (en) | Position estimation device | |
CN109715461B (en) | Warehouse-out assisting method and device | |
US10909853B2 (en) | System for identifying driving intention of surrounding vehicle and controlling method thereof | |
CN111344765B (en) | Road map generation system and road map generation method | |
KR101755311B1 (en) | Location awareness apparatus, vehicle having the same and method for controlling the same | |
US11173799B2 (en) | Method for guiding a motor vehicle into a charging position at an inductive charging station, and control device and motor vehicle | |
CN109068281B (en) | Tracking wireless devices using seamless handover between vehicles and mobile devices | |
JP4780155B2 (en) | In-vehicle device | |
US8909388B1 (en) | Driving device and method using imaging device signal and navigation signal | |
US10982962B2 (en) | V2X location accuracy enhancement | |
CA2994391A1 (en) | Travel control method and travel control apparatus | |
US20190227176A1 (en) | Gnss localization using vehicle sensors | |
US20190265042A1 (en) | Navigation system | |
JP2007218848A (en) | Positional information acquisition system for mobile body | |
US11345366B2 (en) | In-vehicle processing device | |
CN112384820B (en) | Method and device for determining the position of a vehicle | |
AU2019210682B2 (en) | Probe information processing apparatus | |
WO2019142820A1 (en) | Information collaboration system | |
US11919527B2 (en) | Autonomous driving system and abnormality determination method | |
JP6173714B2 (en) | In-vehicle device, position correction method thereof, and position correction program | |
JP2006323527A (en) | Traveling support device for vehicles | |
JP5798329B2 (en) | Information processing apparatus for vehicle | |
JP2019184543A (en) | Vehicle position estimation device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20181026 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20191001 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20190927 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20191107 |
|
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: 20200512 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20200525 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 6717115 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |