Movatterモバイル変換


[0]ホーム

URL:


JP2002181518A - Device for detecting angle of coupling of trailer - Google Patents

Device for detecting angle of coupling of trailer

Info

Publication number
JP2002181518A
JP2002181518AJP2000385338AJP2000385338AJP2002181518AJP 2002181518 AJP2002181518 AJP 2002181518AJP 2000385338 AJP2000385338 AJP 2000385338AJP 2000385338 AJP2000385338 AJP 2000385338AJP 2002181518 AJP2002181518 AJP 2002181518A
Authority
JP
Japan
Prior art keywords
trailer
angle
camera
viewing angle
connection
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.)
Pending
Application number
JP2000385338A
Other languages
Japanese (ja)
Inventor
Masaaki Minamino
南野政明
Masato Mochizuki
望月正人
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Isuzu Motors Ltd
Original Assignee
Isuzu Motors Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Isuzu Motors LtdfiledCriticalIsuzu Motors Ltd
Priority to JP2000385338ApriorityCriticalpatent/JP2002181518A/en
Publication of JP2002181518ApublicationCriticalpatent/JP2002181518A/en
Pendinglegal-statusCriticalCurrent

Links

Classifications

Landscapes

Abstract

PROBLEM TO BE SOLVED: To solve the problem that a conventional device for detecting the angle of coupling of a trailer is an expensive mechanical device of a complicated structure constituted by mounting a turn table and a lever to a king pin for detecting the angle θof coupling in the case that the trailer coupled to a tractor 1 by a rotating connecting part 3 is bent into the state of the trailer 2-2. SOLUTION: Cameras 7 and 8 for placing the rear ends 5 and 6 of the trailer in the photographic field of view on each side are mounted to both sides of the tractor 1. The locational relationship when the trailer is bent is shown in Fig. By geometrically analyzing the shape of the diagram in Fig., it is found out that an angle δt facing the rear end 6 of the trailer and the angle θ of coupling have the following correlation. By obtaining δt from the image location of the rear end 6 of the trailer in a photograph screen and utilizing the correlation, it is possible to obtain the angle θof coupling. δt= arctan[ A×sin(θ+ϕ)-h}/ d+A×cos(θ+ϕ)}]+δs.

Description

Translated fromJapanese
【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【発明の属する技術分野】本発明は、トラクタにトレー
ラが連結されているトラクタ車両において、トラクタと
トレーラとの成す角(連結角)を検出するトレーラ連結
角検出装置に関するものである。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a trailer connection angle detecting device for detecting an angle (connection angle) between a tractor and a trailer in a tractor vehicle having a trailer connected to the tractor.

【0002】[0002]

【従来の技術】トラクタとトレーラの連結角は、トラク
タ車両が直進している場合には0度であるが、カーブを
曲がる場合には屈曲して0度ではなくなる。連結角が大
きければ大きいほど、安全走行上好ましくないから、よ
り一層慎重に運転することが要求される。従って、走行
中にどれ位の連結角になっているかを検出し、ドライバ
ーに知らせてやることが必要であると共に、安全走行を
支援するための種々の制御を、連結角に応じてしてやる
必要がある。そのような制御としては、例えば、車両の
挙動制御(旋回走行時に旋回性を向上させるため、トレ
ーラ内輪のブレーキ力を連結角の大きさに応じて変える
という制御)や、ミラー角度制御(アウトサイドミラー
の死角エリアを減少させるため、アウトサイドミラーの
角度を連結角の大きさに応じて変えるという制御)等が
挙げられる。そこで、従来、以下に示すように、幾つか
のトレーラ連結角検出装置が提案されている。
2. Description of the Related Art The connection angle between a tractor and a trailer is 0 degree when the tractor vehicle is traveling straight, but is not 0 degree when the tractor turns a curve. The greater the connection angle, the more unfavorable for safe driving. Therefore, more careful driving is required. Therefore, it is necessary to detect the connection angle during driving and to notify the driver, and it is necessary to perform various controls for supporting safe driving in accordance with the connection angle. is there. Such control includes, for example, vehicle behavior control (control of changing the braking force of the inner wheels of the trailer in accordance with the connection angle in order to improve turning performance during turning) and mirror angle control (outside) In order to reduce the blind spot area of the mirror, control of changing the angle of the outside mirror in accordance with the size of the connection angle) is included. In view of the above, several trailer connection angle detection devices have been proposed as described below.

【0003】 特開平6−087462号公報の検出装置で
は、キングピンを中心部に固設したターンテーブルをト
レーラに回転可能に取り付け、トラクタが旋回すると、
ターンテーブルとキングピンとが一体となって回動し、
それに伴いキングピンに固着されたレバーも回動し、連
結角が検出されるようにしている。 特開平8−332973号公報の検出装置では、トレーラ
前部の下面にキングピンを中心とした円弧状の磁気スケ
ールを埋設し、トラクタ側には磁気センサを取り付け、
磁気センサからの出力パルス数をカウントすることによ
り連結角を検出している。 特開平4−254268号公報の検出装置では、トラクタ
のキャブ後部中央付近に超音波送受信装置を取り付け、
そこから発射した超音波がトレーラ前面で反射されて帰
って来るまでの時間により、トレーラまでの距離を測定
し、それを基に連結角を求めている。
In the detection device disclosed in Japanese Patent Application Laid-Open No. H06-087462, a turntable having a kingpin fixed at the center is rotatably mounted on a trailer, and when the tractor turns,
The turntable and the kingpin rotate integrally,
Along with this, the lever fixed to the king pin also rotates, so that the connection angle is detected. In the detection device disclosed in Japanese Patent Application Laid-Open No. 8-332973, an arc-shaped magnetic scale centered on a kingpin is buried in the lower surface of the front part of the trailer, and a magnetic sensor is mounted on the tractor side.
The connection angle is detected by counting the number of output pulses from the magnetic sensor. In the detection device disclosed in JP-A-4-254268, an ultrasonic transmission / reception device is mounted near the center of the rear portion of the cab of the tractor,
The distance to the trailer is measured based on the time it takes for the ultrasonic waves emitted from the trailer to reflect off the front of the trailer and return, and the connection angle is determined based on the distance.

【0004】[0004]

【発明が解決しようとする課題】(問題点)しかしなが
ら、前記した従来のトレーラ連結角検出装置は、構造が
複雑で高価な機械式のものであったり、設置するのに車
両に大がかりな改修を加えることを必要としたり、誤差
が含まれ易いものであったりするというような問題点を
有していた。
(Problems to be Solved) However, the above-mentioned conventional trailer connection angle detecting device is a mechanical type having a complicated structure and an expensive structure, or requires a major modification to a vehicle for installation. There is a problem that it is necessary to add it or the error is likely to be included.

【0005】(問題点の説明)特開平6−087462号公報
の検出装置は、キングピンを回動可能に取り付ける構成
や、キングピンがカプラの相対角変化に連動して回動す
るようにする構成等に、非常に多くの部品を必要とし、
構造が複雑で高価となっていた。また、キングピンは連
結のための最重要部品であるが、これに種々の部品を取
り付ける加工を施すことは、保安上好ましくないことで
あった。
(Explanation of Problems) The detecting device disclosed in JP-A-6-087462 has a configuration in which a kingpin is rotatably mounted, a configuration in which the kingpin rotates in conjunction with a change in the relative angle of the coupler, and the like. Requires a lot of parts,
The structure was complicated and expensive. Also, the kingpin is the most important part for connection, but it is not preferable for security to attach various parts to it.

【0006】特開平8−332973号公報の検出装置では、
トレーラ前部下面に磁気スケールを埋設しておく必要が
あるわけであるが、そうするにはトレーラに大がかりな
改修を加える必要があった(改修されていない通常のト
レーラには適用できなかった)。特開平4−254268号公
報の検出装置では、超音波により測定した距離を演算に
使っているが、この測定法は分解能が低く、誤差が含ま
れ易い。連結角は、この誤差を含む距離を基に算出して
いるから、算出された角度に含まれる誤差は、測定距離
に含まれる誤差が小さくとも大きなものとなってしまっ
ていた。本発明は、以上のような問題点を解決すること
を課題とするものである。
[0006] In the detection device disclosed in JP-A-8-332973,
A magnetic scale had to be buried under the front of the trailer, which required major modifications to the trailer (not applicable to regular unmodified trailers). . In the detection apparatus disclosed in Japanese Patent Application Laid-Open No. 4-254268, a distance measured by ultrasonic waves is used for calculation. However, this measurement method has a low resolution and tends to include an error. Since the connection angle is calculated based on the distance including the error, the error included in the calculated angle is large even if the error included in the measurement distance is small. An object of the present invention is to solve the above problems.

【0007】[0007]

【課題を解決するための手段】前記課題を解決するた
め、本発明のトレーラ連結角検出装置では、回動連結部
によりトレーラが連結されたトラクタの両側に、直進時
にトレーラ後端がかろうじて撮影視野に入るよう取り付
けられた、水平方向視野角が広い広視野角カメラと、該
広視野角カメラで撮影したトレーラ後端画像の画面内位
置を求め、該画面内位置を該画面内位置と前記連結角と
の対応関係を表すマップに適用して、連結角を求める連
結角演算装置とを具える構成とした。
In order to solve the above-mentioned problems, in the trailer connection angle detecting device of the present invention, the trailing end of the trailer is barely positioned on both sides of the tractor to which the trailer is connected by the rotary connection portion when the vehicle is going straight. A wide viewing angle camera having a wide horizontal viewing angle, and a position in the screen of a trailer trailing end image taken by the wide viewing angle camera, and connecting the in-screen position with the in-screen position. A connection angle calculation device for obtaining a connection angle by applying to a map representing a correspondence relationship with an angle is provided.

【0008】また、回動連結部によりトレーラが連結さ
れたトラクタの両側に、直進時にトレーラ後端がかろう
じて撮影視野に入るよう取り付けられた、水平方向視野
角が特に広くはない標準視野角カメラと、該標準視野角
カメラを水平方向に段階的に回動するモータと、前記標
準視野角カメラで撮影されたトレーラ後端画像の画面内
位置を求め、該画面内位置を該画面内位置と前記連結角
との対応関係を表すマップに適用して、連結角を求める
連結角演算装置と、前記撮影されたトレーラ後端画像
が、水平方向視野角内の予め設定した内方向回動開始線
および外方向回動開始線に挟まれた範囲からはみ出した
場合、前記モータの回動段数を検出し、トレーラ後端が
該範囲に入るよう、前記標準視野角カメラを回動するモ
ータ駆動部とを具える構成としてもよい。
A standard view angle camera having a horizontal view angle which is not particularly wide is mounted on both sides of a tractor to which a trailer is connected by a rotation connection portion so that a trailing end of the trailer barely enters a photographing view when going straight. A motor for rotating the standard viewing angle camera stepwise in a horizontal direction, and a position in a screen of a trailer trailing end image photographed by the standard viewing angle camera is obtained. Applying to the map representing the correspondence relationship with the connection angle, the connection angle calculation device for obtaining the connection angle, and the photographed trailer trailing end image, the preset inward rotation start line within the horizontal viewing angle and A motor drive unit that rotates the standard viewing angle camera so as to detect the number of rotation stages of the motor and to move the trailer trailing end into the range when the motor is out of the range sandwiched by the outward rotation start lines. Equipment It may be configured.

【0009】(作 用)トラクタ両側にトレーラ後端を
撮影するカメラを設置し、撮影した画像を処理して演算
により連結角を検出するようにしたので、従来のトレー
ラ連結角検出装置に比べてコストが安く、設置するのに
車両に大がかりな改修を加える必要もなく、誤差も少な
い。
(Operation) A camera for photographing the trailer trailing end is installed on both sides of the tractor, and the photographed image is processed to detect the connection angle by calculation. It is inexpensive, does not require major modifications to the vehicle to install, and has few errors.

【0010】[0010]

【発明の実施の形態】以下、本発明の実施形態を図面に
基づいて詳細に説明する。 (第1の実施形態)図2は、本発明の第1の実施形態の
装置を装備した車両の平面図である。図2において、1
はトラクタ、2はトレーラ、3は回動連結部、4,5,
6はトレーラ後端、7,8は広視野角カメラ、9,11
は視野内側限界線、10,12は視野外側限界線、16
はトレーラ後端視線である。トレーラ2は、回動連結部
3においてトラクタ1と連結され、ここを中心として回
動屈曲することが出来る。トレーラ後端4は正確にはト
レーラ2の後端面であり、トレーラ後端5,6は、正確
にはそれぞれトレーラ2の後端面の両方の角であるが、
煩雑を避けるためここではいずれも「トレーラ後端」と
言うことにする。
Embodiments of the present invention will be described below in detail with reference to the drawings. (First Embodiment) FIG. 2 is a plan view of a vehicle equipped with the device of the first embodiment of the present invention. In FIG. 2, 1
Is a tractor, 2 is a trailer, 3 is a rotary connection, 4, 5,
6 is the trailer trailing edge, 7 and 8 are wide viewing angle cameras, 9 and 11
Is the inner limit line of the visual field, 10 and 12 are the outer limit line of the visual field, 16
Is a trailer rear end line of sight. The trailer 2 is connected to the tractor 1 at a rotation connection portion 3 and can be rotated and bent about this. The trailer trailing end 4 is exactly the trailing end of the trailer 2, and the trailer trailing ends 5, 6 are exactly the two corners of the trailer 2 trailing end, respectively.
In order to avoid complication, the term “trailer trailing end” is used herein.

【0011】広視野角カメラ7,8は、トラクタ車両の
側面後方のトレーラ後端5,6を撮影するために設けら
れたカメラであり、トラクタ1の左右両側に取り付けら
れる。左側の広視野角カメラ8は、トレーラ2の左側後
端であるトレーラ後端6を撮影するためのものであり、
図示するように、直進時のトレーラ後端6をかろうじて
撮影できるように取り付けられる。そして、トレーラ2
の想定される屈曲時におけるトレーラ後端6も撮影でき
るようにするため、使用するカメラは、少なくとも水平
方向視野角が広い広視野角のものとされる。
The wide viewing angle cameras 7 and 8 are cameras provided for photographing trailer rear ends 5 and 6 on the rear side of the tractor vehicle, and are mounted on the left and right sides of the tractor 1. The left wide viewing angle camera 8 is for photographing the trailer rear end 6 which is the left rear end of the trailer 2,
As shown in the figure, the trailer 6 is mounted so that the trailer rear end 6 when barely moving can be barely photographed. And Trailer 2
In order to capture an image of the trailer rear end 6 at the time of the assumed bending, the camera to be used has a wide viewing angle having a wide horizontal viewing angle at least.

【0012】図で具体的に説明すると、広視野角カメラ
8の水平方向の視野は、視野内側限界線11から視野外
側限界線12までの間であり、その2つの線の成す角δ
Mが視野角である。従って、視野内側限界線11が、直
進時のトレーラ後端6より僅かに内側となるように広視
野角カメラ8を設置すると共に、視野外側限界線12
は、トレーラ2が通常想定し得る程に屈曲した時のトレ
ーラ後端6の位置よりも、なお外側に位置するような広
視野角のカメラを使用する。なお、トレーラ後端視線1
6は、広視野角カメラ8がトレーラ後端6を見る視線で
ある。
More specifically, the view in the horizontal direction of the wide view angle camera 8 is between the inside view limit line 11 and the outside view limit line 12, and the angle δ formed by the two lines.
M is the viewing angle. Therefore, the wide viewing angle camera 8 is installed so that the visual field inner limit line 11 is slightly inside the trailer rear end 6 when traveling straight, and the visual field outer limit line 12 is set.
Uses a camera with a wide viewing angle such that the trailer 2 is still located outside the trailer trailing end 6 when the trailer 2 is bent as normally expected. In addition, trailer rear end line of sight 1
Reference numeral 6 denotes a line of sight when the wide viewing angle camera 8 looks at the trailing end 6 of the trailer.

【0013】広視野角カメラ7についても、トレーラ後
端5に対して同様のものとする。なお、広視野角カメラ
7,8の取り付けは、サイドミラーの取付具を利用して
行ってもよいし、専用の取付具によって行ってもよい。
図3は、本発明の第1の実施形態の装置を装備した車両
の側面図である。符号は図2のものに対応し、13は連
結角演算装置、14は視野下側限界線、15は視野上側
限界線である。広視野角カメラ8(7)で撮影されたト
レーラ後端6(5)を含む画像は、連結角演算装置13
に送られ、ここで演算されて連結角が求められる。
The same applies to the wide-viewing-angle camera 7 with respect to the trailer rear end 5. The wide viewing angle cameras 7 and 8 may be mounted using a side mirror mounting tool or a dedicated mounting tool.
FIG. 3 is a side view of a vehicle equipped with the device according to the first embodiment of the present invention. Reference numerals correspond to those in FIG. 2, 13 is a connection angle calculation device, 14 is a lower limit line of the visual field, and 15 is an upper limit line of the visual field. The image including the trailer trailing end 6 (5) taken by the wide-viewing-angle camera 8 (7) is
To calculate the connection angle.

【0014】図4は、本発明の第1の実施形態で、トレ
ーラが屈曲した状態を示す図である。符号は図2のもの
に対応し、1Cはトラクタ1の中心線、2Cはトレーラ
2の中心線、θはトラクタ1とトレーラ2との連結角、
δtは視野内側限界線11とトレーラ後端視線16との
成す角である。広視野角カメラ8で撮影した画像を想定
した場合、画像の左端には視野内側限界線11上の景色
が映り、画像の右端には視野外側限界線12上の景色が
映ることになる。そして、左端から右端までの広がり
は、角度で考えれば視野角δMである。従って、トレー
ラ後端6が映っている画面上の位置を左端から測れば、
δtを求めることが出来る。本発明では、こうして求め
たδtを基に、連結角θを算出する。何故δtからθを
算出することが出来るのかの説明は、図1を参照しつつ
後で行う。
FIG. 4 shows a first embodiment of the present invention.
It is a figure showing the state where the roller was bent. The code is that of FIG.
1C is the center line of the tractor 1 and 2C is the trailer
2 is the center line, θ is the connection angle between the tractor 1 and the trailer 2,
δtBetween the line of sight inside limit line 11 and the trailer rear end line of sight 16
It is the angle to make. Assume images taken with wide viewing angle camera 8
If you do, the scene on the inner limit line 11
And the scenery on the outer limit line 12 is on the right end of the image.
Will be reflected. And the spread from the left end to the right end
Is the viewing angle δMIt is. Therefore, the tray
If you measure the position on the screen where the rear end 6 is reflected from the left end,
δtCan be requested. In the present invention,
ΔtIs calculated on the basis of. Why δtTo θ
An explanation of whether the calculation can be made will be made with reference to FIG.
I will do it later.

【0015】図5は、本発明の第1の実施形態における
撮影画面を示す図である。これは広視野角カメラ8の撮
影画面であり、符号は図4のものに対応し、20は撮影
画面を指す。画面の横方向は、画像内角度δを表してお
り、左端(視野内側限界線11に対応)の角度は0度で
あり、右端(視野外側限界線12に対応)の角度は、広
視野角カメラ8の視野角δMである。図5(1)は、ト
ラクタ車両が図2のように直進状態にある場合の撮影画
面20であり、トレーラ後端6は、画面の左端近くに映
っている。図5(2)は、トラクタ車両が図4のように
屈曲状態にある場合の撮影画面20であり、トレーラ後
端6は、画面の右端近くに映っている。これらの画面内
におけるトレーラ後端6の画像位置を知ることにより、
トレーラ後端6の画像内角度δtを求めることが出来
る。このようにしてδtを求めると、次のようにして連
結角θを算出することが出来る。
FIG. 5 is a view showing a photographing screen according to the first embodiment of the present invention. This is a shooting screen of the wide viewing angle camera 8, and the reference numerals correspond to those in FIG. 4, and reference numeral 20 denotes a shooting screen. The horizontal direction of the screen represents the angle δ in the image, the angle at the left end (corresponding to the inner limit line 11 of the visual field) is 0 °, and the angle at the right end (corresponding to the outer limit line 12 of the visual field) is the wide viewing angle. a viewing angle δM of the camera 8. FIG. 5A shows a photographing screen 20 when the tractor vehicle is in a straight-ahead state as shown in FIG. 2, and the trailer rear end 6 is shown near the left end of the screen. FIG. 5B shows the photographing screen 20 when the tractor vehicle is in a bent state as shown in FIG. 4, and the trailer rear end 6 is shown near the right end of the screen. By knowing the image position of the trailer rear end 6 in these screens,
Can be obtained an image within an angle [delta]t of the trailer rear end 6. Thus to determine the [delta]t, it can be calculated connecting angle θ as follows.

【0016】図1は、本発明で連結角θが検出される理
由を説明する図である。符号は図4のものに対応し、O
は座標の原点、XはX軸、YはY軸、2−1は直進状態
のトレーラ、2−2は屈曲状態のトレーラを示してい
る。直進状態にあるトラクタ車両の中心線をX軸とし、
広視野角カメラ7,8(のレンズ)を結ぶ直線をY軸と
し、両者の交点を原点Oとしている。17は、広視野角
カメラ8より、X軸に平行に引いた直線である。その他
の符号の意味は、次の通りである。
FIG. 1 is a diagram for explaining the reason why the connection angle θ is detected in the present invention. The symbols correspond to those in FIG.
Is the coordinate origin, X is the X axis, Y is the Y axis, 2-1 is a trailer in a straight traveling state, and 2-2 is a trailer in a bent state. The center line of the tractor vehicle in the straight traveling state is set as the X axis,
A straight line connecting the wide-viewing angle cameras 7 and 8 (the lens thereof) is defined as a Y-axis, and an intersection between the two is defined as an origin O. Reference numeral 17 denotes a straight line drawn by the wide viewing angle camera 8 in parallel with the X axis. The meanings of the other symbols are as follows.

【0017】a…回動連結部3とトレーラ後端4との距
離 d…原点Oと回動連結部3との距離 h…原点Oと広視野角カメラ7(8)との距離 w…トレーラ後端4の幅の半分 A…回動連結部3とトレーラ後端6との距離。つまり√
(a2+w2) φ…回動連結部3とトレーラ後端6とを結ぶ直線が、ト
レーラ2−2の中心線と成す角。これはトレーラの形に
よって自ずと定まる角。 X6…回動連結部3とトレーラ後端6とのX軸方向距離 Y6…回動連結部3とトレーラ後端6とのY軸方向距離 H…トレーラ後端6よりX軸に降ろした垂線の足 G…広視野角カメラ8より直線6Hに降ろした垂線の足 T…X軸と直進時のトレーラ後端4との交点 δk…直線17とトレーラ後端視線16との成す角 δs…直線17と視野内側限界線11との成す角。広視
野角カメラ8の設置時に定まる角。 δt…視野内側限界線11とトレーラ後端視線16との
成す角
A: the distance between the turning connection 3 and the trailer rear end 4 d: the distance between the origin O and the turning connection 3 h: the distance between the origin O and the wide viewing angle camera 7 (8) w: the trailer Half of the width of the rear end 4 A: The distance between the rotary connecting portion 3 and the trailer rear end 6. That is,
(A2 + w2 ) φ: The angle formed by the straight line connecting the rotary connecting portion 3 and the trailer rear end 6 with the center line of the trailer 2-2. This is a corner naturally determined by the shape of the trailer. X6 : Distance in the X-axis direction between the rotation connection portion 3 and the trailer rear end 6 Y6 ... Distance in the Y-axis direction between the rotation connection portion 3 and the trailer rear end 6 H: Lowered from the trailer rear end 6 to the X axis. Perpendicular foot G: Perpendicular foot lowered from the wide viewing angle camera 8 to the straight line 6H T: Intersection between the X axis and the trailer trailing end 4 when traveling straight δk ... Angle between the straight line 17 and the trailer trailing end line of sight δs : Angle formed by the straight line 17 and the visual field inner limit line 11. The angle determined when the wide viewing angle camera 8 is installed. angle between the [delta]t ... and the viewing inner limit line 11 trailer rear sight 16

【0018】図中のδkが属する直角3角形に注目する
と、次式が成り立つ。 tan δk=(Y6−h)/(d+X6) 従って、 δk=arctan{(Y6−h)/(d+X6)} …(1) またδk,δt,δsの間には、図より明らかなように、次式の関係がある。 δk=δt−δs …(2) 一方、△6H3に注目すると、次式が成り立つ。 X6=A・cos(θ+φ) …(3) Y6=A・sin(θ+φ) …(4) (2),(3),(4)式を(1)に代入すると、次式が得られる。 δt=arctan[{A・sin(θ+φ) −h}/{d+A・cos(θ+φ) }]+δs …(5)
Referring to the right-angled triangle to which δk belongs, the following equation is established. tan δk = (Y6 −h) / (d + X6 ) Therefore, δk = arctan {(Y6 −h) / (d + X6 )} (1) and between δk , δt , and δs Has the following relationship, as is clear from the figure. δk = δt −δs (2) On the other hand, when attention is paid to △ 6H3, the following equation is established. X6 = A · cos (θ + φ) (3) Y6 = A · sin (θ + φ) (4) By substituting the equations (2), (3) and (4) into (1), the following equation is obtained. Can be δt = arctan [{A · sin (θ + φ) −h} / {d + A · cos (θ + φ)}] + δs (5)

【0019】(5)式の中で、A,φ,h,d,δs
既知の値であり、未知の値はδtとθだけである。従っ
て、δtをいろいろな値に変えてみて、それらの値に対
応して(5)式を満たすようなθの値を求めることが出
来る。即ち、δtとθとの対応関係を表すマップを、予
め作成しておくことが出来る。図6は、そのようにして
作成したマップであり、縦軸はトレーラ後端6の画像内
角度δtであり、横軸は連結角θである。曲線イは、δ
tとθとの対応関係を示す曲線である。縦方向の幅が視
野角に相当するが、第1の実施形態では、広視野角カメ
ラを用いているので、この幅は広い。
In equation (5), A, φ, h, d, δs are known values, and the only unknown values are δt and θ. Therefore, by changingδt to various values, it is possible to obtain a value of θ that satisfies the expression (5) corresponding to those values. That is, a map representing the correspondence betweenδt and θ can be created in advance. Figure 6 is a map created in this way, the vertical axis indicates the image angle [delta]t of the trailer rear end 6, the horizontal axis is the connecting angle theta. Curve b is δ
6 is a curve showing the correspondence betweent and θ. The width in the vertical direction corresponds to the viewing angle. In the first embodiment, since the wide viewing angle camera is used, the width is wide.

【0020】ところで、図5で説明したように、トレー
ラ後端6の画像内角度であるδtは、広視野角カメラ8
で撮影した画面より求めることが出来るから、そうして
求めたδtを図6のマップに適用することにより、連結
角θを得ることが出来る。例えば、撮影画面より求めた
トレーラ後端6の画像内角度がδt1であったとすると、
図6のマップにそれを適用して、連結角はθ1と求める
ことが出来る。
By the way, as described with reference to FIG. 5, the angle δt in the image of the trailer rear end 6 is determined by the wide viewing angle camera 8.
In because it can be obtained from the captured screen, thus by applying the obtained [delta]t in the map of FIG. 6, it is possible to obtain a connecting angle theta. For example, if the image angle of the trailer rear end 6 determined from the shooting screen is assumed to be a [delta]t1,
Applying it to the map of FIG. 6, the connection angle can be determined as θ1 .

【0021】図7は、本発明の第1の実施形態のブロッ
ク構成を示す図であり、7,8は広視野角カメラ、13
は連結角演算装置、21は画像メモリ、22は画像処理
部、23は演算部である。広視野角カメラ7,8で撮影
された画像データは、まず画像メモリ21に記憶され
る。次に画像処理部22へ送られ、ここで微分処理,エ
ッジ処理,2値化処理等が行われる。このような処理技
術は、既に公知である(例えば、特開平7−220194号公
報参照)。最後の演算部23では、トレーラ後端部形状
判定,トレーラ後端位置の角度検出(画像内角度検
出),連結角演算等が行われ、連結角θが求められる。
FIG. 7 is a diagram showing a block configuration of the first embodiment of the present invention.
Denotes a connection angle calculation device, 21 denotes an image memory, 22 denotes an image processing unit, and 23 denotes a calculation unit. Image data captured by the wide-view cameras 7 and 8 is first stored in the image memory 21. Next, the image data is sent to the image processing unit 22, where differentiation processing, edge processing, binarization processing, and the like are performed. Such a processing technique is already known (for example, see JP-A-7-220194). In the last computing unit 23, the trailer trailing end shape determination, the detection of the trailer trailing end position angle (detection of the angle in the image), the connection angle calculation, and the like are performed, and the connection angle θ is obtained.

【0022】図8は、前記連結角演算装置での動作を説
明するフローチャートである。 ステップ1…トレーラ後端6(5)が認識できたかどう
かチェックする。トレーラ後端の認識は、エッジ処理等
を施した後の画像の中に、トレーラ後端の画像ならば有
している筈の特徴を具えている部分があるかどうかを点
検することにより、行うことが出来る。 ステップ2…トレーラ後端6(5)が認識できた場合
は、撮影画面より、その時のトレーラ後端の画像内角度
δtを検出する(図5参照)。 ステップ3…トレーラ後端の画像内角度δtが検出され
れば、これを連結角θを求めるマップに適用して、その
時の連結角θを求めることが出来る。 ステップ4…ステップ1でトレーラ後端が認識できなか
った場合には、連結角の検出は出来ないことを警報する
(例えば、そのことを画面上に表示したり、ブザーを鳴
らしたりする。)。
FIG. 8 is a flowchart for explaining the operation of the connection angle calculation device. Step 1: Check whether the trailer trailing end 6 (5) has been recognized. Recognition of the trailer trailing edge is performed by checking whether or not the image after the edge processing or the like has a portion having the features that the trailer trailing edge image should have. I can do it. Step 2 ... when the trailer rear end 6 (5) can be recognized, from the photographing screen, and detects the image angle [delta]t of the trailer rear end of that time (see Figure 5). Step 3: If the angle δt in the image at the trailing end of the trailer is detected, the angle δt is applied to a map for obtaining the connection angle θ, and the connection angle θ at that time can be obtained. Step 4: If the trailer trailing end cannot be recognized in step 1, it is warned that the connection angle cannot be detected (for example, the fact is displayed on a screen or a buzzer sounds).

【0023】(第2の実施形態)図9は、本発明の第2
の実施形態の装置を装備した車両の平面図である。符号
は図2のものに対応し、30,31は標準視野角カメ
ラ、32は内方向回動開始線、33は外方向回動開始線
である。図2の第1の実施形態と相違する第1の点は、
トラクタ1の両側に設置するカメラを、広視野角カメラ
ではなく、それより視野角δMが小さい標準視野角カメ
ラとした点である。一般に、標準視野角カメラの方が、
広視野角カメラよりコストが安い。第2の相違点は、視
野内側限界線11よりも少し外側に内方向回動開始線3
2を設定し、視野外側限界線12よりも少し内側に外方
向回動開始線33を設定したという点である。
(Second Embodiment) FIG. 9 shows a second embodiment of the present invention.
It is a top view of the vehicles equipped with the device of an embodiment. The reference numerals correspond to those in FIG. 2, 30 and 31 are standard viewing angle cameras, 32 is an inward rotation start line, and 33 is an outward rotation start line. A first point different from the first embodiment of FIG.
A camera installed on both sides of the tractor 1, rather than the wide viewing angle camera, is that from the viewing angle [delta]M it was smaller standard viewing angle camera. Generally, the standard viewing angle camera is
Lower cost than wide viewing angle camera. The second difference is that the inward rotation start line 3 is located slightly outside the visual field inner limit line 11.
2 is set, and the outward rotation start line 33 is set slightly inside the visual field outer limit line 12.

【0024】図10は、本発明の第2の実施形態の装置
を装備した車両の側面図である。符号は図3のものに対
応し、34はモータ、35はモータ駆動部である。モー
タ34は、標準視野角カメラ31を水平方向の段階的位
置に何段階かに回動させるために設けられている。モー
タ駆動部35は、モータ34の駆動を制御する。反対側
の標準視野角カメラ30にも、同様のモータ,モータ駆
動部が設けられる。標準視野角カメラは視野角が狭いの
で、トレーラが大きく屈曲した場合には、トレーラ後端
が視野の外に出てしまうことが考えられる。そこで、そ
の場合には、トレーラ後端を追っ掛けて標準視野角カメ
ラを回動させ、視野の中に納まるようにする必要があ
る。図9の内方向回動開始線32や外方向回動開始線3
3は、その回動の開始を決めるために設定されたもので
ある。
FIG. 10 is a side view of a vehicle equipped with the device according to the second embodiment of the present invention. Reference numerals correspond to those in FIG. 3, reference numeral 34 denotes a motor, and reference numeral 35 denotes a motor drive unit. The motor 34 is provided for rotating the standard viewing angle camera 31 to a horizontal stepwise position in several steps. The motor driving unit 35 controls driving of the motor 34. The opposite standard viewing angle camera 30 is also provided with a similar motor and motor drive unit. Since the standard viewing angle camera has a narrow viewing angle, it is conceivable that the trailing end of the trailer goes out of the field of view when the trailer is greatly bent. Therefore, in such a case, it is necessary to rotate the standard viewing angle camera while following the trailing end of the trailer so that the trailing end of the trailer trails the trailer. The inward rotation start line 32 and the outward rotation start line 3 in FIG.
Numeral 3 is set to determine the start of the rotation.

【0025】図9に戻るが、トラクタ1に対してトレー
ラ2が屈曲していない状態(直進状態)では、当然のこ
とながらモータは全く回動させられていない。つまり、
カメラ回動段数は0の状態にあるが、この状態で、トレ
ーラ後端(5,6)がそれぞれの側の内方向回動開始線
よりも僅かに外側に位置するように、内方向回動開始線
(32等)は設定される。そして、各カメラは、回動段
数0の状態から内方へは、回動しないようにされてい
る。なぜなら、トレーラ2が屈曲した結果、一方のカメ
ラがトレーラ後端を撮影できなくなっても、反対側のカ
メラはそれと同じ側のトレーラ後端を撮影でき、連結角
の検出は出来るからである。
Referring back to FIG. 9, when the trailer 2 is not bent with respect to the tractor 1 (straight running state), the motor is naturally not rotated at all. That is,
Although the number of camera rotation steps is zero, in this state, the trailer trailing end (5, 6) is rotated inward so that the trailing end (5, 6) is located slightly outside the inward rotation start line on each side. A start line (such as 32) is set. Each camera is configured not to rotate inward from the state where the number of rotation stages is zero. This is because even if one of the cameras cannot capture the trailer trailing edge as a result of the trailer 2 bending, the opposite camera can capture the trailer trailing edge on the same side and detect the connection angle.

【0026】図11は、カメラ回動制御を説明する図で
ある。図11(1)は、トラクタ1に対してトレーラ2
が屈曲していない状態(直進状態)を示している(図9
と同じ)。図11(2)は、トレーラ2が大きく屈曲
し、トレーラ後端6が外方向回動開始線33より外へは
み出した状態を示している。このようになると、トレー
ラ後端6が外方向回動開始線33より外へ出たというこ
とが撮影画面で検知され、標準視野角カメラ31は、1
段階外方へ回動される。
FIG. 11 is a diagram for explaining camera rotation control. FIG. 11A shows a trailer 2 with respect to the tractor 1.
9 is not bent (straight running state) (FIG. 9).
Same as). FIG. 11B shows a state in which the trailer 2 is largely bent, and the trailer rear end 6 protrudes outside the outward rotation start line 33. In this case, it is detected on the photographing screen that the trailer rear end 6 has moved out of the outward rotation start line 33, and the standard viewing angle camera 31
It is pivoted out of the step.

【0027】図11(3)は、1段階外方へ回動された
状態を示している。カメラを回動した結果、トレーラ後
端6は、内方向回動開始線32と外方向回動開始線33
に挟まれた範囲内に位置するようになっている。図11
(4)は、大きく屈曲していたトレーラ2が元に戻りつ
つある過程において、トレーラ後端6が内方向回動開始
線32より内側にはみ出した状態を示している。このよ
うになると、トレーラ後端6が内方向回動開始線32よ
り内側へはみ出したということが撮影画面で検知され、
標準視野角カメラ31は、1段階内方へ回動されること
になる。
FIG. 11 (3) shows a state in which it has been pivoted outward by one step. As a result of rotating the camera, the trailer trailing end 6 has an inward rotation start line 32 and an outward rotation start line 33.
It is located within the range sandwiched between. FIG.
(4) shows a state in which the trailer rear end 6 protrudes inward from the inward rotation start line 32 in a process in which the trailer 2 that has largely bent is returning to its original position. In this case, it is detected on the photographing screen that the trailer rear end 6 protrudes inward from the inward rotation start line 32,
The standard viewing angle camera 31 is rotated inward by one step.

【0028】図12は、本発明の第2の実施形態におけ
る撮影画面を示す図である。符号は図5のものに対応
し、δbは内方向回動開始線32に対応する角度、δf
は外方向回動開始線33に対応する角度である(δb
δfは、いずれも画面左端に対応する視野内側限界線1
1から計った画像内角度)。図5で説明したように、こ
の撮影画面より、トレーラ後端6(5)の画像内角度δ
tを検出することが出来る。図12(1)は、トレーラ
後端6は内方向回動開始線32より僅かに外側に位置し
ており、図11(1)の場合に対応する撮影画面を示し
ている。図12(2)は、トレーラ後端6が外方向回動
開始線33より僅かに外側に位置しており、図11
(2)の場合に対応する撮影画面を示している。
FIG. 12 is a view showing a photographing screen according to the second embodiment of the present invention. The reference numerals correspond to those in FIG. 5, δb is the angle corresponding to the inward rotation start line 32, δf
Is an angle corresponding to the outward rotation start line 33 (δb ,
δf is the visual field inner limit line 1 corresponding to the left edge of the screen.
Angle in image measured from 1). As described with reference to FIG. 5, from this photographing screen, the image angle δ of the trailer rear end 6 (5) is obtained.
t can be detected. FIG. 12A shows a shooting screen corresponding to the case of FIG. 11A, in which the trailer rear end 6 is located slightly outside the inward rotation start line 32. FIG. 12B shows that the trailer rear end 6 is located slightly outside the outward rotation start line 33.
The photographing screen corresponding to the case (2) is shown.

【0029】図13は、本発明の第2の実施形態での連
結角θを求めるマップである。縦軸はトレーラ後端の画
像内角度δtであり、横軸は連結角θである。曲線イは
カメラ回動段数0の場合の曲線であり、曲線ロ,ハはそ
れぞれカメラ回動段数1,2の場合の曲線である。即
ち、標準視野角カメラが1段回動されている状態では、
カメラ回動段数1の曲線ロを利用して連結角θを求め、
2段回動されている状態では、カメラ回動段数2の曲線
ハを利用して連結角θを求める。例えば、カメラを1段
回動している状態で、撮影画面よりトレーラ後端6の画
像内角度がδt1と検出されたとすると、図13に示すよ
うに、δt1の直線と曲線ロの交点の横軸の値θ1を読み
取ることにより、連結角を求めることが出来る。
FIG. 13 is a map for obtaining the connection angle θ according to the second embodiment of the present invention. The vertical axis is the image angle [delta]t of the trailer rear end, the horizontal axis is the connecting angle theta. Curve A is a curve when the number of camera rotation steps is 0, and curves B and C are curves when the number of camera rotation steps is 1 and 2, respectively. That is, when the standard viewing angle camera is rotated by one stage,
The connection angle θ is obtained by using the curve b having the number of camera rotation stages of 1,
In the state where the camera is rotated two steps, the connection angle θ is obtained by using the curve C having two camera rotation steps. For example, when the angle in the image of the trailer rear end 6 is detected as δt1 from the photographing screen while the camera is rotated by one stage, as shown in FIG. 13, the intersection of the straight line of δt1 and the curve B is obtained. By reading the value θ1 on the horizontal axis, the connection angle can be obtained.

【0030】なお、カメラの段階的回動は、視野が1つ
前の視野と相当重なるように行うので、曲線イ〜ハの横
軸方向の相当部分は、隣りの曲線と重なっている。画像
内角度δbの横軸方向の点線は、内方向回動開始線32
に対応する角度を示しており、画像内角度δfの横軸方
向の点線は、外方向回動開始線33に対応する角度を示
している。
Since the camera is rotated stepwise so that the field of view substantially overlaps with the immediately preceding field of view, a substantial portion of the curves A to C in the horizontal axis direction overlaps with the adjacent curve. The horizontal axis direction of the dotted line in the image angle [delta]b is inwardly rotated the start line 32
Indicates the angle corresponding, horizontal axis direction of the dotted line in the image angle [delta]f indicates the angle corresponding to the outward rotation starting line 33.

【0031】図15は、本発明の第2の実施形態のブロ
ック構成を示す図である。符号は図7に対応し、24は
モータ駆動回路、25は回動段数検出部、30は標準視
野角カメラ、34はモータ、35はモータ駆動部である
(反対側のカメラ31についても、同様の構成が設けら
れる。)。回動段数検出部25は、段階的に回動させら
れるモータ34が、何段目に回動されているかを検出す
る。画像メモリ21,画像処理部22の動作は図7のも
のと同様である。演算部23は、図7のものと同様の動
作をして連結角θを求める他に、回動段数検出部25か
らの回動段数信号に応じ、モータ駆動回路24に駆動信
号を発するという動作もする。
FIG. 15 is a diagram showing a block configuration of the second embodiment of the present invention. The reference numerals correspond to those in FIG. 7, 24 is a motor drive circuit, 25 is a rotation stage number detecting unit, 30 is a standard viewing angle camera, 34 is a motor, and 35 is a motor drive unit (the same applies to the camera 31 on the opposite side). Is provided.). The number-of-rotational-stages detecting section 25 detects at which stage the motor 34 that is rotated stepwise is rotated. The operations of the image memory 21 and the image processing unit 22 are the same as those in FIG. The operation unit 23 obtains the connection angle θ by performing the same operation as that of FIG. 7, and also issues a drive signal to the motor drive circuit 24 in response to the rotation stage number signal from the rotation stage number detection unit 25. I will.

【0032】図14は、本発明の第2の実施形態での動
作を説明するフローチャートである。 ステップ1…トレーラ後端6(5)が認識できたかどう
かチェックする。 ステップ2…認識できた場合は、回動段数検出部25か
らの検出信号により、カメラ回動段数Nを知る。 ステップ3…撮影画面より、トレーラ後端の画像内角度
δtを検出する。 ステップ4…検出した画像内角度δtが、内方向回動開
始線32に対応する角度δbより大で、且つ外方向回動
開始線33に対応する角度δfより小かをチェックす
る。つまり、トレーラ後端が、内方向回動開始線と外方
向回動開始線との間に挟まれた視野内(以下「回動開始
線間視野内」という)にあるかどうかを、チェックす
る。 ステップ5…回動開始線間視野内にあれば、連結角を求
めるマップ(図13)における回動段数Nに対応した曲
線により、連結角θを求める。同じ回動開始線間視野内
にある間は、ステップ3,4,5を循環しながら、マッ
プの同じ曲線を使って連結角θの検出を行う(この回動
開始線間視野から外れると、ステップ6へと抜けてゆ
く)。
FIG. 14 is a flowchart for explaining the operation in the second embodiment of the present invention. Step 1: Check whether the trailer trailing end 6 (5) has been recognized. Step 2: If the recognition is successful, the camera rotation stage number N is known from the detection signal from the rotation stage number detection unit 25. From Step 3 ... shooting screen, it detects an image within an angle [delta]t of the trailer rear end. Step 4 ... detected image within an angle [delta]t is large than the angle [delta]b corresponding inwardly turning start line 32, and checks smaller than or corresponding angle [delta]f outward rotation starting line 33. That is, it is checked whether the trailer trailing end is within the visual field sandwiched between the inward rotation start line and the outward rotation start line (hereinafter, referred to as “the rotation start line visual field”). . Step 5: If it is within the rotation start line visual field, the connection angle θ is obtained from a curve corresponding to the number of rotation steps N in the map (FIG. 13) for obtaining the connection angle. While in the same rotation start line visual field, the connection angle θ is detected using the same curve of the map while circulating through steps 3, 4, and 5 (when deviating from this rotation start line visual field, Step 6).

【0033】ステップ6…ステップ4で、トレーラ後端
が、内方向回動開始線と外方向回動開始線との間に挟ま
れた視野内にはない場合には、δt>δfかどうか調べ
る。 ステップ7…δt>δfであれば、トレーラ後端が外方
向回動開始線の外側へはみ出しているということであ
る。そこで、それを視野に納めるべく、モータ駆動回路
24へ駆動信号を送り、カメラを1段外方へ回動する。
そして、ステップ1に戻り、いままでの動作を繰り返
す。 ステップ8…ステップ6でNOの場合は、ステップ4で
NOだったことも併せ考慮すれば、結局、δt≦δb
いうことである。これは、トレーラ後端が、内方向回動
開始線の線上に位置しているか、それより内側に位置し
ているということである。この場合には、回動段数が0
かどうかチェックする。 ステップ9…回動段数が0であれば、それ以上内側には
回動出来ないから、マップの0段曲線(図13の曲線
イ)によって連結角θを求める。 ステップ10…ステップ8で回動段数が0でなければ、
モータ駆動回路24へ駆動信号を送り、1段内方へ回動
する。そして、ステップ1に戻り、いままでの動作を繰
り返す。
Step 6: If the trailer trailing end is not located within the visual field sandwiched between the inward rotation start line and the outward rotation start line in step 4, δt > δf Find out. Step 7: If δt > δf , it means that the trailing end of the trailer protrudes outside the outward rotation start line. Then, in order to put it in the field of view, a drive signal is sent to the motor drive circuit 24 to rotate the camera one step outward.
Then, the process returns to step 1 and repeats the operation up to now. Step 8... If NO in step 6, considering that NO in step 4, it follows that δt ≦ δb . This means that the trailer rear end is located on the line of the inward rotation start line or is located inside the line. In this case, the number of rotation stages is 0
Check if it is. Step 9: If the number of rotation steps is 0, it is not possible to turn any further inwards, so the connection angle θ is determined from the 0-step curve (curve a in FIG. 13) of the map. Step 10: If the number of rotation steps is not 0 in step 8,
A drive signal is sent to the motor drive circuit 24 to rotate one stage inward. Then, the process returns to step 1 and repeats the operation up to now.

【0034】ステップ11…ステップ1で、撮影画面で
トレーラ後端が認識できなかった場合には、モータ駆動
回路24へ駆動信号を送り、いったんカメラを外方へ最
大段数まで回動する。 ステップ12…そして、トレーラ後端が認識できたかど
うかチェックする。認識できた場合は、ステップ2に戻
り、前記したフローに従って連結角θの検出を行う。 ステップ13…ステップ12で認識できなかった場合
は、回動段数検出部25からの検出信号により、回動段
数Nを検知する。 ステップ14…検知した回動段数が、0段であるかどう
かチェックする。 ステップ15…0段でない場合は、1段内方へ回動す
る。そして、ステップ12に戻り、同様の動作を繰り返
す。
Step 11: If the trailer trailing end cannot be recognized on the photographing screen in step 1, a drive signal is sent to the motor drive circuit 24, and the camera is once turned outward to the maximum number of steps. Step 12: It is checked whether the trailer trailing end has been recognized. If the recognition is successful, the process returns to step 2, and the connection angle θ is detected according to the above-described flow. Step 13: If the recognition is not possible in step 12, the number N of rotation steps is detected based on the detection signal from the number-of-rotation-steps detection unit 25. Step 14: It is checked whether or not the detected number of rotation steps is zero. Step 15: If the gear is not the 0th gear, the gear rotates inward by 1 gear. Then, the process returns to step 12, and the same operation is repeated.

【0035】ステップ16…ステップ14で、回動段数
が0段であった場合、もはやそれより内側へは回動でき
ないから、このカメラはそのままの状態を保持する。 ステップ17…反対側のカメラで、そのカメラ側のトレ
ーラ後端を認識できているか調べる。出来ていればステ
ップ1に戻り、前記したフローに従って連結角θの検知
を行う。 ステップ18…反対側のカメラでもトレーラ後端が認識
できないという場合は、トレーラ連結角検出装置が故障
していることを警報する。なぜなら、正常ならば、いず
れかのカメラでトレーラ後端が認識できている筈だから
である。
Step 16: If the number of rotation steps is 0 in step 14, the camera can no longer be rotated inward, so that the camera maintains its state. Step 17: It is checked whether or not the trailing end of the trailer of the camera on the opposite camera can be recognized. If it is completed, the process returns to step 1, and the connection angle θ is detected according to the above-described flow. Step 18: If the trailing end of the trailer cannot be recognized by the camera on the opposite side, a warning is given that the trailer connection angle detecting device is out of order. This is because, if normal, the trailer trailing end should be recognized by one of the cameras.

【0036】[0036]

【発明の効果】以上述べた如く、本発明のトレーラ連結
角検出装置によれば、次のような効果を奏する。 (請求項1の発明の効果)トラクタとトレーラとの連結
角を、トレーラ後端を撮影するカメラと、撮影した画像
を処理して演算する連結角演算装置とを用いて検出する
ようにしたので、従来のトレーラ連結角検出装置に比べ
てコストが安く、設置するのに車両に大がかりな改修を
加える必要もなく、誤差も少ない。
As described above, the trailer connection angle detecting device of the present invention has the following effects. (Advantage of the first aspect of the invention) The connection angle between the tractor and the trailer is detected by using a camera for photographing the trailer rear end and a connection angle calculation device for processing and calculating the photographed image. In addition, the cost is lower than that of the conventional trailer connection angle detecting device, and there is no need to make a major modification to the vehicle for installation, and the error is small.

【0037】(請求項2の発明の効果)請求項1の発明
と同様の効果を奏するほか、使用するカメラとして安価
な標準視野角カメラを使用するので、より一層コストを
安くすることが出来る。
(Effect of the invention of claim 2) In addition to the same effect as the invention of claim 1, the cost can be further reduced because an inexpensive standard viewing angle camera is used as the camera to be used.

【図面の簡単な説明】[Brief description of the drawings]

【図1】 本発明で連結角θが検出される理由を説明す
る図
FIG. 1 is a diagram for explaining the reason why a connection angle θ is detected in the present invention.

【図2】 本発明の第1の実施形態の装置を装備した車
両の平面図
FIG. 2 is a plan view of a vehicle equipped with the device according to the first embodiment of the present invention.

【図3】 本発明の第1の実施形態の装置を装備した車
両の側面図
FIG. 3 is a side view of a vehicle equipped with the device according to the first embodiment of the present invention.

【図4】 本発明の第1の実施形態で、トレーラが屈曲
した状態を示す図
FIG. 4 is a view showing a state in which a trailer is bent in the first embodiment of the present invention.

【図5】 本発明の第1の実施形態における撮影画面を
示す図
FIG. 5 is a diagram showing a shooting screen according to the first embodiment of the present invention.

【図6】 本発明の第1の実施形態での連結角θを求め
るマップ
FIG. 6 is a map for obtaining a connection angle θ according to the first embodiment of the present invention.

【図7】 本発明の第1の実施形態のブロック構成を示
す図
FIG. 7 is a diagram showing a block configuration according to the first embodiment of the present invention;

【図8】 本発明の第1の実施形態での動作を説明する
フローチャート
FIG. 8 is a flowchart illustrating an operation according to the first exemplary embodiment of the present invention.

【図9】 本発明の第2の実施形態の装置を装備した車
両の平面図
FIG. 9 is a plan view of a vehicle equipped with the device according to the second embodiment of the present invention.

【図10】 本発明の第2の実施形態の装置を装備した
車両の側面図
FIG. 10 is a side view of a vehicle equipped with the device according to the second embodiment of the present invention.

【図11】 本発明の第2の実施形態でのカメラ回動制
御を説明する図
FIG. 11 is a diagram illustrating camera rotation control according to a second embodiment of the present invention.

【図12】 本発明の第2の実施形態における撮影画面
を示す図
FIG. 12 is a diagram illustrating a shooting screen according to a second embodiment of the present invention.

【図13】 本発明の第2の実施形態での連結角θを求
めるマップ
FIG. 13 is a map for obtaining a connection angle θ according to the second embodiment of the present invention.

【図14】 本発明の第2の実施形態での動作を説明す
るフローチャート
FIG. 14 is a flowchart illustrating an operation according to the second embodiment of the present invention.

【図15】 本発明の第2の実施形態のブロック構成を
示す図
FIG. 15 is a diagram showing a block configuration according to a second embodiment of the present invention.

【符号の説明】[Explanation of symbols]

1…トラクタ、2…トレーラ、3…回動連結部、4,
5,6…トレーラ後端、7,8…広視野角カメラ、9,
11…視野内側限界線、10,12…視野外側限界線、
13…連結角演算装置、14…視野下側限界線、15…
視野上側限界線、16…トレーラ後端視線、20…撮影
画面、21…画像メモリ、22…画像処理部、23…演
算部、24…モータ駆動回路、25…回動段数検出部、
30,31…標準視野角カメラ、32…内方向回動開始
線、33…外方向回動開始線、34…モータ、35…モ
ータ駆動部
DESCRIPTION OF SYMBOLS 1 ... Tractor, 2 ... Trailer, 3 ... Rotation connection part, 4,
5, 6 ... trailer trailing edge, 7, 8 ... wide viewing angle camera, 9,
11 ... limit line inside the field of view, 10, 12 ... limit line outside the field of view,
13: Connection angle calculation device, 14: Lower limit line of view, 15:
Upper limit line of view, 16: Trailer rear end line of sight, 20: Shooting screen, 21: Image memory, 22: Image processing unit, 23: Operation unit, 24: Motor drive circuit, 25: Rotating step number detection unit,
30, 31: standard viewing angle camera, 32: inward rotation start line, 33: outward rotation start line, 34: motor, 35: motor drive unit

フロントページの続き Fターム(参考) 2F065 AA31 BB05 BB15 BB16 CC11 FF04 FF09 FF61 JJ03 JJ05 JJ19 JJ26 PP01 PP05 QQ04 QQ13 QQ24 QQ25 QQ26 QQ27 QQ28 QQ32Continued on front page F-term (reference) 2F065 AA31 BB05 BB15 BB16 CC11 FF04 FF09 FF61 JJ03 JJ05 JJ19 JJ26 PP01 PP05 QQ04 QQ13 QQ24 QQ25 QQ26 QQ27 QQ28 QQ32

Claims (2)

Translated fromJapanese
【特許請求の範囲】[Claims]【請求項1】 回動連結部によりトレーラが連結された
トラクタの両側に、直進時にトレーラ後端がかろうじて
撮影視野に入るよう取り付けられた、水平方向視野角が
広い広視野角カメラと、該広視野角カメラで撮影したト
レーラ後端画像の画面内位置を求め、該画面内位置を該
画面内位置と前記連結角との対応関係を表すマップに適
用して、連結角を求める連結角演算装置とを具えたこと
を特徴とするトレーラ連結角検出装置。
1. A wide viewing angle camera having a wide horizontal viewing angle, which is mounted on both sides of a tractor to which a trailer is connected by a rotation connection portion so that the trailing end of the trailer barely enters a shooting field of view when traveling straight. A connection angle calculation device for obtaining a connection angle by obtaining a position in a screen of a trailer trailing edge image captured by a viewing angle camera and applying the position in the screen to a map representing a correspondence relationship between the position in the screen and the connection angle. And a trailer connection angle detecting device.
【請求項2】 回動連結部によりトレーラが連結された
トラクタの両側に、直進時にトレーラ後端がかろうじて
撮影視野に入るよう取り付けられた、水平方向視野角が
特に広くはない標準視野角カメラと、該標準視野角カメ
ラを水平方向に段階的に回動するモータと、前記標準視
野角カメラで撮影されたトレーラ後端画像の画面内位置
を求め、該画面内位置を該画面内位置と前記連結角との
対応関係を表すマップに適用して、連結角を求める連結
角演算装置と、前記撮影されたトレーラ後端画像が、水
平方向視野角内の予め設定した内方向回動開始線および
外方向回動開始線に挟まれた範囲からはみ出した場合、
前記モータの回動段数を検出し、トレーラ後端が該範囲
に入るよう、前記標準視野角カメラを回動するモータ駆
動部とを具えたことを特徴とするトレーラ連結角検出装
置。
2. A standard view angle camera having a horizontal view angle which is not particularly wide, which is mounted on both sides of a tractor to which a trailer is connected by a rotation connection portion such that a trailing end of the trailer barely enters a shooting view field when traveling straight. A motor for rotating the standard viewing angle camera stepwise in a horizontal direction, and a position in a screen of a trailer trailing end image photographed by the standard viewing angle camera is obtained. Applying to the map representing the correspondence relationship with the connection angle, the connection angle calculation device for obtaining the connection angle, and the photographed trailer trailing end image, the preset inward rotation start line within the horizontal viewing angle and If it goes outside the range between the outward rotation start lines,
And a motor drive unit for rotating the standard viewing angle camera so that the trailing end of the trailer falls within the range.
JP2000385338A2000-10-022000-12-19Device for detecting angle of coupling of trailerPendingJP2002181518A (en)

Priority Applications (1)

Application NumberPriority DateFiling DateTitle
JP2000385338AJP2002181518A (en)2000-10-022000-12-19Device for detecting angle of coupling of trailer

Applications Claiming Priority (3)

Application NumberPriority DateFiling DateTitle
JP2000-3016822000-10-02
JP20003016822000-10-02
JP2000385338AJP2002181518A (en)2000-10-022000-12-19Device for detecting angle of coupling of trailer

Publications (1)

Publication NumberPublication Date
JP2002181518Atrue JP2002181518A (en)2002-06-26

Family

ID=26601325

Family Applications (1)

Application NumberTitlePriority DateFiling Date
JP2000385338APendingJP2002181518A (en)2000-10-022000-12-19Device for detecting angle of coupling of trailer

Country Status (1)

CountryLink
JP (1)JP2002181518A (en)

Cited By (12)

* Cited by examiner, † Cited by third party
Publication numberPriority datePublication dateAssigneeTitle
EP1529689A1 (en)*2003-11-052005-05-11DaimlerChrysler AGMethod to display the path of a drawn vehicle axle
EP1892150A2 (en)2006-08-212008-02-27Sanyo Electric Co., Ltd.Image processor and vehicle surrounding visual field support device
GB2447672A (en)*2007-03-212008-09-24Ford Global Tech LlcVehicle manoeuvring aids
JP2016107985A (en)*2014-12-052016-06-20メクラ・ラング・ゲーエムベーハー・ウント・コー・カーゲーMEKRA Lang GmbH & Co. KG Visual system
JP2017215936A (en)*2016-03-162017-12-07メクラ・ラング・ゲーエムベーハー・ウント・コー・カーゲーMEKRA Lang GmbH & Co. KGVisual system for vehicles, in particular visual system for commercial vehicles
EP3293971A1 (en)*2016-09-072018-03-14Continental Automotive GmbHMethod for reproducing a section of an image
EP3321130A1 (en)*2016-09-072018-05-16Continental Automotive GmbHMethod for reproducing a section of an image
WO2018108532A1 (en)*2016-12-172018-06-21Wabco Europe BvbaMethod for monitoring the vehicle surroundings of a vehicle combination and monitoring system
JP2019047143A (en)*2017-08-292019-03-22サカエ理研工業株式会社Vehicle periphery vision device
GB2616102A (en)*2021-12-022023-08-30Motherson Innovations Co LtdCamera-wing-system, vehicle therewith and method to operate the same
JP2025515250A (en)*2022-03-312025-05-14ストーンリッジ エレクトロニクス アーベー Dynamic Longitudinal and Lateral Line of Recognition Adjustment for Commercial Vehicle Camera Mirror Systems
FR3155795A1 (en)*2023-11-282025-05-30Continental Autonomous Mobility Germany GmbH Method for determining the angular position of a trailer relative to a towing vehicle

Cited By (22)

* Cited by examiner, † Cited by third party
Publication numberPriority datePublication dateAssigneeTitle
EP1529689A1 (en)*2003-11-052005-05-11DaimlerChrysler AGMethod to display the path of a drawn vehicle axle
US7974444B2 (en)2006-08-212011-07-05Sanyo Electric Co., Ltd.Image processor and vehicle surrounding visual field support device
EP1892150A2 (en)2006-08-212008-02-27Sanyo Electric Co., Ltd.Image processor and vehicle surrounding visual field support device
US9971943B2 (en)2007-03-212018-05-15Ford Global Technologies, LlcVehicle trailer angle detection system and method
GB2447672B (en)*2007-03-212011-12-14Ford Global Tech LlcVehicle manoeuvring aids
US9156496B2 (en)2007-03-212015-10-13Ford Global Technologies, LlcVehicle maneuvering aids
US9566911B2 (en)2007-03-212017-02-14Ford Global Technologies, LlcVehicle trailer angle detection system and method
GB2447672A (en)*2007-03-212008-09-24Ford Global Tech LlcVehicle manoeuvring aids
JP2016107985A (en)*2014-12-052016-06-20メクラ・ラング・ゲーエムベーハー・ウント・コー・カーゲーMEKRA Lang GmbH & Co. KG Visual system
JP2017215936A (en)*2016-03-162017-12-07メクラ・ラング・ゲーエムベーハー・ウント・コー・カーゲーMEKRA Lang GmbH & Co. KGVisual system for vehicles, in particular visual system for commercial vehicles
EP3293971A1 (en)*2016-09-072018-03-14Continental Automotive GmbHMethod for reproducing a section of an image
EP3321130A1 (en)*2016-09-072018-05-16Continental Automotive GmbHMethod for reproducing a section of an image
WO2018108532A1 (en)*2016-12-172018-06-21Wabco Europe BvbaMethod for monitoring the vehicle surroundings of a vehicle combination and monitoring system
CN110073429A (en)*2016-12-172019-07-30威伯科欧洲有限责任公司For monitoring the method and monitoring system of the vehicle-periphery of vehicle combination
US10713505B2 (en)2016-12-172020-07-14Wabco Europe BvbaMethod for monitoring the vehicle surroundings of a vehicle combination and monitoring system
CN110073429B (en)*2016-12-172022-06-14威伯科欧洲有限责任公司Method for monitoring the surroundings of a vehicle combination and monitoring system
JP2019047143A (en)*2017-08-292019-03-22サカエ理研工業株式会社Vehicle periphery vision device
GB2616102A (en)*2021-12-022023-08-30Motherson Innovations Co LtdCamera-wing-system, vehicle therewith and method to operate the same
GB2616102B (en)*2021-12-022024-06-19Motherson Innovations Co LtdCamera-wing-system, vehicle therewith and method to operate the same
JP2025515250A (en)*2022-03-312025-05-14ストーンリッジ エレクトロニクス アーベー Dynamic Longitudinal and Lateral Line of Recognition Adjustment for Commercial Vehicle Camera Mirror Systems
FR3155795A1 (en)*2023-11-282025-05-30Continental Autonomous Mobility Germany GmbH Method for determining the angular position of a trailer relative to a towing vehicle
EP4564296A1 (en)*2023-11-282025-06-04Continental Autonomous Mobility Germany GmbHMethod for determining the angular position of a trailer with respect to a towing vehicle

Similar Documents

PublicationPublication DateTitle
JP2002120775A (en)Trailer connecting angle detection device
US11620837B2 (en)Systems and methods for augmenting upright object detection
JP5867273B2 (en) Approaching object detection device, approaching object detection method, and computer program for approaching object detection
US8018488B2 (en)Vehicle-periphery image generating apparatus and method of switching images
CN110909705B (en)Road side parking space sensing method and system based on vehicle-mounted camera
US8670036B2 (en)Image-based vehicle maneuvering assistant method and system
JP3125550B2 (en) Vehicle forward recognition device and vehicle travel control device
JP2002181518A (en)Device for detecting angle of coupling of trailer
JP3092105B1 (en) Outside monitoring device with fail-safe function
CN112529935B (en)Target vehicle motion state identification method and device
WO2018207782A1 (en)Parking space detection device
JP2010019589A (en)Inter-vehicle distance detector, drive recorder apparatus
CN114572192B (en) Parking assistance device and parking assistance method
US20090099767A1 (en)Light stripe detection method for indoor navigation and parking assist apparatus using the same
JP3991731B2 (en) Parking direction setting device for vehicles
CN113808013A (en)Method and device for generating aerial view point image
JP3900415B2 (en) Vehicle peripheral image processing apparatus, program, and recording medium
CN116039538A (en) A control method and device for a rotating camera of a vehicle, and the vehicle
JP3395393B2 (en) Vehicle periphery display device
JP6314655B2 (en) Marking line detection device, marking line detection method
JP2022098113A (en)Parking support device and parking support method
JP2919718B2 (en) Vehicle distance measuring device and vehicle equipped with it
JP2002114176A (en)Trailer connecting angle detecting device
JP2003030627A (en)Vehicle peripheral image processor and recording medium
CN114814803B (en) A method, device and storage medium for visual ranging of a vehicle

[8]ページ先頭

©2009-2025 Movatter.jp