JP2006322753A - 車両の走行制御装置 - Google Patents
車両の走行制御装置 Download PDFInfo
- Publication number
- JP2006322753A JP2006322753A JP2005144482A JP2005144482A JP2006322753A JP 2006322753 A JP2006322753 A JP 2006322753A JP 2005144482 A JP2005144482 A JP 2005144482A JP 2005144482 A JP2005144482 A JP 2005144482A JP 2006322753 A JP2006322753 A JP 2006322753A
- Authority
- JP
- Japan
- Prior art keywords
- information
- reference station
- vehicle
- station
- abnormality
- 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
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
【解決手段】 制御装置18は、基準局4からの情報とGPS衛星3からの情報に基づいて測位した自車位置から自車両1の走行情報(第1の走行情報)を演算し、この第1の走行情報が実車の走行状態から求まる走行情報(第2の走行情報)に対して予め設定した閾値以上異なるとき、基準局4が移動することによる該基準局4の異常を判定することにより、基準局4の異常を的確に検出する。そして、制御装置18は、異常判定時に、自車位置に基づく走行制御の実行をキャンセルすることにより精度のよい走行制御を実現する。
【選択図】 図1
Description
(i)基準局4の位置が移動前の基準点に補正されたとき。
(ii)基準局4の移動量に基づいて走行制御の制御情報が補正されたとき。
すなわち、自車両1が定点に停車し、その旨の信号がドライバ入力等によって制御装置18に入力されると、制御装置18は、予め高精度に位置情報が求められている定点と基準点との関係から、現在の自車両1(移動局)と基準局4との相対位置に基づいて、基準点に対する基準局4の移動量を演算する。
このルーチンは設定時間毎に繰り返し実行されるもので、制御装置10は、先ず、ステップS101で、現在通信中の移動局が存在するか否かを調べる。そして、通信中の移動局が存在しないと判定すると、制御装置10は、ステップS105に進む。
このルーチンは設定時間毎に繰り返し実行されるもので、制御装置18は、先ず、ステップS201で、必要なパラメータの読み込みを行う。
γG=VG/ρG …(1)
ここで、VGは、3点のノード情報(位置及び時間)から求まる自車両1の車速である。
また、ρGは、3点のノード情報(位置)から求まる自車の旋回半径であり、例えば、以下の(2)式から求めることができる。
ρG=(a・b・c)/4Δ …(2)
但し、(2)式中において、a,b,cは3点のノードで形成される三角形の各辺の長さであり、
2s=a+b+cとおくと、
Δ=(s・(s−a)・(s−b)・(s−c))1/2 …(3)
である。
γS=γ0・(θHS/N)/(1+Tr) …(4)
ここで、(4)式中において、γ0は定常ヨーレートゲインであり、以下の(5)式から求まる。
γ0=1/(1+sf・V2)・V/l …(5)
但し、sfはスタビリティファクタであり、lはホイルベースである。
また、(5)式中において、Trは時定数であり、以下の(6)式から求まる。
Tr=(m・lf・V)/(2・l・kre) …(6)
但し、(6)式中において、mは車両質量であり、lfはフロント軸距離(重心から前輪軸までの距離)、kreは後輪の等価コーナリングパワである。
このルーチンがスタートすると、制御装置18は、先ず、ステップS301で必要なパラメータを読み込み、続くステップS302で、自車位置の過去の履歴の中から、例えば、現在位置より略車長長さ(例えば、5m)手前の自車測位点履歴を抽出し、この5m手前の自車測位点と現在の自車位置とを結んで得られる前方への直線方向を自車進行路として推定する。
δh=GP・ΔD+Gd・(d(ΔD)/dt) …(7)
ここで、GPは比例項ゲインであり、Gdは微分項ゲインである。
Iδ=KP・Δδ+Kd・(d(Δδ)/dt)+Ki・∫Δδdt …(8)
ここで、KPは比例項ゲイン、Kdは微分項ゲイン、Kiは積分項ゲインである。
2 … 車両制御装置
3 … 人工衛星
4 … 基準局
4a … GPSアンテナ
4b … GPS受信機
4c … 無線機
10 … 制御装置(異常判定手段、ガイド手段、警報手段)
11 … 加速度センサ(設置情報検出手段)
12 … 接地スイッチ(設置情報検出手段)
13 … 移動体検出センサ(移動体検出手段)
14 … 液晶ディスプレイ(ガイド手段、警報手段)
15a … GPSアンテナ
15b … GPS受信機
15c … 無線機
18 … 制御装置(車両位置演算手段、走行制御手段、異常判定手段、移動量演算手段、制御情報補正手段)
19 … 車速センサ
20 … ハンドル角センサ
Claims (5)
- 予め位置が求められた基準点に設置し、衛星からの情報を基に補正情報を求める基準局と、
車両に搭載され、上記衛星からの情報に基づき車両位置を演算する移動局と、
上記基準局と上記移動局との通信が確立した際に、上記基準局の情報と上記車両位置とから該車両位置を補正演算する車両位置演算手段と、
上記車両位置に基づく走行制御を行う走行制御手段と、
上記車両位置に基づいて自車の第1の走行情報を演算し、当該第1の走行情報が実車の走行状態から求まる第2の走行情報に対して予め設定した閾値以上異なるとき上記基準局の移動による異常を判定する異常判定手段とを有し、
上記走行制御手段は、上記異常判定手段での異常判定時に、上記車両位置に基づく走行制御の実行をキャンセルすることを特徴とする車両の走行制御装置。 - 予め位置が求められた基準点に設置し、衛星からの情報を基に補正情報をる基準局と、
車両に搭載され、上記衛星からの情報に基づき車両位置を演算する車載の移動局と、
上記基準局と上記移動局との通信が確立した際に、上記基準局の情報と上記車両位置とから該車両位置を補正演算する車両位置演算手段と、
上記車両位置に基づく走行制御を行う走行制御手段と、
上記基準局の設置情報を検出する設置情報検出手段と、
上記設置情報検出手段で検出した設置情報が予め設定した挙動を示したとき上記基準局の移動による異常を判定する異常判定手段とを有し、
上記走行制御手段は、上記異常判定手段での異常判定時に、上記車両位置に基づく走行制御の実行をキャンセルすることを特徴とする車両の走行制御装置。 - 上記基準局の異常判定時において、上記移動局が予め設定した定点で停止したとき、当該移動局と上記基準局との相対位置に基づいて上記基準点に対する上記基準局の移動量を演算する移動量演算手段と、
上記移動量演算手段で演算した移動量に基づいて上記基準局を上記基準点までガイドするガイド手段とを有し、
上記異常判定手段は、上記基準局の位置が上記基準点に補正されたとき、上記基準局の異常判定をクリアすることを特徴とする請求項1または請求項2記載の車両の走行制御装置。 - 上記基準局の異常判定時において、上記移動局が予め設定した定点で停止したとき、当該移動局と上記基準局との相対位置に基づいて上記基準点に対する上記基準局の移動量を演算する移動量演算手段と、
上記移動量演算手段で演算した上記基準局の移動量に基づき、上記基準局の現在位置を新たな基準点として、上記走行制御手段で行う走行制御の制御情報を補正する制御情報補正手段とを有し、
上記異常判定手段は、上記制御情報補正手段で上記制御情報の補正を行ったとき、上記基準局の異常判定をクリアすることを特徴とする請求項1または請求項2記載の車両の走行制御装置。 - 上記基準局を含む予め設定した警報領域に進入する移動体を検出する移動体検出手段と、
少なくとも上記基準局と上記移動局との通信中に、上記警報領域に移動体が進入したとき、上記移動体に警報を発する警報手段とを備えたことを特徴とする請求項1乃至請求項4の何れか1つに記載の車両の走行制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005144482A JP4807728B2 (ja) | 2005-05-17 | 2005-05-17 | 車両の走行制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005144482A JP4807728B2 (ja) | 2005-05-17 | 2005-05-17 | 車両の走行制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2006322753A true JP2006322753A (ja) | 2006-11-30 |
JP4807728B2 JP4807728B2 (ja) | 2011-11-02 |
Family
ID=37542553
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2005144482A Expired - Fee Related JP4807728B2 (ja) | 2005-05-17 | 2005-05-17 | 車両の走行制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4807728B2 (ja) |
Cited By (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008292480A (ja) * | 2007-05-18 | 2008-12-04 | Astrium Sas | 衛星位置決め方法およびその設備 |
JP2009031042A (ja) * | 2007-07-25 | 2009-02-12 | Furuno Electric Co Ltd | 姿勢計測装置 |
JP2009175071A (ja) * | 2008-01-28 | 2009-08-06 | Hitachi Industrial Equipment Systems Co Ltd | Gpsデータ処理装置 |
JP2009270928A (ja) * | 2008-05-07 | 2009-11-19 | Toyota Motor Corp | 移動体用測位システム |
JP2010060421A (ja) * | 2008-09-03 | 2010-03-18 | Toyota Motor Corp | 移動体用測位システム及びgnss受信装置 |
JP2011145139A (ja) * | 2010-01-14 | 2011-07-28 | Hitachi Zosen Corp | 海面変位計測システム |
JP2011185692A (ja) * | 2010-03-08 | 2011-09-22 | Nec (China) Co Ltd | 位置決め装置の異常変位を判定するためのシステム、方法、および装置 |
JP2012127899A (ja) * | 2010-12-17 | 2012-07-05 | Isuzu Motors Ltd | 測位精度判定装置 |
JP2012525587A (ja) * | 2009-04-28 | 2012-10-22 | キャタピラー インコーポレイテッド | 可動機械用の位置監視システム |
JP2013228237A (ja) * | 2012-04-25 | 2013-11-07 | Hitachi Zosen Corp | 変位観測方法および変位観測システム |
WO2014132618A1 (ja) * | 2013-02-26 | 2014-09-04 | 日本電気株式会社 | 状態検出方法、補正値処理装置、測位システム、および状態検出プログラム |
JP2015075380A (ja) * | 2013-10-08 | 2015-04-20 | 鹿島建設株式会社 | リアルタイムキネマティックシステム及び位置測定方法 |
KR101882683B1 (ko) * | 2017-07-13 | 2018-07-30 | 한국건설기술연구원 | Rtk-gnss를 이용한 도로 차선 위치정보 검출 시스템 및 그 방법 |
JP2018200274A (ja) * | 2017-05-29 | 2018-12-20 | 株式会社クボタ | 自動走行作業車両のための衛星測位システム |
WO2019049540A1 (ja) * | 2017-09-07 | 2019-03-14 | ヤンマー株式会社 | 測位システム |
JP2020101529A (ja) * | 2018-12-20 | 2020-07-02 | エスゼット ディージェイアイ テクノロジー カンパニー リミテッドSz Dji Technology Co.,Ltd | 装置および方法 |
WO2020262528A1 (ja) * | 2019-06-27 | 2020-12-30 | 株式会社Nttドコモ | 情報処理装置及び情報処理方法 |
JP2021181990A (ja) * | 2017-09-07 | 2021-11-25 | ヤンマーパワーテクノロジー株式会社 | 測位システム |
JP7476263B2 (ja) | 2020-12-28 | 2024-04-30 | 株式会社ブロードリーフ | 車両制御装置、車両制御方法及び車両制御プログラム |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0961509A (ja) * | 1995-08-22 | 1997-03-07 | Hitachi Zosen Corp | Gps測量方法およびその装置 |
JP2002090150A (ja) * | 2000-09-11 | 2002-03-27 | Kawasaki Heavy Ind Ltd | 移動体の方位推定装置および位置推定装置 |
JP2003219448A (ja) * | 2002-01-25 | 2003-07-31 | Hitachi Ltd | 位置補正情報配信システム |
JP2005067322A (ja) * | 2003-08-21 | 2005-03-17 | Fuji Heavy Ind Ltd | 車両の走行制御装置 |
-
2005
- 2005-05-17 JP JP2005144482A patent/JP4807728B2/ja not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0961509A (ja) * | 1995-08-22 | 1997-03-07 | Hitachi Zosen Corp | Gps測量方法およびその装置 |
JP2002090150A (ja) * | 2000-09-11 | 2002-03-27 | Kawasaki Heavy Ind Ltd | 移動体の方位推定装置および位置推定装置 |
JP2003219448A (ja) * | 2002-01-25 | 2003-07-31 | Hitachi Ltd | 位置補正情報配信システム |
JP2005067322A (ja) * | 2003-08-21 | 2005-03-17 | Fuji Heavy Ind Ltd | 車両の走行制御装置 |
Cited By (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008292480A (ja) * | 2007-05-18 | 2008-12-04 | Astrium Sas | 衛星位置決め方法およびその設備 |
JP2009031042A (ja) * | 2007-07-25 | 2009-02-12 | Furuno Electric Co Ltd | 姿勢計測装置 |
JP2009175071A (ja) * | 2008-01-28 | 2009-08-06 | Hitachi Industrial Equipment Systems Co Ltd | Gpsデータ処理装置 |
JP2009270928A (ja) * | 2008-05-07 | 2009-11-19 | Toyota Motor Corp | 移動体用測位システム |
JP2010060421A (ja) * | 2008-09-03 | 2010-03-18 | Toyota Motor Corp | 移動体用測位システム及びgnss受信装置 |
JP2012525587A (ja) * | 2009-04-28 | 2012-10-22 | キャタピラー インコーポレイテッド | 可動機械用の位置監視システム |
JP2011145139A (ja) * | 2010-01-14 | 2011-07-28 | Hitachi Zosen Corp | 海面変位計測システム |
JP2011185692A (ja) * | 2010-03-08 | 2011-09-22 | Nec (China) Co Ltd | 位置決め装置の異常変位を判定するためのシステム、方法、および装置 |
JP2012127899A (ja) * | 2010-12-17 | 2012-07-05 | Isuzu Motors Ltd | 測位精度判定装置 |
JP2013228237A (ja) * | 2012-04-25 | 2013-11-07 | Hitachi Zosen Corp | 変位観測方法および変位観測システム |
JPWO2014132618A1 (ja) * | 2013-02-26 | 2017-02-02 | 日本電気株式会社 | 状態検出方法、補正値処理装置、測位システム、および状態検出プログラム |
WO2014132618A1 (ja) * | 2013-02-26 | 2014-09-04 | 日本電気株式会社 | 状態検出方法、補正値処理装置、測位システム、および状態検出プログラム |
JP2015075380A (ja) * | 2013-10-08 | 2015-04-20 | 鹿島建設株式会社 | リアルタイムキネマティックシステム及び位置測定方法 |
JP2018200274A (ja) * | 2017-05-29 | 2018-12-20 | 株式会社クボタ | 自動走行作業車両のための衛星測位システム |
KR101882683B1 (ko) * | 2017-07-13 | 2018-07-30 | 한국건설기술연구원 | Rtk-gnss를 이용한 도로 차선 위치정보 검출 시스템 및 그 방법 |
JP2021181990A (ja) * | 2017-09-07 | 2021-11-25 | ヤンマーパワーテクノロジー株式会社 | 測位システム |
JP2019045456A (ja) * | 2017-09-07 | 2019-03-22 | ヤンマー株式会社 | 測位システム |
WO2019049540A1 (ja) * | 2017-09-07 | 2019-03-14 | ヤンマー株式会社 | 測位システム |
JP7083065B2 (ja) | 2017-09-07 | 2022-06-09 | ヤンマーパワーテクノロジー株式会社 | 測位システム |
JP2020101529A (ja) * | 2018-12-20 | 2020-07-02 | エスゼット ディージェイアイ テクノロジー カンパニー リミテッドSz Dji Technology Co.,Ltd | 装置および方法 |
WO2020262528A1 (ja) * | 2019-06-27 | 2020-12-30 | 株式会社Nttドコモ | 情報処理装置及び情報処理方法 |
JPWO2020262528A1 (ja) * | 2019-06-27 | 2020-12-30 | ||
JP7143525B2 (ja) | 2019-06-27 | 2022-09-28 | 株式会社Nttドコモ | 情報処理装置及び情報処理方法 |
JP7476263B2 (ja) | 2020-12-28 | 2024-04-30 | 株式会社ブロードリーフ | 車両制御装置、車両制御方法及び車両制御プログラム |
Also Published As
Publication number | Publication date |
---|---|
JP4807728B2 (ja) | 2011-11-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4807728B2 (ja) | 車両の走行制御装置 | |
JP4638277B2 (ja) | 車両の走行制御装置 | |
JP4456855B2 (ja) | 車両の走行制御装置 | |
JP4435519B2 (ja) | 車両の走行制御装置 | |
JP6338614B2 (ja) | 車両の走行制御装置 | |
US9896101B2 (en) | Autonomous driving vehicle system | |
US20160292998A1 (en) | Vehicle traveling control device | |
JP2008170404A (ja) | 車両の走行制御装置 | |
US10534363B2 (en) | Autonomous driving device and autonomous driving method | |
EP3655298B1 (en) | A tunnel-based planning system for autonomous driving vehicles | |
JP7360269B2 (ja) | 車両の走行制御装置 | |
JP2017087816A (ja) | 自動運転システム | |
JP4230312B2 (ja) | 車両の進行路推定装置、及び、その進行路推定装置を備えた走行制御装置 | |
KR20160127662A (ko) | 자동 운전 차량 시스템 | |
JP2016172500A (ja) | 車両の走行制御装置 | |
JP7193948B2 (ja) | 自動運転支援装置 | |
JPWO2020025991A1 (ja) | 走行軌跡補正方法、走行制御方法、及び走行軌跡補正装置 | |
JP4225190B2 (ja) | 車両運転支援装置 | |
JP4176616B2 (ja) | 車両の走行制御装置 | |
JP6784629B2 (ja) | 車両の操舵支援装置 | |
JP2022122118A (ja) | 走行環境認識装置 | |
WO2023113005A1 (ja) | 鉱山機械及び自律走行システム | |
EP4047318A1 (en) | Autonomous driving system and abnormality determination method | |
JP4615369B2 (ja) | 車両の走行支援装置 | |
JP2007278898A (ja) | 車両の向き検出装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20080509 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20101129 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20101207 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20110203 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20110621 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20110704 |
|
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: 20110726 |
|
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: 20110810 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140826 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 4807728 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
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 |
|
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 |
|
LAPS | Cancellation because of no payment of annual fees |