JP2011221667A - 対象物リスク予測装置 - Google Patents
対象物リスク予測装置 Download PDFInfo
- Publication number
- JP2011221667A JP2011221667A JP2010088093A JP2010088093A JP2011221667A JP 2011221667 A JP2011221667 A JP 2011221667A JP 2010088093 A JP2010088093 A JP 2010088093A JP 2010088093 A JP2010088093 A JP 2010088093A JP 2011221667 A JP2011221667 A JP 2011221667A
- Authority
- JP
- Japan
- Prior art keywords
- interference
- future
- prediction
- obstacle
- avoidance
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Regulating Braking Force (AREA)
- Traffic Control Systems (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
【解決手段】本実施形態では、複数の他者(障害物)同士の将来予測位置(第1予測進路)が干渉(接近)する場合(複数の他者同士の将来予測位置が干渉するエリアを検出した場合)には、当該干渉の影響で当該将来予測位置から変更され得る複数の他者のそれぞれの将来予測位置(回避経路、第2予測進路)を算出し、当該将来予測位置に応じたリスク値を設定する。
【選択図】図1
Description
ここでは、本実施形態の概要について図1を参照して説明する。図1は、本実施形態の概要を示す図である。
ここでは、本実施形態の対象物リスク予測装置等を含む車両の構成について図2を参照しながら説明する。図2は、本実施形態の対象物リスク予測装置等を含む車両の構成を示すブロック図である。
ここでは、上述した構成の車両(主にECU)にて行われる各種処理の一例について図3から図13を参照して説明する。
最初に、本実施形態の支援実施処理の一例について図3を参照して説明する。図3は、本実施形態の支援実施処理の一例を示すフローチャートである。
次に、本実施形態の特長である他者対将来位置予測処理の一例について図4から図6を参照して詳細に説明する。図4は、本実施形態の他者対将来位置予測処理の一例を示すフローチャートである。
D12(t)2
={(x1−x2)+t(vx1−vx2)}2+{(y1−y2)+t(vy1−vy2)}2
・・・(1)
D12(t)2
=At2+Bt+C
=A{t+(B/2A)}2+C−(B2/4A) ・・・(2)
B/2A≧0の場合:Dmin=C1/2
B/2A<0の場合:Dmin={C−(B2/4A)}1/2
L1:(x1−x2)y−(y1−y2)x+x1(y1−y2)−y1(x1−x2)=0
・・・(3)
L2:(y1−y2)y+(x1−x2)x−{(x1+x2)/2}(x1−x2)−{(y1+y2)/2}(y1−y2)=0 ・・・(4)
L12/Q2+L22/S2=1 ・・・(5)
Q=D12(0)/2+max(max(W1,L1),max(W2,L2))
・・・(6)
次に、本実施形態の特長である他者間将来位置予測処理の一例について図7から図13を参照して詳細に説明する。図7は、本実施形態の他者間将来位置予測処理の一例を示すフローチャートである。なお、ここでは、他者を障害物として説明する。
2.干渉する2つの障害物の位置、速度および周囲道路との位置関係から回避方向を予測し、当該予測した回避方向を設定する。例えば、障害物の移動可能路(走路)より、干渉発生時における移動可能方向が多い方向(例えば歩道が広い側)を回避方向として設定する。
=xi_0+vi_0×t (0≦t<Tg−Ts)
={xi_0+vi_0×(Tg−Ts)}+(vi_0×cosφi)×{t−(Tg−Ts)}
(Tg−Ts≦t<Tg)
=〔xi_0+vi_0×{Tg−(1−cosφi)Ts}〕+vi_0×(t−Tg)
(Tg≦t)
yi_new_pre(t)
=0 (0≦t<Tg−Ts)
=(vi_0×sinφi)×{t−(Tg−Ts) (Tg−Ts≦t<Tg)
=Ai (Tg≦t)
※φi=sin−1{Ai/vi_0×Ts}
=[cosθi_0 −sinθi_0 xi_0;sinθi_0 cosθi_0 yi_0;0 0 1]×[xi_new_pre(t);yi_new_pre(t);1]
※[]は行列を表す記号である。;は行列の各行を区切る記号である。記号;で区切られた間に記述された文字(数字)または文字列(数字列)は、行列内の1つの行を構成する列要素である。
=[σi_x(t)2 σi_xu(t);σi_ux(t) σi_u(t)2]
Σi_y(t)
=[σi_y(t)2 σi_yv(t);σi_vy(t) σi_v(t)2]
Fi(t)
=[1 Δt 0 0;0 1 0 0;0 0 1 Δt;0 0 0 1]
Σi_x(t+Δt)=Fi(t)×Σi_x(t)×inv(Fi(t))
Σi_y(t+Δt)=Fi(t)×Σi_y(t)×inv(Fi(t))
※分散σi_x(0)2およびσi_u(0)2は、ある一定定数である。共分散σi_xu(0)およびσi_ux(0)は、0である。分散σi_y(0)2およびσi_v(0)2は、ある一定定数である。共分散σi_yv(0)およびσi_vy(0)は、0である。
Fi(t)
=[1 a×Δt 0 0;0 1 0 0;0 0 1 a×Δt;0 0 0 1]
=[cosθi_0 −sinθi_0 xi_0;sinθi_0 cosθi_0 yi_0;0 0 1]×[xi_0+vi_0×t;0;1]
以上説明したように、本実施形態では、複数の他者(障害物)同士の将来予測位置(第1予測進路)が干渉(接近)する場合(複数の他者同士の将来予測位置が干渉するエリアを検出した場合)には、当該干渉の影響で当該将来予測位置から変更され得る複数の他者のそれぞれの将来予測位置(回避経路、第2予測進路)を算出し、当該将来予測位置に応じたリスク値を設定する。これにより、それぞれの他者にインタラクションの影響があると考慮して、正確な移動予測変化に伴うリスク予測を行うことができる。
2b 道路構造検出部
2c 可動物検出部
3 運動量算出手段
3a 他者将来位置予測部
3b リスク値算出部
Claims (2)
- 車両周囲の対象物に関する情報を取得し、取得した情報から対象物の第1将来進路を予測し、予測した第1将来進路に応じたリスクを設定する対象物リスク予測装置において、
予測した複数の対象物の第1将来進路同士が干渉する場合には、当該干渉の影響で当該第1将来進路から変更され得る当該複数の対象物それぞれの第2将来進路を予測し、予測した第2将来進路に応じたリスクを設定すること、
を特徴とする対象物リスク予測装置。 - 複数の対象物の現在位置を結ぶ線分を長軸又は短軸に含み第1将来進路同士が干渉するエリアを含む楕円を作成し、作成した楕円をリスク範囲として設定すること、
を特徴とする請求項1に記載の対象物リスク予測装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010088093A JP5607409B2 (ja) | 2010-04-06 | 2010-04-06 | 対象物リスク予測装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010088093A JP5607409B2 (ja) | 2010-04-06 | 2010-04-06 | 対象物リスク予測装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2011221667A true JP2011221667A (ja) | 2011-11-04 |
JP5607409B2 JP5607409B2 (ja) | 2014-10-15 |
Family
ID=45038606
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2010088093A Active JP5607409B2 (ja) | 2010-04-06 | 2010-04-06 | 対象物リスク予測装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5607409B2 (ja) |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2016092591A1 (ja) * | 2014-12-09 | 2016-06-16 | 三菱電機株式会社 | 衝突リスク算出装置、衝突リスク表示装置、車体制御装置 |
JP2017523938A (ja) * | 2014-08-06 | 2017-08-24 | ルノー エス.ア.エス. | 運転支援システム、および、そのようなシステムにおいて実装される方法 |
CN108846992A (zh) * | 2018-05-22 | 2018-11-20 | 东北大学秦皇岛分校 | 一种能够对听障人士进行安全预警的方法及装置 |
JP2019504373A (ja) * | 2016-12-21 | 2019-02-14 | バイドゥ ユーエスエー エルエルシーBaidu USA LLC | 車両の周囲の状況に基づいて車両の一つ又は複数の軌跡を予測する方法とシステム |
CN109426263A (zh) * | 2017-09-01 | 2019-03-05 | 本田技研工业株式会社 | 车辆控制装置、车辆控制方法及存储介质 |
CN109572694A (zh) * | 2018-11-07 | 2019-04-05 | 同济大学 | 一种考虑不确定性的自动驾驶风险评估方法 |
WO2019098216A1 (ja) * | 2017-11-17 | 2019-05-23 | アイシン・エィ・ダブリュ株式会社 | 車両運転補助システム、車両運転補助方法、及び車両運転補助プログラム |
KR20190073038A (ko) * | 2017-12-18 | 2019-06-26 | 현대자동차주식회사 | 차량의 경로 생성 시스템 및 방법 |
JP2019215783A (ja) * | 2018-06-14 | 2019-12-19 | シャープ株式会社 | 走行装置、走行装置の走行制御方法、走行装置の走行制御プログラムおよび記録媒体 |
JP2019214318A (ja) * | 2018-06-13 | 2019-12-19 | 本田技研工業株式会社 | 車両制御装置、車両制御方法、およびプログラム |
WO2020121612A1 (ja) * | 2018-12-14 | 2020-06-18 | パナソニックIpマネジメント株式会社 | 車両制御装置、車両制御方法、車両制御プログラム、非一時的記録媒体、および車両 |
CN112061119A (zh) * | 2019-05-24 | 2020-12-11 | 奥迪股份公司 | 二次碰撞预防系统、包括其的车辆及相应的方法和介质 |
US11027737B2 (en) | 2015-05-31 | 2021-06-08 | Denso Corporation | Travel control apparatus and travel control method |
WO2021166448A1 (ja) * | 2020-02-17 | 2021-08-26 | 株式会社デンソー | 車両行動生成装置、車両行動生成方法、および車両行動生成プログラム |
CN113895434A (zh) * | 2021-09-29 | 2022-01-07 | 岚图汽车科技有限公司 | 一种基于车对外界信息交互通信技术的路障预测方法 |
US20220234577A1 (en) * | 2021-01-26 | 2022-07-28 | Honda Motor Co., Ltd. | Mobile object control device, mobile object control method,and storage medium |
US11926319B2 (en) | 2018-04-20 | 2024-03-12 | Mitsubishi Electric Corporation | Driving monitoring device and computer readable medium |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2015155833A1 (ja) | 2014-04-08 | 2015-10-15 | 三菱電機株式会社 | 衝突防止装置 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008123217A (ja) * | 2006-11-10 | 2008-05-29 | Toyota Motor Corp | 障害物進路予測方法、装置、およびプログラム |
JP2009064088A (ja) * | 2007-09-04 | 2009-03-26 | Toyota Motor Corp | 移動体進路取得方法、および、移動体進路取得装置 |
-
2010
- 2010-04-06 JP JP2010088093A patent/JP5607409B2/ja active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008123217A (ja) * | 2006-11-10 | 2008-05-29 | Toyota Motor Corp | 障害物進路予測方法、装置、およびプログラム |
JP2009064088A (ja) * | 2007-09-04 | 2009-03-26 | Toyota Motor Corp | 移動体進路取得方法、および、移動体進路取得装置 |
Cited By (31)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2017523938A (ja) * | 2014-08-06 | 2017-08-24 | ルノー エス.ア.エス. | 運転支援システム、および、そのようなシステムにおいて実装される方法 |
WO2016092591A1 (ja) * | 2014-12-09 | 2016-06-16 | 三菱電機株式会社 | 衝突リスク算出装置、衝突リスク表示装置、車体制御装置 |
JPWO2016092591A1 (ja) * | 2014-12-09 | 2017-04-27 | 三菱電機株式会社 | 衝突リスク算出装置、衝突リスク表示装置、車体制御装置 |
US9965956B2 (en) | 2014-12-09 | 2018-05-08 | Mitsubishi Electric Corporation | Collision risk calculation device, collision risk display device, and vehicle body control device |
US11027737B2 (en) | 2015-05-31 | 2021-06-08 | Denso Corporation | Travel control apparatus and travel control method |
US11400959B2 (en) | 2016-12-21 | 2022-08-02 | Baidu Usa Llc | Method and system to predict one or more trajectories of a vehicle based on context surrounding the vehicle |
JP2019504373A (ja) * | 2016-12-21 | 2019-02-14 | バイドゥ ユーエスエー エルエルシーBaidu USA LLC | 車両の周囲の状況に基づいて車両の一つ又は複数の軌跡を予測する方法とシステム |
CN109426263A (zh) * | 2017-09-01 | 2019-03-05 | 本田技研工业株式会社 | 车辆控制装置、车辆控制方法及存储介质 |
US20190072971A1 (en) * | 2017-09-01 | 2019-03-07 | Honda Motor Co., Ltd. | Vehicle control device, vehicle control method, and storage medium |
JP2019046161A (ja) * | 2017-09-01 | 2019-03-22 | 本田技研工業株式会社 | 車両制御装置、車両制御方法、およびプログラム |
CN109426263B (zh) * | 2017-09-01 | 2022-03-18 | 本田技研工业株式会社 | 车辆控制装置、车辆控制方法及存储介质 |
US10795371B2 (en) | 2017-09-01 | 2020-10-06 | Honda Motor Co., Ltd. | Vehicle control device, vehicle control method, and storage medium |
CN111226269A (zh) * | 2017-11-17 | 2020-06-02 | 爱信艾达株式会社 | 车辆驾驶辅助系统、车辆驾驶辅助方法以及车辆驾驶辅助程序 |
WO2019098216A1 (ja) * | 2017-11-17 | 2019-05-23 | アイシン・エィ・ダブリュ株式会社 | 車両運転補助システム、車両運転補助方法、及び車両運転補助プログラム |
JPWO2019098216A1 (ja) * | 2017-11-17 | 2020-08-20 | アイシン・エィ・ダブリュ株式会社 | 車両運転補助システム、車両運転補助方法、及び車両運転補助プログラム |
KR102463720B1 (ko) | 2017-12-18 | 2022-11-07 | 현대자동차주식회사 | 차량의 경로 생성 시스템 및 방법 |
KR20190073038A (ko) * | 2017-12-18 | 2019-06-26 | 현대자동차주식회사 | 차량의 경로 생성 시스템 및 방법 |
US11926319B2 (en) | 2018-04-20 | 2024-03-12 | Mitsubishi Electric Corporation | Driving monitoring device and computer readable medium |
CN108846992A (zh) * | 2018-05-22 | 2018-11-20 | 东北大学秦皇岛分校 | 一种能够对听障人士进行安全预警的方法及装置 |
JP2019214318A (ja) * | 2018-06-13 | 2019-12-19 | 本田技研工業株式会社 | 車両制御装置、車両制御方法、およびプログラム |
JP7120820B2 (ja) | 2018-06-13 | 2022-08-17 | 本田技研工業株式会社 | 車両制御装置、車両制御方法、およびプログラム |
JP7111517B2 (ja) | 2018-06-14 | 2022-08-02 | シャープ株式会社 | 走行装置、走行装置の走行制御方法、走行装置の走行制御プログラムおよび記録媒体 |
JP2019215783A (ja) * | 2018-06-14 | 2019-12-19 | シャープ株式会社 | 走行装置、走行装置の走行制御方法、走行装置の走行制御プログラムおよび記録媒体 |
CN109572694A (zh) * | 2018-11-07 | 2019-04-05 | 同济大学 | 一种考虑不确定性的自动驾驶风险评估方法 |
WO2020121612A1 (ja) * | 2018-12-14 | 2020-06-18 | パナソニックIpマネジメント株式会社 | 車両制御装置、車両制御方法、車両制御プログラム、非一時的記録媒体、および車両 |
CN112061119A (zh) * | 2019-05-24 | 2020-12-11 | 奥迪股份公司 | 二次碰撞预防系统、包括其的车辆及相应的方法和介质 |
WO2021166448A1 (ja) * | 2020-02-17 | 2021-08-26 | 株式会社デンソー | 車両行動生成装置、車両行動生成方法、および車両行動生成プログラム |
JP2021127095A (ja) * | 2020-02-17 | 2021-09-02 | 株式会社デンソー | 車両行動生成装置、車両行動生成方法、および車両行動生成プログラム |
JP7234970B2 (ja) | 2020-02-17 | 2023-03-08 | 株式会社デンソー | 車両行動生成装置、車両行動生成方法、および車両行動生成プログラム |
US20220234577A1 (en) * | 2021-01-26 | 2022-07-28 | Honda Motor Co., Ltd. | Mobile object control device, mobile object control method,and storage medium |
CN113895434A (zh) * | 2021-09-29 | 2022-01-07 | 岚图汽车科技有限公司 | 一种基于车对外界信息交互通信技术的路障预测方法 |
Also Published As
Publication number | Publication date |
---|---|
JP5607409B2 (ja) | 2014-10-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5607409B2 (ja) | 対象物リスク予測装置 | |
CN107792065B (zh) | 道路车辆轨迹规划的方法 | |
JP4699426B2 (ja) | 障害物回避方法と障害物回避移動装置 | |
WO2019124001A1 (ja) | 移動体挙動予測装置および移動体挙動予測方法 | |
JP5098584B2 (ja) | 車両用運転支援装置 | |
JP5112666B2 (ja) | 移動装置 | |
US9116521B2 (en) | Autonomous moving device and control method thereof | |
WO2015156097A1 (ja) | 衝突防止装置 | |
JP2761454B2 (ja) | 自律移動機械の誘導方法 | |
JP6470839B2 (ja) | 走行指令生成装置 | |
JP5402813B2 (ja) | 車両運動制御装置及びプログラム | |
CN107111317B (zh) | 移动体 | |
JPWO2016098238A1 (ja) | 走行制御装置 | |
WO2020121215A1 (en) | Method and system for planning a path for a land vehicle for obstacle avoidance with fast reaction, particularly in an autonomous drive scenario | |
CN107004368A (zh) | 车辆的行驶控制装置、行驶控制方法以及行驶控制程序 | |
Song et al. | Reactive navigation in dynamic environment using a multisensor predictor | |
JP7490193B2 (ja) | ロボット、移動経路生成装置及びそのプログラム、並びに、移動予測装置 | |
JP2008003880A (ja) | 車両周辺監視システム、車両周辺監視プログラム、車両周辺監視システムの構築方法およびサーバ | |
CN115309163A (zh) | 基于改进方向评价函数dwa算法的局部路径规划方法 | |
WO2020136977A1 (ja) | 経路決定装置、ロボット及び経路決定方法 | |
CN110497906A (zh) | 车辆控制方法、装置、设备和介质 | |
JPH07225612A (ja) | 時間軸を探索空間に取り入れた経路探索方法,及び装置 | |
KR20220107344A (ko) | 장애물에 의한 이동 로봇의 제어 시스템 및 그 제어 방법 | |
CN114003027A (zh) | 移动体控制装置、移动体、移动体控制方法及存储介质 | |
JP2022139058A (ja) | 制御システム、移動体、制御方法、およびプログラム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20130207 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20131224 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20131226 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20140213 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20140415 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20140612 |
|
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: 20140805 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20140828 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 5607409 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |