JP5796947B2 - 自律走行制御装置及びそれを備えた自律走行車両 - Google Patents
自律走行制御装置及びそれを備えた自律走行車両 Download PDFInfo
- Publication number
- JP5796947B2 JP5796947B2 JP2010228505A JP2010228505A JP5796947B2 JP 5796947 B2 JP5796947 B2 JP 5796947B2 JP 2010228505 A JP2010228505 A JP 2010228505A JP 2010228505 A JP2010228505 A JP 2010228505A JP 5796947 B2 JP5796947 B2 JP 5796947B2
- Authority
- JP
- Japan
- Prior art keywords
- score
- travel route
- road
- travel
- curvature
- 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
- 238000000034 method Methods 0.000 claims description 20
- 239000000284 extract Substances 0.000 claims description 6
- 238000002360 preparation method Methods 0.000 claims description 6
- 238000000605 extraction Methods 0.000 description 10
- 238000010586 diagram Methods 0.000 description 5
- 238000005259 measurement Methods 0.000 description 2
- 238000005452 bending Methods 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 238000002347 injection Methods 0.000 description 1
- 239000007924 injection Substances 0.000 description 1
Images
Landscapes
- Traffic Control Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
本発明は、自律走行可能な車両に搭載され、該車両の自律走行を支援する自律走行制御装置であって、高低差が所定値以上である位置を検出し、検出した該位置に基づいて道路の幅を含む道路形状を認識する道路形状認識手段と、前記道路形状認識手段によって認識された道路形状を用いて走行経路を設定する走行経路設定手段とを備え、前記走行経路設定手段は、前記道路形状認識手段によって認識された道路の両端の間に複数の走行経路候補を設定する候補設定手段と、複数の走行経路候補の各々について、路面の凹凸、路面の斜度、経路の曲率、及び経路の曲率変化のうち、少なくともいずれか一つに基づいて走り易さを反映したスコアを作成するスコア作成手段と、前記スコア作成手段によって作成されたスコアに基づいて、複数の走行経路候補の一つを走行経路として決定する経路決定手段とを具備する自律走行制御装置を提供する。
図1は、自律走行車両の概略構成を示したブロック図である。図1に示すように、自律走行車両1は、自律走行制御装置10を備えている。自律走行制御装置10は、自律走行車両1の自律走行を制御する装置であって、車両周辺において高低差が所定値以上の位置を検出し、検出した位置情報を用いて道路形状を認識する道路形状認識部11と、道路形状認識部11によって認識された道路形状を用いて走行経路を設定する走行経路設定部12とを主な構成として備えている。
レーザレーダ21aによって取得された点列(rn,θn)は点列抽出部22に出力され、レーザレーダ21bによって取得された点列は、後述する走行経路設定部12に出力されて、走行経路を決定する際に使用される。
なお、本実施形態では、所定の高さ位置に設置したレーザレーダ21aにより得られる点列に基づいて高低差が所定値以上である位置を簡易的に抽出することとしたが、これに代えて、例えば、レーザレーダから射出されるレーザビームを高さ方向においても走査させることで、車両周辺の状況を立体的に捉え、これらの点列から高低差が所定値以上になる位置を抽出することとしてもよい。このように、車両周辺の状況を3次元的に捉えることで、より詳細に周囲の状況を把握することが可能となる。
このように抽出された点列は、形状特定部23に出力される。
曲線モデルは、直線、円弧、スプライン曲線、ベジェ曲線などの任意のモデルを用いることができる。フィッティング手法は、最小二乗法や、最小メジアン法、RANSAC、M推定法等のロバスト推定法などを用いることが可能である。ロバスト推定法を用いることで、レーザレーダ21aのセンサ計測値の誤差に対してロバストなフィッティングが可能となる。
曲線フィッティングは、車両位置を基準として進行方向左側の点群と、右側の点群とでそれぞれ個別に行う。あるいは,曲線モデルを平行な直線、二重円弧等,右側の点群と左側の点群を一度にフィッティングできる曲線モデルを用いてもよい。これにより、図8に示すように、点群から道路形状が特定される。
走行経路設定部12は、道路形状認識部11の形状特定部23から入力された道路形状を表わす曲線情報及びレーザレーダ21bによって取得された点列から得られる路面情報などに基づいて、道路上に走り易い走行経路を設定する。
まず、レーザレーダ21a、21bによってレーザビームL1、L2がそれぞれ射出されることにより、車両周辺における物体の存在や路面状況を示す点列(rn,θn)が取得される。レーザレーダ21aによって取得された点列は点列抽出部22に、レーザレーダ21aによって取得された点列は走行経路設定部12にそれぞれ出力される。
点列抽出部22では、レーザレーダ21aによって取得された点列のうち、距離rの変化が所定の閾値よりも大きい点列が抽出されて、形状特定部23に出力される。形状特定部23では、点列抽出部22から入力された点列を用いて曲線フィッティングが行われ、道路形状が特定される。
11 道路形状認識部
12 走行経路設定部
21 点列取得部
21a,21b レーザレーダ
22 点列抽出部
23 形状特定部
31 候補設定部
32 スコア作成部
33 経路決定部
41 凹凸スコア作成部
42 斜度スコア作成部
43 曲率スコア作成部
44 曲率変化スコア作成部
Claims (7)
- 自律走行可能な車両に搭載され、該車両の自律走行を制御する自律走行制御装置であって、
高低差が所定値以上である位置を検出し、検出した該位置に基づいて道路の幅を含む道路形状を認識する道路形状認識手段と、
前記道路形状認識手段によって認識された道路形状を用いて走行経路を設定する走行経路設定手段と
を備え、
前記走行経路設定手段は、
前記道路形状認識手段によって認識された道路の両端の間に複数の走行経路候補を設定する候補設定手段と、
複数の走行経路候補の各々について、路面の凹凸、路面の斜度、経路の曲率、及び経路の曲率変化のうち、少なくともいずれか一つに基づいて走り易さを表わすスコアを作成するスコア作成手段と、
前記スコア作成手段によって作成されたスコアに基づいて、複数の走行経路候補の一つを走行経路として決定する経路決定手段と
を具備する自律走行制御装置。 - 前記スコア作成手段は、前記走行経路候補毎に路面高低差を算出し、該路面高低差に基づいて凹凸スコアを作成する凹凸スコア作成手段を具備する請求項1に記載の自律走行制御装置。
- 前記スコア作成手段は、前記走行経路候補毎に路面の最高高さと最低高さとを抽出し、抽出した該最高高さと最低高さとの差分をその間の距離で除算して路面の斜度を算出し、算出した斜度に基づいて斜度スコアを作成する斜度スコア作成手段を具備する請求項1または請求項2に記載の自律走行制御装置。
- 前記スコア作成手段は、前記走行経路候補毎に最大曲率を算出し、算出した最大曲率に基づいて曲率スコアを作成する曲率スコア作成手段を具備する請求項1から請求項3のいずれかに記載の自律走行制御装置。
- 前記スコア作成手段は、前記走行経路候補毎に最大曲率変化を算出し、算出した最大曲率変化に基づいて曲率変化スコアを作成する曲率変化スコア作成手段を具備する請求項1から請求項4のいずれかに記載の自律走行制御装置。
- 請求項1から請求項5のいずれかに記載の自律走行制御装置を搭載し、該自律走行制御装置によって設定された走行経路に従って走行する自律走行車両。
- 自律走行可能な車両に搭載され、該車両の自律走行を制御する自律走行制御方法であって、
高低差が所定値以上である位置を検出し、検出した該位置に基づいて道路の幅を含む道路形状を認識する道路形状認識過程と、
前記道路形状認識過程において認識された道路形状を用いて走行経路を設定する走行経路設定過程と
を備え、
前記走行経路設定過程は、
前記道路形状認識過程において認識された道路の両端の間に複数の走行経路候補を設定する候補設定過程と、
複数の走行経路候補の各々について、路面の凹凸、路面の斜度、経路の曲率、及び経路の曲率変化のうち、少なくともいずれか一つに基づいて走り易さを表わすスコアを作成するスコア作成過程と、
前記スコア作成過程において作成されたスコアに基づいて、複数の走行経路候補の一つを走行経路として決定する経路決定過程と
を具備する自律走行制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010228505A JP5796947B2 (ja) | 2010-10-08 | 2010-10-08 | 自律走行制御装置及びそれを備えた自律走行車両 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010228505A JP5796947B2 (ja) | 2010-10-08 | 2010-10-08 | 自律走行制御装置及びそれを備えた自律走行車両 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2012083892A JP2012083892A (ja) | 2012-04-26 |
JP5796947B2 true JP5796947B2 (ja) | 2015-10-21 |
Family
ID=46242702
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2010228505A Active JP5796947B2 (ja) | 2010-10-08 | 2010-10-08 | 自律走行制御装置及びそれを備えた自律走行車両 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5796947B2 (ja) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20160013713A (ko) * | 2014-07-28 | 2016-02-05 | 현대자동차주식회사 | 자율주행차량의 전역경로 생성장치 및 방법 |
CN105184852B (zh) * | 2015-08-04 | 2018-01-30 | 百度在线网络技术(北京)有限公司 | 一种基于激光点云的城市道路识别方法及装置 |
CN106407893B (zh) * | 2016-08-29 | 2019-11-22 | 东软集团股份有限公司 | 一种检测车道线的方法、装置和设备 |
KR102518532B1 (ko) | 2016-11-11 | 2023-04-07 | 현대자동차주식회사 | 자율주행차량의 경로 결정장치 및 그 방법 |
JP2018206094A (ja) * | 2017-06-06 | 2018-12-27 | 三菱電機株式会社 | 観測装置および車両制御システム |
US10684134B2 (en) | 2017-12-15 | 2020-06-16 | Waymo Llc | Using prediction models for scene difficulty in vehicle routing |
JP7046359B2 (ja) * | 2018-04-24 | 2022-04-04 | シャロン株式会社 | 運転制御装置および自動走行装置 |
CN110412530B (zh) * | 2018-04-27 | 2021-09-17 | 深圳市优必选科技有限公司 | 一种识别充电桩的方法、装置及机器人 |
JP7019885B2 (ja) * | 2018-05-17 | 2022-02-16 | 株式会社デンソーアイティーラボラトリ | 車両制御値決定装置、車両制御値決定方法、およびプログラム |
CN112055805A (zh) * | 2019-01-30 | 2020-12-08 | 百度时代网络技术(北京)有限公司 | 用于自动驾驶车辆的点云登记系统 |
US11688155B2 (en) | 2020-01-06 | 2023-06-27 | Luminar, Llc | Lane detection and tracking techniques for imaging systems |
US11884291B2 (en) | 2020-08-03 | 2024-01-30 | Waymo Llc | Assigning vehicles for transportation services |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3150018B2 (ja) * | 1993-08-27 | 2001-03-26 | 株式会社アイ・エイチ・アイ・エアロスペース | 無人移動探査機の経路決定方法 |
JP3881048B2 (ja) * | 1995-11-06 | 2007-02-14 | 富士重工業株式会社 | 狭路ガイド装置 |
JP2002132343A (ja) * | 2000-10-26 | 2002-05-10 | Kawasaki Heavy Ind Ltd | 自律走行体の走行制御方法 |
JP4256812B2 (ja) * | 2004-04-26 | 2009-04-22 | 三菱重工業株式会社 | 移動体の障害物回避方法及び該移動体 |
-
2010
- 2010-10-08 JP JP2010228505A patent/JP5796947B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2012083892A (ja) | 2012-04-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5796947B2 (ja) | 自律走行制御装置及びそれを備えた自律走行車両 | |
JP4676373B2 (ja) | 周辺認識装置、周辺認識方法、プログラム | |
JP5874756B2 (ja) | 区画線検出システム及び区画線検出方法 | |
JP5926228B2 (ja) | 自律車両用の奥行き検知方法及びシステム | |
WO2016129646A1 (ja) | 走行軌跡選定装置、および走行軌跡選定方法 | |
JP5962771B2 (ja) | 移動物体位置姿勢角推定装置及び移動物体位置姿勢角推定方法 | |
US9797981B2 (en) | Moving-object position/attitude estimation apparatus and moving-object position/attitude estimation method | |
KR101448411B1 (ko) | 입체물 검출 장치 및 입체물 검출 방법 | |
US10436898B2 (en) | Object recognition device | |
KR102056147B1 (ko) | 자율주행차량을 위한 거리 데이터와 3차원 스캔 데이터의 정합 방법 및 그 장치 | |
JP6156400B2 (ja) | 走行路面検出装置及び走行路面検出方法 | |
JP2016146061A (ja) | 走行制御装置 | |
JP5623362B2 (ja) | 段差部認識装置 | |
JP4333611B2 (ja) | 移動体用の障害物検出装置 | |
JP2012159469A (ja) | 車両用画像認識装置 | |
JP4721278B2 (ja) | 車線逸脱判定装置、車線逸脱防止装置および車線追従支援装置 | |
JP5433289B2 (ja) | 自動走行車両及び道路形状認識装置 | |
JP2011175572A (ja) | 車線認識装置 | |
JP6204782B2 (ja) | オフロードダンプトラック | |
JP2012150595A (ja) | 一時停止線検出装置及びプログラム | |
JP7043787B2 (ja) | 対象物検知システム | |
JP6439592B2 (ja) | 落下物検出装置 | |
WO2014054124A1 (ja) | 路面標示検出装置及び路面標示検出方法 | |
JP5692767B1 (ja) | 自動走行車両 | |
JP4978938B2 (ja) | 距離測定装置及び方法、並びにコンピュータプログラム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20130930 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20140617 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20140618 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20140818 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20141111 |
|
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: 20150721 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20150818 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 5796947 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |