JP6448029B2 - 連結車両の連結角取得装置及び連結車両の運転支援システム - Google Patents
連結車両の連結角取得装置及び連結車両の運転支援システム Download PDFInfo
- Publication number
- JP6448029B2 JP6448029B2 JP2015013464A JP2015013464A JP6448029B2 JP 6448029 B2 JP6448029 B2 JP 6448029B2 JP 2015013464 A JP2015013464 A JP 2015013464A JP 2015013464 A JP2015013464 A JP 2015013464A JP 6448029 B2 JP6448029 B2 JP 6448029B2
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- trailer
- tractor
- connected vehicle
- angle
- 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
- 230000008878 coupling Effects 0.000 claims description 6
- 238000010168 coupling process Methods 0.000 claims description 6
- 238000005859 coupling reaction Methods 0.000 claims description 6
- 238000001514 detection method Methods 0.000 description 12
- 235000004522 Pentaglottis sempervirens Nutrition 0.000 description 4
- 230000006870 function Effects 0.000 description 4
- 239000000428 dust Substances 0.000 description 2
- 238000012423 maintenance Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 240000004050 Pentaglottis sempervirens Species 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000000034 method Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Landscapes
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Description
例えば、特許文献1では、トレーラの予想移動軌跡を表示することで連結車両の運転を支援するシステムが記載されている。
牽引車両と、該牽引車両に対して略垂直方向に延びる連結軸廻りに回転可能に連結される被牽引車両と、からなる連結車両の連結角取得装置であって、
牽引車両に対する被牽引車両の連結軸廻りの回転角である連結角θを、
δ:実操舵角(実舵角)
L1:トラクタの車軸間距離
L2:連結点からトレーラの後輪軸までの距離
Lh:カプラオフセット(連結点からトラクタの後輪軸までの距離)
V1:トラクタの後輪の車輪速(トラクタの旋回中心に関する後輪軸の旋回速度)
V2:トレーラの後輪の車輪速(トレーラの旋回中心に関する後輪軸の旋回速度)
により取得することを特徴とする。
図1、図2に示すように、本発明の一実施の形態に係る連結車両10は、トラクタ(牽引車両)1とトレーラ(被牽引車両)2とからなり、トラクタ(牽引車)1とトレーラ(被牽引車)2は、連結器3により、略垂直方向に延在される連結軸廻りに回転可能に連結された構成となっている。なお、連結器3は、トラクタ(牽引車両)1とトレーラ(被牽引車両)2とを切り離し可能に構成することができる。
(1)後退での車庫入れのように、連結車両10をある目的の方向に後退させる場合には、まず初めに、トレーラ2の後端側が目的の方向を向くようにトレーラ2を旋回(回転)させる必要がある。そのために、図3(A)に示すように、トラクタ1を、トレーラ2に旋回(回転)のきっかけを与えるために、目的の方向とは逆方向にハンドルを切る。
既知の情報であるとトラクタ1の車軸間距離L1(操舵輪軸と後輪軸の間の距離)と、トレーラ2の連結点(連結軸)と後輪軸の間の距離L2と、トラクタ1の連結点(連結軸)と後輪軸の間の距離Lhと、を用いて、図4に示すような幾何学モデルに基づいて演算により連結角θを算出する。連結角θは、トラクタ(牽引車)1とトレーラ(被牽引車)2との連結器3による連結点(鉛直な連結軸)廻りの回転角度である(或いは、平面図上におけるトラクタ(牽引車)1の長手方向中心軸と、トレーラ(被牽引車)2の長手方向中心軸と、が交差する角度である)。
なお、舵角センサは、連結車両10に他の目的(DSC(ダイナミック・スタビリティー・コントロール)など)のために既に搭載されているセンサである。
なお、トラクタ1の後輪の車輪速度センサ、トレーラ2の後輪の車輪速度センサは、他の目的(DSC(ダイナミック・スタビリティー・コントロール)、アンチロックブレーキシステムなど)のために既に搭載されているセンサである。
θ:連結角(演算により取得)
δ:実操舵角(実舵角)(操舵角センサの出力に基づき取得)
L1:トラクタの車軸間距離(ホイールベース)(既知の値)(コンピュータに入力或いは記憶)
L2:連結点からトレーラの後輪軸までの距離(既知の値)(コンピュータに入力或いは記憶)
Lh:カプラオフセット(連結点からトラクタの後輪軸までの距離)(既知の値)(コンピュータに入力或いは記憶)
V1:トラクタの後輪の車輪速(トラクタの旋回中心に関する後輪軸の旋回速度)(車輪速センサの出力に基づき取得)
V2:トレーラの後輪の車輪速(トレーラの旋回中心に関する後輪軸の旋回速度)(車輪速センサの出力に基づき取得)
Vc:連結点の速度(演算により取得)
R1:連結点からトラクタの旋回中心までの距離(演算により取得)
R2:連結点からトレーラの旋回中心までの距離(演算により取得)
R3:トラクタの車両中心線X(後輪軸の幅方向中心線)からトラクタ旋回中心までの最短距離(演算により取得)
R4:トレーラの車両中心線Y(後輪軸の幅方向中心線)からトレーラ旋回中心までの最短距離(演算により取得)
α:トラクタの車両中心線Xと、連結点とトラクタ旋回中心を結ぶ線と、のなす角(交差角)(演算により取得)
と定義する。
Vc/V1=R1/R3、 V2/Vc=R4/R2の関係から、
V2/V1=R4/R2・R1/R3 …(式1)
R4/R2=cos(π/4+θ−α) …(式2)
また、
R3=L1/tanδ
R1=(Lh2+R32)1/2=(Lh2+(L1/tanδ)2)1/2より、
R1/R3=((Lh・tanδ)2+L12)1/2/L1 …(式3)
α=tan−1(L1/(Lh・tanδ)) …(式4)
ここで、式1に、式2、式3、式4を代入し変形すると、
cos(π/4+θ−α)=V2/V1・L1/((Lh・tanδ)2+L12)1/2
θ=cos−1(V2/V1・L1/((Lh・tanδ)2+L12)1/2−π/4+α
=cos−1(V2/V1・L1/((Lh・tanδ)2+L12)1/2−π/4+
tan−1(L1/(Lh・tanδ))
となる。
すなわち、
これにより、連結角θを演算により取得(検出)することができる。
これにより、ドライバーは、バックカメラの映像に重畳されたトレーラ2の後退時の進行方向の表示を参考に後退運転をすることができるため、円滑かつ安全な後退運転の支援の実現に貢献するができる。
このような音声報知(音声案内:音情報の提示)により、本実施の形態に係る連結車両の運転支援システムは、円滑かつ安全な後退運転の支援の実現に貢献することができる。
2 トレーラ(被牽引車両)
3 連結器
10 連結車両(セミトレーラ)
Claims (3)
- 請求項1に記載の連結車両の連結角取得装置により取得される連結角に基づく情報をドライバーに提示して、連結車両の運転を支援することを特徴とする連結車両の運転支援システム。
- 連結車両の後退運転において、そのまま後退させても連結角θが変化しない実操舵角δのときに、その旨をドライバーに報知することを特徴とする請求項2に記載の連結車両の運転支援システム。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015013464A JP6448029B2 (ja) | 2015-01-27 | 2015-01-27 | 連結車両の連結角取得装置及び連結車両の運転支援システム |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015013464A JP6448029B2 (ja) | 2015-01-27 | 2015-01-27 | 連結車両の連結角取得装置及び連結車両の運転支援システム |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2016137802A JP2016137802A (ja) | 2016-08-04 |
JP6448029B2 true JP6448029B2 (ja) | 2019-01-09 |
Family
ID=56558290
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2015013464A Active JP6448029B2 (ja) | 2015-01-27 | 2015-01-27 | 連結車両の連結角取得装置及び連結車両の運転支援システム |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6448029B2 (ja) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6495076B2 (ja) * | 2015-04-02 | 2019-04-03 | 日野自動車株式会社 | 連結車両の後退運転支援装置 |
DE102015014799A1 (de) | 2015-11-13 | 2017-05-18 | Mekra Lang Gmbh & Co. Kg | System und Verfahren zur Erfassung eines Heckbereiches eines Fahrzeugs |
JP6897294B2 (ja) * | 2017-05-11 | 2021-06-30 | 株式会社アイシン | 牽引支援装置 |
JP6893857B2 (ja) * | 2017-09-25 | 2021-06-23 | 日野自動車株式会社 | 発進方法決定装置 |
JP7087332B2 (ja) * | 2017-10-10 | 2022-06-21 | 株式会社アイシン | 運転支援装置 |
JP7000787B2 (ja) * | 2017-10-12 | 2022-01-19 | 株式会社アイシン | 周辺監視装置 |
US20190322317A1 (en) * | 2018-04-18 | 2019-10-24 | GM Global Technology Operations LLC | System and method for automatically determining dimensions of a trailer |
JP7259441B2 (ja) * | 2019-03-19 | 2023-04-18 | 株式会社Ihi | 連結角推定装置 |
JP7352907B2 (ja) * | 2019-09-27 | 2023-09-29 | 日野自動車株式会社 | 駐車支援装置 |
CN112848822B (zh) * | 2021-02-25 | 2022-12-09 | 清华大学 | 一种测量挂车车头与货箱夹角的拉线装置及其测量方法 |
JPWO2023090122A1 (ja) * | 2021-11-17 | 2023-05-25 | ||
CN114407780A (zh) * | 2022-03-03 | 2022-04-29 | 南京天安汽车电子科技股份有限公司 | 基于双陀螺仪的半挂车内轮差区域防碰撞预警方法 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2722183B2 (ja) * | 1995-06-07 | 1998-03-04 | 輸送機工業株式会社 | セミトレーラの連結角度検出装置 |
JPH11160063A (ja) * | 1997-11-26 | 1999-06-18 | Mitsubishi Motors Corp | 連結車の連結角測定装置 |
JP3745187B2 (ja) * | 2000-03-22 | 2006-02-15 | 日産ディーゼル工業株式会社 | 連結車両の挙動制御装置 |
JP2002145133A (ja) * | 2000-11-10 | 2002-05-22 | Isuzu Motors Ltd | トレーラ連結角検出装置 |
JP2003034261A (ja) * | 2001-07-24 | 2003-02-04 | Tokyu Car Corp | 連結車両の後退制御装置及びその後退制御方法 |
DE102007040250A1 (de) * | 2007-08-27 | 2009-03-05 | Daimler Ag | Verfahren und Vorrichtung zur Fahrerunterstützung beim Rangieren eines Fahrzeuges oder Fahrzeuggespanns |
JP2009060499A (ja) * | 2007-09-03 | 2009-03-19 | Sanyo Electric Co Ltd | 運転支援システム及び連結車両 |
US9389613B2 (en) * | 2014-11-14 | 2016-07-12 | International Truck Intellectual Property Company, Llc | Determining turning radius of coupled vehicles |
-
2015
- 2015-01-27 JP JP2015013464A patent/JP6448029B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2016137802A (ja) | 2016-08-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6448029B2 (ja) | 連結車両の連結角取得装置及び連結車両の運転支援システム | |
JP6495076B2 (ja) | 連結車両の後退運転支援装置 | |
US10435070B2 (en) | Vehicle-trailer backing system having targetless hitch angle detection and trailer geometry learning | |
US9963004B2 (en) | Trailer sway warning system and method | |
US10384607B2 (en) | Trailer backup assist system with hitch angle offset estimation | |
US11385651B2 (en) | System and methods for detection and response to interference between trailer coupler and hitch ball | |
KR101900787B1 (ko) | 차량의 후방부를 캡쳐하기 위한 시스템 및 방법 | |
US8073594B2 (en) | Trailer articulation angle estimation | |
US20120296523A1 (en) | Vehicle periphery monitoring device | |
US11941847B2 (en) | Controller for a vehicle | |
RU2010133248A (ru) | Способ и устройство для отображения пространства вокруг транспортного средства | |
US11400974B2 (en) | Towing assist device for notifying driver of backup conditions | |
US11701931B2 (en) | Angle and orientation measurements for vehicles with multiple drivable sections | |
US10946897B2 (en) | System and methods for steering control in assisted vehicle operation | |
US11964659B2 (en) | System and method for determining a hitch angle for controlling a vehicle with active rear steering | |
JP2017107538A (ja) | 構造光を運用し物体距離を感知する内輪差警告方法及びシステム | |
US11148488B2 (en) | System and method for positioning a vehicle with reduced variation | |
US20190389260A1 (en) | System for detection and response to retreating trailer | |
JP2023163795A (ja) | 連結車両の相対角度検出装置 | |
JP7081105B2 (ja) | 牽引支援装置 | |
US11866033B2 (en) | Method for estimating an effective length of a first vehicle segment of a vehicle combination | |
GB2572144A (en) | A control module for a vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20171220 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20181115 |
|
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: 20181128 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20181128 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6448029 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
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 |