JP4896482B2 - 衝突判定装置 - Google Patents
衝突判定装置 Download PDFInfo
- Publication number
- JP4896482B2 JP4896482B2 JP2005293969A JP2005293969A JP4896482B2 JP 4896482 B2 JP4896482 B2 JP 4896482B2 JP 2005293969 A JP2005293969 A JP 2005293969A JP 2005293969 A JP2005293969 A JP 2005293969A JP 4896482 B2 JP4896482 B2 JP 4896482B2
- Authority
- JP
- Japan
- Prior art keywords
- dimensional object
- longitudinal
- seconds
- current
- distribution
- 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
- 238000009826 distribution Methods 0.000 claims description 43
- 238000001514 detection method Methods 0.000 claims description 8
- 239000007787 solid Substances 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 description 52
- 238000000034 method Methods 0.000 description 21
- 230000008569 process Effects 0.000 description 20
- 238000010586 diagram Methods 0.000 description 9
- 230000010354 integration Effects 0.000 description 4
- 230000014509 gene expression Effects 0.000 description 3
- 239000000284 extract Substances 0.000 description 2
- 238000012423 maintenance Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 230000004069 differentiation Effects 0.000 description 1
- 239000006185 dispersion Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000002123 temporal effect Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Images
Landscapes
- Traffic Control Systems (AREA)
- Regulating Braking Force (AREA)
Description
図1乃至図4は本発明の実施の第1形態を示し、図1は車両に搭載した運転支援制御装置の概略構成図、図2は運転支援制御プログラムのフローチャート、図3は現在からΔt秒後に至る判定対象とする立体物の統計的な位置の説明図、図4は接触確率の説明図である。
ax(ax(0)a,σax(0)2)
=(1/((2・π)1/2・σax(0)))
・exp(−(x−ax(0)a)2/(2・σax(0)2)) …(1)
Vx(Vx(0)a,σvx(0)2)
=(1/((2・π)1/2・σvx(0)))
・exp(−(x−Vx(0)a)2/(2・σvx(0)2)) …(2)
x(x(0)a,σx(0)2)
=(1/((2・π)1/2・σx(0)))
・exp(−(x−x(0)a)2/(2・σx(0)2)) …(3)
ax(Δt)=ax(ax(0)a,σax(0)2)
=ax(ax(Δt)a,σax(Δt)2) …(4)
Vx(Δt)=Vx(Vx(0)a,σvx(0)2)
+ax(ax(0)a,σax(0)2)・Δt
=Vx(Vx(0)a+ax(0)a・Δt,
(σvx(0)+σax(0)・Δt)2)
=Vx(Vx(Δt)a,σvx(Δt)2) …(5)
x(Δt)=x(x(0)a,σx(0)2)
+Vx(Vx(0)a,σvx(0)2)・Δt
+(1/2)・ax(ax(0)a,σax(0)2)・Δt2
=x(x(0)a+Vx(0)a・Δt
+(1/2)・ax(0)a・Δt2,
(σx(0)+σvx(0)・Δt
+(1/2)・σax(0)・Δt2)2)
=x(x(Δt)a,σx(Δt)2) …(6)
R(Δt)=∫(x(x(Δt)a,σx(Δt)2))dx …(7)
(但し、積分範囲は、−∞<x<0)
まず、ステップ(以下、「S」と略称)101で、必要情報(画像情報、自車速V0)の読み込みを行い、S102に進み、ステレオ画像認識装置4は、判定対象とする立体物の抽出を行う。尚、本実施の第1形態では、特に自車進行路上にある最も近い立体物が判定対象とする立体物として抽出される。
aix(aix(0)a,σiax(0)2)
=(1/((2・π)1/2・σiax(0)))
・exp(−(x−aix(0)a)2/(2・σiax(0)2)) …(8)
Vix(Vix(0)a,σivx(0)2)
=(1/((2・π)1/2・σivx(0)))
・exp(−(x−Vix(0)a)2/(2・σivx(0)2)) …(9)
xi(xi(0)a,σix(0)2)
=(1/((2・π)1/2・σix(0)))
・exp(−(x−xi(0)a)2/(2・σix(0)2)) …(10)
aiy(aiy(0)a,σiay(0)2)
=(1/((2・π)1/2・σiay(0)))
・exp(−(y−aiy(0)a)2/(2・σiay(0)2)) …(11)
Viy(Viy(0)a,σivy(0)2)
=(1/((2・π)1/2・σivy(0)))
・exp(−(y−Viy(0)a)2/(2・σivy(0)2)) …(12)
yi(yi(0)a,σiy(0)2)
=(1/((2・π)1/2・σiy(0)))
・exp(−(y−yi(0)a)2/(2・σiy(0)2)) …(13)
aix(Δt)=aix(aix(0)a,σiax(0)2)
=aix(aix(Δt)a,σiax(Δt)2) …(14)
Vix(Δt)=Vix(Vix(0)a,σivx(0)2)
+aix(aix(0)a,σiax(0)2)・Δt
=Vix(Vix(0)a+aix(0)a・Δt,
(σivx(0)+σiax(0)・Δt)2)
=Vix(Vix(Δt)a,σivx(Δt)2) …(15)
xi(Δt)=xi(xi(0)a,σix(0)2)
+Vix(Vix(0)a,σivx(0)2)・Δt
+(1/2)・aix(aix(0)a,σiax(0)2)・Δt2
=xi(xi(0)a+Vix(0)a・Δt
+(1/2)・aix(0)a・Δt2,
(σix(0)+σivx(0)・Δt
+(1/2)・σiax(0)・Δt2)2)
=xi(xi(Δt)a,σix(Δt)2) …(16)
aiy(Δt)=aiy(aiy(0)a,σiay(0)2)
=aiy(aiy(Δt)a,σiay(Δt)2) …(17)
Viy(Δt)=Viy(Viy(0)a,σivy(0)2)
+aiy(aiy(0)a,σiay(0)2)・Δt
=Viy(Viy(0)a+aiy(0)a・Δt,
(σivy(0)+σiay(0)・Δt)2)
=Viy(Viy(Δt)a,σivy(Δt)2) …(18)
yi(Δt)=yi(yi(0)a,σiy(0)2)
+Viy(Viy(0)a,σivy(0)2)・Δt
+(1/2)・aiy(aiy(0)a,σiay(0)2)・Δt2
=yi(yi(0)a+Viy(0)a・Δt
+(1/2)・aiy(0)a・Δt2,
(σiy(0)+σivy(0)・Δt
+(1/2)・σiay(0)・Δt2)2)
=yi(yi(Δt)a,σiy(Δt)2) …(19)
ri(x,y,Δt)=xi(xi(Δt)a,σix(Δt)2)
×yi(yi(Δt)a,σiy(Δt)2)…(20)
Ri(Δt)=∫∫(ri(x,y,Δt))dxdy …(21)
(但し、積分範囲は、(Δt秒後における前後方向自車位置)<x<∞,
−∞<y<(Δt秒後における横方向自車位置))
Rt(Δt)=Σi=1 nRi(Δt) …(22)
まず、S201で、必要情報(画像情報、自車速V0)の読み込みを行い、S202に進み、ステレオ画像認識装置4は、判定対象とする立体物の抽出を行う。尚、本実施の第2形態では、ステレオカメラ3からの画像領域の中で、判定を実行する領域を設定し、該設定領域内に存在する全ての立体物を判定対象とする立体物として抽出する。
2 車両用運転支援制御装置(衝突判定装置)
3 ステレオカメラ(立体物情報検出手段、判定対象物選択手段)
4 ステレオ画像認識装置(立体物情報検出手段、判定対象物選択手段)
5 制御ユニット(現在状態処理手段、状態推定手段、接触確率演算手段、制御手段)
6 モニタ
7 スピーカ
8 自動ブレーキ制御装置
9 車速センサ
Claims (5)
- 移動体に搭載され、前方に存在する立体物を検出する立体物検出手段と、
上記立体物の現在の運動と位置状態を自己の前後方向の分布で統計処理にて演算する現在状態処理手段と、
上記統計処理にて演算した現在の運動と位置状態を基に上記立体物の予め設定した時間後の運動と位置状態を上記予め設定した時間後の自己の前後方向の分布で統計処理により推定する状態推定手段と、
上記立体物の位置状態の上記予め設定した時間後の上記前後方向の分布と自己位置とに基づき上記立体物と接触する接触確率を演算する接触確率演算手段と、
を備えたことを特徴とする衝突判定装置。 - 移動体に搭載され、前方の平面上に存在する立体物を検出する立体物検出手段と、
上記立体物の現在の運動と位置状態を自己の前後方向の分布と横方向の分布で統計処理にて演算する現在状態処理手段と、
上記統計処理にて演算した現在の運動と位置状態を基に上記立体物の予め設定した時間後の運動と位置状態を上記予め設定した時間後の自己の前後方向の分布と横方向の分布で統計処理により推定する状態推定手段と、
上記立体物の位置状態の上記予め設定した時間後の上記前後方向の分布と上記横方向の分布と自己位置とに基づき上記立体物と接触する接触確率を演算する接触確率演算手段と、
を備えたことを特徴とする衝突判定装置。 - 上記衝突判定装置は、検出した立体物の中から接触する可能性を判定するための立体物を抽出する判定立体物選択手段を備え、
上記判定立体物選択手段で選択する立体物は、予め複数設定することを特徴とする請求項2記載の衝突判定装置。 - 上記複数の判定立体物毎に演算する接触確率の合計の値を基に減速制御と、警報制御と、注意情報の提供の少なくとも一つを行う制御手段を備えたことを特徴とする請求項3記載の衝突判定装置。
- 上記衝突判定装置は移動体に搭載され、上記接触確率の値を基に減速制御と、警報制御と、注意情報の提供の少なくとも一つを行う制御手段を備えたことを特徴とする請求項1乃至請求項4の何れか一つに記載の衝突判定装置。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005293969A JP4896482B2 (ja) | 2005-10-06 | 2005-10-06 | 衝突判定装置 |
US11/543,070 US7864032B2 (en) | 2005-10-06 | 2006-10-05 | Collision determination device and vehicle behavior control device |
EP06021098A EP1772840A3 (en) | 2005-10-06 | 2006-10-06 | Collision determination and vehicle behavior control device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005293969A JP4896482B2 (ja) | 2005-10-06 | 2005-10-06 | 衝突判定装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2007102639A JP2007102639A (ja) | 2007-04-19 |
JP4896482B2 true JP4896482B2 (ja) | 2012-03-14 |
Family
ID=38029501
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2005293969A Active JP4896482B2 (ja) | 2005-10-06 | 2005-10-06 | 衝突判定装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4896482B2 (ja) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5620147B2 (ja) * | 2010-05-24 | 2014-11-05 | 株式会社豊田中央研究所 | 可動物予測装置及びプログラム |
JP5267517B2 (ja) * | 2010-07-14 | 2013-08-21 | 株式会社デンソー | 車両位置推定装置、および車両位置推定プログラム |
CN103155015B (zh) * | 2010-09-08 | 2014-12-31 | 丰田自动车株式会社 | 移动物预测装置、假想活动物预测装置、程序模块、移动物预测方法以及假想活动物预测方法 |
DE112012006790B4 (de) * | 2012-08-08 | 2022-09-29 | Toyota Jidosha Kabushiki Kaisha | Kollisionsvorhersagevorrichtung |
CN107004361B (zh) * | 2014-12-09 | 2020-03-27 | 三菱电机株式会社 | 碰撞风险计算装置、碰撞风险显示装置以及车体控制装置 |
US20190016339A1 (en) * | 2016-02-16 | 2019-01-17 | Honda Motor Co., Ltd. | Vehicle control device, vehicle control method, and vehicle control program |
JP2018045426A (ja) * | 2016-09-14 | 2018-03-22 | いすゞ自動車株式会社 | 衝突確率推定装置 |
US10160448B2 (en) * | 2016-11-08 | 2018-12-25 | Ford Global Technologies, Llc | Object tracking using sensor fusion within a probabilistic framework |
CN107329116B (zh) * | 2017-05-18 | 2020-04-14 | 陕西长岭电子科技有限责任公司 | 机载雷达三维运动场景显示方法 |
JP7146433B2 (ja) | 2018-04-18 | 2022-10-04 | 日立Astemo株式会社 | 衝突判定装置 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3031098B2 (ja) * | 1993-02-04 | 2000-04-10 | トヨタ自動車株式会社 | 車両衝突防止装置 |
JP2002048860A (ja) * | 2000-07-31 | 2002-02-15 | Mitsubishi Electric Corp | 移動体追尾装置及び方法 |
JP2002260192A (ja) * | 2001-03-05 | 2002-09-13 | Natl Inst For Land & Infrastructure Management Mlit | 歩行者衝突防止支援方法及びその装置 |
JP4153798B2 (ja) * | 2003-01-29 | 2008-09-24 | 株式会社日立製作所 | 安全運転診断方法および安全運転診断装置 |
JP4357266B2 (ja) * | 2003-10-30 | 2009-11-04 | 富士通テン株式会社 | レーダ装置及びレーダ装置の異常判定方法 |
-
2005
- 2005-10-06 JP JP2005293969A patent/JP4896482B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2007102639A (ja) | 2007-04-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4896482B2 (ja) | 衝突判定装置 | |
JP5167051B2 (ja) | 車両の運転支援装置 | |
JP5971341B2 (ja) | 物体検出装置及び運転支援装置 | |
JP4615038B2 (ja) | 画像処理装置 | |
US9595197B2 (en) | Lateral control apparatus of vehicle and control method of the same | |
JP5066478B2 (ja) | 車両の運転支援装置 | |
US9819927B2 (en) | Image processing device, image processing method, and device control system | |
JP4763250B2 (ja) | 物体検出装置 | |
JP4420011B2 (ja) | 物体検知装置 | |
CN108116408B (zh) | 多传感器概率对象和自动制动 | |
JP2007310741A (ja) | 立体物認識装置 | |
JP2002331850A (ja) | 運転行動意図検出装置 | |
US8160300B2 (en) | Pedestrian detecting apparatus | |
KR20060021922A (ko) | 두 개의 카메라를 이용한 장애물 감지 기술 및 장치 | |
JP2014241036A (ja) | 車両運転支援装置 | |
JP4864450B2 (ja) | 車両の運転支援装置 | |
CN112046502A (zh) | 自动驾驶装置和方法 | |
JP4850963B1 (ja) | 車両の運転支援装置 | |
JP5067091B2 (ja) | 衝突判定装置 | |
EP1496486B1 (en) | Vehicle drive assist apparatus | |
JP4807753B2 (ja) | 車両の運転支援装置 | |
JP4768499B2 (ja) | 車載周辺他車検出装置 | |
CN112542060B (zh) | 车用后侧方警报装置 | |
JP2008129871A (ja) | 走行環境推定装置 | |
JP2019172032A (ja) | 自動制動装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20081001 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20101014 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20101019 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20110517 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20110719 |
|
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: 20111206 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20111221 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 4896482 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20150106 Year of fee payment: 3 |
|
S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |